drivers/mtd/maps/uclinux.c

   1 /****************************************************************************/
   2
   3 /*
   4  *      uclinux.c -- generic memory mapped MTD driver for uclinux
   5  *
   6  *      (C) Copyright 2002, Greg Ungerer (gerg@snapgear.com)
   7  *
   8  *      $Id: uclinux.c,v 1.12 2005/11/07 11:14:29 gleixner Exp $
   9  */
  10
  11 /****************************************************************************/
  12
  13 #include <linux/module.h>
  14 #include <linux/types.h>
  15 #include <linux/init.h>
  16 #include <linux/kernel.h>
  17 #include <linux/fs.h>
  18 #include <linux/mm.h>
  19 #include <linux/major.h>
  20 #include <linux/mtd/mtd.h>
  21 #include <linux/mtd/map.h>
  22 #include <linux/mtd/partitions.h>
  23 #include <asm/io.h>
  24
  25 /****************************************************************************/
  26
  27 struct map_info uclinux_ram_map = {
  28         .name = "RAM",
  29 };
  30
  31 struct mtd_info *uclinux_ram_mtdinfo;
  32
  33 /****************************************************************************/
  34
  35 struct mtd_partition uclinux_romfs[] = {
  36         { .name = "ROMfs" }
  37 };
  38
  39 #define NUM_PARTITIONS  ARRAY_SIZE(uclinux_romfs)
  40
  41 /****************************************************************************/
  42
  43 int uclinux_point(struct mtd_info *mtd, loff_t from, size_t len,
  44         size_t *retlen, void **virt, resource_size_t *phys)
  45 {
  46         struct map_info *map = mtd->priv;
  47         *virt = map->virt + from;
  48         if (phys)
  49                 *phys = map->phys + from;
  50         *retlen = len;
  51         return(0);
  52 }
  53
  54 /****************************************************************************/
  55
  56 int __init uclinux_mtd_init(void)
  57 {
  58         struct mtd_info *mtd;
  59         struct map_info *mapp;
  60         extern char _ebss;
  61         unsigned long addr = (unsigned long) &_ebss;
  62
  63         mapp = &uclinux_ram_map;
  64         mapp->phys = addr;
  65         mapp->size = PAGE_ALIGN(ntohl(*((unsigned long *)(addr + 8))));
  66         mapp->bankwidth = 4;
  67
  68         printk("uclinux[mtd]: RAM probe address=0x%x size=0x%x\n",
  69                 (int) mapp->phys, (int) mapp->size);
  70
  71         mapp->virt = ioremap_nocache(mapp->phys, mapp->size);
  72
  73         if (mapp->virt == 0) {
  74                 printk("uclinux[mtd]: ioremap_nocache() failed\n");
  75                 return(-EIO);
  76         }
  77
  78         simple_map_init(mapp);
  79
  80         mtd = do_map_probe("map_ram", mapp);
  81         if (!mtd) {
  82                 printk("uclinux[mtd]: failed to find a mapping?\n");
  83                 iounmap(mapp->virt);
  84                 return(-ENXIO);
  85         }
  86
  87         mtd->owner = THIS_MODULE;
  88         mtd->point = uclinux_point;
  89         mtd->priv = mapp;
  90
  91         uclinux_ram_mtdinfo = mtd;
  92         add_mtd_partitions(mtd, uclinux_romfs, NUM_PARTITIONS);
  93
  94         return(0);
  95 }
  96
  97 /****************************************************************************/
  98
  99 void __exit uclinux_mtd_cleanup(void)
 100 {
 101         if (uclinux_ram_mtdinfo) {
 102                 del_mtd_partitions(uclinux_ram_mtdinfo);
 103                 map_destroy(uclinux_ram_mtdinfo);
 104                 uclinux_ram_mtdinfo = NULL;
 105         }
 106         if (uclinux_ram_map.virt) {
 107                 iounmap((void *) uclinux_ram_map.virt);
 108                 uclinux_ram_map.virt = 0;
 109         }
 110 }
 111
 112 /****************************************************************************/
 113
 114 module_init(uclinux_mtd_init);
 115 module_exit(uclinux_mtd_cleanup);
 116
 117 MODULE_LICENSE("GPL");
 118 MODULE_AUTHOR("Greg Ungerer <gerg@snapgear.com>");
 119 MODULE_DESCRIPTION("Generic RAM based MTD for uClinux");
 120
 121 /****************************************************************************/