fmd.cpp

三星 ARM920T S3C2440A 400MHz bsp包

//
// Copyright (c) Microsoft Corporation.  All rights reserved.
//
//
// Use of this source code is subject to the terms of the Microsoft end-user
// license agreement (EULA) under which you licensed this SOFTWARE PRODUCT.
// If you did not accept the terms of the EULA, you are not authorized to use
// this source code. For a copy of the EULA, please see the LICENSE.RTF on your
// install media.
//
#include <fmd.h>
#include <s3c2440x_clkpwr.h>
#include <s3c2440x_nand.h>
#include "nand.h"
#include <ethdbg.h>

#define NAND_BASE 0xB0E00000
#define CLKPWR_BASE 0xB0C00000
static volatile S3C2440X_NAND_REG *s2440NAND = (S3C2440X_NAND_REG *)NAND_BASE;
static volatile S3C2440X_CLKPWR_REG *s2440CLKPWR = (S3C2440X_CLKPWR_REG *)CLKPWR_BASE;

extern "C" void RdPage512(unsigned char *bufPt,PULONG pReg);
extern "C" void RdPage512Unalign(unsigned char *bufPt,PULONG pReg);
extern "C" void WrPage512(unsigned char *bufPt,PULONG pReg); 
extern "C" void WrPage512Unalign(unsigned char *bufPt,PULONG pReg); 
extern "C" void WrPageInfo(PBYTE pBuff,PULONG pReg);
extern "C" void RdPageInfo(PBYTE pBuff,PULONG pReg);

void NF_Reset()
{
	int i;

    NF_nFCE_L();

	NF_CLEAR_RB();
    NF_CMD(CMD_RESET);
	for(i=0;i<10;i++);  //tWB = 100ns. //??????

    NF_nFCE_H();
}

/*
    @func   DWORD | ReadFlashID | Reads the flash manufacturer and device codes.
    @rdesc  Manufacturer and device codes.
    @comm    
    @xref   
*/
static DWORD ReadFlashID(void)
{
    BYTE Mfg, Dev;

	NF_CLEAR_RB();
    NF_CMD(CMD_READID);        // Send flash ID read command.
    NF_ADDR(0);                //
    NF_DETECT_RB();	 // Wait tR(max 12us)
//    NF_WAITRB();            // Wait for flash to complete command.
    Mfg    = NF_RDDATA();    // 
    Dev    = NF_RDDATA();    // 

    //RETAILMSG(1,(TEXT("FMD: ReadID (Mfg=%x, Dev=%x)\r\n"), Mfg, Dev));

    return ((DWORD)Mfg*0x100+Dev);
}

/*
    @func   PVOID | FMD_Init | Initializes the Smart Media NAND flash controller.
    @rdesc  Pointer to S3C2440 NAND controller registers.
    @comm    
    @xref   
*/
PVOID FMD_Init(LPCTSTR lpActiveReg, PPCI_REG_INFO pRegIn, PPCI_REG_INFO pRegOut)
{

    // Caller should have specified NAND controller address.
    //
	int i;
    BOOL bLastMode = SetKMode(TRUE);

    if (pRegIn && pRegIn->MemBase.Num && pRegIn->MemBase.Reg[0])
        s2440NAND = (S3C2440X_NAND_REG *)(pRegIn->MemBase.Reg[0]);
    else
        s2440NAND = (S3C2440X_NAND_REG *)NAND_BASE;

	// Enable the clock to NAND controller
	s2440CLKPWR->CLKCON |= (1<<4);
    // Set up initial flash controller configuration.
    //
    s2440NAND->NFCONF =  (TACLS  <<  12) | /* CLE & ALE = HCLK * (TACLS  + 1)   */
                          (TWRPH0 <<  8) | /* TWRPH0    = HCLK * (TWRPH0 + 1)   */
                          (TWRPH1 <<  4);  /* TWRPH1    = HCLK * (TWRPH1 + 1)   */
    s2440NAND->NFCONT = (0<<13)|(0<<12)|(0<<10)|(0<<9)|(0<<8)|(0<<6)|(0<<5)|(1<<4)|(1<<1)|(1<<0);
    s2440NAND->NFSTAT = 0;
    NF_nFCE_L();            // Select the flash chip.
    NF_CLEAR_RB();
    NF_CMD(CMD_RESET);        // Send reset command.
    //NF_WAITRB();            // Wait for flash to complete command.
    for(i=0;i<10;i++);  //tWB = 100ns. //??????

    // Get manufacturer and device codes.
    if (ReadFlashID() != 0xEC76)
    {
        SetKMode (bLastMode);
 //       return(NULL);
    }
    NF_nFCE_H();            // Deselect the flash chip.

    SetKMode (bLastMode);
	RETAILMSG(1,(TEXT("FMD_Init: finished successful\r\n")));
    return((PVOID)s2440NAND);
}


