⭐ 欢迎来到虫虫下载站! | 📦 资源下载 📁 资源专辑 ℹ️ 关于我们
⭐ 虫虫下载站

📄 fmd.cpp

📁 SMDK2450的BSP 有很多新的特性,记得升级PB啊.
💻 CPP
📖 第 1 页 / 共 4 页
字号:
				RETAILMSG(1,(TEXT("#### SECC1 Uncorrectable error(0x%x) ####\r\n"), sectoraddr));
			else if(nType == ECC_CORRECT_SPARE2)
				RETAILMSG(1,(TEXT("#### SECC2 Uncorrectable error(0x%x) ####\r\n"), sectoraddr));
			bRet = FALSE;			
			break;
		case 3:	// ECC area Error
			RETAILMSG(1,(TEXT("#### %cECC area error ####\r\n"), ((nType==ECC_CORRECT_MAIN)?'M':'S')));
		default:
			bRet = FALSE;			
			break;
	}

	return bRet;
}


BOOL FMD_LB_ReadSector(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, PSectorInfo pSectorInfoBuff, DWORD dwNumSectors,int mode)
{
	ULONG SectorAddr = (ULONG)startSectorAddr;
	DWORD       i;
	volatile DWORD		rddata;	
	UINT32 nRetEcc = 0;
	DWORD MECCBuf[4];
	UINT16 nSectorLoop;
	int NewSpareAddr = 2048;	//Spare 康开 矫累 林家
	int NewDataAddr = 0;		//Data 康开 矫累 林家
	int NewSectorAddr = startSectorAddr;
	DWORD SECCBuf1;
	DWORD SECCBuf2;
	byte bTempSectorInfo[6];
	
	// Parameter Check.
	if (!pSectorBuff && !pSectorInfoBuff)
	{
		return(FALSE);
	}	
	if ( dwNumSectors > 1 )
	{
		RETAILMSG(1, (TEXT("######## FATAL ERROR => FMD::FMD_ReadSector->dwNumsectors is bigger than 1. \r\n")));
		return FALSE;
	}
	
	BOOL bLastMode = SetKMode(TRUE);	// always true... dummy function.
	
	if (!pSectorBuff)
	{
		if (!NAND_LB_ReadSectorInfo(startSectorAddr, pSectorInfoBuff, mode))	//error啊 绝绰瘤 眉农 乐栏搁 荐沥
		{
			return FALSE;
		}
	
		return TRUE;
	}
	
	//  Enable Chip
	NF_nFCE_L();		// NFCONT狼 [1]甫 0栏肺 努府绢 ... Force nFCE to low
	
	NF_CLEAR_RB();		// NFSTAT狼 [4]甫 1肺 悸泼 ... RnB_TransDetect ... RnB啊 low俊辑 high肺 官拆锭 detect 窍档废 enable.
	
	NF_CMD(CMD_READ);	// Send read confirm command.
	//  Set address to read SECC1, SECC2 from Spare Area
	NF_ADDR((NewSpareAddr+24)&0xff);
	NF_ADDR(((NewSpareAddr+24)>>8)&0xff);
	NF_ADDR((NewSectorAddr)&0xff);		// 佬绢棵 block 阑 啊府虐绰 林家 (== row address 3cycle俊 吧媚辑 焊晨)
	NF_ADDR((NewSectorAddr>>8)&0xff);
	
	if (LB_NEED_EXT_ADDR)
	{
		NF_ADDR((NewSectorAddr>>16)&0xff);
	}
	
	NF_CMD(CMD_READ3);
	
	NF_DETECT_RB();		// NFSTAT狼 [1:0]捞 11老 锭鳖瘤 公茄 风橇.  [0]== 1 ; NAND Flash memory ready to operate							// Wait for command to complete.

	// Read SECC1, SECC2 from Spare area
	SECCBuf1 = NF_RDDATA_WORD();
	SECCBuf2 = NF_RDDATA_WORD();

	// Set address for random access to read SectorInfo and MECC code from Spare Area
	NF_CMD(CMD_RDO);	// Send read random data output command.
	NF_ADDR((NewSpareAddr)&0xff);
	NF_ADDR(((NewSpareAddr)>>8)&0xff);
	NF_CMD(CMD_RDO2);	// command 场.
	
	if (pSectorInfoBuff)
	{
		// Initialize MECC Module
		NF_RSTECC();
		NF_MECC_UnLock();
		// Read SectorInfo
		for(i = 0; i < 6; i++) {
			bTempSectorInfo[i] = NF_RDDATA_BYTE();
		}
		NF_MECC_Lock();
		pSectorInfoBuff->wReserved2 = NF_RDDATA_BYTE();
		pSectorInfoBuff->wReserved2 |= (NF_RDDATA_BYTE()<<8);
	}
	// If there is no SectorInfoBuffer, Just read and waste.
	else	
	{
		for(i=0; i<sizeof(SectorInfo)/sizeof(DWORD); i++) 
		rddata = (DWORD) NF_RDDATA_WORD();		// read and trash the data
	}

	// Check ECC about SectorInfo
	if (pSectorInfoBuff)
	{
		NF_WRMECCD0( ((SECCBuf1&0xff00)<<8)|(SECCBuf1&0xff) );
		NF_WRMECCD1( ((SECCBuf1&0xff000000)>>8)|((SECCBuf1&0xff0000)>>16) );
	
		nRetEcc = NF_ECC_ERR0;

		if (!ECC_CorrectData(startSectorAddr, bTempSectorInfo, nRetEcc, ECC_CORRECT_SPARE1))
		{
			RETAILMSG(1, (TEXT("#### FMD_DRIVER:::FMD_LB_READSECTOR 5 for SECC1\r\n")));
			return FALSE;
		}

		pSectorInfoBuff->bBadBlock =  bTempSectorInfo[0];
		pSectorInfoBuff->dwReserved1 = bTempSectorInfo[1];
		pSectorInfoBuff->dwReserved1 |= bTempSectorInfo[2]<<8;
		pSectorInfoBuff->dwReserved1 |= bTempSectorInfo[3]<<16;
		pSectorInfoBuff->dwReserved1 |= bTempSectorInfo[4]<<24;
		pSectorInfoBuff->bOEMReserved = bTempSectorInfo[5];
		
	}

	// Initialize MECC module
	NF_RSTECC();
	NF_MECC_UnLock();

	// Read MECC parity code from Spare Area
	for (nSectorLoop = 0; nSectorLoop < SECTORS_PER_PAGE; nSectorLoop++)
	{
		MECCBuf[nSectorLoop] = NF_RDDATA_WORD();
	}
	NF_MECC_Lock();
	
	// Check ECC about MECC parity code
	NF_WRMECCD0( ((SECCBuf2&0xff00)<<8)|(SECCBuf2&0xff) );
	NF_WRMECCD1( ((SECCBuf2&0xff000000)>>8)|((SECCBuf2&0xff0000)>>16) );

	nRetEcc = NF_ECC_ERR0;

	if (!ECC_CorrectData(startSectorAddr, (LPBYTE)MECCBuf, nRetEcc, ECC_CORRECT_SPARE2))
	{
		RETAILMSG(1, (TEXT("#### FMD_DRIVER:::FMD_LB_READSECTOR 5 for SECC2\r\n")));
		return FALSE;
	}



	// Read each Sector in the Page. (4 Sector per Page, Loop 4 times.)
	for (nSectorLoop = 0; nSectorLoop < SECTORS_PER_PAGE; nSectorLoop++)
	{
		// calculate start address of each Sector
		NewDataAddr = nSectorLoop * SECTOR_SIZE;

		// Set address for random access
		NF_CMD(CMD_RDO);
		NF_ADDR((NewDataAddr)&0xff);
		NF_ADDR((NewDataAddr>>8)&0xff);
		NF_CMD(CMD_RDO2);

		// Initialize ECC module
		NF_RSTECC();
		NF_MECC_UnLock();
		
		 // Special case to handle un-aligned buffer pointer.
		if( ((DWORD) (pSectorBuff+nSectorLoop*SECTOR_SIZE)) & 0x3) 
		{
			for(i=0; i<SECTOR_SIZE/sizeof(DWORD); i++)
			{
				rddata = (DWORD) NF_RDDATA_WORD();
				(pSectorBuff+nSectorLoop*SECTOR_SIZE)[i*4+0] = (BYTE)(rddata & 0xff);
				(pSectorBuff+nSectorLoop*SECTOR_SIZE)[i*4+1] = (BYTE)(rddata>>8 & 0xff);
				(pSectorBuff+nSectorLoop*SECTOR_SIZE)[i*4+2] = (BYTE)(rddata>>16 & 0xff);
				(pSectorBuff+nSectorLoop*SECTOR_SIZE)[i*4+3] = (BYTE)(rddata>>24 & 0xff);
			}
		}
		// usual case to handle 4byte aligned buffer pointer
		else 
		{
			RdPage512(pSectorBuff+nSectorLoop*SECTOR_SIZE);					// Read page/sector data.
		}
	
		NF_MECC_Lock();
		
		// Check ECC about Main Data with MECC parity code
		NF_WRMECCD0( ((MECCBuf[nSectorLoop]&0xff00)<<8)|(MECCBuf[nSectorLoop]&0xff) );
		NF_WRMECCD1( ((MECCBuf[nSectorLoop]&0xff000000)>>8)|((MECCBuf[nSectorLoop]&0xff0000)>>16) );
	
		nRetEcc = NF_ECC_ERR0;
	
		if (!ECC_CorrectData(startSectorAddr, pSectorBuff+nSectorLoop*SECTOR_SIZE, nRetEcc, ECC_CORRECT_MAIN))
		{
			RETAILMSG(1, (TEXT("#### FMD_DRIVER:::FMD_LB_READSECTOR 7\r\n")));
			return FALSE;
		}
	}
	
	NF_nFCE_H();	//NFCONT狼 [1]甫 1肺 Set ... Force nFCE to high
	
	SetKMode (bLastMode);
	
	return TRUE;
}	

