138 lines
3.9 KiB
C
138 lines
3.9 KiB
C
|
/*
|
||
|
|
* Copyright © 2001 Flaga hf. Medical Devices, Kári Davíðsson <kd@flaga.is>
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify it
|
||
|
|
* under the terms of the GNU General Public License as published by the
|
||
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
||
|
|
* option) any later version.
|
||
|
|
*
|
||
|
|
* THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
||
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
|
||
|
|
* NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
|
||
|
|
* USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
||
|
|
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License along
|
||
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||
|
|
* 675 Mass Ave, Cambridge, MA 02139, USA.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/types.h>
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <asm/io.h>
|
||
|
|
#include <linux/mtd/mtd.h>
|
||
|
|
#include <linux/mtd/map.h>
|
||
|
|
#include <linux/mtd/partitions.h>
|
||
|
|
|
||
|
|
|
||
|
|
/* We split the flash chip up into four parts.
|
||
|
|
* 1: bootloader first 128k (0x00000000 - 0x0001FFFF) size 0x020000
|
||
|
|
* 2: kernel 640k (0x00020000 - 0x000BFFFF) size 0x0A0000
|
||
|
|
* 3: compressed 1536k root ramdisk (0x000C0000 - 0x0023FFFF) size 0x180000
|
||
|
|
* 4: writeable diskpartition (jffs)(0x00240000 - 0x003FFFFF) size 0x1C0000
|
||
|
|
*/
|
||
|
|
|
||
|
|
#define FLASH_PHYS_ADDR 0x40000000
|
||
|
|
#define FLASH_SIZE 0x400000
|
||
|
|
|
||
|
|
#define FLASH_PARTITION0_ADDR 0x00000000
|
||
|
|
#define FLASH_PARTITION0_SIZE 0x00020000
|
||
|
|
|
||
|
|
#define FLASH_PARTITION1_ADDR 0x00020000
|
||
|
|
#define FLASH_PARTITION1_SIZE 0x000A0000
|
||
|
|
|
||
|
|
#define FLASH_PARTITION2_ADDR 0x000C0000
|
||
|
|
#define FLASH_PARTITION2_SIZE 0x00180000
|
||
|
|
|
||
|
|
#define FLASH_PARTITION3_ADDR 0x00240000
|
||
|
|
#define FLASH_PARTITION3_SIZE 0x001C0000
|
||
|
|
|
||
|
|
|
||
|
|
static struct map_info flagadm_map = {
|
||
|
|
.name = "FlagaDM flash device",
|
||
|
|
.size = FLASH_SIZE,
|
||
|
|
.bankwidth = 2,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct mtd_partition flagadm_parts[] = {
|
||
|
|
{
|
||
|
|
.name = "Bootloader",
|
||
|
|
.offset = FLASH_PARTITION0_ADDR,
|
||
|
|
.size = FLASH_PARTITION0_SIZE
|
||
|
|
},
|
||
|
|
{
|
||
|
|
.name = "Kernel image",
|
||
|
|
.offset = FLASH_PARTITION1_ADDR,
|
||
|
|
.size = FLASH_PARTITION1_SIZE
|
||
|
|
},
|
||
|
|
{
|
||
|
|
.name = "Initial ramdisk image",
|
||
|
|
.offset = FLASH_PARTITION2_ADDR,
|
||
|
|
.size = FLASH_PARTITION2_SIZE
|
||
|
|
},
|
||
|
|
{
|
||
|
|
.name = "Persistent storage",
|
||
|
|
.offset = FLASH_PARTITION3_ADDR,
|
||
|
|
.size = FLASH_PARTITION3_SIZE
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
#define PARTITION_COUNT ARRAY_SIZE(flagadm_parts)
|
||
|
|
|
||
|
|
static struct mtd_info *mymtd;
|
||
|
|
|
||
|
|
static int __init init_flagadm(void)
|
||
|
|
{
|
||
|
|
printk(KERN_NOTICE "FlagaDM flash device: %x at %x\n",
|
||
|
|
FLASH_SIZE, FLASH_PHYS_ADDR);
|
||
|
|
|
||
|
|
flagadm_map.phys = FLASH_PHYS_ADDR;
|
||
|
|
flagadm_map.virt = ioremap(FLASH_PHYS_ADDR,
|
||
|
|
FLASH_SIZE);
|
||
|
|
|
||
|
|
if (!flagadm_map.virt) {
|
||
|
|
printk("Failed to ioremap\n");
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
|
||
|
|
simple_map_init(&flagadm_map);
|
||
|
|
|
||
|
|
mymtd = do_map_probe("cfi_probe", &flagadm_map);
|
||
|
|
if (mymtd) {
|
||
|
|
mymtd->owner = THIS_MODULE;
|
||
|
|
mtd_device_register(mymtd, flagadm_parts, PARTITION_COUNT);
|
||
|
|
printk(KERN_NOTICE "FlagaDM flash device initialized\n");
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
iounmap((void __iomem *)flagadm_map.virt);
|
||
|
|
return -ENXIO;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void __exit cleanup_flagadm(void)
|
||
|
|
{
|
||
|
|
if (mymtd) {
|
||
|
|
mtd_device_unregister(mymtd);
|
||
|
|
map_destroy(mymtd);
|
||
|
|
}
|
||
|
|
if (flagadm_map.virt) {
|
||
|
|
iounmap((void __iomem *)flagadm_map.virt);
|
||
|
|
flagadm_map.virt = NULL;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
module_init(init_flagadm);
|
||
|
|
module_exit(cleanup_flagadm);
|
||
|
|
|
||
|
|
|
||
|
|
MODULE_LICENSE("GPL");
|
||
|
|
MODULE_AUTHOR("Kári Davíðsson <kd@flaga.is>");
|
||
|
|
MODULE_DESCRIPTION("MTD map driver for Flaga digital module");
|