#include <string.h>
#include "def.h"
#include "option.h"
#include "2410addr.h"
#include "2410lib.h"
#include "2410slib.h" 
#include "sst39vf800.h"

//Revision History
// 2001.8.25:purnnamu:If the data is downloaded by ICE, the writing isn't done correct.
 
int SST39VF800_ProgFlash(U32 realAddr,U16 data);
void SST39VF800_EraseSector(int targetAddr);
int SST39VF800_CheckId(void);
int SST39VF800_BlankCheck(int targetAddr,int targetSize);
int SST39VF800_WAIT(void);


// Because KS32C41000_A1 is connected to AM29LV800_A0,
// the addr parameter has to be a WORD address, so called in AMD specification.

#define _WR(addr,data)	*((volatile U16 *)(addr<<1))=(U16)data
//#define _WR(addr,data)	*((U16 *)(addr))=(U16)data
#define _RD(addr)	( *((volatile U16 *)(addr<<1)) )
//#define _RD(addr)	( *((U16 *)(addr)) )
//#define _RESET()	{_WR(0x5555,0xaaaa);_WR(0x2aaaa,0x5555);_WR(0x0,0xf0f0);}
#define _RESET()	_WR(0x0,0xf0f0)
#define BADDR2WADDR(addr)   (addr>>1)
extern U32 downloadAddress;
extern U32 downloadProgramSize;
static U32 srcAddress;
static U32 srcOffset;
static U32 targetAddress;
static U32 targetSize;
static U32 targetOffset;

void ProgramSST39VF800(void)
{
    int i;
    
    targetAddress = 0;
	targetOffset = 0;
    targetSize = downloadProgramSize;
   
  	srcAddress=downloadAddress;
    if(targetSize == 0)
    {
        Uart_Printf("The data must be downloaded using XMODEM from %x\n", downloadAddress);
        return;
    }
    	

    Uart_Printf("[Check SST39LF800]\n");
    if(!SST39VF800_CheckId())
    {
		Uart_Printf("ID Check Error!!!\n");
		return;
    }
    
    Uart_Printf("\nErase the sector:0x%x.\n",targetAddress);
    for(i=0;i<targetSize;i+=0x1000)
    {
        SST39VF800_EraseSector(targetAddress+targetOffset+i);
    }


    if(!SST39VF800_BlankCheck(targetAddress+targetOffset,targetSize))
    {
        Uart_Printf("Blank Check Error!!!\n");
        return;
    }

    Uart_Printf("\nStart of the data writing.\n");

    for(i=0x0;i<targetSize;i+=2) 
    {
        SST39VF800_ProgFlash(  i+targetAddress,*( (U16 *)(srcAddress+srcOffset+i) )  );
        if((i%0x1000)==0)Uart_Printf("%x ",i);
    }
    Uart_Printf("\nEnd of the data writing!!!\n");

    _RESET();

    Uart_Printf("\nVerifying Start.\n");
    for(i=0x0;i<targetSize;i+=2) 
    {
        if(*( (U16 *)(i+targetAddress) )!=*( (U16 *)(srcAddress+srcOffset+i) )  )
	{    
	    Uart_Printf("%x=verify error\n",i+targetAddress);
	    return;
	}
        if((i%0x1000)==0)Uart_Printf("%x ",i);
    }
    Uart_Printf("\nVerifying End!!!\n");
}



int SST39VF800_CheckId(void)
{
    U16 manId=0,devId=0;

    _RESET();
    _WR(0x5555,0xaaaa);
    _WR(0x2aaa,0x5555);
    _WR(0x5555,0x9090);
    manId = _RD(0x0);
    _RESET();

    _RESET();
    _WR(0x5555,0xaaaa);
    _WR(0x2aaa,0x5555);
    _WR(0x5555,0x9090);
    devId = _RD(0x1);
    _RESET();

    Uart_Printf("Manufacture ID(0x00bf)=%8x, Device ID(0x2781)=%8x\n", manId, devId);

    if(manId==0x00bf && devId==0x2781)
    	return 1;
   	return 0;
}




void SST39VF800_EraseSector(int targetAddr)
{

        _RESET();

        _WR(0x5555,0xaaaa);
        _WR(0x2aaa,0x5555);
        _WR(0x5555,0x8080);
        _WR(0x5555,0xaaaa);
        _WR(0x2aaa,0x5555);
        _WR(BADDR2WADDR(targetAddr),0x3030);
        
        SST39VF800_WAIT();
        
        _RESET();
        
        Uart_Printf("Sector_%x Erase O.K. \n",targetAddr);        
}


int SST39VF800_BlankCheck(int targetAddr,int targetSize)
{
    int i,j;
    for(i=0;i<targetSize;i+=2)
    {
	j=*((U16 *)(i+targetAddr));
	if( j!=0xffff)
	{
	    Uart_Printf("E:%x=%x\n",(i+targetAddr),j);
	    return 0;
	}
    }
    return 1;
}




int SST39VF800_WAIT(void) //Check if the bit6 toggle ends.
{


    volatile U16 flashStatus,old;

	old=*((volatile U16 *)0x0);

    while(1)
	{
	    flashStatus=*((volatile U16 *)0x0);
        if( (old&0x40) == (flashStatus&0x40) )break;
        if( flashStatus&0x20 )
	    {
		    //Uart_Printf("[DQ5=1:%x]\n",flashStatus);
		    old=*((volatile U16 *)0x0);
		    flashStatus=*((volatile U16 *)0x0);
		    if( (old&0x40) == (flashStatus&0x40) )
		        return 0;
		    else return 1;
	    }
	    //Uart_Printf(".");
	    old=flashStatus;
    }
    //Uart_Printf("!\n");
	return 1;

	
}




int SST39VF800_ProgFlash(U32 realAddr,U16 data)
{
	volatile U16 *tempPt;

        tempPt=(volatile U16 *)realAddr;
        _WR(0x5555,0xaaaa);
        _WR(0x2aaa,0x5555);
        _WR(0x5555,0xa0a0);
        *tempPt=data;
        
	return SST39VF800_WAIT();

}