开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
fortunet.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：8k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

fortunet.c：源码内容
  1. /* fortunet.c memory map
  2.  */
  4. #include <linux/module.h>
  5. #include <linux/types.h>
  6. #include <linux/kernel.h>
  7. #include <asm/io.h>
  8. #include <linux/mtd/mtd.h>
  9. #include <linux/mtd/map.h>
  10. #include <linux/mtd/partitions.h>
  12. #define MAX_NUM_REGIONS 4
  13. #define MAX_NUM_PARTITIONS 8
  15. #define DEF_WINDOW_ADDR_PHY 0x00000000
  16. #define DEF_WINDOW_SIZE 0x00800000 // 8 Mega Bytes
  18. #define MTD_FORTUNET_PK "MTD FortuNet: "
  20. #define MAX_NAME_SIZE 128
  22. struct map_region
  23. {
  24. int window_addr_phyical;
  25. int altbuswidth;
  26. struct map_info map_info;
  27. struct mtd_info *mymtd;
  28. struct mtd_partition parts[MAX_NUM_PARTITIONS];
  29. char map_name[MAX_NAME_SIZE];
  30. char parts_name[MAX_NUM_PARTITIONS][MAX_NAME_SIZE];
  31. };
  33. static struct map_region map_regions[MAX_NUM_REGIONS];
  34. static int map_regions_set[MAX_NUM_REGIONS] = {0,0,0,0};
  35. static int map_regions_parts[MAX_NUM_REGIONS] = {0,0,0,0};
  38. __u8 fortunet_read8(struct map_info *map, unsigned long ofs)
  39. {
  40. return *(__u8 *)(map->map_priv_1 + ofs);
  41. }
  43. __u16 fortunet_read16(struct map_info *map, unsigned long ofs)
  44. {
  45. return *(__u16 *)(map->map_priv_1 + ofs);
  46. }
  48. __u32 fortunet_read32(struct map_info *map, unsigned long ofs)
  49. {
  50. return *(__u32 *)(map->map_priv_1 + ofs);
  51. }
  53. void fortunet_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
  54. {
  55. memcpy(to, (void *)(map->map_priv_1 + from), len);
  56. }
  58. void fortunet_write8(struct map_info *map, __u8 d, unsigned long adr)
  59. {
  60. *(__u8 *)(map->map_priv_1 + adr) = d;
  61. }
  63. void fortunet_write16(struct map_info *map, __u16 d, unsigned long adr)
  64. {
  65. *(__u16 *)(map->map_priv_1 + adr) = d;
  66. }
  68. void fortunet_write32(struct map_info *map, __u32 d, unsigned long adr)
  69. {
  70. *(__u32 *)(map->map_priv_1 + adr) = d;
  71. }
  73. void fortunet_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len)
  74. {
  75. memcpy((void *)(map->map_priv_1 + to), from, len);
  76. }
  78. struct map_info default_map = {
  79. size: DEF_WINDOW_SIZE,
  80. buswidth: 4,
  81. read8: fortunet_read8,
  82. read16: fortunet_read16,
  83. read32: fortunet_read32,
  84. copy_from: fortunet_copy_from,
  85. write8: fortunet_write8,
  86. write16: fortunet_write16,
  87. write32: fortunet_write32,
  88. copy_to: fortunet_copy_to
  89. };
  91. static char * __init get_string_option(char *dest,int dest_size,char *sor)
  92. {
  93. if(!dest_size)
  94. return sor;
  95. dest_size--;
  96. while(*sor)
  97. {
  98. if(*sor==',')
  99. {
  100. sor++;
  101. break;
  102. }
  103. else if(*sor=='"')
  104. {
  105. sor++;
  106. while(*sor)
  107. {
  108. if(*sor=='"')
  109. {
  110. sor++;
  111. break;
  112. }
  113. *dest = *sor;
  114. dest++;
  115. sor++;
  116. dest_size--;
  117. if(!dest_size)
  118. {
  119. *dest = 0;
  120. return sor;
  121. }
  122. }
  123. }
  124. else
  125. {
  126. *dest = *sor;
  127. dest++;
  128. sor++;
  129. dest_size--;
  130. if(!dest_size)
  131. {
  132. *dest = 0;
  133. return sor;
  134. }
  135. }
  136. }
  137. *dest = 0;
  138. return sor;
  139. }
  141. static int __init MTD_New_Region(char *line)
  142. {
  143. char string[MAX_NAME_SIZE];
  144. int params[6];
  145. get_options (get_string_option(string,sizeof(string),line),6,params);
  146. if(params[0]<1)
  147. {
  148. printk(MTD_FORTUNET_PK "Bad paramters for MTD Region "
  149. " name,region-number[,base,size,buswidth,altbuswidth]n");
  150. return 1;
  151. }
  152. if((params[1]<0)||(params[1]>=MAX_NUM_REGIONS))
  153. {
  154. printk(MTD_FORTUNET_PK "Bad region index of %d only have 0..%u regionsn",
  155. params[1],MAX_NUM_REGIONS-1);
  156. return 1;
  157. }
  158. memset(&map_regions[params[1]],0,sizeof(map_regions[params[1]]));
  159. memcpy(&map_regions[params[1]].map_info,
  160. &default_map,sizeof(map_regions[params[1]].map_info));
  161.         map_regions_set[params[1]] = 1;
  162.         map_regions[params[1]].window_addr_phyical = DEF_WINDOW_ADDR_PHY;
  163.         map_regions[params[1]].altbuswidth = 2;
  164.         map_regions[params[1]].mymtd = NULL;
  165. map_regions[params[1]].map_info.name = map_regions[params[1]].map_name;
  166. strcpy(map_regions[params[1]].map_info.name,string);
  167. if(params[0]>1)
  168. {
  169. map_regions[params[1]].window_addr_phyical = params[2];
  170. }
  171. if(params[0]>2)
  172. {
  173. map_regions[params[1]].map_info.size = params[3];
  174. }
  175. if(params[0]>3)
  176. {
  177. map_regions[params[1]].map_info.buswidth = params[4];
  178. }
  179. if(params[0]>4)
  180. {
  181. map_regions[params[1]].altbuswidth = params[5];
  182. }
  183. return 1;
  184. }
  186. static int __init MTD_New_Partion(char *line)
  187. {
  188. char string[MAX_NAME_SIZE];
  189. int params[4];
  190. get_options (get_string_option(string,sizeof(string),line),4,params);
  191. if(params[0]<3)
  192. {
  193. printk(MTD_FORTUNET_PK "Bad paramters for MTD Partion "
  194. " name,region-number,size,offsetn");
  195. return 1;
  196. }
  197. if((params[1]<0)||(params[1]>=MAX_NUM_REGIONS))
  198. {
  199. printk(MTD_FORTUNET_PK "Bad region index of %d only have 0..%u regionsn",
  200. params[1],MAX_NUM_REGIONS-1);
  201. return 1;
  202. }
  203. if(map_regions_parts[params[1]]>=MAX_NUM_PARTITIONS)
  204. {
  205. printk(MTD_FORTUNET_PK "Out of space for partion in this regionn");
  206. return 1;
  207. }
  208. map_regions[params[1]].parts[map_regions_parts[params[1]]].name =
  209. map_regions[params[1]]. parts_name[map_regions_parts[params[1]]];
  210. strcpy(map_regions[params[1]].parts[map_regions_parts[params[1]]].name,string);
  211. map_regions[params[1]].parts[map_regions_parts[params[1]]].size =
  212. params[2];
  213. map_regions[params[1]].parts[map_regions_parts[params[1]]].offset =
  214. params[3];
  215. map_regions[params[1]].parts[map_regions_parts[params[1]]].mask_flags = 0;
  216. map_regions_parts[params[1]]++;
  217. return 1;
  218. }
  220. __setup("MTD_Region=", MTD_New_Region);
  221. __setup("MTD_Partion=", MTD_New_Partion);
  223. int __init init_fortunet(void)
  224. {
  225. int ix,iy;
  226. for(iy=ix=0;ix<MAX_NUM_REGIONS;ix++)
  227. {
  228. if(map_regions_parts[ix]&&(!map_regions_set[ix]))
  229. {
  230. printk(MTD_FORTUNET_PK "Region %d is not setup (Seting to default)n",
  231. ix);
  232. memset(&map_regions[ix],0,sizeof(map_regions[ix]));
  233. memcpy(&map_regions[ix].map_info,&default_map,
  234. sizeof(map_regions[ix].map_info));
  235. map_regions_set[ix] = 1;
  236. map_regions[ix].window_addr_phyical = DEF_WINDOW_ADDR_PHY;
  237. map_regions[ix].altbuswidth = 2;
  238. map_regions[ix].mymtd = NULL;
  239. map_regions[ix].map_info.name = map_regions[ix].map_name;
  240. strcpy(map_regions[ix].map_info.name,"FORTUNET");
  241. }
  242. if(map_regions_set[ix])
  243. {
  244. iy++;
  245. printk(KERN_NOTICE MTD_FORTUNET_PK "%s flash device at phyicaly "
  246. " address %x size %xn",
  247. map_regions[ix].map_info.name,
  248. map_regions[ix].window_addr_phyical,
  249. map_regions[ix].map_info.size);
  250. map_regions[ix].map_info.map_priv_1 =
  251. (int)ioremap_nocache(
  252. map_regions[ix].window_addr_phyical,
  253. map_regions[ix].map_info.size);
  254. if(!map_regions[ix].map_info.map_priv_1)
  255. {
  256. printk(MTD_FORTUNET_PK "%s flash failed to ioremap!n",
  257. map_regions[ix].map_info.name);
  258. return -ENXIO;
  259. }
  260. printk(KERN_NOTICE MTD_FORTUNET_PK "%s flash is veritualy at: %xn",
  261. map_regions[ix].map_info.name,
  262. map_regions[ix].map_info.map_priv_1);
  263. map_regions[ix].mymtd = do_map_probe("cfi_probe",
  264. &map_regions[ix].map_info);
  265. if((!map_regions[ix].mymtd)&&(
  266. map_regions[ix].altbuswidth!=map_regions[ix].map_info.buswidth))
  267. {
  268. printk(KERN_NOTICE MTD_FORTUNET_PK "Trying alternet buswidth "
  269. "for %s flash.n",
  270. map_regions[ix].map_info.name);
  271. map_regions[ix].map_info.buswidth =
  272. map_regions[ix].altbuswidth;
  273. map_regions[ix].mymtd = do_map_probe("cfi_probe",
  274. &map_regions[ix].map_info);
  275. }
  276. map_regions[ix].mymtd->module = THIS_MODULE;
  277. add_mtd_partitions(map_regions[ix].mymtd,
  278. map_regions[ix].parts,map_regions_parts[ix]);
  279. }
  280. }
  281. if(iy)
  282. return 0;
  283. return -ENXIO;
  284. }
  286. static void __exit cleanup_fortunet(void)
  287. {
  288. int ix;
  289. for(ix=0;ix<MAX_NUM_REGIONS;ix++)
  290. {
  291. if(map_regions_set[ix])
  292. {
  293. if( map_regions[ix].mymtd )
  294. {
  295. del_mtd_partitions( map_regions[ix].mymtd );
  296. map_destroy( map_regions[ix].mymtd );
  297. }
  298. iounmap((void *)map_regions[ix].map_info.map_priv_1);
  299. }
  300. }
  301. }
  303. module_init(init_fortunet);
  304. module_exit(cleanup_fortunet);
  306. MODULE_AUTHOR("FortuNet, Inc.");
  307. MODULE_DESCRIPTION("MTD map driver for FortuNet boards");