]>
git.ipfire.org Git - people/ms/u-boot.git/blob - board/bf533-ezkit/flash.c
2 * U-boot - flash.c Flash driver for PSD4256GV
4 * Copyright (c) 2005-2007 Analog Devices Inc.
5 * This file is based on BF533EzFlash.c originally written by Analog Devices, Inc.
7 * (C) Copyright 2000-2004
8 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
10 * See file CREDITS for list of people who contributed to this
13 * This program is free software; you can redistribute it and/or
14 * modify it under the terms of the GNU General Public License as
15 * published by the Free Software Foundation; either version 2 of
16 * the License, or (at your option) any later version.
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, write to the Free Software
25 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
30 #include "flash-defines.h"
32 void flash_reset(void)
37 unsigned long flash_get_size(ulong baseaddr
, flash_info_t
* info
, int bank_flag
)
40 static int FlagDev
= 1;
45 printf("Device ID of the Flash is %x\n", id
);
53 for (i
= PriFlashABegin
; i
< SecFlashABegin
; i
++)
54 info
->start
[i
] = (baseaddr
+ (i
* AFP_SectorSize1
));
55 info
->size
= 0x200000;
56 info
->sector_count
= 32;
59 info
->start
[0] = baseaddr
+ SecFlashASec1Off
;
60 info
->start
[1] = baseaddr
+ SecFlashASec2Off
;
61 info
->start
[2] = baseaddr
+ SecFlashASec3Off
;
62 info
->start
[3] = baseaddr
+ SecFlashASec4Off
;
64 info
->sector_count
= 4;
67 info
->start
[0] = baseaddr
+ SecFlashBSec1Off
;
68 info
->start
[1] = baseaddr
+ SecFlashBSec2Off
;
69 info
->start
[2] = baseaddr
+ SecFlashBSec3Off
;
70 info
->start
[3] = baseaddr
+ SecFlashBSec4Off
;
72 info
->sector_count
= 4;
78 unsigned long flash_init(void)
80 unsigned long size_b0
, size_b1
, size_b2
;
83 size_b0
= size_b1
= size_b2
= 0;
85 printf("Flash Memory Start 0x%x\n", CFG_FLASH_BASE
);
86 printf("Memory Map for the Flash\n");
87 printf("0x20000000 - 0x200FFFFF Flash A Primary (1MB)\n");
88 printf("0x20100000 - 0x201FFFFF Flash B Primary (1MB)\n");
89 printf("0x20200000 - 0x2020FFFF Flash A Secondary (64KB)\n");
90 printf("0x20280000 - 0x2028FFFF Flash B Secondary (64KB)\n");
91 printf("Please type command flinfo for information on Sectors \n");
93 for (i
= 0; i
< CFG_MAX_FLASH_BANKS
; ++i
) {
94 flash_info
[i
].flash_id
= FLASH_UNKNOWN
;
97 size_b0
= flash_get_size(CFG_FLASH0_BASE
, &flash_info
[0], 0);
98 size_b1
= flash_get_size(CFG_FLASH0_BASE
, &flash_info
[1], 1);
99 size_b2
= flash_get_size(CFG_FLASH0_BASE
, &flash_info
[2], 2);
101 if (flash_info
[0].flash_id
== FLASH_UNKNOWN
|| size_b0
== 0) {
102 printf("## Unknown FLASH on Bank 0 - Size = 0x%08lx = %ld MB\n",
103 size_b0
, size_b0
>> 20);
106 (void)flash_protect(FLAG_PROTECT_SET
, CFG_FLASH0_BASE
,
107 (flash_info
[0].start
[2] - 1), &flash_info
[0]);
109 return (size_b0
+ size_b1
+ size_b2
);
112 void flash_print_info(flash_info_t
* info
)
116 if (info
->flash_id
== FLASH_UNKNOWN
) {
117 printf("missing or unknown FLASH type\n");
121 switch (info
->flash_id
) {
122 case FLASH_PSD4256GV
:
123 printf("ST Microelectronics ");
126 printf("Unknown Vendor: (0x%08X) ", info
->flash_id
);
129 for (i
= 0; i
< info
->sector_count
; ++i
) {
133 info
->start
[i
], info
->protect
[i
] ? " (RO)" : " ");
139 int flash_erase(flash_info_t
* info
, int s_first
, int s_last
)
145 for (sect
= s_first
; sect
<= s_last
; ++sect
) {
146 if (info
->protect
[sect
])
151 printf("- Warning: %d protected sectors will not be erased!\n",
156 cnt
= s_last
- s_first
+ 1;
158 if (cnt
== FLASH_TOT_SECT
) {
159 printf("Erasing flash, Please Wait \n");
160 if (erase_flash() < 0) {
161 printf("Erasing flash failed \n");
165 printf("Erasing Flash locations, Please Wait\n");
166 for (i
= s_first
; i
<= s_last
; i
++) {
167 if (info
->protect
[i
] == 0) { /* not protected */
168 if (erase_block_flash(i
, info
->start
[i
]) < 0) {
169 printf("Error Sector erasing \n");
175 return FLASH_SUCCESS
;
178 int write_buff(flash_info_t
* info
, uchar
* src
, ulong addr
, ulong cnt
)
183 read_flash(addr
- 1 - CFG_FLASH_BASE
, &d
);
184 d
= (int)((d
& 0x00FF) | (*src
++ << 8));
185 ret
= write_data(addr
- 1, 2, (uchar
*) & d
);
186 if (ret
== FLASH_FAIL
)
187 return ERR_NOT_ERASED
;
188 ret
= write_data(addr
+ 1, cnt
- 1, src
);
190 ret
= write_data(addr
, cnt
, src
);
191 if (ret
== FLASH_FAIL
)
192 return ERR_NOT_ERASED
;
193 return FLASH_SUCCESS
;
196 int write_data(long lStart
, long lCount
, uchar
* pnData
)
199 unsigned long ulOffset
= lStart
- CFG_FLASH_BASE
;
209 for (i
= 0; i
< lCount
- 1; i
+= 2, ulOffset
+= 2) {
210 get_sector_number(ulOffset
, &nSector
);
211 read_flash(ulOffset
, &d
);
214 ("Flash not erased at offset 0x%x Please erase to reprogram \n",
218 unlock_flash(ulOffset
);
219 d
= (int)(pnData
[i
] | pnData
[i
+ 1] << 8);
220 write_flash(ulOffset
, d
);
221 if (poll_toggle_bit(ulOffset
) < 0) {
222 printf("Error programming the flash \n");
225 if ((i
> 0) && (!(i
% AFP_SectorSize2
)))
229 get_sector_number(ulOffset
, &nSector
);
230 read_flash(ulOffset
, &d
);
233 ("Flash not erased at offset 0x%x Please erase to reprogram \n",
237 unlock_flash(ulOffset
);
238 d
= (int)(pnData
[i
] | (d
& 0xFF00));
239 write_flash(ulOffset
, d
);
240 if (poll_toggle_bit(ulOffset
) < 0) {
241 printf("Error programming the flash \n");
245 return FLASH_SUCCESS
;
248 int read_data(long ulStart
, long lCount
, long lStride
, int *pnData
)
252 long ulOffset
= ulStart
;
255 int nLeftover
= lCount
% 4;
259 for (i
= 0; (i
< lCount
/ 4) && (i
< BUFFER_SIZE
); i
++) {
260 for (iShift
= 0, j
= 0; j
< iNumWords
; j
+= 2) {
261 if ((ulOffset
>= INVALIDLOCNSTART
)
262 && (ulOffset
< INVALIDLOCNEND
))
265 get_sector_number(ulOffset
, &nSector
);
266 read_flash(ulOffset
, &nLow
);
267 ulOffset
+= (lStride
* 2);
268 read_flash(ulOffset
, &nHi
);
269 ulOffset
+= (lStride
* 2);
270 pnData
[i
] = (nHi
<< 16) | nLow
;
274 if ((ulOffset
>= INVALIDLOCNSTART
)
275 && (ulOffset
< INVALIDLOCNEND
))
278 get_sector_number(ulOffset
, &nSector
);
279 read_flash(ulOffset
, &pnData
[i
]);
281 return FLASH_SUCCESS
;
284 int write_flash(long nOffset
, int nValue
)
288 addr
= (CFG_FLASH_BASE
+ nOffset
);
290 *(unsigned volatile short *)addr
= nValue
;
292 if (poll_toggle_bit(nOffset
) < 0)
294 return FLASH_SUCCESS
;
297 int read_flash(long nOffset
, int *pnValue
)
300 long addr
= (CFG_FLASH_BASE
+ nOffset
);
305 nValue
= *(volatile unsigned short *)addr
;
311 int poll_toggle_bit(long lOffset
)
314 unsigned long timeout
= 0xFFFFFFFF;
315 volatile unsigned long *FB
=
316 (volatile unsigned long *)(0x20000000 + lOffset
);
320 u1
= *(volatile unsigned short *)FB
;
321 u2
= *(volatile unsigned short *)FB
;
322 if ((u1
& 0x0040) == (u2
& 0x0040))
323 return FLASH_SUCCESS
;
324 if ((u2
& 0x0020) == 0x0000)
326 u1
= *(volatile unsigned short *)FB
;
327 if ((u2
& 0x0040) == (u1
& 0x0040))
328 return FLASH_SUCCESS
;
335 printf("Time out occured \n");
340 void reset_flash(void)
342 write_flash(WRITESEQ1
, RESET_VAL
);
343 /* Wait for 10 micro seconds */
347 int erase_flash(void)
349 write_flash(WRITESEQ1
, WRITEDATA1
);
350 write_flash(WRITESEQ2
, WRITEDATA2
);
351 write_flash(WRITESEQ3
, WRITEDATA3
);
352 write_flash(WRITESEQ4
, WRITEDATA4
);
353 write_flash(WRITESEQ5
, WRITEDATA5
);
354 write_flash(WRITESEQ6
, WRITEDATA6
);
356 if (poll_toggle_bit(0x0000) < 0)
359 write_flash(SecFlashAOff
+ WRITESEQ1
, WRITEDATA1
);
360 write_flash(SecFlashAOff
+ WRITESEQ2
, WRITEDATA2
);
361 write_flash(SecFlashAOff
+ WRITESEQ3
, WRITEDATA3
);
362 write_flash(SecFlashAOff
+ WRITESEQ4
, WRITEDATA4
);
363 write_flash(SecFlashAOff
+ WRITESEQ5
, WRITEDATA5
);
364 write_flash(SecFlashAOff
+ WRITESEQ6
, WRITEDATA6
);
366 if (poll_toggle_bit(SecFlashASec1Off
) < 0)
369 write_flash(PriFlashBOff
+ WRITESEQ1
, WRITEDATA1
);
370 write_flash(PriFlashBOff
+ WRITESEQ2
, WRITEDATA2
);
371 write_flash(PriFlashBOff
+ WRITESEQ3
, WRITEDATA3
);
372 write_flash(PriFlashBOff
+ WRITESEQ4
, WRITEDATA4
);
373 write_flash(PriFlashBOff
+ WRITESEQ5
, WRITEDATA5
);
374 write_flash(PriFlashBOff
+ WRITESEQ6
, WRITEDATA6
);
376 if (poll_toggle_bit(PriFlashBOff
) < 0)
379 write_flash(SecFlashBOff
+ WRITESEQ1
, WRITEDATA1
);
380 write_flash(SecFlashBOff
+ WRITESEQ2
, WRITEDATA2
);
381 write_flash(SecFlashBOff
+ WRITESEQ3
, WRITEDATA3
);
382 write_flash(SecFlashBOff
+ WRITESEQ4
, WRITEDATA4
);
383 write_flash(SecFlashBOff
+ WRITESEQ5
, WRITEDATA5
);
384 write_flash(SecFlashBOff
+ WRITESEQ6
, WRITEDATA6
);
386 if (poll_toggle_bit(SecFlashBOff
) < 0)
389 return FLASH_SUCCESS
;
392 int erase_block_flash(int nBlock
, unsigned long address
)
394 long ulSectorOff
= 0x0;
396 if ((nBlock
< 0) || (nBlock
> AFP_NumSectors
))
399 ulSectorOff
= (address
- CFG_FLASH_BASE
);
401 write_flash((WRITESEQ1
| ulSectorOff
), WRITEDATA1
);
402 write_flash((WRITESEQ2
| ulSectorOff
), WRITEDATA2
);
403 write_flash((WRITESEQ3
| ulSectorOff
), WRITEDATA3
);
404 write_flash((WRITESEQ4
| ulSectorOff
), WRITEDATA4
);
405 write_flash((WRITESEQ5
| ulSectorOff
), WRITEDATA5
);
407 write_flash(ulSectorOff
, BlockEraseVal
);
409 if (poll_toggle_bit(ulSectorOff
) < 0)
412 return FLASH_SUCCESS
;
415 void unlock_flash(long ulOffset
)
417 unsigned long ulOffsetAddr
= ulOffset
;
418 ulOffsetAddr
&= 0xFFFF0000;
420 write_flash((WRITESEQ1
| ulOffsetAddr
), UNLOCKDATA1
);
421 write_flash((WRITESEQ2
| ulOffsetAddr
), UNLOCKDATA2
);
422 write_flash((WRITESEQ3
| ulOffsetAddr
), UNLOCKDATA3
);
429 write_flash(WRITESEQ1
, GETCODEDATA1
);
430 write_flash(WRITESEQ2
, GETCODEDATA2
);
431 write_flash(WRITESEQ3
, GETCODEDATA3
);
433 read_flash(0x0002, &dev_id
);
441 void get_sector_number(long ulOffset
, int *pnSector
)
445 if (ulOffset
>= SecFlashAOff
) {
446 if ((ulOffset
< SecFlashASec1Off
)
447 && (ulOffset
< SecFlashASec2Off
)) {
449 } else if ((ulOffset
>= SecFlashASec2Off
)
450 && (ulOffset
< SecFlashASec3Off
)) {
452 } else if ((ulOffset
>= SecFlashASec3Off
)
453 && (ulOffset
< SecFlashASec4Off
)) {
455 } else if ((ulOffset
>= SecFlashASec4Off
)
456 && (ulOffset
< SecFlashAEndOff
)) {
459 } else if (ulOffset
>= SecFlashBOff
) {
460 if ((ulOffset
< SecFlashBSec1Off
)
461 && (ulOffset
< SecFlashBSec2Off
)) {
464 if ((ulOffset
< SecFlashBSec2Off
)
465 && (ulOffset
< SecFlashBSec3Off
)) {
468 if ((ulOffset
< SecFlashBSec3Off
)
469 && (ulOffset
< SecFlashBSec4Off
)) {
472 if ((ulOffset
< SecFlashBSec4Off
)
473 && (ulOffset
< SecFlashBEndOff
)) {
476 } else if ((ulOffset
>= PriFlashAOff
) && (ulOffset
< SecFlashAOff
)) {
477 nSector
= ulOffset
& 0xffff0000;
478 nSector
= ulOffset
>> 16;
479 nSector
= nSector
& 0x000ff;
482 if ((nSector
>= 0) && (nSector
< AFP_NumSectors
)) {