#include <string.h>
#include <stdlib.h>
#include "def.h"
#include "option.h"
#include "2440addr.h"
#include "nand.h"
#define NF_MECC_UnLock() {rNFCONT&=~(1<<5);}
#define NF_MECC_Lock() {rNFCONT|=(1<<5);}
#define NF_CMD(cmd) {rNFCMD=cmd;}
#define NF_ADDR(addr) {rNFADDR=addr;}
#define NF_nFCE_L() {rNFCONT&=~(1<<1);}
#define NF_nFCE_H() {rNFCONT|=(1<<1);}
#define NF_RSTECC() {rNFCONT|=(1<<4);}
#define NF_RDDATA() (rNFDATA)
#define NF_RDDATA8() ((*(volatile unsigned char*)0x4E000010) )
#define NF_WRDATA(data) {rNFDATA=data;}
#define NF_WAITRB() {while(!(rNFSTAT&(1<<1)));}
//wait tWB and check F_RNB pin.
// RnB Signal
#define NF_CLEAR_RB() {rNFSTAT |= (1<<2);} // Have write '1' to clear this bit.
#define NF_DETECT_RB() {while(!(rNFSTAT&(1<<2)));}
#define TACLS 0 // 1-clk(0ns)
#define TWRPH0 6 // 3-clk(25ns)
#define TWRPH1 0 // 1-clk(10ns) //TACLS+TWRPH0+TWRPH1>=50ns
#define STATIC
STATIC void __RdPage512(U8 *buf)
{
unsigned i;
for (i = 0; i < 512; i++) {
buf[i] = NF_RDDATA8();
}
}
STATIC void Nand_Reset(void)
{
volatile int i;
NF_nFCE_L();
NF_CLEAR_RB();
for (i=0; i<10; i++);
NF_CMD(0xFF); //reset command
NF_DETECT_RB();
NF_nFCE_H();
}
STATIC U32 NF8_CheckId(void)
{
int i;
U8 Mid, Did, DontCare, id4th;
NF_nFCE_L();
NF_CMD(0x90);
NF_ADDR(0x0);
for (i=0; i<100; i++);
Mid = NF_RDDATA8();
Did = NF_RDDATA8();
DontCare = NF_RDDATA8();
id4th = NF_RDDATA8();
NF_nFCE_H();
switch(Did) {
case 0x76:
return 0;
case 0xF1:
case 0xD3:
case 0xDA:
case 0xDC:
return 1;
default:
//Uart_SendString("Unknown NAND type\r\n");
for(;;);
}
}
STATIC int Nand_Init(void)
{
rNFCONF = (TACLS<<12)|(TWRPH0<<8)|(TWRPH1<<4)|(0<<0);
rNFCONT = (0<<13)|(0<<12)|(0<<10)|(0<<9)|(0<<8)|(0<<6)|(0<<5)|(1<<4)|(1<<1)|(1<<0);
rNFSTAT = 0;
Nand_Reset();
return NF8_CheckId();
}
STATIC int Nand_IsBadBlockPage512(U32 block)
{
U32 Page;
U8 BAD;
Page = (block<<8);
Nand_Reset();
NF_nFCE_L();
NF_CLEAR_RB();
NF_CMD(0x50);
NF_ADDR(5);
NF_ADDR(Page&0xff);
NF_ADDR((Page>>8)&0xff);
NF_ADDR((Page>>16)&0xff);
NF_DETECT_RB();
BAD = NF_RDDATA8();
NF_nFCE_H();
return BAD != 0xff;
}
STATIC int Nand_IsBadBlockPage2048(U32 block)
{
U32 Page;
U8 BAD;
Page = block << 6;
NF_nFCE_L();
NF_CLEAR_RB();
NF_CMD(0x00);
NF_ADDR(0);
NF_ADDR((2048>>8)&0xff);
NF_ADDR(Page&0xff);
NF_ADDR((Page>>8)&0xff);
NF_ADDR((Page>>16)&0xff);
NF_CMD(0x30);
NF_DETECT_RB();
BAD = NF_RDDATA8();
NF_nFCE_H();
return BAD != 0xff;
}
STATIC int Nand_IsBadBlock(U32 block,int bLargeBlock)
{
switch(bLargeBlock) {
case 0:
return Nand_IsBadBlockPage512(block);
case 1:
return Nand_IsBadBlockPage2048(block);
}
return 0;
}
STATIC int Nand_ReadSectorPage512(U32 sector, U8 *buffer)
{
Nand_Reset();
NF_nFCE_L();
NF_CLEAR_RB();
NF_CMD(0x00);
NF_ADDR(0x00);
NF_ADDR(sector&0xff);
NF_ADDR((sector>>8)&0xff);
NF_ADDR((sector>>16)&0xff);
NF_DETECT_RB();
__RdPage512(buffer);
NF_nFCE_H();
return 1;
}
STATIC int Nand_ReadSectorPage2048(U32 sector, U8 *buffer)
{
U32 page, data_addr;
Nand_Reset();
NF_nFCE_L();
NF_CLEAR_RB();
NF_CMD(0x00); // Read command
page = sector/4;
data_addr = 512 *(sector%4);
NF_ADDR(data_addr&0xff);
NF_ADDR((data_addr>>8)&0xff);
NF_ADDR(page&0xff);
NF_ADDR((page>>8)&0xff);
NF_ADDR((page>>16)&0xff);
NF_CMD(0x30);
NF_DETECT_RB();
__RdPage512(buffer);
NF_nFCE_H();
return OK;
}
STATIC int Nand_ReadSector(U32 sector, U8 *buffer, int bLargeBlock)
{
switch(bLargeBlock) {
case 0:
return Nand_ReadSectorPage512(sector, buffer);
case 1:
return Nand_ReadSectorPage2048(sector, buffer);
}
return 0;
}
void CopyProgramFromNand(void)
{
const int bLargeBlock = Nand_Init();
const unsigned StartSector = 0, StopSector = 5120;
const unsigned byte_sector_shift = 9;
const unsigned sector_block_shift = bLargeBlock ? 8 : 5;
unsigned char *RAM = (unsigned char *)0x30000000;
unsigned Sector, GoodSector;
for (Sector = StartSector, GoodSector = Sector; Sector < StopSector; Sector ++, GoodSector++) {
// begin of a block
if (GoodSector & ( (1 << sector_block_shift) - 1 ) == 0) {
// found a good block
for (;;) {
if (!Nand_IsBadBlock(GoodSector >> sector_block_shift, bLargeBlock)) {
// Is good Block
break;
}
// try next block
GoodSector += (1 << sector_block_shift);
}
}
Nand_ReadSector(GoodSector, RAM + (Sector << byte_sector_shift ), bLargeBlock);
}
}
