Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 1 | #include <stdio.h> |
| 2 | #include <stdlib.h> |
| 3 | #include <string.h> |
| 4 | #include <ctype.h> |
| 5 | #include <errno.h> |
| 6 | #include <fcntl.h> |
Olivier Bailly | b93e581 | 2010-11-17 11:47:23 -0800 | [diff] [blame] | 7 | #include <unistd.h> |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 8 | |
| 9 | #include <mtd/mtd-user.h> |
| 10 | #include <sys/ioctl.h> |
| 11 | |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 12 | static int test_empty(const char *buf, size_t size) |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 13 | { |
| 14 | while(size--) { |
Elliott Hughes | b05a2e5 | 2013-11-11 16:17:49 -0800 | [diff] [blame] | 15 | if (*buf++ != (char) 0xff) |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 16 | return 0; |
| 17 | } |
| 18 | return 1; |
| 19 | } |
| 20 | |
| 21 | int nandread_main(int argc, char **argv) |
| 22 | { |
| 23 | char *devname = NULL; |
| 24 | char *filename = NULL; |
| 25 | char *statusfilename = NULL; |
| 26 | char *statusext = ".stat"; |
| 27 | int fd; |
| 28 | int outfd = -1; |
| 29 | FILE *statusfile = NULL; |
| 30 | int ret; |
| 31 | int verbose = 0; |
| 32 | void *buffer; |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 33 | loff_t pos, opos, end, bpos; |
| 34 | loff_t start = 0, len = 0; |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 35 | int c; |
| 36 | int i; |
| 37 | int empty_pages = 0; |
| 38 | int page_count = 0; |
| 39 | int bad_block; |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 40 | int rawmode = 0; |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 41 | uint32_t *oob_data; |
| 42 | uint8_t *oob_fixed; |
| 43 | size_t spare_size = 64; |
| 44 | struct mtd_info_user mtdinfo; |
| 45 | struct mtd_ecc_stats initial_ecc, last_ecc, ecc; |
| 46 | struct mtd_oob_buf oobbuf; |
Elliott Hughes | b05a2e5 | 2013-11-11 16:17:49 -0800 | [diff] [blame] | 47 | nand_ecclayout_t ecclayout; |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 48 | |
| 49 | do { |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 50 | c = getopt(argc, argv, "d:f:s:S:L:Rhv"); |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 51 | if (c == EOF) |
| 52 | break; |
| 53 | switch (c) { |
| 54 | case 'd': |
| 55 | devname = optarg; |
| 56 | break; |
| 57 | case 'f': |
| 58 | filename = optarg; |
| 59 | break; |
| 60 | case 's': |
| 61 | spare_size = atoi(optarg); |
| 62 | break; |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 63 | case 'S': |
| 64 | start = strtoll(optarg, NULL, 0); |
| 65 | break; |
| 66 | case 'L': |
| 67 | len = strtoll(optarg, NULL, 0); |
| 68 | break; |
| 69 | case 'R': |
| 70 | rawmode = 1; |
| 71 | break; |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 72 | case 'v': |
| 73 | verbose++; |
| 74 | break; |
| 75 | case 'h': |
| 76 | fprintf(stderr, "%s [-d <dev>] [-f file] [-s sparesize] [-vh]\n" |
| 77 | " -d <dev> Read from <dev>\n" |
| 78 | " -f <file> Write to <file>\n" |
| 79 | " -s <size> Number of spare bytes in file (default 64)\n" |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 80 | " -R Raw mode\n" |
| 81 | " -S <start> Start offset (default 0)\n" |
| 82 | " -L <len> Length (default 0)\n" |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 83 | " -v Print info\n" |
| 84 | " -h Print help\n", argv[0]); |
| 85 | return -1; |
| 86 | case '?': |
| 87 | fprintf(stderr, "%s: invalid option -%c\n", |
| 88 | argv[0], optopt); |
| 89 | exit(1); |
| 90 | } |
| 91 | } while (1); |
| 92 | |
| 93 | if (optind < argc) { |
| 94 | fprintf(stderr, "%s: extra arguments\n", argv[0]); |
| 95 | return 1; |
| 96 | } |
| 97 | if (!devname) { |
| 98 | fprintf(stderr, "%s: specify device name\n", argv[0]); |
| 99 | return 1; |
| 100 | } |
| 101 | |
| 102 | fd = open(devname, O_RDONLY); |
| 103 | if (fd < 0) { |
| 104 | fprintf(stderr, "cannot open %s, %s\n", devname, strerror(errno)); |
| 105 | return 1; |
| 106 | } |
| 107 | |
| 108 | if (filename) { |
| 109 | outfd = creat(filename, 0666); |
| 110 | if (outfd < 0) { |
| 111 | fprintf(stderr, "cannot open %s, %s\n", filename, strerror(errno)); |
| 112 | return 1; |
| 113 | } |
| 114 | statusfilename = malloc(strlen(filename) + strlen(statusext) + 1); |
| 115 | strcpy(statusfilename, filename); |
| 116 | strcat(statusfilename, statusext); |
| 117 | statusfile = fopen(statusfilename, "w+"); |
| 118 | if (!statusfile) { |
| 119 | fprintf(stderr, "cannot open %s, %s\n", statusfilename, strerror(errno)); |
| 120 | return 1; |
| 121 | } |
| 122 | } |
| 123 | |
| 124 | ret = ioctl(fd, MEMGETINFO, &mtdinfo); |
| 125 | if (ret) { |
| 126 | fprintf(stderr, "failed get mtd info for %s, %s\n", |
| 127 | devname, strerror(errno)); |
| 128 | return 1; |
| 129 | } |
| 130 | |
| 131 | if (verbose) { |
| 132 | printf("size: %u\n", mtdinfo.size); |
| 133 | printf("erase size: %u\n", mtdinfo.erasesize); |
| 134 | printf("write size: %u\n", mtdinfo.writesize); |
| 135 | printf("oob size: %u\n", mtdinfo.oobsize); |
| 136 | } |
| 137 | |
| 138 | buffer = malloc(mtdinfo.writesize + mtdinfo.oobsize + spare_size); |
| 139 | if (!buffer) { |
| 140 | fprintf(stderr, "failed allocate readbuffer size %u\n", |
| 141 | mtdinfo.writesize + mtdinfo.oobsize); |
| 142 | return 1; |
| 143 | } |
| 144 | |
| 145 | oobbuf.length = mtdinfo.oobsize; |
| 146 | oob_data = (uint32_t *)((uint8_t *)buffer + mtdinfo.writesize); |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 147 | memset(oob_data, 0xff, mtdinfo.oobsize + spare_size); |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 148 | oobbuf.ptr = (uint8_t *)oob_data + spare_size; |
| 149 | |
| 150 | ret = ioctl(fd, ECCGETLAYOUT, &ecclayout); |
| 151 | if (ret) { |
| 152 | fprintf(stderr, "failed get ecc layout for %s, %s\n", |
| 153 | devname, strerror(errno)); |
| 154 | return 1; |
| 155 | } |
| 156 | if (verbose) { |
| 157 | printf("ecc bytes: %u\n", ecclayout.eccbytes); |
| 158 | printf("oobavail: %u\n", ecclayout.oobavail); |
| 159 | } |
| 160 | if (ecclayout.oobavail > spare_size) |
Elliott Hughes | ccecf14 | 2014-01-16 10:53:11 -0800 | [diff] [blame] | 161 | printf("oobavail, %d > image spare size, %zu\n", ecclayout.oobavail, spare_size); |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 162 | |
| 163 | ret = ioctl(fd, ECCGETSTATS, &initial_ecc); |
| 164 | if (ret) { |
| 165 | fprintf(stderr, "failed get ecc stats for %s, %s\n", |
| 166 | devname, strerror(errno)); |
| 167 | return 1; |
| 168 | } |
| 169 | last_ecc = initial_ecc; |
| 170 | |
| 171 | if (verbose) { |
| 172 | printf("initial ecc corrected: %u\n", initial_ecc.corrected); |
| 173 | printf("initial ecc failed: %u\n", initial_ecc.failed); |
| 174 | printf("initial ecc badblocks: %u\n", initial_ecc.badblocks); |
| 175 | printf("initial ecc bbtblocks: %u\n", initial_ecc.bbtblocks); |
| 176 | } |
| 177 | |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 178 | if (rawmode) { |
| 179 | rawmode = mtdinfo.oobsize; |
Elliott Hughes | b05a2e5 | 2013-11-11 16:17:49 -0800 | [diff] [blame] | 180 | ret = ioctl(fd, MTDFILEMODE, MTD_FILE_MODE_RAW); |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 181 | if (ret) { |
| 182 | fprintf(stderr, "failed set raw mode for %s, %s\n", |
| 183 | devname, strerror(errno)); |
| 184 | return 1; |
| 185 | } |
| 186 | } |
| 187 | |
| 188 | end = len ? (start + len) : mtdinfo.size; |
| 189 | for (pos = start, opos = 0; pos < end; pos += mtdinfo.writesize) { |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 190 | bad_block = 0; |
| 191 | if (verbose > 3) |
| 192 | printf("reading at %llx\n", pos); |
| 193 | lseek64(fd, pos, SEEK_SET); |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 194 | ret = read(fd, buffer, mtdinfo.writesize + rawmode); |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 195 | if (ret < (int)mtdinfo.writesize) { |
| 196 | fprintf(stderr, "short read at %llx, %d\n", pos, ret); |
| 197 | bad_block = 2; |
| 198 | } |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 199 | if (!rawmode) { |
| 200 | oobbuf.start = pos; |
| 201 | ret = ioctl(fd, MEMREADOOB, &oobbuf); |
| 202 | if (ret) { |
| 203 | fprintf(stderr, "failed to read oob data at %llx, %d\n", pos, ret); |
| 204 | bad_block = 2; |
| 205 | } |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 206 | } |
| 207 | ret = ioctl(fd, ECCGETSTATS, &ecc); |
| 208 | if (ret) { |
| 209 | fprintf(stderr, "failed get ecc stats for %s, %s\n", |
| 210 | devname, strerror(errno)); |
| 211 | return 1; |
| 212 | } |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 213 | bpos = pos / mtdinfo.erasesize * mtdinfo.erasesize; |
| 214 | ret = ioctl(fd, MEMGETBADBLOCK, &bpos); |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 215 | if (ret && errno != EOPNOTSUPP) { |
| 216 | printf("badblock at %llx\n", pos); |
| 217 | bad_block = 1; |
| 218 | } |
| 219 | if (ecc.corrected != last_ecc.corrected) |
| 220 | printf("ecc corrected, %u, at %llx\n", ecc.corrected - last_ecc.corrected, pos); |
| 221 | if (ecc.failed != last_ecc.failed) |
| 222 | printf("ecc failed, %u, at %llx\n", ecc.failed - last_ecc.failed, pos); |
| 223 | if (ecc.badblocks != last_ecc.badblocks) |
| 224 | printf("ecc badblocks, %u, at %llx\n", ecc.badblocks - last_ecc.badblocks, pos); |
| 225 | if (ecc.bbtblocks != last_ecc.bbtblocks) |
| 226 | printf("ecc bbtblocks, %u, at %llx\n", ecc.bbtblocks - last_ecc.bbtblocks, pos); |
| 227 | |
Arve Hjønnevåg | b6b8793 | 2010-03-03 16:48:38 -0800 | [diff] [blame] | 228 | if (!rawmode) { |
| 229 | oob_fixed = (uint8_t *)oob_data; |
| 230 | for (i = 0; i < MTD_MAX_OOBFREE_ENTRIES; i++) { |
| 231 | int len = ecclayout.oobfree[i].length; |
| 232 | if (oob_fixed + len > oobbuf.ptr) |
| 233 | len = oobbuf.ptr - oob_fixed; |
| 234 | if (len) { |
| 235 | memcpy(oob_fixed, oobbuf.ptr + ecclayout.oobfree[i].offset, len); |
| 236 | oob_fixed += len; |
| 237 | } |
Arve Hjønnevåg | 7c953d0 | 2009-09-17 17:30:55 -0700 | [diff] [blame] | 238 | } |
| 239 | } |
| 240 | |
| 241 | if (outfd >= 0) { |
| 242 | ret = write(outfd, buffer, mtdinfo.writesize + spare_size); |
| 243 | if (ret < (int)(mtdinfo.writesize + spare_size)) { |
| 244 | fprintf(stderr, "short write at %llx, %d\n", pos, ret); |
| 245 | close(outfd); |
| 246 | outfd = -1; |
| 247 | } |
| 248 | if (ecc.corrected != last_ecc.corrected) |
| 249 | fprintf(statusfile, "%08llx: ecc corrected\n", opos); |
| 250 | if (ecc.failed != last_ecc.failed) |
| 251 | fprintf(statusfile, "%08llx: ecc failed\n", opos); |
| 252 | if (bad_block == 1) |
| 253 | fprintf(statusfile, "%08llx: badblock\n", opos); |
| 254 | if (bad_block == 2) |
| 255 | fprintf(statusfile, "%08llx: read error\n", opos); |
| 256 | opos += mtdinfo.writesize + spare_size; |
| 257 | } |
| 258 | |
| 259 | last_ecc = ecc; |
| 260 | page_count++; |
| 261 | if (test_empty(buffer, mtdinfo.writesize + mtdinfo.oobsize + spare_size)) |
| 262 | empty_pages++; |
| 263 | else if (verbose > 2 || (verbose > 1 && !(pos & (mtdinfo.erasesize - 1)))) |
| 264 | printf("page at %llx (%d oobbytes): %08x %08x %08x %08x " |
| 265 | "%08x %08x %08x %08x\n", pos, oobbuf.start, |
| 266 | oob_data[0], oob_data[1], oob_data[2], oob_data[3], |
| 267 | oob_data[4], oob_data[5], oob_data[6], oob_data[7]); |
| 268 | } |
| 269 | |
| 270 | if (outfd >= 0) { |
| 271 | fprintf(statusfile, "read %d pages, %d empty\n", page_count, empty_pages); |
| 272 | fprintf(statusfile, "total ecc corrected, %u\n", ecc.corrected - initial_ecc.corrected); |
| 273 | fprintf(statusfile, "total ecc failed, %u\n", ecc.failed - initial_ecc.failed); |
| 274 | fprintf(statusfile, "total ecc badblocks, %u\n", ecc.badblocks - initial_ecc.badblocks); |
| 275 | fprintf(statusfile, "total ecc bbtblocks, %u\n", ecc.bbtblocks - initial_ecc.bbtblocks); |
| 276 | } |
| 277 | if (verbose) { |
| 278 | printf("total ecc corrected, %u\n", ecc.corrected - initial_ecc.corrected); |
| 279 | printf("total ecc failed, %u\n", ecc.failed - initial_ecc.failed); |
| 280 | printf("total ecc badblocks, %u\n", ecc.badblocks - initial_ecc.badblocks); |
| 281 | printf("total ecc bbtblocks, %u\n", ecc.bbtblocks - initial_ecc.bbtblocks); |
| 282 | } |
| 283 | printf("read %d pages, %d empty\n", page_count, empty_pages); |
| 284 | |
| 285 | return 0; |
| 286 | } |