i28f128.c

IXP425的BSP代码

#include <stdio.h>
#include "tffs/flflash.h"
#include "tffs/backgrnd.h"

/* support 28f320 28f640 28f128*/
#undef CFI_DEBUG 
#ifdef CFI_DEBUG
#define DEBUG_PRINT    printf
#else
#undef DEBUG_PRINT
#endif

/* JEDEC ids for this MTD */
#define I28F128_FLASH		0x18 		/* device code 28F128 */
#define I28F640_FLASH		0x17 		/* device code 28F640 */
#define I28F320_FLASH		0x16 		/* device code 28F320 */

#define SETUP_ERASE	0x2020
#define SETUP_WRITE	0x4040
#define CLEAR_STATUS	0x5050
#define READ_STATUS	0x7070
#define READ_ID 	0x9090
#define SUSPEND_ERASE	0xb0b0
#define CONFIRM_ERASE	0xd0d0
#define	RESUME_ERASE	0xd0d0
#define READ_ARRAY	0xffff

#define STAT_WSMS	0x0080

/* Defintion for Bit macro */
#ifndef BIT    
#define BIT(bitNumber)		(1 << (bitNumber))
#endif /* BIT */

static FLStatus i28f128Write(FLFlash vol,
			   CardAddress address,
			   const void FAR1 *buffer,
			   int length,
			   FLBoolean overwrite)
{
	unsigned long writeTimeout;
	int           i;
	FlashWPTR flashPtr;
	FlashWPTR ptr;
	STATUS retVal;
	
#ifdef DEBUG_PRINT
	DEBUG_PRINT("Debug: Entering i28f128Write function.\n");
	DEBUG_PRINT("Debug: address=0x%x, length=%d, overwrite=%d\n", address, length, overwrite);
#endif
	
	if ( flWriteProtected(vol.socket) )
		return flWriteProtect;
		
	if ((length & 1) || (address & 1))	/* Only write words on word-boundary */
		return flBadParameter;
		
	flashPtr = (FlashWPTR) flMap(vol.socket, address);

	/* Set timeout to 5 seconds from now */
	writeTimeout = flMsecCounter + 5000;

	retVal = OK;
	ptr = flashPtr;
	for (i = 0; i < length ; i += 2, ptr++)
	{	
		unsigned short value;
		
		value = *((FlashWPTR)(buffer + i));
		
		*ptr = SETUP_WRITE;
		*ptr = value;		
		do
		{
			/*ptr = READ_STATUS;*/
			if (flMsecCounter > writeTimeout)
			{
				retVal = ERROR;
				*ptr = CLEAR_STATUS;
				break;
			}
		}while((*ptr & STAT_WSMS) != STAT_WSMS);
		if (retVal == ERROR)
		{
			*ptr = READ_ARRAY;
			break;
		}
			
		if (*ptr & (BIT(5) | BIT(4) | BIT(3) | BIT(1)))
		{
			retVal = ERROR;
			*ptr = CLEAR_STATUS;
		}
		if (retVal == ERROR)
		{
			*ptr = READ_ARRAY;
			break;
		}
		
		*ptr = READ_ARRAY;
	}
	if (retVal == ERROR)
	{
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: In i28f128Write, write failed\n");
#endif
		return flWriteFault;
	}
		
	if (tffscmp((void FAR0 *)flashPtr, buffer, length))
	{
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: In i28f128Write, write  data error\n");
		{
			int i;
			/*dump data*/
			for (i = 0; i < length/2; i++)
			{
				unsigned short data;

				data = *((unsigned short*)(buffer + i * 2));
				
				DEBUG_PRINT("%x==>%x\n", data, *(flashPtr+i));
			}
		}
#endif
		return flWriteFault;
	}

#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: In i28f128Write, erase OK\n");
#endif
	return flOK;	
}

