#include <string.h>
#include "option.h"
#include "2460addr.h"
#include "2460lib.h"
#include "2460slib.h" 
#include "Am29f800.h"

//Revision History
// 2001.8.25:purnnamu:If the data is downloaded by ICE, the writing isn't done correct.
 
int AM29F800_ProgFlash(unsigned int realAddr,unsigned short data);
void AM29F800_EraseSector(int targetAddr);
void AM29F800_EraseAll(void);
int AM29F800_CheckId(void);
int BlankCheck(int targetAddr,int targetSize);
int _WAIT(void);

static void InputTargetAddr(void);

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

#if 0
#define _WR(addr,data)	*((volatile unsigned short *)(addr<<1))=(unsigned short)data
#define _RD(addr)	( *((volatile unsigned short *)(addr<<1)) )
#define _RESET()	_WR(0x0,0xf0f0)
#define BADDR2WADDR(addr)   (addr>>1)
#else
#define _WR(addr,data)	*((volatile unsigned short *)((bank_of_nor&0xff000000)+((addr&0x00ffffff)<<1)))=(unsigned short)data
#define _RD(addr)	( *((volatile unsigned short *)((bank_of_nor&0xff000000)+((addr&0x00ffffff)<<1))))
#define _RESET()	*((volatile unsigned short *)bank_of_nor)=(unsigned short)0xf0f0
#define BADDR2WADDR(addr)   ((addr&0x00ffffff)>>1)
#endif

extern unsigned int downloadAddress;
static unsigned int srcAddress;
static unsigned int srcOffset;
static unsigned int targetAddress;
static unsigned int targetSize;


void ProgramAM29F800(void)
{
    int i, iSectorAddr;   
        
    if(downloadFileSize==0)
    {
        printf("\n!NOTE:Download source image to 0x%08x before programming\n",_NONCACHE_STARTADDRESS);
    	return;
    }
    else
    	srcAddress=_NONCACHE_STARTADDRESS;
    	    
    InputTargetAddr();
     
    printf("\nErase the sector:0x%x.\n",targetAddress);

    if(targetAddress<0x4000) iSectorAddr=0x0;
    else if(targetAddress<0x6000) iSectorAddr=0x4000;
    else if(targetAddress<0x8000) iSectorAddr=0x6000;
    else if(targetAddress<0x10000) iSectorAddr=0x8000; 
    else 
    {
    	for (i=2; i<256; i++) // until..16MB
    		if (targetAddress < i*0x10000) 
    		{ 
    			iSectorAddr = (i-1)*0x10000; 
    			break;
    		}
    }

    while (iSectorAddr < targetAddress+targetSize)
    {
		AM29F800_EraseSector(iSectorAddr);
    	if (iSectorAddr == 0x0 ) iSectorAddr = 0x4000;
    	else if (iSectorAddr == 0x4000 ) iSectorAddr = 0x6000;
    	else if (iSectorAddr == 0x6000 ) iSectorAddr = 0x8000;
    	else if (iSectorAddr == 0x8000 ) iSectorAddr = 0x10000;    		
    	else iSectorAddr += 0x10000;
    }
    
    if(!BlankCheck(targetAddress, targetSize))
    {
		printf("Blank Check Error!!!\n");
		return;
    }

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

    for(i=0x0;i<targetSize;i+=2) 
    {
        AM29F800_ProgFlash(  i+targetAddress,*( (unsigned short *)(srcAddress+i) )  );
        if((i%0x1000)==0)printf("%x ",i);
    }
    printf("\nEnd of the data writing!!!\n");

    _RESET();

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

    printf("Do you want another programming without additional download? [y/n]\n");
    if(getchar()=='y')ProgramAM29F800();
}



