📄 sst39vf160.c
字号:
/****************************************************************************
【文 件 名 称】SST39VF160.c
【功 能 描 述】FS2410XP教学平台实验程序
【程 序 版 本】3.0
【创建及创建日期】优龙公司/2005-XX-XX
【修改及修改日期】2005-5-23
****************************************************************************/
//头文件定义
#include "config.h"
#include "board.h"
#ifdef SST39VF160_SUPPORT
//#define ROM_BASE 0x10000000 //地址重定向到0x10000000
#define CMD_ADDR0 *((volatile U16 *)(0x5555*2+ROM_BASE))
#define CMD_ADDR1 *((volatile U16 *)(0x2aaa*2+ROM_BASE))
#define CHECK_DELAY 100000
#define NorFlashRead(dst, src, size) memcpy((char *)(dst), (char *)(ROM_BASE+(src)), (int)(size))
static U16 state;
static U16 support;
static U32 chip_id;
void outportw(U16, U32);
U16 inportw(U32);
/********************************************************************
Function name: CFIQueryExit
Parameter : void
Description : CFI查询退出
Return : void
Argument :
Autor & date :
*********************************************************************/
static void CFIQueryExit(void)
{
outportw(0xaaaa, ROM_BASE+0xaaaa);//CMD_ADDR0 = 0xaaaa;
outportw(0x5555, ROM_BASE+0x5554);//CMD_ADDR1 = 0x5555;
outportw(0xf0f0, ROM_BASE+0xaaaa);//CMD_ADDR0 = 0xf0f0;
state &= 0xfc;
}
/********************************************************************
Function name: SWPIDExit
Parameter : void
Description : 软件ID的退出
Return : void
Argument :
Autor & date :
*********************************************************************/
static void SWPIDExit(void)
{
outportw(0xf0f0, ROM_BASE+0xaaaa);//CMD_ADDR0 = 0xf0f0;
state &= 0xfc;
}
/********************************************************************
Function name: SWPIDEntry
Parameter : void
Description : 软件ID的入口
Return : void
Argument :
Autor & date :
*********************************************************************/
static void SWPIDEntry(void)
{
if(state&1)
{
if(state&2)
return;
else
CFIQueryExit();
}
outportw(0xaaaa, ROM_BASE+0xaaaa);//CMD_ADDR0 = 0xaaaa;
outportw(0x5555, ROM_BASE+0x5554);//CMD_ADDR1 = 0x5555;
outportw(0x9090, ROM_BASE+0xaaaa);//CMD_ADDR0 = 0x9090;
state |= 3;
}
/********************************************************************
Function name: GetFlashID
Parameter : void
Description : 读取Nor Flash的ID号
Return : 返回Nor Flash的ID号
Argument :
Autor & date :
*********************************************************************/
static U32 GetFlashID(void)
{
U32 i;
SWPIDEntry();
//i = *(U16 *)(0x0+ROM_BASE);
//i |= (*(U16 *)(2+ROM_BASE))<<16;
i = inportw(ROM_BASE);
i |= inportw(ROM_BASE+2)<<16;
SWPIDExit();
return i;
}
/********************************************************************
Function name: SectorErase
Parameter : sector : 要擦除的扇区地址
Description : 擦除sector地址的扇区
Return : 返回0或非0数值
Argument : 返回0:烧写成功 返回非0:烧写不成功
Autor & date :
*********************************************************************/
static int SectorErase(U32 sector)
{
U32 tm, d1 ,d2;
if(state&1) {
if(state&2)
SWPIDExit();
else
CFIQueryExit();
}
sector += ROM_BASE;
outportw(0xaaaa, ROM_BASE+0xaaaa);
outportw(0x5555, ROM_BASE+0x5554);
outportw(0x8080, ROM_BASE+0xaaaa);
outportw(0xaaaa, ROM_BASE+0xaaaa);
outportw(0x5555, ROM_BASE+0x5554);
outportw(0x3030, sector);
d2 = inportw(sector);
tm = CHECK_DELAY;
while(1) {
tm--;
if(!tm)
return -1;
d1 = d2;
d2 = inportw(sector);
if((d1^d2)&(1<<6)) { //D6 == D6
//tm--;
//if(!tm)
// return -1;
continue;
}
if(inportw(sector)==0xffff) {
return 0;
}
}
}
/********************************************************************
Function name: FlashProg
Parameter : ProgStart : 目的地址
*DataPtr : 源地址
WorkCnt : 要写入的数据长度的大小
Description : 将大小为size的数据从src地址写到dst地址
Return : 返回0或非0数值
Argument : 返回0:烧写成功 返回非0:烧写不成功
Autor & date :
*********************************************************************/
static int FlashProg(U32 ProgStart, U16 *DataPtr, U32 WordCnt)
{
ProgStart += ROM_BASE;
for( ; WordCnt; ProgStart+=2, DataPtr++, WordCnt--) {
U32 tm;
outportw(0xaaaa, ROM_BASE+0xaaaa);
outportw(0x5555, ROM_BASE+0x5554);
outportw(0xa0a0, ROM_BASE+0xaaaa);
outportw(*DataPtr, ProgStart);
tm = CHECK_DELAY;
while(1) {
if((inportw(ProgStart)^inportw(ProgStart))&(0x40)) { //D6 == D6
tm--;
if(!tm)
return -1;
continue;
}
if(inportw(ProgStart)==*DataPtr)
break; //D7 == D7
tm--;
if(!tm)
return -1;
}
}
return 0;
}
/********************************************************************
Function name: NorFlashProg
Parameter : dst : 目的地址
src : 源地址
size: 要写入的数据长度的大小
Description : 将大小为size的数据从src地址写到dst地址
Return : void
Argument : 从指定扇区begin开始，将size个来自指针data的数据编程到Flash
Autor & date :
*********************************************************************/
void NorFlashProg(U32 dst, U32 src, U32 size)
{
char buf[0x1000];
U32 tmp = 0x1000-(dst&0xfff);
int err;
if(support) {
if((dst>ROM_SIZE)||(dst&1)) {
printf("Invalid flash address, the address is from 0~0x%x, 16Bits aligned\n", ROM_SIZE);
return;
}
if(tmp>size)
tmp = size;
if(tmp&1)
tmp++;
for(; size;) {
if(tmp<0x1000) {
NorFlashRead(buf, (dst&~0xfff), 0x1000);
memcpy(buf+(dst&0xfff), (char *)src, tmp);
} else {
memcpy(buf, (char *)src, 0x1000);
}
err = SectorErase(dst&~0xfff);
if(err) { //4K Bytes boudary
printf("Erase 0x%x Fail!\n", dst&~0xfff);
return;
}
printf("Program 0x%x %s\n", dst&~0xfff, FlashProg(dst&~0xfff, (U16 *)buf, 0x1000>>1)?"Fail":"Ok");
size -= tmp;
dst += tmp;
src += tmp;
tmp = (size>0x1000)?0x1000:size;
}
}
return;
}
/********************************************************************
Function name: NorFlashInit
Parameter : void
Description : 初始化Nor Flash
Return : void
Argument :
Autor & date :
*********************************************************************/
void NorFlashInit(void)
{
chip_id = GetFlashID();
support = 0;
if((chip_id==0x234b00bf)||(chip_id==0x278200bf)||(chip_id==0x22c400c2))
support = 1;
}
/********************************************************************
Function name: NorFlashStatusRep
Parameter : void
Description : 读取Nor Flash的相关信息
Return : void
Argument :
Autor & date :
*********************************************************************/
void NorFlashStatusRep(void)
{
printf("Nor Flash ID is : %x\n", chip_id);
if(support) {
if(chip_id==0x234b00bf)
printf("SST39VF1601 Found\n");
if(chip_id==0x278200bf)
printf("SST39VF160 Found\n");
if(chip_id==0x22c400c2)
printf("MX29LV160 Found\n");
} else
printf("Unknown Flash Type\n");
}
/********************************************************************
Function name: NorFlash_Test
Parameter : void
Description : Nor Flash读写函数
Return : void
Argument :
Autor & date : void
*********************************************************************/
void NorFlash_Test( void )
{
U32 m,n ;
int err ;
U8 data[36] ;
NorFlashInit() ;
NorFlashStatusRep() ;
printf("\nSector Erase Test\n\n" );
for( m = 0x100000 ; m < 0x105000 ; m += 0x1000 )
{
err = SectorErase( m );
if(err) printf("\tErase 0x%x Fail!!!\n", m );
else printf("\tErase 0x%x OK!!!\n", m );
}
//给要写入nandflash的数组赋值
for( m = 0 ; m < 36 ; m++ ) data[m] = m ;
printf("write data : \n");
for( m = 0; m < 3; m++ )
{
for( n = 0; n < 12; n++ )
printf( "%02x ", data[m*12+n] ) ;
printf("\n");
}
printf("\nProgram Flash Test\n\n" );
NorFlashProg( 0x100000, (int)data, 560 ) ;
for( m = 0 ; m < 36 ; m++ ) data[m] = 0 ;
//DataPtr =(U16)data ;
NorFlashRead( data,0x100000, 36 ) ;
printf("\nread data from 0x100000 :\n\n");
for( m = 0; m < 3; m++ )
{
for( n = 0; n < 12; n++ )
printf( "%02x ", data[m*12+n] ) ;
printf("\n");
}
}
#endif⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -