func.c

nor flash烧写源代码,非常实用啊

#include "Func.h"
#include "Types.h"


 
/*
 *	func_toggle() - 
 *		Used to check the toggle bit (Q6). This can be used 
 *		to detect if the write/erase operation is completed.
 *
 *	Return:
 *		0 - Successful.
 *		1 - Time out.
 */
int func_toggle(U32 sysbase, U32 addr)
{
    U8 old_data;
    U8 new_data;

    old_data = *SysAddr8(sysbase, addr);
    old_data = old_data & 0x40;   	 	// read DQ6
	while(1)
    {
	    new_data = *SysAddr8(sysbase, addr);
	    new_data = new_data & 0x40;    	// read DQ6
        if (new_data == old_data)
        {
		    return 0;
        }
		old_data = new_data;
    }
    
    return 1;
}



/*
 *	func_readid() -
 *		Used to read the flash id.
 */
U32 func_readid(U32 sysbase)
{
	U32 id;
	U8  mid;
	U8  did;

	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2aAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0x90;
				
	mid = *SysAddr8(sysbase, 0x0);
	did = *SysAddr8(sysbase, 0x1);
	id  = mid | (did << 16);
	
	*SysAddr8(sysbase, 0x5555) = 0xF0;
	
	return id;
}



/*
 *	func_erase_sector() -
 *		Used to erase a sector.
 *
 *	Input:
 *		addr  - Address
 *		size8 - Size of target sector in terms of bytes.
 *
 *	Return: 
 *		0 - Successful
 *		1 - Error
 */
int func_erase_sector(U32 sysbase, U32 addr, U32 size8)
{
	int i;
	int ret;
	
	//Erase
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0x80;
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, addr)   = 0x30;

	//Wait
	ret = func_toggle(sysbase, addr);	
	if(ret != 0)
		return 1;		
	
	//Verify
	for(i = 0; i < size8; i += 4){
		if( *((volatile U32*)(sysbase + addr + i)) != 0xFFFFFFFF )
			return 1;				
	}
	
	return 0;	
}



/*
 *	func_erase_chip() -
 *		Used to erase the entire chip.
 *
 *	Input:
 *		size8 - Length of target flash in terms of bytes.
 *
 *	Return: 
 *		0 - Successful
 *		1 - Error 
 */
int func_erase_chip(U32 sysbase, U32 size8)
{
	int i;
	int ret;
		
	//Erase Chip
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0x80;
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0x10;
	
	//Wait
	ret = func_toggle(sysbase, 0);	
	if(ret != 0)
		return 1;	
	
	//Verify
	for(i = 0; i < size8; i += 4){
		if( *((volatile U32*)(sysbase + i)) != 0xFFFFFFFF )
			return 1;					
	}	
	
	return 0;
}



/*
 *	func_program32() -
 *		Used to program a 32-bit word into the flash chip.
 *
 *	Input:
 *		addr - Destination address.
 *		data - Data to be programmed.
 *
 *	Return: 
 *		0 - Successful
 *		1 - Error 
 */
int func_program32(U32 sysbase, U32 addr, U32 data)
{
	int ret;
	U8 *p8;
	
	addr &= 0xFFFFFFFC;
	p8 = (U8*)(&data);
	
	//Program
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0xA0;
	*SysAddr8(sysbase, addr)   = *p8;
		
	//Check
	ret = func_toggle(sysbase, addr);
	if(ret != 0)
		return 1;
		
	
	//Program
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0xA0;
	*SysAddr8(sysbase, addr+1) = *(p8+1);
		
	//Check
	ret = func_toggle(sysbase, addr+1);
	if(ret != 0)
		return 1;	
		
		
	//Program
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0xA0;
	*SysAddr8(sysbase, addr+2) = *(p8+2);
		
	//Check
	ret = func_toggle(sysbase, addr+2);
	if(ret != 0)
		return 1;	
		
		
	//Program
	*SysAddr8(sysbase, 0x5555) = 0xAA;
	*SysAddr8(sysbase, 0x2AAA) = 0x55;
	*SysAddr8(sysbase, 0x5555) = 0xA0;
	*SysAddr8(sysbase, addr+3) = *(p8+3);
		
	//Check
	ret = func_toggle(sysbase, addr+3);
	if(ret != 0)
		return 1;	
				
				
	//Verify
	if( *((volatile U32*)(sysbase + addr)) != data )
		return 1;

	return 0;
}