1 files changed, 178 insertions, 0 deletions

diff --git a/drivers/mtd/maps/mainstone-flash.c b/drivers/mtd/maps/mainstone-flash.c
new file mode 100644
index 000000000000..87e93fa60588
--- /dev/null
+++ b/drivers/mtd/maps/mainstone-flash.c
@@ -0,0 +1,178 @@
+/*
+ * $Id:  $
+ *
+ * Map driver for the Mainstone developer platform.
+ *
+ * Author:      Nicolas Pitre
+ * Copyright:   (C) 2001 MontaVista Software Inc.
+ * 
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/module.h>
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/dma-mapping.h>
+#include <linux/mtd/mtd.h>
+#include <linux/mtd/map.h>
+#include <linux/mtd/partitions.h>
+#include <asm/io.h>
+#include <asm/hardware.h>
+#include <asm/arch/pxa-regs.h>
+#include <asm/arch/mainstone.h>
+
+
+#define ROM_ADDR        0x00000000
+#define FLASH_ADDR      0x04000000
+
+#define WINDOW_SIZE     0x04000000
+
+static void mainstone_map_inval_cache(struct map_info *map, unsigned long from,
+                                      ssize_t len)
+{
+        consistent_sync((char *)map->cached + from, len, DMA_FROM_DEVICE);
+}
+
+static struct map_info mainstone_maps[2] = { {
+        .size =         WINDOW_SIZE,
+        .phys =         PXA_CS0_PHYS,
+        .inval_cache =  mainstone_map_inval_cache,
+}, {
+        .size =         WINDOW_SIZE,
+        .phys =         PXA_CS1_PHYS,
+        .inval_cache =  mainstone_map_inval_cache,
+} };
+
+static struct mtd_partition mainstone_partitions[] = {
+        {
+                .name =         "Bootloader",
+                .size =         0x00040000,
+                .offset =       0,
+                .mask_flags =   MTD_WRITEABLE  /* force read-only */
+        },{
+                .name =         "Kernel",
+                .size =         0x00400000,
+                .offset =       0x00040000,
+        },{
+                .name =         "Filesystem",
+                .size =         MTDPART_SIZ_FULL,
+                .offset =       0x00440000
+        }
+};
+
+static struct mtd_info *mymtds[2];
+static struct mtd_partition *parsed_parts[2];
+static int nr_parsed_parts[2];
+
+static const char *probes[] = { "RedBoot", "cmdlinepart", NULL };
+
+static int __init init_mainstone(void)
+{
+        int SW7 = 0;  /* FIXME: get from SCR (Mst doc section 3.2.1.1) */
+        int ret = 0, i;
+
+        mainstone_maps[0].bankwidth = (BOOT_DEF & 1) ? 2 : 4;
+        mainstone_maps[1].bankwidth = 4;
+
+        /* Compensate for SW7 which swaps the flash banks */
+        mainstone_maps[SW7].name = "processor flash";
+        mainstone_maps[SW7 ^ 1].name = "main board flash";
+
+        printk(KERN_NOTICE "Mainstone configured to boot from %s\n",
+               mainstone_maps[0].name);
+
+        for (i = 0; i < 2; i++) {
+                mainstone_maps[i].virt = ioremap(mainstone_maps[i].phys,
+                                                 WINDOW_SIZE);
+                if (!mainstone_maps[i].virt) {
+                        printk(KERN_WARNING "Failed to ioremap %s\n", 
+                               mainstone_maps[i].name);
+                        if (!ret)
+                                ret = -ENOMEM;
+                        continue;
+                }
+                mainstone_maps[i].cached = 
+                        ioremap_cached(mainstone_maps[i].phys, WINDOW_SIZE);
+                if (!mainstone_maps[i].cached)
+                        printk(KERN_WARNING "Failed to ioremap cached %s\n",
+                               mainstone_maps[i].name);
+                simple_map_init(&mainstone_maps[i]);
+
+                printk(KERN_NOTICE 
+                       "Probing %s at physical address 0x%08lx"
+                       " (%d-bit bankwidth)\n",
+                       mainstone_maps[i].name, mainstone_maps[i].phys, 
+                       mainstone_maps[i].bankwidth * 8);
+
+                mymtds[i] = do_map_probe("cfi_probe", &mainstone_maps[i]);
+                
+                if (!mymtds[i]) {
+                        iounmap((void *)mainstone_maps[i].virt);
+                        if (mainstone_maps[i].cached)
+                                iounmap(mainstone_maps[i].cached);
+                        if (!ret)
+                                ret = -EIO;
+                        continue;
+                }
+                mymtds[i]->owner = THIS_MODULE;
+
+                ret = parse_mtd_partitions(mymtds[i], probes,
+                                           &parsed_parts[i], 0);
+
+                if (ret > 0)
+                        nr_parsed_parts[i] = ret;
+        }
+
+        if (!mymtds[0] && !mymtds[1])
+                return ret;
+        
+        for (i = 0; i < 2; i++) {
+                if (!mymtds[i]) {
+                        printk(KERN_WARNING "%s is absent. Skipping\n", 
+                               mainstone_maps[i].name);
+                } else if (nr_parsed_parts[i]) {
+                        add_mtd_partitions(mymtds[i], parsed_parts[i], 
+                                           nr_parsed_parts[i]);
+                } else if (!i) {
+                        printk("Using static partitions on %s\n",
+                               mainstone_maps[i].name);
+                        add_mtd_partitions(mymtds[i], mainstone_partitions, 
+                                           ARRAY_SIZE(mainstone_partitions));
+                } else {
+                        printk("Registering %s as whole device\n", 
+                               mainstone_maps[i].name);
+                        add_mtd_device(mymtds[i]);
+                }
+        }
+        return 0;
+}
+
+static void __exit cleanup_mainstone(void)
+{
+        int i;
+        for (i = 0; i < 2; i++) {
+                if (!mymtds[i])
+                        continue;
+
+                if (nr_parsed_parts[i] || !i)
+                        del_mtd_partitions(mymtds[i]);
+                else
+                        del_mtd_device(mymtds[i]);
+
+                map_destroy(mymtds[i]);
+                iounmap((void *)mainstone_maps[i].virt);
+                if (mainstone_maps[i].cached)
+                        iounmap(mainstone_maps[i].cached);
+                kfree(parsed_parts[i]);
+        }
+}
+
+module_init(init_mainstone);
+module_exit(cleanup_mainstone);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Nicolas Pitre <nico@cam.org>");
+MODULE_DESCRIPTION("MTD map driver for Intel Mainstone");