mtd: fix reading of image magic bytes in smaller chunks
[openwrt.git] / package / system / mtd / src / mtd.c
index ae0d032..dae0514 100644 (file)
@@ -22,6 +22,7 @@
  */
 
 #define _GNU_SOURCE
+#include <byteswap.h>
 #include <limits.h>
 #include <unistd.h>
 #include <stdlib.h>
 #define MAX_ARGS 8
 #define JFFS2_DEFAULT_DIR      "" /* directory name without /, empty means root dir */
 
+#define TRX_MAGIC              0x48445230      /* "HDR0" */
+#define SEAMA_MAGIC            0x5ea3a417
+
+#if !defined(__BYTE_ORDER)
+#error "Unknown byte order"
+#endif
+
+#if __BYTE_ORDER == __BIG_ENDIAN
+#define cpu_to_be32(x) (x)
+#define be32_to_cpu(x) (x)
+#elif __BYTE_ORDER == __LITTLE_ENDIAN
+#define cpu_to_be32(x) bswap_32(x)
+#define be32_to_cpu(x) bswap_32(x)
+#else
+#error "Unsupported endianness"
+#endif
+
+enum mtd_image_format {
+       MTD_IMAGE_FORMAT_UNKNOWN,
+       MTD_IMAGE_FORMAT_TRX,
+       MTD_IMAGE_FORMAT_SEAMA,
+};
+
 static char *buf = NULL;
 static char *imagefile = NULL;
+static enum mtd_image_format imageformat = MTD_IMAGE_FORMAT_UNKNOWN;
 static char *jffs2file = NULL, *jffs2dir = JFFS2_DEFAULT_DIR;
 static int buflen = 0;
 int quiet;
@@ -149,13 +174,46 @@ int mtd_write_buffer(int fd, const char *buf, int offset, int length)
        return 0;
 }
 
-
 static int
 image_check(int imagefd, const char *mtd)
 {
+       uint32_t magic;
        int ret = 1;
-       if (trx_check) {
-         ret = trx_check(imagefd, mtd, buf, &buflen);
+       int bufread;
+
+       while (buflen < sizeof(magic)) {
+               bufread = read(imagefd, buf + buflen, sizeof(magic) - buflen);
+               if (bufread < 1)
+                       break;
+
+               buflen += bufread;
+       }
+
+       if (buflen < sizeof(magic)) {
+               fprintf(stdout, "Could not get image magic\n");
+               return 0;
+       }
+
+       magic = ((uint32_t *)buf)[0];
+
+       if (be32_to_cpu(magic) == TRX_MAGIC)
+               imageformat = MTD_IMAGE_FORMAT_TRX;
+       else if (be32_to_cpu(magic) == SEAMA_MAGIC)
+               imageformat = MTD_IMAGE_FORMAT_SEAMA;
+
+       switch (imageformat) {
+       case MTD_IMAGE_FORMAT_TRX:
+               if (trx_check)
+                       ret = trx_check(imagefd, mtd, buf, &buflen);
+               break;
+       case MTD_IMAGE_FORMAT_SEAMA:
+               break;
+       default:
+#ifdef target_brcm
+               if (!strcmp(mtd, "firmware"))
+                       ret = 0;
+#endif
+               break;
        }
 
        return ret;
@@ -274,6 +332,58 @@ mtd_erase(const char *mtd)
 }
 
 static int
+mtd_dump(const char *mtd, int part_offset, int size)
+{
+       int ret = 0, offset = 0;
+       int fd;
+       char *buf;
+
+       if (quiet < 2)
+               fprintf(stderr, "Dumping %s ...\n", mtd);
+
+       fd = mtd_check_open(mtd);
+       if(fd < 0) {
+               fprintf(stderr, "Could not open mtd device: %s\n", mtd);
+               return -1;
+       }
+
+       if (!size)
+               size = mtdsize;
+
+       if (part_offset)
+               lseek(fd, part_offset, SEEK_SET);
+
+       buf = malloc(erasesize);
+       if (!buf)
+               return -1;
+
+       do {
+               int len = (size > erasesize) ? (erasesize) : (size);
+               int rlen = read(fd, buf, len);
+
+               if (rlen < 0) {
+                       if (errno == EINTR)
+                               continue;
+                       ret = -1;
+                       goto out;
+               }
+               if (!rlen || rlen != len)
+                       break;
+               if (mtd_block_is_bad(fd, offset)) {
+                       fprintf(stderr, "skipping bad block at 0x%08x\n", offset);
+               } else {
+                       size -= rlen;
+                       write(1, buf, rlen);
+               }
+               offset += rlen;
+       } while (size > 0);
+
+out:
+       close(fd);
+       return ret;
+}
+
+static int
 mtd_verify(const char *mtd, char *file)
 {
        uint32_t f_md5[4], m_md5[4];
@@ -285,7 +395,7 @@ mtd_verify(const char *mtd, char *file)
        if (quiet < 2)
                fprintf(stderr, "Verifying %s against %s ...\n", mtd, file);
 
-       if (stat(file, &s) || md5sum(file, f_md5)) {
+       if (stat(file, &s) || md5sum(file, f_md5) < 0) {
                fprintf(stderr, "Failed to hash %s\n", file);
                return -1;
        }
@@ -556,8 +666,19 @@ resume:
                offset = 0;
        }
 
-       if (jffs2_replaced && trx_fixup) {
-               trx_fixup(fd, mtd);
+       if (jffs2_replaced) {
+               switch (imageformat) {
+               case MTD_IMAGE_FORMAT_TRX:
+                       if (trx_fixup)
+                               trx_fixup(fd, mtd);
+                       break;
+               case MTD_IMAGE_FORMAT_SEAMA:
+                       if (mtd_fixseama)
+                               mtd_fixseama(mtd, 0);
+                       break;
+               default:
+                       break;
+               }
        }
 
        if (!quiet)
@@ -588,6 +709,10 @@ static void usage(void)
        "        verify <imagefile>|-    verify <imagefile> (use - for stdin) to device\n"
        "        write <imagefile>|-     write <imagefile> (use - for stdin) to device\n"
        "        jffs2write <file>       append <file> to the jffs2 partition on the device\n");
+       if (mtd_resetbc) {
+           fprintf(stderr,
+       "        resetbc <device>        reset the uboot boot counter\n");
+       }
        if (mtd_fixtrx) {
            fprintf(stderr,
        "        fixtrx                  fix the checksum in a trx header on first boot\n");
@@ -596,7 +721,7 @@ static void usage(void)
            fprintf(stderr,
        "        fixseama                fix the checksum in a seama header on first boot\n");
        }
-    fprintf(stderr,
+       fprintf(stderr,
        "Following options are available:\n"
        "        -q                      quiet mode (once: no [w] on writing,\n"
        "                                           twice: no status messages)\n"
@@ -607,11 +732,12 @@ static void usage(void)
        "        -d <name>               directory for jffs2write, defaults to \"tmp\"\n"
        "        -j <name>               integrate <file> into jffs2 data when writing an image\n"
        "        -s <number>             skip the first n bytes when appending data to the jffs2 partiton, defaults to \"0\"\n"
-       "        -p                      write beginning at partition offset\n");
+       "        -p                      write beginning at partition offset\n"
+       "        -l <length>             the length of data that we want to dump\n");
        if (mtd_fixtrx) {
            fprintf(stderr,
        "        -o offset               offset of the image header in the partition(for fixtrx)\n");
-    }
+       }
        fprintf(stderr,
 #ifdef FIS_SUPPORT
        "        -F <part>[:<size>[:<entrypoint>]][,<part>...]\n"
@@ -643,7 +769,7 @@ int main (int argc, char **argv)
        int ch, i, boot, imagefd = 0, force, unlocked;
        char *erase[MAX_ARGS], *device = NULL;
        char *fis_layout = NULL;
-       size_t offset = 0, part_offset = 0;
+       size_t offset = 0, part_offset = 0, dump_len = 0;
        enum {
                CMD_ERASE,
                CMD_WRITE,
@@ -652,6 +778,8 @@ int main (int argc, char **argv)
                CMD_FIXTRX,
                CMD_FIXSEAMA,
                CMD_VERIFY,
+               CMD_DUMP,
+               CMD_RESETBC,
        } cmd = -1;
 
        erase[0] = NULL;
@@ -665,7 +793,7 @@ int main (int argc, char **argv)
 #ifdef FIS_SUPPORT
                        "F:"
 #endif
-                       "frnqe:d:s:j:p:o:")) != -1)
+                       "frnqe:d:s:j:p:o:l:")) != -1)
                switch (ch) {
                        case 'f':
                                force = 1;
@@ -709,11 +837,15 @@ int main (int argc, char **argv)
                                        usage();
                                }
                                break;
