?? fmd.cpp
字號:
NF_WRDATA_WORD(SECCBuf);
#endif
// Issue the write complete command
NF_CMD(CMD_WRITE2);
// Check ready bit
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"), sectorAddr));
s2443NAND->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"), sectorAddr));
bRet = FALSE;
}
}
NF_nFCE_H();
SetKMode(bLastMode);
return bRet;
}
BOOL RAW_LB_ReadPage(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, LPBYTE pSectorInfoBuff)
{
UINT SectorAddr = (UINT)startSectorAddr;
DWORD i;
volatile DWORD rddata;
UINT32 SpareAddr = 2048;
UINT32 ColAddr = 0;
//RETAILMSG(1,(TEXT("#### FMD_DRIVER:::RAW_LB_ReadPage %x\r\n"),startSectorAddr));
if (!pSectorBuff && !pSectorInfoBuff)
return(FALSE);
BOOL bLastMode = SetKMode(TRUE);
// Enable Chip
NF_nFCE_L();
NF_CLEAR_RB();
NF_CMD(CMD_READ); // Send read command.
NF_ADDR((ColAddr)&0xff);
NF_ADDR(((ColAddr)>>8)&0xff);
NF_ADDR((SectorAddr) & 0xff);
NF_ADDR((SectorAddr>>8) & 0xff);
if (LB_NEED_EXT_ADDR)
NF_ADDR((SectorAddr>>16) & 0xff);
NF_CMD(CMD_READ3); // 2nd command
NF_DETECT_RB(); // Wait for command to complete.
if( ((DWORD) pSectorBuff) & 0x3)
{
for(i=0; i<(2048/sizeof(DWORD)); i++) {
rddata = (DWORD) NF_RDDATA_WORD();
pSectorBuff[i*4+0] = (BYTE)(rddata & 0xff);
pSectorBuff[i*4+1] = (BYTE)(rddata>>8 & 0xff);
pSectorBuff[i*4+2] = (BYTE)(rddata>>16 & 0xff);
pSectorBuff[i*4+3] = (BYTE)(rddata>>24 & 0xff);
}
}
else
{
RdPage2048(pSectorBuff); // Read page/sector data.
}
NF_CMD(CMD_RDO);
// Set up address
NF_ADDR((SpareAddr)&0xff);
NF_ADDR(((SpareAddr)>>8)&0xff);
NF_CMD(CMD_RDO2);
if (pSectorInfoBuff)
{
RdPageSpare((PBYTE)pSectorInfoBuff); // Read page/sector information.
}
NF_nFCE_H();
SetKMode (bLastMode);
return(TRUE);
}
BOOL RAW_SB_ReadPage(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, LPBYTE pSectorInfoBuff)
{
ULONG SectorAddr = (ULONG)startSectorAddr;
UINT32* pSBuf = (UINT32*)pSectorInfoBuff;
if (!pSectorBuff && !pSectorInfoBuff)
return(FALSE);
BOOL bLastMode = SetKMode(TRUE);
//RETAILMSG(1, (TEXT("FMD::FMD_SB_ReadSector 0x%x \r\n"), startSectorAddr));
NF_nFCE_L();
NF_CLEAR_RB();
NF_CMD(CMD_READ); // Send read command.
NF_ADDR(0); // Column = 0.
NF_ADDR((SectorAddr) &0xff); // Page address.
NF_ADDR((SectorAddr>>8)&0xff);
if (SB_NEED_EXT_ADDR)
NF_ADDR((SectorAddr>>16)&0xff);
NF_DETECT_RB(); // Wait for command to complete.
if( ((DWORD) pSectorBuff) & 0x3)
{
RdPage512Unalign (pSectorBuff);
}
else
{
RdPage512(pSectorBuff); // Read page/sector data.
}
if (pSectorInfoBuff)
{
*pSBuf++ = NF_RDDATA_WORD();
*pSBuf++ = NF_RDDATA_WORD();
*pSBuf++ = NF_RDDATA_WORD();
*pSBuf++ = NF_RDDATA_WORD();
}
NF_nFCE_H();
SetKMode (bLastMode);
return(TRUE);
}
BOOL FMD_SB_WriteSector(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, PSectorInfo pSectorInfoBuff, DWORD dwNumSectors,int mode)
{
BYTE Status;
ULONG SectorAddr = (ULONG)startSectorAddr;
ULONG MECC;
if (!pSectorBuff && !pSectorInfoBuff)
return(FALSE);
//RETAILMSG(1,(TEXT("#### FMD_DRIVER:::FMD_sbwrite \r\n")));
BOOL bLastMode = SetKMode(TRUE);
NF_nFCE_L(); // Select the flash chip.
while (dwNumSectors--)
{
if (!pSectorBuff) // Only spare area
{
// If we are asked just to write the SectorInfo, we will do that separately
NF_CMD(CMD_READ2); // Send read command.
NF_CMD(CMD_WRITE); // Send write command.
NF_ADDR(0); // Column = 0.
NF_ADDR(SectorAddr & 0xff); // Page address.
NF_ADDR((SectorAddr >> 8) & 0xff);
if (SB_NEED_EXT_ADDR)
NF_ADDR((SectorAddr >> 16) & 0xff);
// Write the SectorInfo data to the media.
// Spare area[7:0]
WrPageInfo((PBYTE)pSectorInfoBuff);
NF_CLEAR_RB();
NF_CMD(CMD_WRITE2); // Send write confirm command.
NF_DETECT_RB();
NF_CMD(CMD_STATUS);
Status = NF_RDDATA_BYTE(); // Read command status.
if (Status & STATUS_ERROR)
{
NF_nFCE_H(); // Deselect the flash chip.
SetKMode (bLastMode);
return(FALSE);
}
pSectorInfoBuff++;
}
else // Main area+Spare area.
{
NF_CMD(CMD_READ); // Send read command.
NF_CMD(CMD_WRITE); // Send write command.
NF_ADDR(0); // Column = 0.
NF_ADDR(SectorAddr & 0xff); // Page address.
NF_ADDR((SectorAddr >> 8) & 0xff);
if (SB_NEED_EXT_ADDR)
NF_ADDR((SectorAddr >> 16) & 0xff);
// Special case to handle un-aligned buffer pointer.
NF_RSTECC();
NF_MECC_UnLock();
if( ((DWORD) pSectorBuff) & 0x3)
{
WrPage512Unalign (pSectorBuff);
}
else
{
WrPage512(pSectorBuff); // Write page/sector data.
}
NF_MECC_Lock();
// Write the SectorInfo data to the media.
// Spare area[7:0]
if(pSectorInfoBuff)
{
WrPageInfo((PBYTE)pSectorInfoBuff);
pSectorInfoBuff++;
}
else // Make sure we advance the Flash's write pointer (even though we aren't writing the SectorInfo data)
{
BYTE TempInfo[] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
WrPageInfo(TempInfo);
}
// Write the SectorInfo data to the media.
// Spare area[11:8]
// Get the ECC data from status register.
MECC = NF_RDMECC0();
// Now, Write the ECC data to Spare area[11:8]
NF_WRDATA_BYTE((UCHAR)((MECC ) & 0xff)); // Spare area offset 8
NF_WRDATA_BYTE((UCHAR)((MECC >> 8) & 0xff)); // Spare area offset 9
NF_WRDATA_BYTE((UCHAR)((MECC >> 16) & 0xff)); // Spare area offset 10
NF_WRDATA_BYTE((UCHAR)((MECC >> 24) & 0xff)); // Spare area offset 11
NF_CLEAR_RB();
NF_CMD(CMD_WRITE2); // Send write confirm command.
NF_DETECT_RB();
do
{
NF_CMD(CMD_STATUS);
Status = NF_RDDATA_BYTE(); // Read command status.
}while(!(Status & STATUS_READY));
if (Status & STATUS_ERROR)
{
NF_nFCE_H(); // Deselect the flash chip.
SetKMode (bLastMode);
return(FALSE);
}
pSectorBuff += NAND_SECTOR_SIZE;
}
++SectorAddr;
}
NF_nFCE_H(); // Deselect the flash chip.
SetKMode (bLastMode);
return(TRUE);
}
BOOL FMD_LB_EraseBlock(BLOCK_ID blockID, int mode)
{
BOOL bRet = TRUE;
DWORD dwPageID = blockID << LB_NAND_LOG_2_PAGES_PER_BLOCK;
BOOL bLastMode = SetKMode(TRUE);
//RETAILMSG(1, (TEXT("FMD_LB_EraseBlock 0x%x \r\n"), blockID));
// Enable the chip
NF_nFCE_L(); // Select the flash chip.
NF_CLEAR_RB();
// Issue command
NF_CMD(CMD_ERASE);
// Set up address
NF_ADDR((dwPageID) & 0xff);
NF_ADDR((dwPageID >> 8) & 0xff);
if (LB_NEED_EXT_ADDR)
NF_ADDR((dwPageID >> 16) & 0xff);
// Complete erase operation
NF_CMD(CMD_ERASE2);
// Wait for ready bit
NF_DETECT_RB(); // Wait tR(max 12us)
if ( NF_RDSTAT & STATUS_ILLACC )
{
RETAILMSG(1, (TEXT("LB######## Error Erasing block (Illigar Access) %d!\n"), blockID));
s2443NAND->NFSTAT = STATUS_ILLACC; // Write 1 to clear.
bRet = FALSE;
}
else
{
// Check the status
NF_CMD(CMD_STATUS);
if( NF_RDDATA_BYTE() & STATUS_ERROR) {
RETAILMSG(1, (TEXT("LB######## Error Erasing block %d!\n"), blockID));
bRet = FALSE;
}
}
NF_nFCE_H(); // Select the flash chip.
SetKMode(bLastMode);
return bRet;
}
BOOL FMD_SB_EraseBlock(BLOCK_ID blockID, int mode)
{
BOOL bRet = TRUE;
DWORD dwPageID = blockID << SB_NAND_LOG_2_PAGES_PER_BLOCK;
BOOL bLastMode = SetKMode(TRUE);
//RETAILMSG(1, (TEXT("FMD_sb_EraseBlock 0x%x \r\n"), blockID));
// Enable the chip
NF_nFCE_L(); // Select the flash chip.
// Issue command
NF_CMD(CMD_ERASE);
// Set up address
NF_ADDR((dwPageID) & 0xff);
NF_ADDR((dwPageID >> 8) & 0xff);
if (SB_NEED_EXT_ADDR)
NF_ADDR((dwPageID >> 16) & 0xff);
NF_CLEAR_RB();
// Complete erase operation
NF_CMD(CMD_ERASE2);
// Wait for ready bit
NF_DETECT_RB(); // Wait tR(max 12us)
if ( NF_RDSTAT & STATUS_ILLACC )
{
RETAILMSG(1, (TEXT("SB######## Error Erasing block (Illigar Access) %d!\n"), blockID));
s2443NAND->NFSTAT = STATUS_ILLACC; // Write 1 to clear.
bRet = FALSE;
}
else
{
// Check the status
NF_CMD(CMD_STATUS);
if( NF_RDDATA_BYTE() & STATUS_ERROR) {
RETAILMSG(1, (TEXT("SB######## Error Erasing block %d!\n"), blockID));
bRet = FALSE;
}
}
NF_nFCE_H(); // Select the flash chip.
SetKMode(bLastMode);
return bRet;
}
DWORD FMD_LB_GetBlockStatus(BLOCK_ID blockID, int mode)
{
SECTOR_ADDR sectorAddr = blockID << LB_NAND_LOG_2_PAGES_PER_BLOCK;
SectorInfo SI;
DWORD dwResult = 0;
BOOL bLastMode = SetKMode(TRUE);
//RETAILMSG(1, (TEXT("FMD_LB_GetBlockStatus (0x%x)0x%x \r\n"), blockID, sectorAddr));
if(!FMD_LB_ReadSector(sectorAddr, NULL, &SI, 1, mode))
{
return BLOCK_STATUS_UNKNOWN;
}
if(!(SI.bOEMReserved & OEM_BLOCK_READONLY))
{
dwResult |= BLOCK_STATUS_READONLY;
}
#if MAGNETO
if( sectorAddr < pBSPArgs->nfsblk )
{
dwResult |= BLOCK_STATUS_READONLY;
}
#endif
if (!(SI.bOEMReserved & OEM_BLOCK_RESERVED))
dwResult |= BLOCK_STATUS_RESERVED;
if(SI.bBadBlock != 0xFF)
{
dwResult |= BLOCK_STATUS_BAD;
}
SetKMode(bLastMode);
return dwResult;
}
DWORD FMD_SB_GetBlockStatus(BLOCK_ID blockID, int mode)
{
SECTOR_ADDR sectorAddr = blockID << SB_NAND_LOG_2_PAGES_PER_BLOCK;
SectorInfo SI;
DWORD dwResult = 0;
BOOL bLastMode = SetKMode(TRUE);
//RETAILMSG(1, (TEXT("FMD_SB_GetBlockStatus (0x%x)0x%x \r\n"), blockID, sectorAddr));
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;
//RETAILMSG(1,(TEXT("#### FMD_DRIVER:::FMD_sbsetblock \r\n")));
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;
}
BOOL LB_MarkBlockBad(BLOCK_ID blockID, int mode)
{
DWORD dwStartPage = blockID << LB_NAND_LOG_2_PAGES_PER_BLOCK;
BOOL bRet = TRUE;
// RETAILMSG(1, (TEXT("LB_MarkBlockBad 0x%x \r\n"), dwStartPage));
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+POS_BADBLOCK)&0xff);
NF_ADDR(((2048+POS_BADBLOCK)>>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);
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -