Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* fortunet.c memory map |
2 | * | |
1da177e4 LT |
3 | */ |
4 | ||
5 | #include <linux/module.h> | |
6 | #include <linux/types.h> | |
7 | #include <linux/kernel.h> | |
8 | #include <linux/init.h> | |
4e57b681 TS |
9 | #include <linux/string.h> |
10 | ||
1da177e4 LT |
11 | #include <linux/mtd/mtd.h> |
12 | #include <linux/mtd/map.h> | |
13 | #include <linux/mtd/partitions.h> | |
14 | ||
4e57b681 TS |
15 | #include <asm/io.h> |
16 | ||
1da177e4 LT |
17 | #define MAX_NUM_REGIONS 4 |
18 | #define MAX_NUM_PARTITIONS 8 | |
19 | ||
20 | #define DEF_WINDOW_ADDR_PHY 0x00000000 | |
21 | #define DEF_WINDOW_SIZE 0x00800000 // 8 Mega Bytes | |
22 | ||
23 | #define MTD_FORTUNET_PK "MTD FortuNet: " | |
24 | ||
25 | #define MAX_NAME_SIZE 128 | |
26 | ||
27 | struct map_region | |
28 | { | |
29 | int window_addr_physical; | |
30 | int altbankwidth; | |
31 | struct map_info map_info; | |
32 | struct mtd_info *mymtd; | |
33 | struct mtd_partition parts[MAX_NUM_PARTITIONS]; | |
34 | char map_name[MAX_NAME_SIZE]; | |
35 | char parts_name[MAX_NUM_PARTITIONS][MAX_NAME_SIZE]; | |
36 | }; | |
37 | ||
38 | static struct map_region map_regions[MAX_NUM_REGIONS]; | |
39 | static int map_regions_set[MAX_NUM_REGIONS] = {0,0,0,0}; | |
40 | static int map_regions_parts[MAX_NUM_REGIONS] = {0,0,0,0}; | |
41 | ||
42 | ||
43 | ||
44 | struct map_info default_map = { | |
45 | .size = DEF_WINDOW_SIZE, | |
46 | .bankwidth = 4, | |
47 | }; | |
48 | ||
49 | static char * __init get_string_option(char *dest,int dest_size,char *sor) | |
50 | { | |
51 | if(!dest_size) | |
52 | return sor; | |
53 | dest_size--; | |
54 | while(*sor) | |
55 | { | |
56 | if(*sor==',') | |
57 | { | |
58 | sor++; | |
59 | break; | |
60 | } | |
61 | else if(*sor=='\"') | |
62 | { | |
63 | sor++; | |
64 | while(*sor) | |
65 | { | |
66 | if(*sor=='\"') | |
67 | { | |
68 | sor++; | |
69 | break; | |
70 | } | |
71 | *dest = *sor; | |
72 | dest++; | |
73 | sor++; | |
74 | dest_size--; | |
75 | if(!dest_size) | |
76 | { | |
77 | *dest = 0; | |
78 | return sor; | |
79 | } | |
80 | } | |
81 | } | |
82 | else | |
83 | { | |
84 | *dest = *sor; | |
85 | dest++; | |
86 | sor++; | |
87 | dest_size--; | |
88 | if(!dest_size) | |
89 | { | |
90 | *dest = 0; | |
91 | return sor; | |
92 | } | |
93 | } | |
94 | } | |
95 | *dest = 0; | |
96 | return sor; | |
97 | } | |
98 | ||
99 | static int __init MTD_New_Region(char *line) | |
100 | { | |
101 | char string[MAX_NAME_SIZE]; | |
102 | int params[6]; | |
103 | get_options (get_string_option(string,sizeof(string),line),6,params); | |
104 | if(params[0]<1) | |
105 | { | |
106 | printk(MTD_FORTUNET_PK "Bad parameters for MTD Region " | |
107 | " name,region-number[,base,size,bankwidth,altbankwidth]\n"); | |
108 | return 1; | |
109 | } | |
110 | if((params[1]<0)||(params[1]>=MAX_NUM_REGIONS)) | |
111 | { | |
112 | printk(MTD_FORTUNET_PK "Bad region index of %d only have 0..%u regions\n", | |
113 | params[1],MAX_NUM_REGIONS-1); | |
114 | return 1; | |
115 | } | |
116 | memset(&map_regions[params[1]],0,sizeof(map_regions[params[1]])); | |
117 | memcpy(&map_regions[params[1]].map_info, | |
118 | &default_map,sizeof(map_regions[params[1]].map_info)); | |
119 | map_regions_set[params[1]] = 1; | |
120 | map_regions[params[1]].window_addr_physical = DEF_WINDOW_ADDR_PHY; | |
121 | map_regions[params[1]].altbankwidth = 2; | |
122 | map_regions[params[1]].mymtd = NULL; | |
123 | map_regions[params[1]].map_info.name = map_regions[params[1]].map_name; | |
124 | strcpy(map_regions[params[1]].map_info.name,string); | |
125 | if(params[0]>1) | |
126 | { | |
127 | map_regions[params[1]].window_addr_physical = params[2]; | |
128 | } | |
129 | if(params[0]>2) | |
130 | { | |
131 | map_regions[params[1]].map_info.size = params[3]; | |
132 | } | |
133 | if(params[0]>3) | |
134 | { | |
135 | map_regions[params[1]].map_info.bankwidth = params[4]; | |
136 | } | |
137 | if(params[0]>4) | |
138 | { | |
139 | map_regions[params[1]].altbankwidth = params[5]; | |
140 | } | |
141 | return 1; | |
142 | } | |
143 | ||
144 | static int __init MTD_New_Partition(char *line) | |
145 | { | |
146 | char string[MAX_NAME_SIZE]; | |
147 | int params[4]; | |
148 | get_options (get_string_option(string,sizeof(string),line),4,params); | |
149 | if(params[0]<3) | |
150 | { | |
151 | printk(MTD_FORTUNET_PK "Bad parameters for MTD Partition " | |
152 | " name,region-number,size,offset\n"); | |
153 | return 1; | |
154 | } | |
155 | if((params[1]<0)||(params[1]>=MAX_NUM_REGIONS)) | |
156 | { | |
157 | printk(MTD_FORTUNET_PK "Bad region index of %d only have 0..%u regions\n", | |
158 | params[1],MAX_NUM_REGIONS-1); | |
159 | return 1; | |
160 | } | |
161 | if(map_regions_parts[params[1]]>=MAX_NUM_PARTITIONS) | |
162 | { | |
163 | printk(MTD_FORTUNET_PK "Out of space for partition in this region\n"); | |
164 | return 1; | |
165 | } | |
166 | map_regions[params[1]].parts[map_regions_parts[params[1]]].name = | |
167 | map_regions[params[1]]. parts_name[map_regions_parts[params[1]]]; | |
168 | strcpy(map_regions[params[1]].parts[map_regions_parts[params[1]]].name,string); | |
169 | map_regions[params[1]].parts[map_regions_parts[params[1]]].size = | |
170 | params[2]; | |
171 | map_regions[params[1]].parts[map_regions_parts[params[1]]].offset = | |
172 | params[3]; | |
173 | map_regions[params[1]].parts[map_regions_parts[params[1]]].mask_flags = 0; | |
174 | map_regions_parts[params[1]]++; | |
175 | return 1; | |
176 | } | |
177 | ||
178 | __setup("MTD_Region=", MTD_New_Region); | |
179 | __setup("MTD_Partition=", MTD_New_Partition); | |
180 | ||
181 | /* Backwards-spelling-compatibility */ | |
182 | __setup("MTD_Partion=", MTD_New_Partition); | |
183 | ||
e63b3f94 | 184 | static int __init init_fortunet(void) |
1da177e4 LT |
185 | { |
186 | int ix,iy; | |
187 | for(iy=ix=0;ix<MAX_NUM_REGIONS;ix++) | |
188 | { | |
189 | if(map_regions_parts[ix]&&(!map_regions_set[ix])) | |
190 | { | |
191 | printk(MTD_FORTUNET_PK "Region %d is not setup (Setting to default)\n", | |
192 | ix); | |
193 | memset(&map_regions[ix],0,sizeof(map_regions[ix])); | |
194 | memcpy(&map_regions[ix].map_info,&default_map, | |
195 | sizeof(map_regions[ix].map_info)); | |
196 | map_regions_set[ix] = 1; | |
197 | map_regions[ix].window_addr_physical = DEF_WINDOW_ADDR_PHY; | |
198 | map_regions[ix].altbankwidth = 2; | |
199 | map_regions[ix].mymtd = NULL; | |
200 | map_regions[ix].map_info.name = map_regions[ix].map_name; | |
201 | strcpy(map_regions[ix].map_info.name,"FORTUNET"); | |
202 | } | |
203 | if(map_regions_set[ix]) | |
204 | { | |
205 | iy++; | |
206 | printk(KERN_NOTICE MTD_FORTUNET_PK "%s flash device at physically " | |
207 | " address %x size %x\n", | |
208 | map_regions[ix].map_info.name, | |
209 | map_regions[ix].window_addr_physical, | |
210 | map_regions[ix].map_info.size); | |
211 | ||
212 | map_regions[ix].map_info.phys = map_regions[ix].window_addr_physical, | |
213 | ||
69f34c98 | 214 | map_regions[ix].map_info.virt = |
1da177e4 LT |
215 | ioremap_nocache( |
216 | map_regions[ix].window_addr_physical, | |
217 | map_regions[ix].map_info.size); | |
218 | if(!map_regions[ix].map_info.virt) | |
219 | { | |
25f0c659 | 220 | int j = 0; |
1da177e4 LT |
221 | printk(MTD_FORTUNET_PK "%s flash failed to ioremap!\n", |
222 | map_regions[ix].map_info.name); | |
25f0c659 AL |
223 | for (j = 0 ; j < ix; j++) |
224 | iounmap(map_regions[j].map_info.virt); | |
1da177e4 LT |
225 | return -ENXIO; |
226 | } | |
227 | simple_map_init(&map_regions[ix].map_info); | |
228 | ||
229 | printk(KERN_NOTICE MTD_FORTUNET_PK "%s flash is virtually at: %x\n", | |
230 | map_regions[ix].map_info.name, | |
231 | map_regions[ix].map_info.virt); | |
232 | map_regions[ix].mymtd = do_map_probe("cfi_probe", | |
233 | &map_regions[ix].map_info); | |
234 | if((!map_regions[ix].mymtd)&&( | |
235 | map_regions[ix].altbankwidth!=map_regions[ix].map_info.bankwidth)) | |
236 | { | |
237 | printk(KERN_NOTICE MTD_FORTUNET_PK "Trying alternate bankwidth " | |
238 | "for %s flash.\n", | |
239 | map_regions[ix].map_info.name); | |
240 | map_regions[ix].map_info.bankwidth = | |
241 | map_regions[ix].altbankwidth; | |
242 | map_regions[ix].mymtd = do_map_probe("cfi_probe", | |
243 | &map_regions[ix].map_info); | |
244 | } | |
245 | map_regions[ix].mymtd->owner = THIS_MODULE; | |
246 | add_mtd_partitions(map_regions[ix].mymtd, | |
247 | map_regions[ix].parts,map_regions_parts[ix]); | |
248 | } | |
249 | } | |
250 | if(iy) | |
251 | return 0; | |
252 | return -ENXIO; | |
253 | } | |
254 | ||
255 | static void __exit cleanup_fortunet(void) | |
256 | { | |
257 | int ix; | |
258 | for(ix=0;ix<MAX_NUM_REGIONS;ix++) | |
259 | { | |
260 | if(map_regions_set[ix]) | |
261 | { | |
262 | if( map_regions[ix].mymtd ) | |
263 | { | |
264 | del_mtd_partitions( map_regions[ix].mymtd ); | |
265 | map_destroy( map_regions[ix].mymtd ); | |
266 | } | |
267 | iounmap((void *)map_regions[ix].map_info.virt); | |
268 | } | |
269 | } | |
270 | } | |
271 | ||
272 | module_init(init_fortunet); | |
273 | module_exit(cleanup_fortunet); | |
274 | ||
275 | MODULE_AUTHOR("FortuNet, Inc."); | |
276 | MODULE_DESCRIPTION("MTD map driver for FortuNet boards"); |