release/src-rt-6.x/linux/linux-2.6/drivers/mtd/maps/mainstone-flash.c

   1 /*
   2  * $Id:  $
   3  *
   4  * Map driver for the Mainstone developer platform.
   5  *
   6  * Author:      Nicolas Pitre
   7  * Copyright:   (C) 2001 MontaVista Software Inc.
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License version 2 as
  11  * published by the Free Software Foundation.
  12  */
  13
  14 #include <linux/module.h>
  15 #include <linux/types.h>
  16 #include <linux/kernel.h>
  17 #include <linux/init.h>
  18 #include <linux/dma-mapping.h>
  19 #include <linux/slab.h>
  20
  21 #include <linux/mtd/mtd.h>
  22 #include <linux/mtd/map.h>
  23 #include <linux/mtd/partitions.h>
  24
  25 #include <asm/io.h>
  26 #include <asm/hardware.h>
  27 #include <asm/arch/pxa-regs.h>
  28 #include <asm/arch/mainstone.h>
  29
  30
  31 #define ROM_ADDR        0x00000000
  32 #define FLASH_ADDR      0x04000000
  33
  34 #define WINDOW_SIZE     0x04000000
  35
  36 static void mainstone_map_inval_cache(struct map_info *map, unsigned long from,
  37                                       ssize_t len)
  38 {
  39         consistent_sync((char *)map->cached + from, len, DMA_FROM_DEVICE);
  40 }
  41
  42 static struct map_info mainstone_maps[2] = { {
  43         .size =         WINDOW_SIZE,
  44         .phys =         PXA_CS0_PHYS,
  45         .inval_cache =  mainstone_map_inval_cache,
  46 }, {
  47         .size =         WINDOW_SIZE,
  48         .phys =         PXA_CS1_PHYS,
  49         .inval_cache =  mainstone_map_inval_cache,
  50 } };
  51
  52 static struct mtd_partition mainstone_partitions[] = {
  53         {
  54                 .name =         "Bootloader",
  55                 .size =         0x00040000,
  56                 .offset =       0,
  57                 .mask_flags =   MTD_WRITEABLE  /* force read-only */
  58         },{
  59                 .name =         "Kernel",
  60                 .size =         0x00400000,
  61                 .offset =       0x00040000,
  62         },{
  63                 .name =         "Filesystem",
  64                 .size =         MTDPART_SIZ_FULL,
  65                 .offset =       0x00440000
  66         }
  67 };
  68
  69 static struct mtd_info *mymtds[2];
  70 static struct mtd_partition *parsed_parts[2];
  71 static int nr_parsed_parts[2];
  72
  73 static const char *probes[] = { "RedBoot", "cmdlinepart", NULL };
  74
  75 static int __init init_mainstone(void)
  76 {
  77         int SW7 = 0;  /* FIXME: get from SCR (Mst doc section 3.2.1.1) */
  78         int ret = 0, i;
  79
  80         mainstone_maps[0].bankwidth = (BOOT_DEF & 1) ? 2 : 4;
  81         mainstone_maps[1].bankwidth = 4;
  82
  83         /* Compensate for SW7 which swaps the flash banks */
  84         mainstone_maps[SW7].name = "processor flash";
  85         mainstone_maps[SW7 ^ 1].name = "main board flash";
  86
  87         printk(KERN_NOTICE "Mainstone configured to boot from %s\n",
  88                mainstone_maps[0].name);
  89
  90         for (i = 0; i < 2; i++) {
  91                 mainstone_maps[i].virt = ioremap(mainstone_maps[i].phys,
  92                                                  WINDOW_SIZE);
  93                 if (!mainstone_maps[i].virt) {
  94                         printk(KERN_WARNING "Failed to ioremap %s\n",
  95                                mainstone_maps[i].name);
  96                         if (!ret)
  97                                 ret = -ENOMEM;
  98                         continue;
  99                 }
 100                 mainstone_maps[i].cached =
 101                         ioremap_cached(mainstone_maps[i].phys, WINDOW_SIZE);
 102                 if (!mainstone_maps[i].cached)
 103                         printk(KERN_WARNING "Failed to ioremap cached %s\n",
 104                                mainstone_maps[i].name);
 105                 simple_map_init(&mainstone_maps[i]);
 106
 107                 printk(KERN_NOTICE
 108                        "Probing %s at physical address 0x%08lx"
 109                        " (%d-bit bankwidth)\n",
 110                        mainstone_maps[i].name, mainstone_maps[i].phys,
 111                        mainstone_maps[i].bankwidth * 8);
 112
 113                 mymtds[i] = do_map_probe("cfi_probe", &mainstone_maps[i]);
 114
 115                 if (!mymtds[i]) {
 116                         iounmap((void *)mainstone_maps[i].virt);
 117                         if (mainstone_maps[i].cached)
 118                                 iounmap(mainstone_maps[i].cached);
 119                         if (!ret)
 120                                 ret = -EIO;
 121                         continue;
 122                 }
 123                 mymtds[i]->owner = THIS_MODULE;
 124
 125                 ret = parse_mtd_partitions(mymtds[i], probes,
 126                                            &parsed_parts[i], 0);
 127
 128                 if (ret > 0)
 129                         nr_parsed_parts[i] = ret;
 130         }
 131
 132         if (!mymtds[0] && !mymtds[1])
 133                 return ret;
 134
 135         for (i = 0; i < 2; i++) {
 136                 if (!mymtds[i]) {
 137                         printk(KERN_WARNING "%s is absent. Skipping\n",
 138                                mainstone_maps[i].name);
 139                 } else if (nr_parsed_parts[i]) {
 140                         add_mtd_partitions(mymtds[i], parsed_parts[i],
 141                                            nr_parsed_parts[i]);
 142                 } else if (!i) {
 143                         printk("Using static partitions on %s\n",
 144                                mainstone_maps[i].name);
 145                         add_mtd_partitions(mymtds[i], mainstone_partitions,
 146                                            ARRAY_SIZE(mainstone_partitions));
 147                 } else {
 148                         printk("Registering %s as whole device\n",
 149                                mainstone_maps[i].name);
 150                         add_mtd_device(mymtds[i]);
 151                 }
 152         }
 153         return 0;
 154 }
 155
 156 static void __exit cleanup_mainstone(void)
 157 {
 158         int i;
 159         for (i = 0; i < 2; i++) {
 160                 if (!mymtds[i])
 161                         continue;
 162
 163                 if (nr_parsed_parts[i] || !i)
 164                         del_mtd_partitions(mymtds[i]);
 165                 else
 166                         del_mtd_device(mymtds[i]);
 167
 168                 map_destroy(mymtds[i]);
 169                 iounmap((void *)mainstone_maps[i].virt);
 170                 if (mainstone_maps[i].cached)
 171                         iounmap(mainstone_maps[i].cached);
 172                 kfree(parsed_parts[i]);
 173         }
 174 }
 175
 176 module_init(init_mainstone);
 177 module_exit(cleanup_mainstone);
 178
 179 MODULE_LICENSE("GPL");
 180 MODULE_AUTHOR("Nicolas Pitre <nico@cam.org>");
 181 MODULE_DESCRIPTION("MTD map driver for Intel Mainstone");