OneNAND: Add write_oob verify function
Signed-off-by: Jarkko Lavinen <jarkko.lavinen@nokia.com>
This commit is contained in:
parent
d9777f1c42
commit
8e6ec69059
1 changed files with 43 additions and 4 deletions
|
@ -758,6 +758,36 @@ static int onenand_read_oob(struct mtd_info *mtd, loff_t from, size_t len,
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef CONFIG_MTD_ONENAND_VERIFY_WRITE
|
#ifdef CONFIG_MTD_ONENAND_VERIFY_WRITE
|
||||||
|
/**
|
||||||
|
* onenand_verify_oob - [GENERIC] verify the oob contents after a write
|
||||||
|
* @param mtd MTD device structure
|
||||||
|
* @param buf the databuffer to verify
|
||||||
|
* @param to offset to read from
|
||||||
|
* @param len number of bytes to read and compare
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
static int onenand_verify_oob(struct mtd_info *mtd, const u_char *buf, loff_t to, int len)
|
||||||
|
{
|
||||||
|
struct onenand_chip *this = mtd->priv;
|
||||||
|
char *readp = this->page_buf;
|
||||||
|
int column = to & (mtd->oobsize - 1);
|
||||||
|
int status, i;
|
||||||
|
|
||||||
|
this->command(mtd, ONENAND_CMD_READOOB, to, mtd->oobsize);
|
||||||
|
onenand_update_bufferram(mtd, to, 0);
|
||||||
|
status = this->wait(mtd, FL_READING);
|
||||||
|
if (status)
|
||||||
|
return status;
|
||||||
|
|
||||||
|
this->read_bufferram(mtd, ONENAND_SPARERAM, readp, column, len);
|
||||||
|
|
||||||
|
for(i = 0; i < len; i++)
|
||||||
|
if (buf[i] != 0xFF && buf[i] != readp[i])
|
||||||
|
return -EBADMSG;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* onenand_verify_page - [GENERIC] verify the chip contents after a write
|
* onenand_verify_page - [GENERIC] verify the chip contents after a write
|
||||||
* @param mtd MTD device structure
|
* @param mtd MTD device structure
|
||||||
|
@ -790,6 +820,7 @@ static int onenand_verify_page(struct mtd_info *mtd, u_char *buf, loff_t addr)
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
#define onenand_verify_page(...) (0)
|
#define onenand_verify_page(...) (0)
|
||||||
|
#define onenand_verify_oob(...) (0)
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define NOTALIGNED(x) ((x & (mtd->oobblock - 1)) != 0)
|
#define NOTALIGNED(x) ((x & (mtd->oobblock - 1)) != 0)
|
||||||
|
@ -909,7 +940,7 @@ static int onenand_write_oob(struct mtd_info *mtd, loff_t to, size_t len,
|
||||||
size_t *retlen, const u_char *buf)
|
size_t *retlen, const u_char *buf)
|
||||||
{
|
{
|
||||||
struct onenand_chip *this = mtd->priv;
|
struct onenand_chip *this = mtd->priv;
|
||||||
int column, status;
|
int column, ret = 0;
|
||||||
int written = 0;
|
int written = 0;
|
||||||
|
|
||||||
DEBUG(MTD_DEBUG_LEVEL3, "onenand_write_oob: to = 0x%08x, len = %i\n", (unsigned int) to, (int) len);
|
DEBUG(MTD_DEBUG_LEVEL3, "onenand_write_oob: to = 0x%08x, len = %i\n", (unsigned int) to, (int) len);
|
||||||
|
@ -941,9 +972,17 @@ static int onenand_write_oob(struct mtd_info *mtd, loff_t to, size_t len,
|
||||||
|
|
||||||
onenand_update_bufferram(mtd, to, 0);
|
onenand_update_bufferram(mtd, to, 0);
|
||||||
|
|
||||||
status = this->wait(mtd, FL_WRITING);
|
ret = this->wait(mtd, FL_WRITING);
|
||||||
if (status)
|
if (ret) {
|
||||||
|
DEBUG(MTD_DEBUG_LEVEL0, "onenand_write_oob: write filaed %d\n", ret);
|
||||||
goto out;
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = onenand_verify_oob(mtd, buf, to, thislen);
|
||||||
|
if (ret) {
|
||||||
|
DEBUG(MTD_DEBUG_LEVEL0, "onenand_write_oob: verify failed %d\n", ret);
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
written += thislen;
|
written += thislen;
|
||||||
|
|
||||||
|
@ -960,7 +999,7 @@ static int onenand_write_oob(struct mtd_info *mtd, loff_t to, size_t len,
|
||||||
|
|
||||||
*retlen = written;
|
*retlen = written;
|
||||||
|
|
||||||
return 0;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|
Loading…
Reference in a new issue