am29lv160.c

ucos for 2410 Bootloader,for norflash

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

#define	PROGRAMSTART_ADDR 0x8000  //the second sector
#define FLASHSECTOR_SIZE 0x10000
 
int AM29LV160_ProgFlash(U32 realAddr,U16 data);
void AM29LV160_EraseSector(U32 targetAddr);
int AM29LV160_CheckId(void);
int BlankCheck(U32 targetAddr);
int _WAIT(void); 

#define _WR(addr,data)	*((volatile U16 *)(addr<<1))=(U16)data
#define _RD(addr)	*((volatile U16 *)(addr<<1))
#define _RESET()	_WR(0x0,0xf0)
#define BADDR2WADDR(addr)   (addr>>1)

extern U32 downloadAddress; 
extern U32 downloadProgramSize;

void ProgramAM29LV160(void)
{
    U32 i;
    U32 SectorUsed;
    U32 srcAddress;
	U32 srcOffset;
	U32 targetAddress; //the real addr in memory map

    SectorUsed = downloadProgramSize >> 16;
    if(downloadProgramSize & 0xffff)
    	SectorUsed++;
    
   	srcAddress=downloadAddress+4; //to discard the data head for the size
    targetAddress = PROGRAMSTART_ADDR << 1;

    Uart_Printf("[Check AM29LV160]\n");
    if(!AM29LV160_CheckId())
    {
//		Uart_Printf("ID Check Error!!!\n");
//		return;
    }
    for(i=0; i<SectorUsed; i++)
    {
	    Uart_Printf("Erase the sector:0x%x.\n",targetAddress);
        AM29LV160_EraseSector(targetAddress);
	    if(!BlankCheck(targetAddress))
    	{
			Uart_Printf("Blank Check Error!!!\n");
			return;
		}
	    Uart_Printf("Start of data writing.\n");

    	for(srcOffset=0x0; srcOffset<FLASHSECTOR_SIZE;srcOffset+=2) 
    	{
        	AM29LV160_ProgFlash(srcOffset+targetAddress,*((U16 *)(srcAddress+srcOffset)));
    	}
    	Uart_Printf("End of the sector writing!!!\n");

	    _RESET();

    	Uart_Printf("Verifying Start.\n");
    	for(srcOffset=0x0; srcOffset<FLASHSECTOR_SIZE; srcOffset+=2) 
   		{
        	if(*((U16 *)(srcOffset+targetAddress))!=*((U16 *)(srcAddress+srcOffset)))
			{    
	    		Uart_Printf("%x=verify error\n",srcOffset+targetAddress);
	    		return;
			}
    	}
    	Uart_Printf("Verifying End!!!\n");
    	targetAddress += 1<<16;
	    srcAddress += 1<<16;
    }
    Uart_Printf("All write finished!\n");
}



int AM29LV160_CheckId(void)
{
    U16 manId,devId;

    _RESET();
    
    _WR(0x555,0xaa);
    _WR(0x2aa,0x55);
    _WR(0x555,0x90);
    manId=_RD(0x0);
        
    _RESET(); // New 5V AM29F800 needs this command. 
    _WR(0x555,0xaa);
    _WR(0x2aa,0x55);
    _WR(0x555,0x90);
    devId=_RD(0x1);

    _RESET();   

    Uart_Printf("Manufacture ID=%x(0x0004), Device ID(0x22c4)=%x\n",manId,devId);

    if(manId==0x4 && devId==0x22c4)return 1;
    else return 0;
}




void AM29LV160_EraseSector(U32 targetAddr)
{
        Uart_Printf("Sector Erase is started!\n");

        _RESET();

        _WR(0x555,0xaa);
        _WR(0x2aa,0x55);
        _WR(0x555,0x80);
        _WR(0x555,0xaa);
        _WR(0x2aa,0x55);
        _WR(BADDR2WADDR(targetAddr),0x30);
        _WAIT();
        _RESET();
}




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




int _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 AM29LV160_ProgFlash(U32 realAddr,U16 data)
{
	volatile U16 *tempPt;

        tempPt=(volatile U16 *)realAddr;
        _WR(0x555,0xaa);
        _WR(0x2aa,0x55);
        _WR(0x555,0xa0);
        *tempPt=data;
        
	return _WAIT();

}