/*
    @func   BOOL | FMD_ReadSector | Reads the specified sector(s) from NAND flash.
    @rdesc  TRUE = Success, FALSE = Failure.
    @comm    
    @xref   
*/
BOOL FMD_ReadSector(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, PSectorInfo pSectorInfoBuff, DWORD dwNumSectors)
{
    ULONG SectorAddr = (ULONG)startSectorAddr;

    BOOL bLastMode = SetKMode(TRUE);
//	NF_Reset();
//    NF_RSTECC();                            // Initialize ECC.
//    NF_nFCE_L();                            // Select the flash chip.
//    NF_CLEAR_RB();
//    NF_CMD(CMD_RESET);                        // Send reset command.
//    NF_DETECT_RB();	 // Wait tR(max 12us)
    while (dwNumSectors--)
    {
        ULONG blockPage = (((SectorAddr / NAND_PAGE_CNT) * NAND_PAGE_CNT) | (SectorAddr % NAND_PAGE_CNT));

        //NF_WAITRB();                            // Wait for flash to complete command.
	NF_Reset();
    	NF_RSTECC();                            // Initialize ECC.
    	NF_nFCE_L();                            // Select the flash chip.
//    	NF_CLEAR_RB();
        if (pSectorBuff)
        {
        	NF_CLEAR_RB();
            NF_CMD(CMD_READ);                    // Send read command.
            NF_ADDR(0);                            // Column = 0.
            NF_ADDR(blockPage         & 0xff);    // Page address.
            NF_ADDR((blockPage >>  8) & 0xff);
            NF_ADDR((blockPage >> 16) & 0xff);  
            NF_DETECT_RB();	 // Wait tR(max 12us)

            //  Handle unaligned buffer pointer
            if( ((DWORD) pSectorBuff) & 0x3) 
            {
                RdPage512Unalign (pSectorBuff,(PULONG)&s2440NAND->NFDATA);
            }
            else 
            {
                RdPage512(pSectorBuff,(PULONG)&s2440NAND->NFDATA);                // Read page/sector data.
            }
            
        }

        if (pSectorInfoBuff)
        {
        	if(!pSectorBuff)
        	{
        	NF_CLEAR_RB();
            NF_CMD(CMD_READ2);                    // Send read confirm command.
            NF_ADDR(0);                            // Column = 0.
            NF_ADDR(blockPage         & 0xff);    // Page address.
            NF_ADDR((blockPage >>  8) & 0xff);
            NF_ADDR((blockPage >> 16) & 0xff);  
            NF_DETECT_RB();	 // Wait tR(max 12us)
        	}

//            RdPageInfo((PBYTE)pSectorInfoBuff,(PULONG)&s2440NAND->NFDATA);    // Read page/sector information.
		pSectorInfoBuff->dwReserved1  = NF_DATA_R4();

    		//  OEM byte
    		pSectorInfoBuff->bOEMReserved = (BYTE) NF_RDDATA();
    		//  Read the bad block mark
    		pSectorInfoBuff->bBadBlock = (BYTE) NF_RDDATA();
    		//  Second reserved field (WORD)
    		pSectorInfoBuff->wReserved2 = ((BYTE) NF_RDDATA() << 8);
    		pSectorInfoBuff->wReserved2 |= ((BYTE) NF_RDDATA());

            pSectorInfoBuff++;
        }
	    NF_nFCE_H();                             // Deselect the flash chip.
        ++SectorAddr;
        pSectorBuff += NAND_PAGE_SIZE;
    }

    SetKMode (bLastMode);
    return(TRUE);
}


