fmd.cpp

来自「SAMSUNG S3C6410 CPU BSP for winmobile6」· C++ 代码 · 共 2,345 行 · 第 1/4 页

	if(!FMD_SB_ReadSector(sectorAddr, NULL, &SI, 1, mode))
	{
		return BLOCK_STATUS_UNKNOWN;
	}

	if(!(SI.bOEMReserved & OEM_BLOCK_READONLY))
	{
		dwResult |= BLOCK_STATUS_READONLY;
	}

#if	MAGNETO
	if( blockID/8 < pBSPArgs->nfsblk )
	{
//		RETAILMSG(1,(TEXT("pBSPArgs->nfsblk=%d\r\n"),pBSPArgs->nfsblk));
		dwResult |= BLOCK_STATUS_READONLY;
	}
#endif

	if(SI.bBadBlock != 0xFF)
	{
		dwResult |= BLOCK_STATUS_BAD;
	}
	
	SetKMode(bLastMode);
	
	return dwResult;
}

BOOL FMD_LB_SetBlockStatus(BLOCK_ID blockID, DWORD dwStatus, int mode)
{
	BYTE bStatus = 0;

	if(dwStatus & BLOCK_STATUS_BAD)
	{
		if(!LB_MarkBlockBad (blockID, mode))
		{
			return FALSE;
		}
	}

	// We don't currently support setting a block to read-only, so fail if request is
	// for read-only and block is not currently read-only.
	if(dwStatus & BLOCK_STATUS_READONLY)
	{
		if(!(FMD_LB_GetBlockStatus(blockID, mode) & BLOCK_STATUS_READONLY))
		{
			return FALSE;
		}
	}

	return TRUE;
}

BOOL FMD_SB_SetBlockStatus(BLOCK_ID blockID, DWORD dwStatus, int mode)
{
	SECTOR_ADDR sectorAddr = blockID << SB_NAND_LOG_2_PAGES_PER_BLOCK;
	BYTE bStatus = 0;

	if(dwStatus & BLOCK_STATUS_BAD)
	{
		if(!SB_MarkBlockBad (blockID, mode))
		{
			return FALSE;
		}
	}

	// We don't currently support setting a block to read-only, so fail if request is
	// for read-only and block is not currently read-only.
	if(dwStatus & BLOCK_STATUS_READONLY)
	{
		if(!(FMD_SB_GetBlockStatus(blockID, mode) & BLOCK_STATUS_READONLY))
		{
			return FALSE;
		}
	}

	return TRUE;
}



#if MAGNETO
BOOL FMD_LB_GetOEMReservedByte(SECTOR_ADDR physicalSectorAddr, PBYTE pOEMReserved, int mode)
{
	int NewSpareAddr = 2048;
	int NewDataAddr = 0;
	int NewSectorAddr = physicalSectorAddr;

	RETAILMSG(1, (TEXT("FMD_GetOEMReservedByte 0x%x \n"), physicalSectorAddr));
    BOOL bLastMode = SetKMode(TRUE);
    
    //  Enable chip select
    NF_nFCE_L();	
	NF_CLEAR_RB();

    //  Issue command
    NF_CMD(CMD_READ);

    //  Set up address
    NF_ADDR((NewSpareAddr+OEMADDR)&0xff);
    NF_ADDR(((NewSpareAddr+OEMADDR)>>8)&0xff);
    NF_ADDR((NewSectorAddr) & 0xff);
    NF_ADDR((NewSectorAddr >> 8) & 0xff);

    if (LB_NEED_EXT_ADDR) {
        NF_ADDR((NewSectorAddr >> 16) & 0xff);
    }

	NF_CMD(CMD_READ3);

    //  Wait for the ready bit
	NF_DETECT_RB();	 // Wait tR(max 12us)

    //  Read the data
    *pOEMReserved = (BYTE) NF_RDDATA_BYTE();		// read and discard

    //  Disable chip select
    NF_nFCE_H();	

    SetKMode(bLastMode);
	return TRUE;

}


