/* sst39vf160.c - SST39VF160 MTD driver *//* Copyright 2004-2005 Amine@263.net *//************************************************************************//*                                                                      *//*		FAT-FTL Lite Software Development Kit			*//*		Copyright (C) M-Systems Ltd. 1995-1996			*//*									*//************************************************************************//*modification history--------------------01o,28jul04,a_m  BSP定制 for 思創S3C44B0X黃金開發板*/#include "intLib.h"#include "stdio.h"#include "tffs/flflash.h"#include "config.h"/* NOTE:	!!!UNLOCK_ADDR為字地址, 賦值轉換x2	!!!使用自己的地址映射函數	!!!中斷向量表在同一片Flash存儲器上,擦除和寫入操作時需要屏蔽中斷*//* 需與sysTffs.c中相同定義一致 */#if(BOARD_TYPE == BOARD_ARMEPS) /*ARMCORE V1.0*/#define	FLASH_BASE_ADRS		0x2000000#define	FLASH_SIZE			0x0400000#else#define	FLASH_BASE_ADRS		ROM_SIZE#define	FLASH_SIZE		(0x00200000-ROM_SIZE)#endiftypedef struct {	FlashWPTR	unlockAddr1;	FlashWPTR  	unlockAddr2;} Vars;static Vars mtdVars[DRIVES];#define thisVars   ((Vars *) vol.mtdVars)#undef DEBUG_PRINT	/* 調試信息輸出宏定義 */static void FAR0* sst39vf160Map(FLFlash* pVol,	CardAddress address, int length);static FLStatus sst39vf160Erase	(FLFlash vol, int firstErasableBlock, int numOfErasableBlocks);static FLStatus sst39vf160Write	(FLFlash vol, CardAddress address, const void FAR1 *buffer, int length, int modes);static STATUS  doneDetect(void * ptr,  int timeCounter);/*------------------------------------------------------------------------ Procedure:     sst39vf160Identify ID:1 Purpose:       MTD入口函數 Input:          Output:		 Errors:------------------------------------------------------------------------*/FLStatus sst39vf160Identify(FLFlash vol){	FlashWPTR  baseFlashPtr;#ifdef DEBUG_PRINT  	DEBUG_PRINT("Debug: entering 16-bit SST media identification routine.\n");#endif	flSetWindowBusWidth(vol.socket, 16);	/* use 16-bits */	flSetWindowSpeed(vol.socket, 90);  		/* 90 nsec */	flSetWindowSize(vol.socket, FLASH_SIZE>>12);	vol.interleaving = 1; 	vol.chipSize = FLASH_SIZE;	vol.noOfChips = 0x1;	                /* one chip */	vol.erasableBlockSize = 0x1000;      	/* 4k bytes */  	vol.flags |= SUSPEND_FOR_WRITE;	vol.map   = sst39vf160Map;		vol.erase = sst39vf160Erase;	vol.write = sst39vf160Write;	vol.mtdVars = &mtdVars[flSocketNoOf(vol.socket)];	baseFlashPtr = (FlashWPTR)vol.map (&vol, (CardAddress)0, vol.interleaving);	/*!!!UNLOCK_ADDR為字地址, 賦值轉換x2*/	thisVars->unlockAddr1 = (FlashWPTR)((long)baseFlashPtr) + 0x5555;	thisVars->unlockAddr2 = (FlashWPTR)((long)baseFlashPtr) + 0x2aaa;	return flOK;}/*------------------------------------------------------------------------ Procedure:     sst39vf160Map ID:1 Purpose:       映射Flash片內地址為CPU全局地址 Input:         address-相對地址 Output:		 Errors:------------------------------------------------------------------------*/static void FAR0* sst39vf160Map(FLFlash* pVol,	CardAddress address, int length){	void FAR0* pFlash = (void FAR0*) (FLASH_BASE_ADRS + address);	return(pFlash);}/*------------------------------------------------------------------------ Procedure:     sst39vf160Erase ID:1 Purpose:       MTD擦除Flash函數 Input:          Output:		 Errors:------------------------------------------------------------------------*/static FLStatus sst39vf160Erase	(FLFlash vol, int firstErasableBlock, int numOfErasableBlocks){	int iBlock, i; 			FlashWPTR flashPtr;	unsigned int offset;	int level;	if(numOfErasableBlocks <= 0) return ERROR;	for (iBlock = 0; iBlock < numOfErasableBlocks; iBlock++) {		offset = (firstErasableBlock + iBlock) * vol.erasableBlockSize;		flashPtr = (FlashWPTR) vol.map(&vol, offset, vol.interleaving);#ifdef DEBUG_PRINT    	DEBUG_PRINT("Debug: sst39vf160Erase - flashPtr=0x%x, first=%d, number=%d.\n", flashPtr, firstErasableBlock, numOfErasableBlocks);#endif		*thisVars->unlockAddr1 = 0xaa;	    *thisVars->unlockAddr2 = 0x55;	    *thisVars->unlockAddr1 = 0x80;		*thisVars->unlockAddr1 = 0xaa;	    *thisVars->unlockAddr2 = 0x55;	    #if(BOARD_TYPE != BOARD_ARMEPS) /*ARMCORE V1.0*/		level = intLock();		#endif		*flashPtr = 0x30;		doneDetect((void *)flashPtr, 0x2000000);				  		for(i=0; i<vol.erasableBlockSize/2; i++,flashPtr++){		   if(*flashPtr != 0xffff)  break;		}		*flashPtr = 0xf0;		#if(BOARD_TYPE != BOARD_ARMEPS) /*ARMCORE V1.0*/		intUnlock(level);		#endif		if(i < vol.erasableBlockSize/2)	{#ifdef DEBUG_PRINT			DEBUG_PRINT("Debug: sst39vf160Erase fail.\n");#endif			return flWriteFault;		}	}		return flOK;}/*------------------------------------------------------------------------ Procedure:     sst39vf160Write ID:1 Purpose:       MTD寫Flash函數 Input:          Output:		 Errors:------------------------------------------------------------------------*/static FLStatus sst39vf160Write	(FLFlash vol, CardAddress address, const void FAR1 *buffer, int length, int modes){	int cLength; int level;	FlashWPTR flashPtr, flashTmp;	volatile UINT16 *gBuffer;	flashTmp = flashPtr = (FlashWPTR) vol.map(&vol, address, length);#ifdef DEBUG_PRINT    DEBUG_PRINT("Debug: sst39vf160Write - flashPtr=0x%x, buffer=0x%x, length=%d, modes=%d.\n", flashPtr, buffer, length, modes);#endif	if(length&1)		printf("warning! the data length can not divided by 2.");		cLength = length/2;	gBuffer = (UINT16 *)buffer;	while (cLength >= 1) {		*thisVars->unlockAddr1 = 0x0aa;    	*thisVars->unlockAddr2 = 0x55;    	#if(BOARD_TYPE != BOARD_ARMEPS) /*ARMCORE V1.0*/		level = intLock();		#endif	    *thisVars->unlockAddr1 = 0x0a0;		*flashPtr = *gBuffer;		doneDetect((void *)flashPtr, 0x1000000);		if(*flashPtr != *gBuffer) {			*flashPtr = 0xf0;#ifdef DEBUG_PRINT			DEBUG_PRINT("Debug: sst39vf160Write timeout.\n");#endif			return flWriteFault;		}		#if(BOARD_TYPE != BOARD_ARMEPS) /*ARMCORE V1.0*/		intUnlock(level);		#endif		cLength--;		flashPtr++;		gBuffer++;	}	if (tffscmp((void FAR0 *)flashTmp, buffer,length))	{#ifdef DEBUG_PRINT		DEBUG_PRINT("Debug: sst39vf160Write fail.\n");#endif		return flWriteFault;	}	return flOK;}/*------------------------------------------------------------------------ Procedure:     doneDetect ID:1 Purpose:       探測write,erase操作是否結束,超時錯誤 Input:          Output:		 Errors:------------------------------------------------------------------------*/static STATUS  doneDetect(void * ptr,  int timeCounter){	FlashWPTR pFlash = ptr;	INT16 buf1,buf2;		buf1 = *pFlash & 0x40;	while(1){		buf2  = *pFlash & 0x40;		if(buf1 == buf2) break; /* D6位沒有跳變表示操作結束 */		else buf1 = buf2;		if(timeCounter-- <= 0) return ERROR;	}	return OK;}