#include "flashrom.h"
#include "def.h"

/*** SST39VF160 檢查是否為空 ***
 扇區的值若為oxFF則判斷為空 ****/
int SST39VF160_CheckBlank(U32 addr,U32 WordSize) 
{
	U32 i,temp;
	for (i=addr;i<(addr+WordSize);i++)
	{
		temp=*((volatile U16 *)(i<<1));
		if(temp!=0xffff)
			return 0;
	}
	return 1;	
}

/****** SST39VF160 的檢測 ******
 Check if the bit6 toggle ends */
int Waitfor_endofprg(void)
{
	volatile U16 flashStatus,old;
	old=*((volatile U16 *)0x0);

	while(1)
	{
		flashStatus=*((volatile U16 *)0x0);
		if( (old&0x40) == (flashStatus&0x40) )
			break;
		else
		old=flashStatus;
	}
	return 1;
}

/*** SST39VF160 的寫入操作，是一個word（16bit）寫入的 ***/
int SST39VF160_WordProg (U32 addr,U16 dat)
{
	Writeflash (0x5555,0xAA);
	Writeflash (0x2AAA,0x55);
	Writeflash (0x5555,0xA0);
	Writeflash (addr,dat);
	return(Waitfor_endofprg());
	
}

/*** SST39VF160 扇區擦除 ***/
void  SST39VF160_SectorErase(U32 SAaddr)
{
	Writeflash(0x5555,0xAA);
	Writeflash(0x2AAA,0x55);
	Writeflash(0x5555,0x80);
	Writeflash(0x5555,0xAA);
	Writeflash(0x2AAA,0x55);
	Writeflash(SAaddr,0x30);
    Waitfor_endofprg();
}