BOOL FMD_SB_GetOEMReservedByte(SECTOR_ADDR physicalSectorAddr, PBYTE pOEMReserved, int mode)
{
    BOOL bLastMode = SetKMode(TRUE);
    
    //  Enable chip select
    NF_nFCE_L();	
	NF_CLEAR_RB();

    //  Issue command
    NF_CMD(CMD_READ2);

    //  Set up address
    NF_ADDR(OEMADDR);
    NF_ADDR((physicalSectorAddr) & 0xff);
    NF_ADDR((physicalSectorAddr >> 8) & 0xff);

    if (SB_NEED_EXT_ADDR) {
        NF_ADDR((physicalSectorAddr >> 16) & 0xff);
    }

    //  Wait for the ready bit
	NF_DETECT_RB();	 // Wait tR(max 12us)

    //  Read the data
    *pOEMReserved = (BYTE) NF_RDDATA_BYTE();	

    //  Disable chip select
    NF_nFCE_H();	

    SetKMode(bLastMode);
	return TRUE;

}



//  FMD_SetOEMReservedByte
//
//  Sets the OEM reserved byte (for metadata) for the specified physical sector.
//
BOOL FMD_LB_SetOEMReservedByte(SECTOR_ADDR physicalSectorAddr, BYTE bOEMReserved, int mode)
{
    BOOL    bRet = TRUE;
	int NewSpareAddr = 2048;
	int NewDataAddr = 0;
	int NewSectorAddr = physicalSectorAddr;

	RETAILMSG(1, (TEXT("FMD_SetOEMReservedByte 0x%x \n"), physicalSectorAddr));
    BOOL bLastMode = SetKMode(TRUE);

    //  Enable chip select
    NF_nFCE_L();	
	NF_CLEAR_RB();

    //  Issue command
    NF_CMD(CMD_WRITE);

    //  Set up address
    NF_ADDR((NewSpareAddr+OEMADDR)&0xff);
    NF_ADDR(((NewSpareAddr+OEMADDR)>>8)&0xff);
    NF_ADDR((NewSectorAddr) & 0xff);
    NF_ADDR((NewSectorAddr >> 8) & 0xff);

    if (LB_NEED_EXT_ADDR) {
        NF_ADDR((NewSectorAddr >> 16) & 0xff);
    }

    //  Write the data
	bOEMReserved = NF_RDDATA_BYTE() ;

    //  Complete the write
    NF_CMD(CMD_WRITE2);

    //  Wait for the ready bit
	NF_DETECT_RB();	 // Wait tR(max 12us)

#if 1
	if ( NF_RDSTAT & STATUS_ILLACC )
	{
		RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page (Illigar Access) %d!\n"), NewSectorAddr));
		s6410NAND->NFSTAT =  STATUS_ILLACC;	// Write 1 to clear.
       	bRet = FALSE;
	}
	else
#endif		
	{
		//  Check the status of program
		NF_CMD(CMD_STATUS);

		if( NF_RDDATA_BYTE() & STATUS_ERROR) {
			RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page %d!\n"), NewSectorAddr));
			bRet = FALSE;
		}
	}

    //  Disable chip select
    NF_nFCE_H();	

    SetKMode(bLastMode);
    return bRet;
}


