|
|
/*
* $Log: V:/Flite/archives/TrueFFS5/Src/NFTLLITE.C_V $ * * Rev 1.27 Apr 15 2002 07:38:22 oris * Added support for RAM based MTD power failure tests. * Remove cache allocation checks - They are not needed since the cache routine itself check for proper allocation. * Improved power failure resistant: * - Added support for VERIFY_ERASED_SECTOR compilation flag - make sure a sector is free before writing it. * - writeAndCheck() - * 1) Added an option to verify that the sector is erased before writing. * It subject to the FL_UPS/FL_OFF/FL_ON modes of the flVerifyWrite environment variable. * 2) Added support for partition > 0. * - getUnitData() - Bug fix - in case of invalid replacement unit if we are mounting or formatting store physical unit number in * invalidReplacement field of the Anand record otherwise mark head of chain as frozen and not the unit itself. * - Bug fix - Added logic to find end of endless loops - findEndOfEndlessLoop() * - virtual2Physical() - Added call to findEndOfEndlessLoop() if needed and return address of next free sector (used verifySector()). * - initNFTL() - Added initialization of TL verifyBuffer buffer and invalidReplacement fields. * - Separated the search for a free unit in physical table from allocateUnit() into dedicated routine findFreeUnit(). * - foldUnit() * 1) Added support for partition > 0. * 2) Prevent a recursive call to foldUnit by changing allocateUnit() with findFreeUnit(). * 3) Added logic for endless loops. * 4) Added check that last sector of chain can be used. * - foldBestChain() - revised the entire routine * 1) If folding not in place was forced free all frozen units. * 2) Validate that a unit was actually freed. * - mountUnit() - * 1) In case of bad virtual unit number format the unit . An invalid virtual unit might be a result of power failures. * - allocateAndWrite() - Bug fix - sector count might be incorrectly updated in case folding found a sector with bad EDC. * - mountNFTL - * 1) Moved badFormat initialization to the end of the routine so that getUnitData() might know if it was called by mount routine. * 2) Made sure there is at least 1 free unit. * 3) Fold chains with invalid pointer in their end of chain - caused by power failures. * - Added MAKE_SURE_IGNORE_HAS_BAD_EDC compilation flag - make sure that the sector is really marked * - verifySector() - was completely revised. * * Rev 1.26 Feb 19 2002 21:00:56 oris * Compilation errors - NO_READ_BBT_CODE * Removed warnings. * Replaced TL_LEAVE_BINARY_AREA with FL_LEAVE_BINARY_AREA * * Rev 1.25 Jan 29 2002 20:09:58 oris * Bug fix - if an invalid sector flag is found in getSectorFlags routine and read operation failed, SECTOR_IGNORED should have been returned. * * Rev 1.24 Jan 23 2002 23:33:56 oris * Improved markAsIgnored routine. * Changed DFORMAT_PRINT syntax. * * Rev 1.23 Jan 20 2002 20:29:26 oris * Remove warnings * Bug fix - Missing cache buffers allocation check in formatUnit. * * Rev 1.22 Jan 17 2002 23:04:22 oris * Added onesCount routine - number of bits in a byte. * Improved FL_READ_ONLY compilation mode. * Flash field of the TL was changed to a pointer. * Added check verifyVolume routine to issue a longer, but safer mount. * Moved RAM tables to far heap to allow BIOS driver to allocate far memory heap even when compiled as tiny model: * - InitTables : allocation was change from FL_MALLOC to FL_FAR_MALLOC. * - mountUnit : changes pointer to virtual table to be FAR. * - mountNFTL : * - changes pointer to virtual table to be FAR. * - allocation of cache tables was change from FL_MALLOC to FL_FAR_MALLOC. * - dismount : use FL_FAR_FREE instead of FL_FREE * formatUnit routine improved re-initialization of sector cache. * Changed flPolicy to be socket specific. * Added \r to all DEBUG_PRINT. * writeSector routine if this sector is the cached sector then force re-mapping. * Bug fix in formatNFTL : * - Add binary length to percentage of bad blocks. * - Report error if there is not enough good blocks. * - Report error if block 0 is bad. * New power failures protection algorithm * - setUnitData : When verify write is on , no need to reread unit data * - getSectorFlags : if flags is not valid (including SECTOR_IGNORE) check EDC and bit distance instead of simple or. * - virtual2Physical : Added endAddress parameter to allow retrieval of not the newest sector. * - writeAndCheck : * - Toggle socket verify write mode according to global verify write mode. * - Moved the marking of the sector as bad into a dedicated routine (markAsIgnored) * - initNftl : * - Init FLFlash pointer (and not structure) * - Init socket number of the TL * - Init verifiedSectorNo for FL_OFF verify write mode * - swapUnits : Catch failed folding operation * - Moved copySector routine into foldUnit. * - Changed chain bound for all chains "for loops" to the constant DOUBLE_MAX_UNIT_CHAIN (support MAX_UNIT_CHAIN of 1 in case of folding not in place). * - foldUnit : * - When verify write is set to FL_OFF call verifySectors routine to gradually scan the entire media * - Force re-mapping of cached sector * - Add force folding parameter * - Toggle socket verify write mode according to verify write mode and currently scanned sector number * - Verify copied sector EDC even for last sector of chain (no need to copy it) and if bad freeze chain and return flCanNotFold (unless forced folding is issued) * - In case of bad EDC use older sector. * - In case write operation failed (could be partially written sector that was discovered by verify write mode) freeze chain and return flCanNotFold (unless forced folding is issued) * - foldBestChain : if folding of the chosen unit failed, freeze and try another unit MAX_FOLDING_TRIES times. * - allocateUnit : free media space even if there is a free unit available * - mapSector : if sector has bad EDC read older sector until no sectors were found or chain bound has been reached * - allocateAndWriteSector : * - Catch failed folding operation. * - Set curSectorWrite to current sector so that writeAndCheck routine will be able to decide whether to verify this sector or not while in FL_OFF verify mode. * - deleteSectors : Catch failed folding operation. * - mountNFTL : * - Set default verify write policy to FL_UPS. * - Set checkVolme routine pointer. * - Added checkVolume / checkFolding / verifySectors and markAsIgnored routines. * * Rev 1.21 Nov 21 2001 11:38:04 oris * Changed FL_MARK_DELETE to FL_ON. * * Rev 1.20 15 Nov 2001 16:28:24 dimitrys * Fix Big BDK partition with Bad Units problem in formatNFTL() * * Rev 1.19 Sep 25 2001 15:39:58 oris * Removed warnings. * * Rev 1.18 Jul 29 2001 18:48:50 oris * Bug fix - unit 0 of floors > 0 were not marked as bad blocks therefore future write operation might force the device into external eprom mode. * * Rev 1.17 Jul 15 2001 20:45:26 oris * Changed DFORMAT_PRINT syntax to be similar to DEBUG_PRINT. * * Rev 1.16 Jul 13 2001 01:08:38 oris * Removed EDC for media header. * Added dformat debug print for virgin media. * * Rev 1.15 Jun 17 2001 16:39:12 oris * Improved documentation and remove warnings. * * Rev 1.14 Jun 17 2001 08:17:34 oris * Removed warnings. * Changed erase routine to formatUnit. * Bug fix - original meida header was not written. * Added NO_READ_BBT_CODE compilation flag to reduce code size. * * Rev 1.13 May 29 2001 23:12:28 oris * Added EDC check of the media header both in the mount and format routines. * * Rev 1.12 May 16 2001 21:21:26 oris * Added EDC check for media header. * Added the FL_ prefix to the following defines: ON , OFF, MALLOC and FREE. * Changed wear level counter from 0xFF to 0xFFF0 * * Rev 1.11 May 06 2001 22:42:26 oris * Removed warnings. * * Rev 1.10 May 01 2001 16:33:46 oris * Bug fix - readBBT routine returned used blocks as bad. * * Rev 1.9 Apr 30 2001 18:03:30 oris * Bug fix - marking binary partition blocks of devices that use artifitial large erase blocks (units). * Added support for the flMarkDeleteOnFlash environment variable. * * Rev 1.8 Apr 24 2001 17:10:14 oris * Bug fix - readBBT routine missing casting. * * Rev 1.7 Apr 16 2001 13:56:46 oris * Removed warrnings. * * Rev 1.6 Apr 09 2001 15:04:42 oris * End with an empty line. * * Rev 1.5 Apr 01 2001 07:55:42 oris * copywrite notice. * changed SEPERATED to SEPARATED. * Changed SEPARATED_CASCADED ifdef to a runtime if. * * Rev 1.3 Feb 14 2001 02:03:38 oris * Changed readBBT to return media size. * * Rev 1.2 Feb 12 2001 12:10:56 oris * Moved SEPARATED cascaded to include more uneeded code. * Rewritten readBBT to support far pointers. * * Rev 1.1 Feb 07 2001 17:46:26 oris * Added SEPARATED_CASCADED compilation flag * * Rev 1.0 Feb 05 2001 12:24:18 oris * Initial revision. * */
/***********************************************************************************//* M-Systems Confidential *//* Copyright (C) M-Systems Flash Disk Pioneers Ltd. 1995-2001 *//* All Rights Reserved *//***********************************************************************************//* NOTICE OF M-SYSTEMS OEM *//* SOFTWARE LICENSE AGREEMENT *//* *//* THE USE OF THIS SOFTWARE IS GOVERNED BY A SEPARATE LICENSE *//* AGREEMENT BETWEEN THE OEM AND M-SYSTEMS. REFER TO THAT AGREEMENT *//* FOR THE SPECIFIC TERMS AND CONDITIONS OF USE, *//* OR CONTACT M-SYSTEMS FOR LICENSE ASSISTANCE: *//* E-MAIL = [email protected] *//***********************************************************************************/
#include "nftllite.h"
#include "nanddefs.h"
#ifndef FL_READ_ONLY
#if (defined(VERIFY_WRITE) || defined (VERIFY_VOLUME) || defined(VERIFY_ERASED_SECTOR))
static FLStatus checkVolume(Anand vol);static FLStatus verifySectors(Anand vol, dword sectorCount);#endif /* VERIFY_WRITE || VERIFY_VOLUME || VERIFY_ERASED_SECTOR */
static void markAsIgnored(Anand vol,CardAddress addr);static FLStatus foldBestChain(Anand vol, ANANDUnitNo *unitNo);static FLStatus foldUnit(Anand vol, ANANDUnitNo virtualUnitNo, FLBoolean);static FLStatus checkFolding(Anand vol, ANANDUnitNo virtualUnitNo);static FLStatus allocateUnit(Anand vol, ANANDUnitNo *);#endif /* FL_READ_ONLY */
static Anand vols[VOLUMES];
#ifdef NFTL_CACHE
/* translation table for Sector Flags cache */static unsigned char scacheTable[4] = { SECTOR_DELETED, /* 0 */ SECTOR_IGNORE, /* 1 */ SECTOR_USED, /* 2 */ SECTOR_FREE }; /* 3 */#endif /* NFTL_CACHE */
#ifdef FORMAT_VOLUME
byte ff[ANAND_SPARE_SIZE];#endif /* FORMAT_VOLUME */
/*------------------------------------------------------*//* o n e s C o u n t *//* *//* counts number of bits that valued 1 in a given byte *//*------------------------------------------------------*/
static byte onesCount(byte flag){ byte counter;
for (counter = 0; flag; flag >>= 1) if (flag & 1) counter++;
return counter;}
/*----------------------------------------------------------------------*//* u n i t B a s e A d d r e s s *//* *//* Returns the physical address of a unit. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* *//* Returns: *//* physical address of unitNo *//*----------------------------------------------------------------------*/
static CardAddress unitBaseAddress(Anand vol, ANANDUnitNo unitNo){ return (CardAddress)unitNo << vol.unitSizeBits;}
/*----------------------------------------------------------------------*//* g e t U n i t D a t a *//* *//* Get virtual unit No. and replacement unit no. of a unit. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* virtualUnitNo : Receives the virtual unit no. *//* replacementUnitNo : Receives the replacement unit no. *//* *//*----------------------------------------------------------------------*/
static void getUnitData(Anand vol, ANANDUnitNo unitNo, ANANDUnitNo *virtualUnitNo, ANANDUnitNo *replacementUnitNo){ ANANDUnitHeader unitData;
#ifdef NFTL_CACHE
/* check ANANDUnitHeader cache first */ if (vol.ucache != NULL) { /* on cache miss read ANANDUnitHeader from flash and re-fill cache */ if((vol.ucache[unitNo].virtualUnitNo == 0xDEAD) && (vol.ucache[unitNo].replacementUnitNo == 0xDEAD)) { vol.flash->read(vol.flash, unitBaseAddress(&vol,unitNo) + UNIT_DATA_OFFSET, &unitData, sizeof(ANANDUnitHeader), EXTRA);
vol.ucache[unitNo].virtualUnitNo = LE2(unitData.virtualUnitNo) | LE2(unitData.spareVirtualUnitNo); vol.ucache[unitNo].replacementUnitNo = LE2(unitData.replacementUnitNo) | LE2(unitData.spareReplacementUnitNo); }
*virtualUnitNo = vol.ucache[unitNo].virtualUnitNo; *replacementUnitNo = vol.ucache[unitNo].replacementUnitNo; } else#endif /* NFTL_CACHE */
{ /* no ANANDUnitHeader cache */ vol.flash->read(vol.flash, unitBaseAddress(&vol,unitNo) + UNIT_DATA_OFFSET, &unitData, sizeof(ANANDUnitHeader), EXTRA);
/* Mask out any 1 -> 0 bit faults by or'ing with spare data */ *virtualUnitNo = LE2(unitData.virtualUnitNo) | LE2(unitData.spareVirtualUnitNo); *replacementUnitNo = LE2(unitData.replacementUnitNo) | LE2(unitData.spareReplacementUnitNo); } if( !isLegalUnit(*replacementUnitNo) ) { vol.invalidReplacement = unitNo; if(vol.badFormat == FALSE) /* Not called by mount operation */ { ANANDUnitNo firstUnits = vol.virtualUnits[*virtualUnitNo]; if(firstUnits != ANAND_NO_UNIT) setUnavail(firstUnits & (~ANAND_REPLACING_UNIT)); /* freeze unit chain */ } *replacementUnitNo = ANAND_NO_UNIT; }}
#ifndef FL_READ_ONLY
/*----------------------------------------------------------------------*//* s e t U n i t D a t a *//* *//* Set virtual unit No. and replacement unit no. of a unit. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* virtualUnitNo : Virtual unit no. *//* replacementUnitNo : Replacement unit no. *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//* *//*----------------------------------------------------------------------*/
static FLStatus setUnitData(Anand vol, ANANDUnitNo unitNo, ANANDUnitNo virtualUnitNo, ANANDUnitNo replacementUnitNo){ ANANDUnitHeader unitData; ANANDUnitNo newVirtualUnitNo, newReplacementUnitNo;
if( replacementUnitNo == unitNo ) /* prevent chain loop */ return flGeneralFailure;
toLE2(unitData.virtualUnitNo,virtualUnitNo); toLE2(unitData.spareVirtualUnitNo,virtualUnitNo); toLE2(unitData.replacementUnitNo,replacementUnitNo); toLE2(unitData.spareReplacementUnitNo,replacementUnitNo);
checkStatus(vol.flash->write(vol.flash, unitBaseAddress(&vol,unitNo) + UNIT_DATA_OFFSET, &unitData, sizeof(ANANDUnitHeader), EXTRA));
#ifdef VERIFY_WRITE
if (vol.flash->socket->verifyWrite==FL_ON) {#ifdef NFTL_CACHE
/* Set new entries for ANANDUnitHeader cache */ if (vol.ucache != NULL) { vol.ucache[unitNo].virtualUnitNo = virtualUnitNo; vol.ucache[unitNo].replacementUnitNo = replacementUnitNo; }#endif /* NFTL_CACHE */
return flOK; }#endif /* VERIFY_WRITE */
#ifdef NFTL_CACHE
/* purge ANANDUnitHeader cache to force re-filling from flash */ if (vol.ucache != NULL) { vol.ucache[unitNo].virtualUnitNo = 0xDEAD; vol.ucache[unitNo].replacementUnitNo = 0xDEAD; }#endif /* NFTL_CACHE */
/* Verify the new unit data */ getUnitData(&vol,unitNo,&newVirtualUnitNo, &newReplacementUnitNo); if (virtualUnitNo != newVirtualUnitNo || replacementUnitNo != newReplacementUnitNo) return flWriteFault; else return flOK;}
#endif /* FL_READ_ONLY */
/*----------------------------------------------------------------------*//* g e t N e x t U n i t *//* *//* Get next unit in chain. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* virUnitNo : Virtual unit number of the chain. *//* *//* Returns: *//* Physical unit number of the unit following unitNo in the chain. *//* If such unit do not exist, return ANAND_NO_UNIT. *//*----------------------------------------------------------------------*/
static ANANDUnitNo getNextUnit(Anand vol, ANANDUnitNo unitNo, ANANDUnitNo virUnitNo){ ANANDUnitNo virtualUnitNo, replacementUnitNo;
if (!(vol.physicalUnits[unitNo] & UNIT_REPLACED)) return ANAND_NO_UNIT;
getUnitData(&vol,unitNo,&virtualUnitNo,&replacementUnitNo); if( virUnitNo != (virtualUnitNo & ~ANAND_REPLACING_UNIT) ) { unitNo = vol.virtualUnits[virUnitNo]; setUnavail(unitNo); /* freeze unit chain */ return ANAND_NO_UNIT; }
return replacementUnitNo;}
#ifdef NFTL_CACHE
/*----------------------------------------------------------------------*//* g e t S e c t o r F l a g s F r o m C a c h e *//* *//* Get sector flags from Sector Cache. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* address : starting address of the sector *//* *//* Returns: *//* sector flags (SECTOR_USED, SECTOR_DELETED etc.) *//*----------------------------------------------------------------------*/static unsigned char getSectorFlagsFromCache(Anand vol, CardAddress address){ return scacheTable[(vol.scache[address >> (SECTOR_SIZE_BITS+2)] >> (((unsigned int)address >> 8) & 0x7)) & 0x3];}
/*----------------------------------------------------------------------*//* s e t S e c t o r F l a g s C a c h e *//* *//* Get sector flags from Sector Cache. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* address : starting address of the sector *//* sectorFlags : one of SECTOR_USED, SECTOR_DELETED etc. *//* *//*----------------------------------------------------------------------*/static void setSectorFlagsCache(Anand vol, CardAddress address, unsigned char sectorFlags){ register unsigned char tmp, val;
if (vol.scache == NULL) return;
tmp = vol.scache[address >> (SECTOR_SIZE_BITS+2)];
switch(sectorFlags) { case SECTOR_USED: val = S_CACHE_SECTOR_USED; break; case SECTOR_FREE: val = S_CACHE_SECTOR_FREE; break; case SECTOR_DELETED: val = S_CACHE_SECTOR_DELETED; break; default:/* SECTOR_IGNORE */val = S_CACHE_SECTOR_IGNORE; break; }
switch (((unsigned int)address >> 8) & 0x7) { case 0: tmp = (tmp & 0xfc) | (val ); break; /* update bits 0..1 */ case 2: tmp = (tmp & 0xf3) | (val << 2); break; /* bits 2..3 */ case 4: tmp = (tmp & 0xcf) | (val << 4); break; /* bits 4..5 */ case 6: tmp = (tmp & 0x3f) | (val << 6); break; /* bits 6..7 */ }
vol.scache[address >> (SECTOR_SIZE_BITS+2)] = tmp;}
#endif /* NFTL_CACHE */
/*----------------------------------------------------------------------*//* g e t S e c t o r F l a g s *//* *//* Get sector status. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorAddress : Physical address of the sector *//* *//* Returns: *//* Return the OR of the two bytes in the sector status area (the *//* bytes should contain the same data). *//*----------------------------------------------------------------------*/
static unsigned char getSectorFlags(Anand vol, CardAddress sectorAddress){ byte flags[2]; byte blockFlag = SECTOR_IGNORE; byte index,tmpSector; FLStatus status;
#ifdef NFTL_CACHE
if (vol.scache != NULL) { /* check for Sector Flags cache hit */
blockFlag = getSectorFlagsFromCache(&vol, sectorAddress); if (blockFlag != SECTOR_IGNORE) return blockFlag; }#endif /* NFTL_CACHE */
vol.flash->read(vol.flash, sectorAddress + SECTOR_DATA_OFFSET, flags, sizeof flags, EXTRA);
if((flags[0] == flags[1]) && (isValidSectorFlag(flags[0]))) { blockFlag = flags[0]; } else /* Sector flags that were read are not legal */ { /* Force remapping of internal catched sector */ vol.flash->socket->remapped = TRUE;
/* Check for ignored sector using the EDC */ status = vol.flash->read(vol.flash, sectorAddress, nftlBuffer, SECTOR_SIZE, EDC);
if(status == flOK) { /* Check if distance is less then 2 bits failure since */ /* 2 bits failure can be either delete or used */ for (index=0 , tmpSector = (byte)SECTOR_USED ; index < 2 ; index++ , tmpSector = (byte)SECTOR_DELETED) { if (distanceOf(flags[0], tmpSector) + distanceOf(flags[1], tmpSector) <= 2) { blockFlag = tmpSector; break; } } if(index>=2) return SECTOR_IGNORE; } else { return SECTOR_IGNORE; } }
#ifdef NFTL_CACHE
/* update Sector Flags cache */ setSectorFlagsCache(&vol, sectorAddress, blockFlag);#endif /* NFTL_CACHE */
return blockFlag;}
/*----------------------------------------------------------------------*//* f i n d E n d O f E n d l e s s C h a i n *//* *//* Find end of endless chain - last unit of unit chain that points to *//* itself. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* virUnitNo : Virtual unit number *//* *//* Returns: *//* Physical unit number of oldest unit of the chain *//*----------------------------------------------------------------------*/
static ANANDUnitNo findEndOfEndlessChain(Anand vol, ANANDUnitNo virUnitNo){ ANANDUnitNo chainsUnit[DOUBLE_MAX_UNIT_CHAIN/2+2]; ANANDUnitNo unitNo; int i; int chainBound;
for (unitNo = vol.virtualUnits[virUnitNo] , chainBound = 0 ; chainBound < MAX_UNIT_CHAIN ; unitNo = getNextUnit(&vol,unitNo,virUnitNo) , chainBound++) { chainsUnit[chainBound] = unitNo; /* Save location of current unit */
for(i = 0 ; i < chainBound ; i++) /* Check if already been to this unit */ { if(chainsUnit[chainBound] == unitNo) /* Bad next unit number pointer */ break; } } return chainsUnit[chainBound-1];}
/*----------------------------------------------------------------------*//* v i r t u a l 2 P h y s i c a l *//* *//* Translate virtual sector number to physical address. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorNo : Virtual sector number *//* endAddress : End address for sector search. NULL for no end *//* *//* Returns: *//* endAddress : Next free sector address *//* physical address of sectorNo *//*----------------------------------------------------------------------*/
static CardAddress virtual2Physical(Anand vol, SectorNo sectorNo , CardAddress* endAddress){ unsigned unitOffset = (unsigned)((sectorNo % vol.sectorsPerUnit) << SECTOR_SIZE_BITS); CardAddress prevSectorAddress = ANAND_UNASSIGNED_ADDRESS; CardAddress sectorAddress; CardAddress *freeSectorAddressPtr; ANANDUnitNo unitNo, virUnitNo; ANANDUnitNo chainBound = 0; ANANDUnitNo endUnit; byte sectorFlags; FLBoolean badPointerFound = FALSE;
/* Set end unit and nextFreeSectorAddress */ if(endAddress == NULL) { endUnit = ANAND_NO_UNIT; } else { endUnit = (ANANDUnitNo)(*endAddress>>vol.unitSizeBits); *endAddress = ANAND_UNASSIGNED_ADDRESS; }
/* follow the chain */ virUnitNo = (ANANDUnitNo)(sectorNo / vol.sectorsPerUnit); for (unitNo = vol.virtualUnits[virUnitNo]; ( (unitNo != endUnit) && (chainBound < DOUBLE_MAX_UNIT_CHAIN) ); unitNo = getNextUnit(&vol,unitNo,virUnitNo)) { sectorAddress = unitBaseAddress(&vol,unitNo) + unitOffset; sectorFlags = getSectorFlags(&vol,sectorAddress);
if (sectorFlags == SECTOR_FREE) { if(endAddress != NULL) *endAddress = sectorAddress; break; }
if (sectorFlags != SECTOR_IGNORE) prevSectorAddress = sectorFlags != SECTOR_DELETED ? sectorAddress : ANAND_UNASSIGNED_ADDRESS; chainBound++; }
if(chainBound < DOUBLE_MAX_UNIT_CHAIN) return prevSectorAddress;
/* Infint loop caused by power failure */ if(endAddress == NULL) { freeSectorAddressPtr = §orAddress; } else { freeSectorAddressPtr = endAddress; } *freeSectorAddressPtr = unitOffset + unitBaseAddress(&vol, findEndOfEndlessChain(&vol,virUnitNo)); return virtual2Physical(&vol, sectorNo , freeSectorAddressPtr);}
/*----------------------------------------------------------------------*//* g e t F o l d M a r k *//* *//* Get the fold mark a unit. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* *//* Returns: *//* Return the OR of the two words in the fold mark area (the words *//* should be identical) *//*----------------------------------------------------------------------*/
static unsigned short getFoldMark(Anand vol, ANANDUnitNo unitNo){ unsigned short foldMark[2];
vol.flash->read(vol.flash, unitBaseAddress(&vol,unitNo) + FOLD_MARK_OFFSET, foldMark, sizeof foldMark, EXTRA);
return foldMark[0] | foldMark[1];}
/*----------------------------------------------------------------------*//* g e t U n i t T a i l e r *//* *//* Get the erase record of a unit. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* eraseMark : Receives the erase mark of the unit *//* eraseCount : Receives the erase count of the unit *//* *//*----------------------------------------------------------------------*/
static void getUnitTailer(Anand vol, ANANDUnitNo unitNo, unsigned short *eraseMark, unsigned long *eraseCount){ UnitTailer unitTailer;
vol.flash->read(vol.flash, unitBaseAddress(&vol,unitNo) + UNIT_TAILER_OFFSET, &unitTailer, sizeof(UnitTailer), EXTRA);
/* Mask out any 1 -> 0 bit faults by or'ing with spare data */ *eraseMark = LE2(unitTailer.eraseMark) | LE2(unitTailer.eraseMark1); *eraseCount = LE4(unitTailer.eraseCount);}
/*----------------------------------------------------------------------*//* s e t U n i t T a i l e r *//* *//* Set the erase record of a unit. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* eraseMark : Erase mark to set *//* eraseCount : Erase count to set *//* *//*----------------------------------------------------------------------*/
static FLStatus setUnitTailer(Anand vol, ANANDUnitNo unitNo, unsigned short eraseMark, unsigned long eraseCount){ UnitTailer unitTailer;
toLE2(unitTailer.eraseMark,eraseMark); toLE2(unitTailer.eraseMark1,eraseMark); toLE4(unitTailer.eraseCount,eraseCount);
return vol.flash->write(vol.flash, unitBaseAddress(&vol,unitNo) + UNIT_TAILER_OFFSET, &unitTailer, sizeof(UnitTailer), EXTRA);}
/*----------------------------------------------------------------------*//* i n i t N F T L *//* *//* Initializes essential volume data as a preparation for mount or *//* format. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* flash : Flash media mounted on this socket *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus initNFTL(Anand vol, FLFlash *flash){ dword size = 1;
if (flash == NULL || !(flash->flags & NFTL_ENABLED)) { DEBUG_PRINT(("Debug: media is not fit for NFTL format.\r\n")); return flUnknownMedia; }
vol.flash = flash;
#ifdef NT5PORT
vol.socketNo = (byte)(flSocketNoOf(vol.flash->socket));#else
vol.socketNo = flSocketNoOf(vol.flash->socket);#endif NT5PORT
vol.physicalUnits = NULL; vol.virtualUnits = NULL;
#ifdef NFTL_CACHE
vol.ucache = NULL; vol.scache = NULL;#endif
for (vol.erasableBlockSizeBits = 0; size < vol.flash->erasableBlockSize; vol.erasableBlockSizeBits++, size <<= 1); vol.unitSizeBits = vol.erasableBlockSizeBits;
vol.noOfUnits = (unsigned short)((vol.flash->noOfChips * vol.flash->chipSize) >> vol.unitSizeBits);
/* Adjust unit size so header unit fits in one unit */ while (vol.noOfUnits * sizeof(ANANDPhysUnit) + SECTOR_SIZE > (1UL << vol.unitSizeBits)) { vol.unitSizeBits++; vol.noOfUnits >>= 1; } /* Bound number of units to find room in 64 Kbytes Segment */ if( (vol.noOfUnits >= MAX_UNIT_NUM) && (vol.unitSizeBits < MAX_UNIT_SIZE_BITS) ) { vol.unitSizeBits++; vol.noOfUnits >>= 1; }
vol.badFormat = TRUE; /* until mount completes*/ vol.mappedSectorNo = UNASSIGNED_SECTOR; vol.countsValid = 0; /* No units have a valid count yet */
/*get pointer to buffer (we assume SINGLE_BUFFER is not defined) */ vol.buffer = flBufferOf(flSocketNoOf(vol.flash->socket));#ifdef VERIFY_ERASED_SECTOR
vol.verifyBuffer = (dword *)flReadBackBufferOf(flSocketNoOf(flash->socket));#endif /* VERIFY_ERASED_SECTOR */
#if (defined(VERIFY_WRITE) || defined(VERIFY_VOLUME) || defined(VERIFY_ERASED_SECTOR))
vol.verifiedSectorNo = 0; /* Largest sector verified so far */#endif /* VERIFY_WRITE || VERIFY_VOLUME || VERIFY_ERASED_SECTOR */
vol.invalidReplacement = ANAND_NO_UNIT; /* a unit with bad RUN */
return flOK;}
/*----------------------------------------------------------------------*//* i n i t T a b l e s *//* *//* Allocates and initializes the dynamic volume table, including the *//* unit tables and secondary virtual map. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus initTables(Anand vol){ /* Allocate the conversion tables */#ifdef FL_MALLOC
vol.physicalUnits = (ANANDPhysUnit FAR1*) FL_FAR_MALLOC (vol.noOfUnits * sizeof(ANANDPhysUnit)); vol.virtualUnits = (ANANDUnitNo FAR1*) FL_FAR_MALLOC (vol.noOfVirtualUnits * sizeof(ANANDUnitNo)); if (vol.physicalUnits == NULL || vol.virtualUnits == NULL) { DEBUG_PRINT(("Debug: failed allocating conversion tables for NFTL.\r\n")); return flNotEnoughMemory; }#else
char *heapPtr;
heapPtr = vol.heap; vol.physicalUnits = (ANANDPhysUnit *) heapPtr; heapPtr += vol.noOfUnits * sizeof(ANANDPhysUnit); vol.virtualUnits = (ANANDUnitNo *) heapPtr; heapPtr += vol.noOfVirtualUnits * sizeof(ANANDUnitNo); if (heapPtr > vol.heap + sizeof vol.heap) { DEBUG_PRINT(("Debug: not enough memory for NFTL conversion tables.\r\n")); return flNotEnoughMemory; }#endif
return flOK;}
/*----------------------------------------------------------------------*//* m a r k U n i t B a d *//* *//* Mark a unit as bad in the conversion table and the bad units table. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical number of bad unit *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus markUnitBad(Anand vol, ANANDUnitNo unitNo){ unsigned short eraseMark; unsigned long eraseCount;
vol.physicalUnits[unitNo] = UNIT_BAD_MOUNT;
getUnitTailer(&vol,unitNo,&eraseMark,&eraseCount);
return setUnitTailer(&vol,unitNo,0,eraseCount);}
/*----------------------------------------------------------------------*//* f o r m a t U n i t *//* *//* Format one unit. Erase the unit, and mark the physical units table. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Unit to format *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus formatUnit(Anand vol, ANANDUnitNo unitNo){ unsigned short eraseMark; unsigned long eraseCount; FLStatus status;
if (!isAvailable(unitNo)) return flWriteFault;
if (vol.physicalUnits[unitNo] == ANAND_UNIT_FREE) vol.freeUnits--; setUnavail(unitNo);
getUnitTailer(&vol,unitNo,&eraseMark,&eraseCount);
#ifdef NFTL_CACHE
/* purge ANANDUnitHeader cache to force re-filling from flash */ if (vol.ucache != NULL) { vol.ucache[unitNo].virtualUnitNo = 0xDEAD; vol.ucache[unitNo].replacementUnitNo = 0xDEAD; }
/*
* Purge the Sector Flags cache (set entries for all the unit's * sectors to SECTOR_FREE). */ if (vol.scache != NULL) { tffsset(&(vol.scache[unitNo << (vol.unitSizeBits - SECTOR_SIZE_BITS-2)]), S_CACHE_4_SECTORS_FREE, 1 << (vol.unitSizeBits - SECTOR_SIZE_BITS - 2)); }#endif /* NFTL_CACHE */
status = vol.flash->erase(vol.flash, (word)(unitNo << (vol.unitSizeBits - vol.erasableBlockSizeBits)), (word)(1 << (vol.unitSizeBits - vol.erasableBlockSizeBits))); if (status != flOK) { markUnitBad(&vol,unitNo); /* make sure unit format is not valid */ return status; }
vol.eraseSum++; eraseCount++; if (eraseCount == 0) /* was hex FF's */ eraseCount++;
checkStatus(setUnitTailer(&vol,unitNo,ERASE_MARK,eraseCount));
vol.physicalUnits[unitNo] = ANAND_UNIT_FREE; vol.freeUnits++;
return flOK;}
#ifndef FL_READ_ONLY
/*----------------------------------------------------------------------*//* w r i t e A n d C h e c k *//* *//* Write one sector. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* address : Physical address of the sector to write to *//* fromAddress : Buffer of data to write *//* flags : Write flags (ECC, overwrite etc.) *//* *//* Returns: *//* Status : 0 on success, failed otherwise. *//*----------------------------------------------------------------------*/
static FLStatus writeAndCheck(Anand vol, CardAddress address, void FAR1 *fromAddress, unsigned flags){ FLStatus status;#ifdef VERIFY_ERASED_SECTOR
register int noOfDword; int i;#endif /* VERIFY_ERASED_SECTOR */
/* Toggle verify write flag */#if (defined(VERIFY_WRITE) || defined(VERIFY_ERASED_SECTOR))
switch (flVerifyWrite[vol.socketNo][vol.flash->socket->curPartition]) { case FL_OFF: if (vol.verifiedSectorNo>vol.curSectorWrite) break; case FL_ON:#ifdef VERIFY_WRITE
vol.flash->socket->verifyWrite = FL_ON;#endif /* VERIFY_WRITE */
#ifdef VERIFY_ERASED_SECTOR
/* Make sure all of the sectors are really free */ checkStatus(vol.flash->read(vol.flash,address,vol.verifyBuffer,SECTOR_SIZE,0)); noOfDword = SECTOR_SIZE/sizeof(dword); for(i = 0;i<noOfDword;i++) /* Loop over sector data */ { if(vol.verifyBuffer[i]!=0xffffffffL) { markAsIgnored(&vol,address); DEBUG_PRINT(("writeAndCheck : The sector was not erased and is ignored\r\n")); return flWriteFault; } }#endif /* VERIFY_ERASED_SECTOR */
default: break; }#endif /* VERIFY_WRITE || VERIFY_ERASED_SECTOR */
/* Write sector */ status = vol.flash->write(vol.flash,address,fromAddress,SECTOR_SIZE,(word)flags);
if (status == flWriteFault) { /* write failed, ignore this sector */ markAsIgnored(&vol,address); }#ifdef NFTL_CACHE
else { setSectorFlagsCache(&vol, address, SECTOR_USED); }#endif
#ifdef VERIFY_WRITE
/* Restore verify write mode */ if(flVerifyWrite[flSocketNoOf(vol.flash->socket)][vol.flash->socket->curPartition] != FL_ON) vol.flash->socket->verifyWrite = FL_OFF;#endif /* VERIFY_WRITE */
return status;}
#endif /* FL_READ_ONLY */
/*----------------------------------------------------------------------*//* l a s t I n C h a i n *//* *//* Find last unit in chain. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Start the search from this unit *//* *//* Returns: *//* Physical unit number of the last unit in chain. *//*----------------------------------------------------------------------*/
static ANANDUnitNo lastInChain(Anand vol, ANANDUnitNo unitNo){ ANANDUnitNo firstVirtualUnitNo, firstReplacementUnitNo; ANANDUnitNo lastUnit = unitNo, nextUnitNo; ANANDUnitNo chainBound = 0;
if(unitNo == ANAND_NO_UNIT) return ANAND_NO_UNIT;
getUnitData(&vol,unitNo,&firstVirtualUnitNo,&firstReplacementUnitNo); nextUnitNo = firstReplacementUnitNo;
while( (nextUnitNo < vol.noOfUnits) && /* Validate replacement unit no. */ (chainBound < DOUBLE_MAX_UNIT_CHAIN) ) { ANANDUnitNo nextVirtualUnitNo, nextReplacementUnitNo;
if( !isAvailable(nextUnitNo) ) break; getUnitData(&vol,nextUnitNo,&nextVirtualUnitNo,&nextReplacementUnitNo); if( nextVirtualUnitNo != (firstVirtualUnitNo | ANAND_REPLACING_UNIT) ) break; /* Virtual unit no. not validated */ lastUnit = nextUnitNo; nextUnitNo = nextReplacementUnitNo; chainBound++; }
return lastUnit;}
#ifndef FL_READ_ONLY
/*----------------------------------------------------------------------*//* a s s i g n U n i t *//* *//* Assigns a virtual unit no. to a unit *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* virtualUnitNo : Virtual unit number to assign *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus assignUnit(Anand vol, ANANDUnitNo unitNo, ANANDUnitNo virtualUnitNo){ ANANDUnitNo newVirtualUnitNo, newReplacementUnitNo; ANANDUnitNo oldVirtualUnitNo, oldReplacementUnitNo; FLStatus status; ANANDUnitNo newestUnitNo = vol.virtualUnits[virtualUnitNo]; ANANDUnitNo oldUnitNo;
/* Assign the new unit */ newVirtualUnitNo = virtualUnitNo; if (newestUnitNo != ANAND_NO_UNIT) newVirtualUnitNo |= ANAND_REPLACING_UNIT; newReplacementUnitNo = ANAND_NO_UNIT; vol.physicalUnits[unitNo] = 0; vol.freeUnits--; status = setUnitData(&vol,unitNo,newVirtualUnitNo,newReplacementUnitNo); if (status != flOK) { markUnitBad(&vol,unitNo); return status; }
/* Add unit to chain */ if (newestUnitNo != ANAND_NO_UNIT) { /* If unit is frozen, don't attempt to chain (folding not-in-place) */ if (!isAvailable(newestUnitNo)) return flOK;
oldUnitNo = lastInChain(&vol,newestUnitNo); getUnitData(&vol,oldUnitNo,&oldVirtualUnitNo,&oldReplacementUnitNo); if (oldReplacementUnitNo != ANAND_NO_UNIT) status = flWriteFault; /* can't write here, so assume failure */ else { vol.physicalUnits[oldUnitNo] |= UNIT_REPLACED; status = setUnitData(&vol,oldUnitNo,oldVirtualUnitNo,unitNo); } if (status != flOK) { formatUnit(&vol,unitNo); /* Get rid of the allocated unit quickly */ setUnavail(newestUnitNo); /* freeze the chain */
return status; } if (vol.countsValid > virtualUnitNo && newestUnitNo != oldUnitNo){ if (countOf(newestUnitNo) + countOf(oldUnitNo) <= UNIT_MAX_COUNT) vol.physicalUnits[newestUnitNo] += countOf(oldUnitNo); else return flGeneralFailure; } } else vol.virtualUnits[virtualUnitNo] = unitNo;
return flOK;}
#endif /* FL_READ_ONLY */
/*----------------------------------------------------------------------*//* f o r m a t C h a i n *//* *//* Format all the units in a chain. Start from the last one and go *//* backwards until unitNo is reached. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Format the chain from this unit onwards *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus formatChain(Anand vol, ANANDUnitNo unitNo){ /* Erase the chain from end to start */ ANANDUnitNo chainBound;
setUnitCount(unitNo,0); /* Reenable erase of this unit */ for (chainBound=0;( chainBound < DOUBLE_MAX_UNIT_CHAIN ); chainBound++) { /* Find last unit in chain */ ANANDUnitNo unitToErase = lastInChain(&vol,unitNo);
if( formatUnit(&vol,unitToErase) != flOK ) break;
if (unitToErase == unitNo) break; /* Erased everything */ }
return flOK;}
#ifndef FL_READ_ONLY
/*----------------------------------------------------------------------*//* S w a p U n i t s *//* *//* Applies wear leveling. *//* A rover unit dictates the current unit to level. If a unit chain *//* fold, if single unit chain , append a unit and then fold. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
FLStatus swapUnits(Anand vol){ ANANDUnitNo i,unitNo,virtualUnitNo,replacementUnitNo; FLStatus status;
if(vol.wearLevel.currUnit>=vol.noOfVirtualUnits) return flOK;
for(i=0,unitNo=vol.virtualUnits[vol.wearLevel.currUnit]; (unitNo==ANAND_NO_UNIT) && (i<vol.noOfVirtualUnits);i++) {
vol.wearLevel.currUnit++; if(vol.wearLevel.currUnit>=vol.noOfVirtualUnits) vol.wearLevel.currUnit = 0;
unitNo=vol.virtualUnits[vol.wearLevel.currUnit]; }
if(unitNo==ANAND_NO_UNIT) /*The media is empty*/ return flOK;
virtualUnitNo = vol.wearLevel.currUnit;
vol.wearLevel.currUnit++; if(vol.wearLevel.currUnit>=vol.noOfVirtualUnits) vol.wearLevel.currUnit = 0;
if((vol.physicalUnits[unitNo] & UNIT_REPLACED) || (!isAvailable(unitNo) ) ) { status = foldUnit(&vol,virtualUnitNo,FALSE); } else { checkStatus(allocateUnit(&vol,&replacementUnitNo)); return assignUnit(&vol,replacementUnitNo,virtualUnitNo); }
/* If folding failed make sure there are enough units and call again */ if(status == flCanNotFold) return checkFolding(&vol,virtualUnitNo);
return status;}
/*----------------------------------------------------------------------*//* f i n d F r e e U n i t *//* *//* Find a free unit from the physical unit pool. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Receives the physical unit no. *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus findFreeUnit(Anand vol, ANANDUnitNo *unitNo){ ANANDUnitNo originalUnit = vol.roverUnit; unsigned short eraseMark; unsigned long eraseCount;
do { if (++vol.roverUnit >= vol.noOfUnits) vol.roverUnit = vol.bootUnits;
if (vol.physicalUnits[vol.roverUnit] == ANAND_UNIT_FREE) { /* found a free unit, if not erased, */ getUnitTailer(&vol,vol.roverUnit,&eraseMark,&eraseCount); if (eraseMark != ERASE_MARK) { if (formatUnit(&vol,vol.roverUnit) != flOK) continue; /* this unit is bad, find another */ } *unitNo = vol.roverUnit; return flOK; } } while (vol.roverUnit != originalUnit); return flNotEnoughMemory; /* Report no space at all */}
/*----------------------------------------------------------------------*//* f o l d U n i t *//* *//* Copy all the sectors that hold valid data in the chain to the last *//* unit of the chain and erase the chain. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* virtualUnitNo : Virtual unit number of the first unit in chain. *//* forceFolding : Boolean flag stating wether to force folding even *//* at the cost of loosing sector data. *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus foldUnit(Anand vol, ANANDUnitNo virtualUnitNo, FLBoolean forceFolding){ ANANDUnitNo unitNo = vol.virtualUnits[virtualUnitNo]; ANANDUnitNo targetUnitNo, chainBound; unsigned long foldMark; SectorNo virtualSectorNo = (SectorNo)virtualUnitNo * vol.sectorsPerUnit; CardAddress endSectorAddress; CardAddress targetSectorAddress; CardAddress sourceSectorAddress; unsigned newSectorCount, i; FLBoolean partialFoldingFlag = FALSE; FLStatus status;
/* Force remapping of internal catched sector */ vol.flash->socket->remapped = TRUE; vol.unitsFolded++;
/* When using FL_OFF option the media is scanned in the folding operation */#if (defined(VERIFY_WRITE) || defined(VERIFY_ERASED_SECTOR))
if(flVerifyWrite[flSocketNoOf(vol.flash->socket)][vol.flash->socket->curPartition]==FL_OFF) { checkStatus(verifySectors(&vol,SECTORS_VERIFIED_PER_FOLDING)); vol.curSectorWrite = virtualSectorNo; }#endif /* VERIFY_WRITE || VERIFY_ERASED_SECTOR */
/* Find target unit */ if (!isAvailable(unitNo)) /* If this unit is frozen, */ { if(vol.freeUnits > 0) { /* allocate a new unit to fold into */ checkStatus(findFreeUnit(&vol,&targetUnitNo)); checkStatus(assignUnit(&vol,targetUnitNo,virtualUnitNo)); } else { if(forceFolding==FALSE) return flCanNotFold; partialFoldingFlag = TRUE; } }
if((isAvailable(unitNo)) || (partialFoldingFlag == TRUE)) { /* Default. Fold into end of chain */ targetUnitNo = unitNo;
for (chainBound=0;( chainBound < DOUBLE_MAX_UNIT_CHAIN );chainBound++) { ANANDUnitNo nextUnitNo = getNextUnit(&vol,targetUnitNo,virtualUnitNo); if (nextUnitNo == ANAND_NO_UNIT) break; targetUnitNo = nextUnitNo; } if(chainBound == DOUBLE_MAX_UNIT_CHAIN) { targetUnitNo = findEndOfEndlessChain(&vol, virtualUnitNo); } }
/***********************************/ /* Copy all sectors to target unit */ /***********************************/
/* Mark unit as currently folded */ foldMark = FOLDING_IN_PROGRESS * 0x10001l;
if( getFoldMark(&vol,unitNo) != FOLDING_IN_PROGRESS ) vol.flash->write(vol.flash, unitBaseAddress(&vol,unitNo) + FOLD_MARK_OFFSET, &foldMark, sizeof foldMark, EXTRA);
setUnavail(unitNo); /* Freeze this unit chain */
/* Copy all sectors to target unit */ targetSectorAddress = unitBaseAddress(&vol,targetUnitNo); newSectorCount = 0;
for (i = 0; i < vol.sectorsPerUnit; i++, virtualSectorNo++,#if (defined(VERIFY_WRITE) || defined(VERIFY_ERASED_SECTOR))
vol.curSectorWrite++,#endif /* VERIFY_WRITE || VERIFY_ERASED_SECTOR */
targetSectorAddress += SECTOR_SIZE) { endSectorAddress = ANAND_UNASSIGNED_ADDRESS; for(chainBound=0;chainBound<DOUBLE_MAX_UNIT_CHAIN;chainBound++) { sourceSectorAddress = virtual2Physical(&vol,virtualSectorNo,&endSectorAddress); if(sourceSectorAddress == targetSectorAddress) { /* Sector resides on the last unit of the virtual chain and */ /* does not need to be copied */#if (defined(VERIFY_WRITE) || defined(VERIFY_ERASED_SECTOR))
switch(flVerifyWrite[flSocketNoOf(vol.flash->socket)][vol.flash->socket->curPartition]) { case FL_UPS: newSectorCount++; goto nextSectorLable;
case FL_OFF: if(vol.verifiedSectorNo > virtualSectorNo) { newSectorCount++; goto nextSectorLable; } default: /* FL_ON */ break; }
/* Validate the sector has valid EDC/ECC */ status = vol.flash->read(vol.flash,sourceSectorAddress,nftlBuffer,SECTOR_SIZE,EDC); if(status!=flOK) { /* Last sector of chain has EDC errors - can not fold there */ if(forceFolding!=TRUE) { return flCanNotFold; } else { goto nextSectorLable; } } newSectorCount++; goto nextSectorLable;#endif /* VERIFY_WRITE || VERIFY_ERASED_SECTOR */
} else if(sourceSectorAddress != ANAND_UNASSIGNED_ADDRESS) { /* Check that area is free (ignore flag) */ if(getSectorFlags(&vol,targetSectorAddress) != SECTOR_FREE) { if(forceFolding!=TRUE) { return flCanNotFold; } else { break; } }
/* Copy sector to target sector */ status = vol.flash->read(vol.flash,sourceSectorAddress,nftlBuffer,SECTOR_SIZE,EDC); if (status != flOK) /* Try reading previous sector */ { endSectorAddress = sourceSectorAddress; continue; } status = writeAndCheck(&vol,targetSectorAddress,nftlBuffer,EDC); switch (status) { case flOK: /* Success */ vol.parasiteWrites++; newSectorCount++; goto nextSectorLable;
case flWriteFault: /* Faild in verify write */ if (forceFolding == FALSE) return flCanNotFold; goto nextSectorLable;
default : /* Protection error or any other */ return status; } } else /* ANAND_UNASSIGNED_ADDRESS - Sector not used */ { goto nextSectorLable; } } return flGeneralFailure;nextSectorLable:; } /* End of copy sector loop */
/*****************************/ /* Add unit to virtual chain */ /*****************************/
if (newSectorCount > 0) { /* Some sectors remaining*/ /* Mark target unit as original */ if( (setUnitData(&vol,targetUnitNo,virtualUnitNo,ANAND_NO_UNIT) != flOK ) || (partialFoldingFlag == TRUE)) { setUnavail(targetUnitNo); /* freeze this unit */ } else { setUnitCount(targetUnitNo,newSectorCount); } /* Set target unit in virtual unit table */ vol.virtualUnits[virtualUnitNo] = targetUnitNo; } else { if (unitNo != targetUnitNo) {/* If there is a chain to delete ... *//* mark unit as completed folding, pending erase */#ifndef NT5PORT
unsigned long foldMark = FOLDING_COMPLETE * 0x10001l;#else /*NT5PORT*/
foldMark = FOLDING_COMPLETE * 0x10001l;#endif /*NT5PORT*/
vol.flash->write(vol.flash, unitBaseAddress(&vol,unitNo) + FOLD_MARK_OFFSET, &foldMark, sizeof foldMark, EXTRA); }
vol.virtualUnits[virtualUnitNo] = ANAND_NO_UNIT; }
/* Erase source units */
return formatChain(&vol,unitNo);
}
/*----------------------------------------------------------------------*//* c r e a t e U n i t C o u n t *//* *//* Count the number of sectors in a unit that hold valid data. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Physical unit number *//* *//*----------------------------------------------------------------------*/
static void createUnitCount(Anand vol, ANANDUnitNo unitNo){ unsigned int i; SectorNo sectorNo; CardAddress sectorAddress; ANANDUnitNo physicalUnitNo = vol.virtualUnits[unitNo];
if (physicalUnitNo == ANAND_NO_UNIT) return;
if (!isAvailable(physicalUnitNo)) return;
/* Get a count of the valid sector in this unit */ setUnitCount(physicalUnitNo,0);
sectorNo = (SectorNo)unitNo * vol.sectorsPerUnit; for (i = 0; i < vol.sectorsPerUnit; i++, sectorNo++) { sectorAddress = virtual2Physical(&vol,sectorNo,NULL); if (sectorAddress != ANAND_UNASSIGNED_ADDRESS) { ANANDUnitNo currUnitNo = (ANANDUnitNo)(sectorAddress >> vol.unitSizeBits); if (vol.physicalUnits[currUnitNo] & UNIT_REPLACED) currUnitNo = physicalUnitNo; /* Increament sector count - Assumed EDC OK , was not verified */ vol.physicalUnits[currUnitNo]++; } }}
/*----------------------------------------------------------------------*//* f o l d B e s t C h a i n *//* *//* Find the best chain to fold and fold it.A good chain to fold is a *//* long chain with a small number of sectors that hold valid data. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Receives the physical unit no. of the first *//* unit in the chain that was folded. *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus foldBestChain(Anand vol, ANANDUnitNo *unitNo){ unsigned leastCount; unsigned longestChain; unsigned unitCount; ANANDUnitNo virtualUnitNo; ANANDUnitNo u; ANANDUnitNo firstUnitNo; unsigned int maxCounter; FLStatus status = flCanNotFold;
*unitNo = ANAND_NO_UNIT;
/* Loop as long as can not fold in place or until MAX_FOLDING_TRIES time */
for (maxCounter = 0 ; maxCounter < MAX_FOLDING_TRIES ; maxCounter++) { leastCount = vol.sectorsPerUnit + 1; /* Set to invalid sector count */ longestChain = 0; /* Set to invalid unit length */ virtualUnitNo = ANAND_NO_UNIT;
/*************************************************************/ /* Loop over all virtual units until best candidate is found */ /*************************************************************/
for (u = 0; u < vol.noOfVirtualUnits; u++) { /* If virtual unit does not exist continue to next unit */ firstUnitNo = vol.virtualUnits[u]; if( firstUnitNo == ANAND_NO_UNIT ) continue;
/* Make sure sector count of unit is valid */ if (vol.countsValid <= u) { createUnitCount(&vol,u); /* Update sector count */ vol.countsValid = u + 1; }
if( isAvailable(firstUnitNo) ) /* store sector count */ { unitCount = countOf(firstUnitNo); } else { unitCount = vol.sectorsPerUnit; /* set low priority */ }
/* This is an empty unit. We can simply erase it */ if (unitCount == 0) { leastCount = 0; virtualUnitNo = u; break; }
if(/* Smallest sector count found so far */ (leastCount >= unitCount ) && /* And this unit is not a single unit chain */ (vol.physicalUnits[firstUnitNo] & UNIT_REPLACED) ) { unsigned chainLength = 0;
/* Compare chain length */ ANANDUnitNo nextUnitNo = getNextUnit(&vol,firstUnitNo,u); if(isAvailable(firstUnitNo)) { while((nextUnitNo != ANAND_NO_UNIT ) && (chainLength < DOUBLE_MAX_UNIT_CHAIN)) { chainLength++; nextUnitNo = getNextUnit(&vol,nextUnitNo,u); } } else { chainLength = 0; /* Set lowest priority to frozen chain */ }
/* set low priority to neverending loop chain */ if(chainLength == DOUBLE_MAX_UNIT_CHAIN) chainLength = 0; if((leastCount == unitCount ) && (longestChain >= chainLength)) continue; longestChain = chainLength; leastCount = unitCount; virtualUnitNo = u; } /* End - unit has less (or eqaul) no' of used sectors found so far */ } /* End - Loop over all virtual units and find best candidate */
/*************************************************************/ /* Candidate virtual chain has been chosen - try and fold it */ /*************************************************************/
if ((leastCount > vol.sectorsPerUnit) || (virtualUnitNo == ANAND_NO_UNIT)) { /* Only single units chains were found */
if(maxCounter==0) /* And no chain was frozen while searching */ return flNotEnoughMemory; /* Report no space at all */ break; /* Try and fold the frozen units that have been found */ } else /* Try and fold the candidate unit */ { if(!isAvailable(vol.virtualUnits[virtualUnitNo])) /* This is a frozen unit */ { /* Frozen chains have the lowest priority - stop searching */ break; } else /* Try and fold the unit */ { /* Store the first unit as the new free unit */ *unitNo = vol.virtualUnits[virtualUnitNo]; /* Store number of free Units */ u = vol.freeUnits; /* Fold the candidate unit */ status = foldUnit(&vol,virtualUnitNo,FALSE); switch(status) { case flOK: if(vol.freeUnits == u) /* Did not free any units */ continue; break; case flCanNotFold: /* Need to fold not in place */ continue; default: return status; } break; } } } /* End MAX_FOLDING_TRIES loop */
/***************************************************************/ /* Check folding status - might need a special kind of folding */ /***************************************************************/
if(maxCounter) { *unitNo = ANAND_NO_UNIT; /* Unfreeze all units */ for (u = vol.spareOrgUnit + 1; u < vol.noOfUnits; u++) { if(!isAvailable(u)) /* This is a frozen unit */ { /* Get virtual unit of frozen physical unit */ getUnitData(&vol,u,&virtualUnitNo,&firstUnitNo); if(virtualUnitNo < vol.noOfVirtualUnits) { /* Store the first unit as the new free unit */ firstUnitNo = vol.virtualUnits[virtualUnitNo]; /* Force folding no matter what */ if(firstUnitNo != ANAND_NO_UNIT) { checkStatus(foldUnit(&vol,virtualUnitNo,TRUE)); /* Recalculate sector count */ createUnitCount(&vol, virtualUnitNo); *unitNo = firstUnitNo; } } } } } if((*unitNo!= ANAND_NO_UNIT) && (vol.freeUnits > 0)) /* A unit was freed */ return flOK; else return flGeneralFailure;}
/*----------------------------------------------------------------------*//* a l l o c a t e U n i t *//* *//* Find a free unit to allocate, erase it if necessary. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Receives the physical number of the allocated *//* unit *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus allocateUnit(Anand vol, ANANDUnitNo *unitNo){ ANANDUnitNo originalUnit = vol.roverUnit; FLStatus status;
if (vol.freeUnits < 2) /* Try to make sure not to use the last unit */ { status = foldBestChain(&vol,unitNo); if(status != flNotEnoughMemory) return status; }
return findFreeUnit(&vol, unitNo);}
#endif /* FL_READ_ONLY */
/*----------------------------------------------------------------------*//* m a p S e c t o r *//* *//* Maps and returns location of a given sector no. *//* NOTE: This function is used in place of a read-sector operation. *//* *//* A one-sector cache is maintained to save on map operations. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorNo : Sector no. to read *//* physAddress : Optional pointer to receive sector address *//* *//* Returns: *//* Pointer to physical sector location. NULL returned if sector *//* does not exist. *//*----------------------------------------------------------------------*/
static const void FAR0 *mapSector(Anand vol, SectorNo sectorNo, CardAddress *physAddress){ if (sectorNo != vol.mappedSectorNo || vol.flash->socket->remapped) { if (sectorNo >= vol.virtualSectors) { vol.mappedSector = NULL; } else { int chainBound = 0;
for(vol.mappedSectorAddress=ANAND_UNASSIGNED_ADDRESS; chainBound<DOUBLE_MAX_UNIT_CHAIN;chainBound++) { CardAddress endSectorAddress = vol.mappedSectorAddress; vol.mappedSectorAddress = virtual2Physical(&vol,sectorNo,&endSectorAddress);
if (vol.mappedSectorAddress == ANAND_UNASSIGNED_ADDRESS) { vol.mappedSector = NULL; /* no such sector */ break; } else { vol.mappedSector = nftlBuffer; if (vol.flash->read(vol.flash,vol.mappedSectorAddress,nftlBuffer,SECTOR_SIZE,EDC) == flOK) break; } } vol.mappedSectorNo = sectorNo; vol.flash->socket->remapped = FALSE; } } if (physAddress) *physAddress = vol.mappedSectorAddress;
return vol.mappedSector;}
/* Mounting and formatting */
/*----------------------------------------------------------------------*//* m o u n t U n i t *//* *//* Mount one unit. Read the relevant data from the unit header and *//* update the conversion tables. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : Unit to mount *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus mountUnit(Anand vol, ANANDUnitNo unitNo, unsigned long* eraseCount){ ANANDUnitNo virtualUnitNo, replacementUnitNo; unsigned short eraseMark; ANANDPhysUnit FAR1 *pU = &vol.physicalUnits[unitNo];
getUnitData(&vol,unitNo,&virtualUnitNo,&replacementUnitNo); getUnitTailer(&vol,unitNo,&eraseMark,eraseCount);
if (virtualUnitNo == ANAND_NO_UNIT || eraseMark != ERASE_MARK) { /* this unit is not assigned */ *pU = ANAND_UNIT_FREE; } else { /* this unit is assigned */ *pU &= UNIT_ORPHAN; if (replacementUnitNo < vol.noOfUnits) { *pU |= UNIT_REPLACED; if (isAvailable(replacementUnitNo) || isReplaced(replacementUnitNo)) /* Mark replacement unit as non-orphan */ vol.physicalUnits[replacementUnitNo] &= ~UNIT_ORPHAN; } if (!(virtualUnitNo & ANAND_REPLACING_UNIT)) { unsigned short foldMark; ANANDUnitNo physUnitNo;
if (virtualUnitNo >= vol.noOfVirtualUnits) return formatUnit(&vol,unitNo);
foldMark = getFoldMark(&vol,unitNo); physUnitNo = vol.virtualUnits[virtualUnitNo]; if (foldMark == FOLDING_COMPLETE) formatChain(&vol,unitNo); else if (physUnitNo == ANAND_NO_UNIT || !isAvailable(physUnitNo)) { /* If we have duplicates, it's OK if one of them is currently folded */ vol.virtualUnits[virtualUnitNo] = unitNo; *pU &= ~UNIT_ORPHAN;
if (foldMark == FOLDING_IN_PROGRESS) { setUnavail(unitNo); } if (physUnitNo != ANAND_NO_UNIT) formatChain(&vol,physUnitNo); /* Get rid of old chain */ } else if (foldMark == FOLDING_IN_PROGRESS) formatChain(&vol,unitNo); else return flBadFormat; /* We have a duplicate to a unit that */ /* is not currently folded. That's bad. */ } }
return flOK;}
#ifndef FL_READ_ONLY
/*----------------------------------------------------------------------*//* a l l o c a t e A n d W r i t e S e c t o r *//* *//* Write to sectorNo. if necessary, allocate a free sector first. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorNo : Virtual sector no. to write *//* fromAddress : Address of sector data. *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus allocateAndWriteSector(void* rec, SectorNo sectorNo, void FAR1 *fromAddress){ Anand vol = (Anand*)rec; ANANDUnitNo virtualUnitNo = (ANANDUnitNo)(sectorNo / vol.sectorsPerUnit); ANANDUnitNo firstUnitNo = vol.virtualUnits[virtualUnitNo]; ANANDUnitNo unitNo; unsigned unitOffset = (unsigned)((sectorNo % vol.sectorsPerUnit) << SECTOR_SIZE_BITS); unsigned unitChainLength = 0; FLBoolean sectorExists = FALSE; FLBoolean unitWasFoldedOutOfPlace = FALSE; FLStatus status;
/* If we can't write to this unit, must fold it first */ if (firstUnitNo != ANAND_NO_UNIT && !isAvailable(firstUnitNo)) { status = foldUnit(&vol,virtualUnitNo,FALSE); switch(status) { case flOK: break; case flCanNotFold: checkStatus(checkFolding(&vol,virtualUnitNo)); break; default: return status; } firstUnitNo = vol.virtualUnits[virtualUnitNo]; }
/* Find a unit to write this sector */
unitNo = firstUnitNo; while ((unitNo != ANAND_NO_UNIT) && (unitChainLength < DOUBLE_MAX_UNIT_CHAIN)) { unsigned char sectorFlags = getSectorFlags(&vol,unitBaseAddress(&vol,unitNo) + unitOffset); if (sectorFlags == SECTOR_FREE) break; if (sectorFlags != SECTOR_IGNORE) sectorExists = sectorFlags == SECTOR_USED; unitNo = getNextUnit(&vol,unitNo,virtualUnitNo); unitChainLength++; }
if (unitChainLength == DOUBLE_MAX_UNIT_CHAIN) { /* unit points to itself */ unitNo = ANAND_NO_UNIT; /* force folding not in place */ setUnavail(firstUnitNo); }
if (unitNo == ANAND_NO_UNIT) { /* Can not write in chain - must add a unit */ firstUnitNo = vol.virtualUnits[virtualUnitNo]; if (unitChainLength >= MAX_UNIT_CHAIN) { status = foldUnit(&vol,virtualUnitNo,FALSE); switch(status) { case flOK: break; case flCanNotFold: checkStatus(checkFolding(&vol,virtualUnitNo)); break; default: return status; } } if(vol.virtualUnits[virtualUnitNo] != firstUnitNo) { firstUnitNo = vol.virtualUnits[virtualUnitNo]; unitWasFoldedOutOfPlace = TRUE; } checkStatus(allocateUnit(&vol,&unitNo)); checkStatus(assignUnit(&vol,unitNo,virtualUnitNo)); if(vol.virtualUnits[virtualUnitNo] != firstUnitNo) { firstUnitNo = vol.virtualUnits[virtualUnitNo]; unitWasFoldedOutOfPlace = TRUE; }#if (defined(VERIFY_WRITE) || defined(VERIFY_ERASED_SECTOR))
/* Folding might have discovered that the sector we are using is invalid */ if(sectorExists) { if( unitWasFoldedOutOfPlace ) { /* Unit was folded out of place, so if sector exists it must be in
* the first unit of the chain */ if(getSectorFlags(&vol,unitBaseAddress(&vol,firstUnitNo) + unitOffset) != SECTOR_USED) { /* The sector we saw before had bad EDC */ sectorExists = FALSE; unitNo = firstUnitNo; } } }#endif /* VERIFY_WRITE || VERIFY_ERASED_SECTOR */
}
#if (defined(VERIFY_WRITE) || defined(VERIFY_ERASED_SECTOR))
vol.curSectorWrite = sectorNo;#endif /* VERIFY_WRITE || VERIFY_ERASED_SECTOR */
checkStatus(writeAndCheck(&vol,unitBaseAddress(&vol,unitNo) + unitOffset,fromAddress,EDC));
if (vol.countsValid > virtualUnitNo) { if (unitNo != firstUnitNo && !(vol.physicalUnits[unitNo] & UNIT_REPLACED)) { if (countOf(unitNo) < UNIT_MAX_COUNT) /* Increment block count */ vol.physicalUnits[unitNo]++; else return flGeneralFailure;
if (sectorExists) /* Decrement block count */ { if (countOf(firstUnitNo) > 0) vol.physicalUnits[firstUnitNo]--; else return flGeneralFailure; } } else if (!sectorExists) { if (countOf(firstUnitNo) < UNIT_MAX_COUNT) /* Increment block count */ vol.physicalUnits[firstUnitNo]++; else return flGeneralFailure; } }
return flOK;}
/*----------------------------------------------------------------------*//* w r i t e S e c t o r *//* *//* Writes a sector. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorNo : Virtual sector no. to write *//* fromAddress : Data to write *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus writeSector(Anand vol, SectorNo sectorNo, void FAR1 *fromAddress){ FLStatus status = flWriteFault; int i;
if (vol.badFormat) return flBadFormat; if (sectorNo >= vol.virtualSectors) return flSectorNotFound;
if(vol.wearLevel.currUnit!=ANAND_NO_UNIT) { vol.wearLevel.alarm++; if(vol.wearLevel.alarm>=WLnow) { vol.wearLevel.alarm = 0; checkStatus(swapUnits(&vol)); } }
if (sectorNo == vol.mappedSectorNo) { /* Force remapping of internal catched sector */ vol.flash->socket->remapped = TRUE; }
vol.sectorsWritten++; for (i = 0; i < 4 && status == flWriteFault; i++) { if (vol.mappedSectorNo == sectorNo) vol.mappedSectorNo = UNASSIGNED_SECTOR; status = allocateAndWriteSector(&vol,sectorNo,fromAddress); }
return status;}
/*----------------------------------------------------------------------*//* d e l e t e S e c t o r *//* *//* Marks contiguous sectors as deleted. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorNo : First sector no. to delete *//* noOfSectors : No. of sectors to delete *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus deleteSector(Anand vol, SectorNo sectorNo, SectorNo noOfSectors){ SectorNo iSector; FLStatus status;
if (vol.badFormat) return flBadFormat; if (sectorNo + noOfSectors > vol.virtualSectors) return flSectorNotFound;
for (iSector = 0; iSector < noOfSectors; iSector++, sectorNo++, vol.sectorsDeleted++) {
CardAddress sectorAddress = virtual2Physical(&vol,sectorNo,NULL); if (sectorAddress != ANAND_UNASSIGNED_ADDRESS) { byte sectorFlags[2]; ANANDUnitNo currUnitNo;
/* Check that the unit is writable, and if not, fold it first */ ANANDUnitNo virtualUnitNo = (ANANDUnitNo)(sectorNo / vol.sectorsPerUnit); ANANDUnitNo unitNo = vol.virtualUnits[virtualUnitNo]; if (!isAvailable(unitNo)) { status = foldUnit(&vol,virtualUnitNo,FALSE); switch(status) { case flOK: break; case flCanNotFold: checkStatus(checkFolding(&vol,virtualUnitNo)); break; default: return status; } sectorAddress = virtual2Physical(&vol,sectorNo,NULL); }
/* Mark sector deleted */ sectorFlags[0] = sectorFlags[1] = SECTOR_DELETED;#ifdef NFTL_CACHE
setSectorFlagsCache(&vol, sectorAddress, SECTOR_DELETED);#ifdef ENVIRONMENT_VARS
if (((flMarkDeleteOnFlash == FL_ON) && (flPolicy[vol.socketNo][vol.flash->socket->curPartition] != FL_COMPLETE_ASAP)) || (vol.scache == NULL))#endif /* ENVIRONMENT_VARS */
#endif
vol.flash->write(vol.flash, sectorAddress + SECTOR_DATA_OFFSET,
#ifndef NT5PORT
§orFlags,#else /*NT5PORT*/
sectorFlags,#endif /*NT5PORT*/
sizeof sectorFlags, EXTRA);
currUnitNo = (ANANDUnitNo)(sectorAddress >> vol.unitSizeBits); if ( isAvailable(currUnitNo) ) { if (vol.physicalUnits[currUnitNo] & UNIT_REPLACED) currUnitNo = vol.virtualUnits[virtualUnitNo]; if (vol.countsValid > virtualUnitNo) { if (countOf(currUnitNo) > 0) vol.physicalUnits[currUnitNo]--; /* Decrement block count */ else return flGeneralFailure; } } } }
return flOK;}
#endif /* FL_READ_ONLY */
/*----------------------------------------------------------------------*//* t l S e t B u s y *//* *//* Notifies the start and end of a file-system operation. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* state : FL_ON (1) = operation entry *//* FL_OFF(0) = operation exit *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus tlSetBusy(Anand vol, FLBoolean state){ return flOK;}
#ifndef FL_READ_ONLY
#ifdef DEFRAGMENT_VOLUME
/*----------------------------------------------------------------------*//* d e f r a g m e n t *//* *//* Performs unit allocations to arrange a minimum number of writable *//* sectors. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorsNeeded : Minimum required sectors *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus defragment(Anand vol, long FAR2 *sectorsNeeded){ ANANDUnitNo dummyUnitNo, firstFreeUnit = ANAND_NO_UNIT; FLBoolean firstRound = TRUE; FLStatus status = flOK;
if( (*sectorsNeeded) == -1 ) { /* fold single chain */ if (vol.badFormat) return flBadFormat;
status = foldBestChain(&vol,&dummyUnitNo); if( (status != flOK) && (vol.freeUnits == 0) ) return status; *sectorsNeeded = vol.freeUnits * vol.sectorsPerUnit; return flOK; } while ((SectorNo)vol.freeUnits * vol.sectorsPerUnit < ((SectorNo)(*sectorsNeeded))) { if (vol.badFormat) return flBadFormat;
status = allocateUnit(&vol,&dummyUnitNo); if( status != flOK ) break; if (firstRound) { /* remember the first free unit */ firstFreeUnit = dummyUnitNo; firstRound = FALSE; } else if (firstFreeUnit == dummyUnitNo) { /* We have wrapped around, all the units that were marked as free */ /* are now erased, and we still don't have enough space. */ status = foldBestChain(&vol,&dummyUnitNo); /* make more free units */ if( status != flOK ) break; } }
*sectorsNeeded = (long)vol.freeUnits * vol.sectorsPerUnit;
return status;}
#endif /* DEFRAGMENT_VOLUME */
#endif /* FL_READ_ONLY */
/*----------------------------------------------------------------------*//* s e c t o r s I n V o l u m e *//* *//* Gets the total number of sectors in the volume *//* *//* Parameters: *//* vol : Pointer identifying drive *//* *//* Returns: *//* Number of sectors in the volume *//*----------------------------------------------------------------------*/
static SectorNo sectorsInVolume(Anand vol){ return vol.virtualSectors;}
/*----------------------------------------------------------------------*//* d i s m o u n t N F T L *//* *//* Dismount NFTL volume *//* *//* Parameters: *//* vol : Pointer identifying drive *//* *//*----------------------------------------------------------------------*/
static void dismountNFTL(Anand vol){#ifdef FL_MALLOC
if( vol.physicalUnits != NULL ) FL_FAR_FREE (vol.physicalUnits); if( vol.virtualUnits != NULL ) FL_FAR_FREE (vol.virtualUnits); vol.physicalUnits = NULL; vol.virtualUnits = NULL;
#ifdef NFTL_CACHE
if( vol.ucache != NULL ) FL_FAR_FREE (vol.ucache); if( vol.scache != NULL ) FL_FAR_FREE (vol.scache); vol.ucache = NULL; vol.scache = NULL;#endif /* NFTL_CACHE */
#endif /* FL_MALLOC */
}
Anand* getAnandRec(unsigned driveNo){ return (&vols[driveNo]);}
#ifdef FORMAT_VOLUME
/*----------------------------------------------------------------------*//* i s E r a s e d U n i t *//* *//* Check if a unit is erased. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* unitNo : unit to check *//* *//* Returns: *//* TRUE if unit is erased, FALSE otherwise *//*----------------------------------------------------------------------*/
static FLBoolean isErased(Anand vol, ANANDUnitNo unitNo){
CardAddress addr; CardAddress endAddr; word offset;
/* Force remapping of internal catched sector */ vol.flash->socket->remapped = TRUE; addr = unitBaseAddress(&vol,unitNo); endAddr = addr + (1L << vol.unitSizeBits);
for (;addr < endAddr; addr += SECTOR_SIZE) {
/* Check area a and b */
vol.flash->read(vol.flash, addr, nftlBuffer,SECTOR_SIZE, 0); for (offset=0;offset<SECTOR_SIZE;offset+=ANAND_SPARE_SIZE) if (tffscmp(nftlBuffer+offset, ff, ANAND_SPARE_SIZE)) return FALSE;
/* Check area c */
vol.flash->read(vol.flash, addr, nftlBuffer,ANAND_SPARE_SIZE, EXTRA); if (tffscmp( nftlBuffer, ff, ANAND_SPARE_SIZE )) return FALSE; } return TRUE;}
/*----------------------------------------------------------------------*//* f o r m a t N F T L *//* *//* Perform NFTL Format. *//* *//* Parameters: *//* volNo : Volume serial no. *//* formatParams : Address of FormatParams structure to use *//* flash : Flash media mounted on this socket *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus formatNFTL(unsigned volNo, TLFormatParams *formatParams, FLFlash *flash){ Anand vol = &vols[volNo]; long int unitSize; unsigned long prevVirtualSize; ANANDUnitNo iUnit, prevOrgUnit; ANANDUnitNo noOfBootUnits=0; ANANDBootRecord bootRecord; int noOfBadUnits = 0; FLStatus status = flOK; FLBoolean forceHeaderUpdate = FALSE; static unsigned char checkSum[EXTRA_LEN] = { 0x4B, 0x00, 0xE2, 0x0E, 0x93, 0xF7, 0x55, 0x55 };#ifdef EXTRA_LARGE
int moreUnitBits; unsigned char anandFlagsTmp;#endif /* EXTRA_LARGE */
DEBUG_PRINT(("Debug: starting NFTL format.\r\n"));
checkStatus(initNFTL(&vol,flash));
tffsset(&bootRecord,0,sizeof(ANANDBootRecord));
/* Find the medium boot record */ for (vol.orgUnit = 0; vol.orgUnit < vol.noOfUnits; vol.orgUnit++) { vol.flash->read(vol.flash, unitBaseAddress(&vol,vol.orgUnit), &bootRecord, sizeof bootRecord, 0); if (tffscmp(bootRecord.bootRecordId,"ANAND",sizeof bootRecord.bootRecordId) == 0) break; }
#ifdef EXTRA_LARGE
if (vol.orgUnit >= vol.noOfUnits) { /* first time formatting */ bootRecord.anandFlags = 0xFF; moreUnitBits = 0; while( ((vol.noOfUnits >> moreUnitBits) > 4096) && ((vol.unitSizeBits + moreUnitBits) < MAX_UNIT_SIZE_BITS) && (bootRecord.anandFlags > 0xFC) ) { moreUnitBits++; bootRecord.anandFlags--; } }
moreUnitBits = ~bootRecord.anandFlags & MORE_UNIT_BITS_MASK; if (moreUnitBits > 0) { vol.unitSizeBits += moreUnitBits; vol.noOfUnits >>= moreUnitBits; vol.orgUnit >>= moreUnitBits; }#endif /* EXTRA_LARGE */
/* adjust number of boot area units include the EXB area */
if (formatParams->flags & FL_LEAVE_BINARY_AREA) { /* Leave binary area (except for the area between the old
original unit and the new one */ if (formatParams->bootImageLen >= 0) { noOfBootUnits += (ANANDUnitNo)((formatParams->bootImageLen - 1) >> vol.unitSizeBits) + 1; } else /* Leave binary area excatly as it was */ { if (vol.orgUnit >= vol.noOfUnits) /* first time formatting */ { noOfBootUnits = 0; } else { if (LE2(bootRecord.bootUnits) > noOfBootUnits ) noOfBootUnits = LE2(bootRecord.bootUnits); } } } else /* Actualy format binary area with a signature */ {#ifdef WRITE_EXB_IMAGE
if (formatParams->exbLen > 0) { noOfBootUnits = (ANANDUnitNo)((formatParams->exbLen - 1) >> vol.unitSizeBits) + 1; formatParams->exbLen = noOfBootUnits; } else { formatParams->exbLen = 0; }#endif /* WRITE_EXB_IMAGE */
if(formatParams->noOfBinaryPartitions > 0) { noOfBootUnits += (ANANDUnitNo)((formatParams->binaryPartitionInfo ->length - 1) >> vol.unitSizeBits) + 1; } } prevOrgUnit = vol.orgUnit; /* save previous Original Unit */ prevVirtualSize = UNAL4(bootRecord.virtualMediumSize); vol.bootUnits = noOfBootUnits; vol.unitOffsetMask = (1L << vol.unitSizeBits) - 1; vol.sectorsPerUnit = 1 << (vol.unitSizeBits - SECTOR_SIZE_BITS); /* Add 'percentUse'% of bootUnits to transfer units */ formatParams->percentUse -= (unsigned)(((long)(100 - formatParams->percentUse) * (vol.bootUnits)) / (vol.noOfUnits - vol.bootUnits));
vol.noOfTransferUnits = (ANANDUnitNo)formatParams->noOfSpareUnits;
vol.noOfTransferUnits += (ANANDUnitNo)((long)(vol.noOfUnits - vol.bootUnits) * (100 - formatParams->percentUse) / 100);
if (vol.noOfUnits <= vol.bootUnits + vol.noOfTransferUnits) return flVolumeTooSmall;
unitSize = 1L << vol.unitSizeBits; vol.noOfVirtualUnits = vol.noOfUnits-vol.bootUnits;
checkStatus(initTables(&vol));
for (iUnit = 0; iUnit < (vol.noOfUnits-vol.bootUnits); iUnit++) vol.virtualUnits[iUnit] = ANAND_NO_UNIT;
if (vol.orgUnit >= vol.noOfUnits) { /* no boot record - virgin card, scan it for bad blocks */ DFORMAT_PRINT(("Virgin card rebuilding unit map.\r\n")); prevVirtualSize = 0L; tffsset(ff,0xff,ANAND_SPARE_SIZE);
/* Generate the bad unit table */ /* if a unit is not erased it is marked as bad */ for (iUnit = 0; iUnit < vol.noOfUnits; iUnit++) { vol.physicalUnits[iUnit] = (unsigned char)(isErased(&vol,iUnit) ? ANAND_UNIT_FREE : UNIT_BAD_ORIGINAL);#ifndef NT5PORT
DFORMAT_PRINT(("Checking unit %ld\r",(CardAddress)iUnit));#endif/*NT5PORT*/
} DFORMAT_PRINT(("\rMedia has been scanned\r\n")); } else /* Read bad unit table from boot record */ { status = vol.flash->read(vol.flash, unitBaseAddress(&vol,vol.orgUnit) + SECTOR_SIZE, vol.physicalUnits, vol.noOfUnits * sizeof(ANANDPhysUnit), EDC); if( status != flOK ) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; } }
if(vol.physicalUnits[0] == UNIT_BAD_ORIGINAL) { DFORMAT_PRINT(("ERROR - IPL block is bad.\r\n")); return flBadIPLBlock; }
/* count bad units */ vol.noOfTransferUnits += 2; /* include orgUnit & spareOrgUnit */
/* Convert first unit of MDOC of any floor > 0 to BAD in order to make it
* unchangeable and force internal EEprom mode */ if(flash->flags & EXTERNAL_EPROM) { long docFloorSize; int iFloor, iPage;
docFloorSize = (flash->chipSize * flash->noOfChips) / flash->noOfFloors;
for(iFloor=1;( iFloor < flash->noOfFloors ); iFloor++) { iUnit = (ANANDUnitNo)((docFloorSize * (long)iFloor) >> vol.unitSizeBits); if( vol.physicalUnits[iUnit] == ANAND_UNIT_FREE ) { forceHeaderUpdate = TRUE; /* force writing of NFTL Header */ vol.physicalUnits[iUnit] = UNIT_BAD_ORIGINAL; /* mark as BAD */ } status = vol.flash->erase(vol.flash, (word)(iUnit << (vol.unitSizeBits - vol.erasableBlockSizeBits)), (word)(1 << (vol.unitSizeBits - vol.erasableBlockSizeBits))); if( status != flOK ) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; }
for(iPage=0;( iPage < 2 ); iPage++) { status = vol.flash->write(vol.flash, unitBaseAddress(&vol,iUnit) + iPage * SECTOR_SIZE, (const void FAR1 *)checkSum, EXTRA_LEN, EXTRA); if( status != flOK ) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; } } } }
/* Translate physicalUnits[] to internal representation */ for (iUnit = 0; iUnit < vol.noOfUnits; iUnit++) { if (vol.physicalUnits[iUnit] != ANAND_UNIT_FREE) vol.physicalUnits[iUnit] = UNIT_BAD_MOUNT; }
/* extend bootimage area if there are bad units in it */ for( iUnit = vol.bootUnits = 0; (vol.bootUnits < noOfBootUnits) && (iUnit < vol.noOfUnits); iUnit++ ) if (isAvailable(iUnit)) vol.bootUnits++;
if (vol.bootUnits < noOfBootUnits) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return flVolumeTooSmall; }
vol.bootUnits = iUnit;
/* Discount transfer units taken by the boot image */ for (iUnit = 0; iUnit < vol.bootUnits; iUnit++) if (!isAvailable(iUnit)) { if( vol.noOfTransferUnits <= (ANANDUnitNo)formatParams->noOfSpareUnits ) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return flVolumeTooSmall; } vol.noOfTransferUnits--; } if (vol.noOfUnits <= vol.bootUnits + vol.noOfTransferUnits) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return flVolumeTooSmall; }
vol.virtualSectors = (SectorNo)((vol.noOfUnits - vol.bootUnits - vol.noOfTransferUnits) * (unitSize / SECTOR_SIZE)); vol.noOfVirtualUnits = (unsigned short)((vol.virtualSectors + vol.sectorsPerUnit - 1) / vol.sectorsPerUnit);
/* Find a place for the boot records and protect them */ /* NOTE : We don't erase the old orgUnits, this might cause a problem
when formatting with bootImageLen = 0 and then formatting with bootImageLen = 44Kbyte */ for (vol.orgUnit = vol.bootUnits; vol.orgUnit < vol.noOfUnits; vol.orgUnit++) if (vol.physicalUnits[vol.orgUnit] == ANAND_UNIT_FREE) break; vol.physicalUnits[vol.orgUnit] = UNIT_UNAVAIL; for (vol.spareOrgUnit = vol.orgUnit + 1; vol.spareOrgUnit < vol.noOfUnits; vol.spareOrgUnit++) if (vol.physicalUnits[vol.spareOrgUnit] == ANAND_UNIT_FREE) break; vol.physicalUnits[vol.spareOrgUnit] = UNIT_UNAVAIL;
for (iUnit = vol.bootUnits; iUnit < vol.noOfUnits; iUnit++) { status = formatUnit(&vol,iUnit); if(status == flWriteFault) { if ((iUnit != vol.orgUnit) && (iUnit != vol.spareOrgUnit)) { noOfBadUnits++; vol.physicalUnits[iUnit] = UNIT_BAD_MOUNT; /* Mark it bad in table */ if ((noOfBadUnits+2) >= vol.noOfTransferUnits) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; } } } else if (status != flOK) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; }
if (formatParams->progressCallback) { status = (*formatParams->progressCallback) ((word)(vol.noOfUnits - vol.bootUnits), (word)((iUnit + 1) - vol.bootUnits)); if(status!=flOK) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; } } }
/* Prepare the boot record header */ for(iUnit = 0; iUnit < vol.noOfUnits; iUnit++) { /* Convert Bad Block table to previous state */ if( vol.physicalUnits[iUnit] == UNIT_BAD_MOUNT ) vol.physicalUnits[iUnit] = UNIT_BAD_ORIGINAL; }#ifdef EXTRA_LARGE
anandFlagsTmp = bootRecord.anandFlags;#endif /* EXTRA_LARGE */
tffsset(&bootRecord,0xff,sizeof bootRecord);#ifdef EXTRA_LARGE
bootRecord.anandFlags = anandFlagsTmp;#endif /* EXTRA_LARGE */
toLE2(bootRecord.noOfUnits,vol.noOfUnits - vol.bootUnits); toLE2(bootRecord.bootUnits,vol.bootUnits); tffscpy(bootRecord.bootRecordId,"ANAND",sizeof bootRecord.bootRecordId); toUNAL4(bootRecord.virtualMediumSize,(CardAddress) vol.virtualSectors * SECTOR_SIZE);
/* Write boot records, spare unit first */ vol.physicalUnits[vol.orgUnit] = ANAND_UNIT_FREE; /* Unprotect it */ vol.physicalUnits[vol.spareOrgUnit] = ANAND_UNIT_FREE; /* Unprotect it */
if( ((prevOrgUnit != vol.orgUnit) || (forceHeaderUpdate == TRUE)) || (prevVirtualSize != UNAL4(bootRecord.virtualMediumSize)) ) { /* Copy boot Record to 512 bytes buffer in order to add EDC */ tffsset(nftlBuffer,0,sizeof nftlBuffer); tffscpy(nftlBuffer,&bootRecord,sizeof bootRecord);
/* Loop over the original unit and the spare (spare first) */ for (iUnit = vol.spareOrgUnit, prevOrgUnit = 0; prevOrgUnit < 2 ; prevOrgUnit ++) { status = formatUnit(&vol,iUnit); /* Erase unit */
if(status==flOK) /* Write BBT */ { status = vol.flash->write(vol.flash, unitBaseAddress(&vol,iUnit) + SECTOR_SIZE, vol.physicalUnits, vol.noOfUnits * sizeof(ANANDPhysUnit), EDC); }
if(status==flOK) /* Write header */ { status = vol.flash->write(vol.flash, unitBaseAddress(&vol,iUnit), nftlBuffer, sizeof (nftlBuffer), EDC); }
if(status!=flOK) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; } iUnit = vol.orgUnit; } }
/* Mark Binary partition with the proper signature */
if (!(formatParams->flags & FL_LEAVE_BINARY_AREA)&& (vol.bootUnits > 0)) { byte sign[BINARY_SIGNATURE_LEN];
/* Add SPL special Signature */
#ifdef WRITE_EXB_IMAGE
byte signOffset = 8; tffscpy(sign,SIGN_SPL,BINARY_SIGNATURE_NAME);#else
byte signOffset = formatParams->binaryPartitionInfo->signOffset; tffscpy(sign,formatParams->binaryPartitionInfo->sign, BINARY_SIGNATURE_NAME);#endif /* WRITE_EXB_IMAGE */
tffsset(sign+BINARY_SIGNATURE_NAME,'F',BINARY_SIGNATURE_NAME); unitSize = 1L << vol.unitSizeBits;
for (iUnit=0;iUnit<vol.bootUnits;iUnit++) { if ( vol.physicalUnits[iUnit] == ANAND_UNIT_FREE ) { status = formatUnit(&vol,iUnit); if(status != flOK) break;
#ifdef WRITE_EXB_IMAGE
if (iUnit == formatParams->exbLen) { signOffset = formatParams->binaryPartitionInfo->signOffset; tffscpy(sign,formatParams->binaryPartitionInfo->sign, BINARY_SIGNATURE_NAME); }#endif /* WRITE_EXB_IMAGE */
/* Each logical unit might contain several physical blocks */ for (noOfBootUnits = 0 ; (noOfBootUnits < unitSize) && (status == flOK) ; noOfBootUnits += (ANANDUnitNo)vol.flash->erasableBlockSize) { status = vol.flash->write(vol.flash, unitBaseAddress(&vol,iUnit) + noOfBootUnits + signOffset, sign, BINARY_SIGNATURE_LEN,EXTRA); } if(status != flOK) break; }#ifdef WRITE_EXB_IMAGE
else { formatParams->exbLen++; }#endif /* WRITE_EXB_IMAGE */
} } else /* Erase previous Original and SpareOriginal Unit */ { for (iUnit = prevOrgUnit; iUnit < vol.orgUnit; iUnit++) if( vol.physicalUnits[iUnit] != UNIT_BAD_ORIGINAL ) formatUnit(&vol,iUnit); }
if (status != flOK) { DEBUG_PRINT(("Debug: NFTL failed while formating the binary partition.\r\n")); } else { DEBUG_PRINT(("Debug: finished NFTL format.\r\n")); }
dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status;}
#endif /* FORMAT_VOLUME */
/*----------------------------------------------------------------------*//* N F T L I n f o *//* *//* get NFTL information. *//* *//* Parameters: *//* volNo : Volume serial no. *//* tlInfo : Address of TLInfo record *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus NFTLInfo(Anand vol, TLInfo *tlInfo){ tlInfo->sectorsInVolume = vol.virtualSectors; tlInfo->bootAreaSize = (unsigned long)vol.bootUnits << vol.unitSizeBits; tlInfo->eraseCycles = vol.eraseSum; tlInfo->tlUnitBits = vol.unitSizeBits; return flOK;}
#ifndef NO_READ_BBT_CODE
/*----------------------------------------------------------------------*//* r e a d B B T *//* *//* Returns a pointer to the BBT of the device. *//* Note: Bad unit are marked with a 4 bytes address of the unit. *//* Note: A unit can contain several blocks *//* *//* Parameters: *//* vol : Pointer identifying drive *//* buf : pointer to buffer to read into *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//* noOfBB : returns the number of bad unit of the media *//* meidaSize : returns the media size in bytes *//*----------------------------------------------------------------------*/static FLStatus readBBT(Anand vol, CardAddress FAR1 * buf, long FAR2 * mediaSize, unsigned FAR2 * noOfBB){ ANANDUnitNo iUnit; ANANDUnitNo maxBad = vol.noOfUnits * ANAND_BAD_PERCENTAGE / 100; CardAddress FAR1* ptr = (CardAddress FAR1*) buf;
*noOfBB = 0;
for (iUnit=0;(iUnit<vol.noOfUnits);iUnit++) { if (vol.physicalUnits[iUnit] == UNIT_BAD_MOUNT) { if (*noOfBB <= maxBad) { *ptr = (CardAddress) iUnit << vol.unitSizeBits; (*noOfBB)++; ptr = (CardAddress FAR1*)flAddLongToFarPointer((byte FAR1 *)ptr, sizeof(CardAddress)); } else { DEBUG_PRINT(("Debug: ERROR to many bad blocks.\r\n")); return flVolumeTooSmall; } } } *mediaSize = vol.noOfUnits << vol.unitSizeBits; return flOK;}
#endif /* NO_READ_BBT_CODE */
/*----------------------------------------------------------------------*//* m o u n t N F T L *//* *//* Mount the volume. Initialize data structures and conversion tables *//* *//* Parameters: *//* volNo : Volume serial no. *//* tl : Mounted translation layer on exit *//* flash : Flash media mounted on this socket *//* volForCallback : Pointer to FLFlash structure for power on *//* callback routine. *//* *//* update the tlType field of the TL record to NFTL *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus mountNFTL(unsigned volNo, TL *tl, FLFlash *flash, FLFlash **volForCallback){ Anand vol = &vols[volNo]; ANANDUnitNo iUnit,virUnit,nextUnit; unsigned long currEraseCount=0; ANANDBootRecord bootRecord,spareBootRecord; FLStatus status;#ifdef NFTL_CACHE
unsigned long scacheSize = 0;#endif /* NFTL_CACHE */
#ifdef EXTRA_LARGE
int moreUnitBits;#endif /* EXTRA_LARGE */
#if (defined(VERIFY_WRITE) || defined(VERIFY_ERASED_SECTOR))
/* Default for NFTL is FL_UPS */ flVerifyWrite[vol.socketNo][tl->partitionNo] = FL_UPS;#endif /* VERIFY_WRITE || VERIFY_ERASED_SECTOR */
tffsset(&bootRecord,0,sizeof(ANANDBootRecord));
DEBUG_PRINT(("Debug: starting NFTL mount.\r\n"));
checkStatus(initNFTL(&vol,flash)); *volForCallback = vol.flash; vol.eraseSum = 0; /* Find the medium boot record */ for (vol.orgUnit = 0; vol.orgUnit < vol.noOfUnits; vol.orgUnit++) { vol.flash->read(vol.flash, unitBaseAddress(&vol,vol.orgUnit), &bootRecord, sizeof bootRecord, 0); if (tffscmp(bootRecord.bootRecordId,"ANAND",sizeof bootRecord.bootRecordId) == 0) break; } if (vol.orgUnit >= vol.noOfUnits) { DEBUG_PRINT(("Debug: not NFTL format.\r\n")); return flUnknownMedia; }
for (vol.spareOrgUnit = vol.orgUnit + 1; vol.spareOrgUnit < vol.noOfUnits; vol.spareOrgUnit++) { vol.flash->read(vol.flash, unitBaseAddress(&vol,vol.spareOrgUnit), &spareBootRecord, sizeof spareBootRecord, 0); if (tffscmp(spareBootRecord.bootRecordId,"ANAND",sizeof spareBootRecord.bootRecordId) == 0) break; } if (vol.spareOrgUnit >= vol.noOfUnits) vol.spareOrgUnit = ANAND_NO_UNIT;
/* Get media information from unit header */ vol.noOfUnits = LE2(bootRecord.noOfUnits); vol.bootUnits = LE2(bootRecord.bootUnits); vol.virtualSectors = (SectorNo)(UNAL4(bootRecord.virtualMediumSize) >> SECTOR_SIZE_BITS); vol.noOfUnits += vol.bootUnits;
#ifdef EXTRA_LARGE
moreUnitBits = ~bootRecord.anandFlags & MORE_UNIT_BITS_MASK; if (moreUnitBits > 0) { vol.unitSizeBits += moreUnitBits; vol.orgUnit >>= moreUnitBits; if (vol.spareOrgUnit != ANAND_NO_UNIT) vol.spareOrgUnit >>= moreUnitBits; }#endif /* EXTRA_LARGE */
vol.unitOffsetMask = (1L << vol.unitSizeBits) - 1; vol.sectorsPerUnit = 1 << (vol.unitSizeBits - SECTOR_SIZE_BITS); vol.noOfVirtualUnits = (ANANDUnitNo)((vol.virtualSectors + vol.sectorsPerUnit - 1) / vol.sectorsPerUnit);
if(((ANANDUnitNo)(vol.virtualSectors >> (vol.unitSizeBits - SECTOR_SIZE_BITS)) > (vol.noOfUnits - vol.bootUnits)) ) {
if( vol.spareOrgUnit != ANAND_NO_UNIT ) { vol.noOfUnits = LE2(spareBootRecord.noOfUnits); vol.bootUnits = LE2(spareBootRecord.bootUnits); vol.virtualSectors = (SectorNo)(UNAL4(spareBootRecord.virtualMediumSize) >> SECTOR_SIZE_BITS); vol.noOfUnits += vol.bootUnits;
#ifdef EXTRA_LARGE
moreUnitBits = ~spareBootRecord.anandFlags & MORE_UNIT_BITS_MASK; if (moreUnitBits > 0) { vol.unitSizeBits += moreUnitBits; vol.orgUnit >>= moreUnitBits; if (vol.spareOrgUnit != ANAND_NO_UNIT) vol.spareOrgUnit >>= moreUnitBits; }#endif /* EXTRA_LARGE */
vol.unitOffsetMask = (1L << vol.unitSizeBits) - 1; vol.sectorsPerUnit = 1 << (vol.unitSizeBits - SECTOR_SIZE_BITS); vol.noOfVirtualUnits = (ANANDUnitNo)((vol.virtualSectors + vol.sectorsPerUnit - 1) / vol.sectorsPerUnit);
if ((ANANDUnitNo)(vol.virtualSectors >> (vol.unitSizeBits - SECTOR_SIZE_BITS)) > (vol.noOfUnits - vol.bootUnits)) return flBadFormat; } else return flBadFormat; }
checkStatus(initTables(&vol));
/* Read bad unit table from boot record */ status = vol.flash->read(vol.flash, unitBaseAddress(&vol,vol.orgUnit) + SECTOR_SIZE, vol.physicalUnits, vol.noOfUnits * sizeof(ANANDPhysUnit), EDC); if( status != flOK ) { if( vol.spareOrgUnit != ANAND_NO_UNIT ) { status = vol.flash->read(vol.flash, unitBaseAddress(&vol,vol.spareOrgUnit) + SECTOR_SIZE, vol.physicalUnits, vol.noOfUnits * sizeof(ANANDPhysUnit), EDC); if( status != flOK ) { dismountNFTL(&vol); /* Free tables must be done after call to initTables */ return status; } } else return status; } /* Exclude boot-image units */ for (iUnit = 0; iUnit < vol.noOfVirtualUnits; iUnit++) vol.virtualUnits[iUnit] = ANAND_NO_UNIT;
/* Translate bad unit table to internal representation */ for (iUnit = 0; iUnit < vol.noOfUnits; iUnit++) { /* Exclude bad & protected units */ if (iUnit < vol.bootUnits || iUnit == vol.orgUnit || iUnit == vol.spareOrgUnit || vol.physicalUnits[iUnit] != ANAND_UNIT_FREE) { if (vol.physicalUnits[iUnit] != ANAND_UNIT_FREE) { vol.physicalUnits[iUnit] = UNIT_BAD_MOUNT; } else { vol.physicalUnits[iUnit] = UNIT_UNAVAIL; } } }
/* Mount all units */ for (iUnit = 0; iUnit < vol.noOfUnits; iUnit++) { if ((vol.physicalUnits[iUnit] != UNIT_UNAVAIL) && (vol.physicalUnits[iUnit] != UNIT_BAD_MOUNT)) { status = mountUnit(&vol,iUnit,&currEraseCount); if(status!=flOK) { dismountNFTL(&vol); /*Free tables must be done after call to initTables*/ return status; } vol.eraseSum+=currEraseCount; } }
/* Scan for orphan units, and count free units */ vol.freeUnits = 0; for (iUnit = vol.bootUnits; iUnit < vol.noOfUnits; iUnit++) { ANANDPhysUnit FAR1 *pU = &vol.physicalUnits[iUnit];
if (*pU == UNIT_ORPHAN || *pU == (UNIT_REPLACED | UNIT_ORPHAN)) { formatChain(&vol,iUnit); /* Get rid of orphan */ if(iUnit == vol.invalidReplacement) vol.invalidReplacement = ANAND_NO_UNIT; } else if (*pU == (ANAND_UNIT_FREE & ~UNIT_ORPHAN)) *pU = ANAND_UNIT_FREE; /* Reference to free unit. That's OK */ } /* Calculate Free Units again after formatChain */ vol.freeUnits = 0; for (iUnit = vol.bootUnits; iUnit < vol.noOfUnits; iUnit++) { if( vol.physicalUnits[iUnit] == ANAND_UNIT_FREE ) vol.freeUnits++; }
/* Initialize allocation rover */ vol.roverUnit = vol.bootUnits;
/* Initialize statistics */ vol.sectorsRead = vol.sectorsWritten = vol.sectorsDeleted = 0; vol.parasiteWrites = vol.unitsFolded = 0;
#ifndef FL_READ_ONLY
/*
* Make sure no unit chain with an invalid replacemenet unit * pointer on the last unit */
if(vol.invalidReplacement != ANAND_NO_UNIT) { getUnitData(&vol,vol.invalidReplacement,&virUnit,&nextUnit); virUnit = virUnit&(~ANAND_REPLACING_UNIT); if(virUnit >= vol.noOfVirtualUnits) { DEBUG_PRINT(("ERROR - a bad unit header encountered.\r\n")); dismountNFTL(&vol); return flBadFormat; }
iUnit = vol.virtualUnits[virUnit]; if(iUnit >= vol.noOfUnits) { DEBUG_PRINT(("ERROR - a bad unit header encountered.\r\n")); dismountNFTL(&vol); return flBadFormat; } setUnavail(iUnit); checkStatus(foldUnit(&vol,virUnit,TRUE)); }
/* Make sure there is at least 1 free unit */ if(vol.freeUnits == 0) foldBestChain(&vol,&iUnit); /* make free units by folding the best chain */
#endif /* FL_READ_ONLY */
/* Set TL routine */ tl->rec = &vol; tl->mapSector = mapSector;#ifndef FL_READ_ONLY
tl->writeSector = writeSector; tl->deleteSector = deleteSector;#ifdef DEFRAGMENT_VOLUME
tl->defragment = defragment;#endif
#if (defined(VERIFY_WRITE) || defined (VERIFY_VOLUME) || defined(VERIFY_ERASED_SECTOR))
tl->checkVolume = checkVolume;#endif /* VERIFY_WRITE || VERIFY_VOLUME || VERIFY_ERASED_SECTOR */
#endif /* FL_READ_ONLY */
tl->sectorsInVolume = sectorsInVolume; tl->getTLInfo = NFTLInfo; tl->tlSetBusy = tlSetBusy; tl->dismount = dismountNFTL;#ifndef NO_READ_BBT_CODE
tl->readBBT = readBBT;#endif /* NO_READ_BBT_CODE */
tl->writeMultiSector = NULL; tl->readSectors = NULL;
DEBUG_PRINT(("Debug: finished NFTL mount.\r\n"));
#ifdef NFTL_CACHE
/* create and initialize ANANDUnitHeader cache */#ifdef ENVIRONMENT_VARS
if( flUseNFTLCache == 1 ) /* behave according to the value of env variable */#endif
{#ifdef FL_MALLOC
vol.ucache = (ucacheEntry FAR1*) FL_FAR_MALLOC (vol.noOfUnits * sizeof(ucacheEntry));#else
vol.ucache = vol.ucacheBuf;#endif /* FL_MALLOC */
}#ifdef ENVIRONMENT_VARS
else vol.ucache = NULL;#endif
if (vol.ucache != NULL) { for (iUnit = 0; iUnit < vol.noOfUnits; iUnit++) { vol.ucache[iUnit].virtualUnitNo = 0xDEAD; vol.ucache[iUnit].replacementUnitNo = 0xDEAD; } } else { DEBUG_PRINT(("Debug: NFTL runs without U-cache\r\n")); }
/* create and initialize SectorFlags cache */#ifdef ENVIRONMENT_VARS
if( flUseNFTLCache == 1 ) /* behave according to the value of env variable */#endif
{ scacheSize = (unsigned long)vol.noOfUnits << (vol.unitSizeBits - SECTOR_SIZE_BITS - 2);#ifdef FL_MALLOC
if( (sizeof(unsigned) < sizeof(scacheSize)) && (scacheSize >= 0x10000L) ) /* Out of Segment Boundary */ vol.scache = NULL; else vol.scache = (unsigned char FAR1*) FL_FAR_MALLOC (scacheSize);#else
vol.scache = vol.scacheBuf;#endif /* FL_MALLOC */
}#ifdef ENVIRONMENT_VARS
else vol.scache = NULL;#endif
if (vol.scache != NULL) { /*
* Whenever SECTOR_IGNORE is found in Sector Flags cache it is double * checked by reading actual sector flags from flash-> This is way * all the cache entries are initially set to SECTOR_IGNORE. */ unsigned char val = (S_CACHE_SECTOR_IGNORE << 6) | (S_CACHE_SECTOR_IGNORE << 4) | (S_CACHE_SECTOR_IGNORE << 2) | S_CACHE_SECTOR_IGNORE; unsigned long iC;
for(iC=0;( iC < scacheSize );iC++) vol.scache[iC] = val; } else { DEBUG_PRINT(("Debug: NFTL runs without S-cache\r\n")); }
#endif /* NFTL_CACHE */
vol.badFormat = FALSE; vol.wearLevel.alarm = (unsigned char)(vol.eraseSum % WLnow); vol.wearLevel.currUnit = (ANANDUnitNo)(vol.eraseSum % vol.noOfVirtualUnits);
return flOK;}
/*----------------------------------------------------------------------*//* f l R e g i s t e r N F T L *//* *//* Register this translation layer *//* *//* Parameters: *//* None *//* *//* Returns: *//* FLStatus : 0 on success, otherwise failure *//*----------------------------------------------------------------------*/
FLStatus flRegisterNFTL(void){#ifdef FL_MALLOC
unsigned i;#endif
if (noOfTLs >= TLS) return flTooManyComponents;
tlTable[noOfTLs].mountRoutine = mountNFTL;
#ifdef FORMAT_VOLUME
tlTable[noOfTLs].formatRoutine = formatNFTL;#else
tlTable[noOfTLs].formatRoutine = noFormat;#endif
noOfTLs++;
#ifdef FL_MALLOC
for(i=0;( i < VOLUMES );i++) { vols[i].physicalUnits = NULL; vols[i].virtualUnits = NULL;#ifdef NFTL_CACHE
vols[i].ucache = NULL; vols[i].scache = NULL;#endif /* NFTL_CACHE */
}#endif /* FL_MALLOC */
return flOK;}
#ifndef FL_READ_ONLY
/*----------------------------------------------------------------------*//* m a r k A s I g n o r e d *//* *//* Mark sector at given address as ignored. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* addr : Physical address of the sector *//* *//*----------------------------------------------------------------------*/
static void markAsIgnored(Anand vol,CardAddress addr){#ifndef RAM_MTD
static const#endif /* RAM_MTD */
byte sectorFlags[2] = {SECTOR_IGNORE,SECTOR_IGNORE};
DEBUG_PRINT(("markAsIgnored : A sector is being marked as ignored\r\n"));
/* Force remapping of internal catched sector */ vol.flash->socket->remapped = TRUE;
#ifdef NFTL_CACHE
setSectorFlagsCache(&vol, addr, SECTOR_IGNORE);#endif /* NFTL_CACHE */
vol.flash->write(vol.flash,addr+SECTOR_DATA_OFFSET,sectorFlags,sizeof(sectorFlags),EXTRA);
#if MAKE_SURE_IGNORE_HAS_BAD_EDC
/* Force remapping of internal catched sector */ vol.flash->socket->remapped = TRUE;
/* Make sure EDC is wrong - a slite problem with PPP */ if(vol.flash->read(vol.flash,addr,nftlBuffer,sizeof(nftlBuffer),EDC)==flOK) { tffsset(nftlBuffer,0,sizeof(nftlBuffer)); vol.flash->write(vol.flash,addr,nftlBuffer,sizeof(nftlBuffer),0);#if (defined(VERIFY_WRITE) || defined (VERIFY_VOLUME) || defined(VERIFY_ERASED_SECTOR))
/* Set all ff's for verifySector routine */ tffsset(nftlBuffer,0xff,sizeof(nftlBuffer));#endif /* VERIFY_WRITE || VERIFY_VOLUME || VERIFY_ERASED_SECTOR */
}#endif /* MAKE_SURE_IGNORE_HAS_BAD_EDC */
}
#if (defined(VERIFY_WRITE) || defined (VERIFY_VOLUME) || defined(VERIFY_ERASED_SECTOR))
/*----------------------------------------------------------------------*//* v e r i f y S e c t o r s *//* *//* Verify sectors for power failures simptoms and fix if neccesary. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* sectorCount : No of sectors to verify *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
FLStatus verifySectors(Anand vol, dword sectorCount){ FLStatus status;
ANANDUnitNo virUnitNo; ANANDUnitNo unitNo; dword curRead; CardAddress unitOffset; CardAddress startSectorAddress; CardAddress sourceSectorAddress; CardAddress nextFreeSectorAddress; byte index,sectorFlags; byte FAR1* buffer;
if (vol.verifiedSectorNo >= vol.virtualSectors) return flOK;
/* Initialize variables */ buffer = flReadBackBufferOf(vol.socketNo); if(buffer==NULL) { DEBUG_PRINT(("\nDebug : Can not verify sectors since no buffer was allocated\r\n")); return flOK; } virUnitNo = (ANANDUnitNo)(vol.verifiedSectorNo / vol.sectorsPerUnit); sectorCount = TFFSMIN(vol.virtualSectors - vol.verifiedSectorNo,sectorCount); /* Force remapping of internal catched sector */ vol.flash->socket->remapped = TRUE; tffsset(nftlBuffer,0xff,sizeof(nftlBuffer));
/* Run over required number of virtual sectors */ for (; sectorCount > 0 ; virUnitNo++ ,sectorCount -= curRead) { /* Calculate needed number of sector in this unit */ unitOffset = (word)((vol.verifiedSectorNo % vol.sectorsPerUnit) << SECTOR_SIZE_BITS); curRead = TFFSMIN(sectorCount,((1UL<<vol.unitSizeBits)-unitOffset)>>SECTOR_SIZE_BITS); unitNo = vol.virtualUnits[virUnitNo];
if(unitNo == ANAND_NO_UNIT) /* Unit is empty */ { vol.verifiedSectorNo += ((1<<vol.unitSizeBits)-unitOffset)>>SECTOR_SIZE_BITS; continue; }
/* Check all sector of unit or until required sectors */ startSectorAddress = unitBaseAddress(&vol,unitNo)+unitOffset;
for (index = 0 ; index < curRead ; index++, vol.verifiedSectorNo++) { nextFreeSectorAddress = ANAND_UNASSIGNED_ADDRESS; /* Search end addr */ sourceSectorAddress = virtual2Physical(&vol, vol.verifiedSectorNo, &nextFreeSectorAddress);
if(sourceSectorAddress == ANAND_UNASSIGNED_ADDRESS) /* No written sector */ sourceSectorAddress = startSectorAddress + ((CardAddress)index << SECTOR_SIZE_BITS);
sectorFlags = getSectorFlags(&vol,sourceSectorAddress); if(sectorFlags == SECTOR_FREE) { checkStatus(vol.flash->read(vol.flash,sourceSectorAddress,buffer,SECTOR_SIZE,0)); if (tffscmp(nftlBuffer,buffer,SECTOR_SIZE)!=0) markAsIgnored(&vol,sourceSectorAddress); continue; } else /* Used sector */ { status = vol.flash->read(vol.flash,sourceSectorAddress,buffer,SECTOR_SIZE,EDC); switch (status) { case flDataError: markAsIgnored(&vol,sourceSectorAddress); createUnitCount(&vol,virUnitNo); break; /* Mark as ignored */ case flOK: break; /* Sector OK */ default: return status; /* Report error */ } } /* Check the next free sector to make sure it is erased */ if(nextFreeSectorAddress != ANAND_UNASSIGNED_ADDRESS) { checkStatus(vol.flash->read(vol.flash,nextFreeSectorAddress,buffer,SECTOR_SIZE,0)); if (tffscmp(nftlBuffer,buffer,SECTOR_SIZE)!=0) markAsIgnored(&vol,nextFreeSectorAddress); } } /* Loop over all sector of unit or until required sectors */ } /* Loop over all required sectors */ return flOK;}
/*----------------------------------------------------------------------*//* c h e c k V o l u m e *//* *//* Scanthe entire media for partialy written sectors. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus checkVolume(Anand vol){ return verifySectors(&vol, 0xffffffff);}
#endif /* VERIFY_WRITE || VERIFY_VOLUME || VERIFY_ERASED_SECTOR */
/*----------------------------------------------------------------------*//* c h e c k F o l d i n g *//* *//* Check folding status and if needed fold again. *//* *//* Parameters: *//* vol : Pointer identifying drive *//* virtualUnitNo : Virtual unit number to re-fold *//* *//* Returns: *//* FLStatus : 0 on success, failed otherwise *//*----------------------------------------------------------------------*/
static FLStatus checkFolding(Anand vol, ANANDUnitNo virtualUnitNo){ ANANDUnitNo tmp;
if(vol.freeUnits == 0) checkStatus(foldBestChain(&vol, &tmp)); return foldUnit(&vol,virtualUnitNo,TRUE);}
#endif /* FL_READ_ONLY */
|
