openwrt/target/utils/src/addpattern.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 'addpattern' utility used to
  22  * create wrt54g .bin firmware files.  It isn't pretty, but it does
  23  * the job for me.
  24  *
  25  * Extensions:
  26  *  -v allows setting the version string on the command line.
  27  *  -{0|1} sets the (currently ignored) hw_ver flag in the header
  28  *      to 0 or 1 respectively.
  29  */
  30
  31 /* January 12, 2005
  32  *
  33  * Modified by rodent at rodent dot za dot net
  34  * Support added for the new WRT54G v2.2 and WRT54GS v1.1 "flags"
  35  * Without the flags set to 0x7, the above units will refuse to flash.
  36  *
  37  * Extensions:
  38  *  -{0|1|2} sets {0|1} sets hw_ver flag to 0/1. {2} sets hw_ver to 1
  39  *     and adds the new hardware "flags" for the v2.2/v1.1 units
  40 */
  41
  42 #include <stdio.h>
  43 #include <stdlib.h>
  44 #include <string.h>
  45 #include <time.h>
  46 #include <unistd.h>
  47 #include <sys/stat.h>
  48
  49 /**********************************************************************/
  50
  51 #define CODE_ID         "U2ND"          /* from code_pattern.h */
  52 #define CODE_PATTERN   "W54S"   /* from code_pattern.h */
  53 #define PBOT_PATTERN   "PBOT"
  54
  55 #define CYBERTAN_VERSION        "v3.37.2" /* from cyutils.h */
  56
  57 /* WRT54G v2.2 and WRT54GS v1.1 "flags" (from 3.37.32 firmware cyutils.h) */
  58 #define SUPPORT_4712_CHIP      0x0001
  59 #define SUPPORT_INTEL_FLASH    0x0002
  60 #define SUPPORT_5325E_SWITCH   0x0004
  61
  62 struct code_header {                    /* from cyutils.h */
  63         char magic[4];
  64         char res1[4];                           /* for extra magic */
  65         char fwdate[3];
  66         char fwvern[3];
  67         char id[4];                                     /* U2ND */
  68         char hw_ver;                            /* 0: for 4702, 1: for 4712 -- new in 2.04.3 */
  69         char unused;
  70         unsigned char flags[2];       /* SUPPORT_ flags new for 3.37.2 (WRT54G v2.2 and WRT54GS v1.1) */
  71         unsigned char res2[10];
  72 } ;
  73
  74 /**********************************************************************/
  75
  76 void usage(void) __attribute__ (( __noreturn__ ));
  77
  78 void usage(void)
  79 {
  80         fprintf(stderr, "Usage: addpattern [-i trxfile] [-o binfile] [-p pattern] [-g] [-b] [-v v#.#.#] [-{0|1|2|4}]\n");
  81         exit(EXIT_FAILURE);
  82 }
  83
  84 int main(int argc, char **argv)
  85 {
  86         char buf[1024]; /* keep this at 1k or adjust garbage calc below */
  87         struct code_header *hdr;
  88         FILE *in = stdin;
  89         FILE *out = stdout;
  90         char *ifn = NULL;
  91         char *ofn = NULL;
  92         char *pattern = CODE_PATTERN;
  93         char *pbotpat = PBOT_PATTERN;
  94         char *version = CYBERTAN_VERSION;
  95         int gflag = 0;
  96         int pbotflag = 0;
  97         int c;
  98         int v0, v1, v2;
  99         size_t off, n;
 100         time_t t;
 101         struct tm *ptm;
 102
 103         fprintf(stderr, "mjn3's addpattern replacement - v0.81\n");
 104
 105         hdr = (struct code_header *) buf;
 106         memset(hdr, 0, sizeof(struct code_header));
 107
 108         while ((c = getopt(argc, argv, "i:o:p:gbv:0124")) != -1) {
 109                 switch (c) {
 110                         case 'i':
 111                                 ifn = optarg;
 112                                 break;
 113                         case 'o':
 114                                 ofn = optarg;
 115                                 break;
 116                         case 'p':
 117                                 pattern = optarg;
 118                                 break;
 119                         case 'g':
 120                                 gflag = 1;
 121                                 break;
 122                         case 'b':
 123                                 pbotflag = 1;
 124                                 break;
 125                         case 'v':                       /* extension to allow setting version */
 126                                 version = optarg;
 127                                 break;
 128                         case '0':
 129                                 hdr->hw_ver = 0;
 130                                 break;
 131                         case '1':
 132                                 hdr->hw_ver = 1;
 133                                 break;
 134                         case '2':                       /* new 54G v2.2 and 54GS v1.1 flags */
 135                                 hdr->hw_ver = 1;
 136                                 hdr->flags[0] |= SUPPORT_4712_CHIP;
 137                                 hdr->flags[0] |= SUPPORT_INTEL_FLASH;
 138                                 hdr->flags[0] |= SUPPORT_5325E_SWITCH;
 139                                 break;
 140                         case '4':
 141                                 /* V4 firmware sets the flags to 0x1f */
 142                                 hdr->hw_ver = 0;
 143                                 hdr->flags[0] = 0x1f;
 144                                 break;
 145
 146                         default:
 147                                 usage();
 148                 }
 149         }
 150
 151         if (optind != argc) {
 152                 fprintf(stderr, "illegal arg \"%s\"\n", argv[optind]);
 153                 usage();
 154         }
 155
 156         if (strlen(pattern) != 4) {
 157                 fprintf(stderr, "illegal pattern \"%s\": length != 4\n", pattern);
 158                 usage();
 159         }
 160
 161         if (ifn && !(in = fopen(ifn, "r"))) {
 162                 fprintf(stderr, "can not open \"%s\" for reading\n", ifn);
 163                 usage();
 164         }
 165
 166         if (ofn && !(out = fopen(ofn, "w"))) {
 167                 fprintf(stderr, "can not open \"%s\" for writing\n", ofn);
 168                 usage();
 169         }
 170
 171         if (time(&t) == (time_t)(-1)) {
 172                 fprintf(stderr, "time call failed\n");
 173                 return EXIT_FAILURE;
 174         }
 175
 176         ptm = localtime(&t);
 177
 178         if (3 != sscanf(version, "v%d.%d.%d", &v0, &v1, &v2)) {
 179                 fprintf(stderr, "bad version string \"%s\"\n", version);
 180                 return EXIT_FAILURE;
 181         }
 182
 183         memcpy(&hdr->magic, pattern, 4);
 184         if (pbotflag)
 185                 memcpy(&hdr->res1, pbotpat, 4);
 186         hdr->fwdate[0] = ptm->tm_year % 100;
 187         hdr->fwdate[1] = ptm->tm_mon + 1;
 188         hdr->fwdate[2] = ptm->tm_mday;
 189         hdr->fwvern[0] = v0;
 190         hdr->fwvern[1] = v1;
 191         hdr->fwvern[2] = v2;
 192         memcpy(&hdr->id, CODE_ID, strlen(CODE_ID));
 193
 194         off = sizeof(struct code_header);
 195
 196         fprintf(stderr, "writing firmware v%d.%d.%d on %d/%d/%d (y/m/d)\n",
 197                         v0, v1, v2,
 198                         hdr->fwdate[0], hdr->fwdate[1], hdr->fwdate[2]);
 199
 200
 201         while ((n = fread(buf + off, 1, sizeof(buf)-off, in) + off) > 0) {
 202                 off = 0;
 203                 if (n < sizeof(buf)) {
 204                         if (ferror(in)) {
 205                         FREAD_ERROR:
 206                                 fprintf(stderr, "fread error\n");
 207                                 return EXIT_FAILURE;
 208                         }
 209                         if (gflag) {
 210                                 gflag = sizeof(buf) - n;
 211                                 memset(buf + n, 0xff, gflag);
 212                                 fprintf(stderr, "adding %d bytes of garbage\n", gflag);
 213                                 n = sizeof(buf);
 214                         }
 215                 }
 216                 if (!fwrite(buf, n, 1, out)) {
 217                 FWRITE_ERROR:
 218                         fprintf(stderr, "fwrite error\n");
 219                         return EXIT_FAILURE;
 220                 }
 221         }
 222
 223         if (ferror(in)) {
 224                 goto FREAD_ERROR;
 225         }
 226
 227         if (fflush(out)) {
 228                 goto FWRITE_ERROR;
 229         }
 230
 231         fclose(in);
 232         fclose(out);
 233
 234         return EXIT_SUCCESS;
 235 }