U-boot在S3C2440上的移植詳解（五）

#gedit drivers/mtd/nand/nand_util.c? //在nand_write_skip_bad函數(shù)中添加

int nand_write_skip_bad(nand_info_t *nand, loff_t offset, size_t *length, u_char *buffer)
{
??? int rval;
??? size_t left_to_write = *length;
??? size_t len_incl_bad;
??? u_char *p_buffer = buffer;

#if defined(CONFIG_MTD_NAND_YAFFS2) //add yaffs2 file system support
??? if(nand->rw_oob==1)???
??? {
??????? size_t oobsize = nand->oobsize;
??????? size_t datasize = nand->writesize;
??????? int datapages = 0;

??????? if (((*length)%(nand->oobsize+nand->writesize)) != 0)
??????? {
???????? printf ("Attempt to write error length data!\n");
???????? return -EINVAL;
???? }

??????? datapages = *length/(datasize+oobsize);
??????? *length = datapages*datasize;
??????? left_to_write = *length;
??? }
#endif

??? /* Reject writes, which are not page aligned */
??? if ((offset & (nand->writesize - 1)) != 0 ||
???? (*length & (nand->writesize - 1)) != 0) {
??????? printf ("Attempt to write non page aligned data\n");
??????? return -EINVAL;
??? }

??? len_incl_bad = get_len_incl_bad (nand, offset, *length);

??? if ((offset + len_incl_bad) >= nand->size) {
??????? printf ("Attempt to write outside the flash area\n");
??????? return -EINVAL;
??? }

#if !defined(CONFIG_MTD_NAND_YAFFS2) //add yaffs2 file system support
??? if (len_incl_bad == *length) {
??????? rval = nand_write (nand, offset, length, buffer);
??????? if (rval != 0)
??????????? printf ("NAND write to offset %llx failed %d\n",
??????????????? offset, rval);

??????? return rval;
??? }
#endif

??? while (left_to_write > 0) {
??????? size_t block_offset = offset & (nand->erasesize - 1);
??????? size_t write_size;

??????? WATCHDOG_RESET ();

??????? if (nand_block_isbad (nand, offset & ~(nand->erasesize - 1))) {
??????????? printf ("Skip bad block 0x%08llx\n",
??????????????? offset & ~(nand->erasesize - 1));
??????????? offset += nand->erasesize - block_offset;
??????????? continue;
??????? }

#if defined(CONFIG_MTD_NAND_YAFFS2) //add yaffs2 file system support
??????? if(nand->skipfirstblk==1)???
??????? {
??????????? nand->skipfirstblk=0;
??????????? printf ("Skip the first good block %llx\n", offset & ~(nand->erasesize - 1));
??????????? offset += nand->erasesize - block_offset;
??????????? continue;
??????? }
#endif

??????? if (left_to_write < (nand->erasesize - block_offset))
??????????? write_size = left_to_write;
??????? else
??????????? write_size = nand->erasesize - block_offset;

??????? printf("\rWriting at 0x%llx -- ",offset); //add yaffs2 file system support

??????? rval = nand_write (nand, offset, &write_size, p_buffer);
??????? if (rval != 0) {
??????????? printf ("NAND write to offset %llx failed %d\n",
??????????????? offset, rval);
??????????? *length -= left_to_write;
??????????? return rval;
??????? }

??????? left_to_write -= write_size;
??????? printf("%d%% is complete.",100-(left_to_write/(*length/100)));
??????? offset += write_size;

#if defined(CONFIG_MTD_NAND_YAFFS2) //add yaffs2 file system support
??????? if(nand->rw_oob==1)???
??????? {
??????????? p_buffer += write_size+(write_size/nand->writesize*nand->oobsize);
??????? }
??????? else???
??????? {
??????????? p_buffer += write_size;
??????? }
#else
??????? p_buffer += write_size;
#endif

??? }

??? return 0;
}

#gedit drivers/mtd/nand/nand_base.c? //在nand_write函數(shù)中添加

static int nand_write(struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const uint8_t *buf)
{
??? struct nand_chip *chip = mtd->priv;
??? int ret;

?

#if defined(CONFIG_MTD_NAND_YAFFS2) //add yaffs2 file system support

??? int oldopsmode = 0;

??? if(mtd->rw_oob==1)???
??? {
??????? int i = 0;
??????? int datapages = 0;

??????? size_t oobsize = mtd->oobsize;
??????? size_t datasize = mtd->writesize;

??????? uint8_t oobtemp[oobsize];
??????? datapages = len / (datasize);

??????? for(i = 0; i < (datapages); i++)???
??????? {
??????????? memcpy((void *)oobtemp, (void *)(buf + datasize * (i + 1)), oobsize);
??????????? memmove((void *)(buf + datasize * (i + 1)), (void *)(buf + datasize * (i + 1) + oobsize), (datapages - (i + 1)) * (datasize) + (datapages - 1) * oobsize);
??????????? memcpy((void *)(buf+(datapages) * (datasize + oobsize) - oobsize), (void *)(oobtemp), oobsize);
??????? }
??? }
#endif

?

??? /* Do not allow reads past end of device */
??? if ((to + len) > mtd->size)
??????? return -EINVAL;
??? if (!len)
??????? return 0;

??? nand_get_device(chip, mtd, FL_WRITING);

??? chip->ops.len = len;
??? chip->ops.datbuf = (uint8_t *)buf;

?

#if defined(CONFIG_MTD_NAND_YAFFS2) //add yaffs2 file system support

??? if(mtd->rw_oob!=1)???
??? {
??????? chip->ops.oobbuf = NULL;
??? }
??? else???
??? {
??????? chip->ops.oobbuf = (uint8_t *)(buf + len);
??????? chip->ops.ooblen = mtd->oobsize;
??????? oldopsmode = chip->ops.mode;
??????? chip->ops.mode = MTD_OOB_RAW;
??? }
#else
??? chip->ops.oobbuf = NULL;
#endif

?

??? ret = nand_do_write_ops(mtd, to, &chip->ops);

??? *retlen = chip->ops.retlen;

??? nand_release_device(mtd);

?

#if defined(CONFIG_MTD_NAND_YAFFS2) //add yaffs2 file system support

??? chip->ops.mode = oldopsmode;
#endif

?

??? return ret;
}