474 lines
11 KiB
C
474 lines
11 KiB
C
/*
|
|
* U-Boot - flash.c Flash driver for PSD4256GV
|
|
*
|
|
* Copyright (c) 2005-2007 Analog Devices Inc.
|
|
* This file is based on BF533EzFlash.c originally written by Analog Devices, Inc.
|
|
*
|
|
* (C) Copyright 2000-2004
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <asm/io.h>
|
|
#include "flash-defines.h"
|
|
|
|
int AFP_NumSectors = 40;
|
|
long AFP_SectorSize1 = 0x10000;
|
|
int AFP_SectorSize2 = 0x4000;
|
|
|
|
void flash_reset(void)
|
|
{
|
|
reset_flash();
|
|
}
|
|
|
|
unsigned long flash_get_size(ulong baseaddr, flash_info_t * info, int bank_flag)
|
|
{
|
|
int id = 0, i = 0;
|
|
static int FlagDev = 1;
|
|
|
|
id = get_codes();
|
|
if (FlagDev) {
|
|
#ifdef DEBUG
|
|
printf("Device ID of the Flash is %x\n", id);
|
|
#endif
|
|
FlagDev = 0;
|
|
}
|
|
info->flash_id = id;
|
|
|
|
switch (bank_flag) {
|
|
case 0:
|
|
for (i = PriFlashABegin; i < SecFlashABegin; i++)
|
|
info->start[i] = (baseaddr + (i * AFP_SectorSize1));
|
|
info->size = 0x200000;
|
|
info->sector_count = 32;
|
|
break;
|
|
case 1:
|
|
info->start[0] = baseaddr + SecFlashASec1Off;
|
|
info->start[1] = baseaddr + SecFlashASec2Off;
|
|
info->start[2] = baseaddr + SecFlashASec3Off;
|
|
info->start[3] = baseaddr + SecFlashASec4Off;
|
|
info->size = 0x10000;
|
|
info->sector_count = 4;
|
|
break;
|
|
case 2:
|
|
info->start[0] = baseaddr + SecFlashBSec1Off;
|
|
info->start[1] = baseaddr + SecFlashBSec2Off;
|
|
info->start[2] = baseaddr + SecFlashBSec3Off;
|
|
info->start[3] = baseaddr + SecFlashBSec4Off;
|
|
info->size = 0x10000;
|
|
info->sector_count = 4;
|
|
break;
|
|
}
|
|
return (info->size);
|
|
}
|
|
|
|
unsigned long flash_init(void)
|
|
{
|
|
unsigned long size_b0, size_b1, size_b2;
|
|
int i;
|
|
|
|
size_b0 = size_b1 = size_b2 = 0;
|
|
#ifdef DEBUG
|
|
printf("Flash Memory Start 0x%x\n", CONFIG_SYS_FLASH_BASE);
|
|
printf("Memory Map for the Flash\n");
|
|
printf("0x20000000 - 0x200FFFFF Flash A Primary (1MB)\n");
|
|
printf("0x20100000 - 0x201FFFFF Flash B Primary (1MB)\n");
|
|
printf("0x20200000 - 0x2020FFFF Flash A Secondary (64KB)\n");
|
|
printf("0x20280000 - 0x2028FFFF Flash B Secondary (64KB)\n");
|
|
printf("Please type command flinfo for information on Sectors \n");
|
|
#endif
|
|
for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; ++i) {
|
|
flash_info[i].flash_id = FLASH_UNKNOWN;
|
|
}
|
|
|
|
size_b0 = flash_get_size(CONFIG_SYS_FLASH0_BASE, &flash_info[0], 0);
|
|
size_b1 = flash_get_size(CONFIG_SYS_FLASH0_BASE, &flash_info[1], 1);
|
|
size_b2 = flash_get_size(CONFIG_SYS_FLASH0_BASE, &flash_info[2], 2);
|
|
|
|
if (flash_info[0].flash_id == FLASH_UNKNOWN || size_b0 == 0) {
|
|
printf("## Unknown FLASH on Bank 0 - Size = 0x%08lx = %ld MB\n",
|
|
size_b0, size_b0 >> 20);
|
|
}
|
|
|
|
(void)flash_protect(FLAG_PROTECT_SET, CONFIG_SYS_FLASH0_BASE,
|
|
(flash_info[0].start[2] - 1), &flash_info[0]);
|
|
|
|
return (size_b0 + size_b1 + size_b2);
|
|
}
|
|
|
|
void flash_print_info(flash_info_t * info)
|
|
{
|
|
int i;
|
|
|
|
if (info->flash_id == FLASH_UNKNOWN) {
|
|
printf("missing or unknown FLASH type\n");
|
|
return;
|
|
}
|
|
|
|
switch (info->flash_id) {
|
|
case FLASH_PSD4256GV:
|
|
printf("ST Microelectronics ");
|
|
break;
|
|
default:
|
|
printf("Unknown Vendor: (0x%08lX) ", info->flash_id);
|
|
break;
|
|
}
|
|
for (i = 0; i < info->sector_count; ++i) {
|
|
if ((i % 5) == 0)
|
|
printf("\n ");
|
|
printf(" %08lX%s",
|
|
info->start[i], info->protect[i] ? " (RO)" : " ");
|
|
}
|
|
printf("\n");
|
|
return;
|
|
}
|
|
|
|
int flash_erase(flash_info_t * info, int s_first, int s_last)
|
|
{
|
|
int cnt = 0, i;
|
|
int prot, sect;
|
|
|
|
prot = 0;
|
|
for (sect = s_first; sect <= s_last; ++sect) {
|
|
if (info->protect[sect])
|
|
prot++;
|
|
}
|
|
|
|
if (prot)
|
|
printf("- Warning: %d protected sectors will not be erased!\n",
|
|
prot);
|
|
else
|
|
printf("\n");
|
|
|
|
cnt = s_last - s_first + 1;
|
|
|
|
if (cnt == FLASH_TOT_SECT) {
|
|
printf("Erasing flash, Please Wait \n");
|
|
if (erase_flash() < 0) {
|
|
printf("Erasing flash failed \n");
|
|
return FLASH_FAIL;
|
|
}
|
|
} else {
|
|
printf("Erasing Flash locations, Please Wait\n");
|
|
for (i = s_first; i <= s_last; i++) {
|
|
if (info->protect[i] == 0) { /* not protected */
|
|
if (erase_block_flash(i, info->start[i]) < 0) {
|
|
printf("Error Sector erasing \n");
|
|
return FLASH_FAIL;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return FLASH_SUCCESS;
|
|
}
|
|
|
|
int write_buff(flash_info_t * info, uchar * src, ulong addr, ulong cnt)
|
|
{
|
|
int ret;
|
|
int d;
|
|
if (addr % 2) {
|
|
read_flash(addr - 1 - CONFIG_SYS_FLASH_BASE, &d);
|
|
d = (int)((d & 0x00FF) | (*src++ << 8));
|
|
ret = write_data(addr - 1, 2, (uchar *) & d);
|
|
if (ret == FLASH_FAIL)
|
|
return ERR_NOT_ERASED;
|
|
ret = write_data(addr + 1, cnt - 1, src);
|
|
} else
|
|
ret = write_data(addr, cnt, src);
|
|
if (ret == FLASH_FAIL)
|
|
return ERR_NOT_ERASED;
|
|
return FLASH_SUCCESS;
|
|
}
|
|
|
|
int write_data(long lStart, long lCount, uchar * pnData)
|
|
{
|
|
long i = 0;
|
|
unsigned long ulOffset = lStart - CONFIG_SYS_FLASH_BASE;
|
|
int d;
|
|
int nSector = 0;
|
|
int flag = 0;
|
|
|
|
if (lCount % 2) {
|
|
flag = 1;
|
|
lCount = lCount - 1;
|
|
}
|
|
|
|
for (i = 0; i < lCount - 1; i += 2, ulOffset += 2) {
|
|
get_sector_number(ulOffset, &nSector);
|
|
read_flash(ulOffset, &d);
|
|
if (d != 0xffff) {
|
|
printf
|
|
("Flash not erased at offset 0x%lx Please erase to reprogram\n",
|
|
ulOffset);
|
|
return FLASH_FAIL;
|
|
}
|
|
unlock_flash(ulOffset);
|
|
d = (int)(pnData[i] | pnData[i + 1] << 8);
|
|
write_flash(ulOffset, d);
|
|
if (poll_toggle_bit(ulOffset) < 0) {
|
|
printf("Error programming the flash \n");
|
|
return FLASH_FAIL;
|
|
}
|
|
if ((i > 0) && (!(i % AFP_SectorSize2)))
|
|
printf(".");
|
|
}
|
|
if (flag) {
|
|
get_sector_number(ulOffset, &nSector);
|
|
read_flash(ulOffset, &d);
|
|
if (d != 0xffff) {
|
|
printf
|
|
("Flash not erased at offset 0x%lx Please erase to reprogram\n",
|
|
ulOffset);
|
|
return FLASH_FAIL;
|
|
}
|
|
unlock_flash(ulOffset);
|
|
d = (int)(pnData[i] | (d & 0xFF00));
|
|
write_flash(ulOffset, d);
|
|
if (poll_toggle_bit(ulOffset) < 0) {
|
|
printf("Error programming the flash \n");
|
|
return FLASH_FAIL;
|
|
}
|
|
}
|
|
return FLASH_SUCCESS;
|
|
}
|
|
|
|
int read_data(long ulStart, long lCount, long lStride, int *pnData)
|
|
{
|
|
long i = 0;
|
|
int j = 0;
|
|
long ulOffset = ulStart;
|
|
int iShift = 0;
|
|
int iNumWords = 2;
|
|
int nLeftover = lCount % 4;
|
|
int nHi, nLow;
|
|
int nSector = 0;
|
|
|
|
for (i = 0; (i < lCount / 4) && (i < BUFFER_SIZE); i++) {
|
|
for (iShift = 0, j = 0; j < iNumWords; j += 2) {
|
|
if ((ulOffset >= INVALIDLOCNSTART)
|
|
&& (ulOffset < INVALIDLOCNEND))
|
|
return FLASH_FAIL;
|
|
|
|
get_sector_number(ulOffset, &nSector);
|
|
read_flash(ulOffset, &nLow);
|
|
ulOffset += (lStride * 2);
|
|
read_flash(ulOffset, &nHi);
|
|
ulOffset += (lStride * 2);
|
|
pnData[i] = (nHi << 16) | nLow;
|
|
}
|
|
}
|
|
if (nLeftover > 0) {
|
|
if ((ulOffset >= INVALIDLOCNSTART)
|
|
&& (ulOffset < INVALIDLOCNEND))
|
|
return FLASH_FAIL;
|
|
|
|
get_sector_number(ulOffset, &nSector);
|
|
read_flash(ulOffset, &pnData[i]);
|
|
}
|
|
return FLASH_SUCCESS;
|
|
}
|
|
|
|
int write_flash(long nOffset, int nValue)
|
|
{
|
|
long addr;
|
|
|
|
addr = (CONFIG_SYS_FLASH_BASE + nOffset);
|
|
SSYNC();
|
|
*(unsigned volatile short *)addr = nValue;
|
|
SSYNC();
|
|
if (poll_toggle_bit(nOffset) < 0)
|
|
return FLASH_FAIL;
|
|
return FLASH_SUCCESS;
|
|
}
|
|
|
|
int read_flash(long nOffset, int *pnValue)
|
|
{
|
|
int nValue = 0x0;
|
|
long addr = (CONFIG_SYS_FLASH_BASE + nOffset);
|
|
|
|
if (nOffset != 0x2)
|
|
reset_flash();
|
|
SSYNC();
|
|
nValue = *(volatile unsigned short *)addr;
|
|
SSYNC();
|
|
*pnValue = nValue;
|
|
return true;
|
|
}
|
|
|
|
int poll_toggle_bit(long lOffset)
|
|
{
|
|
unsigned int u1, u2;
|
|
unsigned long timeout = 0xFFFFFFFF;
|
|
volatile unsigned long *FB =
|
|
(volatile unsigned long *)(0x20000000 + lOffset);
|
|
while (1) {
|
|
if (timeout < 0)
|
|
break;
|
|
u1 = *(volatile unsigned short *)FB;
|
|
u2 = *(volatile unsigned short *)FB;
|
|
if ((u1 & 0x0040) == (u2 & 0x0040))
|
|
return FLASH_SUCCESS;
|
|
if ((u2 & 0x0020) == 0x0000)
|
|
continue;
|
|
u1 = *(volatile unsigned short *)FB;
|
|
if ((u2 & 0x0040) == (u1 & 0x0040))
|
|
return FLASH_SUCCESS;
|
|
else {
|
|
reset_flash();
|
|
return FLASH_FAIL;
|
|
}
|
|
timeout--;
|
|
}
|
|
printf("Time out occurred \n");
|
|
if (timeout < 0)
|
|
return FLASH_FAIL;
|
|
}
|
|
|
|
void reset_flash(void)
|
|
{
|
|
write_flash(WRITESEQ1, RESET_VAL);
|
|
/* Wait for 10 micro seconds */
|
|
udelay(10);
|
|
}
|
|
|
|
int erase_flash(void)
|
|
{
|
|
write_flash(WRITESEQ1, WRITEDATA1);
|
|
write_flash(WRITESEQ2, WRITEDATA2);
|
|
write_flash(WRITESEQ3, WRITEDATA3);
|
|
write_flash(WRITESEQ4, WRITEDATA4);
|
|
write_flash(WRITESEQ5, WRITEDATA5);
|
|
write_flash(WRITESEQ6, WRITEDATA6);
|
|
|
|
if (poll_toggle_bit(0x0000) < 0)
|
|
return FLASH_FAIL;
|
|
|
|
write_flash(SecFlashAOff + WRITESEQ1, WRITEDATA1);
|
|
write_flash(SecFlashAOff + WRITESEQ2, WRITEDATA2);
|
|
write_flash(SecFlashAOff + WRITESEQ3, WRITEDATA3);
|
|
write_flash(SecFlashAOff + WRITESEQ4, WRITEDATA4);
|
|
write_flash(SecFlashAOff + WRITESEQ5, WRITEDATA5);
|
|
write_flash(SecFlashAOff + WRITESEQ6, WRITEDATA6);
|
|
|
|
if (poll_toggle_bit(SecFlashASec1Off) < 0)
|
|
return FLASH_FAIL;
|
|
|
|
write_flash(PriFlashBOff + WRITESEQ1, WRITEDATA1);
|
|
write_flash(PriFlashBOff + WRITESEQ2, WRITEDATA2);
|
|
write_flash(PriFlashBOff + WRITESEQ3, WRITEDATA3);
|
|
write_flash(PriFlashBOff + WRITESEQ4, WRITEDATA4);
|
|
write_flash(PriFlashBOff + WRITESEQ5, WRITEDATA5);
|
|
write_flash(PriFlashBOff + WRITESEQ6, WRITEDATA6);
|
|
|
|
if (poll_toggle_bit(PriFlashBOff) < 0)
|
|
return FLASH_FAIL;
|
|
|
|
write_flash(SecFlashBOff + WRITESEQ1, WRITEDATA1);
|
|
write_flash(SecFlashBOff + WRITESEQ2, WRITEDATA2);
|
|
write_flash(SecFlashBOff + WRITESEQ3, WRITEDATA3);
|
|
write_flash(SecFlashBOff + WRITESEQ4, WRITEDATA4);
|
|
write_flash(SecFlashBOff + WRITESEQ5, WRITEDATA5);
|
|
write_flash(SecFlashBOff + WRITESEQ6, WRITEDATA6);
|
|
|
|
if (poll_toggle_bit(SecFlashBOff) < 0)
|
|
return FLASH_FAIL;
|
|
|
|
return FLASH_SUCCESS;
|
|
}
|
|
|
|
int erase_block_flash(int nBlock, unsigned long address)
|
|
{
|
|
long ulSectorOff = 0x0;
|
|
|
|
if ((nBlock < 0) || (nBlock > AFP_NumSectors))
|
|
return false;
|
|
|
|
ulSectorOff = (address - CONFIG_SYS_FLASH_BASE);
|
|
|
|
write_flash((WRITESEQ1 | ulSectorOff), WRITEDATA1);
|
|
write_flash((WRITESEQ2 | ulSectorOff), WRITEDATA2);
|
|
write_flash((WRITESEQ3 | ulSectorOff), WRITEDATA3);
|
|
write_flash((WRITESEQ4 | ulSectorOff), WRITEDATA4);
|
|
write_flash((WRITESEQ5 | ulSectorOff), WRITEDATA5);
|
|
|
|
write_flash(ulSectorOff, BlockEraseVal);
|
|
|
|
if (poll_toggle_bit(ulSectorOff) < 0)
|
|
return FLASH_FAIL;
|
|
|
|
return FLASH_SUCCESS;
|
|
}
|
|
|
|
void unlock_flash(long ulOffset)
|
|
{
|
|
unsigned long ulOffsetAddr = ulOffset;
|
|
ulOffsetAddr &= 0xFFFF0000;
|
|
|
|
write_flash((WRITESEQ1 | ulOffsetAddr), UNLOCKDATA1);
|
|
write_flash((WRITESEQ2 | ulOffsetAddr), UNLOCKDATA2);
|
|
write_flash((WRITESEQ3 | ulOffsetAddr), UNLOCKDATA3);
|
|
}
|
|
|
|
int get_codes()
|
|
{
|
|
int dev_id = 0;
|
|
|
|
write_flash(WRITESEQ1, GETCODEDATA1);
|
|
write_flash(WRITESEQ2, GETCODEDATA2);
|
|
write_flash(WRITESEQ3, GETCODEDATA3);
|
|
|
|
read_flash(0x0002, &dev_id);
|
|
dev_id &= 0x00FF;
|
|
|
|
reset_flash();
|
|
|
|
return dev_id;
|
|
}
|
|
|
|
void get_sector_number(long ulOffset, int *pnSector)
|
|
{
|
|
int nSector = 0;
|
|
|
|
if (ulOffset >= SecFlashAOff) {
|
|
if ((ulOffset < SecFlashASec1Off)
|
|
&& (ulOffset < SecFlashASec2Off)) {
|
|
nSector = SECT32;
|
|
} else if ((ulOffset >= SecFlashASec2Off)
|
|
&& (ulOffset < SecFlashASec3Off)) {
|
|
nSector = SECT33;
|
|
} else if ((ulOffset >= SecFlashASec3Off)
|
|
&& (ulOffset < SecFlashASec4Off)) {
|
|
nSector = SECT34;
|
|
} else if ((ulOffset >= SecFlashASec4Off)
|
|
&& (ulOffset < SecFlashAEndOff)) {
|
|
nSector = SECT35;
|
|
}
|
|
} else if (ulOffset >= SecFlashBOff) {
|
|
if ((ulOffset < SecFlashBSec1Off)
|
|
&& (ulOffset < SecFlashBSec2Off)) {
|
|
nSector = SECT36;
|
|
}
|
|
if ((ulOffset < SecFlashBSec2Off)
|
|
&& (ulOffset < SecFlashBSec3Off)) {
|
|
nSector = SECT37;
|
|
}
|
|
if ((ulOffset < SecFlashBSec3Off)
|
|
&& (ulOffset < SecFlashBSec4Off)) {
|
|
nSector = SECT38;
|
|
}
|
|
if ((ulOffset < SecFlashBSec4Off)
|
|
&& (ulOffset < SecFlashBEndOff)) {
|
|
nSector = SECT39;
|
|
}
|
|
} else if ((ulOffset >= PriFlashAOff) && (ulOffset < SecFlashAOff)) {
|
|
nSector = ulOffset & 0xffff0000;
|
|
nSector = ulOffset >> 16;
|
|
nSector = nSector & 0x000ff;
|
|
}
|
|
|
|
if ((nSector >= 0) && (nSector < AFP_NumSectors)) {
|
|
*pnSector = nSector;
|
|
}
|
|
}
|