540 lines
13 KiB
C
540 lines
13 KiB
C
/*
|
|
*
|
|
* Copyright (c) 2004 Cucy Systems (http://www.cucy.com)
|
|
* Curt Brune <curt@cucy.com>
|
|
*
|
|
* See file CREDITS for list of people who contributed to this
|
|
* project.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of
|
|
* the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/hardware.h>
|
|
#include <flash.h>
|
|
|
|
flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS];
|
|
|
|
typedef enum {
|
|
FLASH_DEV_U9_512KB = 0,
|
|
FLASH_DEV_U7_2MB = 1
|
|
} FLASH_DEV;
|
|
|
|
#define FLASH_DQ7 (0x80)
|
|
#define FLASH_DQ5 (0x20)
|
|
|
|
#define PROG_ADDR (0xAAA)
|
|
#define SETUP_ADDR (0xAAA)
|
|
#define ID_ADDR (0xAAA)
|
|
#define UNLOCK_ADDR1 (0xAAA)
|
|
#define UNLOCK_ADDR2 (0x555)
|
|
|
|
#define UNLOCK_CMD1 (0xAA)
|
|
#define UNLOCK_CMD2 (0x55)
|
|
#define ERASE_SUSPEND_CMD (0xB0)
|
|
#define ERASE_RESUME_CMD (0x30)
|
|
#define RESET_CMD (0xF0)
|
|
#define ID_CMD (0x90)
|
|
#define SELECT_CMD (0x90)
|
|
#define CHIPERASE_CMD (0x10)
|
|
#define BYPASS_CMD (0x20)
|
|
#define SECERASE_CMD (0x30)
|
|
#define PROG_CMD (0xa0)
|
|
#define SETUP_CMD (0x80)
|
|
|
|
#if 0
|
|
#define WRITE_UNLOCK(addr) { \
|
|
PUT__U8( addr + UNLOCK_ADDR1, UNLOCK_CMD1); \
|
|
PUT__U8( addr + UNLOCK_ADDR2, UNLOCK_CMD2); \
|
|
}
|
|
|
|
/* auto select command */
|
|
#define CMD_ID(addr) WRITE_UNLOCK(addr); { \
|
|
PUT__U8( addr + ID_ADDR, ID_CMD); \
|
|
}
|
|
|
|
#define CMD_RESET(addr) WRITE_UNLOCK(addr); { \
|
|
PUT__U8( addr + ID_ADDR, RESET_CMD); \
|
|
}
|
|
|
|
#define CMD_ERASE_SEC(base, addr) WRITE_UNLOCK(base); \
|
|
PUT__U8( base + SETUP_ADDR, SETUP_CMD); \
|
|
WRITE_UNLOCK(base); \
|
|
PUT__U8( addr, SECERASE_CMD);
|
|
|
|
#define CMD_ERASE_CHIP(base) WRITE_UNLOCK(base); \
|
|
PUT__U8( base + SETUP_ADDR, SETUP_CMD); \
|
|
WRITE_UNLOCK(base); \
|
|
PUT__U8( base + SETUP_ADDR, CHIPERASE_CMD);
|
|
|
|
/* prepare for bypass programming */
|
|
#define CMD_UNLOCK_BYPASS(addr) WRITE_UNLOCK(addr); { \
|
|
PUT__U8( addr + ID_ADDR, 0x20); \
|
|
}
|
|
|
|
/* terminate bypass programming */
|
|
#define CMD_BYPASS_RESET(addr) { \
|
|
PUT__U8(addr, 0x90); \
|
|
PUT__U8(addr, 0x00); \
|
|
}
|
|
#endif
|
|
|
|
inline static void FLASH_CMD_UNLOCK (FLASH_DEV dev, u32 base)
|
|
{
|
|
switch (dev) {
|
|
case FLASH_DEV_U7_2MB:
|
|
PUT__U8 (base + 0xAAA, 0xAA);
|
|
PUT__U8 (base + 0x555, 0x55);
|
|
break;
|
|
case FLASH_DEV_U9_512KB:
|
|
PUT__U8 (base + 0x555, 0xAA);
|
|
PUT__U8 (base + 0x2AA, 0x55);
|
|
break;
|
|
}
|
|
}
|
|
|
|
inline static void FLASH_CMD_SELECT (FLASH_DEV dev, u32 base)
|
|
{
|
|
switch (dev) {
|
|
case FLASH_DEV_U7_2MB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0xAAA, SELECT_CMD);
|
|
break;
|
|
case FLASH_DEV_U9_512KB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0x555, SELECT_CMD);
|
|
break;
|
|
}
|
|
}
|
|
|
|
inline static void FLASH_CMD_RESET (FLASH_DEV dev, u32 base)
|
|
{
|
|
switch (dev) {
|
|
case FLASH_DEV_U7_2MB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0xAAA, RESET_CMD);
|
|
break;
|
|
case FLASH_DEV_U9_512KB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0x555, RESET_CMD);
|
|
break;
|
|
}
|
|
}
|
|
|
|
inline static void FLASH_CMD_ERASE_SEC (FLASH_DEV dev, u32 base, u32 addr)
|
|
{
|
|
switch (dev) {
|
|
case FLASH_DEV_U7_2MB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0xAAA, SETUP_CMD);
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (addr, SECERASE_CMD);
|
|
break;
|
|
case FLASH_DEV_U9_512KB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0x555, SETUP_CMD);
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (addr, SECERASE_CMD);
|
|
break;
|
|
}
|
|
}
|
|
|
|
inline static void FLASH_CMD_ERASE_CHIP (FLASH_DEV dev, u32 base)
|
|
{
|
|
switch (dev) {
|
|
case FLASH_DEV_U7_2MB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0xAAA, SETUP_CMD);
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base, CHIPERASE_CMD);
|
|
break;
|
|
case FLASH_DEV_U9_512KB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0x555, SETUP_CMD);
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base, CHIPERASE_CMD);
|
|
break;
|
|
}
|
|
}
|
|
|
|
inline static void FLASH_CMD_UNLOCK_BYPASS (FLASH_DEV dev, u32 base)
|
|
{
|
|
switch (dev) {
|
|
case FLASH_DEV_U7_2MB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0xAAA, BYPASS_CMD);
|
|
break;
|
|
case FLASH_DEV_U9_512KB:
|
|
FLASH_CMD_UNLOCK (dev, base);
|
|
PUT__U8 (base + 0x555, BYPASS_CMD);
|
|
break;
|
|
}
|
|
}
|
|
|
|
inline static void FLASH_CMD_BYPASS_RESET (FLASH_DEV dev, u32 base)
|
|
{
|
|
PUT__U8 (base, SELECT_CMD);
|
|
PUT__U8 (base, 0x0);
|
|
}
|
|
|
|
/* poll for flash command completion */
|
|
static u16 _flash_poll (FLASH_DEV dev, u32 addr, u16 data, ulong timeOut)
|
|
{
|
|
u32 done = 0;
|
|
ulong t0;
|
|
|
|
u16 error = 0;
|
|
volatile u16 flashData;
|
|
|
|
data = data & 0xFF;
|
|
t0 = get_timer (0);
|
|
while (get_timer (t0) < timeOut) {
|
|
/* for( i = 0; i < POLL_LOOPS; i++) { */
|
|
/* Read the Data */
|
|
flashData = GET__U8 (addr);
|
|
|
|
/* FLASH_DQ7 = Data? */
|
|
if ((flashData & FLASH_DQ7) == (data & FLASH_DQ7)) {
|
|
done = 1;
|
|
break;
|
|
}
|
|
|
|
/* Check Timeout (FLASH_DQ5==1) */
|
|
if (flashData & FLASH_DQ5) {
|
|
/* Read the Data */
|
|
flashData = GET__U8 (addr);
|
|
|
|
/* FLASH_DQ7 = Data? */
|
|
if (!((flashData & FLASH_DQ7) == (data & FLASH_DQ7))) {
|
|
printf ("_flash_poll(): FLASH_DQ7 & flashData not equal to write value\n");
|
|
error = ERR_PROG_ERROR;
|
|
}
|
|
FLASH_CMD_RESET (dev, addr);
|
|
done = 1;
|
|
break;
|
|
}
|
|
/* spin delay */
|
|
udelay (10);
|
|
}
|
|
|
|
|
|
/* error update */
|
|
if (!done) {
|
|
printf ("_flash_poll(): Timeout\n");
|
|
error = ERR_TIMOUT;
|
|
}
|
|
|
|
/* Check the data */
|
|
if (!error) {
|
|
/* Read the Data */
|
|
flashData = GET__U8 (addr);
|
|
if (flashData != data) {
|
|
error = ERR_PROG_ERROR;
|
|
printf ("_flash_poll(): flashData(0x%04x) not equal to data(0x%04x)\n",
|
|
flashData, data);
|
|
}
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
*/
|
|
static int _flash_check_protection (flash_info_t * info, int s_first, int s_last)
|
|
{
|
|
int sect, prot = 0;
|
|
|
|
for (sect = s_first; sect <= s_last; sect++)
|
|
if (info->protect[sect]) {
|
|
printf (" Flash sector %d protected.\n", sect);
|
|
prot++;
|
|
}
|
|
return prot;
|
|
}
|
|
|
|
static int _detectFlash (FLASH_DEV dev, u32 base, u8 venId, u8 devId)
|
|
{
|
|
|
|
u32 baseAddr = base | CACHE_DISABLE_MASK;
|
|
u8 vendorId, deviceId;
|
|
|
|
/* printf(__FUNCTION__"(): detecting flash @ 0x%08x\n", base); */
|
|
|
|
/* Send auto select command and read manufacturer info */
|
|
FLASH_CMD_SELECT (dev, baseAddr);
|
|
vendorId = GET__U8 (baseAddr);
|
|
FLASH_CMD_RESET (dev, baseAddr);
|
|
|
|
/* Send auto select command and read device info */
|
|
FLASH_CMD_SELECT (dev, baseAddr);
|
|
|
|
if (dev == FLASH_DEV_U7_2MB) {
|
|
deviceId = GET__U8 (baseAddr + 2);
|
|
} else if (dev == FLASH_DEV_U9_512KB) {
|
|
deviceId = GET__U8 (baseAddr + 1);
|
|
} else {
|
|
return 0;
|
|
}
|
|
|
|
FLASH_CMD_RESET (dev, baseAddr);
|
|
|
|
/* printf (__FUNCTION__"(): found vendorId 0x%04x, deviceId 0x%04x\n",
|
|
vendorId, deviceId);
|
|
*/
|
|
|
|
return (vendorId == venId) && (deviceId == devId);
|
|
|
|
}
|
|
|
|
/******************************************************************************
|
|
*
|
|
* Public u-boot interface functions below
|
|
*
|
|
*****************************************************************************/
|
|
|
|
/***************************************************************************
|
|
*
|
|
* Flash initialization
|
|
*
|
|
* This board has two banks of flash, but the base addresses depend on
|
|
* how the board is jumpered.
|
|
*
|
|
* The two flash types are:
|
|
*
|
|
* AMD Am29LV160DB (2MB) sectors layout 16KB, 2x8KB, 32KB, 31x64KB
|
|
*
|
|
* AMD Am29LV040B (512KB) sectors: 8x64KB
|
|
*****************************************************************************/
|
|
|
|
unsigned long flash_init (void)
|
|
{
|
|
flash_info_t *info;
|
|
u16 i;
|
|
u32 flashtest;
|
|
s16 amd160 = -1;
|
|
u32 amd160base = 0;
|
|
|
|
#if CONFIG_SYS_MAX_FLASH_BANKS == 2
|
|
s16 amd040 = -1;
|
|
u32 amd040base = 0;
|
|
#endif
|
|
|
|
/* configure PHYS_FLASH_1 */
|
|
if (_detectFlash (FLASH_DEV_U7_2MB, PHYS_FLASH_1, 0x1, 0x49)) {
|
|
amd160 = 0;
|
|
amd160base = PHYS_FLASH_1;
|
|
#if CONFIG_SYS_MAX_FLASH_BANKS == 1
|
|
}
|
|
#else
|
|
if (_detectFlash
|
|
(FLASH_DEV_U9_512KB, PHYS_FLASH_2, 0x1, 0x4F)) {
|
|
amd040 = 1;
|
|
amd040base = PHYS_FLASH_2;
|
|
} else {
|
|
printf (__FUNCTION__
|
|
"(): Unable to detect PHYS_FLASH_2: 0x%08x\n",
|
|
PHYS_FLASH_2);
|
|
}
|
|
} else if (_detectFlash (FLASH_DEV_U9_512KB, PHYS_FLASH_1, 0x1, 0x4F)) {
|
|
amd040 = 0;
|
|
amd040base = PHYS_FLASH_1;
|
|
if (_detectFlash (FLASH_DEV_U7_2MB, PHYS_FLASH_2, 0x1, 0x49)) {
|
|
amd160 = 1;
|
|
amd160base = PHYS_FLASH_2;
|
|
} else {
|
|
printf (__FUNCTION__
|
|
"(): Unable to detect PHYS_FLASH_2: 0x%08x\n",
|
|
PHYS_FLASH_2);
|
|
}
|
|
}
|
|
#endif
|
|
else {
|
|
printf ("flash_init(): Unable to detect PHYS_FLASH_1: 0x%08x\n",
|
|
PHYS_FLASH_1);
|
|
}
|
|
|
|
/* Configure AMD Am29LV160DB (2MB) */
|
|
info = &flash_info[amd160];
|
|
info->flash_id = FLASH_DEV_U7_2MB;
|
|
info->sector_count = 35;
|
|
info->size = 2 * 1024 * 1024; /* 2MB */
|
|
/* 1*16K Boot Block
|
|
2*8K Parameter Block
|
|
1*32K Small Main Block */
|
|
info->start[0] = amd160base;
|
|
info->start[1] = amd160base + 0x4000;
|
|
info->start[2] = amd160base + 0x6000;
|
|
info->start[3] = amd160base + 0x8000;
|
|
for (i = 1; i < info->sector_count; i++)
|
|
info->start[3 + i] = amd160base + i * (64 * 1024);
|
|
|
|
for (i = 0; i < info->sector_count; i++) {
|
|
/* Write auto select command sequence and query sector protection */
|
|
FLASH_CMD_SELECT (info->flash_id,
|
|
info->start[i] | CACHE_DISABLE_MASK);
|
|
flashtest =
|
|
GET__U8 (((info->start[i] + 4) | CACHE_DISABLE_MASK));
|
|
FLASH_CMD_RESET (info->flash_id,
|
|
amd160base | CACHE_DISABLE_MASK);
|
|
info->protect[i] = (flashtest & 0x0001);
|
|
}
|
|
|
|
/*
|
|
* protect monitor and environment sectors in 2MB flash
|
|
*/
|
|
flash_protect (FLAG_PROTECT_SET,
|
|
amd160base, amd160base + monitor_flash_len - 1, info);
|
|
|
|
flash_protect (FLAG_PROTECT_SET,
|
|
CONFIG_ENV_ADDR, CONFIG_ENV_ADDR + CONFIG_ENV_SIZE - 1, info);
|
|
|
|
#if CONFIG_SYS_MAX_FLASH_BANKS == 2
|
|
/* Configure AMD Am29LV040B (512KB) */
|
|
info = &flash_info[amd040];
|
|
info->flash_id = FLASH_DEV_U9_512KB;
|
|
info->sector_count = 8;
|
|
info->size = 512 * 1024; /* 512KB, 8 x 64KB */
|
|
for (i = 0; i < info->sector_count; i++) {
|
|
info->start[i] = amd040base + i * (64 * 1024);
|
|
/* Write auto select command sequence and query sector protection */
|
|
FLASH_CMD_SELECT (info->flash_id,
|
|
info->start[i] | CACHE_DISABLE_MASK);
|
|
flashtest =
|
|
GET__U8 (((info->start[i] + 2) | CACHE_DISABLE_MASK));
|
|
FLASH_CMD_RESET (info->flash_id,
|
|
amd040base | CACHE_DISABLE_MASK);
|
|
info->protect[i] = (flashtest & 0x0001);
|
|
}
|
|
#endif
|
|
|
|
return flash_info[0].size
|
|
#if CONFIG_SYS_MAX_FLASH_BANKS == 2
|
|
+ flash_info[1].size
|
|
#endif
|
|
;
|
|
}
|
|
|
|
void flash_print_info (flash_info_t * info)
|
|
{
|
|
int i;
|
|
|
|
if (info->flash_id == FLASH_DEV_U7_2MB) {
|
|
printf ("AMD Am29LV160DB (2MB) 16KB,2x8KB,32KB,31x64KB\n");
|
|
} else if (info->flash_id == FLASH_DEV_U9_512KB) {
|
|
printf ("AMD Am29LV040B (512KB) 8x64KB\n");
|
|
} else {
|
|
printf ("Unknown flash_id ...\n");
|
|
return;
|
|
}
|
|
|
|
printf (" Size: %ld KB in %d Sectors\n",
|
|
info->size >> 10, info->sector_count);
|
|
printf (" Sector Start Addresses:");
|
|
for (i = 0; i < info->sector_count; i++) {
|
|
if ((i % 4) == 0)
|
|
printf ("\n ");
|
|
printf (" S%02d @ 0x%08lX%s", i,
|
|
info->start[i], info->protect[i] ? " !" : " ");
|
|
}
|
|
printf ("\n");
|
|
}
|
|
|
|
int flash_erase (flash_info_t * info, int s_first, int s_last)
|
|
{
|
|
u16 i, error = 0;
|
|
|
|
printf ("\n");
|
|
|
|
/* check flash protection bits */
|
|
if (_flash_check_protection (info, s_first, s_last)) {
|
|
printf (" Flash erase aborted due to protected sectors\n");
|
|
return ERR_PROTECTED;
|
|
}
|
|
|
|
if ((s_first < info->sector_count) && (s_first <= s_last)) {
|
|
for (i = s_first; i <= s_last && !error; i++) {
|
|
printf (" Erasing Sector %d @ 0x%08lx ... ", i,
|
|
info->start[i]);
|
|
/* bypass the cache to access the flash memory */
|
|
FLASH_CMD_ERASE_SEC (info->flash_id,
|
|
(info->
|
|
start[0] | CACHE_DISABLE_MASK),
|
|
(info->
|
|
start[i] | CACHE_DISABLE_MASK));
|
|
/* look for sector to become 0xFF after erase */
|
|
error = _flash_poll (info->flash_id,
|
|
info->
|
|
start[i] | CACHE_DISABLE_MASK,
|
|
0xFF, CONFIG_SYS_FLASH_ERASE_TOUT);
|
|
FLASH_CMD_RESET (info->flash_id,
|
|
(info->
|
|
start[0] | CACHE_DISABLE_MASK));
|
|
printf ("done\n");
|
|
if (error) {
|
|
break;
|
|
}
|
|
}
|
|
} else
|
|
error = ERR_INVAL;
|
|
|
|
return error;
|
|
}
|
|
|
|
int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt)
|
|
{
|
|
u16 error = 0, i;
|
|
u32 n;
|
|
u8 *bp, *bps;
|
|
|
|
/* Write Setup */
|
|
/* bypass the cache to access the flash memory */
|
|
FLASH_CMD_UNLOCK_BYPASS (info->flash_id,
|
|
(info->start[0] | CACHE_DISABLE_MASK));
|
|
|
|
/* Write the Data to Flash */
|
|
|
|
bp = (u8 *) (addr | CACHE_DISABLE_MASK);
|
|
bps = (u8 *) src;
|
|
|
|
for (n = 0; n < cnt && !error; n++, bp++, bps++) {
|
|
|
|
if (!(n % (cnt / 15))) {
|
|
printf (".");
|
|
}
|
|
|
|
/* write the flash command for flash memory */
|
|
*bp = 0xA0;
|
|
|
|
/* Write the data */
|
|
*bp = *bps;
|
|
|
|
/* Check if the write is done */
|
|
for (i = 0; i < 0xff; i++);
|
|
error = _flash_poll (info->flash_id, (u32) bp, *bps,
|
|
CONFIG_SYS_FLASH_WRITE_TOUT);
|
|
if (error) {
|
|
return error;
|
|
}
|
|
}
|
|
|
|
/* Reset the Flash Mode to read */
|
|
FLASH_CMD_BYPASS_RESET (info->flash_id, info->start[0]);
|
|
|
|
printf (" ");
|
|
|
|
return error;
|
|
}
|