int nandemul2k_ReadChunkWithTagsFromNAND(struct yaffs_dev *dev,int nand_chunk, u8 *data, struct yaffs_ext_tags *tags) { int blk; int pg; u8 *x; blk = nand_chunk/PAGES_PER_BLOCK; pg = nand_chunk%PAGES_PER_BLOCK; if(data) { memcpy(data,ned.block[blk]->page[pg]->data,PAGE_DATA_SIZE); } if(tags) { x = &ned.block[blk]->page[pg]->data[PAGE_DATA_SIZE]; yaffs_unpack_tags2(tags,(struct yaffs_packed_tags2 *)x, !dev->param.no_tags_ecc); } return YAFFS_OK; }
int nandmtd2_read_chunk_tags(struct yaffs_dev *dev, int nand_chunk, u8 *data, struct yaffs_ext_tags *tags) { struct mtd_info *mtd = yaffs_dev_to_mtd(dev); #if (MTD_VERSION_CODE > MTD_VERSION(2, 6, 17)) struct mtd_oob_ops ops; #endif size_t dummy; int retval = 0; int local_data = 0; loff_t addr = ((loff_t) nand_chunk) * dev->param.total_bytes_per_chunk; struct yaffs_packed_tags2 pt; int packed_tags_size = dev->param.no_tags_ecc ? sizeof(pt.t) : sizeof(pt); void *packed_tags_ptr = dev->param.no_tags_ecc ? (void *)&pt.t : (void *)&pt; yaffs_trace(YAFFS_TRACE_MTD, "nandmtd2_read_chunk_tags chunk %d data %p tags %p", nand_chunk, data, tags); if (dev->param.inband_tags) { if (!data) { local_data = 1; data = yaffs_get_temp_buffer(dev); } } #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 17)) if (dev->param.inband_tags || (data && !tags)) retval = mtd->read(mtd, addr, dev->param.total_bytes_per_chunk, &dummy, data); else if (tags) { ops.mode = MTD_OPS_AUTO_OOB; ops.ooblen = packed_tags_size; ops.len = data ? dev->data_bytes_per_chunk : packed_tags_size; ops.ooboffs = 0; ops.datbuf = data; ops.oobbuf = yaffs_dev_to_lc(dev)->spare_buffer; retval = mtd->read_oob(mtd, addr, &ops); } #else if (!dev->param.inband_tags && data && tags) { retval = mtd->read_ecc(mtd, addr, dev->data_bytes_per_chunk, &dummy, data, dev->spare_buffer, NULL); } else { if (data) retval = mtd->read(mtd, addr, dev->data_bytes_per_chunk, &dummy, data); if (!dev->param.inband_tags && tags) retval = mtd->read_oob(mtd, addr, mtd->oobsize, &dummy, dev->spare_buffer); } #endif if (dev->param.inband_tags) { if (tags) { struct yaffs_packed_tags2_tags_only *pt2tp; pt2tp = (struct yaffs_packed_tags2_tags_only *) &data[dev->data_bytes_per_chunk]; yaffs_unpack_tags2_tags_only(tags, pt2tp); } } else { if (tags) { memcpy(packed_tags_ptr, yaffs_dev_to_lc(dev)->spare_buffer, packed_tags_size); yaffs_unpack_tags2(tags, &pt, !dev->param.no_tags_ecc); } } if (local_data) yaffs_release_temp_buffer(dev, data); if (tags && retval == -EBADMSG && tags->ecc_result == YAFFS_ECC_RESULT_NO_ERROR) { tags->ecc_result = YAFFS_ECC_RESULT_UNFIXED; dev->n_ecc_unfixed++; } if (tags && retval == -EUCLEAN && tags->ecc_result == YAFFS_ECC_RESULT_NO_ERROR) { tags->ecc_result = YAFFS_ECC_RESULT_FIXED; dev->n_ecc_fixed++; } if (retval == 0) return YAFFS_OK; else return YAFFS_FAIL; }
int main(void){ int fd; char *data; char *chunk; unsigned int total_size = 0; unsigned int total_chunks = 0; enum yaffs_ecc_result tags_ecc_result = 0; enum yaffs_ecc_result data_ecc_result = 0; struct yaffs_packed_tags2 *pt = NULL; struct yaffs_ext_tags t; //extra flags. распаковывается ф-ей yaffs_unpack_tags2_tags_only из pt ! unsigned int offset = 0; unsigned int addr; int a; int size; int chunkInNAND; char *x; printf("pt size = %lu\n", sizeof(*pt)); //!!! конвертация в big endian !!! ЭТО ОЧЕНЬВАЖНЫЙ ФЛАГ !!! без него будет полный бред для big endian образов! to_big_endian = 1; data = malloc(32 * 1024 * 1024); if(!data){ printf("Can't malloc memory!\n"); exit(-1); } //fd = open("/home/prog/openwrt/work/rb941-2nd-mtd-dump/mtdblock2.bin", O_RDONLY); // fd = open("./kernel_nand.bin", O_RDONLY); fd = open("./qqq-nand2.bin", O_RDONLY); if(fd < 0){ printf("Can't open file!\n"); exit(-1); } chunk = data; while((size = read(fd, chunk, total_bytes_per_chunk)) > 0){ total_size += size; chunk += size; } close(fd); //рассчет будет меньше если чанки не полностью заполняют все блоки! то есть если последний блок обрезан! total_chunks = total_size / sectorsize * chunks_per_block; if(total_chunks == 0 & total_size > 0) total_chunks = 1; //total_chunks = total_size / NAND_PAGE_SIZE(total_bytes_per_chunk); printf("I read %d bytes from data file! total_chunks = %d\n", total_size, total_chunks); //данные загрузили. работаем. // total_chunks = 7874; // total_chunks = 189; for(chunkInNAND = 0; chunkInNAND < total_chunks; chunkInNAND++){ // for(chunkInNAND = 0; chunkInNAND < 2; chunkInNAND++){ //chunkInNAND = 202; addr = chunkToAddr(chunkInNAND); chunk = data + addr; pt = (void*)(chunk + total_bytes_per_chunk + noob.oobfree[0].offset); x = (void*)(&pt->t); //x = chunk; //printf("%lu -->\n", x - data); //преобразуем в наш endian но только блок tagsecc! без блока tags! pt_endianes_fix(pt, 2); memset(&t, 0x0, sizeof(t)); yaffs_unpack_tags2(&t, pt, 1); //узнаем ecc result до преобразования tags в наш endians! так как он считается побайтово! tags_ecc_result = t.ecc_result; //теперь преобразуем tags в наш endian pt_endianes_fix(pt, 1); //распакуем. распаковка нужна так как могут быть дополнительные(extra) tags! запакованные в месте с нашими 4-мя полями(seq_number, ...)! memset(&t, 0x0, sizeof(t)); yaffs_unpack_tags2(&t, pt, 1); //считаем ecc для данных. для tags его уже посчитала ф-я yaffs_unpack_tags2. data_ecc_result = check_ecc_data(chunk, total_bytes_per_chunk); #ifdef ECC_ALGO_DEBUG dump_ecc_data(pt); #endif printf("%u, %u: seq_num = %u, obj_id = %u, chunk_id = %u, n_bytes = %u, extra_avail = %u, tecc_res = %s, decc_res = %s\n", chunkInNAND, addr, t.seq_number, t.obj_id, t.chunk_id, t.n_bytes, t.extra_available, ecc_result2str(tags_ecc_result), ecc_result2str(data_ecc_result)); if(t.extra_available){ print_extra(&t); } //printf("0x%x: ", addr); for(a = 0; a < 16; a++){ printf("%3x", x[a] & 0xFF); } printf("\n"); } end: free(data); return 0; }
int yflash2_ReadChunkWithTagsFromNAND(struct yaffs_dev *dev,int nand_chunk, u8 *data, struct yaffs_ext_tags *tags) { int nread; int pos; int h; int localData = 0; int retval = YAFFS_OK; int nRead; yaffs_trace(YAFFS_TRACE_MTD,"read chunk %d data %p tags %p",nand_chunk, data, tags); CheckInit(); if(dev->param.inband_tags){ /* Got to suck the tags out of the data area */ if(!data) { localData=1; data = yaffs_get_temp_buffer(dev); } struct yaffs_packed_tags2_tags_only * pt2tp; pt2tp = (struct yaffs_packed_tags2_tags_only *)&data[dev->data_bytes_per_chunk]; pos = (nand_chunk % (PAGES_PER_BLOCK * BLOCKS_PER_HANDLE)) * PAGE_SIZE; h = filedisk.handle[(nand_chunk / (PAGES_PER_BLOCK * BLOCKS_PER_HANDLE))]; lseek(h,pos,SEEK_SET); nRead = read(h, data,dev->param.total_bytes_per_chunk); yaffs_unpack_tags2_tags_only(tags,pt2tp); if(nread != dev->param.total_bytes_per_chunk) retval = YAFFS_FAIL; if(localData) yaffs_release_temp_buffer(dev, data); } else { if(data) { pos = (nand_chunk % (PAGES_PER_BLOCK * BLOCKS_PER_HANDLE)) * PAGE_SIZE; h = filedisk.handle[(nand_chunk / (PAGES_PER_BLOCK * BLOCKS_PER_HANDLE))]; lseek(h,pos,SEEK_SET); nread = read(h,data,dev->data_bytes_per_chunk); if(nread != dev->data_bytes_per_chunk) retval = YAFFS_FAIL; } if(tags) { pos = (nand_chunk % (PAGES_PER_BLOCK * BLOCKS_PER_HANDLE)) * PAGE_SIZE + PAGE_DATA_SIZE; h = filedisk.handle[(nand_chunk / (PAGES_PER_BLOCK * BLOCKS_PER_HANDLE))]; lseek(h,pos,SEEK_SET); if(0 && dev->param.is_yaffs2) { nread= read(h,tags,sizeof(struct yaffs_ext_tags)); if(nread != sizeof(struct yaffs_ext_tags)) retval = YAFFS_FAIL; if(yaffs_check_all_ff((u8 *)tags, sizeof(struct yaffs_ext_tags))) memset(tags, 0, sizeof(struct yaffs_ext_tags)); else tags->chunk_used = 1; } else { struct yaffs_packed_tags2 pt; nread= read(h,&pt,sizeof(pt)); yaffs_unpack_tags2(tags,&pt, !dev->param.no_tags_ecc); #ifdef SIMULATE_FAILURES if((nand_chunk >> 6) == 100) { if(fail300 && tags->ecc_result == YAFFS_ECC_RESULT_NO_ERROR){ tags->ecc_result = YAFFS_ECC_RESULT_FIXED; fail300 = 0; } } if((nand_chunk >> 6) == 110) { if(fail320 && tags->ecc_result == YAFFS_ECC_RESULT_NO_ERROR){ tags->ecc_result = YAFFS_ECC_RESULT_FIXED; fail320 = 0; } } #endif if(failRead10>0 && nand_chunk == 10){ failRead10--; nread = 0; } if(nread != sizeof(pt)) retval = YAFFS_FAIL; } } } return retval; }
static int yaffs_tags_marshall_read(struct yaffs_dev *dev, int nand_chunk, u8 *data, struct yaffs_ext_tags *tags) { //int retval = 0; int local_data = 0; u8 spare_buffer[100]; enum yaffs_ecc_result ecc_result; struct yaffs_packed_tags2 pt; int packed_tags_size = dev->param.no_tags_ecc ? sizeof(pt.t) : sizeof(pt); void *packed_tags_ptr = dev->param.no_tags_ecc ? (void *)&pt.t : (void *)&pt; yaffs_trace(YAFFS_TRACE_MTD, "yaffs_tags_marshall_read chunk %d data %p tags %p", nand_chunk, data, tags); if (dev->param.inband_tags) { if (!data) { local_data = 1; data = yaffs_get_temp_buffer(dev); } } if (dev->param.inband_tags || (data && !tags)) dev->drv.drv_read_chunk_fn(dev, nand_chunk, data, dev->param.total_bytes_per_chunk, NULL, 0, &ecc_result); //TODO check retval else if (tags) dev->drv.drv_read_chunk_fn(dev, nand_chunk, data, dev->param.total_bytes_per_chunk, spare_buffer, packed_tags_size, &ecc_result); //TODO check retval else BUG(); if (dev->param.inband_tags) { if (tags) { struct yaffs_packed_tags2_tags_only *pt2tp; pt2tp = (struct yaffs_packed_tags2_tags_only *) &data[dev->data_bytes_per_chunk]; yaffs_unpack_tags2_tags_only(tags, pt2tp); } } else if (tags) { memcpy(packed_tags_ptr, spare_buffer, packed_tags_size); yaffs_unpack_tags2(tags, &pt, !dev->param.no_tags_ecc); } if (local_data) yaffs_release_temp_buffer(dev, data); if (tags && ecc_result == YAFFS_ECC_RESULT_UNFIXED) { tags->ecc_result = YAFFS_ECC_RESULT_UNFIXED; dev->n_ecc_unfixed++; } if (tags && ecc_result == YAFFS_ECC_RESULT_FIXED) { if (tags->ecc_result <= YAFFS_ECC_RESULT_NO_ERROR) tags->ecc_result = YAFFS_ECC_RESULT_FIXED; dev->n_ecc_fixed++; } if (ecc_result < YAFFS_ECC_RESULT_UNFIXED) return YAFFS_OK; else return YAFFS_FAIL; }
int nandmtd2_read_chunk_tags(struct yaffs_dev *dev, int nand_chunk, u8 * data, struct yaffs_ext_tags *tags) { struct mtd_info *mtd = yaffs_dev_to_mtd(dev); struct mtd_oob_ops ops; size_t dummy; int retval = 0; int local_data = 0; loff_t addr = ((loff_t) nand_chunk) * dev->param.total_bytes_per_chunk; struct yaffs_packed_tags2 pt; int packed_tags_size = dev->param.no_tags_ecc ? sizeof(pt.t) : sizeof(pt); void *packed_tags_ptr = dev->param.no_tags_ecc ? (void *)&pt.t : (void *)&pt; yaffs_trace(YAFFS_TRACE_MTD, "nandmtd2_read_chunk_tags chunk %d data %p tags %p", nand_chunk, data, tags); if (dev->param.inband_tags) { if (!data) { local_data = 1; data = yaffs_get_temp_buffer(dev, __LINE__); } } if (dev->param.inband_tags || (data && !tags)) retval = mtd_read(mtd, addr, dev->param.total_bytes_per_chunk, &dummy, data); else if (tags) { #if 1 if(!data ) { local_data = 1; data = yaffs_get_temp_buffer(dev, __LINE__); } ops.mode = MTD_OPS_AUTO_OOB; ops.ooblen = packed_tags_size; ops.ooboffs = 0; ops.len = dev->data_bytes_per_chunk; ops.datbuf = data; ops.oobbuf = yaffs_dev_to_lc(dev)->spare_buffer; retval = mtd_read_oob(mtd, addr, &ops); if(retval) { printk(KERN_ERR"yaffsdebug mtdiferror %s retval:%d unfixed:%d fixed:%d chunk:%d addr:0x%llx\n",\ (retval == -EUCLEAN)?"fix ecc":"unfix ecc",retval,dev->n_ecc_unfixed,dev->n_ecc_fixed,nand_chunk,addr); #ifdef YAFFS_MVG_TEST_DEBUG_LOG if(retval != -EUCLEAN) { printk(KERN_ERR"dump checksum_BCH chunk:%d addr:0x%x\n",nand_chunk,addr); mtk_dump_byte(ops.datbuf,ops.len,0); printk(KERN_ERR"dump BCH oob\n"); mtk_dump_byte(ops.oobbuf,ops.ooblen,0); } #endif } #else ops.mode = MTD_OOB_AUTO; ops.ooblen = packed_tags_size; ops.len = data ? dev->data_bytes_per_chunk : packed_tags_size; ops.ooboffs = 0; ops.datbuf = data; ops.oobbuf = yaffs_dev_to_lc(dev)->spare_buffer; retval = mtd->read_oob(mtd, addr, &ops); #endif } if (dev->param.inband_tags) { if (tags) { struct yaffs_packed_tags2_tags_only *pt2tp; pt2tp = (struct yaffs_packed_tags2_tags_only *)&data[dev-> data_bytes_per_chunk]; yaffs_unpack_tags2_tags_only(tags, pt2tp); } } else { if (tags) { memcpy(packed_tags_ptr, yaffs_dev_to_lc(dev)->spare_buffer, packed_tags_size); yaffs_unpack_tags2(tags, &pt, !dev->param.no_tags_ecc); } } if (local_data) yaffs_release_temp_buffer(dev, data, __LINE__); if (tags && retval == -EBADMSG && tags->ecc_result == YAFFS_ECC_RESULT_NO_ERROR) { tags->ecc_result = YAFFS_ECC_RESULT_UNFIXED; dev->n_ecc_unfixed++; } if (tags && retval == -EUCLEAN && tags->ecc_result == YAFFS_ECC_RESULT_NO_ERROR) { tags->ecc_result = YAFFS_ECC_RESULT_FIXED; dev->n_ecc_fixed++; } if (retval == 0) return YAFFS_OK; else return YAFFS_FAIL; }
int ynandif_ReadChunkWithTagsFromNAND(struct yaffs_dev *dev, int nand_chunk, u8 *data, struct yaffs_ext_tags *tags) { struct yaffs_packed_tags2 pt; int localData = 0; void *spare = NULL; unsigned spareSize; int retval = 0; int eccStatus; /* 0 = ok, 1 = fixed, -1 = unfixed */ struct ynandif_Geometry *geometry = (struct ynandif_Geometry *)(dev->driver_context); yaffs_trace(YAFFS_TRACE_MTD, "nandmtd2_ReadChunkWithTagsFromNAND chunk %d data %p tags %p", nand_chunk, data, tags); if (!tags) { spare = NULL; spareSize = 0; } else if (dev->param.inband_tags) { if (!data) { localData = 1; data = yaffs_get_temp_buffer(dev); } spare = NULL; spareSize = 0; } else { spare = &pt; spareSize = sizeof(struct yaffs_packed_tags2); } retval = geometry->readChunk(dev, nand_chunk, data, data ? dev->param.total_bytes_per_chunk : 0, spare, spareSize, &eccStatus); if (dev->param.inband_tags) { if (tags) { struct yaffs_packed_tags2_tags_only *pt2tp; pt2tp = (struct yaffs_packed_tags2_tags_only *) &data[dev->data_bytes_per_chunk]; yaffs_unpack_tags2_tags_only(tags, pt2tp); } } else { if (tags) yaffs_unpack_tags2(tags, &pt, !dev->param.no_tags_ecc); } if (tags && tags->chunk_used) { if (eccStatus < 0 || tags->ecc_result == YAFFS_ECC_RESULT_UNFIXED) tags->ecc_result = YAFFS_ECC_RESULT_UNFIXED; else if (eccStatus > 0 || tags->ecc_result == YAFFS_ECC_RESULT_FIXED) tags->ecc_result = YAFFS_ECC_RESULT_FIXED; else tags->ecc_result = YAFFS_ECC_RESULT_NO_ERROR; } if (localData) yaffs_release_temp_buffer(dev, data); return retval; }