BOOL FMD_SB_SetOEMReservedByte(SECTOR_ADDR physicalSectorAddr, BYTE bOEMReserved, int mode)
{
    BOOL    bRet = TRUE;

    BOOL bLastMode = SetKMode(TRUE);

    //  Enable chip select
    NF_nFCE_L();	
	NF_CLEAR_RB();

    //  Issue command
    NF_CMD(CMD_READ2);
    NF_CMD(CMD_WRITE);

    //  Set up address
    NF_ADDR(OEMADDR);
    NF_ADDR((physicalSectorAddr) & 0xff);
    NF_ADDR((physicalSectorAddr >> 8) & 0xff);

    if (SB_NEED_EXT_ADDR) {
        NF_ADDR((physicalSectorAddr >> 16) & 0xff);
    }

    //  Write the data
    bOEMReserved = NF_RDDATA_BYTE();

    //  Complete the write
    NF_CMD(CMD_WRITE2);

    //  Wait for the ready bit
	NF_DETECT_RB();	 // Wait tR(max 12us)


#if 1
	if ( NF_RDSTAT & STATUS_ILLACC )
	{
		RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page (Illigar Access) %d!\n"), physicalSectorAddr));
		s6410NAND->NFSTAT =  STATUS_ILLACC;	// Write 1 to clear.
       	bRet = FALSE;
	}
	else
#endif		
	{
		//  Check the status of program
		NF_CMD(CMD_STATUS);

		if( NF_RDDATA_BYTE() & STATUS_ERROR) {
			RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page %d!\n"), physicalSectorAddr));
			bRet = FALSE;
		}
	}

    //  Disable chip select
    NF_nFCE_H();	

    SetKMode(bLastMode);
    return bRet;
}
#endif // MAGNETO


BOOL LB_MarkBlockBad(BLOCK_ID blockID, int mode)
{
	DWORD   dwStartPage = blockID << LB_NAND_LOG_2_PAGES_PER_BLOCK;
	BOOL    bRet = TRUE;

	BOOL bLastMode = SetKMode(TRUE);

	//  Enable chip
	NF_nFCE_L();
	NF_CLEAR_RB();

	//  Issue command
	//  We are dealing with spare area
	NF_CMD(CMD_WRITE);

	//  Set up address
	NF_ADDR((2048+VALIDADDR)&0xff);
	NF_ADDR(((2048+VALIDADDR)>>8)&0xff);
	NF_ADDR((dwStartPage) & 0xff);
	NF_ADDR((dwStartPage >> 8) & 0xff);
	if (LB_NEED_EXT_ADDR) {
		NF_ADDR((dwStartPage >> 16) & 0xff);
	}

	NF_WRDATA_BYTE(BADBLOCKMARK);

	//  Copmlete the write
	NF_CMD(CMD_WRITE2);

	//  Wait for RB
	NF_DETECT_RB();	 // Wait tR(max 12us)

	if ( NF_RDSTAT & STATUS_ILLACC )
	{
		RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page (Illigar Access) %d!\n")));
		s6410NAND->NFSTAT =  STATUS_ILLACC;	// Write 1 to clear.
		bRet = FALSE;
	}
	else
	{
		//  Check the status of program
		NF_CMD(CMD_STATUS);

		if( NF_RDDATA_BYTE() & STATUS_ERROR)
		{
			RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page %d!\n")));
			bRet = FALSE;
		}
	}

	//  Disable chip select
	NF_nFCE_H();

    SetKMode(bLastMode);
	return bRet;
}

BOOL SB_MarkBlockBad(BLOCK_ID blockID, int mode)
{
	DWORD   dwStartPage = blockID << SB_NAND_LOG_2_PAGES_PER_BLOCK;
	BOOL    bRet = TRUE;


	BOOL bLastMode = SetKMode(TRUE);

	//  Enable chip
	NF_nFCE_L();
	NF_CLEAR_RB();

	//  Issue command
	//  We are dealing with spare area
	NF_CMD(CMD_READ2);
	NF_CMD(CMD_WRITE);

	//  Set up address
	NF_ADDR(VALIDADDR);
	NF_ADDR((dwStartPage) & 0xff);
	NF_ADDR((dwStartPage >> 8) & 0xff);
	if (SB_NEED_EXT_ADDR) {
		NF_ADDR((dwStartPage >> 16) & 0xff);
	}

	NF_WRDATA_BYTE(BADBLOCKMARK);

	//  Copmlete the write
	NF_CMD(CMD_WRITE2);

	//  Wait for RB
	NF_DETECT_RB();	 // Wait tR(max 12us)

	if ( NF_RDSTAT & STATUS_ILLACC )
	{
		RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page (Illigar Access) %d!\n")));
		s6410NAND->NFSTAT =  STATUS_ILLACC;	// Write 1 to clear.
		bRet = FALSE;
	}
	else
	{
		//  Check the status of program
		NF_CMD(CMD_STATUS);

		if( NF_RDDATA_BYTE() & STATUS_ERROR)
		{
			RETAILMSG(1, (TEXT("NAND_LB_WriteSectorInfo() ######## Error Programming page %d!\n")));
			bRet = FALSE;
		}
	}

    //  Disable chip select
    NF_nFCE_H();

    SetKMode(bLastMode);
    return bRet;
}