BOOL NAND_LB_ReadSectorInfo(SECTOR_ADDR sectorAddr, PSectorInfo pInfo, int mode)
{
	int i;
	BOOL bRet = TRUE;
	int NewSpareAddr = 2048;
	int NewSectorAddr = sectorAddr;
	DWORD MECCBuf[4];
	byte bTempSectorInfo[6];
	DWORD SECCBuf;
	UINT32 nRetEcc = 0;

	if (sectorAddr == 0)
	{
        pInfo->bOEMReserved = OEM_BLOCK_RESERVED | OEM_BLOCK_READONLY;
        pInfo->bBadBlock    = BADBLOCKMARK;
        pInfo->dwReserved1  = 0xffffffff;
        pInfo->wReserved2   = 0xffff;

        return TRUE;
	}

	BOOL bLastMode = SetKMode(TRUE);	// always true... dummy function.

	NF_nFCE_L();	// NFCONT狼 [1]甫 0栏肺 努府绢 ... Force nFCE to low

	NF_CLEAR_RB();	// NFSTAT狼 [4]甫 1肺 悸泼 ... RnB_TransDetect ... 

	NF_CMD(CMD_READ);	// Read data command

	// Set address to read data from Spare area
	NF_ADDR((NewSpareAddr)&0xff);	
	NF_ADDR((NewSpareAddr>>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); // end of read command

	NF_DETECT_RB();		// NFSTAT狼 [4],:0]捞 11老 锭鳖瘤 公茄 风橇. -> RnB啊 low俊辑 high甫 摹搁 1肺 凳.


	// Initialize MECC Module
	NF_RSTECC();		// NFCONT [5:4]甫 11肺 悸泼. ; Init main ECC, Init spare ECC.
	NF_MECC_UnLock();	// NFCOnT [6]甫 0栏肺 努府绢. ; Unlock Spare ECC


	// Read SectorInfo
	for(i = 0; i < 6; i++) {
		bTempSectorInfo[i] = NF_RDDATA_BYTE();
	}

	NF_MECC_Lock();		// NFCONT [6]甫 1肺 悸泼. ; Lock Spare ECC

	pInfo->wReserved2 = NF_RDDATA_BYTE();
	pInfo->wReserved2 |= (NF_RDDATA_BYTE()<<8);

	// Read MECC parity code from Spare area, actually don't use these data... Dummy data...
	MECCBuf[0] = NF_RDDATA_WORD();
	MECCBuf[1] = NF_RDDATA_WORD();
	MECCBuf[2] = NF_RDDATA_WORD();
	MECCBuf[3] = NF_RDDATA_WORD();


	// Check ECC about SectorInfo with SECC1 parity code
	SECCBuf = NF_RDDATA_WORD();

	NF_WRMECCD0( ((SECCBuf&0xff00)<<8)|(SECCBuf&0xff) );
	NF_WRMECCD1( ((SECCBuf&0xff000000)>>8)|((SECCBuf&0xff0000)>>16) );

	nRetEcc = NF_ECC_ERR0;	// Error蔼阑 NFECCERR0肺 何磐 佬绢柯促. 

	if(!ECC_CorrectData(sectorAddr, bTempSectorInfo, nRetEcc, ECC_CORRECT_SPARE1)) {
		RETAILMSG(1, (TEXT("#### NAND_LB_ReadSectorInfo ECC_Correct_Spare1 Error\r\n")));
		return FALSE;
	};

	pInfo->bBadBlock =  bTempSectorInfo[0];
	pInfo->dwReserved1 = bTempSectorInfo[1];
	pInfo->dwReserved1 |= bTempSectorInfo[2]<<8;
	pInfo->dwReserved1 |= bTempSectorInfo[3]<<16;
	pInfo->dwReserved1 |= bTempSectorInfo[4]<<24;
	pInfo->bOEMReserved = bTempSectorInfo[5];

	NF_nFCE_H();		// NFCONT狼 [1]甫 1栏肺 悸泼 ... Force nFCE to high
	
	SetKMode(bLastMode);	// always true... dummy function.

	return bRet;
}		


BOOL FMD_SB_ReadSector(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, PSectorInfo pSectorInfoBuff, DWORD dwNumSectors,int mode)
{
	ULONG SectorAddr = (ULONG)startSectorAddr;
	ULONG MECC;
	UINT32 nRet = TRUE;
	UINT32 nRetEcc = 0;

	if (!pSectorBuff && !pSectorInfoBuff)
		return(FALSE);

	BOOL bLastMode = SetKMode(TRUE);

	while (dwNumSectors--)
	{
		NF_RSTECC();
		NF_MECC_UnLock();
		NF_nFCE_L();
		
		if (!pSectorBuff)
		{
			NF_CLEAR_RB();
			NF_CMD(CMD_READ2);							// Send read confirm command.

			NF_ADDR(0);									// Ignored.
			NF_ADDR(SectorAddr		 & 0xff);			// Page address.
			NF_ADDR((SectorAddr >>  8) & 0xff);
			if (SB_NEED_EXT_ADDR)
				NF_ADDR((SectorAddr >> 16) & 0xff);  

			NF_DETECT_RB();
			
			RdPageInfo((PBYTE)pSectorInfoBuff);			// Read page/sector information.

			pSectorInfoBuff++;
		}
		else
		{
			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.
			}
			NF_MECC_Lock();

			if (pSectorInfoBuff)
			{
				RdPageInfo((PBYTE)pSectorInfoBuff);		// Read page/sector information.
				pSectorInfoBuff ++;
			}
			else
			{
				BYTE TempInfo[8];
				RdPageInfo(TempInfo);				   	// Read page/sector information.
			}

			MECC  = NF_RDDATA_BYTE();
			MECC |= NF_RDDATA_BYTE() << 8;
			MECC |= NF_RDDATA_BYTE() << 16;
			MECC |= (NF_RDMECC0() &0xff000000);
			//MECC |= NF_RDDATA_BYTE() << 24;
			
			NF_WRMECCD0( ((MECC&0xff00)<<8)|(MECC&0xff) );
	 		NF_WRMECCD1( ((MECC&0xff000000)>>8)|((MECC&0xff0000)>>16) );

	 		nRetEcc = NF_ECC_ERR0;

			switch(nRetEcc & 0x3)
			{
				case 0:	// No Error
					nRet = TRUE;
					break;
				case 1:	// 1-bit Error(Correctable)
					RETAILMSG(1,(TEXT("ECC correctable error(0x%x)\r\n"), SectorAddr));
					(pSectorBuff)[(nRetEcc>>7)&0x7ff] ^= (1<<((nRetEcc>>4)&0x7));
					nRet = TRUE;		
					break;
				case 2:	// Multiple Error
					RETAILMSG(1,(TEXT("ECC Uncorrectable error(0x%x)\r\n"), SectorAddr));
					nRet = FALSE;			
					break;
				case 3:	// ECC area Error
					RETAILMSG(1,(TEXT("ECC area error\r\n")));
				default:
					nRet = FALSE;			
					break;
			}
			pSectorBuff += NAND_SECTOR_SIZE;
		}
		NF_nFCE_H();
		++SectorAddr;
	}

	SetKMode (bLastMode);

	return(nRet);
}

