39vf160.c

YL9200开发板的BIOS9200源码

#include "def.h"
#include "config.h"
#include "console.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))

static U8 state = 0;

static void CFIQueryExit(void)
{
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0xf0f0;
	state &= 0xfc;	
}

static void SWPIDExit(void)
{
	CMD_ADDR0 = 0xf0f0;
	state &= 0xfc;
}

static void CFIQueryEntry(void)
{
	if(state&1)
	{
		if(state&2)
			SWPIDExit();
		else
			return;
	}
	
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0x9898;
	state |= 1;	
}

static void SWPIDEntry(void)
{
	if(state&1)
	{
		if(state&2)
			return;
		else
			CFIQueryExit();
	}

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

U32 GetFlashID(void)
{
	U32 i;
	
	SWPIDEntry();
	i  = *(U16 *)(0x0+ROM_BASE);
	i |= (*(U16 *)(2+ROM_BASE))<<16;
	SWPIDExit();
	return i;	
}

void GetFlashCFI(U16 *DataPtr)
{
	U16 i;
	
	CFIQueryEntry();
	for(i = 0x10; i<0x35; DataPtr++, i++)
		*DataPtr = *(U16 *)(i*2+ROM_BASE);	
	CFIQueryExit();
}

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)
	{
		U16 i;
		i = *((volatile U16 *)0x6666)&0x40;
		if(i!=*((volatile U16 *)0x6666)&0x40)	//D6 == D6
			continue;
		if(*((volatile U16 *)0x8888)&0x80)	
			break;						//D7 == 1
	}		
}

int SectorErase(U32 sector)
{
	U32 tm;
	
	if(state&1) {	
		if(state&2)
			SWPIDExit();
		else
			CFIQueryExit();						
	}
	
	sector += ROM_BASE;	
	
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	CMD_ADDR0 = 0x8080;
	CMD_ADDR0 = 0xaaaa;
	CMD_ADDR1 = 0x5555;
	*(volatile U16 *)sector = 0x3030;
	
	tm = 0;
	while(tm++<100000) {
		U16 i;
		i = *((volatile U16 *)sector)&0x40;
		if(i!=*((volatile U16 *)sector)&0x40)	//D6 == D6
			continue;
		if(*((volatile U16 *)sector)&0x80)	
			break;								//D7 == 1
	}
//	printf("Erase sector 0x%x	ok\n", sector-ROM_BASE);
	if(tm>=100000)
		return -1;
	return 0;
}

int FlashProg(U32 ProgStart, U16 *DataPtr, U32 WordCnt)
{
	U16 i, j;
	U32 tm;
	
	ProgStart += ROM_BASE;
	
	for( ; WordCnt; ProgStart+=2, DataPtr++, WordCnt--) {
		j = *DataPtr;
		CMD_ADDR0 = 0xaaaa;
		CMD_ADDR1 = 0x5555;
		CMD_ADDR0 = 0xa0a0;
		*(volatile U16 *)ProgStart = j;	
		
		tm = 0;
		while(tm++<10000){
			i = *(volatile U16 *)ProgStart&0x40;
		//		printf("%x,", ProgStart);
			if(i!=*(volatile U16 *)ProgStart&0x40)		//D6 == D6
				continue;
			if((*(volatile U16 *)ProgStart&0x80)==(j&0x80))	
				break;					//D7 == D7
		}
		if(tm>=10000)
			return -1;
	}
	return 0;
}

void FlashRead(unsigned int ReadStart, unsigned short *DataPtr, unsigned int Size)
{
	int i;
	
	ReadStart += ROM_BASE;
	
	for(i=0; i<Size/2; i++)
		*(DataPtr+i) = *((unsigned short *)ReadStart+i);	
	
}

int SectorProg(U32 begin, U16 *data, U32 size)
{	
	int err;	
	U32 tmp = 0x1000-(begin&0xfff);
	
	if(tmp>size)
		tmp = size;
	
	for(; size;) {

		if(SectorErase(begin&~0xfff)) {	//4K Bytes boudary
			printf("Erase 0x%x Fail!\n", begin&~0xfff);
			return -1;
		}		
		printf("Program 0x%x ", begin);
		err = FlashProg(begin, data, tmp>>1);
		if(err) {
			puts("Fail!\n");
			return -1;
		}
		puts("Ok\n");
		
		size  -= tmp;
		begin += tmp;
		data  += tmp>>1;
		tmp = (size>0x1000)?0x1000:size;				
	}
	return 0;			
}

int SectorRead(U32 begin, U16 *data, U32 size)
{	
	U32 idx, rd_len;	
	
	rd_len = size>>1;
	begin += ROM_BASE;
	
	for(idx=0 ; idx<rd_len; idx++) {
		data[idx] = ((volatile U16 *)begin)[idx];
	}	
	return 0;
}

#endif