drivers/mtd/maps/ocotea.c

   1 /*
   2  * Mapping for Ocotea user flash
   3  *
   4  * Matt Porter <mporter@kernel.crashing.org>
   5  *
   6  * Copyright 2002-2004 MontaVista Software Inc.
   7  *
   8  * This program is free software; you can redistribute  it and/or modify it
   9  * under  the terms of  the GNU General  Public License as published by the
  10  * Free Software Foundation;  either version 2 of the  License, or (at your
  11  * option) any later version.
  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/mtd/mtd.h>
  19 #include <linux/mtd/map.h>
  20 #include <linux/mtd/partitions.h>
  21 #include <asm/io.h>
  22 #include <asm/ibm44x.h>
  23 #include <platforms/4xx/ocotea.h>
  24
  25 static struct mtd_info *flash;
  26
  27 static struct map_info ocotea_small_map = {
  28         .name =         "Ocotea small flash",
  29         .size =         OCOTEA_SMALL_FLASH_SIZE,
  30         .buswidth =     1,
  31 };
  32
  33 static struct map_info ocotea_large_map = {
  34         .name =         "Ocotea large flash",
  35         .size =         OCOTEA_LARGE_FLASH_SIZE,
  36         .buswidth =     1,
  37 };
  38
  39 static struct mtd_partition ocotea_small_partitions[] = {
  40         {
  41                 .name =   "pibs",
  42                 .offset = 0x0,
  43                 .size =   0x100000,
  44         }
  45 };
  46
  47 static struct mtd_partition ocotea_large_partitions[] = {
  48         {
  49                 .name =   "fs",
  50                 .offset = 0,
  51                 .size =   0x300000,
  52         },
  53         {
  54                 .name =   "firmware",
  55                 .offset = 0x300000,
  56                 .size =   0x100000,
  57         }
  58 };
  59
  60 int __init init_ocotea(void)
  61 {
  62         u8 fpga0_reg;
  63         u8 *fpga0_adr;
  64         unsigned long long small_flash_base, large_flash_base;
  65
  66         fpga0_adr = ioremap64(OCOTEA_FPGA_ADDR, 16);
  67         if (!fpga0_adr)
  68                 return -ENOMEM;
  69
  70         fpga0_reg = readb((unsigned long)fpga0_adr);
  71         iounmap(fpga0_adr);
  72
  73         if (OCOTEA_BOOT_LARGE_FLASH(fpga0_reg)) {
  74                 small_flash_base = OCOTEA_SMALL_FLASH_HIGH;
  75                 large_flash_base = OCOTEA_LARGE_FLASH_LOW;
  76         }
  77         else {
  78                 small_flash_base = OCOTEA_SMALL_FLASH_LOW;
  79                 large_flash_base = OCOTEA_LARGE_FLASH_HIGH;
  80         }
  81
  82         ocotea_small_map.phys = small_flash_base;
  83         ocotea_small_map.virt = ioremap64(small_flash_base,
  84                                          ocotea_small_map.size);
  85
  86         if (!ocotea_small_map.virt) {
  87                 printk("Failed to ioremap flash\n");
  88                 return -EIO;
  89         }
  90
  91         simple_map_init(&ocotea_small_map);
  92
  93         flash = do_map_probe("map_rom", &ocotea_small_map);
  94         if (flash) {
  95                 flash->owner = THIS_MODULE;
  96                 add_mtd_partitions(flash, ocotea_small_partitions,
  97                                         ARRAY_SIZE(ocotea_small_partitions));
  98         } else {
  99                 printk("map probe failed for flash\n");
 100                 iounmap(ocotea_small_map.virt);
 101                 return -ENXIO;
 102         }
 103
 104         ocotea_large_map.phys = large_flash_base;
 105         ocotea_large_map.virt = ioremap64(large_flash_base,
 106                                          ocotea_large_map.size);
 107
 108         if (!ocotea_large_map.virt) {
 109                 printk("Failed to ioremap flash\n");
 110                 iounmap(ocotea_small_map.virt);
 111                 return -EIO;
 112         }
 113
 114         simple_map_init(&ocotea_large_map);
 115
 116         flash = do_map_probe("cfi_probe", &ocotea_large_map);
 117         if (flash) {
 118                 flash->owner = THIS_MODULE;
 119                 add_mtd_partitions(flash, ocotea_large_partitions,
 120                                         ARRAY_SIZE(ocotea_large_partitions));
 121         } else {
 122                 printk("map probe failed for flash\n");
 123                 iounmap(ocotea_small_map.virt);
 124                 iounmap(ocotea_large_map.virt);
 125                 return -ENXIO;
 126         }
 127
 128         return 0;
 129 }
 130
 131 static void __exit cleanup_ocotea(void)
 132 {
 133         if (flash) {
 134                 del_mtd_partitions(flash);
 135                 map_destroy(flash);
 136         }
 137
 138         if (ocotea_small_map.virt) {
 139                 iounmap((void *)ocotea_small_map.virt);
 140                 ocotea_small_map.virt = 0;
 141         }
 142
 143         if (ocotea_large_map.virt) {
 144                 iounmap((void *)ocotea_large_map.virt);
 145                 ocotea_large_map.virt = 0;
 146         }
 147 }
 148
 149 module_init(init_ocotea);
 150 module_exit(cleanup_ocotea);
 151
 152 MODULE_LICENSE("GPL");
 153 MODULE_AUTHOR("Matt Porter <mporter@kernel.crashing.org>");
 154 MODULE_DESCRIPTION("MTD map and partitions for IBM 440GX Ocotea boards");