]>
Commit | Line | Data |
---|---|---|
972ac24b MG |
1 | #include <stdio.h> |
2 | #include <stdlib.h> | |
3 | #include <sys/types.h> | |
4 | #include <sys/stat.h> | |
5 | #include <fcntl.h> | |
6 | #include <unistd.h> | |
7 | #include <errno.h> | |
7f88d2b6 | 8 | #include <string.h> |
972ac24b MG |
9 | #include <strings.h> |
10 | #include "rsb-crc.h" | |
90836933 | 11 | #include "rsb-lz.h" |
972ac24b | 12 | |
7f88d2b6 MG |
13 | #define FINDSTR(addr, str) (!strncmp((char*)addr, str, strlen(str))) |
14 | ||
39601b0e MG |
15 | struct properties { |
16 | unsigned int magic; | |
17 | unsigned char unknown0; | |
18 | unsigned char unknown1; | |
19 | unsigned char right_rw; | |
20 | unsigned char rw_mask; | |
21 | unsigned char type1; | |
22 | unsigned char unknown5; | |
23 | unsigned char unknown6; | |
24 | unsigned char unknown7; | |
25 | unsigned char type2; | |
26 | unsigned char val[]; | |
27 | }; | |
28 | ||
7ac4bfad MG |
29 | #define PROP_ACTION_TRUE (1<<0) |
30 | #define PROP_ACTION_FALSE (1<<1) | |
31 | #define PROP_ACTION_RO (1<<2) | |
32 | #define PROP_ACTION_RW (1<<3) | |
33 | ||
34 | #define PROP_STATUS_NOTFOUND (0) | |
35 | #define PROP_STATUS_WRONGTYPE (1<<0) | |
36 | #define PROP_STATUS_WRONGRIGHTS (1<<1) | |
37 | #define PROP_STATUS_SAMEVAL (1<<2) | |
38 | #define PROP_STATUS_SUCCESS (1<<3) | |
39 | ||
40 | struct propaction { | |
41 | char *property; | |
42 | unsigned int action; | |
43 | unsigned int status; | |
44 | struct propaction *next; | |
45 | }; | |
46 | ||
39601b0e | 47 | void show_properties(unsigned char *fw, int len) |
7f88d2b6 MG |
48 | { |
49 | int i; | |
50 | ||
51 | for (i = 0; i < (len-100 /* XXX */); i++) { | |
52 | if (FINDSTR(fw+i, "/default/fw_prop/") || | |
53 | FINDSTR(fw+i, "/default/fw_setup/") || | |
54 | FINDSTR(fw+i, "/default/oem_prop/")) { | |
39601b0e | 55 | struct properties *prop; |
7f88d2b6 | 56 | unsigned char *pos = fw + i; |
7f88d2b6 | 57 | |
7ac4bfad | 58 | printf("0x%08x: found setting: %s ", i, pos); |
7f88d2b6 | 59 | |
39601b0e MG |
60 | prop = (struct properties*)(pos + strlen((char*)pos) + 1); |
61 | ||
62 | if (prop->magic != 0x83011111) { | |
7f88d2b6 MG |
63 | printf("ignoring...\n"); |
64 | continue; | |
65 | } | |
66 | ||
39601b0e | 67 | if (prop->type1 == 0x00 && prop->type2 == 0x04) { |
7ac4bfad | 68 | printf("STRING: '%s' ", prop->val); |
39601b0e MG |
69 | } else if (prop->type1 == 0x01 && prop->type2 == 0x01) { |
70 | printf("BOOL: %s ",(*prop->val ? "TRUE" : "FALSE")); | |
71 | } else if (prop->type1 == 0x04 && prop->type2 == 0x02) { | |
72 | printf("VAL: 0x%x ", *((unsigned int*)prop->val)); | |
7f88d2b6 | 73 | } else { |
39601b0e | 74 | printf("0x%02x 0x%2x...ignoring\n", prop->type1, prop->type2); |
7f88d2b6 MG |
75 | continue; |
76 | } | |
77 | ||
39601b0e | 78 | if (prop->right_rw == 0x00 && prop->rw_mask == 0x00) { |
a519eca7 | 79 | printf("(R-)"); |
39601b0e | 80 | } else if (prop->right_rw == 0x01) { |
a519eca7 | 81 | printf("(RW mask: 0x%02x)", prop->rw_mask); |
7f88d2b6 | 82 | } else { |
a519eca7 | 83 | printf("(UNK 0x%02x 0x%02x)", prop->right_rw, prop->rw_mask); |
7f88d2b6 | 84 | } |
a519eca7 | 85 | printf(", length: %d\n", *((unsigned int*)(fw + i - 4))); |
7f88d2b6 MG |
86 | } |
87 | } | |
88 | } | |
89 | ||
7ac4bfad MG |
90 | void change_properties(unsigned char *fw, int len, struct propaction *paction) |
91 | { | |
92 | int i; | |
93 | struct propaction *cpaction; | |
94 | ||
95 | for (i = 0; i < (len-100 /* XXX */); i++) { | |
96 | cpaction = paction; | |
97 | while (cpaction != NULL) { | |
98 | if (FINDSTR(fw + i, cpaction->property)) { | |
99 | break; | |
100 | } | |
101 | cpaction = cpaction->next; | |
102 | } | |
103 | if (cpaction != NULL) { | |
104 | struct properties *prop; | |
105 | unsigned char *pos = fw + i; | |
106 | ||
107 | prop = (struct properties*)(pos + strlen((char*)pos) + 1); | |
108 | ||
109 | if (prop->magic != 0x83011111) { | |
110 | continue; | |
111 | } | |
112 | ||
113 | if (cpaction->action & (PROP_ACTION_TRUE|PROP_ACTION_FALSE)) { | |
114 | if (prop->type1 == 0x01 && prop->type2 == 0x01) { | |
115 | if (cpaction->action & PROP_ACTION_TRUE) { | |
116 | if (*prop->val == 0x00) { | |
117 | *prop->val = 0x01; | |
118 | cpaction->status |= PROP_STATUS_SUCCESS; | |
119 | } else { | |
120 | cpaction->status |= PROP_STATUS_SAMEVAL; | |
121 | } | |
122 | } else { | |
123 | if (*prop->val == 0x01) { | |
124 | *prop->val = 0x00; | |
125 | cpaction->status |= PROP_STATUS_SUCCESS; | |
126 | } else { | |
127 | cpaction->status |= PROP_STATUS_SAMEVAL; | |
128 | } | |
129 | } | |
130 | } else { | |
131 | cpaction->status = PROP_STATUS_WRONGTYPE; | |
132 | } | |
133 | } | |
134 | if (cpaction->action & PROP_ACTION_RW) { | |
135 | if (prop->right_rw == 0x00 && prop->rw_mask == 0x00) { | |
136 | prop->right_rw = 0x01; | |
137 | prop->rw_mask = 0x02; | |
138 | cpaction->status |= PROP_STATUS_SUCCESS; | |
139 | } else { | |
140 | cpaction->status |= PROP_STATUS_WRONGRIGHTS; | |
141 | } | |
142 | } | |
143 | if (cpaction->action & PROP_ACTION_RO) { | |
144 | if (prop->right_rw == 0x01 && prop->rw_mask == 0x02) { | |
145 | prop->right_rw = 0x00; | |
146 | prop->rw_mask = 0x00; | |
147 | cpaction->status |= PROP_STATUS_SUCCESS; | |
148 | } else { | |
149 | cpaction->status |= PROP_STATUS_WRONGRIGHTS; | |
150 | } | |
151 | } | |
152 | } | |
153 | } | |
154 | } | |
155 | ||
68fc92b2 MG |
156 | #define BD_SERIAL1 0x14,0x02 |
157 | #define BD_ICMB 0x14,0x04 | |
158 | #define BD_LAN 0x14,0x08 | |
159 | #define BD_SERIAL2 0x14,0x10 | |
160 | #define BD_SERIAL3 0x14,0x20 | |
161 | #define BD_USB 0x14,0x40 | |
162 | #define BD_PCI 0x15,0x03 | |
163 | #define BD_LPC 0x15,0x04 | |
164 | #define BD_VGA 0x15,0x08 | |
165 | #define BD_BATTERY 0x15,0x10 | |
166 | #define BD_ACDC 0x15,0x20 | |
167 | #define BD_STANDBY 0x15,0x40 | |
168 | #define BD_POWERCONN 0x15,0x70 | |
169 | #define BD_DVI 0x15,0x80 | |
170 | #define BD_PWRATX 0x16,0x01 | |
171 | #define BD_PWRRELAY 0x16,0x02 | |
172 | #define BD_PS2A 0x19,0xff | |
173 | ||
174 | #define MAGIC(fn, args...) fn(args) | |
175 | ||
176 | #define _BD_IS_SET(bd, byte, bits) (bd[byte] & bits) | |
177 | #define BD_IS_SET(bd, ident) MAGIC(_BD_IS_SET, bd, BD_##ident) | |
178 | #define BD_TEXT(bd, ident) (BD_IS_SET(bd, ident) ? "TRUE" : "FALSE") | |
179 | ||
180 | #define _BD_SET(bd, byte, bits) (bd[byte] |= bits) | |
181 | #define BD_SET(bd, ident) MAGIC(_BD_SET, bd, BD_##ident) | |
182 | ||
453260c6 MG |
183 | void print_boarddescription(unsigned char *bd) |
184 | { | |
185 | int j; | |
186 | ||
187 | for (j = 0; j < 32; j++) { | |
188 | printf("%02x ", *(bd+j)); | |
189 | } | |
190 | printf("\n"); | |
f370a858 MG |
191 | |
192 | /* com/agilent/rmc/amr/AmrMaster.class | |
193 | * com/agilent/rmc/mgui/RmcPanel.class | |
194 | * com/agilent/rmc/mgui/panels/AvrManualConfig.class | |
195 | * com/agilent/rmc/mgui/panels/CardConf.jad | |
196 | * com/agilent/rmc/mgui/panels/PowerMgmtConf.jad | |
197 | * com/agilent/rmc/mgui/panels/RemoteDiskConf.jad | |
198 | */ | |
68fc92b2 MG |
199 | printf("\tserial1Present\t\t: %s\n", BD_TEXT(bd, SERIAL1)); |
200 | printf("\ticmbPresent\t\t: %s\n", BD_TEXT(bd, ICMB)); | |
201 | printf("\tlanPresent\t\t: %s\n", BD_TEXT(bd, LAN)); | |
202 | printf("\tserial2Present\t\t: %s\n", BD_TEXT(bd, SERIAL2)); | |
203 | printf("\tserial3Present\t\t: %s\n", BD_TEXT(bd, SERIAL3)); | |
204 | printf("\tusbPresent\t\t: %s\n", BD_TEXT(bd, USB)); | |
205 | printf("\tpciPresent\t\t: %s\n", BD_TEXT(bd, PCI)); | |
206 | printf("\tlpcPresent\t\t: %s\n", BD_TEXT(bd, LPC)); | |
207 | printf("\tvgaPresent\t\t: %s\n", BD_TEXT(bd, VGA)); | |
208 | printf("\tbatteryPresent\t\t: %s\n", BD_TEXT(bd, BATTERY)); | |
209 | printf("\tacdcPresent\t\t: %s\n", BD_TEXT(bd, ACDC)); | |
210 | printf("\tstandbyPresent\t\t: %s\n", BD_TEXT(bd, STANDBY)); | |
211 | printf("\thasPowerConnectors\t: %s\n", BD_TEXT(bd, POWERCONN)); | |
212 | printf("\tdviPresent\t\t: %s\n", BD_TEXT(bd, DVI)); | |
213 | printf("\tpowerSwitchATX\t\t: %s\n", BD_TEXT(bd, PWRATX)); | |
214 | printf("\tpowerSwitchRelay\t: %s\n", BD_TEXT(bd, PWRRELAY)); | |
f370a858 | 215 | /* 22 & 4 */ |
68fc92b2 | 216 | printf("\tps2aPresent\t\t: %s\n", BD_TEXT(bd, PS2A)); |
453260c6 MG |
217 | } |
218 | ||
7f88d2b6 MG |
219 | void handle_boarddescription(unsigned char *fw, int len, int patch) |
220 | { | |
453260c6 MG |
221 | int i; |
222 | ||
223 | for (i = len - (strlen("pdata")+1); i > 0; i--) { | |
224 | if (FINDSTR(fw+i, "pdata")) { | |
225 | unsigned char *pos = fw + i + strlen("pdata") + 1; | |
226 | ||
227 | /* MAGIC? */ | |
228 | if (*((unsigned int*)pos) != 0x00002802) { | |
229 | continue; | |
230 | } | |
231 | ||
232 | pos += 26; | |
233 | ||
234 | /* MAGIC2? */ | |
235 | if (*((unsigned int*)pos) != 0x00500101) { | |
236 | continue; | |
237 | } | |
238 | ||
453260c6 | 239 | if (patch) { |
4b913d63 | 240 | /* Enable relay power switching */ |
68fc92b2 | 241 | BD_SET(pos, PWRRELAY); |
453260c6 | 242 | } |
62248c5c MG |
243 | printf("0x%08x: BOARD_DESCRIPTION: ", pos-fw); |
244 | print_boarddescription(pos); | |
453260c6 MG |
245 | |
246 | break; | |
247 | } | |
248 | } | |
7f88d2b6 MG |
249 | } |
250 | ||
7ac4bfad MG |
251 | void syntax(char *name) |
252 | { | |
253 | fprintf(stderr,"Syntax: %s parameters firmware.bin\n", name); | |
254 | fprintf(stderr,"parameters as follows:\n"); | |
255 | fprintf(stderr,"\t-d\t\tdisplay all properties of the image\n"); | |
256 | fprintf(stderr,"\t-u\t\tupdate checksum of the image\n"); | |
453260c6 | 257 | fprintf(stderr,"\t-b\t\tmodify BOARD_DESCRIPTION for more power-switch options\n"); |
14ff7444 | 258 | fprintf(stderr,"\t-e\t\textract files in firmware\n"); |
7ac4bfad MG |
259 | fprintf(stderr,"\t-t property\tset 'property' to true\n"); |
260 | fprintf(stderr,"\t-f property\tset 'property' to false\n"); | |
261 | fprintf(stderr,"\t-w property\tallow read-write access to 'property'\n"); | |
262 | fprintf(stderr,"\t-r property\tallow read-only access to 'property'\n"); | |
263 | exit(1); | |
264 | } | |
265 | ||
266 | void add_action(int opt, char *optarg, struct propaction **paction) { | |
267 | struct propaction *pos = *paction; | |
268 | struct propaction *prev = NULL; | |
269 | ||
270 | while (pos != NULL) { | |
271 | if (!strcmp(pos->property, optarg)) | |
272 | break; | |
273 | prev = pos; | |
274 | pos = pos->next; | |
275 | } | |
276 | ||
277 | if (pos == NULL) { | |
278 | pos = malloc(sizeof(struct propaction)); | |
279 | if (pos == NULL) { | |
280 | perror("malloc"); | |
281 | exit(1); | |
282 | } | |
283 | bzero(pos, sizeof(struct propaction)); | |
284 | pos->property = optarg; | |
285 | ||
286 | if (prev == NULL) { | |
287 | *paction = pos; | |
288 | } else { | |
289 | prev->next = pos; | |
290 | } | |
291 | } | |
292 | ||
293 | switch(opt) { | |
294 | case 't': | |
295 | if (pos->action & PROP_ACTION_FALSE) { | |
296 | fprintf(stderr,"inconsistent requests for %s\n",pos->property); | |
297 | exit(1); | |
298 | } | |
299 | pos->action |= PROP_ACTION_TRUE; | |
300 | break; | |
301 | case 'f': | |
302 | if (pos->action & PROP_ACTION_TRUE) { | |
303 | fprintf(stderr,"inconsistent requests for %s\n",pos->property); | |
304 | exit(1); | |
305 | } | |
306 | pos->action |= PROP_ACTION_FALSE; | |
307 | break; | |
308 | case 'w': | |
309 | if (pos->action & PROP_ACTION_RO) { | |
310 | fprintf(stderr,"inconsistent requests for %s\n",pos->property); | |
311 | exit(1); | |
312 | } | |
313 | pos->action |= PROP_ACTION_RW; | |
314 | break; | |
315 | case 'r': | |
316 | if (pos->action & PROP_ACTION_RW) { | |
317 | fprintf(stderr,"inconsistent requests for %s\n",pos->property); | |
318 | exit(1); | |
319 | } | |
320 | pos->action |= PROP_ACTION_RO; | |
321 | break; | |
322 | } | |
323 | } | |
324 | ||
325 | int check_crc(unsigned char *fw, int len) | |
326 | { | |
327 | int ret; | |
328 | unsigned int crc, oldcrc; | |
329 | ||
330 | ret = rsb_crc2(fw, len, 0x55335053, &crc); | |
331 | oldcrc = (unsigned int)*((unsigned int*)(fw + len - 4)); | |
332 | ||
333 | printf("Checksum: 0x%08x (%s), should be: 0x%08x\n", | |
334 | crc, | |
335 | (ret ? "NOT OK" : "OK"), | |
336 | oldcrc); | |
337 | ||
338 | return ret; | |
339 | } | |
340 | ||
972ac24b MG |
341 | int main(int argc, char **argv) |
342 | { | |
343 | struct stat statbuf; | |
7ac4bfad | 344 | char *file = NULL; |
972ac24b MG |
345 | unsigned char *fw; |
346 | int fd; | |
347 | int remaining; | |
348 | int ret; | |
7ac4bfad MG |
349 | int opt; |
350 | unsigned int crc; | |
351 | struct propaction *paction = NULL; | |
352 | int showall = 0; | |
353 | int update_crc = 0; | |
453260c6 | 354 | int patch_bd = 0; |
7ac4bfad | 355 | int patch_fw = 0; |
14ff7444 | 356 | int extract = 0; |
972ac24b | 357 | |
7ac4bfad MG |
358 | if (argc < 2) |
359 | syntax(argv[0]); | |
360 | ||
14ff7444 | 361 | while ((opt = getopt(argc, argv, "dubet:f:w:r:")) != -1) { |
7ac4bfad MG |
362 | switch(opt) { |
363 | case 'd': | |
364 | showall = 1; | |
365 | break; | |
366 | case 'u': | |
367 | update_crc = 1; | |
368 | break; | |
453260c6 MG |
369 | case 'b': |
370 | patch_bd = 1; | |
371 | break; | |
14ff7444 MG |
372 | case 'e': |
373 | extract = 1; | |
374 | break; | |
7ac4bfad MG |
375 | case 't': |
376 | case 'f': | |
377 | case 'w': | |
378 | case 'r': | |
379 | patch_fw = 1; | |
380 | add_action(opt, optarg, &paction); | |
381 | break; | |
382 | default: | |
383 | syntax(argv[0]); | |
384 | } | |
972ac24b MG |
385 | } |
386 | ||
7ac4bfad MG |
387 | if (argc > optind) { |
388 | file = argv[optind]; | |
389 | } else { | |
390 | syntax(argv[0]); | |
391 | } | |
392 | ||
393 | if (stat(file, &statbuf) == -1) { | |
394 | fprintf(stderr,"%s: ", file); | |
972ac24b MG |
395 | perror("stat"); |
396 | exit(1); | |
397 | } | |
398 | ||
7ac4bfad MG |
399 | if ((fd = open(file, O_RDONLY)) == -1) { |
400 | fprintf(stderr,"%s: ", file); | |
972ac24b MG |
401 | perror("open"); |
402 | exit(1); | |
403 | } | |
404 | ||
405 | if ((fw = malloc(statbuf.st_size)) == NULL) { | |
406 | perror("malloc"); | |
407 | exit(1); | |
408 | } | |
409 | ||
410 | bzero(fw, statbuf.st_size); | |
411 | ||
412 | remaining = statbuf.st_size; | |
413 | ||
414 | while(remaining) { | |
415 | if ((ret = read(fd, fw + (statbuf.st_size - remaining), remaining)) == -1) { | |
416 | perror("read"); | |
417 | exit(1); | |
418 | } | |
419 | remaining -= ret; | |
420 | } | |
7ac4bfad | 421 | close(fd); |
972ac24b | 422 | |
7ac4bfad MG |
423 | ret = check_crc(fw, statbuf.st_size); |
424 | if ((ret != 0) && (!update_crc)) { | |
425 | fprintf(stderr,"Checksum incorrect, aborting...\n"); | |
426 | } | |
972ac24b | 427 | |
7ac4bfad MG |
428 | if (patch_fw) { |
429 | struct propaction *cpaction = paction; | |
430 | ||
431 | change_properties(fw, statbuf.st_size, paction); | |
432 | ||
433 | printf("\nProperty change results:\n"); | |
434 | while(cpaction != NULL) { | |
435 | printf("%s: ", cpaction->property); | |
436 | ||
437 | if (cpaction->status == PROP_STATUS_NOTFOUND) | |
438 | printf("NOTFOUND "); | |
439 | if (cpaction->status & PROP_STATUS_SUCCESS) | |
440 | printf("SUCCESS "); | |
441 | if (cpaction->status & PROP_STATUS_SAMEVAL) | |
442 | printf("SAMEVAL "); | |
443 | if (cpaction->status & PROP_STATUS_WRONGTYPE) | |
444 | printf("WRONGTYPE "); | |
445 | if (cpaction->status & PROP_STATUS_WRONGRIGHTS) | |
446 | printf("WRONGRIGHTS "); | |
447 | printf("\n"); | |
448 | ||
449 | cpaction = cpaction->next; | |
7f88d2b6 | 450 | } |
7ac4bfad | 451 | printf("\n"); |
7f88d2b6 | 452 | } |
972ac24b | 453 | |
453260c6 MG |
454 | if (patch_bd) { |
455 | handle_boarddescription(fw, statbuf.st_size -4, 1); | |
456 | } | |
457 | ||
458 | if (showall) { | |
7ac4bfad | 459 | show_properties(fw, statbuf.st_size - 4); |
453260c6 | 460 | handle_boarddescription(fw, statbuf.st_size -4, 0); |
14ff7444 MG |
461 | } |
462 | ||
463 | if (extract) { | |
90836933 | 464 | search_lz_sections(fw, statbuf.st_size - 4); |
453260c6 | 465 | } |
7ac4bfad | 466 | |
453260c6 | 467 | if (update_crc || patch_fw || patch_bd) { |
7ac4bfad MG |
468 | ret = rsb_crc2(fw, statbuf.st_size, 0x55335053, &crc); |
469 | if (ret == 4) { | |
470 | *((unsigned int*)(fw + statbuf.st_size - 4)) = crc; | |
471 | } | |
472 | ||
473 | if (check_crc(fw, statbuf.st_size) == 0) { | |
474 | char *newfile; | |
475 | ||
476 | newfile = malloc(strlen(file) + strlen(".patched") + 1); | |
477 | if (newfile == NULL) { | |
478 | perror("malloc"); | |
479 | exit(1); | |
480 | } | |
481 | strcpy(newfile, file); | |
482 | strcat(newfile, ".patched"); | |
483 | ||
484 | printf("Writing %s\n", newfile); | |
485 | if ((fd = open(newfile, O_WRONLY|O_CREAT, 0644)) == -1) { | |
486 | fprintf(stderr,"%s: ", file); | |
487 | perror("open"); | |
488 | exit(1); | |
489 | } | |
490 | ||
491 | remaining = statbuf.st_size; | |
492 | ||
493 | while(remaining) { | |
494 | if ((ret = write(fd, fw + (statbuf.st_size - remaining), remaining)) == -1) { | |
495 | perror("write"); | |
496 | exit(1); | |
497 | } | |
498 | remaining -= ret; | |
499 | } | |
500 | close(fd); | |
501 | } else { | |
502 | fprintf(stderr,"Can't set correct checksum, aborting...\n"); | |
503 | } | |
504 | } | |
505 | ||
972ac24b MG |
506 | exit(0); |
507 | } |