static FLStatus i28f128Erase (FLFlash  vol,
                                int      firstBlock,
                                int      numOfBlocks)
{
	unsigned long writeTimeout;
	FlashWPTR ptr;
	int        i;
	STATUS retVal;	

#ifdef DEBUG_PRINT
	DEBUG_PRINT("Debug: Entering i28f128Erase function.\n");
	DEBUG_PRINT("Debug: firstblock=%d, numOfBlocks=%d.\n", firstBlock, numOfBlocks);
#endif

	if ( flWriteProtected(vol.socket) )
		return flWriteProtect;

	/* Set timeout to 5 seconds from now */
	writeTimeout = flMsecCounter + 5000;

	retVal = OK;	
	for (i = 0;  i < numOfBlocks;  i++)
	{
		ptr = (FlashWPTR) flMap(vol.socket, (firstBlock + i) * vol.erasableBlockSize);
		
#ifdef DEBUG_PRINT
	DEBUG_PRINT("Debug: Erase ptr=0x%x.\n", ptr);
#endif
				
		*ptr = SETUP_ERASE;
		*ptr = CONFIRM_ERASE;
		
		do
		{
			if (flMsecCounter > writeTimeout)
			{
				retVal = ERROR;
				*ptr = CLEAR_STATUS;
				break;
			}
		}while((*ptr & STAT_WSMS) != STAT_WSMS);
		if (retVal == ERROR)
		{
			*ptr = READ_ARRAY;
			break;
		}
		
		if (*ptr & (BIT(5) | BIT(4) | BIT(3) | BIT(1)))
		{
			retVal = ERROR;
			*ptr = CLEAR_STATUS;
		}
		if (retVal == ERROR)
		{
			*ptr = READ_ARRAY;
			break;
		}
		
		*ptr = READ_ARRAY;
	}
	
	if (retVal == ERROR)
	{
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: In i28f128Erase, erase failed\n");
#endif
		return flWriteFault;
	}

#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: In i28f128Erase, erase OK\n");
#endif
	return flOK;	
}

FLStatus i28f128Identify(FLFlash vol)
{
	FlashWPTR flashPtr;

#ifdef DEBUG_PRINT
	DEBUG_PRINT("Debug: Entering i28f128Identify.\n");
#endif

	flSetWindowBusWidth(vol.socket,16);/* use 16-bits */
	flSetWindowSpeed(vol.socket,120);  /* 120 nsec. */
	flSetWindowSize(vol.socket,2);	/* 8 KBytes */

	flashPtr = (FlashWPTR) flMap(vol.socket,0);
  
	flashPtr[0] = READ_ARRAY;
	flashPtr[1] = READ_ID;
	switch (flashPtr[1])
	{
	case I28F640_FLASH:
		vol.type = I28F640_FLASH;
		vol.chipSize = 0x800000;
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: Detect Intel 28f640\n");
#endif	
		break;	
	case I28F320_FLASH:
		vol.type = I28F320_FLASH;
		vol.chipSize = 0x400000;
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: Detect Intel 28f320\n");
#endif	
		break;
	case I28F128_FLASH:
		vol.type = I28F128_FLASH;
		vol.chipSize = 0x1000000;
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: Detect Intel 28f128\n");
#endif	
		break;
	default:
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: Can't detect flash type\n");
#endif	
		vol.type = NOT_FLASH;
#ifdef DEBUG_PRINT
		DEBUG_PRINT("Debug: failed to identify 16-bit Intel media.\n");
#endif
		return flUnknownMedia; 	/* not ours */  	
	}  	

	flashPtr[0] = READ_ARRAY;
	vol.interleaving = 1;
	vol.noOfChips = 1;
	vol.erasableBlockSize = 128*1024;

	/* Register our flash handlers */
	vol.write = i28f128Write;
	vol.erase = i28f128Erase;
  
#ifdef DEBUG_PRINT  
	DEBUG_PRINT("Debug: identified 16-bit Intel media.\n");
#endif  

	return flOK;
}