diff options
author | Yang Zhang <yang.z.zhang@intel.com> | 2015-08-28 09:58:54 +0800 |
---|---|---|
committer | Yang Zhang <yang.z.zhang@intel.com> | 2015-09-01 12:44:00 +0800 |
commit | e44e3482bdb4d0ebde2d8b41830ac2cdb07948fb (patch) | |
tree | 66b09f592c55df2878107a468a91d21506104d3f /qemu/roms/u-boot/fs/yaffs2/yaffs_mtdif.c | |
parent | 9ca8dbcc65cfc63d6f5ef3312a33184e1d726e00 (diff) |
Add qemu 2.4.0
Change-Id: Ic99cbad4b61f8b127b7dc74d04576c0bcbaaf4f5
Signed-off-by: Yang Zhang <yang.z.zhang@intel.com>
Diffstat (limited to 'qemu/roms/u-boot/fs/yaffs2/yaffs_mtdif.c')
-rw-r--r-- | qemu/roms/u-boot/fs/yaffs2/yaffs_mtdif.c | 165 |
1 files changed, 165 insertions, 0 deletions
diff --git a/qemu/roms/u-boot/fs/yaffs2/yaffs_mtdif.c b/qemu/roms/u-boot/fs/yaffs2/yaffs_mtdif.c new file mode 100644 index 000000000..6fcba047f --- /dev/null +++ b/qemu/roms/u-boot/fs/yaffs2/yaffs_mtdif.c @@ -0,0 +1,165 @@ +/* + * 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. + */ + +/* XXX U-BOOT XXX */ +#include <common.h> + +#include "yportenv.h" + + +#include "yaffs_mtdif.h" + +#include "linux/mtd/mtd.h" +#include "linux/types.h" +#include "linux/time.h" +#include "linux/mtd/nand.h" + + +static inline void translate_spare2oob(const struct yaffs_spare *spare, u8 *oob) +{ + oob[0] = spare->tb0; + oob[1] = spare->tb1; + oob[2] = spare->tb2; + oob[3] = spare->tb3; + oob[4] = spare->tb4; + oob[5] = spare->tb5 & 0x3f; + oob[5] |= spare->block_status == 'Y' ? 0 : 0x80; + oob[5] |= spare->page_status == 0 ? 0 : 0x40; + oob[6] = spare->tb6; + oob[7] = spare->tb7; +} + +static inline void translate_oob2spare(struct yaffs_spare *spare, u8 *oob) +{ + struct yaffs_nand_spare *nspare = (struct yaffs_nand_spare *)spare; + spare->tb0 = oob[0]; + spare->tb1 = oob[1]; + spare->tb2 = oob[2]; + spare->tb3 = oob[3]; + spare->tb4 = oob[4]; + spare->tb5 = oob[5] == 0xff ? 0xff : oob[5] & 0x3f; + spare->block_status = oob[5] & 0x80 ? 0xff : 'Y'; + spare->page_status = oob[5] & 0x40 ? 0xff : 0; + spare->ecc1[0] = spare->ecc1[1] = spare->ecc1[2] = 0xff; + spare->tb6 = oob[6]; + spare->tb7 = oob[7]; + spare->ecc2[0] = spare->ecc2[1] = spare->ecc2[2] = 0xff; + + nspare->eccres1 = nspare->eccres2 = 0; /* FIXME */ +} + + +int nandmtd_WriteChunkToNAND(struct yaffs_dev *dev, int chunkInNAND, + const u8 *data, const struct yaffs_spare *spare) +{ + struct mtd_info *mtd = (struct mtd_info *)(dev->driver_context); + struct mtd_oob_ops ops; + size_t dummy; + int retval = 0; + loff_t addr = ((loff_t) chunkInNAND) * dev->data_bytes_per_chunk; + u8 spareAsBytes[8]; /* OOB */ + + if (data && !spare) + retval = mtd_write(mtd, addr, dev->data_bytes_per_chunk, + &dummy, data); + else if (spare) { + if (dev->param.use_nand_ecc) { + translate_spare2oob(spare, spareAsBytes); + ops.mode = MTD_OPS_AUTO_OOB; + ops.ooblen = 8; /* temp hack */ + } else { + ops.mode = MTD_OPS_RAW; + ops.ooblen = YAFFS_BYTES_PER_SPARE; + } + ops.len = data ? dev->data_bytes_per_chunk : ops.ooblen; + ops.datbuf = (u8 *)data; + ops.ooboffs = 0; + ops.oobbuf = spareAsBytes; + retval = mtd_write_oob(mtd, addr, &ops); + } + + if (retval == 0) + return YAFFS_OK; + else + return YAFFS_FAIL; +} + +int nandmtd_ReadChunkFromNAND(struct yaffs_dev *dev, int chunkInNAND, u8 *data, + struct yaffs_spare *spare) +{ + struct mtd_info *mtd = (struct mtd_info *)(dev->driver_context); + struct mtd_oob_ops ops; + size_t dummy; + int retval = 0; + + loff_t addr = ((loff_t) chunkInNAND) * dev->data_bytes_per_chunk; + u8 spareAsBytes[8]; /* OOB */ + + if (data && !spare) + retval = mtd_read(mtd, addr, dev->data_bytes_per_chunk, + &dummy, data); + else if (spare) { + if (dev->param.use_nand_ecc) { + ops.mode = MTD_OPS_AUTO_OOB; + ops.ooblen = 8; /* temp hack */ + } else { + ops.mode = MTD_OPS_RAW; + ops.ooblen = YAFFS_BYTES_PER_SPARE; + } + ops.len = data ? dev->data_bytes_per_chunk : ops.ooblen; + ops.datbuf = data; + ops.ooboffs = 0; + ops.oobbuf = spareAsBytes; + retval = mtd_read_oob(mtd, addr, &ops); + if (dev->param.use_nand_ecc) + translate_oob2spare(spare, spareAsBytes); + } + + if (retval == 0) + return YAFFS_OK; + else + return YAFFS_FAIL; +} + +int nandmtd_EraseBlockInNAND(struct yaffs_dev *dev, int blockNumber) +{ + struct mtd_info *mtd = (struct mtd_info *)(dev->driver_context); + __u32 addr = + ((loff_t) blockNumber) * dev->data_bytes_per_chunk + * dev->param.chunks_per_block; + struct erase_info ei; + int retval = 0; + + ei.mtd = mtd; + ei.addr = addr; + ei.len = dev->data_bytes_per_chunk * dev->param.chunks_per_block; + ei.time = 1000; + ei.retries = 2; + ei.callback = NULL; + ei.priv = (u_long) dev; + + /* Todo finish off the ei if required */ + + + retval = mtd_erase(mtd, &ei); + + if (retval == 0) + return YAFFS_OK; + else + return YAFFS_FAIL; +} + +int nandmtd_InitialiseNAND(struct yaffs_dev *dev) +{ + return YAFFS_OK; +} |