]> git.sur5r.net Git - u-boot/blob - board/sc520_cdp/flash_old.c
* Code cleanup:
[u-boot] / board / sc520_cdp / flash_old.c
1 /*
2  * (C) Copyright 2002
3  * Daniel Engström, Omicron Ceti AB, daniel@omicron.se
4  *
5  * (C) Copyright 2002
6  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
7  * Alex Zuepke <azu@sysgo.de>
8  *
9  * See file CREDITS for list of people who contributed to this
10  * project.
11  *
12  * This program is free software; you can redistribute it and/or
13  * modify it under the terms of the GNU General Public License as
14  * published by the Free Software Foundation; either version 2 of
15  * the License, or (at your option) any later version.
16  *
17  * This program is distributed in the hope that it will be useful,
18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
20  * GNU General Public License for more details.
21  *
22  * You should have received a copy of the GNU General Public License
23  * along with this program; if not, write to the Free Software
24  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
25  * MA 02111-1307 USA
26  */
27
28 #include <common.h>
29 #include <asm/io.h>
30
31 ulong myflush(void);
32
33
34 #define SC520_MAX_FLASH_BANKS  3
35 #define SC520_FLASH_BANK0_BASE 0x38000000  /* BOOTCS */
36 #define SC520_FLASH_BANK1_BASE 0x30000000  /* ROMCS0 */
37 #define SC520_FLASH_BANK2_BASE 0x28000000  /* ROMCS1 */
38 #define SC520_FLASH_BANKSIZE   0x8000000
39
40 #define AMD29LV016_SIZE        0x200000
41 #define AMD29LV016_SECTORS     32
42
43 flash_info_t    flash_info[SC520_MAX_FLASH_BANKS];
44
45 #define CMD_READ_ARRAY          0x00F000F0
46 #define CMD_UNLOCK1             0x00AA00AA
47 #define CMD_UNLOCK2             0x00550055
48 #define CMD_ERASE_SETUP         0x00800080
49 #define CMD_ERASE_CONFIRM       0x00300030
50 #define CMD_PROGRAM             0x00A000A0
51 #define CMD_UNLOCK_BYPASS       0x00200020
52
53
54 #define BIT_ERASE_DONE          0x00800080
55 #define BIT_RDY_MASK            0x00800080
56 #define BIT_PROGRAM_ERROR       0x00200020
57 #define BIT_TIMEOUT             0x80000000 /* our flag */
58
59 #define READY 1
60 #define ERR   2
61 #define TMO   4
62
63 /*-----------------------------------------------------------------------
64  */
65
66 ulong flash_init(void)
67 {
68         int i, j;
69         ulong size = 0;
70
71         for (i = 0; i < SC520_MAX_FLASH_BANKS; i++) {
72                 ulong flashbase = 0;
73                 int sectsize = 0;
74                 if (i==0 || i==2) {
75                         /* FixMe: this assumes that bank 0 and 2
76                          * are mapped to the two 8Mb banks */
77                         flash_info[i].flash_id =
78                                 (AMD_MANUFACT & FLASH_VENDMASK) |
79                                 (AMD_ID_LV016B & FLASH_TYPEMASK);
80
81                         flash_info[i].size = AMD29LV016_SIZE*4;
82                         flash_info[i].sector_count = AMD29LV016_SECTORS;
83                         sectsize = (AMD29LV016_SIZE*4)/AMD29LV016_SECTORS;
84                 } else {
85                         /* FixMe: this assumes that bank1 is unmapped
86                          * (or mapped to the same flash bank as BOOTCS) */
87                         flash_info[i].flash_id = 0;
88                         flash_info[i].size = 0;
89                         flash_info[i].sector_count = 0;
90                         sectsize=0;
91                 }
92                 memset(flash_info[i].protect, 0, CFG_MAX_FLASH_SECT);
93                 switch (i) {
94                 case 0:
95                         flashbase = SC520_FLASH_BANK0_BASE;
96                         break;
97                 case 1:
98                         flashbase = SC520_FLASH_BANK1_BASE;
99                         break;
100                 case 2:
101                         flashbase = SC520_FLASH_BANK0_BASE;
102                         break;
103                 default:
104                         panic("configured to many flash banks!\n");
105                 }
106
107                 for (j = 0; j < flash_info[i].sector_count; j++) {
108                         flash_info[i].start[j] = sectsize;
109                         flash_info[i].start[j] = flashbase + j * sectsize;
110                 }
111                 size += flash_info[i].size;
112         }
113
114         /*
115          * Protect monitor and environment sectors
116          */
117         flash_protect(FLAG_PROTECT_SET,
118                       i386boot_start-SC520_FLASH_BANK0_BASE,
119                       i386boot_end-SC520_FLASH_BANK0_BASE,
120                       &flash_info[0]);
121
122 #ifdef CFG_ENV_ADDR
123         flash_protect(FLAG_PROTECT_SET,
124                       CFG_ENV_ADDR,
125                       CFG_ENV_ADDR + CFG_ENV_SIZE - 1,
126                       &flash_info[0]);
127 #endif
128         return size;
129 }
130
131 /*-----------------------------------------------------------------------
132  */
133 void flash_print_info(flash_info_t *info)
134 {
135         int i;
136
137         switch (info->flash_id & FLASH_VENDMASK) {
138         case (AMD_MANUFACT & FLASH_VENDMASK):
139                 printf("AMD: ");
140                 break;
141         default:
142                 printf("Unknown Vendor ");
143                 break;
144         }
145
146         switch (info->flash_id & FLASH_TYPEMASK) {
147         case (AMD_ID_LV016B & FLASH_TYPEMASK):
148                 printf("4x Amd29LV016B (16Mbit)\n");
149                 break;
150         default:
151                 printf("Unknown Chip Type\n");
152                 goto done;
153                 break;
154         }
155
156         printf("  Size: %ld MB in %d Sectors\n",
157                info->size >> 20, info->sector_count);
158
159         printf("  Sector Start Addresses:");
160         for (i = 0; i < info->sector_count; i++) {
161                 if ((i % 5) == 0) {
162                         printf ("\n   ");
163                 }
164                 printf (" %08lX%s", info->start[i],
165                         info->protect[i] ? " (RO)" : "     ");
166         }
167         printf ("\n");
168
169         done:
170 }
171
172 /*-----------------------------------------------------------------------
173  */
174
175 int flash_erase(flash_info_t *info, int s_first, int s_last)
176 {
177         ulong result;
178         int iflag, prot, sect;
179         int rc = ERR_OK;
180         int chip1, chip2;
181
182         /* first look for protection bits */
183
184         if (info->flash_id == FLASH_UNKNOWN) {
185                 return ERR_UNKNOWN_FLASH_TYPE;
186         }
187
188         if ((s_first < 0) || (s_first > s_last)) {
189                 return ERR_INVAL;
190         }
191
192         if ((info->flash_id & FLASH_VENDMASK) !=
193             (AMD_MANUFACT & FLASH_VENDMASK)) {
194                 return ERR_UNKNOWN_FLASH_VENDOR;
195         }
196
197         prot = 0;
198         for (sect=s_first; sect<=s_last; ++sect) {
199                 if (info->protect[sect]) {
200                         prot++;
201                 }
202         }
203         if (prot) {
204                 return ERR_PROTECTED;
205         }
206
207         /*
208          * Disable interrupts which might cause a timeout
209          * here. Remember that our exception vectors are
210          * at address 0 in the flash, and we don't want a
211          * (ticker) exception to happen while the flash
212          * chip is in programming mode.
213          */
214         iflag = disable_interrupts();
215
216         /* Start erase on unprotected sectors */
217         for (sect = s_first; sect<=s_last && !ctrlc(); sect++) {
218                 printf("Erasing sector %2d ... ", sect);
219
220                 /* arm simple, non interrupt dependent timer */
221                 reset_timer();
222
223                 if (info->protect[sect] == 0) {
224                         /* not protected */
225                         ulong addr = info->start[sect];
226
227                         writel(CMD_UNLOCK1, addr + 1);
228                         writel(CMD_UNLOCK2, addr + 2);
229                         writel(CMD_ERASE_SETUP, addr + 1);
230
231                         writel(CMD_UNLOCK1, addr + 1);
232                         writel(CMD_UNLOCK2, addr + 2);
233                         writel(CMD_ERASE_CONFIRM, addr);
234
235
236                         /* wait until flash is ready */
237                         chip1 = chip2 = 0;
238
239                         do {
240                                 result = readl(addr);
241
242                                 /* check timeout */
243                                 if (get_timer(0) > CFG_FLASH_ERASE_TOUT) {
244                                         writel(CMD_READ_ARRAY, addr + 1);
245                                         chip1 = TMO;
246                                         break;
247                                 }
248
249                                 if (!chip1 && (result & 0xFFFF) & BIT_ERASE_DONE) {
250                                         chip1 = READY;
251                                 }
252
253                                 if (!chip1 && (result & 0xFFFF) & BIT_PROGRAM_ERROR) {
254                                         chip1 = ERR;
255                                 }
256
257                                 if (!chip2 && (result >> 16) & BIT_ERASE_DONE) {
258                                         chip2 = READY;
259                                 }
260
261                                 if (!chip2 && (result >> 16) & BIT_PROGRAM_ERROR) {
262                                         chip2 = ERR;
263                                 }
264
265                         }  while (!chip1 || !chip2);
266
267                         writel(CMD_READ_ARRAY, addr + 1);
268
269                         if (chip1 == ERR || chip2 == ERR) {
270                                 rc = ERR_PROG_ERROR;
271                                 goto outahere;
272                         }
273
274                         if (chip1 == TMO) {
275                                 rc = ERR_TIMOUT;
276                                 goto outahere;
277                         }
278
279                         printf("ok.\n");
280                 } else { /* it was protected */
281
282                         printf("protected!\n");
283                 }
284         }
285
286         if (ctrlc()) {
287                 printf("User Interrupt!\n");
288         }
289
290 outahere:
291         /* allow flash to settle - wait 10 ms */
292         udelay(10000);
293
294         if (iflag) {
295                 enable_interrupts();
296         }
297
298         return rc;
299 }
300
301 /*-----------------------------------------------------------------------
302  * Copy memory to flash
303  */
304
305 volatile static int write_word(flash_info_t *info, ulong dest, ulong data)
306 {
307         ulong addr = dest;
308         ulong result;
309         int rc = ERR_OK;
310         int iflag;
311         int chip1, chip2;
312
313         /*
314          * Check if Flash is (sufficiently) erased
315          */
316         result = readl(addr);
317         if ((result & data) != data) {
318                 return ERR_NOT_ERASED;
319         }
320
321         /*
322          * Disable interrupts which might cause a timeout
323          * here. Remember that our exception vectors are
324          * at address 0 in the flash, and we don't want a
325          * (ticker) exception to happen while the flash
326          * chip is in programming mode.
327          */
328         iflag = disable_interrupts();
329
330         writel(CMD_UNLOCK1, addr + 1);
331         writel(CMD_UNLOCK2, addr + 2);
332         writel(CMD_UNLOCK_BYPASS, addr + 1);
333         writel(addr, CMD_PROGRAM);
334         writel(addr, data);
335
336         /* arm simple, non interrupt dependent timer */
337         reset_timer();
338
339         /* wait until flash is ready */
340         chip1 = chip2 = 0;
341         do {
342                 result = readl(addr);
343
344                 /* check timeout */
345                 if (get_timer(0) > CFG_FLASH_ERASE_TOUT) {
346                         chip1 = ERR | TMO;
347                         break;
348                 }
349
350                 if (!chip1 && ((result & 0x80) == (data & 0x80))) {
351                         chip1 = READY;
352                 }
353
354                 if (!chip1 && ((result & 0xFFFF) & BIT_PROGRAM_ERROR)) {
355                         result = readl(addr);
356
357                         if ((result & 0x80) == (data & 0x80)) {
358                                 chip1 = READY;
359                         } else {
360                                 chip1 = ERR;
361                         }
362                 }
363
364                 if (!chip2 && ((result & (0x80 << 16)) == (data & (0x80 << 16)))) {
365                         chip2 = READY;
366                 }
367
368                 if (!chip2 && ((result >> 16) & BIT_PROGRAM_ERROR)) {
369                         result = readl(addr);
370
371                         if ((result & (0x80 << 16)) == (data & (0x80 << 16))) {
372                                 chip2 = READY;
373                         } else {
374                                 chip2 = ERR;
375                         }
376                 }
377
378         }  while (!chip1 || !chip2);
379
380         writel(CMD_READ_ARRAY, addr);
381
382         if (chip1 == ERR || chip2 == ERR || readl(addr) != data) {
383                 rc = ERR_PROG_ERROR;
384         }
385
386         if (iflag) {
387                 enable_interrupts();
388         }
389
390         return rc;
391 }
392
393 /*-----------------------------------------------------------------------
394  * Copy memory to flash.
395  */
396
397 int write_buff(flash_info_t *info, uchar *src, ulong addr, ulong cnt)
398 {
399         ulong cp, wp, data;
400         int l;
401         int i, rc;
402
403         wp = (addr & ~3);       /* get lower word aligned address */
404
405         /*
406          * handle unaligned start bytes
407          */
408         if ((l = addr - wp) != 0) {
409                 data = 0;
410                 for (i=0, cp=wp; i<l; ++i, ++cp) {
411                         data = (data >> 8) | (*(uchar *)cp << 24);
412                 }
413                 for (; i<4 && cnt>0; ++i) {
414                         data = (data >> 8) | (*src++ << 24);
415                         --cnt;
416                         ++cp;
417                 }
418                 for (; cnt==0 && i<4; ++i, ++cp) {
419                         data = (data >> 8) | (*(uchar *)cp << 24);
420                 }
421
422                 if ((rc = write_word(info, wp, data)) != 0) {
423                         return rc;
424                 }
425                 wp += 4;
426         }
427
428         /*
429          * handle word aligned part
430          */
431         while (cnt >= 4) {
432                 data = *((vu_long*)src);
433                 if ((rc = write_word(info, wp, data)) != 0) {
434                         return rc;
435                 }
436                 src += 4;
437                 wp  += 4;
438                 cnt -= 4;
439         }
440
441         if (cnt == 0) {
442                 return ERR_OK;
443         }
444
445         /*
446          * handle unaligned tail bytes
447          */
448         data = 0;
449         for (i=0, cp=wp; i<4 && cnt>0; ++i, ++cp) {
450                 data = (data >> 8) | (*src++ << 24);
451                 --cnt;
452         }
453         for (; i<4; ++i, ++cp) {
454                 data = (data >> 8) | (*(uchar *)cp << 24);
455         }
456
457         return write_word(info, wp, data);
458 }