#include "ioregs.h" 
#include "net.h"
#include "flash.h"


unsigned long address;				//32位地址
unsigned long data;					//32位數(shù)據(jù)
unsigned long length;				//32位長(zhǎng)度
void init_uart(void)				//串口1初始化 @ 115200bps
{
	IO_UBRLCR1 = (IO_UBRLCR1 & ~BRDIV) | BR_115200;
	IO_UBRLCR1 = IO_UBRLCR1 | FIFOEN;
	IO_UBRLCR1 = (IO_UBRLCR1 & ~WRDLEN) | (3<<WRDLEN_SHIFT);
	IO_SYSCON1 |=  UART1EN;
}
unsigned char get_char(void)			//串口1接收
{
	while (IO_SYSFLG1 & URXFE1);
	return IO_UARTDR1 & 0xff;
}
void put_char(unsigned char data)	//串口1發(fā)送
{
	while (IO_SYSFLG1 & UTXFF1);
	IO_UARTDR1 = data;
}
void put_string(char *sp)				//串口1字符串發(fā)送
{
	unsigned int i=0;
	while(sp[i]!=0)
		put_char(sp[i++]);
}
unsigned int wait(unsigned char i)	//延時(shí)函數(shù)
{
	unsigned int sum=0;
	for(;i>0;i--)
		sum+=i;
	return(sum);
}
void flash_erase()					//FLASH擦除
{
	SYSC_(0x70005555)=0xaa;			//寫(xiě)入擦除命令
	wait(1);						//延時(shí)
	SYSC_(0x70002aaa)=0x55;			//寫(xiě)入擦除命令
	wait(1);						//延時(shí)
	SYSC_(0x70005555)=0x80;			//寫(xiě)入擦除命令
	wait(1);						//延時(shí)
	SYSC_(0x70005555)=0xaa;			    //寫(xiě)入擦除命令
	wait(1);						//延時(shí)
	SYSC_(0x70002aaa)=0x55;		//寫(xiě)入擦除命令
	wait(1);						//延時(shí)
	SYSC_(0x70005555)=0x10;			    //寫(xiě)入擦除命令
	wait(1);						//延時(shí)
	while((SYSC_(0x70000000)& 0x80)==0);	//確認(rèn)已擦除
}
void flash_prog(unsigned long address,unsigned char data)	//FLASH字節(jié)編程
{
	SYSC_(0x70005555)=0xaa;			    //寫(xiě)入編程命令
	wait(1);						//延時(shí)
	SYSC_(0x70002aaa)=0x55;		//寫(xiě)入編程命令
	wait(1);						//延時(shí)
	SYSC_(0x70005555)=0xa0;			      //寫(xiě)入編程命令
	wait(1);						//延時(shí)
	SYSC_(address)=data;				//寫(xiě)入編程數(shù)據(jù)
	while(SYSC_(address)!=data);	//確認(rèn)字節(jié)已寫(xiě)入
}
void writein()					//塊數(shù)據(jù)獲取
{
	unsigned long i,data;
	put_string("Len:\n");				//發(fā)送“請(qǐng)輸入長(zhǎng)度數(shù)據(jù)”的提示
	length=get_char();
	length=(length<<8)+get_char();
	length=(length<<8)+get_char();
	length=(length<<8)+get_char();	//獲取32位長(zhǎng)度數(shù)據(jù)
	for(i=0;i<length;i+=4)
	{
		data=get_char();
		data+=get_char()<<8;
		data+=get_char()<<16;
		data+=get_char()<<24;			//獲取32位數(shù)據(jù)
		SDRAM_(i)=data;			//SDRAM賦值
	}
	put_string("Ok!\n");				//發(fā)送塊數(shù)據(jù)讀取完畢標(biāo)志
}
void flashload()					//塊數(shù)據(jù)FLASH編程
{
	unsigned long i;
	writein();					//編程數(shù)據(jù)先讀入SDRAM
	flash_erase();				//FLASH擦除
	for(i=0;i<length;i+=4)
	{
		data=SDRAM_(i);
		flash_prog((0x70000000+i),data & 0xff);	          //FLASH字節(jié)編程
		flash_prog((0x70000001+i),(data>>8) & 0xff);	//FLASH字節(jié)編程
		flash_prog((0x70000002+i),(data>>16) & 0xff);	//FLASH字節(jié)編程
		flash_prog((0x70000003+i),(data>>24) & 0xff);	//FLASH字節(jié)編程			
	}
	put_string("Done!\n");				//發(fā)送FLASH編程成功標(biāo)志
}
void mymain(void)					//串口調(diào)試函數(shù)
{
	unsigned char scomm,sdata;
	unsigned char *addrp;
	unsigned char *datap;
	addrp=(unsigned char*)&address;
	datap=(unsigned char*)&data;
	put_string("ok!\n");				//發(fā)送串口調(diào)試啟動(dòng)標(biāo)志
	
	while (1)					//主循環(huán)
    	{
		scomm=get_char();			   //讀串口
		if(scomm==0xff)			//是否為命令前導(dǎo)字節(jié)“0xFF”？
	  		{
		  	scomm=get_char();	//讀調(diào)試命令字節(jié)
		  	if(scomm!=0xff)
	  			switch(scomm)		//根據(jù)調(diào)試命令散轉(zhuǎn)
	  			{
					case 0xfa:flashload();break; //執(zhí)行FLASH編程操作
		  			default:put_string("Not Support!\n"); //不支持的命令
		  		}
		else sdata=0xff;				   //數(shù)據(jù)“0xFF”賦值
		}
	else sdata=scomm;			//非“0xFF”數(shù)據(jù)直接賦值
	}
}
void  C_vMain(void)				//主程序
{
	unsigned char i;
	unsigned short j;	
	init_uart();					//串口1初始化
	while(1)
	{
		i=get_char();				//讀串口
		if(i==0x79)				//是否讀取到調(diào)試開(kāi)始命令？
			mymain();			//進(jìn)入串口調(diào)試
		else put_char(i);			//測(cè)試串口
	}
}