-                       case 'o':
-                               if (!mtd_fixtrx) {
-                                       fprintf(stderr, "-o: is not available on this platform\n");
+                       case 'l':
+                               errno = 0;
+                               dump_len = strtoul(optarg, 0, 0);
+                               if (errno) {
+                                       fprintf(stderr, "-l: illegal numeric string\n");
                                        usage();
                                }
+                               break;
+                       case 'o':
                                errno = 0;
                                offset = strtoul(optarg, 0, 0);
                                if (errno) {
@@ -742,6 +874,9 @@ int main (int argc, char **argv)
        } else if ((strcmp(argv[0], "erase") == 0) && (argc == 2)) {
                cmd = CMD_ERASE;
                device = argv[1];
+       } else if (((strcmp(argv[0], "resetbc") == 0) && (argc == 2)) && mtd_resetbc) {
+               cmd = CMD_RESETBC;
+               device = argv[1];
        } else if (((strcmp(argv[0], "fixtrx") == 0) && (argc == 2)) && mtd_fixtrx) {
                cmd = CMD_FIXTRX;
                device = argv[1];
@@ -752,6 +887,9 @@ int main (int argc, char **argv)
                cmd = CMD_VERIFY;
                imagefile = argv[1];
                device = argv[2];
+       } else if ((strcmp(argv[0], "dump") == 0) && (argc == 2)) {
+               cmd = CMD_DUMP;
+               device = argv[1];
        } else if ((strcmp(argv[0], "write") == 0) && (argc == 3)) {
                cmd = CMD_WRITE;
                device = argv[2];
@@ -809,6 +947,9 @@ int main (int argc, char **argv)
                case CMD_VERIFY:
                        mtd_verify(device, imagefile);
                        break;
+               case CMD_DUMP:
+                       mtd_dump(device, offset, dump_len);
+                       break;
                case CMD_ERASE:
                        if (!unlocked)
                                mtd_unlock(device);
@@ -828,6 +969,10 @@ int main (int argc, char **argv)
                    if (mtd_fixtrx) {
                            mtd_fixtrx(device, offset);
             }
+               case CMD_RESETBC:
+                   if (mtd_resetbc) {
+                           mtd_resetbc(device);
+            }
                case CMD_FIXSEAMA:
                        if (mtd_fixseama)
                            mtd_fixseama(device, 0);