root/drivers/mtd/maps/cfi_flagadm.c

DEFINITIONS

1. init_flagadm
2. cleanup_flagadm

   1 /*
   2  *  Copyright © 2001 Flaga hf. Medical Devices, Kári Davíðsson <kd@flaga.is>
   3  *
   4  *  This program is free software; you can redistribute  it and/or modify it
   5  *  under  the terms of  the GNU General  Public License as published by the
   6  *  Free Software Foundation;  either version 2 of the  License, or (at your
   7  *  option) any later version.
   8  *
   9  *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
  10  *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
  11  *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
  12  *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
  13  *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  14  *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
  15  *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
  16  *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
  17  *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  18  *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  19  *
  20  *  You should have received a copy of the  GNU General Public License along
  21  *  with this program; if not, write  to the Free Software Foundation, Inc.,
  22  *  675 Mass Ave, Cambridge, MA 02139, USA.
  23  */
  24 
  25 #include <linux/module.h>
  26 #include <linux/types.h>
  27 #include <linux/kernel.h>
  28 #include <linux/init.h>
  29 #include <asm/io.h>
  30 #include <linux/mtd/mtd.h>
  31 #include <linux/mtd/map.h>
  32 #include <linux/mtd/partitions.h>
  33 
  34 
  35 /* We split the flash chip up into four parts.
  36  * 1: bootloader first 128k                     (0x00000000 - 0x0001FFFF) size 0x020000
  37  * 2: kernel 640k                                       (0x00020000 - 0x000BFFFF) size 0x0A0000
  38  * 3: compressed 1536k root ramdisk     (0x000C0000 - 0x0023FFFF) size 0x180000
  39  * 4: writeable diskpartition (jffs)(0x00240000 - 0x003FFFFF) size 0x1C0000
  40  */
  41 
  42 #define FLASH_PHYS_ADDR 0x40000000
  43 #define FLASH_SIZE 0x400000
  44 
  45 #define FLASH_PARTITION0_ADDR 0x00000000
  46 #define FLASH_PARTITION0_SIZE 0x00020000
  47 
  48 #define FLASH_PARTITION1_ADDR 0x00020000
  49 #define FLASH_PARTITION1_SIZE 0x000A0000
  50 
  51 #define FLASH_PARTITION2_ADDR 0x000C0000
  52 #define FLASH_PARTITION2_SIZE 0x00180000
  53 
  54 #define FLASH_PARTITION3_ADDR 0x00240000
  55 #define FLASH_PARTITION3_SIZE 0x001C0000
  56 
  57 
  58 static struct map_info flagadm_map = {
  59                 .name =         "FlagaDM flash device",
  60                 .size =         FLASH_SIZE,
  61                 .bankwidth =    2,
  62 };
  63 
  64 static const struct mtd_partition flagadm_parts[] = {
  65         {
  66                 .name =         "Bootloader",
  67                 .offset =       FLASH_PARTITION0_ADDR,
  68                 .size =         FLASH_PARTITION0_SIZE
  69         },
  70         {
  71                 .name =         "Kernel image",
  72                 .offset =       FLASH_PARTITION1_ADDR,
  73                 .size =         FLASH_PARTITION1_SIZE
  74         },
  75         {
  76                 .name =         "Initial ramdisk image",
  77                 .offset =       FLASH_PARTITION2_ADDR,
  78                 .size =         FLASH_PARTITION2_SIZE
  79         },
  80         {
  81                 .name =         "Persistent storage",
  82                 .offset =       FLASH_PARTITION3_ADDR,
  83                 .size =         FLASH_PARTITION3_SIZE
  84         }
  85 };
  86 
  87 #define PARTITION_COUNT ARRAY_SIZE(flagadm_parts)
  88 
  89 static struct mtd_info *mymtd;
  90 
  91 static int __init init_flagadm(void)
  92 {
  93         printk(KERN_NOTICE "FlagaDM flash device: %x at %x\n",
  94                         FLASH_SIZE, FLASH_PHYS_ADDR);
  95 
  96         flagadm_map.phys = FLASH_PHYS_ADDR;
  97         flagadm_map.virt = ioremap(FLASH_PHYS_ADDR,
  98                                         FLASH_SIZE);
  99 
 100         if (!flagadm_map.virt) {
 101                 printk("Failed to ioremap\n");
 102                 return -EIO;
 103         }
 104 
 105         simple_map_init(&flagadm_map);
 106 
 107         mymtd = do_map_probe("cfi_probe", &flagadm_map);
 108         if (mymtd) {
 109                 mymtd->owner = THIS_MODULE;
 110                 mtd_device_register(mymtd, flagadm_parts, PARTITION_COUNT);
 111                 printk(KERN_NOTICE "FlagaDM flash device initialized\n");
 112                 return 0;
 113         }
 114 
 115         iounmap((void __iomem *)flagadm_map.virt);
 116         return -ENXIO;
 117 }
 118 
 119 static void __exit cleanup_flagadm(void)
 120 {
 121         if (mymtd) {
 122                 mtd_device_unregister(mymtd);
 123                 map_destroy(mymtd);
 124         }
 125         if (flagadm_map.virt) {
 126                 iounmap((void __iomem *)flagadm_map.virt);
 127                 flagadm_map.virt = NULL;
 128         }
 129 }
 130 
 131 module_init(init_flagadm);
 132 module_exit(cleanup_flagadm);
 133 
 134 
 135 MODULE_LICENSE("GPL");
 136 MODULE_AUTHOR("Kári Davíðsson <kd@flaga.is>");
 137 MODULE_DESCRIPTION("MTD map driver for Flaga digital module");