| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * Common code to handle map devices which are simple ROM | 
|  | 3 | * (C) 2000 Red Hat. GPL'd. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4 | */ | 
|  | 5 |  | 
|  | 6 | #include <linux/module.h> | 
|  | 7 | #include <linux/types.h> | 
|  | 8 | #include <linux/kernel.h> | 
|  | 9 | #include <asm/io.h> | 
|  | 10 | #include <asm/byteorder.h> | 
|  | 11 | #include <linux/errno.h> | 
|  | 12 | #include <linux/slab.h> | 
|  | 13 | #include <linux/init.h> | 
|  | 14 | #include <linux/mtd/mtd.h> | 
|  | 15 | #include <linux/mtd/map.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 |  | 
|  | 17 | static int maprom_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *); | 
|  | 18 | static int maprom_write (struct mtd_info *, loff_t, size_t, size_t *, const u_char *); | 
|  | 19 | static void maprom_nop (struct mtd_info *); | 
|  | 20 | static struct mtd_info *map_rom_probe(struct map_info *map); | 
| Alan Cox | 5f87760 | 2009-01-11 19:52:19 +0000 | [diff] [blame] | 21 | static int maprom_erase (struct mtd_info *mtd, struct erase_info *info); | 
| David Howells | 402d326 | 2009-02-12 10:40:00 +0000 | [diff] [blame] | 22 | static unsigned long maprom_unmapped_area(struct mtd_info *, unsigned long, | 
|  | 23 | unsigned long, unsigned long); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 |  | 
|  | 25 | static struct mtd_chip_driver maprom_chipdrv = { | 
|  | 26 | .probe	= map_rom_probe, | 
|  | 27 | .name	= "map_rom", | 
|  | 28 | .module	= THIS_MODULE | 
|  | 29 | }; | 
|  | 30 |  | 
|  | 31 | static struct mtd_info *map_rom_probe(struct map_info *map) | 
|  | 32 | { | 
|  | 33 | struct mtd_info *mtd; | 
|  | 34 |  | 
| Burman Yan | 95b93a0 | 2006-11-15 21:10:29 +0200 | [diff] [blame] | 35 | mtd = kzalloc(sizeof(*mtd), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | if (!mtd) | 
|  | 37 | return NULL; | 
|  | 38 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | map->fldrv = &maprom_chipdrv; | 
|  | 40 | mtd->priv = map; | 
|  | 41 | mtd->name = map->name; | 
| David Woodhouse | 21c8db9 | 2006-06-14 21:39:48 +0100 | [diff] [blame] | 42 | mtd->type = MTD_ROM; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | mtd->size = map->size; | 
| David Howells | 402d326 | 2009-02-12 10:40:00 +0000 | [diff] [blame] | 44 | mtd->get_unmapped_area = maprom_unmapped_area; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | mtd->read = maprom_read; | 
|  | 46 | mtd->write = maprom_write; | 
|  | 47 | mtd->sync = maprom_nop; | 
| Alan Cox | 5f87760 | 2009-01-11 19:52:19 +0000 | [diff] [blame] | 48 | mtd->erase = maprom_erase; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | mtd->flags = MTD_CAP_ROM; | 
| Joern Engel | e369d62 | 2006-05-30 14:25:17 +0200 | [diff] [blame] | 50 | mtd->erasesize = map->size; | 
| Artem B. Bityutskiy | 17ffc7b | 2006-06-22 18:15:48 +0400 | [diff] [blame] | 51 | mtd->writesize = 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 |  | 
|  | 53 | __module_get(THIS_MODULE); | 
|  | 54 | return mtd; | 
|  | 55 | } | 
|  | 56 |  | 
|  | 57 |  | 
| David Howells | 402d326 | 2009-02-12 10:40:00 +0000 | [diff] [blame] | 58 | /* | 
|  | 59 | * Allow NOMMU mmap() to directly map the device (if not NULL) | 
|  | 60 | * - return the address to which the offset maps | 
|  | 61 | * - return -ENOSYS to indicate refusal to do the mapping | 
|  | 62 | */ | 
|  | 63 | static unsigned long maprom_unmapped_area(struct mtd_info *mtd, | 
|  | 64 | unsigned long len, | 
|  | 65 | unsigned long offset, | 
|  | 66 | unsigned long flags) | 
|  | 67 | { | 
|  | 68 | struct map_info *map = mtd->priv; | 
|  | 69 | return (unsigned long) map->virt + offset; | 
|  | 70 | } | 
|  | 71 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | static int maprom_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) | 
|  | 73 | { | 
|  | 74 | struct map_info *map = mtd->priv; | 
|  | 75 |  | 
|  | 76 | map_copy_from(map, buf, from, len); | 
|  | 77 | *retlen = len; | 
|  | 78 | return 0; | 
|  | 79 | } | 
|  | 80 |  | 
|  | 81 | static void maprom_nop(struct mtd_info *mtd) | 
|  | 82 | { | 
|  | 83 | /* Nothing to see here */ | 
|  | 84 | } | 
|  | 85 |  | 
|  | 86 | static int maprom_write (struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u_char *buf) | 
|  | 87 | { | 
|  | 88 | printk(KERN_NOTICE "maprom_write called\n"); | 
|  | 89 | return -EIO; | 
|  | 90 | } | 
|  | 91 |  | 
| Alan Cox | 5f87760 | 2009-01-11 19:52:19 +0000 | [diff] [blame] | 92 | static int maprom_erase (struct mtd_info *mtd, struct erase_info *info) | 
|  | 93 | { | 
|  | 94 | /* We do our best 8) */ | 
|  | 95 | return -EROFS; | 
|  | 96 | } | 
|  | 97 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | static int __init map_rom_init(void) | 
|  | 99 | { | 
|  | 100 | register_mtd_chip_driver(&maprom_chipdrv); | 
|  | 101 | return 0; | 
|  | 102 | } | 
|  | 103 |  | 
|  | 104 | static void __exit map_rom_exit(void) | 
|  | 105 | { | 
|  | 106 | unregister_mtd_chip_driver(&maprom_chipdrv); | 
|  | 107 | } | 
|  | 108 |  | 
|  | 109 | module_init(map_rom_init); | 
|  | 110 | module_exit(map_rom_exit); | 
|  | 111 |  | 
|  | 112 | MODULE_LICENSE("GPL"); | 
|  | 113 | MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>"); | 
|  | 114 | MODULE_DESCRIPTION("MTD chip driver for ROM chips"); |