--- /dev/null
+/*
+ * Copyright (C) 2006-2008 Nokia Corporation
+ * Copyright (C) 2015 sigma star gmbh
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License along with
+ * this program; see the file COPYING. If not, write to the Free Software
+ * Foundation, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
+ *
+ * Check MTD device read.
+ *
+ * Author: David Oberhollenzer <david.oberhollenzer@sigma-star.at>
+ *
+ * Based on linux readtest.c
+ * Author: Adrian Hunter <ext-adrian.hunter@nokia.com>
+ */
+#define PROGRAM_NAME "flash_readtest"
+
+#include <mtd/mtd-user.h>
+#include <sys/ioctl.h>
+#include <unistd.h>
+#include <string.h>
+#include <stdlib.h>
+#include <libmtd.h>
+#include <getopt.h>
+#include <stdio.h>
+#include <fcntl.h>
+#include <time.h>
+
+#include "common.h"
+
+#define FLAG_VERBOSE 1
+
+static int peb=-1, skip=-1, count=-1, flags=0, pgcnt, pgsize, fd;
+static unsigned char *iobuf, *iobuf1;
+static struct mtd_dev_info mtd;
+static const char *mtddev;
+static libmtd_t mtd_desc;
+
+static const struct option options[] = {
+ { "help", no_argument, NULL, 'h' },
+ { "verbose", no_argument, NULL, 'v' },
+ { "peb", required_argument, NULL, 'b' },
+ { "count", required_argument, NULL, 'c' },
+ { "skip", required_argument, NULL, 's' },
+ { NULL, 0, NULL, 0 },
+};
+
+static void usage(int status)
+{
+ fputs(
+ "Usage: "PROGRAM_NAME" [OPTIONS] <device>\n\n"
+ "Common options:\n"
+ " -h, --help Display this help output\n"
+ " -b, --peb <num> Start from this physical erase block\n"
+ " -c, --count <num> Number of erase blocks to process (default: all)\n"
+ " -s, --skip <num> Number of blocks to skip\n"
+ " -v, --verbose Generate more verbose output\n\n",
+ status==EXIT_SUCCESS ? stdout : stderr);
+ exit(status);
+}
+
+static long read_num(int opt, const char *arg)
+{
+ char *end;
+ long num;
+
+ num = strtol(arg, &end, 0);
+
+ if (!end || *end != '\0') {
+ fprintf(stderr, "-%c: expected integer argument\n", opt);
+ exit(EXIT_FAILURE);
+ }
+ return num;
+}
+
+static void process_options(int argc, char **argv)
+{
+ int c;
+
+ while (1) {
+ c = getopt_long(argc, argv, "hb:c:s:v", options, NULL);
+ if (c == -1)
+ break;
+
+ switch (c) {
+ case 'v':
+ if (flags & FLAG_VERBOSE)
+ goto failmulti;
+ flags |= FLAG_VERBOSE;
+ break;
+ case 'b':
+ if (peb >= 0)
+ goto failmulti;
+ peb = read_num(c, optarg);
+ if (peb < 0)
+ goto failarg;
+ break;
+ case 'c':
+ if (count >= 0)
+ goto failmulti;
+ count = read_num(c, optarg);
+ if (count < 0)
+ goto failarg;
+ break;
+ case 's':
+ if (skip >= 0)
+ goto failmulti;
+ skip = read_num(c, optarg);
+ if (skip < 0)
+ goto failarg;
+ break;
+ case 'h':
+ usage(EXIT_SUCCESS);
+ default:
+ exit(EXIT_FAILURE);
+ }
+ }
+
+ if (optind < argc)
+ mtddev = argv[optind++];
+ else
+ errmsg_die("No device specified!\n");
+
+ if (optind < argc)
+ usage(EXIT_FAILURE);
+ if (peb < 0)
+ peb = 0;
+ if (skip < 0)
+ skip = 0;
+ return;
+failmulti:
+ errmsg_die("'-%c' specified more than once!", c);
+failarg:
+ errmsg_die("Invalid argument for '-%c'!", c);
+}
+
+static int read_eraseblock_by_page(int ebnum)
+{
+ unsigned char *buf = iobuf, *oobbuf = iobuf1;
+ uint64_t addr = ((uint64_t)ebnum) * ((uint64_t)mtd.eb_size);
+ int i, ret;
+
+ for (i = 0; i < pgcnt; ++i) {
+ memset(buf, 0, pgsize);
+ ret = mtd_read(&mtd, fd, ebnum, i*pgsize, buf, pgsize);
+ if (ret) {
+ fprintf(stderr, "Error reading block %d, page %d\n", ebnum, i);
+ return -1;
+ }
+ if (mtd.oob_size) {
+ ret = mtd_read_oob(mtd_desc, &mtd, fd,
+ addr, mtd.oob_size, oobbuf);
+
+ if (ret) {
+ fprintf(stderr, "Error reading OOB in block %d, page %d\n",
+ ebnum, i);
+ return -1;
+ }
+ oobbuf += mtd.oob_size;
+ }
+ buf += pgsize;
+ addr += pgsize;
+ }
+
+ if (flags & FLAG_VERBOSE)
+ printf("Successfully read erase block %d\n", ebnum);
+
+ return 0;
+}
+
+static void dump_eraseblock(int ebnum)
+{
+ char line[128];
+ int i, j, n;
+ int pg, oob;
+
+ printf("dumping eraseblock %d\n", ebnum);
+ n = mtd.eb_size;
+ for (i = 0; i < n;) {
+ char *p = line;
+
+ p += sprintf(p, "%05x: ", i);
+ for (j = 0; j < 32 && i < n; j++, i++)
+ p += sprintf(p, "%02x", (unsigned int)iobuf[i]);
+ printf("%s\n", line);
+ }
+ if (!mtd.oob_size)
+ return;
+ printf("dumping oob from eraseblock %d\n", ebnum);
+ n = mtd.oob_size;
+ for (pg = 0, i = 0; pg < pgcnt; ++pg) {
+ for (oob = 0; oob < n;) {
+ char *p = line;
+
+ p += sprintf(p, "%05x: ", i);
+ for (j = 0; j < 32 && oob < n; ++j, ++oob, ++i)
+ p += sprintf(p, "%02x", (unsigned int)iobuf1[i]);
+ printf("%s\n", line);
+ }
+ }
+ putchar('\n');
+}
+
+int main(int argc, char **argv)
+{
+ int status = EXIT_SUCCESS, i, ret, blk;
+
+ process_options(argc, argv);
+
+ mtd_desc = libmtd_open();
+ if (!mtd_desc)
+ return errmsg("can't initialize libmtd");
+
+ if (mtd_get_dev_info(mtd_desc, mtddev, &mtd) < 0)
+ return errmsg("mtd_get_dev_info failed");
+
+ if (mtd.subpage_size == 1) {
+ puts("not NAND flash, assume page size is 512 bytes.");
+ pgsize = 512;
+ } else {
+ pgsize = mtd.subpage_size;
+ }
+
+ pgcnt = mtd.eb_size / pgsize;
+
+ if (count < 0)
+ count = mtd.eb_cnt;
+
+ if (peb >= mtd.eb_cnt)
+ return errmsg("Physical erase block %d is out of range!\n", peb);
+
+ if ((peb + (count - 1)*(skip + 1)) >= mtd.eb_cnt) {
+ return errmsg("Given block range exceeds block count of %d!\n",
+ mtd.eb_cnt);
+ }
+
+ iobuf = xmalloc(mtd.eb_size);
+ iobuf1 = xmalloc(mtd.eb_size);
+
+ if ((fd = open(mtddev, O_RDWR)) == -1) {
+ perror(mtddev);
+ status = EXIT_FAILURE;
+ goto out;
+ }
+
+ /* Read all eraseblocks 1 page at a time */
+ puts("testing page read");
+
+ for (i = 0; i < count; ++i) {
+ blk = peb + i*(skip+1);
+
+ if (mtd_is_bad(&mtd, fd, blk)) {
+ printf("Skipping bad block %d\n", blk);
+ continue;
+ }
+ ret = read_eraseblock_by_page(blk);
+ if (ret && (flags & FLAG_VERBOSE)) {
+ dump_eraseblock(blk);
+ status = EXIT_FAILURE;
+ }
+ }
+out:
+ free(iobuf);
+ free(iobuf1);
+ return status;
+}
projects / mtd-utils.git / commitdiff