BOOL LB_IsBlockBad(BLOCK_ID blockID, int mode)
{
	DWORD   dwPageID = blockID << LB_NAND_LOG_2_PAGES_PER_BLOCK;
	BOOL    bRet = FALSE;
	BYTE    wFlag;

    BOOL bLastMode = SetKMode(TRUE);

	//  Enable the chip
	NF_nFCE_L();
	NF_CLEAR_RB();

	//  Issue the command
	NF_CMD(CMD_READ);

	//  Set up address
	NF_ADDR((2048+VALIDADDR)&0xff);
	NF_ADDR(((2048+VALIDADDR)>>8)&0xff);
	NF_ADDR((dwPageID) & 0xff);
	NF_ADDR((dwPageID >> 8) & 0xff);

    if (LB_NEED_EXT_ADDR) {
        NF_ADDR((dwPageID >> 16) & 0xff);
    }

	NF_CMD(CMD_READ3);

	//  Wait for Ready bit
	NF_DETECT_RB();	 // Wait tR(max 12us)

	//  Now get the byte we want
	wFlag = (BYTE)(NF_RDDATA_BYTE()&0xff);

	if(wFlag != 0xff)
	{
		RETAILMSG(1, (TEXT("FMDLB: IsBlockBad - Page #: 0x%x \r\n"), dwPageID));
		bRet = TRUE;
	}

	//  Disable the chip
	NF_nFCE_H();

    SetKMode(bLastMode);
	return bRet;
}

BOOL SB_IsBlockBad(BLOCK_ID blockID, int mode)
{
	DWORD   dwPageID = blockID << SB_NAND_LOG_2_PAGES_PER_BLOCK;
	BOOL    bRet = FALSE;
	BYTE    wFlag;


    BOOL bLastMode = SetKMode(TRUE);

	//  Enable the chip
	NF_nFCE_L();
	NF_CLEAR_RB();
	//  Issue the command
	NF_CMD(CMD_READ2);

	//  Set up address
	NF_ADDR(VALIDADDR);
	NF_ADDR((dwPageID) & 0xff);
	NF_ADDR((dwPageID >> 8) & 0xff);
    if (SB_NEED_EXT_ADDR) {
        NF_ADDR((dwPageID >> 16) & 0xff);
    }

	//  Wait for Ready bit
	NF_DETECT_RB();	 // Wait tR(max 12us)

	//  Now get the byte we want
	wFlag = (BYTE) NF_RDDATA_BYTE();

    if(wFlag != 0xff) {
		RETAILMSG(1, (TEXT("FMDSB: IsBlockBad - Page #: 0x%x \r\n"), dwPageID));
		bRet = TRUE;
	}

	//  Disable the chip
	NF_nFCE_H();

    SetKMode(bLastMode);
    return bRet;
}


