tools/firmware-utils/src/trx.c

   1 /*
   2  * Copyright (C) 2004  Manuel Novoa III  <mjn3@codepoet.org>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  12  * General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with this program; if not, write to the Free Software
  16  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  17  */
  18
  19 /* July 29, 2004
  20  *
  21  * This is a hacked replacement for the 'trx' utility used to create
  22  * wrt54g .trx firmware files.  It isn't pretty, but it does the job
  23  * for me.
  24  *
  25  * As an extension, you can specify a larger maximum length for the
  26  * .trx file using '-m'.  It will be rounded up to be a multiple of 4K.
  27  * NOTE: This space will be malloc()'d.
  28  *
  29  * August 16, 2004
  30  *
  31  * Sigh... Make it endian-neutral.
  32  *
  33  * TODO: Support '-b' option to specify offsets for each file.
  34  *
  35  * February 19, 2005 - mbm
  36  *
  37  * Add -a (align offset) and -b (absolute offset)
  38  *
  39  * March 24, 2010 - markus
  40  *
  41  * extend trx header struct for new version
  42  * assume v1 for as default
  43  * Add option -2 to allow v2 header
  44  */
  45
  46 #include <stdio.h>
  47 #include <stdlib.h>
  48 #include <stddef.h>
  49 #include <stdint.h>
  50 #include <string.h>
  51 #include <errno.h>
  52 #include <unistd.h>
  53
  54 #if __BYTE_ORDER == __BIG_ENDIAN
  55 #define STORE32_LE(X)           bswap_32(X)
  56 #elif __BYTE_ORDER == __LITTLE_ENDIAN
  57 #define STORE32_LE(X)           (X)
  58 #else
  59 #error unkown endianness!
  60 #endif
  61
  62 uint32_t crc32buf(char *buf, size_t len);
  63
  64 /**********************************************************************/
  65 /* from trxhdr.h */
  66
  67 #define TRX_MAGIC       0x30524448      /* "HDR0" */
  68 #define TRX_MAX_LEN     0x720000
  69 #define TRX_NO_HEADER   1               /* Do not write TRX header */
  70
  71 struct trx_header {
  72         uint32_t magic;                 /* "HDR0" */
  73         uint32_t len;                   /* Length of file including header */
  74         uint32_t crc32;                 /* 32-bit CRC from flag_version to end of file */
  75         uint32_t flag_version;  /* 0:15 flags, 16:31 version */
  76         uint32_t offsets[4];    /* Offsets of partitions from start of header */
  77 };
  78
  79 /**********************************************************************/
  80
  81 void usage(void) __attribute__ (( __noreturn__ ));
  82
  83 void usage(void)
  84 {
  85         fprintf(stderr, "Usage:\n");
  86         fprintf(stderr, " trx [-2] [-o outfile] [-m maxlen] [-a align] [-b absolute offset] [-x relative offset]\n");
  87         fprintf(stderr, "     [-f file] [-f file [-f file [-f file (v2 only)]]]\n");
  88         exit(EXIT_FAILURE);
  89 }
  90
  91 int main(int argc, char **argv)
  92 {
  93         FILE *out = stdout;
  94         FILE *in;
  95         char *ofn = NULL;
  96         char *buf;
  97         char *e;
  98         int c, i, append = 0;
  99         size_t n;
 100         ssize_t n2;
 101         uint32_t cur_len;
 102         unsigned long maxlen = TRX_MAX_LEN;
 103         struct trx_header *p;
 104         char trx_version = 1;
 105
 106         fprintf(stderr, "mjn3's trx replacement - v0.81.1\n");
 107
 108         if (!(buf = malloc(maxlen))) {
 109                 fprintf(stderr, "malloc failed\n");
 110                 return EXIT_FAILURE;
 111         }
 112
 113         p = (struct trx_header *) buf;
 114
 115         p->magic = STORE32_LE(TRX_MAGIC);
 116         cur_len = sizeof(struct trx_header) - 4; /* assume v1 header */
 117
 118         in = NULL;
 119         i = 0;
 120
 121         while ((c = getopt(argc, argv, "-:2o:m:a:x:b:f:A:")) != -1) {
 122                 switch (c) {
 123                         case '2':
 124                                 /* take care that nothing was written to buf so far */
 125                                 if (cur_len != sizeof(struct trx_header) - 4) {
 126                                         fprintf(stderr, "-2 has to be used before any other argument!\n");
 127                                 }
 128                                 else {
 129                                         trx_version = 2;
 130                                         cur_len += 4;
 131                                 }
 132                                 break;
 133                         case 'A':
 134                                 append = 1;
 135                                 /* fall through */
 136                         case 'f':
 137                         case 1:
 138                                 if (!append)
 139                                         p->offsets[i++] = STORE32_LE(cur_len);
 140
 141                                 if (!(in = fopen(optarg, "r"))) {
 142                                         fprintf(stderr, "can not open \"%s\" for reading\n", optarg);
 143                                         usage();
 144                                 }
 145                                 n = fread(buf + cur_len, 1, maxlen - cur_len, in);
 146                                 if (!feof(in)) {
 147                                         fprintf(stderr, "fread failure or file \"%s\" too large\n",optarg);
 148                                         fclose(in);
 149                                         return EXIT_FAILURE;
 150                                 }
 151                                 fclose(in);
 152 #undef  ROUND
 153 #define ROUND 4
 154                                 if (n & (ROUND-1)) {
 155                                         memset(buf + cur_len + n, 0, ROUND - (n & (ROUND-1)));
 156                                         n += ROUND - (n & (ROUND-1));
 157                                 }
 158                                 cur_len += n;
 159                                 append = 0;
 160
 161                                 break;
 162                         case 'o':
 163                                 ofn = optarg;
 164                                 if (ofn && !(out = fopen(ofn, "w"))) {
 165                                         fprintf(stderr, "can not open \"%s\" for writing\n", ofn);
 166                                         usage();
 167                                 }
 168
 169                                 break;
 170                         case 'm':
 171                                 errno = 0;
 172                                 maxlen = strtoul(optarg, &e, 0);
 173                                 if (errno || (e == optarg) || *e) {
 174                                         fprintf(stderr, "illegal numeric string\n");
 175                                         usage();
 176                                 }
 177 #undef  ROUND
 178 #define ROUND 0x1000
 179                                 if (maxlen & (ROUND-1)) {
 180                                         maxlen += (ROUND - (maxlen & (ROUND-1)));
 181                                 }
 182                                 if (maxlen < ROUND) {
 183                                         fprintf(stderr, "maxlen too small (or wrapped)\n");
 184                                         usage();
 185                                 }
 186                                 if (maxlen > TRX_MAX_LEN) {
 187                                         fprintf(stderr, "WARNING: maxlen exceeds default maximum!  Beware of overwriting nvram!\n");
 188                                 }
 189                                 if (!(buf = realloc(buf,maxlen))) {
 190                                         fprintf(stderr, "realloc failed");
 191                                         return EXIT_FAILURE;
 192                                 }
 193                                 p = (struct trx_header *) buf;
 194                                 break;
 195                         case 'a':
 196                                 errno = 0;
 197                                 n = strtoul(optarg, &e, 0);
 198                                 if (errno || (e == optarg) || *e) {
 199                                         fprintf(stderr, "illegal numeric string\n");
 200                                         usage();
 201                                 }
 202                                 if (cur_len & (n-1)) {
 203                                         n = n - (cur_len & (n-1));
 204                                         memset(buf + cur_len, 0, n);
 205                                         cur_len += n;
 206                                 }
 207                                 break;
 208                         case 'b':
 209                                 errno = 0;
 210                                 n = strtoul(optarg, &e, 0);
 211                                 if (errno || (e == optarg) || *e) {
 212                                         fprintf(stderr, "illegal numeric string\n");
 213                                         usage();
 214                                 }
 215                                 if (n < cur_len) {
 216                                         fprintf(stderr, "WARNING: current length exceeds -b %d offset\n",n);
 217                                 } else {
 218                                         memset(buf + cur_len, 0, n - cur_len);
 219                                         cur_len = n;
 220                                 }
 221                                 break;
 222                         case 'x':
 223                                 errno = 0;
 224                                 n2 = strtol(optarg, &e, 0);
 225                                 if (errno || (e == optarg) || *e) {
 226                                         fprintf(stderr, "illegal numeric string\n");
 227                                         usage();
 228                                 }
 229                                 if (n2 < 0) {
 230                                         if (-n2 > cur_len) {
 231                                                 fprintf(stderr, "WARNING: current length smaller then -x %d offset\n",n2);
 232                                                 cur_len = 0;
 233                                         } else
 234                                                 cur_len += n2;
 235                                 } else {
 236                                         memset(buf + cur_len, 0, n2);
 237                                         cur_len += n2;
 238                                 }
 239
 240                                 break;
 241                         default:
 242                                 usage();
 243                 }
 244         }
 245         p->flag_version = STORE32_LE((trx_version << 16));
 246
 247         if (!in) {
 248                 fprintf(stderr, "we require atleast one filename\n");
 249                 usage();
 250         }
 251
 252 #undef  ROUND
 253 #define ROUND 0x1000
 254         n = cur_len & (ROUND-1);
 255         if (n) {
 256                 memset(buf + cur_len, 0, ROUND - n);
 257                 cur_len += ROUND - n;
 258         }
 259
 260         p->crc32 = crc32buf((char *) &p->flag_version,
 261                                                 cur_len - offsetof(struct trx_header, flag_version));
 262         p->crc32 = STORE32_LE(p->crc32);
 263
 264         p->len = STORE32_LE(cur_len);
 265
 266         if (!fwrite(buf, cur_len, 1, out) || fflush(out)) {
 267                 fprintf(stderr, "fwrite failed\n");
 268                 return EXIT_FAILURE;
 269         }
 270
 271         fclose(out);
 272
 273         return EXIT_SUCCESS;
 274 }
 275
 276 /**********************************************************************/
 277 /* The following was grabbed and tweaked from the old snippets collection
 278  * of public domain C code. */
 279
 280 /**********************************************************************\
 281 |* Demonstration program to compute the 32-bit CRC used as the frame  *|
 282 |* check sequence in ADCCP (ANSI X3.66, also known as FIPS PUB 71     *|
 283 |* and FED-STD-1003, the U.S. versions of CCITT's X.25 link-level     *|
 284 |* protocol).  The 32-bit FCS was added via the Federal Register,     *|
 285 |* 1 June 1982, p.23798.  I presume but don't know for certain that   *|
 286 |* this polynomial is or will be included in CCITT V.41, which        *|
 287 |* defines the 16-bit CRC (often called CRC-CCITT) polynomial.  FIPS  *|
 288 |* PUB 78 says that the 32-bit FCS reduces otherwise undetected       *|
 289 |* errors by a factor of 10^-5 over 16-bit FCS.                       *|
 290 \**********************************************************************/
 291
 292 /* Copyright (C) 1986 Gary S. Brown.  You may use this program, or
 293    code or tables extracted from it, as desired without restriction.*/
 294
 295 /* First, the polynomial itself and its table of feedback terms.  The  */
 296 /* polynomial is                                                       */
 297 /* X^32+X^26+X^23+X^22+X^16+X^12+X^11+X^10+X^8+X^7+X^5+X^4+X^2+X^1+X^0 */
 298 /* Note that we take it "backwards" and put the highest-order term in  */
 299 /* the lowest-order bit.  The X^32 term is "implied"; the LSB is the   */
 300 /* X^31 term, etc.  The X^0 term (usually shown as "+1") results in    */
 301 /* the MSB being 1.                                                    */
 302
 303 /* Note that the usual hardware shift register implementation, which   */
 304 /* is what we're using (we're merely optimizing it by doing eight-bit  */
 305 /* chunks at a time) shifts bits into the lowest-order term.  In our   */
 306 /* implementation, that means shifting towards the right.  Why do we   */
 307 /* do it this way?  Because the calculated CRC must be transmitted in  */
 308 /* order from highest-order term to lowest-order term.  UARTs transmit */
 309 /* characters in order from LSB to MSB.  By storing the CRC this way,  */
 310 /* we hand it to the UART in the order low-byte to high-byte; the UART */
 311 /* sends each low-bit to hight-bit; and the result is transmission bit */
 312 /* by bit from highest- to lowest-order term without requiring any bit */
 313 /* shuffling on our part.  Reception works similarly.                  */
 314
 315 /* The feedback terms table consists of 256, 32-bit entries.  Notes:   */
 316 /*                                                                     */
 317 /*  1. The table can be generated at runtime if desired; code to do so */
 318 /*     is shown later.  It might not be obvious, but the feedback      */
 319 /*     terms simply represent the results of eight shift/xor opera-    */
 320 /*     tions for all combinations of data and CRC register values.     */
 321 /*                                                                     */
 322 /*  2. The CRC accumulation logic is the same for all CRC polynomials, */
 323 /*     be they sixteen or thirty-two bits wide.  You simply choose the */
 324 /*     appropriate table.  Alternatively, because the table can be     */
 325 /*     generated at runtime, you can start by generating the table for */
 326 /*     the polynomial in question and use exactly the same "updcrc",   */
 327 /*     if your application needn't simultaneously handle two CRC       */
 328 /*     polynomials.  (Note, however, that XMODEM is strange.)          */
 329 /*                                                                     */
 330 /*  3. For 16-bit CRCs, the table entries need be only 16 bits wide;   */
 331 /*     of course, 32-bit entries work OK if the high 16 bits are zero. */
 332 /*                                                                     */
 333 /*  4. The values must be right-shifted by eight bits by the "updcrc"  */
 334 /*     logic; the shift must be unsigned (bring in zeroes).  On some   */
 335 /*     hardware you could probably optimize the shift in assembler by  */
 336 /*     using byte-swap instructions.                                   */
 337
 338 static const uint32_t crc_32_tab[] = { /* CRC polynomial 0xedb88320 */
 339 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419, 0x706af48f,
 340 0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988,
 341 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91, 0x1db71064, 0x6ab020f2,
 342 0xf3b97148, 0x84be41de, 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7,
 343 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, 0x14015c4f, 0x63066cd9,
 344 0xfa0f3d63, 0x8d080df5, 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172,
 345 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b, 0x35b5a8fa, 0x42b2986c,
 346 0xdbbbc9d6, 0xacbcf940, 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59,
 347 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116, 0x21b4f4b5, 0x56b3c423,
 348 0xcfba9599, 0xb8bda50f, 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924,
 349 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, 0x76dc4190, 0x01db7106,
 350 0x98d220bc, 0xefd5102a, 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433,
 351 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818, 0x7f6a0dbb, 0x086d3d2d,
 352 0x91646c97, 0xe6635c01, 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e,
 353 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457, 0x65b0d9c6, 0x12b7e950,
 354 0x8bbeb8ea, 0xfcb9887c, 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65,
 355 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2, 0x4adfa541, 0x3dd895d7,
 356 0xa4d1c46d, 0xd3d6f4fb, 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0,
 357 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9, 0x5005713c, 0x270241aa,
 358 0xbe0b1010, 0xc90c2086, 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f,
 359 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, 0x59b33d17, 0x2eb40d81,
 360 0xb7bd5c3b, 0xc0ba6cad, 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a,
 361 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683, 0xe3630b12, 0x94643b84,
 362 0x0d6d6a3e, 0x7a6a5aa8, 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1,
 363 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe, 0xf762575d, 0x806567cb,
 364 0x196c3671, 0x6e6b06e7, 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc,
 365 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5, 0xd6d6a3e8, 0xa1d1937e,
 366 0x38d8c2c4, 0x4fdff252, 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b,
 367 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60, 0xdf60efc3, 0xa867df55,
 368 0x316e8eef, 0x4669be79, 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236,
 369 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, 0xc5ba3bbe, 0xb2bd0b28,
 370 0x2bb45a92, 0x5cb36a04, 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d,
 371 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a, 0x9c0906a9, 0xeb0e363f,
 372 0x72076785, 0x05005713, 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38,
 373 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, 0x86d3d2d4, 0xf1d4e242,
 374 0x68ddb3f8, 0x1fda836e, 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777,
 375 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c, 0x8f659eff, 0xf862ae69,
 376 0x616bffd3, 0x166ccf45, 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2,
 377 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db, 0xaed16a4a, 0xd9d65adc,
 378 0x40df0b66, 0x37d83bf0, 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9,
 379 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, 0xbad03605, 0xcdd70693,
 380 0x54de5729, 0x23d967bf, 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94,
 381 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d
 382 };
 383
 384 #define UPDC32(octet,crc) (crc_32_tab[((crc) ^ (octet)) & 0xff] ^ ((crc) >> 8))
 385
 386 uint32_t crc32buf(char *buf, size_t len)
 387 {
 388       uint32_t crc;
 389
 390       crc = 0xFFFFFFFF;
 391
 392       for ( ; len; --len, ++buf)
 393       {
 394             crc = UPDC32(*buf, crc);
 395       }
 396
 397       return crc;
 398 }