]>
Commit | Line | Data |
---|---|---|
cc1c8a13 WD |
1 | /* |
2 | * MOUSSE/MPC8240 Board definitions. | |
3 | * Flash Routines for MOUSSE onboard AMD29LV106DB devices | |
4 | * | |
5 | * (C) Copyright 2000 | |
6 | * Marius Groeger <mgroeger@sysgo.de> | |
7 | * Sysgo Real-Time Solutions, GmbH <www.elinos.com> | |
8 | * | |
9 | * (C) Copyright 2000 | |
10 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
11 | * | |
12 | * (C) Copyright 1999, by Curt McDowell, 08-06-99, Broadcom Corp. | |
13 | * (C) Copyright 2001, James Dougherty, 07/18/01, Broadcom Corp. | |
14 | * | |
1a459660 | 15 | * SPDX-License-Identifier: GPL-2.0+ |
cc1c8a13 WD |
16 | */ |
17 | ||
18 | #include <common.h> | |
19 | #include <mpc8xx.h> | |
20 | #include <malloc.h> | |
21 | #include "mousse.h" | |
22 | #include "flash.h" | |
23 | ||
24 | int flashLibDebug = 0; | |
25 | int flashLibInited = 0; | |
26 | ||
27 | #define OK 0 | |
28 | #define ERROR -1 | |
29 | #define STATUS int | |
30 | #define PRINTF if (flashLibDebug) printf | |
31 | #if 0 | |
32 | #define PRIVATE static | |
33 | #else | |
34 | #define PRIVATE | |
35 | #endif | |
36 | ||
6d0f6bcf | 37 | flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS]; |
cc1c8a13 WD |
38 | |
39 | #define SLEEP_DELAY 166 | |
40 | #define FLASH_SECTOR_SIZE (64*1024) | |
41 | /*********************************************************************** | |
42 | * | |
43 | * Virtual Flash Devices on Mousse board | |
44 | * | |
45 | * These must be kept in sync with the definitions in flashLib.h. | |
46 | * | |
47 | ***********************************************************************/ | |
48 | ||
49 | PRIVATE flash_dev_t flashDev[] = { | |
50 | /* Bank 0 sector SA0 (16 kB) */ | |
51 | { "SA0",FLASH0_BANK, FLASH0_SEG0_START, 1, 14, | |
52 | FLASH0_VENDOR_ID, FLASH0_DEVICE_ID | |
53 | }, | |
54 | /* Bank 0 sector SA1 (8 kB) */ | |
55 | { "SA1", FLASH0_BANK, FLASH0_SEG0_START + 0x4000, 1, 13, | |
56 | FLASH0_VENDOR_ID, FLASH0_DEVICE_ID | |
57 | }, | |
58 | /* Bank 0 sector SA2 (8 kB) */ | |
59 | { "SA2", FLASH0_BANK, FLASH0_SEG0_START + 0x6000, 1, 13, | |
60 | FLASH0_VENDOR_ID, FLASH0_DEVICE_ID | |
61 | }, | |
62 | /* Bank 0 sector SA3 is occluded by Mousse I/O devices */ | |
63 | /* Bank 0 sectors SA4-SA18, after Mousse devices up to PLCC (960 kB) */ | |
64 | { "KERNEL", FLASH0_BANK, FLASH0_SEG1_START, 15, 16, | |
65 | FLASH0_VENDOR_ID, FLASH0_DEVICE_ID | |
66 | }, | |
67 | /* Bank 0 sectors SA19-SA26, jumper can occlude this by PLCC (512 kB) */ | |
68 | /* This is where the Kahlua boot vector and boot ROM code resides. */ | |
69 | { "BOOT",FLASH0_BANK, FLASH0_SEG2_START, 8, 16, | |
70 | FLASH0_VENDOR_ID, FLASH0_DEVICE_ID | |
71 | }, | |
72 | /* Bank 0 sectors SA27-SA34 (512 kB) */ | |
73 | { "RAMDISK",FLASH0_BANK, FLASH0_SEG3_START, 8, 16, | |
74 | FLASH0_VENDOR_ID, FLASH0_DEVICE_ID | |
75 | }, | |
76 | }; | |
77 | ||
78 | int flashDevCount = (sizeof (flashDev) / sizeof (flashDev[0])); | |
79 | ||
80 | #define DEV(no) (&flashDev[no]) | |
81 | #define DEV_NO(dev) ((dev) - flashDev) | |
82 | ||
83 | /*********************************************************************** | |
84 | * | |
85 | * Private Flash Routines | |
86 | * | |
87 | ***********************************************************************/ | |
88 | ||
89 | /* | |
90 | * The convention is: | |
91 | * | |
92 | * "addr" is always the PROM raw address, which is the address of an | |
93 | * 8-bit quantity for flash 0 and 16-bit quantity for flash 1. | |
94 | * | |
95 | * "pos" is always a logical byte position from the PROM beginning. | |
96 | */ | |
97 | ||
98 | #define FLASH0_ADDR(dev, addr) \ | |
99 | ((unsigned char *) ((dev)->base + (addr))) | |
100 | ||
101 | #define FLASH0_WRITE(dev, addr, value) \ | |
102 | (*FLASH0_ADDR(dev, addr) = (value)) | |
103 | ||
104 | #define FLASH0_READ(dev, addr) \ | |
105 | (*FLASH0_ADDR(dev, addr)) | |
106 | ||
8bde7f77 | 107 | PRIVATE int flashCheck (flash_dev_t * dev) |
cc1c8a13 | 108 | { |
8bde7f77 WD |
109 | if (!flashLibInited) { |
110 | printf ("flashCheck: flashLib not initialized\n"); | |
111 | return ERROR; | |
112 | } | |
113 | ||
114 | if (dev < &flashDev[0] || dev >= &flashDev[flashDevCount]) { | |
115 | printf ("flashCheck: Bad dev parameter\n"); | |
116 | return ERROR; | |
117 | } | |
118 | ||
119 | if (!dev->found) { | |
120 | printf ("flashCheck: Device %d not available\n", DEV_NO (dev)); | |
121 | return ERROR; | |
122 | } | |
123 | ||
124 | return OK; | |
cc1c8a13 WD |
125 | } |
126 | ||
8bde7f77 | 127 | PRIVATE void flashReset (flash_dev_t * dev) |
cc1c8a13 | 128 | { |
8bde7f77 | 129 | PRINTF ("flashReset: dev=%d\n", DEV_NO (dev)); |
cc1c8a13 | 130 | |
8bde7f77 WD |
131 | if (dev->bank == FLASH0_BANK) { |
132 | FLASH0_WRITE (dev, 0x555, 0xaa); | |
133 | FLASH0_WRITE (dev, 0xaaa, 0x55); | |
134 | FLASH0_WRITE (dev, 0x555, 0xf0); | |
135 | } | |
cc1c8a13 | 136 | |
8bde7f77 | 137 | udelay (SLEEP_DELAY); |
cc1c8a13 | 138 | |
8bde7f77 | 139 | PRINTF ("flashReset: done\n"); |
cc1c8a13 WD |
140 | } |
141 | ||
8bde7f77 | 142 | PRIVATE int flashProbe (flash_dev_t * dev) |
cc1c8a13 | 143 | { |
8bde7f77 | 144 | int rv, deviceID, vendorID; |
cc1c8a13 | 145 | |
8bde7f77 | 146 | PRINTF ("flashProbe: dev=%d\n", DEV_NO (dev)); |
cc1c8a13 | 147 | |
8bde7f77 WD |
148 | if (dev->bank != FLASH0_BANK) { |
149 | rv = ERROR; | |
150 | goto DONE; | |
151 | } | |
cc1c8a13 | 152 | |
8bde7f77 WD |
153 | FLASH0_WRITE (dev, 0xaaa, 0xaa); |
154 | FLASH0_WRITE (dev, 0x555, 0x55); | |
155 | FLASH0_WRITE (dev, 0xaaa, 0x90); | |
cc1c8a13 | 156 | |
8bde7f77 | 157 | udelay (SLEEP_DELAY); |
cc1c8a13 | 158 | |
8bde7f77 WD |
159 | vendorID = FLASH0_READ (dev, 0); |
160 | deviceID = FLASH0_READ (dev, 2); | |
cc1c8a13 | 161 | |
8bde7f77 | 162 | FLASH0_WRITE (dev, 0, 0xf0); |
cc1c8a13 | 163 | |
8bde7f77 | 164 | PRINTF ("flashProbe: vendor=0x%x device=0x%x\n", vendorID, deviceID); |
cc1c8a13 | 165 | |
8bde7f77 WD |
166 | if (vendorID == dev->vendorID && deviceID == dev->deviceID) |
167 | rv = OK; | |
168 | else | |
169 | rv = ERROR; | |
cc1c8a13 | 170 | |
8bde7f77 WD |
171 | DONE: |
172 | PRINTF ("flashProbe: rv=%d\n", rv); | |
cc1c8a13 | 173 | |
8bde7f77 | 174 | return rv; |
cc1c8a13 WD |
175 | } |
176 | ||
8bde7f77 | 177 | PRIVATE int flashWait (flash_dev_t * dev, int addr, int expect, int erase) |
cc1c8a13 | 178 | { |
8bde7f77 WD |
179 | int rv = ERROR; |
180 | int i, data; | |
181 | int polls; | |
182 | ||
cc1c8a13 | 183 | #if 0 |
8bde7f77 WD |
184 | PRINTF ("flashWait: dev=%d addr=0x%x expect=0x%x erase=%d\n", |
185 | DEV_NO (dev), addr, expect, erase); | |
cc1c8a13 WD |
186 | #endif |
187 | ||
8bde7f77 WD |
188 | if (dev->bank != FLASH0_BANK) { |
189 | rv = ERROR; | |
190 | goto done; | |
191 | } | |
cc1c8a13 | 192 | |
cc1c8a13 | 193 | if (erase) |
8bde7f77 WD |
194 | polls = FLASH_ERASE_SECTOR_TIMEOUT; /* Ticks */ |
195 | else | |
196 | polls = FLASH_PROGRAM_POLLS; /* Loops */ | |
cc1c8a13 | 197 | |
8bde7f77 WD |
198 | for (i = 0; i < polls; i++) { |
199 | if (erase) | |
200 | udelay (SLEEP_DELAY); | |
cc1c8a13 | 201 | |
8bde7f77 | 202 | data = FLASH0_READ (dev, addr); |
cc1c8a13 | 203 | |
8bde7f77 WD |
204 | if (((data ^ expect) & 0x80) == 0) { |
205 | rv = OK; | |
206 | goto done; | |
207 | } | |
cc1c8a13 | 208 | |
8bde7f77 WD |
209 | if (data & 0x20) { |
210 | /* | |
211 | * If the 0x20 bit has come on, it could actually be because | |
212 | * the operation succeeded, so check the done bit again. | |
213 | */ | |
cc1c8a13 | 214 | |
8bde7f77 WD |
215 | data = FLASH0_READ (dev, addr); |
216 | ||
217 | if (((data ^ expect) & 0x80) == 0) { | |
218 | rv = OK; | |
219 | goto done; | |
220 | } | |
cc1c8a13 | 221 | |
8bde7f77 WD |
222 | printf ("flashWait: Program error (dev: %d, addr: 0x%x)\n", |
223 | DEV_NO (dev), addr); | |
cc1c8a13 | 224 | |
8bde7f77 WD |
225 | flashReset (dev); |
226 | rv = ERROR; | |
227 | goto done; | |
228 | } | |
cc1c8a13 | 229 | } |
cc1c8a13 | 230 | |
8bde7f77 WD |
231 | printf ("flashWait: Timeout %s (dev: %d, addr: 0x%x)\n", |
232 | erase ? "erasing sector" : "programming byte", | |
233 | DEV_NO (dev), addr); | |
cc1c8a13 | 234 | |
8bde7f77 | 235 | done: |
cc1c8a13 WD |
236 | |
237 | #if 0 | |
8bde7f77 | 238 | PRINTF ("flashWait: rv=%d\n", rv); |
cc1c8a13 WD |
239 | #endif |
240 | ||
8bde7f77 | 241 | return rv; |
cc1c8a13 WD |
242 | } |
243 | ||
244 | /*********************************************************************** | |
245 | * | |
246 | * Public Flash Routines | |
247 | * | |
248 | ***********************************************************************/ | |
249 | ||
8bde7f77 | 250 | STATUS flashLibInit (void) |
cc1c8a13 | 251 | { |
8bde7f77 | 252 | int i; |
cc1c8a13 | 253 | |
8bde7f77 | 254 | PRINTF ("flashLibInit: devices=%d\n", flashDevCount); |
cc1c8a13 | 255 | |
8bde7f77 WD |
256 | for (i = 0; i < flashDevCount; i++) { |
257 | flash_dev_t *dev = &flashDev[i]; | |
cc1c8a13 | 258 | |
8bde7f77 WD |
259 | /* |
260 | * For bank 1, probe both without and with byte swappage, | |
261 | * so that this module works on both old and new Mousse boards. | |
262 | */ | |
cc1c8a13 | 263 | |
8bde7f77 | 264 | flashReset (dev); |
cc1c8a13 | 265 | |
8bde7f77 WD |
266 | if (flashProbe (dev) != ERROR) |
267 | dev->found = 1; | |
cc1c8a13 | 268 | |
8bde7f77 | 269 | flashReset (dev); |
cc1c8a13 | 270 | |
8bde7f77 WD |
271 | if (flashProbe (dev) != ERROR) |
272 | dev->found = 1; | |
cc1c8a13 | 273 | |
8bde7f77 | 274 | dev->swap = 0; |
cc1c8a13 | 275 | |
8bde7f77 WD |
276 | if (dev->found) { |
277 | PRINTF ("\n FLASH %s[%d]: iobase=0x%x - %d sectors %d KB", | |
278 | flashDev[i].name, i, flashDev[i].base, | |
279 | flashDev[i].sectors, | |
280 | (flashDev[i].sectors * FLASH_SECTOR_SIZE) / 1024); | |
281 | ||
282 | } | |
283 | } | |
cc1c8a13 | 284 | |
8bde7f77 | 285 | flashLibInited = 1; |
cc1c8a13 | 286 | |
8bde7f77 | 287 | PRINTF ("flashLibInit: done\n"); |
cc1c8a13 | 288 | |
8bde7f77 | 289 | return OK; |
cc1c8a13 WD |
290 | } |
291 | ||
8bde7f77 | 292 | STATUS flashEraseSector (flash_dev_t * dev, int sector) |
cc1c8a13 | 293 | { |
8bde7f77 | 294 | int pos, addr; |
cc1c8a13 | 295 | |
8bde7f77 | 296 | PRINTF ("flashErasesector: dev=%d sector=%d\n", DEV_NO (dev), sector); |
cc1c8a13 | 297 | |
8bde7f77 WD |
298 | if (flashCheck (dev) == ERROR) |
299 | return ERROR; | |
cc1c8a13 | 300 | |
8bde7f77 WD |
301 | if (sector < 0 || sector >= dev->sectors) { |
302 | printf ("flashEraseSector: Sector out of range (dev: %d, sector: %d)\n", DEV_NO (dev), sector); | |
303 | return ERROR; | |
304 | } | |
cc1c8a13 | 305 | |
8bde7f77 | 306 | pos = FLASH_SECTOR_POS (dev, sector); |
cc1c8a13 | 307 | |
8bde7f77 WD |
308 | if (dev->bank != FLASH0_BANK) { |
309 | return ERROR; | |
310 | } | |
cc1c8a13 | 311 | |
8bde7f77 | 312 | addr = pos; |
cc1c8a13 | 313 | |
8bde7f77 WD |
314 | FLASH0_WRITE (dev, 0xaaa, 0xaa); |
315 | FLASH0_WRITE (dev, 0x555, 0x55); | |
316 | FLASH0_WRITE (dev, 0xaaa, 0x80); | |
317 | FLASH0_WRITE (dev, 0xaaa, 0xaa); | |
318 | FLASH0_WRITE (dev, 0x555, 0x55); | |
319 | FLASH0_WRITE (dev, addr, 0x30); | |
cc1c8a13 | 320 | |
8bde7f77 | 321 | return flashWait (dev, addr, 0xff, 1); |
cc1c8a13 WD |
322 | } |
323 | ||
324 | /* | |
325 | * Note: it takes about as long to flash all sectors together with Chip | |
326 | * Erase as it does to flash them one at a time (about 30 seconds for 2 | |
327 | * MB). Also since we want to be able to treat subsets of sectors as if | |
328 | * they were complete devices, we don't use Chip Erase. | |
329 | */ | |
330 | ||
8bde7f77 | 331 | STATUS flashErase (flash_dev_t * dev) |
cc1c8a13 | 332 | { |
8bde7f77 | 333 | int sector; |
cc1c8a13 | 334 | |
8bde7f77 | 335 | PRINTF ("flashErase: dev=%d sectors=%d\n", DEV_NO (dev), dev->sectors); |
cc1c8a13 | 336 | |
8bde7f77 WD |
337 | if (flashCheck (dev) == ERROR) |
338 | return ERROR; | |
cc1c8a13 | 339 | |
8bde7f77 WD |
340 | for (sector = 0; sector < dev->sectors; sector++) { |
341 | if (flashEraseSector (dev, sector) == ERROR) | |
342 | return ERROR; | |
343 | } | |
344 | return OK; | |
cc1c8a13 WD |
345 | } |
346 | ||
347 | /* | |
348 | * Read and write bytes | |
349 | */ | |
350 | ||
8bde7f77 | 351 | STATUS flashRead (flash_dev_t * dev, int pos, char *buf, int len) |
cc1c8a13 | 352 | { |
8bde7f77 | 353 | int addr, words; |
cc1c8a13 | 354 | |
8bde7f77 WD |
355 | PRINTF ("flashRead: dev=%d pos=0x%x buf=0x%x len=0x%x\n", |
356 | DEV_NO (dev), pos, (int) buf, len); | |
cc1c8a13 | 357 | |
8bde7f77 WD |
358 | if (flashCheck (dev) == ERROR) |
359 | return ERROR; | |
cc1c8a13 | 360 | |
8bde7f77 WD |
361 | if (pos < 0 || len < 0 || pos + len > FLASH_MAX_POS (dev)) { |
362 | printf ("flashRead: Position out of range " | |
363 | "(dev: %d, pos: 0x%x, len: 0x%x)\n", | |
364 | DEV_NO (dev), pos, len); | |
365 | return ERROR; | |
366 | } | |
cc1c8a13 | 367 | |
8bde7f77 WD |
368 | if (len == 0) |
369 | return OK; | |
cc1c8a13 | 370 | |
8bde7f77 WD |
371 | if (dev->bank == FLASH0_BANK) { |
372 | addr = pos; | |
373 | words = len; | |
cc1c8a13 | 374 | |
8bde7f77 WD |
375 | PRINTF ("flashRead: memcpy(0x%x, 0x%x, 0x%x)\n", |
376 | (int) buf, (int) FLASH0_ADDR (dev, pos), len); | |
cc1c8a13 | 377 | |
8bde7f77 | 378 | memcpy (buf, FLASH0_ADDR (dev, addr), words); |
cc1c8a13 | 379 | |
8bde7f77 WD |
380 | } |
381 | PRINTF ("flashRead: rv=OK\n"); | |
cc1c8a13 | 382 | |
8bde7f77 | 383 | return OK; |
cc1c8a13 WD |
384 | } |
385 | ||
8bde7f77 | 386 | STATUS flashWrite (flash_dev_t * dev, int pos, char *buf, int len) |
cc1c8a13 | 387 | { |
8bde7f77 | 388 | int addr, words; |
cc1c8a13 | 389 | |
8bde7f77 WD |
390 | PRINTF ("flashWrite: dev=%d pos=0x%x buf=0x%x len=0x%x\n", |
391 | DEV_NO (dev), pos, (int) buf, len); | |
cc1c8a13 | 392 | |
8bde7f77 | 393 | if (flashCheck (dev) == ERROR) |
cc1c8a13 | 394 | return ERROR; |
8bde7f77 WD |
395 | |
396 | if (pos < 0 || len < 0 || pos + len > FLASH_MAX_POS (dev)) { | |
397 | printf ("flashWrite: Position out of range " | |
398 | "(dev: %d, pos: 0x%x, len: 0x%x)\n", | |
399 | DEV_NO (dev), pos, len); | |
cc1c8a13 | 400 | return ERROR; |
cc1c8a13 | 401 | } |
cc1c8a13 | 402 | |
8bde7f77 WD |
403 | if (len == 0) |
404 | return OK; | |
405 | ||
406 | if (dev->bank == FLASH0_BANK) { | |
407 | unsigned char tmp; | |
408 | ||
409 | addr = pos; | |
410 | words = len; | |
411 | ||
412 | while (words--) { | |
413 | tmp = *buf; | |
414 | if (~FLASH0_READ (dev, addr) & tmp) { | |
415 | printf ("flashWrite: Attempt to program 0 to 1 " | |
416 | "(dev: %d, addr: 0x%x, data: 0x%x)\n", | |
417 | DEV_NO (dev), addr, tmp); | |
418 | return ERROR; | |
419 | } | |
420 | FLASH0_WRITE (dev, 0xaaa, 0xaa); | |
421 | FLASH0_WRITE (dev, 0x555, 0x55); | |
422 | FLASH0_WRITE (dev, 0xaaa, 0xa0); | |
423 | FLASH0_WRITE (dev, addr, tmp); | |
424 | if (flashWait (dev, addr, tmp, 0) < 0) | |
425 | return ERROR; | |
426 | buf++; | |
427 | addr++; | |
428 | } | |
429 | } | |
cc1c8a13 | 430 | |
8bde7f77 WD |
431 | PRINTF ("flashWrite: rv=OK\n"); |
432 | ||
433 | return OK; | |
cc1c8a13 WD |
434 | } |
435 | ||
436 | /* | |
472d5460 | 437 | * flashWritable returns true if a range contains all F's. |
cc1c8a13 WD |
438 | */ |
439 | ||
8bde7f77 | 440 | STATUS flashWritable (flash_dev_t * dev, int pos, int len) |
cc1c8a13 | 441 | { |
8bde7f77 WD |
442 | int addr, words; |
443 | int rv = ERROR; | |
cc1c8a13 | 444 | |
8bde7f77 WD |
445 | PRINTF ("flashWritable: dev=%d pos=0x%x len=0x%x\n", |
446 | DEV_NO (dev), pos, len); | |
cc1c8a13 | 447 | |
8bde7f77 WD |
448 | if (flashCheck (dev) == ERROR) |
449 | goto done; | |
cc1c8a13 | 450 | |
8bde7f77 WD |
451 | if (pos < 0 || len < 0 || pos + len > FLASH_MAX_POS (dev)) { |
452 | printf ("flashWritable: Position out of range " | |
453 | "(dev: %d, pos: 0x%x, len: 0x%x)\n", | |
454 | DEV_NO (dev), pos, len); | |
455 | goto done; | |
456 | } | |
cc1c8a13 | 457 | |
8bde7f77 WD |
458 | if (len == 0) { |
459 | rv = 1; | |
cc1c8a13 | 460 | goto done; |
cc1c8a13 | 461 | } |
cc1c8a13 | 462 | |
8bde7f77 WD |
463 | if (dev->bank == FLASH0_BANK) { |
464 | addr = pos; | |
465 | words = len; | |
466 | ||
467 | while (words--) { | |
468 | if (FLASH0_READ (dev, addr) != 0xff) { | |
469 | rv = 0; | |
470 | goto done; | |
471 | } | |
472 | addr++; | |
473 | } | |
474 | } | |
475 | ||
476 | rv = 1; | |
cc1c8a13 | 477 | |
8bde7f77 WD |
478 | done: |
479 | PRINTF ("flashWrite: rv=%d\n", rv); | |
480 | return rv; | |
cc1c8a13 WD |
481 | } |
482 | ||
483 | ||
484 | /* | |
485 | * NOTE: the below code cannot run from FLASH!!! | |
486 | */ | |
487 | /*********************************************************************** | |
488 | * | |
489 | * Flash Diagnostics | |
490 | * | |
491 | ***********************************************************************/ | |
492 | ||
8bde7f77 | 493 | STATUS flashDiag (flash_dev_t * dev) |
cc1c8a13 | 494 | { |
8bde7f77 WD |
495 | unsigned int *buf = 0; |
496 | int i, len, sector; | |
497 | int rv = ERROR; | |
498 | ||
499 | if (flashCheck (dev) == ERROR) | |
500 | return ERROR; | |
501 | ||
502 | printf ("flashDiag: Testing device %d, " | |
503 | "base: 0x%x, %d sectors @ %d kB = %d kB\n", | |
504 | DEV_NO (dev), dev->base, | |
505 | dev->sectors, | |
506 | 1 << (dev->lgSectorSize - 10), | |
507 | dev->sectors << (dev->lgSectorSize - 10)); | |
508 | ||
509 | len = 1 << dev->lgSectorSize; | |
cc1c8a13 | 510 | |
8bde7f77 WD |
511 | printf ("flashDiag: Erasing\n"); |
512 | ||
513 | if (flashErase (dev) == ERROR) { | |
514 | printf ("flashDiag: Erase failed\n"); | |
515 | goto done; | |
516 | } | |
517 | printf ("%d bytes requested ...\n", len); | |
518 | buf = malloc (len); | |
519 | printf ("allocated %d bytes ...\n", len); | |
520 | if (buf == 0) { | |
521 | printf ("flashDiag: Out of memory\n"); | |
cc1c8a13 | 522 | goto done; |
cc1c8a13 | 523 | } |
cc1c8a13 | 524 | |
8bde7f77 WD |
525 | /* |
526 | * Write unique counting pattern to each sector | |
527 | */ | |
cc1c8a13 | 528 | |
8bde7f77 WD |
529 | for (sector = 0; sector < dev->sectors; sector++) { |
530 | printf ("flashDiag: Write sector %d\n", sector); | |
cc1c8a13 | 531 | |
8bde7f77 WD |
532 | for (i = 0; i < len / 4; i++) |
533 | buf[i] = sector << 24 | i; | |
cc1c8a13 | 534 | |
8bde7f77 WD |
535 | if (flashWrite (dev, |
536 | sector << dev->lgSectorSize, | |
537 | (char *) buf, len) == ERROR) { | |
538 | printf ("flashDiag: Write failed (dev: %d, sector: %d)\n", | |
539 | DEV_NO (dev), sector); | |
540 | goto done; | |
541 | } | |
542 | } | |
543 | ||
544 | /* | |
545 | * Verify | |
546 | */ | |
547 | ||
548 | for (sector = 0; sector < dev->sectors; sector++) { | |
549 | printf ("flashDiag: Verify sector %d\n", sector); | |
550 | ||
551 | if (flashRead (dev, | |
552 | sector << dev->lgSectorSize, | |
553 | (char *) buf, len) == ERROR) { | |
554 | printf ("flashDiag: Read failed (dev: %d, sector: %d)\n", | |
555 | DEV_NO (dev), sector); | |
556 | goto done; | |
557 | } | |
558 | ||
559 | for (i = 0; i < len / 4; i++) { | |
560 | if (buf[i] != (sector << 24 | i)) { | |
561 | printf ("flashDiag: Verify error " | |
562 | "(dev: %d, sector: %d, offset: 0x%x)\n", | |
563 | DEV_NO (dev), sector, i); | |
564 | printf ("flashDiag: Expected 0x%08x, got 0x%08x\n", | |
565 | sector << 24 | i, buf[i]); | |
566 | ||
567 | goto done; | |
568 | } | |
569 | } | |
570 | } | |
571 | ||
572 | printf ("flashDiag: Erasing\n"); | |
573 | ||
574 | if (flashErase (dev) == ERROR) { | |
575 | printf ("flashDiag: Final erase failed\n"); | |
576 | goto done; | |
577 | } | |
578 | ||
579 | rv = OK; | |
cc1c8a13 | 580 | |
8bde7f77 WD |
581 | done: |
582 | if (buf) | |
583 | free (buf); | |
cc1c8a13 | 584 | |
8bde7f77 WD |
585 | if (rv == OK) |
586 | printf ("flashDiag: Device %d passed\n", DEV_NO (dev)); | |
587 | else | |
588 | printf ("flashDiag: Device %d failed\n", DEV_NO (dev)); | |
589 | ||
590 | return rv; | |
cc1c8a13 WD |
591 | } |
592 | ||
8bde7f77 | 593 | STATUS flashDiagAll (void) |
cc1c8a13 | 594 | { |
8bde7f77 WD |
595 | int i; |
596 | int rv = OK; | |
cc1c8a13 | 597 | |
8bde7f77 | 598 | PRINTF ("flashDiagAll: devices=%d\n", flashDevCount); |
cc1c8a13 | 599 | |
8bde7f77 WD |
600 | for (i = 0; i < flashDevCount; i++) { |
601 | flash_dev_t *dev = &flashDev[i]; | |
cc1c8a13 | 602 | |
8bde7f77 WD |
603 | if (dev->found && flashDiag (dev) == ERROR) |
604 | rv = ERROR; | |
605 | } | |
cc1c8a13 | 606 | |
8bde7f77 WD |
607 | if (rv == OK) |
608 | printf ("flashDiagAll: Passed\n"); | |
609 | else | |
610 | printf ("flashDiagAll: Failed because of earlier errors\n"); | |
cc1c8a13 | 611 | |
8bde7f77 | 612 | return OK; |
cc1c8a13 WD |
613 | } |
614 | ||
615 | ||
616 | /*----------------------------------------------------------------------- | |
617 | */ | |
618 | unsigned long flash_init (void) | |
619 | { | |
8bde7f77 WD |
620 | unsigned long size = 0; |
621 | flash_dev_t *dev = NULL; | |
622 | ||
623 | flashLibInit (); | |
624 | ||
625 | /* | |
626 | * Provide info for FLASH (up to 960K) of Kernel Image data. | |
627 | */ | |
628 | dev = FLASH_DEV_BANK0_LOW; | |
629 | flash_info[FLASH_BANK_KERNEL].flash_id = | |
630 | (dev->vendorID << 16) | dev->deviceID; | |
631 | flash_info[FLASH_BANK_KERNEL].sector_count = dev->sectors; | |
632 | flash_info[FLASH_BANK_KERNEL].size = | |
633 | flash_info[FLASH_BANK_KERNEL].sector_count * FLASH_SECTOR_SIZE; | |
634 | flash_info[FLASH_BANK_KERNEL].start[FIRST_SECTOR] = dev->base; | |
635 | size += flash_info[FLASH_BANK_KERNEL].size; | |
636 | ||
637 | /* | |
638 | * Provide info for 512K PLCC FLASH ROM (U-Boot) | |
639 | */ | |
640 | dev = FLASH_DEV_BANK0_BOOT; | |
641 | flash_info[FLASH_BANK_BOOT].flash_id = | |
642 | (dev->vendorID << 16) | dev->deviceID; | |
643 | flash_info[FLASH_BANK_BOOT].sector_count = dev->sectors; | |
644 | flash_info[FLASH_BANK_BOOT].size = | |
645 | flash_info[FLASH_BANK_BOOT].sector_count * FLASH_SECTOR_SIZE; | |
646 | flash_info[FLASH_BANK_BOOT].start[FIRST_SECTOR] = dev->base; | |
647 | size += flash_info[FLASH_BANK_BOOT].size; | |
648 | ||
649 | ||
650 | /* | |
651 | * Provide info for 512K FLASH0 segment (U-Boot) | |
652 | */ | |
653 | dev = FLASH_DEV_BANK0_HIGH; | |
654 | flash_info[FLASH_BANK_AUX].flash_id = | |
655 | (dev->vendorID << 16) | dev->deviceID; | |
656 | flash_info[FLASH_BANK_AUX].sector_count = dev->sectors; | |
657 | flash_info[FLASH_BANK_AUX].size = | |
658 | flash_info[FLASH_BANK_AUX].sector_count * FLASH_SECTOR_SIZE; | |
659 | flash_info[FLASH_BANK_AUX].start[FIRST_SECTOR] = dev->base; | |
660 | size += flash_info[FLASH_BANK_AUX].size; | |
661 | ||
662 | ||
663 | return size; | |
cc1c8a13 WD |
664 | } |
665 | ||
666 | /* | |
667 | * Get flash device from U-Boot flash info. | |
668 | */ | |
8bde7f77 | 669 | flash_dev_t *getFlashDevFromInfo (flash_info_t * info) |
cc1c8a13 | 670 | { |
8bde7f77 WD |
671 | int i; |
672 | ||
673 | if (!info) | |
674 | return NULL; | |
675 | ||
676 | for (i = 0; i < flashDevCount; i++) { | |
677 | flash_dev_t *dev = &flashDev[i]; | |
678 | ||
679 | if (dev->found && (dev->base == info->start[0])) | |
680 | return dev; | |
681 | } | |
682 | printf ("ERROR: notice, no FLASH mapped at address 0x%x\n", | |
683 | (unsigned int) info->start[0]); | |
684 | return NULL; | |
cc1c8a13 WD |
685 | } |
686 | ||
8bde7f77 | 687 | ulong flash_get_size (vu_long * addr, flash_info_t * info) |
cc1c8a13 | 688 | { |
8bde7f77 WD |
689 | int i; |
690 | ||
691 | for (i = 0; i < flashDevCount; i++) { | |
692 | flash_dev_t *dev = &flashDev[i]; | |
693 | ||
694 | if (dev->found) { | |
695 | if (dev->base == (unsigned int) addr) { | |
696 | info->flash_id = (dev->vendorID << 16) | dev->deviceID; | |
697 | info->sector_count = dev->sectors; | |
698 | info->size = info->sector_count * FLASH_SECTOR_SIZE; | |
699 | return dev->sectors * FLASH_SECTOR_SIZE; | |
700 | } | |
701 | } | |
702 | } | |
703 | return 0; | |
cc1c8a13 WD |
704 | } |
705 | ||
8bde7f77 | 706 | void flash_print_info (flash_info_t * info) |
cc1c8a13 | 707 | { |
8bde7f77 WD |
708 | int i; |
709 | unsigned int chip; | |
710 | ||
711 | if (info->flash_id == FLASH_UNKNOWN) { | |
712 | printf ("missing or unknown FLASH type\n"); | |
713 | return; | |
714 | } | |
715 | ||
716 | switch ((info->flash_id >> 16) & 0xff) { | |
717 | case 0x1: | |
718 | printf ("AMD "); | |
719 | break; | |
720 | default: | |
721 | printf ("Unknown Vendor "); | |
722 | break; | |
723 | } | |
724 | chip = (unsigned int) info->flash_id & 0x000000ff; | |
725 | ||
726 | switch (chip) { | |
727 | ||
728 | case AMD_ID_F040B: | |
729 | printf ("AM29F040B (4 Mbit)\n"); | |
730 | break; | |
731 | ||
732 | case AMD_ID_LV160B: | |
733 | case FLASH_AM160LV: | |
734 | case 0x49: | |
735 | printf ("AM29LV160B (16 Mbit / 2M x 8bit)\n"); | |
736 | break; | |
737 | ||
738 | default: | |
739 | printf ("Unknown Chip Type:0x%x\n", chip); | |
740 | break; | |
741 | } | |
742 | ||
743 | printf (" Size: %ld bytes in %d Sectors\n", | |
744 | info->size, info->sector_count); | |
745 | ||
746 | printf (" Sector Start Addresses:"); | |
747 | for (i = 0; i < info->sector_count; ++i) { | |
748 | if ((i % 5) == 0) | |
749 | printf ("\n "); | |
750 | printf (" %08lX%s", | |
751 | info->start[FIRST_SECTOR] + i * FLASH_SECTOR_SIZE, | |
752 | info->protect[i] ? " (RO)" : " "); | |
753 | } | |
754 | printf ("\n"); | |
cc1c8a13 WD |
755 | } |
756 | ||
757 | ||
758 | /* | |
759 | * Erase a range of flash sectors. | |
760 | */ | |
8bde7f77 | 761 | int flash_erase (flash_info_t * info, int s_first, int s_last) |
cc1c8a13 | 762 | { |
a3cfb39b | 763 | int prot, sect; |
8bde7f77 WD |
764 | flash_dev_t *dev = NULL; |
765 | ||
766 | if ((s_first < 0) || (s_first > s_last)) { | |
767 | if (info->flash_id == FLASH_UNKNOWN) { | |
768 | printf ("- missing\n"); | |
769 | } else { | |
770 | printf ("- no sectors to erase\n"); | |
771 | } | |
772 | return 1; | |
773 | } | |
cc1c8a13 | 774 | |
8bde7f77 WD |
775 | prot = 0; |
776 | for (sect = s_first; sect <= s_last; sect++) { | |
777 | if (info->protect[sect]) { | |
778 | prot++; | |
779 | } | |
cc1c8a13 | 780 | } |
cc1c8a13 | 781 | |
8bde7f77 WD |
782 | if (prot) { |
783 | printf ("- Warning: %d protected sectors will not be erased!\n", | |
784 | prot); | |
785 | } else { | |
786 | printf ("\n"); | |
cc1c8a13 | 787 | } |
cc1c8a13 | 788 | |
8bde7f77 WD |
789 | /* Start erase on unprotected sectors */ |
790 | dev = getFlashDevFromInfo (info); | |
791 | if (dev) { | |
792 | printf ("Erase FLASH[%s] -%d sectors:", dev->name, dev->sectors); | |
793 | for (sect = s_first; sect <= s_last; sect++) { | |
794 | if (info->protect[sect] == 0) { /* not protected */ | |
8bde7f77 WD |
795 | printf ("."); |
796 | if (ERROR == flashEraseSector (dev, sect)) { | |
797 | printf ("ERROR: could not erase sector %d on FLASH[%s]\n", sect, dev->name); | |
798 | return 1; | |
799 | } | |
800 | } | |
801 | } | |
802 | } | |
803 | printf (" done\n"); | |
804 | return 0; | |
cc1c8a13 WD |
805 | } |
806 | ||
807 | /*----------------------------------------------------------------------- | |
808 | * Write a word to Flash, returns: | |
809 | * 0 - OK | |
810 | * 1 - write timeout | |
811 | * 2 - Flash not erased | |
812 | */ | |
8bde7f77 | 813 | static int write_word (flash_info_t * info, ulong dest, ulong data) |
cc1c8a13 WD |
814 | { |
815 | ||
8bde7f77 WD |
816 | flash_dev_t *dev = getFlashDevFromInfo (info); |
817 | int addr = dest - info->start[0]; | |
cc1c8a13 | 818 | |
8bde7f77 WD |
819 | if (!dev) |
820 | return 1; | |
cc1c8a13 | 821 | |
8bde7f77 WD |
822 | if (OK != flashWrite (dev, addr, (char *) &data, sizeof (ulong))) { |
823 | printf ("ERROR: could not write to addr=0x%x, data=0x%x\n", | |
824 | (unsigned int) addr, (unsigned) data); | |
825 | return 1; | |
826 | } | |
cc1c8a13 | 827 | |
8bde7f77 WD |
828 | if ((addr % FLASH_SECTOR_SIZE) == 0) |
829 | printf ("."); | |
cc1c8a13 WD |
830 | |
831 | ||
8bde7f77 WD |
832 | PRINTF ("write_word:0x%x, base=0x%x, addr=0x%x, data=0x%x\n", |
833 | (unsigned) info->start[0], | |
834 | (unsigned) dest, | |
835 | (unsigned) (dest - info->start[0]), (unsigned) data); | |
cc1c8a13 | 836 | |
8bde7f77 | 837 | return (0); |
cc1c8a13 WD |
838 | } |
839 | ||
840 | ||
841 | /*----------------------------------------------------------------------- | |
842 | * Copy memory to flash, returns: | |
843 | * 0 - OK | |
844 | * 1 - write timeout | |
845 | * 2 - Flash not erased | |
846 | */ | |
847 | ||
8bde7f77 | 848 | int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt) |
cc1c8a13 | 849 | { |
8bde7f77 WD |
850 | ulong cp, wp, data; |
851 | int i, l, rc; | |
852 | flash_dev_t *dev = getFlashDevFromInfo (info); | |
853 | ||
854 | if (dev) { | |
855 | printf ("FLASH[%s]:", dev->name); | |
856 | wp = (addr & ~3); /* get lower word aligned address */ | |
857 | ||
858 | /* | |
859 | * handle unaligned start bytes | |
860 | */ | |
861 | if ((l = addr - wp) != 0) { | |
862 | data = 0; | |
863 | for (i = 0, cp = wp; i < l; ++i, ++cp) { | |
864 | data = (data << 8) | (*(uchar *) cp); | |
865 | } | |
866 | for (; i < 4 && cnt > 0; ++i) { | |
867 | data = (data << 8) | *src++; | |
868 | --cnt; | |
869 | ++cp; | |
870 | } | |
871 | for (; cnt == 0 && i < 4; ++i, ++cp) { | |
872 | data = (data << 8) | (*(uchar *) cp); | |
873 | } | |
874 | if ((rc = write_word (info, wp, data)) != 0) { | |
875 | return (rc); | |
876 | } | |
877 | wp += 4; | |
878 | } | |
879 | ||
880 | /* | |
881 | * handle word aligned part | |
882 | */ | |
883 | while (cnt >= 4) { | |
884 | data = 0; | |
885 | for (i = 0; i < 4; ++i) { | |
886 | data = (data << 8) | *src++; | |
887 | } | |
888 | if ((rc = write_word (info, wp, data)) != 0) { | |
889 | return (rc); | |
890 | } | |
891 | wp += 4; | |
892 | cnt -= 4; | |
893 | } | |
894 | ||
895 | if (cnt == 0) { | |
896 | return (0); | |
897 | } | |
898 | ||
899 | /* | |
900 | * handle unaligned tail bytes | |
901 | */ | |
902 | data = 0; | |
903 | for (i = 0, cp = wp; i < 4 && cnt > 0; ++i, ++cp) { | |
904 | data = (data << 8) | *src++; | |
905 | --cnt; | |
906 | } | |
907 | for (; i < 4; ++i, ++cp) { | |
908 | data = (data << 8) | (*(uchar *) cp); | |
909 | } | |
910 | ||
911 | return (write_word (info, wp, data)); | |
912 | } | |
913 | return 1; | |
cc1c8a13 WD |
914 | } |
915 | ||
916 | /*----------------------------------------------------------------------- | |
917 | */ |