2 * U-boot - flash.c Flash driver for PSD4256GV
4 * Copyright (c) 2005 blackfin.uclinux.org
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., 59 Temple Place, Suite 330, 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)
182 ret = write_data(addr, cnt, 1, (int *)src);
183 if (ret == FLASH_FAIL)
184 return ERR_NOT_ERASED;
185 return FLASH_SUCCESS;
188 int write_data(long lStart, long lCount, long lStride, int *pnData)
192 unsigned long ulOffset = lStart - CFG_FLASH_BASE;
196 int nLeftover = lCount % 4;
199 for (i = 0; (i < lCount / 4) && (i < BUFFER_SIZE); i++) {
200 for (iShift = 0, j = 0; (j < iNumWords);
201 j++, ulOffset += (lStride * 2)) {
202 if ((ulOffset >= INVALIDLOCNSTART)
203 && (ulOffset < INVALIDLOCNEND)) {
205 ("Invalid locations, Try writing to another location \n");
208 get_sector_number(ulOffset, &nSector);
209 read_flash(ulOffset, &d);
212 ("Flash not erased at offset 0x%x Please erase to reprogram \n",
216 unlock_flash(ulOffset);
217 if (write_flash(ulOffset, (pnData[i] >> iShift)) < 0) {
218 printf("Error programming the flash \n");
225 if ((ulOffset >= INVALIDLOCNSTART)
226 && (ulOffset < INVALIDLOCNEND))
228 get_sector_number(ulOffset, &nSector);
229 read_flash(ulOffset, &d);
232 ("Flash already programmed. Please erase to reprogram \n");
233 printf("uloffset = 0x%x \t d = 0x%x\n", ulOffset, d);
236 unlock_flash(ulOffset);
237 if (write_flash(ulOffset, pnData[i]) < 0) {
238 printf("Error programming the flash \n");
242 return FLASH_SUCCESS;
245 int read_data(long ulStart, long lCount, long lStride, int *pnData)
249 long ulOffset = ulStart;
252 int nLeftover = lCount % 4;
256 for (i = 0; (i < lCount / 4) && (i < BUFFER_SIZE); i++) {
257 for (iShift = 0, j = 0; j < iNumWords; j += 2) {
258 if ((ulOffset >= INVALIDLOCNSTART)
259 && (ulOffset < INVALIDLOCNEND))
262 get_sector_number(ulOffset, &nSector);
263 read_flash(ulOffset, &nLow);
264 ulOffset += (lStride * 2);
265 read_flash(ulOffset, &nHi);
266 ulOffset += (lStride * 2);
267 pnData[i] = (nHi << 16) | nLow;
271 if ((ulOffset >= INVALIDLOCNSTART)
272 && (ulOffset < INVALIDLOCNEND))
275 get_sector_number(ulOffset, &nSector);
276 read_flash(ulOffset, &pnData[i]);
278 return FLASH_SUCCESS;
281 int write_flash(long nOffset, int nValue)
285 addr = (CFG_FLASH_BASE + nOffset);
287 *(unsigned volatile short *)addr = nValue;
289 if (poll_toggle_bit(nOffset) < 0)
291 return FLASH_SUCCESS;
294 int read_flash(long nOffset, int *pnValue)
297 long addr = (CFG_FLASH_BASE + nOffset);
302 nValue = *(volatile unsigned short *)addr;
308 int poll_toggle_bit(long lOffset)
311 unsigned long timeout = 0xFFFFFFFF;
312 volatile unsigned long *FB =
313 (volatile unsigned long *)(0x20000000 + lOffset);
317 u1 = *(volatile unsigned short *)FB;
318 u2 = *(volatile unsigned short *)FB;
319 if ((u1 & 0x0040) == (u2 & 0x0040))
320 return FLASH_SUCCESS;
321 if ((u2 & 0x0020) == 0x0000)
323 u1 = *(volatile unsigned short *)FB;
324 if ((u2 & 0x0040) == (u1 & 0x0040))
325 return FLASH_SUCCESS;
332 printf("Time out occured \n");
337 void reset_flash(void)
339 write_flash(WRITESEQ1, RESET_VAL);
340 /* Wait for 10 micro seconds */
344 int erase_flash(void)
346 write_flash(WRITESEQ1, WRITEDATA1);
347 write_flash(WRITESEQ2, WRITEDATA2);
348 write_flash(WRITESEQ3, WRITEDATA3);
349 write_flash(WRITESEQ4, WRITEDATA4);
350 write_flash(WRITESEQ5, WRITEDATA5);
351 write_flash(WRITESEQ6, WRITEDATA6);
353 if (poll_toggle_bit(0x0000) < 0)
356 write_flash(SecFlashAOff + WRITESEQ1, WRITEDATA1);
357 write_flash(SecFlashAOff + WRITESEQ2, WRITEDATA2);
358 write_flash(SecFlashAOff + WRITESEQ3, WRITEDATA3);
359 write_flash(SecFlashAOff + WRITESEQ4, WRITEDATA4);
360 write_flash(SecFlashAOff + WRITESEQ5, WRITEDATA5);
361 write_flash(SecFlashAOff + WRITESEQ6, WRITEDATA6);
363 if (poll_toggle_bit(SecFlashASec1Off) < 0)
366 write_flash(PriFlashBOff + WRITESEQ1, WRITEDATA1);
367 write_flash(PriFlashBOff + WRITESEQ2, WRITEDATA2);
368 write_flash(PriFlashBOff + WRITESEQ3, WRITEDATA3);
369 write_flash(PriFlashBOff + WRITESEQ4, WRITEDATA4);
370 write_flash(PriFlashBOff + WRITESEQ5, WRITEDATA5);
371 write_flash(PriFlashBOff + WRITESEQ6, WRITEDATA6);
373 if (poll_toggle_bit(PriFlashBOff) < 0)
376 write_flash(SecFlashBOff + WRITESEQ1, WRITEDATA1);
377 write_flash(SecFlashBOff + WRITESEQ2, WRITEDATA2);
378 write_flash(SecFlashBOff + WRITESEQ3, WRITEDATA3);
379 write_flash(SecFlashBOff + WRITESEQ4, WRITEDATA4);
380 write_flash(SecFlashBOff + WRITESEQ5, WRITEDATA5);
381 write_flash(SecFlashBOff + WRITESEQ6, WRITEDATA6);
383 if (poll_toggle_bit(SecFlashBOff) < 0)
386 return FLASH_SUCCESS;
389 int erase_block_flash(int nBlock, unsigned long address)
391 long ulSectorOff = 0x0;
393 if ((nBlock < 0) || (nBlock > AFP_NumSectors))
396 ulSectorOff = (address - CFG_FLASH_BASE);
398 write_flash((WRITESEQ1 | ulSectorOff), WRITEDATA1);
399 write_flash((WRITESEQ2 | ulSectorOff), WRITEDATA2);
400 write_flash((WRITESEQ3 | ulSectorOff), WRITEDATA3);
401 write_flash((WRITESEQ4 | ulSectorOff), WRITEDATA4);
402 write_flash((WRITESEQ5 | ulSectorOff), WRITEDATA5);
404 write_flash(ulSectorOff, BlockEraseVal);
406 if (poll_toggle_bit(ulSectorOff) < 0)
409 return FLASH_SUCCESS;
412 void unlock_flash(long ulOffset)
414 unsigned long ulOffsetAddr = ulOffset;
415 ulOffsetAddr &= 0xFFFF0000;
417 write_flash((WRITESEQ1 | ulOffsetAddr), UNLOCKDATA1);
418 write_flash((WRITESEQ2 | ulOffsetAddr), UNLOCKDATA2);
419 write_flash((WRITESEQ3 | ulOffsetAddr), UNLOCKDATA3);
426 write_flash(WRITESEQ1, GETCODEDATA1);
427 write_flash(WRITESEQ2, GETCODEDATA2);
428 write_flash(WRITESEQ3, GETCODEDATA3);
430 read_flash(0x0002, &dev_id);
438 void get_sector_number(long ulOffset, int *pnSector)
442 if (ulOffset >= SecFlashAOff) {
443 if ((ulOffset < SecFlashASec1Off)
444 && (ulOffset < SecFlashASec2Off)) {
446 } else if ((ulOffset >= SecFlashASec2Off)
447 && (ulOffset < SecFlashASec3Off)) {
449 } else if ((ulOffset >= SecFlashASec3Off)
450 && (ulOffset < SecFlashASec4Off)) {
452 } else if ((ulOffset >= SecFlashASec4Off)
453 && (ulOffset < SecFlashAEndOff)) {
456 } else if (ulOffset >= SecFlashBOff) {
457 if ((ulOffset < SecFlashBSec1Off)
458 && (ulOffset < SecFlashBSec2Off)) {
461 if ((ulOffset < SecFlashBSec2Off)
462 && (ulOffset < SecFlashBSec3Off)) {
465 if ((ulOffset < SecFlashBSec3Off)
466 && (ulOffset < SecFlashBSec4Off)) {
469 if ((ulOffset < SecFlashBSec4Off)
470 && (ulOffset < SecFlashBEndOff)) {
473 } else if ((ulOffset >= PriFlashAOff) && (ulOffset < SecFlashAOff)) {
474 nSector = ulOffset & 0xffff0000;
475 nSector = ulOffset >> 16;
476 nSector = nSector & 0x000ff;
479 if ((nSector >= 0) && (nSector < AFP_NumSectors)) {