/*
    @func   BOOL | FMD_EraseBlock | Erases the specified flash block.
    @rdesc  TRUE = Success, FALSE = Failure.
    @comm    
    @xref   
*/
BOOL FMD_EraseBlock(BLOCK_ID blockID)
{
    BYTE Status;
    ULONG blockPage = (blockID * NAND_PAGE_CNT);    // Convert block address to page address.

    BOOL bLastMode = SetKMode(TRUE);

    NF_nFCE_L();                        // Select the flash chip.
    NF_CLEAR_RB();
    NF_CMD(CMD_ERASE);                    // Send block erase command.
    NF_ADDR(blockPage         & 0xff);    /* The mark of bad block is in 0 page   */
    NF_ADDR((blockPage >>  8) & 0xff);  /* For block number A[24:17]            */
    NF_ADDR((blockPage >> 16) & 0xff);  /* For block number A[25]               */
    NF_CMD(CMD_ERASE2);                    // Send block erase confirm command.
    //NF_WAITRB();                        // Wait for flash to complete command.
    NF_DETECT_RB();
    //  Check the status
    NF_CMD(CMD_STATUS);
    Status = NF_RDDATA();                // Read command status.
    NF_nFCE_H();                        // Deselect the flash chip.

    SetKMode (bLastMode);
    return((Status & 1) ? FALSE : TRUE);
}


/*
    @func   BOOL | FMD_WriteSector | Writes the specified data to the specified NAND flash sector/page.
    @rdesc  TRUE = Success, FALSE = Failure.
    @comm    
    @xref   
*/
BOOL FMD_WriteSector(SECTOR_ADDR startSectorAddr, LPBYTE pSectorBuff, PSectorInfo pSectorInfoBuff, DWORD dwNumSectors)
{
    BYTE Status;
    ULONG SectorAddr = (ULONG)startSectorAddr;

    BOOL bLastMode = SetKMode(TRUE);

    if (!pSectorBuff && !pSectorInfoBuff)
        return(FALSE);
//	NF_Reset();
//    NF_RSTECC();                            // Initialize ECC.
//    NF_nFCE_L();                             // Select the flash chip.

    while (dwNumSectors--)
    {
        ULONG blockPage = (((SectorAddr / NAND_PAGE_CNT) * NAND_PAGE_CNT) | (SectorAddr % NAND_PAGE_CNT));
	NF_Reset();
    	NF_RSTECC();                            // Initialize ECC.
    	NF_nFCE_L();                             // Select the flash chip.

        if (!pSectorBuff)
        {
            // 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(blockPage         & 0xff);    // Page address.
            NF_ADDR((blockPage >>  8) & 0xff);
            NF_ADDR((blockPage >> 16) & 0xff);  
//            WrPageInfo((PBYTE)pSectorInfoBuff,(PULONG)&s2440NAND->NFDATA);
	    //  Write the first reserved field (DWORD)
	    NF_DATA_W4( pSectorInfoBuff->dwReserved1 );

	    //  Write OEM reserved flag
	    NF_WRDATA( (pSectorInfoBuff->bOEMReserved) );

	    //  Write the bad block flag
	    NF_WRDATA( (pSectorInfoBuff->bBadBlock) );

	    //  Write the second reserved field
	    NF_WRDATA( (pSectorInfoBuff->wReserved2 >> 8) & 0xff );
	    NF_WRDATA( (pSectorInfoBuff->wReserved2) );

            pSectorInfoBuff++;
        }
        else 
        {
            NF_CMD(CMD_READ);                     // Send read command.
            NF_CMD(CMD_WRITE);                    // Send write command.
            NF_ADDR(0);                            // Column = 0.
            NF_ADDR(blockPage         & 0xff);    // Page address.
            NF_ADDR((blockPage >>  8) & 0xff);
            NF_ADDR((blockPage >> 16) & 0xff);