static void InputTargetAddr(void)
{
    static unsigned int nextTargetAddr=0,nextSrcOffset=0;
    
    printf("[AM29F800 Writing Program]\n");

    printf("\nCAUTION: Check AM29LV800 BYTE#(47) pin is connected to VDD.\n");

    printf("\nSource size:0h~%xh\n",downloadFileSize-10);
    printf("\nAvailable Target/Source Address:\n"); 
    printf("    0x0, 0x4000, 0x6000, 0x8000,0x10000,0x20000,0x30000,0x40000,\n");
    printf("0x50000,0x60000,0x70000,0x80000,0x90000,0xa0000,0xb0000,0xc0000,\n");
    printf("0xd0000,0xe0000,0xf0000\n");
    
    printf("Input target start address among above addresses[0x%x]:",nextTargetAddr);
    targetAddress=GetIntNum();
    if(targetAddress==(unsigned int)(-1))targetAddress=nextTargetAddr;

    printf("Input target data size [0x%x]:",downloadFileSize-10);
    targetSize=GetIntNum();
    if(targetSize==(unsigned int)(-1)) targetSize=downloadFileSize-10;

//    printf("source offset=0x%x\n",srcOffset);
    printf("target start address=0x%x\n",targetAddress);
    printf("target data size=0x%x\n",targetSize);

}




int AM29F800_CheckId(void)
{
    unsigned short manId,devId;

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

    _RESET(); // New 5V AM29F800 needs this command. 
    _WR(0x555,0xaaaa);
    _WR(0x2aa,0x5555);
    _WR(0x555,0x9090);
    devId=_RD(0x1);

    _RESET();   

    printf("Manufacture ID(0x0001)=%4x, Device ID(0x22xx)=%4x\n",manId,devId);

    if(manId==0x0001 && devId==0x22bf) return 1; // AM29LV200B
    else if(manId==0x0001 && devId==0x22ba) return 2; // AM29LV400B
    else if(manId==0x0001 && devId==0x225b) return 3; // AM29LV800B
    else if(manId==0x0001 && devId==0x2249) return 4; // AM29LV160B        
    else if(manId==0x0004 && devId==0x2249) return 4; // 29LV160B fairchild        
    else return 0;
}


void AM29F800_EraseSector(int targetAddr)
{
        printf("Erasing a sector 0x%x is started!\n", targetAddr);

        _RESET();

        _WR(0x555,0xaaaa);
        _WR(0x2aa,0x5555);
        _WR(0x555,0x8080);
        _WR(0x555,0xaaaa);
        _WR(0x2aa,0x5555);
        _WR(BADDR2WADDR(targetAddr),0x3030);
        _WAIT();
        _RESET();
}

void AM29F800_EraseAll(void) // It takes too many time to erase all
{
        printf("Erasing a chip is started!\n");

        _RESET();

        _WR(0x555,0xaaaa);
        _WR(0x2aa,0x5555);
        _WR(0x555,0x8080);
        _WR(0x555,0xaaaa);
        _WR(0x2aa,0x5555);
        _WR(0x555,0x1010);
        _WAIT();
        _RESET();

        printf("Erasing device is completed!\n");
}


int BlankCheck(int targetAddr,int targetSize)
{
    int i,j;
    for(i=0;i<targetSize;i+=2)
    {
		j=*((unsigned short *)(i+targetAddr+bank_of_nor));
		if( j!=0xffff)
		{
		    printf("Error!! [Addr:0x%x, Data:0x%x]\n",(i+targetAddr),j);
		    return 0;
		}
    }
    return 1;
}




int _WAIT(void) //Check if the bit6 toggle ends.
{
	volatile unsigned short flashStatus,old;

	old=*((volatile unsigned short *)bank_of_nor);

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




int AM29F800_ProgFlash(unsigned int realAddr,unsigned short data)
{
	volatile unsigned short *tempPt;

        tempPt=(volatile unsigned short *)(realAddr+bank_of_nor);
        _WR(0x555,0xaaaa);
        _WR(0x2aa,0x5555);
        _WR(0x555,0xa0a0);
        *tempPt=data;
        
	return _WAIT();

}