#if MAGNETO
static BOOL DefineLayout()
{
    PFlashRegion pRegion = NULL;
    DWORD dwBlock = 0;

    if (!FMD_GetInfo (&g_flashInfo)) {
        return FALSE;
    }
    
    // Find the MBR to determine if there is a flash layout sector
    g_dwNumRegions = 0;


    // Find the first usuable block
    while (dwBlock < g_flashInfo.dwNumBlocks) {
        if (!(FMD_GetBlockStatus(dwBlock) & (BLOCK_STATUS_BAD | BLOCK_STATUS_RESERVED))) {
            break;
        }
        dwBlock++;
    }

	RETAILMSG(1, (TEXT("DefineLayout: dwBlock = 0x%x \r\n"), dwBlock));

	// Find the first usuable sector
    DWORD dwSector = dwBlock * g_flashInfo.wSectorsPerBlock;
	RETAILMSG(1, (TEXT("DefineLayout: dwSector = 0x%x \r\n"), dwSector));	
    if (!FMD_ReadSector (dwSector, g_pFLSBuffer, NULL, 1)) {
        return FALSE;
    }

    // compare the signatures
    if (IS_VALID_BOOTSEC(g_pFLSBuffer)) 
    {
        if (!FMD_ReadSector (dwSector+1, g_pFLSBuffer, NULL, 1)) {
            return FALSE;
        }
        if (IS_VALID_FLS(g_pFLSBuffer)) 
        {           
            PFlashLayoutSector pFLS = (PFlashLayoutSector)(g_pFLSBuffer);
            
            // Cache the flash layout sector information
            g_dwNumRegions = pFLS->cbRegionEntries / sizeof(FlashRegion);
			RETAILMSG(1, (TEXT("DefineLayout: g_dwNumRegions = 0x%x \r\n"), g_dwNumRegions));
           
            // FlashRegion table starts after the ReservedEntry table. 
            if (g_dwNumRegions)
            {
                pRegion = (PFlashRegion)((LPBYTE)pFLS + sizeof(FlashLayoutSector) + pFLS->cbReservedEntries); 
			RETAILMSG(1, (TEXT("DefineLayout: sizeof(FlashLayoutSector) = %x cdReservedEntries = %x  \r\n"), 
				sizeof(FlashLayoutSector),pFLS->cbReservedEntries));
            }
        }
    }
   
    if (!g_dwNumRegions) 
    {
        g_dwNumRegions = 1;
    }

    if (g_dwNumRegions > MAX_REGIONS)
        return FALSE;


    if (pRegion)
    {
        memcpy (g_pRegionTable, pRegion, g_dwNumRegions * sizeof(FlashRegion));
    }
    else

    {
        g_pRegionTable[0].dwStartPhysBlock = 0;
        g_pRegionTable[0].dwNumPhysBlocks = g_flashInfo.dwNumBlocks;
        g_pRegionTable[0].dwNumLogicalBlocks = FIELD_NOT_IN_USE;        
        g_pRegionTable[0].dwBytesPerBlock = g_flashInfo.dwBytesPerBlock;
        g_pRegionTable[0].regionType = FILESYS;
        g_pRegionTable[0].dwSectorsPerBlock = g_flashInfo.wSectorsPerBlock;
        g_pRegionTable[0].dwCompactBlocks = DEFAULT_COMPACTION_BLOCKS;    
    }

	RETAILMSG(1, (TEXT("DefineLayout: g_pRegionTable[0].dwNumPhysBlocks = 0x%x\r\ndwBytesperBlock = %x \r\ndwSectorsPerBlock = %x\r\n")
						,g_pRegionTable[0].dwNumPhysBlocks,g_pRegionTable[0].dwBytesPerBlock
						,g_pRegionTable[0].dwSectorsPerBlock));
	RETAILMSG(1, (TEXT("DefineLayout: g_flashInfo.dwNumPhysBlocks = 0x%x\r\ndwBytesperBlock = %x \r\ndwSectorsPerBlock = %x\r\n")
						,g_flashInfo.dwNumBlocks,g_flashInfo.dwBytesPerBlock
						,g_flashInfo.wSectorsPerBlock));	
    
    return TRUE;
}
#endif // MAGNETO