map_rom.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:2k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * Common code to handle map devices which are simple ROM
  3.  * (C) 2000 Red Hat. GPL'd.
  4.  * $Id: map_rom.c,v 1.17 2001/10/02 15:05:12 dwmw2 Exp $
  5.  */
  6. #include <linux/version.h>
  7. #include <linux/module.h>
  8. #include <linux/types.h>
  9. #include <linux/kernel.h>
  10. #include <asm/io.h>
  11. #include <asm/byteorder.h>
  12. #include <linux/errno.h>
  13. #include <linux/slab.h>
  14. #include <linux/mtd/map.h>
  15. static int maprom_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *);
  16. static int maprom_write (struct mtd_info *, loff_t, size_t, size_t *, const u_char *);
  17. static void maprom_nop (struct mtd_info *);
  18. struct mtd_info *map_rom_probe(struct map_info *map);
  19. static struct mtd_chip_driver maprom_chipdrv = {
  20. probe: map_rom_probe,
  21. name: "map_rom",
  22. module: THIS_MODULE
  23. };
  24. struct mtd_info *map_rom_probe(struct map_info *map)
  25. {
  26. struct mtd_info *mtd;
  27. mtd = kmalloc(sizeof(*mtd), GFP_KERNEL);
  28. if (!mtd)
  29. return NULL;
  30. memset(mtd, 0, sizeof(*mtd));
  31. map->fldrv = &maprom_chipdrv;
  32. mtd->priv = map;
  33. mtd->name = map->name;
  34. mtd->type = MTD_ROM;
  35. mtd->size = map->size;
  36. mtd->read = maprom_read;
  37. mtd->write = maprom_write;
  38. mtd->sync = maprom_nop;
  39. mtd->flags = MTD_CAP_ROM;
  40. mtd->erasesize = 131072;
  41.   while(mtd->size & (mtd->erasesize - 1))
  42. mtd->erasesize >>= 1;
  43. MOD_INC_USE_COUNT;
  44. return mtd;
  45. }
  46. static int maprom_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf)
  47. {
  48. struct map_info *map = (struct map_info *)mtd->priv;
  49. map->copy_from(map, buf, from, len);
  50. *retlen = len;
  51. return 0;
  52. }
  53. static void maprom_nop(struct mtd_info *mtd)
  54. {
  55. /* Nothing to see here */
  56. }
  57. static int maprom_write (struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u_char *buf)
  58. {
  59. printk(KERN_NOTICE "maprom_write calledn");
  60. return -EIO;
  61. }
  62. int __init map_rom_init(void)
  63. {
  64. register_mtd_chip_driver(&maprom_chipdrv);
  65. return 0;
  66. }
  67. static void __exit map_rom_exit(void)
  68. {
  69. unregister_mtd_chip_driver(&maprom_chipdrv);
  70. }
  71. module_init(map_rom_init);
  72. module_exit(map_rom_exit);
  73. MODULE_LICENSE("GPL");
  74. MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
  75. MODULE_DESCRIPTION("MTD chip driver for ROM chips");