📄 flash32bsc.c
字号:
/***********************************************************************/
/* */
/* This module is the hardware-dependent flash programming module, the */
/* low-level routines to erase and program the flash are provided. */
/* */
/* History: */
/* v1: szg 6/22/98 create */
/* v2: shaozl 6/22/98 add sst39vf160 of SST */
/* v3: zhoudb 01/16/2004 add M28W320CT of ST */
/* This driver can be use to SST,SHARP,FLASH,INTEL and ST 's some FLASH*/
/* */
/***********************************************************************/
#include <string.h>
#include "board.h"
#include "sdev.h"
#include "flash32.h"
#define SST_MANUFACTURER_CODE 0x00BF00BF
#define SST_DEVICE_CODE0 0x27822782
#define SST_DEVICE_CODE1 0x234B234B
#define SST_ID_READ_WAIT 0X20
#define SHARP_MANUFACTURER_CODE 0x00B000B0
#define SHARP_DEVICE_CODE 0x00E000E0
#define FLASH_ERASE_CHIP_LOOP 0X4000000
#define FLASH_ERASE_SECTOR_LOOP 0X4000000
#define FLASH_WRITE_LOOP 0X4000000
#define INTEL_C3MANUFACTURER_CODE 0x00890089
#define INTEL_C3 0x88c088c0
#define ST_MANUFACTURER_CODE 0x00200020
#define ST_M28W320CT_DEVICE_CODE 0x88ba88ba
static ULONG ReadReg(ULONG Addr) {
return (*(ULONG *)Addr);
}
static void WriteReg(ULONG Addr, ULONG val) {
*(ULONG *)Addr = val;
return;
}
static void Flash32Init(void *pDataBuf, Flash32CfgStruct *cfg){
Flash32CfgStruct* pCfg =(Flash32CfgStruct *)(pDataBuf);
memmove(pCfg,cfg,sizeof(*cfg));
}
/***********************************************************************/
/* NOTE: The following are intel DT28F160S3 flash operation functions*/
/***********************************************************************/
static int read_intelflash(void *pDataBuf,void *pBuf, int MaxLen)
{
Flash32CfgStruct *pCfg=(Flash32CfgStruct *)pDataBuf;
SDCFlashAccessStruct *mas=(SDCFlashAccessStruct *)pBuf;
if(MaxLen!=sizeof(SDCFlashAccessStruct))return SDE_INVALID_ARG;
if(mas->Size <= 0 ) return SDE_INVALID_ARG;
if(mas->Size+mas->Offset > pCfg->MaxSize)return SDE_INVALID_ARG;
memmove(mas->Base,(UCHAR *)pCfg->BaseAddr+mas->Offset,mas->Size);
return SDE_OK;
}
static int write_intelflash(void *pDataBuf,void *pBuf, int MaxLen)
{
Flash32CfgStruct *pCfg=(Flash32CfgStruct *)pDataBuf;
SDCFlashAccessStruct *mas=(SDCFlashAccessStruct *)pBuf;
int i,end;
UCHAR *start,*BufAddr;
ULONG data,Offset,BaseAddr;
int DataLen;
if(MaxLen!=sizeof(SDCFlashAccessStruct))return SDE_INVALID_ARG;
if(mas==NULL||(mas->Size+mas->Offset>pCfg->MaxSize))return SDE_INVALID_ARG;
if(mas->Size==0)return SDE_OK;
BaseAddr=pCfg->BaseAddr; Offset=mas->Offset;DataLen=mas->Size;
start=(UCHAR *)((BaseAddr+Offset)&(~3L));
i=((BaseAddr+Offset)&3L);
BufAddr=mas->Base-i; DataLen+=i;
data=0xffffffff;
end=(int)(DataLen>4)?4:DataLen;
memmove(((UCHAR *)&data)+i,BufAddr+i,end-i);
i=0;
while(1)
{
if(data!=0xffffffff)
{
ULONG ii,rc;
WriteReg((ULONG)start,0x00400040);
*(ULONG *)start=data;
for(ii=0;ii<FLASH_WRITE_LOOP;ii++){
if((ReadReg((ULONG)start)&0x00800080)==0x00800080)break;
}
if(ii==FLASH_WRITE_LOOP)break;
rc=ReadReg((ULONG)start)&0x00380038;
WriteReg((ULONG)start,0x00ff00ff);
if(rc!=0)break;
}
i+=4; start+=4;
if(i>=DataLen)break; else data=0xffffffff;
if((i+4)>DataLen)memmove((UCHAR *)&data,BufAddr+i,DataLen-i);
else data=*(ULONG *)(BufAddr+i);
}
if(i<DataLen) return SDE_FLASH_FAIL;
else
{
start = (UCHAR *)(BaseAddr + Offset);
if(memcmp(start,mas->Base,mas->Size)!=0)return SDE_FLASH_FAIL;
return SDE_OK;
}
}
static int IntelFlash32Cntrl(void *pDataBuf, int cmd, void *pParam, int maxlen)
{
Flash32CfgStruct *pCfg=(Flash32CfgStruct *)pDataBuf;
switch(cmd)
{
case SDC_GET_UNIT_SIZE:
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
*(ULONG *)pParam=pCfg->UnitSize;
return SDE_OK;
case SDC_GET_BASE_ADDR:
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
*(ULONG *)pParam=pCfg->BaseAddr;
return SDE_OK;
case SDC_GET_MAX_SIZE:
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
*(ULONG *)pParam=pCfg->MaxSize;
return SDE_OK;
case SDC_WRITE_FLASH:
return write_intelflash(pDataBuf,pParam,maxlen);
case SDC_READ_FLASH:
return read_intelflash(pDataBuf,pParam,maxlen);
case SDC_ERASE_CHIP:
{
ULONG cs;
int ret=SDE_OK;
for(cs=0;cs<8;cs++)
{
ULONG i;
ULONG BaseAddr=pCfg->CSRange[cs][0]+pCfg->BaseAddr;
if(pCfg->CSRange[cs][1]==0)
{
break;
}
WriteReg(BaseAddr,0x00300030);
WriteReg(BaseAddr,0x00d000d0);
for(i=0;i<FLASH_ERASE_CHIP_LOOP;i++)
{
if((ReadReg(BaseAddr)&0x00800080)==0x00800080)
{
break;
}
}
if(i==FLASH_ERASE_CHIP_LOOP)
{
ret=SDE_FLASH_FAIL;
}
if((ReadReg(BaseAddr)&0x00380038) != 0)
{
ret=SDE_FLASH_FAIL;
}
WriteReg(BaseAddr,0x00ff00ff);
}
return ret;
}
case SDC_ERASE_SECTOR:
{
ULONG offset=*(ULONG *)pParam;
int ret=SDE_OK;
ULONG i;
ULONG BaseAddr=0xFFFFFFFF;
for(i=0;i<8 && pCfg->CSRange[i][1]!=0;i++)
if(pCfg->CSRange[i][0]<=offset &&
pCfg->CSRange[i][1]> offset){
BaseAddr=pCfg->CSRange[i][0]+pCfg->BaseAddr;
offset -= pCfg->CSRange[i][0];
}
if(BaseAddr==0xFFFFFFFF)return SDE_INVALID_ARG;
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
WriteReg(BaseAddr,0x00200020);
WriteReg(BaseAddr+offset,0x00D000D0);
for(i=0;i<FLASH_ERASE_SECTOR_LOOP;i++){
if((ReadReg(BaseAddr)&0x00800080)==0x00800080)break;
}
if(i==FLASH_ERASE_SECTOR_LOOP)ret=SDE_FLASH_FAIL;
if((ReadReg(BaseAddr)&0x00380038) != 0)ret=SDE_FLASH_FAIL;
WriteReg(BaseAddr,0x00ff00ff);
return ret;
}
default:
return SDE_UNKNOW_CMD;
}
/* return SDE_OK; */
}
/***********************************************************************/
/* NOTE: The following are the lh28f160 flash operation functions */
/***********************************************************************/
static int SharpFlash32Cntrl(void *pDataBuf, int cmd, void *pParam, int maxlen)
{
Flash32CfgStruct *pCfg=(Flash32CfgStruct *)pDataBuf;
switch(cmd)
{
case SDC_GET_UNIT_SIZE:
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
*(ULONG *)pParam=pCfg->UnitSize;
return SDE_OK;
case SDC_GET_BASE_ADDR:
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
*(ULONG *)pParam=pCfg->BaseAddr;
return SDE_OK;
case SDC_GET_MAX_SIZE:
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
*(ULONG *)pParam=pCfg->MaxSize;
return SDE_OK;
case SDC_WRITE_FLASH:
return write_intelflash(pDataBuf,pParam,maxlen);
case SDC_READ_FLASH:
return read_intelflash(pDataBuf,pParam,maxlen);
case SDC_ERASE_CHIP:
{
ULONG cs;
int ret=SDE_OK;
for(cs=0;cs<8;cs++){
ULONG i;
ULONG BaseAddr=pCfg->CSRange[cs][0]+pCfg->BaseAddr;
if(pCfg->CSRange[cs][1]==0)break;
WriteReg(BaseAddr,0x00300030);
WriteReg(BaseAddr,0x00d000d0);
for(i=0;i<FLASH_ERASE_CHIP_LOOP;i++){
if((ReadReg(BaseAddr)&0x00800080)==0x00800080)break;
}
if(i==FLASH_ERASE_CHIP_LOOP)ret=SDE_FLASH_FAIL;
if((ReadReg(BaseAddr)&0x00380038) != 0)ret=SDE_FLASH_FAIL;
WriteReg(BaseAddr,0x00ff00ff);
}
return ret;
}
case SDC_ERASE_SECTOR:
{
ULONG offset=*(ULONG *)pParam;
int ret=SDE_OK;
ULONG i,j;
ULONG BaseAddr=0xFFFFFFFF;
for(i=0;i<8 && pCfg->CSRange[i][1]!=0;i++)
if(pCfg->CSRange[i][0]<=offset &&
pCfg->CSRange[i][1]> offset){
BaseAddr=pCfg->CSRange[i][0]+pCfg->BaseAddr;
offset -= pCfg->CSRange[i][0];
}
if(BaseAddr==0xFFFFFFFF)return SDE_INVALID_ARG;
if(maxlen!=sizeof(ULONG))return SDE_INVALID_ARG;
if(offset < pCfg->UnitSize)
{
for(j=0;j<8;j++)
{
WriteReg(BaseAddr,0x00200020);
WriteReg(BaseAddr+j*pCfg->UnitSize/8,0x00D000D0);
for(i=0;i<FLASH_ERASE_SECTOR_LOOP;i++)
{
if((ReadReg(BaseAddr)&0x00800080)==0x00800080)break;
}
if(i==FLASH_ERASE_SECTOR_LOOP)ret=SDE_FLASH_FAIL;
if((ReadReg(BaseAddr)&0x00380038) != 0)ret=SDE_FLASH_FAIL;
WriteReg(BaseAddr,0x00ff00ff);
}
}
else
{
WriteReg(BaseAddr,0x00200020);
WriteReg(BaseAddr+offset,0x00D000D0);
for(i=0;i<FLASH_ERASE_SECTOR_LOOP;i++)
{
if((ReadReg(BaseAddr)&0x00800080)==0x00800080)break;
}
if(i==FLASH_ERASE_SECTOR_LOOP)ret=SDE_FLASH_FAIL;
if((ReadReg(BaseAddr)&0x00380038) != 0)ret=SDE_FLASH_FAIL;
WriteReg(BaseAddr,0x00ff00ff);
}
return ret;
}
default:
return SDE_UNKNOW_CMD;
}
/* return SDE_OK; */
}
/***********************************************************************/
/* NOTE: The following are the sst39vf160 flash operation functions */
/***********************************************************************/
static int read_sstflash(void *pDataBuf,void *pBuf, int MaxLen)
{
Flash32CfgStruct *pCfg=(Flash32CfgStruct *)pDataBuf;
SDCFlashAccessStruct *mas=(SDCFlashAccessStruct *)pBuf;
if(MaxLen!=sizeof(SDCFlashAccessStruct))return SDE_INVALID_ARG;
if(mas->Size <= 0 ) return SDE_INVALID_ARG;
if(mas->Size+mas->Offset > pCfg->MaxSize)return SDE_INVALID_ARG;
memmove(mas->Base,(UCHAR *)pCfg->BaseAddr+mas->Offset,mas->Size);
return SDE_OK;
}
static int write_sstflash(void *pDataBuf,void *pBuf, int MaxLen)
{
Flash32CfgStruct *pCfg=(Flash32CfgStruct *)pDataBuf;
SDCFlashAccessStruct *mas=(SDCFlashAccessStruct *)pBuf;
int i,end;
UCHAR *start,*BufAddr;
ULONG data,Offset,BaseAddr;
int DataLen;
if(MaxLen!=sizeof(SDCFlashAccessStruct))return SDE_INVALID_ARG;
if(mas==NULL||(mas->Size+mas->Offset>pCfg->MaxSize))return SDE_INVALID_ARG;
if(mas->Size==0)return SDE_OK;
BaseAddr=pCfg->BaseAddr; Offset=mas->Offset;DataLen=mas->Size;
start=(UCHAR *)((BaseAddr+Offset)&(~3L));
i=((BaseAddr+Offset)&3L);
BufAddr=mas->Base-i; DataLen+=i;
data=0xffffffff;
end=(DataLen>4)?4:DataLen;
memmove(((UCHAR *)&data)+i,BufAddr+i,end-i);
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -