You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 
 
 

711 lines
18 KiB

#include<pmon.h>
#include<asm.h>
#include<machine/types.h>
#include<linux/mtd/mtd.h>
#include<linux/mtd/nand.h>
#include<linux/mtd/partitions.h>
#include<sys/malloc.h>
#include <sys/mbuf.h>
//------------------------------------------
#define CKSEG1ADDR(a) ((a)|0xa0000000)
#define ls2k_readl(addr) (*(volatile unsigned int *)CKSEG1ADDR(addr))
#define ls2k_writel(val, addr) *(volatile unsigned int *)CKSEG1ADDR(addr) = (val)
#define LS2H_CHIP_CFG_REG_BASE 0x1fe10c00
#define LS2H_INT_CLR0_REG (LS2H_CHIP_CFG_REG_BASE + 0x004c)
#define LS2H_DMA_ORDER_REG 0x1fe10c00 //(LS2H_CHIP_CFG_REG_BASE + 0x0100)
#define LS2H_NAND_REG_BASE 0x1fe06000
#define LS2H_NAND_CMD_REG (LS2H_NAND_REG_BASE + 0x0000)
#define LS2H_NAND_ADDR_C_REG (LS2H_NAND_REG_BASE + 0x0004)
#define LS2H_NAND_ADDR_R_REG (LS2H_NAND_REG_BASE + 0x0008)
#define LS2H_NAND_TIMING_REG (LS2H_NAND_REG_BASE + 0x000c)
#define LS2H_NAND_IDL_REG (LS2H_NAND_REG_BASE + 0x0010)
#define LS2H_NAND_STA_IDH_REG (LS2H_NAND_REG_BASE + 0x0014)
#define LS2H_NAND_PARAM_REG (LS2H_NAND_REG_BASE + 0x0018)
#define LS2H_NAND_OP_NUM_REG (LS2H_NAND_REG_BASE + 0x001c)
#define LS2H_NAND_CSRDY_MAP_REG (LS2H_NAND_REG_BASE + 0x0020)
#define LS2H_NAND_DMA_ACC_REG (LS2H_NAND_REG_BASE + 0x0040)
#define DMA_ACCESS_ADDR LS2H_NAND_DMA_ACC_REG
#define ORDER_REG_ADDR (CKSEG1ADDR(LS2H_DMA_ORDER_REG))
#define MAX_BUFF_SIZE 0x4000
#define NAND_PAGE_SHIFT 12
#define NO_SPARE_ADDRH(x) ((x) >> (32 - (NAND_PAGE_SHIFT - 1 )))
#define NO_SPARE_ADDRL(x) ((x) << (NAND_PAGE_SHIFT - 1))
#define SPARE_ADDRH(x) ((x) >> (32 - (NAND_PAGE_SHIFT)))
#define SPARE_ADDRL(x) ((x) << (NAND_PAGE_SHIFT))
#define dma_cache_inv(a,s) CPU_IOFlushDCache(a,s,SYNC_R)
#define USE_POLL
#ifdef USE_POLL
#define complete(...)
#define init_completion(...)
#define wait_for_completion_timeout(...)
#define request_irq(...) (0)
#define free_irq(...)
#define local_irq_save(...)
#define local_irq_restore(...)
#endif
#define CHIP_DELAY_TIMEOUT (2*HZ/10)
#define STATUS_TIME_LOOP_R 30
#define STATUS_TIME_LOOP_WS 100
#define STATUS_TIME_LOOP_WM 60
#define STATUS_TIME_LOOP_E 100
#define NAND_CMD 0x1
#define NAND_ADDRL 0x2
#define NAND_ADDRH 0x4
#define NAND_TIMING 0x8
#define NAND_IDL 0x10
#define NAND_STATUS_IDL 0x20
#define NAND_PARAM 0x40
#define NAND_OP_NUM 0X80
#define NAND_CS_RDY_MAP 0x100
#define DMA_ORDERAD 0x1
#define DMA_SADDR 0x2
#define DMA_DADDR 0x4
#define DMA_LENGTH 0x8
#define DMA_STEP_LENGTH 0x10
#define DMA_STEP_TIMES 0x20
#define DMA_CMD 0x40
#define _NAND_IDL \
(*((volatile unsigned int*)(CKSEG1ADDR(LS2H_NAND_IDL_REG))))
#define _NAND_IDH \
(*((volatile unsigned int*)(CKSEG1ADDR(LS2H_NAND_STA_IDH_REG))))
#define _NAND_BASE CKSEG1ADDR(LS2H_NAND_REG_BASE)
#define _NAND_SET_REG(x,y) \
do{*((volatile unsigned int*)(_NAND_BASE+x)) = (y);}while(0)
#define _NAND_READ_REG(x,y) \
do{(y) = *((volatile unsigned int*)(_NAND_BASE+x));}while(0)
#define show_data_debug 0
#define show_debug(x,y) show_debug_msk(x,y)
#define show_debug_msk(x,y) do{ if(show_data_debug) \
{printk(KERN_ERR "%s:\n",__func__);show_data(x,y);}}while(0)
typedef unsigned long dma_addr_t;
#define init_completion(...)
#define dma_alloc_coherent(dev,size,handle,flag) _dma_alloc_coherent(size,handle)
#define spin_lock_irqsave(...)
#define spin_unlock_irqrestore(...)
enum {
ERR_NONE = 0,
ERR_DMABUSERR = -1,
ERR_SENDCMD = -2,
ERR_DBERR = -3,
ERR_BBERR = -4,
};
enum {
STATE_READY = 0,
STATE_BUSY,
};
//------------------------------------------
//#define LS2H_CHIP_SAMP3_REG 0xbfd0021c
#define LS2H_VER2 2
#define LS2H_VER3 3
#define DRIVER_NAME "ls2k-nand"
#define ALIGN_DMA(x) ((x + 3)/4)
#define REG(reg) (info->mmio_base + reg)
#define NAND_DEBUG
#define STATUS_TIME_LOOP_R 3000
#define STATUS_TIME_LOOP_WS 100
#define STATUS_TIME_LOOP_WM 60
#define STATUS_TIME_LOOP_E 1000
/* Register offset */
#define NAND_CMD_REG 0x00
#define NAND_ADDRC_REG 0x04
#define NAND_ADDRR_REG 0x08
#define NAND_TIM_REG 0x0c
#define NAND_IDL_REG 0x10
#define NAND_IDH_REG 0x14
#define NAND_STA_REG 0x14
#define NAND_PARAM_REG 0x18
#define NAND_OP_NUM_REG 0x1c
#define NAND_CS_RDY_REG 0x20
#define NAND_DMA_ADDR_REG 0x40
/* NAND_CMD_REG */
#define CMD_VALID (1 << 0) /* command valid */
#define CMD_RD_OP (1 << 1) /* read operation */
#define CMD_WR_OP (1 << 2) /* write operation */
#define CMD_ER_OP (1 << 3) /* erase operation */
#define CMD_BER_OP (1 << 4) /* blocks erase operation */
#define CMD_RD_ID (1 << 5) /* read id */
#define CMD_RESET (1 << 6) /* reset */
#define CMD_RD_STATUS (1 << 7) /* read status */
#define CMD_MAIN (1 << 8) /* operation in main region */
#define CMD_SPARE (1 << 9) /* operation in spare region */
#define CMD_DONE (1 << 10) /* operation done */
#define CMD_RS_RD (1 << 11) /* ecc is enable when reading */
#define CMD_RS_WR (1 << 12) /* ecc is enable when writing */
#define CMD_INT_EN (1 << 13) /* interupt enable */
#define CMD_WAIT_RS (1 << 14) /* waiting ecc read done */
#define CMD_ECC_DMA_REQ (1 << 30) /* dma request in ecc mode */
#define CMD_DMA_REQ (1 << 31) /* dma request in normal mode */
#define CMD_RDY_SHIF 16 /* four bits for chip ready */
#define CMD_CE_SHIF 20 /* four bits for chip enable */
/* NAND_PARAM_REG */
#define CHIP_CAP_SHIFT 8
#define ID_NUM_SHIFT 12
#define OP_SCOPE_SHIFT 16
/* DMA COMMAND REG */
#define DMA_INT_MASK (1 << 0) /* dma interrupt mask */
#define DMA_INT (1 << 1) /* dma interrupt */
#define DMA_SIN_TR_OVER (1 << 2) /* a single dma transfer over */
#define DMA_TR_OVER (1 << 3) /* all dma transfer over */
#define DMA_RD_WR (1 << 12) /* dma operation type */
#define DMA_RD_STU_SHIF 4 /* dma read data status */
#define DMA_WR_STU_SHIF 8 /* dma write data status */
#define NAND_USE_CS 2
/* DMA Descripter */
struct ls2k_nand_dma_desc {
uint32_t orderad;
uint32_t saddr;
uint32_t daddr;
uint32_t length;
uint32_t step_length;
uint32_t step_times;
uint32_t cmd;
};
struct ls2k_nand_info {
struct nand_chip nand_chip;
struct platform_device *pdev;
spinlock_t nand_lock;
/* MTD data control */
unsigned int buf_start;
unsigned int buf_count;
void *mmio_base;
unsigned int irq;
unsigned cmd;
/* DMA information */
unsigned int dma_order_reg; /* dma controller register */
unsigned int apb_data_addr; /* dma access this address */
u64 desc_addr; /* dma descriptor address */
dma_addr_t desc_addr_phys;
size_t desc_size;
u64 dma_ask;
dma_addr_t dma_ask_phy;
unsigned char *data_buff; /* dma data buffer */
dma_addr_t data_buff_phys;
size_t data_buff_size;
size_t data_size; /* data size in FIFO */
unsigned int seqin_column;
unsigned int seqin_page_addr;
};
static void *_dma_alloc_coherent(size_t size,
dma_addr_t * dma_handle)
{
void *buf;
buf = malloc(size,M_DEVBUF, M_DONTWAIT );
CPU_IOFlushDCache(buf,size, SYNC_R);
*dma_handle =VA_TO_PA(buf);
return (void *)buf;
}
static int ls2k_nand_init_buff(struct ls2k_nand_info *info)
{
struct platform_device *pdev = info->pdev;
info->data_buff = dma_alloc_coherent(&pdev->dev, MAX_BUFF_SIZE,
&info->data_buff_phys, GFP_KERNEL);
if (info->data_buff == NULL) {
printf("failed to allocate dma buffer\n");
return -ENOMEM;
}
info->data_buff_size = MAX_BUFF_SIZE;
return 0;
}
static int ls2k_nand_ecc_calculate(struct mtd_info *mtd,
const uint8_t * dat, uint8_t * ecc_code)
{
return 0;
}
static int ls2k_nand_ecc_correct(struct mtd_info *mtd,
uint8_t * dat, uint8_t * read_ecc,
uint8_t * calc_ecc)
{
/*
* Any error include ERR_SEND_CMD, ERR_DBERR, ERR_BUSERR, we
* consider it as a ecc error which will tell the caller the
* read fail We have distinguish all the errors, but the
* nand_read_ecc only check this function return value
*/
return 0;
}
static void ls2k_nand_ecc_hwctl(struct mtd_info *mtd, int mode)
{
return;
}
static int ls2k_nand_waitfunc(struct mtd_info *mtd, struct nand_chip *this)
{
udelay(50);
return 0;
}
static void ls2k_nand_select_chip(struct mtd_info *mtd, int chip)
{
return;
}
static int ls2k_nand_dev_ready(struct mtd_info *mtd)
{
return 1;
}
static void nand_setup(struct ls2k_nand_info *info,
int cmd, int addr_c, int addr_r, int param, int op_num)
{
writel(param, REG(NAND_PARAM_REG));
writel(op_num, REG(NAND_OP_NUM_REG));
writel(addr_c, REG(NAND_ADDRC_REG));
writel(addr_r|(0x10000*NAND_USE_CS), REG(NAND_ADDRR_REG));
writel(0, REG(NAND_CMD_REG));
writel(0, REG(NAND_CMD_REG));
writel(cmd, REG(NAND_CMD_REG));
}
static void wait_nand_done(struct ls2k_nand_info *info, int timeout)
{
int t, status_times = timeout;
do {
t = readl(REG(NAND_CMD_REG)) & CMD_DONE;
if (!(status_times--)) {
writel(0x0, REG(NAND_CMD_REG));
writel(0x0, REG(NAND_CMD_REG));
writel(CMD_RESET | CMD_VALID, REG(NAND_CMD_REG));
break;
}
udelay(50);
} while(t == 0);
writel(0x0, REG(NAND_CMD_REG));
}
void dma_desc_init(struct ls2k_nand_info *info)
{
volatile struct ls2k_nand_dma_desc *dma_base =
(volatile struct ls2k_nand_dma_desc *)(info->desc_addr);
dma_base->orderad = 0;
dma_base->saddr = info->data_buff_phys;
dma_base->daddr = info->apb_data_addr;
dma_base->step_length = 0;
dma_base->step_times = 0x1;
dma_base->length = 0;
dma_base->cmd = 0;
}
static void dma_setup(struct ls2k_nand_info *info, int dma_cmd, int dma_cnt)
{
volatile struct ls2k_nand_dma_desc *dma_base =
(volatile struct ls2k_nand_dma_desc *)(info->desc_addr);
unsigned int t;
dma_base->orderad = 0;
dma_base->saddr = info->data_buff_phys;
dma_base->daddr = info->apb_data_addr;
dma_base->step_length = 0;
dma_base->step_times = 0x1;
dma_base->length = dma_cnt;
dma_base->cmd = dma_cmd;
t = ((unsigned int)info->desc_addr_phys) | (1 << 3);
ls2k_writel(t, info->dma_order_reg);
t = STATUS_TIME_LOOP_R;
while ((ls2k_readl(info->dma_order_reg) & 0x8) && t) {
t--;
udelay(50);
};
if (t == 0) {
printf("nand dma timeout!\n");
}
wait_nand_done(info, STATUS_TIME_LOOP_R);
}
static int get_chip_capa_num(uint64_t chipsize, int pagesize)
{
int size_mb = chipsize >> 20;
switch (size_mb) {
case (1 << 7): /* 1Gb */
if (pagesize == 512)
return 0xd;
else
return 0;
case (1 << 8): /* 2Gb */
return 1;
case (1 << 9): /* 4Gb */
return 2;
case (1 << 10): /* 8Gb */
return 3;
case (1 << 11): /* 16Gb */
return 4;
case (1 << 12): /* 32Gb */
return 5;
case (1 << 13): /* 64Gb */
return 6;
case (1 << 14): /* 128Gb */
return 7;
case (1 << 3): /* 64Mb */
return 9;
case (1 << 4): /* 128Mb */
return 0xa;
case (1 << 5): /* 256Mb */
return 0xb;
case (1 << 6): /* 512Mb */
return 0xc;
default: /* 64Mb */
return 0;
}
}
static void __attribute__((noinline)) ls2k_read_id(struct ls2k_nand_info *info)
{
unsigned int id_l, id_h;
unsigned char *data = (unsigned char *)(info->data_buff);
writel((5 << ID_NUM_SHIFT), REG(NAND_PARAM_REG));
writel(0x10000*NAND_USE_CS, REG(NAND_ADDRR_REG));
writel((CMD_RD_ID | CMD_VALID), REG(NAND_CMD_REG));
wait_nand_done(info, 100);
id_l = readl(REG(NAND_IDL_REG));
id_h = readl(REG(NAND_IDH_REG));
#ifdef NAND_DEBUG
printf("id_l: %08x, id_h:%08x\n", id_l, id_h);
#endif
data[0] = (id_h & 0xff);
data[1] = (id_l >> 24) & 0xff;
data[2] = (id_l >> 16) & 0xff;
data[3] = (id_l >> 8) & 0xff;
}
static void ls2k_nand_cmdfunc(struct mtd_info *mtd, unsigned command,
int column, int page_addr)
{
struct ls2k_nand_info *info = mtd->priv;
int chip_cap, oobsize, pagesize;
int cmd, addrc, addrr, op_num, param;
int dma_cmd, dma_cnt;
unsigned long flags;
info->cmd = command;
oobsize = mtd->oobsize;
pagesize = mtd->writesize;
chip_cap = get_chip_capa_num(info->nand_chip.chipsize, pagesize);
spin_lock_irqsave(&info->nand_lock, flags);
switch (command) {
case NAND_CMD_READOOB:
info->buf_count = oobsize;
if (info->buf_count <= 0)
break;
info->buf_start = 0;
addrc = pagesize;
addrr = page_addr;
param = (oobsize << OP_SCOPE_SHIFT)
| (chip_cap << CHIP_CAP_SHIFT);
op_num = oobsize;
cmd = CMD_VALID | CMD_SPARE | CMD_RD_OP;
nand_setup(info, cmd, addrc, addrr, param, op_num);
dma_cmd = DMA_INT_MASK;
dma_cnt = ALIGN_DMA(op_num);
dma_setup(info, dma_cmd, dma_cnt);
break;
case NAND_CMD_READ0:
addrc = 0;
addrr = page_addr;
op_num = oobsize + pagesize;
param = (op_num << OP_SCOPE_SHIFT) | (chip_cap << CHIP_CAP_SHIFT);
cmd = CMD_VALID | CMD_SPARE | CMD_RD_OP | CMD_MAIN;
info->buf_count = op_num;
info->buf_start = 0;
nand_setup(info, cmd, addrc, addrr, param, op_num);
dma_cmd = DMA_INT_MASK;
dma_cnt = ALIGN_DMA(op_num);
dma_setup(info, dma_cmd, dma_cnt);
break;
case NAND_CMD_SEQIN:
info->buf_count = oobsize + pagesize - column;
info->buf_start = 0;
info->seqin_column = column;
info->seqin_page_addr = page_addr;
break;
case NAND_CMD_PAGEPROG:
addrc = info->seqin_column;
addrr = info->seqin_page_addr;
op_num = info->buf_start;
param = ((pagesize + oobsize) << OP_SCOPE_SHIFT)
| (chip_cap << CHIP_CAP_SHIFT);
cmd = CMD_VALID | CMD_SPARE | CMD_WR_OP;
if (addrc < pagesize)
cmd |= CMD_MAIN;
nand_setup(info, cmd, addrc, addrr, param, op_num);
dma_cmd = DMA_INT_MASK | DMA_RD_WR;
dma_cnt = ALIGN_DMA(op_num);
dma_setup(info, dma_cmd, dma_cnt);
break;
case NAND_CMD_RESET:
nand_setup(info, (CMD_RESET | CMD_VALID), 0, 0, 0, 0);
wait_nand_done(info, STATUS_TIME_LOOP_R);
break;
case NAND_CMD_ERASE1:
addrc = 0;
addrr = page_addr;
op_num = 0;
param = ((pagesize | oobsize) << OP_SCOPE_SHIFT)
| (chip_cap << CHIP_CAP_SHIFT);
cmd = CMD_ER_OP | CMD_VALID;
nand_setup(info, cmd, addrc, addrr, param, op_num);
wait_nand_done(info, STATUS_TIME_LOOP_E);
break;
case NAND_CMD_STATUS:
info->buf_count = 0x1;
info->buf_start = 0x0;
*(unsigned char *)info->data_buff =
(readl(REG(NAND_CMD_REG)) & CMD_DONE) | (CMD_RD_STATUS);
break;
case NAND_CMD_READID:
info->buf_count = 0x4;
info->buf_start = 0;
ls2k_read_id(info);
break;
case NAND_CMD_ERASE2:
case NAND_CMD_READ1:
break;
default:
printk(KERN_ERR "non-supported command.\n");
break;
}
spin_unlock_irqrestore(&info->nand_lock, flags);
}
static u16 ls2k_nand_read_word(struct mtd_info *mtd)
{
struct ls2k_nand_info *info = mtd->priv;
unsigned long flags;
u16 retval = 0xFFFF;
spin_lock_irqsave(&info->nand_lock, flags);
if (!(info->buf_start & 0x1) && info->buf_start < info->buf_count) {
retval = *(u16 *) (info->data_buff + info->buf_start);
}
info->buf_start += 2;
spin_unlock_irqrestore(&info->nand_lock, flags);
return retval;
}
static uint8_t ls2k_nand_read_byte(struct mtd_info *mtd)
{
struct ls2k_nand_info *info = mtd->priv;
unsigned long flags;
char retval = 0xFF;
spin_lock_irqsave(&info->nand_lock, flags);
if (info->buf_start < info->buf_count)
retval = info->data_buff[(info->buf_start)++];
spin_unlock_irqrestore(&info->nand_lock, flags);
return retval;
}
static void ls2k_nand_read_buf(struct mtd_info *mtd, uint8_t * buf, int len)
{
struct ls2k_nand_info *info = mtd->priv;
int real_len = min_t(size_t, len, info->buf_count - info->buf_start);
unsigned long flags;
spin_lock_irqsave(&info->nand_lock, flags);
memcpy(buf, info->data_buff + info->buf_start, real_len);
info->buf_start += real_len;
spin_unlock_irqrestore(&info->nand_lock, flags);
}
static void ls2k_nand_write_buf(struct mtd_info *mtd, const uint8_t * buf,
int len)
{
struct ls2k_nand_info *info = mtd->priv;
int real_len = min_t(size_t, len, info->buf_count - info->buf_start);
unsigned long flags;
spin_lock_irqsave(&info->nand_lock, flags);
memcpy(info->data_buff + info->buf_start, buf, real_len);
info->buf_start += real_len;
spin_unlock_irqrestore(&info->nand_lock, flags);
}
static int ls2k_nand_verify_buf(struct mtd_info *mtd, const uint8_t * buf,
int len)
{
int i = 0;
while (len--) {
if (buf[i++] != ls2k_nand_read_byte(mtd)) {
return -1;
}
}
return 0;
}
static void ls2k_nand_init_mtd(struct mtd_info *mtd,
struct ls2k_nand_info *info)
{
struct nand_chip *this = &info->nand_chip;
this->options = 8;
this->waitfunc = ls2k_nand_waitfunc;
this->select_chip = ls2k_nand_select_chip;
this->dev_ready = ls2k_nand_dev_ready;
this->cmdfunc = ls2k_nand_cmdfunc;
this->read_word = ls2k_nand_read_word;
this->read_byte = ls2k_nand_read_byte;
this->read_buf = ls2k_nand_read_buf;
this->write_buf = ls2k_nand_write_buf;
this->verify_buf = ls2k_nand_verify_buf;
this->ecc.mode = NAND_ECC_NONE;
this->ecc.hwctl = ls2k_nand_ecc_hwctl;
this->ecc.calculate = ls2k_nand_ecc_calculate;
this->ecc.correct = ls2k_nand_ecc_correct;
this->ecc.size = 2048;
this->ecc.bytes = 24;
}
static void ls2k_nand_init_info(struct ls2k_nand_info *info)
{
info->buf_start = 0;
info->buf_count = 0;
info->seqin_column = 0;
info->seqin_page_addr = 0;
spin_lock_init(&info->nand_lock);
writel(0x412, REG(NAND_TIM_REG));
writel(0x00440000, REG(NAND_CS_RDY_REG));
}
static int ls2k_nand_detect(struct mtd_info *mtd)
{
return (mtd->erasesize != 1 << 17 || mtd->writesize != 1 << 11
|| mtd->oobsize != 1 << 6);
}
int ls2k_nand_init()
{
struct ls2k_nand_info *info;
struct nand_chip *this;
struct mtd_info *mtd;
int ret = 0, irq;
mtd = malloc(sizeof(struct mtd_info) + sizeof(struct ls2k_nand_info),M_DEVBUF,M_WAITOK);
if (!mtd) {
printf("failed to allocate memory\n");
return -ENOMEM;
}
memset(mtd, 0, sizeof(struct mtd_info) + sizeof(struct ls2k_nand_info));
info = (struct ls2k_nand_info *)(&mtd[1]);
this = &info->nand_chip;
mtd->priv = info;
info->desc_addr = (u64) dma_alloc_coherent(&pdev->dev,
MAX_BUFF_SIZE, &info->desc_addr_phys, GFP_KERNEL);
info->dma_ask = (u64) dma_alloc_coherent(&pdev->dev,
MAX_BUFF_SIZE, &info->dma_ask_phy, GFP_KERNEL);
if (!info->desc_addr) {
printf("fialed to allocate memory\n");
ret = -ENOMEM;
goto fail_free_mtd;
}
info->mmio_base = CKSEG1ADDR(LS2H_NAND_REG_BASE);
info->dma_order_reg = ORDER_REG_ADDR;
info->apb_data_addr = DMA_ACCESS_ADDR;
ret = ls2k_nand_init_buff(info);
if (ret)
goto fail_free_io;
info->irq = 0;
ls2k_nand_init_mtd(mtd, info);
ls2k_nand_init_info(info);
dma_desc_init(info);
if (nand_scan(mtd, 1)) {
printf("failed to scan nand\n");
ret = -ENXIO;
goto fail_free_io;
}
if (ls2k_nand_detect(mtd)) {
printf("driver don't support the Flash!\n");
ret = -ENXIO;
goto fail_free_io;
}
mtd->name="nand-flash";
if(!nand_flash_add_parts(mtd,0)){
add_mtd_device(mtd,0,0,"total");
add_mtd_device(mtd,0,0x01400000,"kernel");
add_mtd_device(mtd,0x01400000,0x0,"os");
}
fail_free_io:
fail_free_res:
fail_free_buf:
fail_free_mtd:
return ret;
}