|
|
@ -1,5 +1,5 @@ |
|
|
|
/*
|
|
|
|
/*
|
|
|
|
* Copyright 2009-2014 Freescale Semiconductor, Inc. and others |
|
|
|
* Copyright 2009-2015 Freescale Semiconductor, Inc. and others |
|
|
|
* |
|
|
|
* |
|
|
|
* Description: MPC5125, VF610, MCF54418 and Kinetis K70 Nand driver. |
|
|
|
* Description: MPC5125, VF610, MCF54418 and Kinetis K70 Nand driver. |
|
|
|
* Ported to U-Boot by Stefan Agner |
|
|
|
* Ported to U-Boot by Stefan Agner |
|
|
@ -19,9 +19,10 @@ |
|
|
|
* |
|
|
|
* |
|
|
|
* Limitations: |
|
|
|
* Limitations: |
|
|
|
* - Untested on MPC5125 and M54418. |
|
|
|
* - Untested on MPC5125 and M54418. |
|
|
|
* - DMA not used. |
|
|
|
* - DMA and pipelining not used. |
|
|
|
* - 2K pages or less. |
|
|
|
* - 2K pages or less. |
|
|
|
* - Only 2K page w. 64+OOB and hardware ECC. |
|
|
|
* - HW ECC: Only 2K page with 64+ OOB. |
|
|
|
|
|
|
|
* - HW ECC: Only 24 and 32-bit error correction implemented. |
|
|
|
*/ |
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
|
|
#include <common.h> |
|
|
|
#include <common.h> |
|
|
@ -53,6 +54,7 @@ |
|
|
|
|
|
|
|
|
|
|
|
#define PAGE_2K 0x0800 |
|
|
|
#define PAGE_2K 0x0800 |
|
|
|
#define OOB_64 0x0040 |
|
|
|
#define OOB_64 0x0040 |
|
|
|
|
|
|
|
#define OOB_MAX 0x0100 |
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
/*
|
|
|
|
* NFC_CMD2[CODE] values. See section: |
|
|
|
* NFC_CMD2[CODE] values. See section: |
|
|
@ -127,32 +129,33 @@ |
|
|
|
|
|
|
|
|
|
|
|
#define NFC_TIMEOUT (1000) |
|
|
|
#define NFC_TIMEOUT (1000) |
|
|
|
|
|
|
|
|
|
|
|
/* ECC status placed at end of buffers. */ |
|
|
|
|
|
|
|
#define ECC_SRAM_ADDR ((PAGE_2K+256-8) >> 3) |
|
|
|
|
|
|
|
#define ECC_STATUS_MASK 0x80 |
|
|
|
|
|
|
|
#define ECC_ERR_COUNT 0x3F |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
/*
|
|
|
|
* ECC status is stored at NFC_CFG[ECCADD] +4 for little-endian |
|
|
|
* ECC status - seems to consume 8 bytes (double word). The documented |
|
|
|
* and +7 for big-endian SOC. |
|
|
|
* status byte is located in the lowest byte of the second word (which is |
|
|
|
|
|
|
|
* the 4th or 7th byte depending on endianness). |
|
|
|
|
|
|
|
* Calculate an offset to store the ECC status at the end of the buffer. |
|
|
|
*/ |
|
|
|
*/ |
|
|
|
#ifdef CONFIG_VF610 |
|
|
|
#define ECC_SRAM_ADDR (PAGE_2K + OOB_MAX - 8) |
|
|
|
#define ECC_OFFSET 4 |
|
|
|
|
|
|
|
#else |
|
|
|
#define ECC_STATUS 0x4 |
|
|
|
#define ECC_OFFSET 7 |
|
|
|
#define ECC_STATUS_MASK 0x80 |
|
|
|
#endif |
|
|
|
#define ECC_STATUS_ERR_COUNT 0x3F |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
enum vf610_nfc_alt_buf { |
|
|
|
|
|
|
|
ALT_BUF_DATA = 0, |
|
|
|
|
|
|
|
ALT_BUF_ID = 1, |
|
|
|
|
|
|
|
ALT_BUF_STAT = 2, |
|
|
|
|
|
|
|
ALT_BUF_ONFI = 3, |
|
|
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
struct vf610_nfc { |
|
|
|
struct vf610_nfc { |
|
|
|
struct mtd_info *mtd; |
|
|
|
struct mtd_info *mtd; |
|
|
|
struct nand_chip chip; |
|
|
|
struct nand_chip chip; |
|
|
|
void __iomem *regs; |
|
|
|
void __iomem *regs; |
|
|
|
uint column; |
|
|
|
uint buf_offset; |
|
|
|
|
|
|
|
int write_sz; |
|
|
|
/* Status and ID are in alternate locations. */ |
|
|
|
/* Status and ID are in alternate locations. */ |
|
|
|
int alt_buf; |
|
|
|
enum vf610_nfc_alt_buf alt_buf; |
|
|
|
#define ALT_BUF_ID 1 |
|
|
|
|
|
|
|
#define ALT_BUF_STAT 2 |
|
|
|
|
|
|
|
#define ALT_BUF_ONFI 3 |
|
|
|
|
|
|
|
struct clk *clk; |
|
|
|
|
|
|
|
}; |
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
#define mtd_to_nfc(_mtd) \ |
|
|
|
#define mtd_to_nfc(_mtd) \ |
|
|
@ -170,8 +173,8 @@ static struct nand_ecclayout vf610_nfc_ecc = { |
|
|
|
48, 49, 50, 51, 52, 53, 54, 55, |
|
|
|
48, 49, 50, 51, 52, 53, 54, 55, |
|
|
|
56, 57, 58, 59, 60, 61, 62, 63}, |
|
|
|
56, 57, 58, 59, 60, 61, 62, 63}, |
|
|
|
.oobfree = { |
|
|
|
.oobfree = { |
|
|
|
{.offset = 8, |
|
|
|
{.offset = 2, |
|
|
|
.length = 11} } |
|
|
|
.length = 17} } |
|
|
|
}; |
|
|
|
}; |
|
|
|
#elif defined(CONFIG_SYS_NAND_VF610_NFC_60_ECC_BYTES) |
|
|
|
#elif defined(CONFIG_SYS_NAND_VF610_NFC_60_ECC_BYTES) |
|
|
|
#define ECC_HW_MODE ECC_60_BYTE |
|
|
|
#define ECC_HW_MODE ECC_60_BYTE |
|
|
@ -226,8 +229,12 @@ static inline void vf610_nfc_set_field(struct mtd_info *mtd, u32 reg, |
|
|
|
static inline void vf610_nfc_memcpy(void *dst, const void *src, size_t n) |
|
|
|
static inline void vf610_nfc_memcpy(void *dst, const void *src, size_t n) |
|
|
|
{ |
|
|
|
{ |
|
|
|
/*
|
|
|
|
/*
|
|
|
|
* Use this accessor for the interal SRAM buffers. On ARM we can |
|
|
|
* Use this accessor for the internal SRAM buffers. On the ARM |
|
|
|
* treat the SRAM buffer as if its memory, hence use memcpy |
|
|
|
* Freescale Vybrid SoC it's known that the driver can treat |
|
|
|
|
|
|
|
* the SRAM buffer as if it's memory. Other platform might need |
|
|
|
|
|
|
|
* to treat the buffers differently. |
|
|
|
|
|
|
|
* |
|
|
|
|
|
|
|
* For the time being, use memcpy |
|
|
|
*/ |
|
|
|
*/ |
|
|
|
memcpy(dst, src, n); |
|
|
|
memcpy(dst, src, n); |
|
|
|
} |
|
|
|
} |
|
|
@ -242,7 +249,7 @@ static inline void vf610_nfc_clear_status(void __iomem *regbase) |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/* Wait for complete operation */ |
|
|
|
/* Wait for complete operation */ |
|
|
|
static inline void vf610_nfc_done(struct mtd_info *mtd) |
|
|
|
static void vf610_nfc_done(struct mtd_info *mtd) |
|
|
|
{ |
|
|
|
{ |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
uint start; |
|
|
|
uint start; |
|
|
@ -260,7 +267,7 @@ static inline void vf610_nfc_done(struct mtd_info *mtd) |
|
|
|
|
|
|
|
|
|
|
|
while (!(vf610_nfc_read(mtd, NFC_IRQ_STATUS) & IDLE_IRQ_BIT)) { |
|
|
|
while (!(vf610_nfc_read(mtd, NFC_IRQ_STATUS) & IDLE_IRQ_BIT)) { |
|
|
|
if (get_timer(start) > NFC_TIMEOUT) { |
|
|
|
if (get_timer(start) > NFC_TIMEOUT) { |
|
|
|
printf("Timeout while waiting for !BUSY.\n"); |
|
|
|
printf("Timeout while waiting for IDLE.\n"); |
|
|
|
return; |
|
|
|
return; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
@ -273,11 +280,13 @@ static u8 vf610_nfc_get_id(struct mtd_info *mtd, int col) |
|
|
|
|
|
|
|
|
|
|
|
if (col < 4) { |
|
|
|
if (col < 4) { |
|
|
|
flash_id = vf610_nfc_read(mtd, NFC_FLASH_STATUS1); |
|
|
|
flash_id = vf610_nfc_read(mtd, NFC_FLASH_STATUS1); |
|
|
|
return (flash_id >> (3-col)*8) & 0xff; |
|
|
|
flash_id >>= (3 - col) * 8; |
|
|
|
} else { |
|
|
|
} else { |
|
|
|
flash_id = vf610_nfc_read(mtd, NFC_FLASH_STATUS2); |
|
|
|
flash_id = vf610_nfc_read(mtd, NFC_FLASH_STATUS2); |
|
|
|
return flash_id >> 24; |
|
|
|
flash_id >>= 24; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return flash_id & 0xff; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
static u8 vf610_nfc_get_status(struct mtd_info *mtd) |
|
|
|
static u8 vf610_nfc_get_status(struct mtd_info *mtd) |
|
|
@ -345,26 +354,28 @@ static void vf610_nfc_command(struct mtd_info *mtd, unsigned command, |
|
|
|
int column, int page) |
|
|
|
int column, int page) |
|
|
|
{ |
|
|
|
{ |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
int page_sz = nfc->chip.options & NAND_BUSWIDTH_16 ? 1 : 0; |
|
|
|
int trfr_sz = nfc->chip.options & NAND_BUSWIDTH_16 ? 1 : 0; |
|
|
|
|
|
|
|
|
|
|
|
nfc->column = max(column, 0); |
|
|
|
nfc->buf_offset = max(column, 0); |
|
|
|
nfc->alt_buf = 0; |
|
|
|
nfc->alt_buf = ALT_BUF_DATA; |
|
|
|
|
|
|
|
|
|
|
|
switch (command) { |
|
|
|
switch (command) { |
|
|
|
case NAND_CMD_SEQIN: |
|
|
|
case NAND_CMD_SEQIN: |
|
|
|
/* Use valid column/page from preread... */ |
|
|
|
/* Use valid column/page from preread... */ |
|
|
|
vf610_nfc_addr_cycle(mtd, column, page); |
|
|
|
vf610_nfc_addr_cycle(mtd, column, page); |
|
|
|
|
|
|
|
nfc->buf_offset = 0; |
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
/*
|
|
|
|
* SEQIN => data => PAGEPROG sequence is done by the controller |
|
|
|
* SEQIN => data => PAGEPROG sequence is done by the controller |
|
|
|
* hence we do not need to issue the command here... |
|
|
|
* hence we do not need to issue the command here... |
|
|
|
*/ |
|
|
|
*/ |
|
|
|
return; |
|
|
|
return; |
|
|
|
case NAND_CMD_PAGEPROG: |
|
|
|
case NAND_CMD_PAGEPROG: |
|
|
|
page_sz += mtd->writesize + mtd->oobsize; |
|
|
|
trfr_sz += nfc->write_sz; |
|
|
|
vf610_nfc_transfer_size(nfc->regs, page_sz); |
|
|
|
vf610_nfc_ecc_mode(mtd, ECC_HW_MODE); |
|
|
|
|
|
|
|
vf610_nfc_transfer_size(nfc->regs, trfr_sz); |
|
|
|
vf610_nfc_send_commands(nfc->regs, NAND_CMD_SEQIN, |
|
|
|
vf610_nfc_send_commands(nfc->regs, NAND_CMD_SEQIN, |
|
|
|
command, PROGRAM_PAGE_CMD_CODE); |
|
|
|
command, PROGRAM_PAGE_CMD_CODE); |
|
|
|
vf610_nfc_ecc_mode(mtd, ECC_HW_MODE); |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
|
|
|
|
|
|
|
|
case NAND_CMD_RESET: |
|
|
|
case NAND_CMD_RESET: |
|
|
@ -373,9 +384,9 @@ static void vf610_nfc_command(struct mtd_info *mtd, unsigned command, |
|
|
|
break; |
|
|
|
break; |
|
|
|
|
|
|
|
|
|
|
|
case NAND_CMD_READOOB: |
|
|
|
case NAND_CMD_READOOB: |
|
|
|
page_sz += mtd->oobsize; |
|
|
|
trfr_sz += mtd->oobsize; |
|
|
|
column = mtd->writesize; |
|
|
|
column = mtd->writesize; |
|
|
|
vf610_nfc_transfer_size(nfc->regs, page_sz); |
|
|
|
vf610_nfc_transfer_size(nfc->regs, trfr_sz); |
|
|
|
vf610_nfc_send_commands(nfc->regs, NAND_CMD_READ0, |
|
|
|
vf610_nfc_send_commands(nfc->regs, NAND_CMD_READ0, |
|
|
|
NAND_CMD_READSTART, READ_PAGE_CMD_CODE); |
|
|
|
NAND_CMD_READSTART, READ_PAGE_CMD_CODE); |
|
|
|
vf610_nfc_addr_cycle(mtd, column, page); |
|
|
|
vf610_nfc_addr_cycle(mtd, column, page); |
|
|
@ -383,18 +394,18 @@ static void vf610_nfc_command(struct mtd_info *mtd, unsigned command, |
|
|
|
break; |
|
|
|
break; |
|
|
|
|
|
|
|
|
|
|
|
case NAND_CMD_READ0: |
|
|
|
case NAND_CMD_READ0: |
|
|
|
page_sz += mtd->writesize + mtd->oobsize; |
|
|
|
trfr_sz += mtd->writesize + mtd->oobsize; |
|
|
|
column = 0; |
|
|
|
vf610_nfc_transfer_size(nfc->regs, trfr_sz); |
|
|
|
vf610_nfc_transfer_size(nfc->regs, page_sz); |
|
|
|
vf610_nfc_ecc_mode(mtd, ECC_HW_MODE); |
|
|
|
vf610_nfc_send_commands(nfc->regs, NAND_CMD_READ0, |
|
|
|
vf610_nfc_send_commands(nfc->regs, NAND_CMD_READ0, |
|
|
|
NAND_CMD_READSTART, READ_PAGE_CMD_CODE); |
|
|
|
NAND_CMD_READSTART, READ_PAGE_CMD_CODE); |
|
|
|
vf610_nfc_addr_cycle(mtd, column, page); |
|
|
|
vf610_nfc_addr_cycle(mtd, column, page); |
|
|
|
vf610_nfc_ecc_mode(mtd, ECC_HW_MODE); |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
|
|
|
|
|
|
|
|
case NAND_CMD_PARAM: |
|
|
|
case NAND_CMD_PARAM: |
|
|
|
nfc->alt_buf = ALT_BUF_ONFI; |
|
|
|
nfc->alt_buf = ALT_BUF_ONFI; |
|
|
|
vf610_nfc_transfer_size(nfc->regs, 768); |
|
|
|
trfr_sz = 3 * sizeof(struct nand_onfi_params); |
|
|
|
|
|
|
|
vf610_nfc_transfer_size(nfc->regs, trfr_sz); |
|
|
|
vf610_nfc_send_command(nfc->regs, NAND_CMD_PARAM, |
|
|
|
vf610_nfc_send_command(nfc->regs, NAND_CMD_PARAM, |
|
|
|
READ_ONFI_PARAM_CMD_CODE); |
|
|
|
READ_ONFI_PARAM_CMD_CODE); |
|
|
|
vf610_nfc_set_field(mtd, NFC_ROW_ADDR, ROW_ADDR_MASK, |
|
|
|
vf610_nfc_set_field(mtd, NFC_ROW_ADDR, ROW_ADDR_MASK, |
|
|
@ -411,7 +422,7 @@ static void vf610_nfc_command(struct mtd_info *mtd, unsigned command, |
|
|
|
|
|
|
|
|
|
|
|
case NAND_CMD_READID: |
|
|
|
case NAND_CMD_READID: |
|
|
|
nfc->alt_buf = ALT_BUF_ID; |
|
|
|
nfc->alt_buf = ALT_BUF_ID; |
|
|
|
nfc->column = 0; |
|
|
|
nfc->buf_offset = 0; |
|
|
|
vf610_nfc_transfer_size(nfc->regs, 0); |
|
|
|
vf610_nfc_transfer_size(nfc->regs, 0); |
|
|
|
vf610_nfc_send_command(nfc->regs, command, READ_ID_CMD_CODE); |
|
|
|
vf610_nfc_send_command(nfc->regs, command, READ_ID_CMD_CODE); |
|
|
|
vf610_nfc_set_field(mtd, NFC_ROW_ADDR, ROW_ADDR_MASK, |
|
|
|
vf610_nfc_set_field(mtd, NFC_ROW_ADDR, ROW_ADDR_MASK, |
|
|
@ -421,21 +432,22 @@ static void vf610_nfc_command(struct mtd_info *mtd, unsigned command, |
|
|
|
case NAND_CMD_STATUS: |
|
|
|
case NAND_CMD_STATUS: |
|
|
|
nfc->alt_buf = ALT_BUF_STAT; |
|
|
|
nfc->alt_buf = ALT_BUF_STAT; |
|
|
|
vf610_nfc_transfer_size(nfc->regs, 0); |
|
|
|
vf610_nfc_transfer_size(nfc->regs, 0); |
|
|
|
vf610_nfc_send_command(nfc->regs, command, |
|
|
|
vf610_nfc_send_command(nfc->regs, command, STATUS_READ_CMD_CODE); |
|
|
|
STATUS_READ_CMD_CODE); |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
default: |
|
|
|
default: |
|
|
|
return; |
|
|
|
return; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
vf610_nfc_done(mtd); |
|
|
|
vf610_nfc_done(mtd); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
nfc->write_sz = 0; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/* Read data from NFC buffers */ |
|
|
|
/* Read data from NFC buffers */ |
|
|
|
static void vf610_nfc_read_buf(struct mtd_info *mtd, u_char *buf, int len) |
|
|
|
static void vf610_nfc_read_buf(struct mtd_info *mtd, u_char *buf, int len) |
|
|
|
{ |
|
|
|
{ |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
uint c = nfc->column; |
|
|
|
uint c = nfc->buf_offset; |
|
|
|
|
|
|
|
|
|
|
|
/* Alternate buffers are only supported through read_byte */ |
|
|
|
/* Alternate buffers are only supported through read_byte */ |
|
|
|
if (nfc->alt_buf) |
|
|
|
if (nfc->alt_buf) |
|
|
@ -443,28 +455,30 @@ static void vf610_nfc_read_buf(struct mtd_info *mtd, u_char *buf, int len) |
|
|
|
|
|
|
|
|
|
|
|
vf610_nfc_memcpy(buf, nfc->regs + NFC_MAIN_AREA(0) + c, len); |
|
|
|
vf610_nfc_memcpy(buf, nfc->regs + NFC_MAIN_AREA(0) + c, len); |
|
|
|
|
|
|
|
|
|
|
|
nfc->column += len; |
|
|
|
nfc->buf_offset += len; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/* Write data to NFC buffers */ |
|
|
|
/* Write data to NFC buffers */ |
|
|
|
static void vf610_nfc_write_buf(struct mtd_info *mtd, const u_char *buf, |
|
|
|
static void vf610_nfc_write_buf(struct mtd_info *mtd, const uint8_t *buf, |
|
|
|
int len) |
|
|
|
int len) |
|
|
|
{ |
|
|
|
{ |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
uint c = nfc->column; |
|
|
|
uint c = nfc->buf_offset; |
|
|
|
uint l; |
|
|
|
uint l; |
|
|
|
|
|
|
|
|
|
|
|
l = min((uint)len, mtd->writesize + mtd->oobsize - c); |
|
|
|
l = min_t(uint, len, mtd->writesize + mtd->oobsize - c); |
|
|
|
nfc->column += l; |
|
|
|
|
|
|
|
vf610_nfc_memcpy(nfc->regs + NFC_MAIN_AREA(0) + c, buf, l); |
|
|
|
vf610_nfc_memcpy(nfc->regs + NFC_MAIN_AREA(0) + c, buf, l); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
nfc->write_sz += l; |
|
|
|
|
|
|
|
nfc->buf_offset += l; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/* Read byte from NFC buffers */ |
|
|
|
/* Read byte from NFC buffers */ |
|
|
|
static u8 vf610_nfc_read_byte(struct mtd_info *mtd) |
|
|
|
static uint8_t vf610_nfc_read_byte(struct mtd_info *mtd) |
|
|
|
{ |
|
|
|
{ |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
u8 tmp; |
|
|
|
u8 tmp; |
|
|
|
uint c = nfc->column; |
|
|
|
uint c = nfc->buf_offset; |
|
|
|
|
|
|
|
|
|
|
|
switch (nfc->alt_buf) { |
|
|
|
switch (nfc->alt_buf) { |
|
|
|
case ALT_BUF_ID: |
|
|
|
case ALT_BUF_ID: |
|
|
@ -473,18 +487,17 @@ static u8 vf610_nfc_read_byte(struct mtd_info *mtd) |
|
|
|
case ALT_BUF_STAT: |
|
|
|
case ALT_BUF_STAT: |
|
|
|
tmp = vf610_nfc_get_status(mtd); |
|
|
|
tmp = vf610_nfc_get_status(mtd); |
|
|
|
break; |
|
|
|
break; |
|
|
|
case ALT_BUF_ONFI: |
|
|
|
|
|
|
|
#ifdef __LITTLE_ENDIAN |
|
|
|
#ifdef __LITTLE_ENDIAN |
|
|
|
|
|
|
|
case ALT_BUF_ONFI: |
|
|
|
/* Reverse byte since the controller uses big endianness */ |
|
|
|
/* Reverse byte since the controller uses big endianness */ |
|
|
|
c = nfc->column ^ 0x3; |
|
|
|
c = nfc->buf_offset ^ 0x3; |
|
|
|
tmp = *((u8 *)(nfc->regs + NFC_MAIN_AREA(0) + c)); |
|
|
|
/* fall-through */ |
|
|
|
break; |
|
|
|
|
|
|
|
#endif |
|
|
|
#endif |
|
|
|
default: |
|
|
|
default: |
|
|
|
tmp = *((u8 *)(nfc->regs + NFC_MAIN_AREA(0) + c)); |
|
|
|
tmp = *((u8 *)(nfc->regs + NFC_MAIN_AREA(0) + c)); |
|
|
|
break; |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
nfc->column++; |
|
|
|
nfc->buf_offset++; |
|
|
|
return tmp; |
|
|
|
return tmp; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
@ -492,6 +505,7 @@ static u8 vf610_nfc_read_byte(struct mtd_info *mtd) |
|
|
|
static u16 vf610_nfc_read_word(struct mtd_info *mtd) |
|
|
|
static u16 vf610_nfc_read_word(struct mtd_info *mtd) |
|
|
|
{ |
|
|
|
{ |
|
|
|
u16 tmp; |
|
|
|
u16 tmp; |
|
|
|
|
|
|
|
|
|
|
|
vf610_nfc_read_buf(mtd, (u_char *)&tmp, sizeof(tmp)); |
|
|
|
vf610_nfc_read_buf(mtd, (u_char *)&tmp, sizeof(tmp)); |
|
|
|
return tmp; |
|
|
|
return tmp; |
|
|
|
} |
|
|
|
} |
|
|
@ -511,12 +525,11 @@ static void vf610_nfc_select_chip(struct mtd_info *mtd, int chip) |
|
|
|
#ifdef CONFIG_VF610 |
|
|
|
#ifdef CONFIG_VF610 |
|
|
|
u32 tmp = vf610_nfc_read(mtd, NFC_ROW_ADDR); |
|
|
|
u32 tmp = vf610_nfc_read(mtd, NFC_ROW_ADDR); |
|
|
|
tmp &= ~(ROW_ADDR_CHIP_SEL_RB_MASK | ROW_ADDR_CHIP_SEL_MASK); |
|
|
|
tmp &= ~(ROW_ADDR_CHIP_SEL_RB_MASK | ROW_ADDR_CHIP_SEL_MASK); |
|
|
|
tmp |= 1 << ROW_ADDR_CHIP_SEL_RB_SHIFT; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (chip == 0) |
|
|
|
if (chip >= 0) { |
|
|
|
tmp |= 1 << ROW_ADDR_CHIP_SEL_SHIFT; |
|
|
|
tmp |= 1 << ROW_ADDR_CHIP_SEL_RB_SHIFT; |
|
|
|
else if (chip == 1) |
|
|
|
tmp |= (1 << chip) << ROW_ADDR_CHIP_SEL_SHIFT; |
|
|
|
tmp |= 2 << ROW_ADDR_CHIP_SEL_SHIFT; |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
vf610_nfc_write(mtd, NFC_ROW_ADDR, tmp); |
|
|
|
vf610_nfc_write(mtd, NFC_ROW_ADDR, tmp); |
|
|
|
#endif |
|
|
|
#endif |
|
|
@ -537,52 +550,61 @@ static inline int count_written_bits(uint8_t *buff, int size, int max_bits) |
|
|
|
return written_bits; |
|
|
|
return written_bits; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
static inline int vf610_nfc_correct_data(struct mtd_info *mtd, u_char *dat) |
|
|
|
static inline int vf610_nfc_correct_data(struct mtd_info *mtd, uint8_t *dat, |
|
|
|
|
|
|
|
uint8_t *oob, int page) |
|
|
|
{ |
|
|
|
{ |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
|
|
|
|
u32 ecc_status_off = NFC_MAIN_AREA(0) + ECC_SRAM_ADDR + ECC_STATUS; |
|
|
|
u8 ecc_status; |
|
|
|
u8 ecc_status; |
|
|
|
u8 ecc_count; |
|
|
|
u8 ecc_count; |
|
|
|
int flip; |
|
|
|
int flips; |
|
|
|
|
|
|
|
int flips_threshold = nfc->chip.ecc.strength / 2; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ecc_status = vf610_nfc_read(mtd, ecc_status_off) & 0xff; |
|
|
|
|
|
|
|
ecc_count = ecc_status & ECC_STATUS_ERR_COUNT; |
|
|
|
|
|
|
|
|
|
|
|
ecc_status = __raw_readb(nfc->regs + ECC_SRAM_ADDR * 8 + ECC_OFFSET); |
|
|
|
|
|
|
|
ecc_count = ecc_status & ECC_ERR_COUNT; |
|
|
|
|
|
|
|
if (!(ecc_status & ECC_STATUS_MASK)) |
|
|
|
if (!(ecc_status & ECC_STATUS_MASK)) |
|
|
|
return ecc_count; |
|
|
|
return ecc_count; |
|
|
|
|
|
|
|
|
|
|
|
/* If 'ecc_count' zero or less then buffer is all 0xff or erased. */ |
|
|
|
/* Read OOB without ECC unit enabled */ |
|
|
|
flip = count_written_bits(dat, nfc->chip.ecc.size, ecc_count); |
|
|
|
vf610_nfc_command(mtd, NAND_CMD_READOOB, 0, page); |
|
|
|
|
|
|
|
vf610_nfc_read_buf(mtd, oob, mtd->oobsize); |
|
|
|
|
|
|
|
|
|
|
|
/* ECC failed. */ |
|
|
|
/*
|
|
|
|
if (flip > ecc_count && flip > (nfc->chip.ecc.strength / 2)) |
|
|
|
* On an erased page, bit count (including OOB) should be zero or |
|
|
|
return -1; |
|
|
|
* at least less then half of the ECC strength. |
|
|
|
|
|
|
|
*/ |
|
|
|
|
|
|
|
flips = count_written_bits(dat, nfc->chip.ecc.size, flips_threshold); |
|
|
|
|
|
|
|
flips += count_written_bits(oob, mtd->oobsize, flips_threshold); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (unlikely(flips > flips_threshold)) |
|
|
|
|
|
|
|
return -EINVAL; |
|
|
|
|
|
|
|
|
|
|
|
/* Erased page. */ |
|
|
|
/* Erased page. */ |
|
|
|
memset(dat, 0xff, nfc->chip.ecc.size); |
|
|
|
memset(dat, 0xff, nfc->chip.ecc.size); |
|
|
|
return 0; |
|
|
|
memset(oob, 0xff, mtd->oobsize); |
|
|
|
|
|
|
|
return flips; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static int vf610_nfc_read_page(struct mtd_info *mtd, struct nand_chip *chip, |
|
|
|
static int vf610_nfc_read_page(struct mtd_info *mtd, struct nand_chip *chip, |
|
|
|
uint8_t *buf, int oob_required, int page) |
|
|
|
uint8_t *buf, int oob_required, int page) |
|
|
|
{ |
|
|
|
{ |
|
|
|
int eccsize = chip->ecc.size; |
|
|
|
int eccsize = chip->ecc.size; |
|
|
|
int stat; |
|
|
|
int stat; |
|
|
|
uint8_t *p = buf; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
vf610_nfc_read_buf(mtd, p, eccsize); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
vf610_nfc_read_buf(mtd, buf, eccsize); |
|
|
|
if (oob_required) |
|
|
|
if (oob_required) |
|
|
|
vf610_nfc_read_buf(mtd, chip->oob_poi, mtd->oobsize); |
|
|
|
vf610_nfc_read_buf(mtd, chip->oob_poi, mtd->oobsize); |
|
|
|
|
|
|
|
|
|
|
|
stat = vf610_nfc_correct_data(mtd, p); |
|
|
|
stat = vf610_nfc_correct_data(mtd, buf, chip->oob_poi, page); |
|
|
|
|
|
|
|
|
|
|
|
if (stat < 0) |
|
|
|
if (stat < 0) { |
|
|
|
mtd->ecc_stats.failed++; |
|
|
|
mtd->ecc_stats.failed++; |
|
|
|
else |
|
|
|
return 0; |
|
|
|
|
|
|
|
} else { |
|
|
|
mtd->ecc_stats.corrected += stat; |
|
|
|
mtd->ecc_stats.corrected += stat; |
|
|
|
|
|
|
|
return stat; |
|
|
|
return 0; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
/*
|
|
|
@ -591,10 +613,15 @@ static int vf610_nfc_read_page(struct mtd_info *mtd, struct nand_chip *chip, |
|
|
|
static int vf610_nfc_write_page(struct mtd_info *mtd, struct nand_chip *chip, |
|
|
|
static int vf610_nfc_write_page(struct mtd_info *mtd, struct nand_chip *chip, |
|
|
|
const uint8_t *buf, int oob_required) |
|
|
|
const uint8_t *buf, int oob_required) |
|
|
|
{ |
|
|
|
{ |
|
|
|
|
|
|
|
struct vf610_nfc *nfc = mtd_to_nfc(mtd); |
|
|
|
|
|
|
|
|
|
|
|
vf610_nfc_write_buf(mtd, buf, mtd->writesize); |
|
|
|
vf610_nfc_write_buf(mtd, buf, mtd->writesize); |
|
|
|
if (oob_required) |
|
|
|
if (oob_required) |
|
|
|
vf610_nfc_write_buf(mtd, chip->oob_poi, mtd->oobsize); |
|
|
|
vf610_nfc_write_buf(mtd, chip->oob_poi, mtd->oobsize); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Always write whole page including OOB due to HW ECC */ |
|
|
|
|
|
|
|
nfc->write_sz = mtd->writesize + mtd->oobsize; |
|
|
|
|
|
|
|
|
|
|
|
return 0; |
|
|
|
return 0; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
@ -635,12 +662,6 @@ static int vf610_nfc_nand_init(int devnum, void __iomem *addr) |
|
|
|
if (cfg.width == 16) |
|
|
|
if (cfg.width == 16) |
|
|
|
chip->options |= NAND_BUSWIDTH_16; |
|
|
|
chip->options |= NAND_BUSWIDTH_16; |
|
|
|
|
|
|
|
|
|
|
|
/* Use 8-bit mode during initialization */ |
|
|
|
|
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_16BIT); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Disable subpage writes as we do not provide ecc->hwctl */ |
|
|
|
|
|
|
|
chip->options |= NAND_NO_SUBPAGE_WRITE; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
chip->dev_ready = vf610_nfc_dev_ready; |
|
|
|
chip->dev_ready = vf610_nfc_dev_ready; |
|
|
|
chip->cmdfunc = vf610_nfc_command; |
|
|
|
chip->cmdfunc = vf610_nfc_command; |
|
|
|
chip->read_byte = vf610_nfc_read_byte; |
|
|
|
chip->read_byte = vf610_nfc_read_byte; |
|
|
@ -649,30 +670,22 @@ static int vf610_nfc_nand_init(int devnum, void __iomem *addr) |
|
|
|
chip->write_buf = vf610_nfc_write_buf; |
|
|
|
chip->write_buf = vf610_nfc_write_buf; |
|
|
|
chip->select_chip = vf610_nfc_select_chip; |
|
|
|
chip->select_chip = vf610_nfc_select_chip; |
|
|
|
|
|
|
|
|
|
|
|
/* Bad block options. */ |
|
|
|
chip->options |= NAND_NO_SUBPAGE_WRITE; |
|
|
|
if (cfg.flash_bbt) |
|
|
|
|
|
|
|
chip->bbt_options = NAND_BBT_USE_FLASH | NAND_BBT_NO_OOB | |
|
|
|
chip->ecc.size = PAGE_2K; |
|
|
|
NAND_BBT_CREATE; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Set configuration register. */ |
|
|
|
/* Set configuration register. */ |
|
|
|
|
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_16BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_ADDR_AUTO_INCR_BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_ADDR_AUTO_INCR_BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_BUFNO_AUTO_INCR_BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_BUFNO_AUTO_INCR_BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_BOOT_MODE_BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_BOOT_MODE_BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_DMA_REQ_BIT); |
|
|
|
vf610_nfc_clear(mtd, NFC_FLASH_CONFIG, CONFIG_DMA_REQ_BIT); |
|
|
|
vf610_nfc_set(mtd, NFC_FLASH_CONFIG, CONFIG_FAST_FLASH_BIT); |
|
|
|
vf610_nfc_set(mtd, NFC_FLASH_CONFIG, CONFIG_FAST_FLASH_BIT); |
|
|
|
|
|
|
|
|
|
|
|
/* Enable Idle IRQ */ |
|
|
|
/* Disable virtual pages, only one elementary transfer unit */ |
|
|
|
vf610_nfc_set(mtd, NFC_IRQ_STATUS, IDLE_EN_BIT); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* PAGE_CNT = 1 */ |
|
|
|
|
|
|
|
vf610_nfc_set_field(mtd, NFC_FLASH_CONFIG, CONFIG_PAGE_CNT_MASK, |
|
|
|
vf610_nfc_set_field(mtd, NFC_FLASH_CONFIG, CONFIG_PAGE_CNT_MASK, |
|
|
|
CONFIG_PAGE_CNT_SHIFT, 1); |
|
|
|
CONFIG_PAGE_CNT_SHIFT, 1); |
|
|
|
|
|
|
|
|
|
|
|
/* Set ECC_STATUS offset */ |
|
|
|
|
|
|
|
vf610_nfc_set_field(mtd, NFC_FLASH_CONFIG, |
|
|
|
|
|
|
|
CONFIG_ECC_SRAM_ADDR_MASK, |
|
|
|
|
|
|
|
CONFIG_ECC_SRAM_ADDR_SHIFT, ECC_SRAM_ADDR); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* first scan to find the device and get the page size */ |
|
|
|
/* first scan to find the device and get the page size */ |
|
|
|
if (nand_scan_ident(mtd, CONFIG_SYS_MAX_NAND_DEVICE, NULL)) { |
|
|
|
if (nand_scan_ident(mtd, CONFIG_SYS_MAX_NAND_DEVICE, NULL)) { |
|
|
|
err = -ENXIO; |
|
|
|
err = -ENXIO; |
|
|
@ -682,11 +695,14 @@ static int vf610_nfc_nand_init(int devnum, void __iomem *addr) |
|
|
|
if (cfg.width == 16) |
|
|
|
if (cfg.width == 16) |
|
|
|
vf610_nfc_set(mtd, NFC_FLASH_CONFIG, CONFIG_16BIT); |
|
|
|
vf610_nfc_set(mtd, NFC_FLASH_CONFIG, CONFIG_16BIT); |
|
|
|
|
|
|
|
|
|
|
|
chip->ecc.mode = NAND_ECC_SOFT; /* default */ |
|
|
|
/* Bad block options. */ |
|
|
|
|
|
|
|
if (cfg.flash_bbt) |
|
|
|
|
|
|
|
chip->bbt_options = NAND_BBT_USE_FLASH | NAND_BBT_NO_OOB | |
|
|
|
|
|
|
|
NAND_BBT_CREATE; |
|
|
|
|
|
|
|
|
|
|
|
/* Single buffer only, max 256 OOB minus ECC status */ |
|
|
|
/* Single buffer only, max 256 OOB minus ECC status */ |
|
|
|
if (mtd->writesize + mtd->oobsize > PAGE_2K + 256 - 8) { |
|
|
|
if (mtd->writesize + mtd->oobsize > PAGE_2K + OOB_MAX - 8) { |
|
|
|
dev_err(nfc->dev, "Unsupported flash size\n"); |
|
|
|
dev_err(nfc->dev, "Unsupported flash page size\n"); |
|
|
|
err = -ENXIO; |
|
|
|
err = -ENXIO; |
|
|
|
goto error; |
|
|
|
goto error; |
|
|
|
} |
|
|
|
} |
|
|
@ -698,6 +714,13 @@ static int vf610_nfc_nand_init(int devnum, void __iomem *addr) |
|
|
|
goto error; |
|
|
|
goto error; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (chip->ecc.size != mtd->writesize) { |
|
|
|
|
|
|
|
dev_err(nfc->dev, "ecc size: %d\n", chip->ecc.size); |
|
|
|
|
|
|
|
dev_err(nfc->dev, "Step size needs to be page size\n"); |
|
|
|
|
|
|
|
err = -ENXIO; |
|
|
|
|
|
|
|
goto error; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/* Current HW ECC layouts only use 64 bytes of OOB */ |
|
|
|
/* Current HW ECC layouts only use 64 bytes of OOB */ |
|
|
|
if (mtd->oobsize > 64) |
|
|
|
if (mtd->oobsize > 64) |
|
|
|
mtd->oobsize = 64; |
|
|
|
mtd->oobsize = 64; |
|
|
@ -718,7 +741,13 @@ static int vf610_nfc_nand_init(int devnum, void __iomem *addr) |
|
|
|
chip->ecc.bytes = 60; |
|
|
|
chip->ecc.bytes = 60; |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
|
|
/* Enable ECC_STATUS */ |
|
|
|
/* Set ECC_STATUS offset */ |
|
|
|
|
|
|
|
vf610_nfc_set_field(mtd, NFC_FLASH_CONFIG, |
|
|
|
|
|
|
|
CONFIG_ECC_SRAM_ADDR_MASK, |
|
|
|
|
|
|
|
CONFIG_ECC_SRAM_ADDR_SHIFT, |
|
|
|
|
|
|
|
ECC_SRAM_ADDR >> 3); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Enable ECC status in SRAM */ |
|
|
|
vf610_nfc_set(mtd, NFC_FLASH_CONFIG, CONFIG_ECC_SRAM_REQ_BIT); |
|
|
|
vf610_nfc_set(mtd, NFC_FLASH_CONFIG, CONFIG_ECC_SRAM_REQ_BIT); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|