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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * $Id: iq80310.c,v 1.9 2002/01/01 22:45:02 rmk Exp $
  3.  *
  4.  * Mapping for the Intel XScale IQ80310 evaluation board
  5.  *
  6.  * Author: Nicolas Pitre
  7.  * Copyright: (C) 2001 MontaVista Software Inc.
  8.  * 
  9.  * This program is free software; you can redistribute it and/or modify
  10.  * it under the terms of the GNU General Public License version 2 as
  11.  * published by the Free Software Foundation.
  12.  */
  13. #include <linux/module.h>
  14. #include <linux/types.h>
  15. #include <linux/kernel.h>
  16. #include <asm/io.h>
  17. #include <linux/mtd/mtd.h>
  18. #include <linux/mtd/map.h>
  19. #include <linux/mtd/partitions.h>
  20. #define WINDOW_ADDR  0
  21. #define WINDOW_SIZE  8*1024*1024
  22. #define BUSWIDTH  1
  23. static struct mtd_info *mymtd;
  24. static __u8 iq80310_read8(struct map_info *map, unsigned long ofs)
  25. {
  26. return *(__u8 *)(map->map_priv_1 + ofs);
  27. }
  28. static __u16 iq80310_read16(struct map_info *map, unsigned long ofs)
  29. {
  30. return *(__u16 *)(map->map_priv_1 + ofs);
  31. }
  32. static __u32 iq80310_read32(struct map_info *map, unsigned long ofs)
  33. {
  34. return *(__u32 *)(map->map_priv_1 + ofs);
  35. }
  36. static void iq80310_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
  37. {
  38. memcpy(to, (void *)(map->map_priv_1 + from), len);
  39. }
  40. static void iq80310_write8(struct map_info *map, __u8 d, unsigned long adr)
  41. {
  42. *(__u8 *)(map->map_priv_1 + adr) = d;
  43. }
  44. static void iq80310_write16(struct map_info *map, __u16 d, unsigned long adr)
  45. {
  46. *(__u16 *)(map->map_priv_1 + adr) = d;
  47. }
  48. static void iq80310_write32(struct map_info *map, __u32 d, unsigned long adr)
  49. {
  50. *(__u32 *)(map->map_priv_1 + adr) = d;
  51. }
  52. static void iq80310_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len)
  53. {
  54. memcpy((void *)(map->map_priv_1 + to), from, len);
  55. }
  56. static struct map_info iq80310_map = {
  57. name: "IQ80310 flash",
  58. size: WINDOW_SIZE,
  59. buswidth: BUSWIDTH,
  60. read8: iq80310_read8,
  61. read16: iq80310_read16,
  62. read32: iq80310_read32,
  63. copy_from: iq80310_copy_from,
  64. write8: iq80310_write8,
  65. write16: iq80310_write16,
  66. write32: iq80310_write32,
  67. copy_to: iq80310_copy_to
  68. };
  69. static struct mtd_partition iq80310_partitions[4] = {
  70. {
  71. name: "Firmware",
  72. size: 0x00080000,
  73. offset: 0,
  74. mask_flags: MTD_WRITEABLE  /* force read-only */
  75. },{
  76. name: "Kernel",
  77. size: 0x000a0000,
  78. offset: 0x00080000,
  79. },{
  80. name: "Filesystem",
  81. size: 0x00600000,
  82. offset: 0x00120000
  83. },{
  84. name: "RedBoot",
  85. size: 0x000e0000,
  86. offset: 0x00720000,
  87. mask_flags: MTD_WRITEABLE
  88. }
  89. };
  90. #define NB_OF(x)  (sizeof(x)/sizeof(x[0]))
  91. static struct mtd_info *mymtd;
  92. static struct mtd_partition *parsed_parts;
  93. extern int parse_redboot_partitions(struct mtd_info *master, struct mtd_partition **pparts);
  94. static int __init init_iq80310(void)
  95. {
  96. struct mtd_partition *parts;
  97. int nb_parts = 0;
  98. int parsed_nr_parts = 0;
  99. char *part_type = "static";
  100. iq80310_map.map_priv_1 = (unsigned long)ioremap(WINDOW_ADDR, WINDOW_SIZE);
  101. if (!iq80310_map.map_priv_1) {
  102. printk("Failed to ioremapn");
  103. return -EIO;
  104. }
  105. mymtd = do_map_probe("cfi_probe", &iq80310_map);
  106. if (!mymtd) {
  107. iounmap((void *)iq80310_map.map_priv_1);
  108. return -ENXIO;
  109. }
  110. mymtd->module = THIS_MODULE;
  111. #ifdef CONFIG_MTD_REDBOOT_PARTS
  112. if (parsed_nr_parts == 0) {
  113. int ret = parse_redboot_partitions(mymtd, &parsed_parts);
  114. if (ret > 0) {
  115. part_type = "RedBoot";
  116. parsed_nr_parts = ret;
  117. }
  118. }
  119. #endif
  120. if (parsed_nr_parts > 0) {
  121. parts = parsed_parts;
  122. nb_parts = parsed_nr_parts;
  123. } else {
  124. parts = iq80310_partitions;
  125. nb_parts = NB_OF(iq80310_partitions);
  126. }
  127. printk(KERN_NOTICE "Using %s partition definitionn", part_type);
  128. add_mtd_partitions(mymtd, parts, nb_parts);
  129. return 0;
  130. }
  131. static void __exit cleanup_iq80310(void)
  132. {
  133. if (mymtd) {
  134. del_mtd_partitions(mymtd);
  135. map_destroy(mymtd);
  136. if (parsed_parts)
  137. kfree(parsed_parts);
  138. }
  139. if (iq80310_map.map_priv_1)
  140. iounmap((void *)iq80310_map.map_priv_1);
  141. }
  142. module_init(init_iq80310);
  143. module_exit(cleanup_iq80310);
  144. MODULE_LICENSE("GPL");
  145. MODULE_AUTHOR("Nicolas Pitre <nico@cam.org>");
  146. MODULE_DESCRIPTION("MTD map driver for Intel XScale IQ80310 evaluation board");