BOOL FMD_LB_WriteSector(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, PSectorInfo pSectorInfoBuff, DWORD dwNumSectors, int mode)
{
	DWORD   i;
	BOOL    bRet = TRUE;
	volatile DWORD	wrdata;
	DWORD MECCBuf[4];
	UINT16 nSectorLoop;
	int NewSpareAddr = 2048;
	int NewDataAddr = 0;
	int NewSectorAddr = startSectorAddr;
	DWORD SECCBuf1;
	DWORD SECCBuf2;

	//Check Parameters.
	if (!pSectorBuff && !pSectorInfoBuff)
	{
		return(FALSE);
	}
	if ( dwNumSectors > 1 )
	{
		RETAILMSG(1, (TEXT("######## FATAL ERROR => FMD::FMD_WriteSector->dwNumsectors is bigger than 1. \r\n")));
		return FALSE;
	}
	
	BOOL bLastMode = SetKMode(TRUE);	// dummy function.
	
	// pSectorBuff啊 NULL捞搁, 酒贰 巩厘 荐青.
	if (!pSectorBuff)
	{
		NAND_LB_WriteSectorInfo(startSectorAddr, pSectorInfoBuff, mode);
		return TRUE;
	}
	
	//  Enable Chip
	NF_nFCE_L();	// NFCONT狼 [1]甫 0栏肺 努府绢 ... Force nFCE to low

⌨️ 快捷键说明

复制代码 Ctrl + C
搜索代码 Ctrl + F
全屏模式 F11
切换主题 Ctrl + Shift + D
显示快捷键 ?
增大字号 Ctrl + =
减小字号 Ctrl + -