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