^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * Common code to handle map devices which are simple ROM
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * (C) 2000 Red Hat. GPL'd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <asm/byteorder.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/mtd/mtd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/mtd/map.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) static int maprom_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) static int maprom_write (struct mtd_info *, loff_t, size_t, size_t *, const u_char *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) static void maprom_nop (struct mtd_info *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) static struct mtd_info *map_rom_probe(struct map_info *map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) static int maprom_erase (struct mtd_info *mtd, struct erase_info *info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) static int maprom_point (struct mtd_info *mtd, loff_t from, size_t len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) size_t *retlen, void **virt, resource_size_t *phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static int maprom_unpoint(struct mtd_info *mtd, loff_t from, size_t len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static struct mtd_chip_driver maprom_chipdrv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) .probe = map_rom_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) .name = "map_rom",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) .module = THIS_MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static unsigned int default_erasesize(struct map_info *map)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) const __be32 *erase_size = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) erase_size = of_get_property(map->device_node, "erase-size", NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) return !erase_size ? map->size : be32_to_cpu(*erase_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) static struct mtd_info *map_rom_probe(struct map_info *map)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) struct mtd_info *mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) mtd = kzalloc(sizeof(*mtd), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) if (!mtd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) map->fldrv = &maprom_chipdrv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) mtd->priv = map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) mtd->name = map->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) mtd->type = MTD_ROM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) mtd->size = map->size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) mtd->_point = maprom_point;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) mtd->_unpoint = maprom_unpoint;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) mtd->_read = maprom_read;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) mtd->_write = maprom_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) mtd->_sync = maprom_nop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) mtd->_erase = maprom_erase;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) mtd->flags = MTD_CAP_ROM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) mtd->erasesize = default_erasesize(map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) mtd->writesize = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) mtd->writebufsize = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) __module_get(THIS_MODULE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) return mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) static int maprom_point(struct mtd_info *mtd, loff_t from, size_t len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) size_t *retlen, void **virt, resource_size_t *phys)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct map_info *map = mtd->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) if (!map->virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) *virt = map->virt + from;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) if (phys)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) *phys = map->phys + from;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) *retlen = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) static int maprom_unpoint(struct mtd_info *mtd, loff_t from, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) static int maprom_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) struct map_info *map = mtd->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) map_copy_from(map, buf, from, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) *retlen = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static void maprom_nop(struct mtd_info *mtd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) /* Nothing to see here */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) static int maprom_write (struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u_char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) return -EROFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) static int maprom_erase (struct mtd_info *mtd, struct erase_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) /* We do our best 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) return -EROFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static int __init map_rom_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) register_mtd_chip_driver(&maprom_chipdrv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) static void __exit map_rom_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) unregister_mtd_chip_driver(&maprom_chipdrv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) module_init(map_rom_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) module_exit(map_rom_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) MODULE_DESCRIPTION("MTD chip driver for ROM chips");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags