1
2
3
4
5
6
7
8
9
10
11
12
13#include <common.h>
14#include <mpc8xx.h>
15
16flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS];
17
18#if defined(CONFIG_ENV_IS_IN_FLASH)
19# ifndef CONFIG_ENV_ADDR
20# define CONFIG_ENV_ADDR (CONFIG_SYS_FLASH_BASE + CONFIG_ENV_OFFSET)
21# endif
22# ifndef CONFIG_ENV_SIZE
23# define CONFIG_ENV_SIZE CONFIG_ENV_SECT_SIZE
24# endif
25# ifndef CONFIG_ENV_SECT_SIZE
26# define CONFIG_ENV_SECT_SIZE CONFIG_ENV_SIZE
27# endif
28#endif
29
30
31
32
33#define FLAG_PROTECT_SET 0x01
34#define FLAG_PROTECT_CLEAR 0x02
35
36
37#undef FLASH_PORT_WIDTH32
38#define FLASH_PORT_WIDTH16
39
40#ifdef FLASH_PORT_WIDTH16
41#define FLASH_PORT_WIDTH ushort
42#define FLASH_PORT_WIDTHV vu_short
43#else
44#define FLASH_PORT_WIDTH ulong
45#define FLASH_PORT_WIDTHV vu_long
46#endif
47
48#define FPW FLASH_PORT_WIDTH
49#define FPWV FLASH_PORT_WIDTHV
50
51
52
53
54static ulong flash_get_size (FPW * addr, flash_info_t * info);
55static int write_data (flash_info_t * info, ulong dest, FPW data);
56static void flash_get_offsets (ulong base, flash_info_t * info);
57
58
59
60
61unsigned long flash_init (void)
62{
63 volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
64 volatile memctl8xx_t *memctl = &immap->im_memctl;
65 unsigned long size_b0;
66 int i;
67
68
69 for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; ++i) {
70 flash_info[i].flash_id = FLASH_UNKNOWN;
71 }
72
73
74 size_b0 = flash_get_size ((FPW *) FLASH_BASE0_PRELIM, &flash_info[0]);
75
76 if (flash_info[0].flash_id == FLASH_UNKNOWN) {
77 printf ("## Unknown FLASH on Bank 0 - Size = 0x%08lx = %ld MB\n",
78 size_b0, size_b0 << 20);
79 }
80
81
82 memctl->memc_or0 = CONFIG_SYS_OR_TIMING_FLASH | (-size_b0 & 0xFFFF8000);
83 memctl->memc_br0 = (CONFIG_SYS_FLASH_BASE & BR_BA_MSK) | BR_PS_16 | BR_MS_GPCM | BR_V;
84
85
86 size_b0 = flash_get_size ((FPW *) CONFIG_SYS_FLASH_BASE, &flash_info[0]);
87
88 flash_get_offsets (CONFIG_SYS_FLASH_BASE, &flash_info[0]);
89
90#if CONFIG_SYS_MONITOR_BASE >= CONFIG_SYS_FLASH_BASE
91
92 (void) flash_protect (FLAG_PROTECT_SET,
93 CONFIG_SYS_FLASH_BASE,
94 CONFIG_SYS_FLASH_BASE + monitor_flash_len - 1,
95 &flash_info[0]);
96#endif
97
98#ifdef CONFIG_ENV_IS_IN_FLASH
99
100 flash_protect (FLAG_PROTECT_SET,
101 CONFIG_ENV_ADDR,
102 CONFIG_ENV_ADDR + CONFIG_ENV_SIZE - 1,
103 &flash_info[0]);
104#endif
105
106 flash_info[0].size = size_b0;
107
108 return (size_b0);
109}
110
111
112
113static void flash_get_offsets (ulong base, flash_info_t * info)
114{
115 int i;
116
117 if (info->flash_id == FLASH_UNKNOWN) {
118 return;
119 }
120
121 if ((info->flash_id & FLASH_VENDMASK) == FLASH_MAN_INTEL) {
122 for (i = 0; i < info->sector_count; i++) {
123 info->start[i] = base + (i * 0x00020000);
124 }
125 }
126}
127
128
129
130void flash_print_info (flash_info_t * info)
131{
132 int i;
133
134 if (info->flash_id == FLASH_UNKNOWN) {
135 printf ("missing or unknown FLASH type\n");
136 return;
137 }
138
139 switch (info->flash_id & FLASH_VENDMASK) {
140 case FLASH_MAN_INTEL:
141 printf ("INTEL ");
142 break;
143 default:
144 printf ("Unknown Vendor ");
145 break;
146 }
147
148 switch (info->flash_id & FLASH_TYPEMASK) {
149 case FLASH_28F320J3A:
150 printf ("28F320J3A\n");
151 break;
152 case FLASH_28F640J3A:
153 printf ("28F640J3A\n");
154 break;
155 case FLASH_28F128J3A:
156 printf ("28F128J3A\n");
157 break;
158 default:
159 printf ("Unknown Chip Type\n");
160 break;
161 }
162
163 printf (" Size: %ld MB in %d Sectors\n",
164 info->size >> 20, info->sector_count);
165
166 printf (" Sector Start Addresses:");
167 for (i = 0; i < info->sector_count; ++i) {
168 if ((i % 5) == 0)
169 printf ("\n ");
170 printf (" %08lX%s",
171 info->start[i],
172 info->protect[i] ? " (RO)" : " ");
173 }
174 printf ("\n");
175 return;
176}
177
178
179
180
181
182
183
184
185
186
187
188
189static ulong flash_get_size (FPW * addr, flash_info_t * info)
190{
191 FPW value;
192
193
194 addr[0] = (FPW) 0x00FF00FF;
195 addr[0] = (FPW) 0x00600060;
196 addr[0] = (FPW) 0x00D000D0;
197 addr[0] = (FPW) 0x00FF00FF;
198
199
200 addr[0x5555] = (FPW) 0x00AA00AA;
201 addr[0x2AAA] = (FPW) 0x00550055;
202 addr[0x5555] = (FPW) 0x00900090;
203
204 value = addr[0];
205
206 debug("Manuf. ID @ 0x%08lx: 0x%08x\n", (ulong)addr, value);
207
208 switch (value) {
209 case (FPW) INTEL_MANUFACT:
210 info->flash_id = FLASH_MAN_INTEL;
211 break;
212 default:
213 info->flash_id = FLASH_UNKNOWN;
214 info->sector_count = 0;
215 info->size = 0;
216 addr[0] = (FPW) 0x00FF00FF;
217 return (0);
218 }
219
220 value = addr[1];
221
222 debug("Device ID @ 0x%08lx: 0x%08x\n", (ulong)(&addr[1]), value);
223
224 switch (value) {
225 case (FPW) INTEL_ID_28F320J3A:
226 info->flash_id += FLASH_28F320J3A;
227 info->sector_count = 32;
228 info->size = 0x00400000;
229 break;
230
231 case (FPW) INTEL_ID_28F640J3A:
232 info->flash_id += FLASH_28F640J3A;
233 info->sector_count = 64;
234 info->size = 0x00800000;
235 break;
236
237 case (FPW) INTEL_ID_28F128J3A:
238 info->flash_id += FLASH_28F128J3A;
239 info->sector_count = 128;
240 info->size = 0x01000000;
241 break;
242
243 default:
244 info->flash_id = FLASH_UNKNOWN;
245 break;
246 }
247
248 if (info->sector_count > CONFIG_SYS_MAX_FLASH_SECT) {
249 printf ("** ERROR: sector count %d > max (%d) **\n",
250 info->sector_count, CONFIG_SYS_MAX_FLASH_SECT);
251 info->sector_count = CONFIG_SYS_MAX_FLASH_SECT;
252 }
253
254 addr[0] = (FPW) 0x00FF00FF;
255
256 return (info->size);
257}
258
259
260
261
262
263int flash_erase (flash_info_t * info, int s_first, int s_last)
264{
265 int flag, prot, sect;
266 ulong type, start, now, last;
267 int rcode = 0;
268
269 if ((s_first < 0) || (s_first > s_last)) {
270 if (info->flash_id == FLASH_UNKNOWN) {
271 printf ("- missing\n");
272 } else {
273 printf ("- no sectors to erase\n");
274 }
275 return 1;
276 }
277
278 type = (info->flash_id & FLASH_VENDMASK);
279 if ((type != FLASH_MAN_INTEL)) {
280 printf ("Can't erase unknown flash type %08lx - aborted\n",
281 info->flash_id);
282 return 1;
283 }
284
285 prot = 0;
286 for (sect = s_first; sect <= s_last; ++sect) {
287 if (info->protect[sect]) {
288 prot++;
289 }
290 }
291
292 if (prot) {
293 printf ("- Warning: %d protected sectors will not be erased!\n",
294 prot);
295 } else {
296 printf ("\n");
297 }
298
299 start = get_timer (0);
300 last = start;
301
302 for (sect = s_first; sect <= s_last; sect++) {
303 if (info->protect[sect] == 0) {
304 FPWV *addr = (FPWV *) (info->start[sect]);
305 FPW status;
306
307
308 flag = disable_interrupts ();
309
310 *addr = (FPW) 0x00500050;
311 *addr = (FPW) 0x00200020;
312 *addr = (FPW) 0x00D000D0;
313
314
315 if (flag)
316 enable_interrupts ();
317
318
319 udelay (1000);
320
321 while (((status = *addr) & (FPW) 0x00800080) != (FPW) 0x00800080) {
322 if ((now = get_timer (start)) > CONFIG_SYS_FLASH_ERASE_TOUT) {
323 printf ("Timeout\n");
324 *addr = (FPW) 0x00B000B0;
325 *addr = (FPW) 0x00FF00FF;
326 rcode = 1;
327 break;
328 }
329
330
331 if ((now - last) > 1000) {
332 putc ('.');
333 last = now;
334 }
335 }
336
337 *addr = (FPW) 0x00FF00FF;
338 }
339 }
340 printf (" done\n");
341 return rcode;
342}
343
344
345
346
347
348
349
350
351
352int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt)
353{
354 ulong cp, wp;
355 FPW data;
356
357 int i, l, rc, port_width;
358
359 if (info->flash_id == FLASH_UNKNOWN) {
360 return 4;
361 }
362
363#ifdef FLASH_PORT_WIDTH16
364 wp = (addr & ~1);
365 port_width = 2;
366#else
367 wp = (addr & ~3);
368 port_width = 4;
369#endif
370
371
372
373
374 if ((l = addr - wp) != 0) {
375 data = 0;
376 for (i = 0, cp = wp; i < l; ++i, ++cp) {
377 data = (data << 8) | (*(uchar *) cp);
378 }
379 for (; i < port_width && cnt > 0; ++i) {
380 data = (data << 8) | *src++;
381 --cnt;
382 ++cp;
383 }
384 for (; cnt == 0 && i < port_width; ++i, ++cp) {
385 data = (data << 8) | (*(uchar *) cp);
386 }
387
388 if ((rc = write_data (info, wp, data)) != 0) {
389 return (rc);
390 }
391 wp += port_width;
392 }
393
394
395
396
397 while (cnt >= port_width) {
398 data = 0;
399 for (i = 0; i < port_width; ++i) {
400 data = (data << 8) | *src++;
401 }
402 if ((rc = write_data (info, wp, data)) != 0) {
403 return (rc);
404 }
405 wp += port_width;
406 cnt -= port_width;
407 }
408
409 if (cnt == 0) {
410 return (0);
411 }
412
413
414
415
416 data = 0;
417 for (i = 0, cp = wp; i < port_width && cnt > 0; ++i, ++cp) {
418 data = (data << 8) | *src++;
419 --cnt;
420 }
421 for (; i < port_width; ++i, ++cp) {
422 data = (data << 8) | (*(uchar *) cp);
423 }
424
425 return (write_data (info, wp, data));
426}
427
428
429
430
431
432
433
434static int write_data (flash_info_t * info, ulong dest, FPW data)
435{
436 FPWV *addr = (FPWV *) dest;
437 ulong status;
438 ulong start;
439 int flag;
440
441
442 if ((*addr & data) != data) {
443 printf ("not erased at %08lx (%x)\n", (ulong) addr, *addr);
444 return (2);
445 }
446
447 flag = disable_interrupts ();
448
449 *addr = (FPW) 0x00400040;
450 *addr = data;
451
452
453 if (flag)
454 enable_interrupts ();
455
456 start = get_timer (0);
457
458 while (((status = *addr) & (FPW) 0x00800080) != (FPW) 0x00800080) {
459 if (get_timer (start) > CONFIG_SYS_FLASH_WRITE_TOUT) {
460 *addr = (FPW) 0x00FF00FF;
461 return (1);
462 }
463 }
464
465 *addr = (FPW) 0x00FF00FF;
466
467 return (0);
468}
469