1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27#include <common.h>
28#include <mpc824x.h>
29#include <asm/processor.h>
30#include <asm/pci_io.h>
31#include <w83c553f.h>
32
33#define ROM_CS0_START 0xFF800000
34#define ROM_CS1_START 0xFF000000
35
36flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS];
37
38#if defined(CONFIG_ENV_IS_IN_FLASH)
39# ifndef CONFIG_ENV_ADDR
40# define CONFIG_ENV_ADDR (CONFIG_SYS_FLASH_BASE + CONFIG_ENV_OFFSET)
41# endif
42# ifndef CONFIG_ENV_SIZE
43# define CONFIG_ENV_SIZE CONFIG_ENV_SECT_SIZE
44# endif
45# ifndef CONFIG_ENV_SECT_SIZE
46# define CONFIG_ENV_SECT_SIZE CONFIG_ENV_SIZE
47# endif
48#endif
49
50
51
52
53static int write_word (flash_info_t *info, ulong dest, ulong data);
54
55
56
57#define ADDR0 (0xAAA)
58#define ADDR1 (0x555)
59#define ADDR3 (0x001)
60
61#define FLASH_WORD_SIZE unsigned char
62
63
64
65
66static unsigned long flash_id (unsigned char mfct, unsigned char chip)
67 __attribute__ ((const));
68
69typedef struct {
70 FLASH_WORD_SIZE extval;
71 unsigned short intval;
72} map_entry;
73
74static unsigned long flash_id (unsigned char mfct, unsigned char chip)
75{
76 static const map_entry mfct_map[] = {
77 {(FLASH_WORD_SIZE) AMD_MANUFACT,
78 (unsigned short) ((unsigned long) FLASH_MAN_AMD >> 16)},
79 {(FLASH_WORD_SIZE) FUJ_MANUFACT,
80 (unsigned short) ((unsigned long) FLASH_MAN_FUJ >> 16)},
81 {(FLASH_WORD_SIZE) STM_MANUFACT,
82 (unsigned short) ((unsigned long) FLASH_MAN_STM >> 16)},
83 {(FLASH_WORD_SIZE) MT_MANUFACT,
84 (unsigned short) ((unsigned long) FLASH_MAN_MT >> 16)},
85 {(FLASH_WORD_SIZE) INTEL_MANUFACT,
86 (unsigned short) ((unsigned long) FLASH_MAN_INTEL >> 16)},
87 {(FLASH_WORD_SIZE) INTEL_ALT_MANU,
88 (unsigned short) ((unsigned long) FLASH_MAN_INTEL >> 16)}
89 };
90
91 static const map_entry chip_map[] = {
92 {AMD_ID_F040B, FLASH_AM040},
93 {(FLASH_WORD_SIZE) STM_ID_x800AB, FLASH_STM800AB}
94 };
95
96 const map_entry *p;
97 unsigned long result = FLASH_UNKNOWN;
98
99
100 for (p = &chip_map[0];
101 p < &chip_map[sizeof chip_map / sizeof chip_map[0]]; p++)
102 if (p->extval == chip) {
103 result = FLASH_VENDMASK | p->intval;
104 break;
105 }
106
107
108 for (p = &mfct_map[0];
109 p < &mfct_map[sizeof mfct_map / sizeof mfct_map[0]]; p++)
110 if (p->extval == mfct) {
111 result &= ~FLASH_VENDMASK;
112 result |= (unsigned long) p->intval << 16;
113 break;
114 }
115
116 return result;
117}
118
119unsigned long flash_init (void)
120{
121 unsigned long i;
122 unsigned char j;
123 static const ulong flash_banks[] = CONFIG_SYS_FLASH_BANKS;
124
125
126 for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; i++) {
127 flash_info_t *const pflinfo = &flash_info[i];
128
129 pflinfo->flash_id = FLASH_UNKNOWN;
130 pflinfo->size = 0;
131 pflinfo->sector_count = 0;
132 }
133
134
135 {
136 register unsigned char temp;
137
138 CONFIG_READ_BYTE (CONFIG_SYS_WINBOND_ISA_CFG_ADDR + WINBOND_CSCR,
139 temp);
140 temp &= ~0x20;
141 CONFIG_WRITE_BYTE (CONFIG_SYS_WINBOND_ISA_CFG_ADDR + WINBOND_CSCR,
142 temp);
143 }
144
145 for (i = 0; i < sizeof flash_banks / sizeof flash_banks[0]; i++) {
146 flash_info_t *const pflinfo = &flash_info[i];
147 const unsigned long base_address = flash_banks[i];
148 volatile FLASH_WORD_SIZE *const flash =
149 (FLASH_WORD_SIZE *) base_address;
150
151 flash[0xAAA << (3 * i)] = 0xaa;
152 flash[0x555 << (3 * i)] = 0x55;
153 flash[0xAAA << (3 * i)] = 0x90;
154 __asm__ __volatile__ ("sync");
155
156 pflinfo->flash_id =
157 flash_id (flash[0x0], flash[0x2 + 14 * i]);
158
159 switch (pflinfo->flash_id & FLASH_TYPEMASK) {
160 case FLASH_AM040:
161 pflinfo->size = 0x00080000;
162 pflinfo->sector_count = 8;
163 for (j = 0; j < 8; j++) {
164 pflinfo->start[j] =
165 base_address + 0x00010000 * j;
166 pflinfo->protect[j] = flash[(j << 16) | 0x2];
167 }
168 break;
169 case FLASH_STM800AB:
170 pflinfo->size = 0x00100000;
171 pflinfo->sector_count = 19;
172 pflinfo->start[0] = base_address;
173 pflinfo->start[1] = base_address + 0x4000;
174 pflinfo->start[2] = base_address + 0x6000;
175 pflinfo->start[3] = base_address + 0x8000;
176 for (j = 1; j < 16; j++) {
177 pflinfo->start[j + 3] =
178 base_address + 0x00010000 * j;
179 }
180 break;
181 default:
182
183
184
185 {
186 int sector_addr = base_address;
187
188 pflinfo->size = 0x00200000;
189 pflinfo->sector_count = 35;
190 pflinfo->start[0] = sector_addr;
191 sector_addr += 0x4000;
192 pflinfo->start[1] = sector_addr;
193 sector_addr += 0x2000;
194 pflinfo->start[2] = sector_addr;
195 sector_addr += 0x2000;
196 pflinfo->start[3] = sector_addr;
197 sector_addr += 0x8000;
198
199 for (j = 4; j < 35; j++) {
200 pflinfo->start[j] = sector_addr;
201 sector_addr += 0x10000;
202 }
203 }
204 break;
205 }
206
207
208#if CONFIG_SYS_MONITOR_BASE >= CONFIG_SYS_FLASH_BASE
209 flash_protect (FLAG_PROTECT_SET,
210 CONFIG_SYS_MONITOR_BASE,
211 CONFIG_SYS_MONITOR_BASE + monitor_flash_len - 1,
212 &flash_info[0]);
213#endif
214
215#if defined(CONFIG_ENV_IS_IN_FLASH) && defined(CONFIG_ENV_ADDR)
216 flash_protect (FLAG_PROTECT_SET,
217 CONFIG_ENV_ADDR,
218 CONFIG_ENV_ADDR + CONFIG_ENV_SIZE - 1,
219 &flash_info[0]);
220#endif
221
222
223 flash[0x0000] = 0xf0;
224 __asm__ __volatile__ ("sync");
225 }
226
227
228 return flash_info[0].size;
229}
230
231
232
233void flash_print_info (flash_info_t * info)
234{
235 static const char unk[] = "Unknown";
236 const char *mfct = unk, *type = unk;
237 unsigned int i;
238
239 if (info->flash_id != FLASH_UNKNOWN) {
240 switch (info->flash_id & FLASH_VENDMASK) {
241 case FLASH_MAN_AMD:
242 mfct = "AMD";
243 break;
244 case FLASH_MAN_FUJ:
245 mfct = "FUJITSU";
246 break;
247 case FLASH_MAN_STM:
248 mfct = "STM";
249 break;
250 case FLASH_MAN_SST:
251 mfct = "SST";
252 break;
253 case FLASH_MAN_BM:
254 mfct = "Bright Microelectonics";
255 break;
256 case FLASH_MAN_INTEL:
257 mfct = "Intel";
258 break;
259 }
260
261 switch (info->flash_id & FLASH_TYPEMASK) {
262 case FLASH_AM040:
263 type = "AM29F040B (512K * 8, uniform sector size)";
264 break;
265 case FLASH_AM400B:
266 type = "AM29LV400B (4 Mbit, bottom boot sect)";
267 break;
268 case FLASH_AM400T:
269 type = "AM29LV400T (4 Mbit, top boot sector)";
270 break;
271 case FLASH_AM800B:
272 type = "AM29LV800B (8 Mbit, bottom boot sect)";
273 break;
274 case FLASH_AM800T:
275 type = "AM29LV800T (8 Mbit, top boot sector)";
276 break;
277 case FLASH_AM160T:
278 type = "AM29LV160T (16 Mbit, top boot sector)";
279 break;
280 case FLASH_AM320B:
281 type = "AM29LV320B (32 Mbit, bottom boot sect)";
282 break;
283 case FLASH_AM320T:
284 type = "AM29LV320T (32 Mbit, top boot sector)";
285 break;
286 case FLASH_STM800AB:
287 type = "M29W800AB (8 Mbit, bottom boot sect)";
288 break;
289 case FLASH_SST800A:
290 type = "SST39LF/VF800 (8 Mbit, uniform sector size)";
291 break;
292 case FLASH_SST160A:
293 type = "SST39LF/VF160 (16 Mbit, uniform sector size)";
294 break;
295 }
296 }
297
298 printf ("\n Brand: %s Type: %s\n"
299 " Size: %lu KB in %d Sectors\n",
300 mfct, type, info->size >> 10, info->sector_count);
301
302 printf (" Sector Start Addresses:");
303
304 for (i = 0; i < info->sector_count; i++) {
305 unsigned long size;
306 unsigned int erased;
307 unsigned long *flash = (unsigned long *) info->start[i];
308
309
310
311
312 size = (i != (info->sector_count - 1)) ?
313 (info->start[i + 1] - info->start[i]) >> 2 :
314 (info->start[0] + info->size - info->start[i]) >> 2;
315
316 for (flash = (unsigned long *) info->start[i], erased = 1;
317 (flash != (unsigned long *) info->start[i] + size)
318 && erased; flash++)
319 erased = *flash == ~0x0UL;
320
321 printf ("%s %08lX %s %s",
322 (i % 5) ? "" : "\n ",
323 info->start[i],
324 erased ? "E" : " ", info->protect[i] ? "RO" : " ");
325 }
326
327 puts ("\n");
328 return;
329}
330
331int flash_erase (flash_info_t * info, int s_first, int s_last)
332{
333 volatile FLASH_WORD_SIZE *addr = (FLASH_WORD_SIZE *) (info->start[0]);
334 int flag, prot, sect, l_sect;
335 ulong start, now, last;
336 unsigned char sh8b;
337
338 if ((s_first < 0) || (s_first > s_last)) {
339 if (info->flash_id == FLASH_UNKNOWN) {
340 printf ("- missing\n");
341 } else {
342 printf ("- no sectors to erase\n");
343 }
344 return 1;
345 }
346
347 if ((info->flash_id == FLASH_UNKNOWN) ||
348 (info->flash_id > (FLASH_MAN_STM | FLASH_AMD_COMP))) {
349 printf ("Can't erase unknown flash type - aborted\n");
350 return 1;
351 }
352
353 prot = 0;
354 for (sect = s_first; sect <= s_last; ++sect) {
355 if (info->protect[sect]) {
356 prot++;
357 }
358 }
359
360 if (prot) {
361 printf ("- Warning: %d protected sectors will not be erased!\n", prot);
362 } else {
363 printf ("\n");
364 }
365
366 l_sect = -1;
367
368
369 if ((info->start[0] >= ROM_CS1_START)
370 && (info->start[0] < ROM_CS0_START))
371 sh8b = 3;
372 else
373 sh8b = 0;
374
375
376 flag = disable_interrupts ();
377
378 addr[ADDR0 << sh8b] = (FLASH_WORD_SIZE) 0x00AA00AA;
379 addr[ADDR1 << sh8b] = (FLASH_WORD_SIZE) 0x00550055;
380 addr[ADDR0 << sh8b] = (FLASH_WORD_SIZE) 0x00800080;
381 addr[ADDR0 << sh8b] = (FLASH_WORD_SIZE) 0x00AA00AA;
382 addr[ADDR1 << sh8b] = (FLASH_WORD_SIZE) 0x00550055;
383
384
385 for (sect = s_first; sect <= s_last; sect++) {
386 if (info->protect[sect] == 0) {
387 addr = (FLASH_WORD_SIZE *) (info->start[0] +
388 ((info->start[sect] -
389 info->start[0]) << sh8b));
390 if (info->flash_id & FLASH_MAN_SST) {
391 addr[ADDR0 << sh8b] =
392 (FLASH_WORD_SIZE) 0x00AA00AA;
393 addr[ADDR1 << sh8b] =
394 (FLASH_WORD_SIZE) 0x00550055;
395 addr[ADDR0 << sh8b] =
396 (FLASH_WORD_SIZE) 0x00800080;
397 addr[ADDR0 << sh8b] =
398 (FLASH_WORD_SIZE) 0x00AA00AA;
399 addr[ADDR1 << sh8b] =
400 (FLASH_WORD_SIZE) 0x00550055;
401 addr[0] = (FLASH_WORD_SIZE) 0x00500050;
402 udelay (30000);
403 } else
404 addr[0] = (FLASH_WORD_SIZE) 0x00300030;
405 l_sect = sect;
406 }
407 }
408
409
410 if (flag)
411 enable_interrupts ();
412
413
414 udelay (1000);
415
416
417
418
419 if (l_sect < 0)
420 goto DONE;
421
422 start = get_timer (0);
423 last = start;
424 addr = (FLASH_WORD_SIZE *) (info->start[0] + ((info->start[l_sect] -
425 info->
426 start[0]) << sh8b));
427 while ((addr[0] & (FLASH_WORD_SIZE) 0x00800080) !=
428 (FLASH_WORD_SIZE) 0x00800080) {
429 if ((now = get_timer (start)) > CONFIG_SYS_FLASH_ERASE_TOUT) {
430 printf ("Timeout\n");
431 return 1;
432 }
433
434 if ((now - last) > 1000) {
435 serial_putc ('.');
436 last = now;
437 }
438 }
439
440 DONE:
441
442 addr = (FLASH_WORD_SIZE *) info->start[0];
443 addr[0] = (FLASH_WORD_SIZE) 0x00F000F0;
444
445 printf (" done\n");
446 return 0;
447}
448
449
450
451
452
453
454
455
456int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt)
457{
458 ulong cp, wp, data;
459 int i, l, rc;
460
461 wp = (addr & ~3);
462
463
464
465
466 if ((l = addr - wp) != 0) {
467 data = 0;
468 for (i = 0, cp = wp; i < l; ++i, ++cp) {
469 data = (data << 8) | (*(uchar *) cp);
470 }
471 for (; i < 4 && cnt > 0; ++i) {
472 data = (data << 8) | *src++;
473 --cnt;
474 ++cp;
475 }
476 for (; cnt == 0 && i < 4; ++i, ++cp) {
477 data = (data << 8) | (*(uchar *) cp);
478 }
479
480 if ((rc = write_word (info, wp, data)) != 0) {
481 return (rc);
482 }
483 wp += 4;
484 }
485
486
487
488
489 while (cnt >= 4) {
490 data = 0;
491 for (i = 0; i < 4; ++i) {
492 data = (data << 8) | *src++;
493 }
494 if ((rc = write_word (info, wp, data)) != 0) {
495 return (rc);
496 }
497 wp += 4;
498 cnt -= 4;
499 }
500
501 if (cnt == 0) {
502 return (0);
503 }
504
505
506
507
508 data = 0;
509 for (i = 0, cp = wp; i < 4 && cnt > 0; ++i, ++cp) {
510 data = (data << 8) | *src++;
511 --cnt;
512 }
513 for (; i < 4; ++i, ++cp) {
514 data = (data << 8) | (*(uchar *) cp);
515 }
516
517 return (write_word (info, wp, data));
518}
519
520
521
522
523
524
525
526static int write_word (flash_info_t * info, ulong dest, ulong data)
527{
528 volatile FLASH_WORD_SIZE *addr2 = (FLASH_WORD_SIZE *) info->start[0];
529 volatile FLASH_WORD_SIZE *dest2;
530 volatile FLASH_WORD_SIZE *data2 = (FLASH_WORD_SIZE *) & data;
531 ulong start;
532 int flag;
533 int i;
534 unsigned char sh8b;
535
536
537 if ((info->start[0] >= ROM_CS1_START)
538 && (info->start[0] < ROM_CS0_START))
539 sh8b = 3;
540 else
541 sh8b = 0;
542
543 dest2 = (FLASH_WORD_SIZE *) (((dest - info->start[0]) << sh8b) +
544 info->start[0]);
545
546
547 if ((*dest2 & (FLASH_WORD_SIZE) data) != (FLASH_WORD_SIZE) data) {
548 return (2);
549 }
550
551 flag = disable_interrupts ();
552
553 for (i = 0; i < 4 / sizeof (FLASH_WORD_SIZE); i++) {
554 addr2[ADDR0 << sh8b] = (FLASH_WORD_SIZE) 0x00AA00AA;
555 addr2[ADDR1 << sh8b] = (FLASH_WORD_SIZE) 0x00550055;
556 addr2[ADDR0 << sh8b] = (FLASH_WORD_SIZE) 0x00A000A0;
557
558 dest2[i << sh8b] = data2[i];
559
560
561 if (flag)
562 enable_interrupts ();
563
564
565 start = get_timer (0);
566 while ((dest2[i << sh8b] & (FLASH_WORD_SIZE) 0x00800080) !=
567 (data2[i] & (FLASH_WORD_SIZE) 0x00800080)) {
568 if (get_timer (start) > CONFIG_SYS_FLASH_WRITE_TOUT) {
569 return (1);
570 }
571 }
572 }
573
574 return (0);
575}
576