[MTD] Add mapping driver for Intel PXA27x Mainstone board flash.

From: Nicolas Pitre <nico@cam.org>
Signed-off-by: Todd Poynor <tpoynor@mvista.com>
Signed-off-by: Thomas Gleixner <tglx@linutronix.de>

diff --git a/drivers/mtd/maps/Kconfig b/drivers/mtd/maps/Kconfig
index 8d27dbf..dbe1716 100644 (file)
--- a/drivers/mtd/maps/Kconfig
+++ b/drivers/mtd/maps/Kconfig
@@ -1,5 +1,5 @@
 # drivers/mtd/maps/Kconfig
-# $Id: Kconfig,v 1.51 2005/03/18 02:07:22 gleixner Exp $
+# $Id: Kconfig,v 1.54 2005/06/30 22:41:36 tpoynor Exp $
 
 menu "Mapping drivers for chip access"
        depends on MTD!=n
@@ -129,6 +129,14 @@ config MTD_LUBBOCK
          This provides a driver for the on-board flash of the Intel
          'Lubbock' XScale evaluation board.
 
+config MTD_MAINSTONE
+       tristate "CFI Flash device mapped on Intel Mainstone XScale eval board"
+       depends on MACH_MAINSTONE && MTD_CFI_INTELEXT
+       select MTD_PARTITIONS
+       help
+         This provides a driver for the on-board flash of the Intel
+         'Mainstone PXA27x evaluation board.
+
 config MTD_OCTAGON
        tristate "JEDEC Flash device mapped on Octagon 5066 SBC"
        depends on X86 && MTD_JEDEC && MTD_COMPLEX_MAPPINGS

diff --git a/drivers/mtd/maps/Makefile b/drivers/mtd/maps/Makefile
index 164cafc..789a4b7 100644 (file)
--- a/drivers/mtd/maps/Makefile
+++ b/drivers/mtd/maps/Makefile
@@ -1,7 +1,7 @@
 #
 # linux/drivers/maps/Makefile
 #
-# $Id: Makefile.common,v 1.26 2005/03/02 14:51:04 dvrabel Exp $
+# $Id: Makefile.common,v 1.29 2005/06/30 22:41:36 tpoynor Exp $
 
 ifeq ($(CONFIG_MTD_COMPLEX_MAPPINGS),y)
 obj-$(CONFIG_MTD)              += map_funcs.o
@@ -22,6 +22,7 @@ obj-$(CONFIG_MTD_AMD76XROM)   += amd76xrom.o
 obj-$(CONFIG_MTD_ICHXROM)      += ichxrom.o
 obj-$(CONFIG_MTD_TSUNAMI)      += tsunami_flash.o
 obj-$(CONFIG_MTD_LUBBOCK)      += lubbock-flash.o
+obj-$(CONFIG_MTD_MAINSTONE)    += mainstone-flash.o
 obj-$(CONFIG_MTD_MBX860)       += mbx860.o
 obj-$(CONFIG_MTD_CEIVA)                += ceiva.o
 obj-$(CONFIG_MTD_OCTAGON)      += octagon-5066.o

diff --git a/drivers/mtd/maps/mainstone-flash.c b/drivers/mtd/maps/mainstone-flash.c
new file mode 100644 (file)
index 0000000..87e93fa
--- /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");