mirror of https://github.com/hak5/openwrt.git
233 lines
5.4 KiB
C
233 lines
5.4 KiB
C
/*
|
|
* YAFFS: Yet Another Flash File System. A NAND-flash specific file system.
|
|
*
|
|
* Copyright (C) 2002-2007 Aleph One Ltd.
|
|
* for Toby Churchill Ltd and Brightstar Engineering
|
|
*
|
|
* Created by Charles Manning <charles@aleph1.co.uk>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
/* mtd interface for YAFFS2 */
|
|
|
|
const char *yaffs_mtdif2_c_version =
|
|
"$Id: yaffs_mtdif2.c,v 1.17 2007-02-14 01:09:06 wookey Exp $";
|
|
|
|
#include "yportenv.h"
|
|
|
|
|
|
#include "yaffs_mtdif2.h"
|
|
|
|
#include "linux/mtd/mtd.h"
|
|
#include "linux/types.h"
|
|
#include "linux/time.h"
|
|
|
|
#include "yaffs_packedtags2.h"
|
|
|
|
int nandmtd2_WriteChunkWithTagsToNAND(yaffs_Device * dev, int chunkInNAND,
|
|
const __u8 * data,
|
|
const yaffs_ExtendedTags * tags)
|
|
{
|
|
struct mtd_info *mtd = (struct mtd_info *)(dev->genericDevice);
|
|
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,17))
|
|
struct mtd_oob_ops ops;
|
|
#else
|
|
size_t dummy;
|
|
#endif
|
|
int retval = 0;
|
|
|
|
loff_t addr = ((loff_t) chunkInNAND) * dev->nDataBytesPerChunk;
|
|
|
|
yaffs_PackedTags2 pt;
|
|
|
|
T(YAFFS_TRACE_MTD,
|
|
(TSTR
|
|
("nandmtd2_WriteChunkWithTagsToNAND chunk %d data %p tags %p"
|
|
TENDSTR), chunkInNAND, data, tags));
|
|
|
|
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,17))
|
|
if (tags)
|
|
yaffs_PackTags2(&pt, tags);
|
|
else
|
|
BUG(); /* both tags and data should always be present */
|
|
|
|
if (data) {
|
|
ops.mode = MTD_OOB_AUTO;
|
|
ops.ooblen = sizeof(pt);
|
|
ops.len = dev->nDataBytesPerChunk;
|
|
ops.ooboffs = 0;
|
|
ops.datbuf = (__u8 *)data;
|
|
ops.oobbuf = (void *)&pt;
|
|
retval = mtd->write_oob(mtd, addr, &ops);
|
|
} else
|
|
BUG(); /* both tags and data should always be present */
|
|
#else
|
|
if (tags) {
|
|
yaffs_PackTags2(&pt, tags);
|
|
}
|
|
|
|
if (data && tags) {
|
|
if (dev->useNANDECC)
|
|
retval =
|
|
mtd->write_ecc(mtd, addr, dev->nDataBytesPerChunk,
|
|
&dummy, data, (__u8 *) & pt, NULL);
|
|
else
|
|
retval =
|
|
mtd->write_ecc(mtd, addr, dev->nDataBytesPerChunk,
|
|
&dummy, data, (__u8 *) & pt, NULL);
|
|
} else {
|
|
if (data)
|
|
retval =
|
|
mtd->write(mtd, addr, dev->nDataBytesPerChunk, &dummy,
|
|
data);
|
|
if (tags)
|
|
retval =
|
|
mtd->write_oob(mtd, addr, mtd->oobsize, &dummy,
|
|
(__u8 *) & pt);
|
|
|
|
}
|
|
#endif
|
|
|
|
if (retval == 0)
|
|
return YAFFS_OK;
|
|
else
|
|
return YAFFS_FAIL;
|
|
}
|
|
|
|
int nandmtd2_ReadChunkWithTagsFromNAND(yaffs_Device * dev, int chunkInNAND,
|
|
__u8 * data, yaffs_ExtendedTags * tags)
|
|
{
|
|
struct mtd_info *mtd = (struct mtd_info *)(dev->genericDevice);
|
|
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,17))
|
|
struct mtd_oob_ops ops;
|
|
#endif
|
|
size_t dummy;
|
|
int retval = 0;
|
|
|
|
loff_t addr = ((loff_t) chunkInNAND) * dev->nDataBytesPerChunk;
|
|
|
|
yaffs_PackedTags2 pt;
|
|
|
|
T(YAFFS_TRACE_MTD,
|
|
(TSTR
|
|
("nandmtd2_ReadChunkWithTagsFromNAND chunk %d data %p tags %p"
|
|
TENDSTR), chunkInNAND, data, tags));
|
|
|
|
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,17))
|
|
if (data && !tags)
|
|
retval = mtd->read(mtd, addr, dev->nDataBytesPerChunk,
|
|
&dummy, data);
|
|
else if (tags) {
|
|
ops.mode = MTD_OOB_AUTO;
|
|
ops.ooblen = sizeof(pt);
|
|
ops.len = data ? dev->nDataBytesPerChunk : sizeof(pt);
|
|
ops.ooboffs = 0;
|
|
ops.datbuf = data;
|
|
ops.oobbuf = dev->spareBuffer;
|
|
retval = mtd->read_oob(mtd, addr, &ops);
|
|
}
|
|
#else
|
|
if (data && tags) {
|
|
if (dev->useNANDECC) {
|
|
retval =
|
|
mtd->read_ecc(mtd, addr, dev->nDataBytesPerChunk,
|
|
&dummy, data, dev->spareBuffer,
|
|
NULL);
|
|
} else {
|
|
retval =
|
|
mtd->read_ecc(mtd, addr, dev->nDataBytesPerChunk,
|
|
&dummy, data, dev->spareBuffer,
|
|
NULL);
|
|
}
|
|
} else {
|
|
if (data)
|
|
retval =
|
|
mtd->read(mtd, addr, dev->nDataBytesPerChunk, &dummy,
|
|
data);
|
|
if (tags)
|
|
retval =
|
|
mtd->read_oob(mtd, addr, mtd->oobsize, &dummy,
|
|
dev->spareBuffer);
|
|
}
|
|
#endif
|
|
|
|
memcpy(&pt, dev->spareBuffer, sizeof(pt));
|
|
|
|
if (tags)
|
|
yaffs_UnpackTags2(tags, &pt);
|
|
|
|
if(tags && retval == -EBADMSG && tags->eccResult == YAFFS_ECC_RESULT_NO_ERROR)
|
|
tags->eccResult = YAFFS_ECC_RESULT_UNFIXED;
|
|
|
|
if (retval == 0)
|
|
return YAFFS_OK;
|
|
else
|
|
return YAFFS_FAIL;
|
|
}
|
|
|
|
int nandmtd2_MarkNANDBlockBad(struct yaffs_DeviceStruct *dev, int blockNo)
|
|
{
|
|
struct mtd_info *mtd = (struct mtd_info *)(dev->genericDevice);
|
|
int retval;
|
|
T(YAFFS_TRACE_MTD,
|
|
(TSTR("nandmtd2_MarkNANDBlockBad %d" TENDSTR), blockNo));
|
|
|
|
retval =
|
|
mtd->block_markbad(mtd,
|
|
blockNo * dev->nChunksPerBlock *
|
|
dev->nDataBytesPerChunk);
|
|
|
|
if (retval == 0)
|
|
return YAFFS_OK;
|
|
else
|
|
return YAFFS_FAIL;
|
|
|
|
}
|
|
|
|
int nandmtd2_QueryNANDBlock(struct yaffs_DeviceStruct *dev, int blockNo,
|
|
yaffs_BlockState * state, int *sequenceNumber)
|
|
{
|
|
struct mtd_info *mtd = (struct mtd_info *)(dev->genericDevice);
|
|
int retval;
|
|
|
|
T(YAFFS_TRACE_MTD,
|
|
(TSTR("nandmtd2_QueryNANDBlock %d" TENDSTR), blockNo));
|
|
retval =
|
|
mtd->block_isbad(mtd,
|
|
blockNo * dev->nChunksPerBlock *
|
|
dev->nDataBytesPerChunk);
|
|
|
|
if (retval) {
|
|
T(YAFFS_TRACE_MTD, (TSTR("block is bad" TENDSTR)));
|
|
|
|
*state = YAFFS_BLOCK_STATE_DEAD;
|
|
*sequenceNumber = 0;
|
|
} else {
|
|
yaffs_ExtendedTags t;
|
|
nandmtd2_ReadChunkWithTagsFromNAND(dev,
|
|
blockNo *
|
|
dev->nChunksPerBlock, NULL,
|
|
&t);
|
|
|
|
if (t.chunkUsed) {
|
|
*sequenceNumber = t.sequenceNumber;
|
|
*state = YAFFS_BLOCK_STATE_NEEDS_SCANNING;
|
|
} else {
|
|
*sequenceNumber = 0;
|
|
*state = YAFFS_BLOCK_STATE_EMPTY;
|
|
}
|
|
}
|
|
T(YAFFS_TRACE_MTD,
|
|
(TSTR("block is bad seq %d state %d" TENDSTR), *sequenceNumber,
|
|
*state));
|
|
|
|
if (retval == 0)
|
|
return YAFFS_OK;
|
|
else
|
|
return YAFFS_FAIL;
|
|
}
|
|
|