39vf160.c

使用ads1.2编译器

#ifndef _Include 
#include  "Include.h"
#endif

static unsigned char state = 0;

/****************************************************************************
* 名称：CFIQueryExit(void)
* 功能：器件特性查询退出
* 入口参数：无
* 出口参数：无
****************************************************************************/
static void CFIQueryExit(void)
{
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0xf0f0;
	state &= 0xfc;	
}

/****************************************************************************
* 名称：SWPIDEntry(void)
* 功能：软件ID命令进入
* 入口参数：无
* 出口参数：无
****************************************************************************/
static void SWPIDEntry(void)
{
	if(state&1)
	{
		if(state&2)
			return;
		else
			CFIQueryExit();
	}

	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0x9090;
	state |= 3;
}

/****************************************************************************
* 名称：SWPIDExit(void)
* 功能：软件ID命令退出
* 入口参数：无
* 出口参数：无
****************************************************************************/
static void SWPIDExit(void)
{
	CMD_ADDR0 = 0xf0f0;
	state &= 0xfc;
}
/****************************************************************************
* 名称：CFIQueryEntry(void)
* 功能：器件特性查询进入
* 入口参数：无
* 出口参数：无
****************************************************************************/
static void CFIQueryEntry(void)
{
	if(state&1)
	{
		if(state&2)
			SWPIDExit();
		else
			return;
	}
	
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0x9898;
	state |= 1;	
}


/****************************************************************************
* 名称：GetFlashID(void)
* 功能：获取flashID
* 入口参数：无
* 出口参数：无
****************************************************************************/
unsigned int GetFlashID(void)
{
	unsigned int i;
	
	SWPIDEntry();
	i  = *(unsigned short *)(0+ROM_BASE);
	i |= (*(unsigned short *)(2+ROM_BASE))<<16;
	SWPIDExit();
	return i;	
}

/****************************************************************************
* 名称：GetFlashCFI(unsigned short *DataPtr)
* 功能：
* 入口参数：无
* 出口参数：无
****************************************************************************/
void GetFlashCFI(unsigned short *DataPtr)
{
	unsigned short i;
	
	CFIQueryEntry();
	for(i = 0x10; i<0x35; DataPtr++, i++)
		*DataPtr = *(unsigned short *)(i*2+ROM_BASE);	
	CFIQueryExit();
}

/****************************************************************************
* 名称：ChipErase(void)
* 功能：芯片擦除
* 入口参数：无
* 出口参数：无
****************************************************************************/
void ChipErase(void)
{
	if(state&1)
	{
		if(state&2)
			SWPIDExit();
		else
			CFIQueryExit();						
	}
	
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0x8080;
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0x1010;

	while(1)
	{
		unsigned short i;
		i = *((volatile unsigned short *)0x6666)&0x40;
		if(i!=*((volatile unsigned short *)0x6666)&0x40)	//D6 == D6
			continue;
		if(*((volatile unsigned short *)0x8888)&0x80)	
			break;						//D7 == 1
	}		
}
/****************************************************************************
* 名称：SectorErase(unsigned int sector)
* 功能：扇区擦除
* 入口参数：无
* 出口参数：无
****************************************************************************/
void SectorErase(unsigned int sector)
{
	if(state&1)
	{
		if(state&2)
			SWPIDExit();
		else
			CFIQueryExit();						
	}
	sector &=~(SECTOR_SIZE-1);
	if(sector>(FLASH_APP_ADD-1)&&sector<FLASH_APP_LIMIT) 
	{	
		CMD_ADDR0 = 0xaaaa;
		CMD_ADDR1 = 0x5555;
		CMD_ADDR0 = 0x8080;
		CMD_ADDR0 = 0xaaaa;
		CMD_ADDR1 = 0x5555;
		*(volatile unsigned short *)sector = 0x3030;
		
		while(1)
		{
			unsigned short i;
			i = *((volatile unsigned short *)sector)&0x40;
			if(i!=*((volatile unsigned short *)sector)&0x40)	//D6 == D6
				continue;
			if(*((volatile unsigned short *)sector)&0x80)	
				break;								//D7 == 1
		}
	}

}
/****************************************************************************
* 名称：FlashProg(unsigned int ReadStart, unsigned short *DataPtr, unsigned int WordCnt)
* 功能：flash编程
* 入口参数：无
* 出口参数：无
****************************************************************************/
void FlashProg(unsigned int ProgStart, unsigned short *DataPtr, unsigned int WordCnt)
{
	unsigned short i, j;	
	
	if(ProgStart>(FLASH_APP_ADD-1)&&ProgStart<FLASH_APP_LIMIT) 
	{	
		for( ; WordCnt; ProgStart+=2, DataPtr++, WordCnt--)
		{	
			j = *DataPtr;
			CMD_ADDR0 = 0xaaaa;
			CMD_ADDR1 = 0x5555;
			CMD_ADDR0 = 0xa0a0;
			*(volatile unsigned short *)ProgStart = j;	
			
			while(1)
			{
				i = *(volatile unsigned short *)ProgStart&0x40;
				if(i!=*(volatile unsigned short *)ProgStart&0x40)		//D6 == D6
					continue;
				if((*(volatile unsigned short *)ProgStart&0x80)==(j&0x80))	
					break;					//D7 == D7
			}
		}
	}
	
}
/****************************************************************************
* 名称：FlashRead(unsigned int ReadStart, unsigned short *DataPtr, unsigned int Size)
* 功能：读flash
* 入口参数：无
* 出口参数：无
****************************************************************************/

void FlashRead(unsigned int ReadStart, unsigned short *DataPtr, unsigned int Size)
{
	int i;
	
	if(ReadStart>(FLASH_APP_ADD-1)&&ReadStart<FLASH_APP_LIMIT) 
	{	
		for(i=0; i<Size/2; i++)
			*(DataPtr+i) = *((unsigned short *)ReadStart+i);
	}	
	
}
/****************************************************************************
* 名称：SectorProg(unsigned int begin, unsigned short *data, unsigned int size)
* 功能：扇区编程
* 入口参数：无
* 出口参数：无
****************************************************************************/

int SectorProg(unsigned int begin, unsigned short *data, unsigned int size)
{		
	unsigned int tmp = 0x1000-(begin&0xfff);
	
	if(tmp>size)
		tmp = size;
	
	for(; size;)
	{	
		SectorErase(begin&0xfffff000);	//4K Bytes boudary		
		FlashProg(begin, data, tmp/2);
				
		size  -= tmp;
		begin += tmp;
		data  += tmp/2;
		tmp = (size>0x1000)?0x1000:size;				
	}
	return 0;			
}