#include<stdio.h>
void EraseChip();
void WriteByte(unsigned int Addr,unsigned char Val);
void WriteIsOver();
#define FlashMap1BaseAddr 0x400000
main()
{
FILE *fp;
	char *ptr=(char *)0x809800;
	unsigned int i;
	int codelengthstart,codelengthend,codelength;
	char filename[128];
	
	
	i = Read_ID();
	printf("FLASH ID is 0x%x\n",i);	
	printf("Clearing FLASH...\n");
	EraseChip();
	printf("Erased.\n");
	printf("Please enter the BIN filename:\n");
    scanf("%s",filename);
    fp = fopen(filename,"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);
		WriteByte(i,*ptr);	
		
	}	
	printf("OK.\n");

}
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();
}
int Read_ID(void)
{
	int CurrentToggleBit,i;

	for(i=0;i<0x10;i++);
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0xaaa) = 0xaa;

	for(i=0;i<0x10;i++);
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0x555) = 0x55;	
	
	for(i=0;i<0x10;i++);
	*(volatile unsigned char*)(FlashMap1BaseAddr + 0xaaa) = 0x90;
	for(i=0;i<0x10;i++);
	CurrentToggleBit = (*(volatile unsigned char*)FlashMap1BaseAddr);
	for(i=0;i<0x10;i++);
	return (CurrentToggleBit);
}

void EraseChip()
{
	*(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 + 0xaaa) = 0x10;
	
	WriteIsOver();
}

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

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

void WriteIsOver()
{
	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;
	}
}