drivers/mtd/maps/uc711X.c

   1 /*
   2  *      UC-711X-LX Version 2 Flash mapping driver
   3  */
   4
   5 //#include <linux/config.h>
   6 //#include <asm/arch/moxa.h>
   7 #include <mach/hardware.h>
   8
   9 #include <linux/module.h>
  10 #include <linux/types.h>
  11 #include <linux/kernel.h>
  12 #include <linux/init.h>
  13 #include <linux/ioport.h>
  14
  15 #include <linux/mtd/mtd.h>
  16 #include <linux/mtd/map.h>
  17 #include <linux/mtd/partitions.h>
  18
  19 #include <asm/io.h>
  20
  21 //#define WINDOW_SIZE 0x00800000
  22 //#define UC7110_FLASH_SIZE 0x00800000
  23
  24 #define RW_PART0_OF     0x0
  25 #define RW_PART0_SZ     0x40000         /* Bootloader */
  26
  27 #define RW_PART1_OF     (RW_PART0_OF+RW_PART0_SZ)
  28 #define RW_PART1_SZ     (0x200000-RW_PART0_SZ)  /* Kernel */
  29
  30 #define RW_PART2_OF     (RW_PART1_OF+RW_PART1_SZ)
  31 #define RW_PART2_SZ     0x800000        /* root file system use JFFS2 */
  32
  33 #define RW_PART3_OF     (RW_PART2_OF+RW_PART2_SZ)
  34 //#define RW_PART3_SZ   (UC7110_FLASH_SIZE-RW_PART3_OF) /* user disk use JFFS2 */
  35 #define RW_PART3_SZ     0x600000        /* user disk use JFFS2 */
  36
  37 #define CONFIG_FLASH_MEM_BASE 0x80000000
  38 #define CONFIG_FLASH_SIZE 0x01000000
  39
  40 static struct map_info moxart_flash_map = {
  41         .name       = "UC-7112-LX-PLUS",
  42         .bankwidth  = 2,
  43         .phys       = CONFIG_FLASH_MEM_BASE,
  44         .size       = CONFIG_FLASH_SIZE,
  45         .virt       = IO_ADDRESS(CONFIG_FLASH_MEM_BASE),
  46 //      .virt           = 0xf4000000, //MTD: Unable to init map for flash
  47 };
  48
  49 static struct mtd_partition moxart_flash_partitions[] = {
  50         {
  51                 .name = "Bootloader",
  52                 .offset = RW_PART0_OF,
  53                 .size = RW_PART0_SZ
  54         },
  55         {
  56                 .name = "LinuxKernel",
  57                 .offset = RW_PART1_OF,
  58                 .size = RW_PART1_SZ,
  59                 //.mask_flags = MTD_WRITEABLE
  60         },
  61         {
  62                 .name = "RootFileSystem",
  63                 .offset = RW_PART2_OF,
  64                 .size = RW_PART2_SZ,
  65         //      .mask_flags = MTD_WRITEABLE
  66         },
  67         {
  68                 .name = "UserDisk",
  69                 .offset = RW_PART3_OF,
  70                 .size = RW_PART3_SZ
  71         }
  72 };
  73
  74 /*struct map_info moxart_flash_map = {
  75         .name = "UC7110LX V2 FLASH",
  76         .size = CONFIG_FLASH_SIZE,
  77         .bankwidth = 2,
  78         .phys = CONFIG_FLASH_MEM_BASE,
  79         .virt = IO_ADDRESS(CONFIG_FLASH_MEM_BASE),
  80 };*/
  81
  82 static int mtd_reboot(struct notifier_block *n, unsigned long code, void *p)
  83 {
  84         if(code != SYS_RESTART)
  85                                 return NOTIFY_DONE;
  86
  87         *( u16 *)(IO_ADDRESS(CONFIG_FLASH_MEM_BASE) + (0x55 * 2)) = 0xb0;
  88         *( u16 *)(IO_ADDRESS(CONFIG_FLASH_MEM_BASE) + (0x55 * 2)) = 0xff;
  89                 return NOTIFY_DONE;
  90 }
  91
  92 static struct notifier_block mtd_notifier = {
  93         notifier_call:  mtd_reboot,
  94         next:           NULL,
  95         priority:       0
  96 };
  97
  98 static struct mtd_info *moxart_mtd;
  99
 100 int __init init_flash(void)
 101 {
 102
 103         printk(KERN_NOTICE "MTD: MOXART CPU flash: probing %d-bit flash bus, flash mapping: 0x%x at 0x%x\n",    moxart_flash_map.bankwidth*8, CONFIG_FLASH_SIZE, CONFIG_FLASH_MEM_BASE);
 104         simple_map_init(&moxart_flash_map);
 105
 106         moxart_mtd = do_map_probe("cfi_probe",&moxart_flash_map);
 107         if (moxart_mtd) {
 108                 moxart_mtd->owner = THIS_MODULE;
 109                 printk(KERN_NOTICE "MTD: Using static partition definition\n");
 110                 add_mtd_partitions(moxart_mtd, moxart_flash_partitions, ARRAY_SIZE(moxart_flash_partitions));
 111         } else {
 112                 printk(KERN_ERR "MTD: map probe failed for flash\n");
 113                 iounmap(moxart_flash_map.virt);
 114                 return -ENXIO;
 115         }
 116
 117         //return -ENXIO;
 118         return 0;
 119 }
 120
 121
 122 int __init init_moxart_flash(void)
 123 {
 124         int status;
 125
 126         if ((status = init_flash())) {
 127                 printk(KERN_ERR "MTD: Unable to init map for flash\n");
 128         } else {
 129                 //register_reboot_notifier(&mtd_notifier);
 130         }
 131         return status;
 132 }
 133
 134
 135 static void __exit cleanup_moxart_flash(void)
 136 {
 137         if (moxart_mtd) {
 138                 //unregister_reboot_notifier(&mtd_notifier);
 139                 del_mtd_partitions(moxart_mtd);
 140                 map_destroy(moxart_mtd);
 141         }
 142 }
 143
 144 module_init(init_moxart_flash);
 145 module_exit(cleanup_moxart_flash);
 146
 147 MODULE_LICENSE("GPL");
 148 MODULE_AUTHOR("Jimmy_chen@moxa.com.tw");
 149 MODULE_DESCRIPTION("MTD map driver for the UC-7110-LX Version 2");