#include<stdio.h>

#define FlashMap1BaseAddr 0x4000
void WriteIsOver(void);
void EraseChip(void);
void WriteByte(unsigned int,unsigned char);

main()
{
	FILE *fp;
	char *ptr=(char *)0x2100;
	unsigned int i;
	int codelengthstart,codelengthend,codelength;

	EraseChip();

    fp = fopen("E:\\MyBootLoader\\led.bin","rb");  
	if(fp == NULL)
	{    
	    exit(0);
	}
	fseek(fp,0,SEEK_END);          
	codelengthend = (int)ftell(fp);
	fseek(fp,0x0,SEEK_SET);          
	codelengthstart = (int)ftell(fp);
	codelength=codelengthend-codelengthstart;
	for(i=0;i<codelength;i++)
	{
		fread(ptr,1,1,fp);
		*ptr=*ptr&0xff;
		WriteByte(i,*ptr);	
	}	
	WriteByte(0xbffe,0x0040);
	WriteByte(0xbfff,0x0000);
	

}
void EraseSector(unsigned int SectorAddr)
{
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0xaaa) = 0xaa;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0x55;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0xaaa) = 0x80;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0xaaa) = 0xaa;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0x55;
	*(volatile unsigned char*)(FlashMap1BaseAddr + SectorAddr) = 0x30;
	
	WriteIsOver();
}

void EraseChip(void)
{
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0xaa;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x2aa) = 0x55;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0x80;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0xaa;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x2aa) = 0x55;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0x10;
	
	WriteIsOver();
}

void WriteByte(unsigned int Addr,unsigned char Val)
{

	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0xaa;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x2aa) = 0x55;
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0xa0;
	*(volatile unsigned char*)(FlashMap1BaseAddr + Addr) = Val;
	WriteIsOver();
}

void WriteIsOver(void)
{
	unsigned int i;
	unsigned char LastToggleBit,CurrentToggleBit;
	LastToggleBit = (*(volatile unsigned char*)FlashMap1BaseAddr) & 0x40;
	CurrentToggleBit = (*(volatile unsigned char*)FlashMap1BaseAddr) & 0x40;
	for(i = 0; ; i++)
	{
		LastToggleBit = CurrentToggleBit;
		CurrentToggleBit = (*(volatile unsigned char*)FlashMap1BaseAddr) & 0x40;
		if(LastToggleBit == CurrentToggleBit) break;
	}
}