X-Git-Url: http://git.zerfleddert.de/cgi-bin/gitweb.cgi/rsbs2/blobdiff_plain/0fcfb8f327f693fd691592cd04cc403d553f0924..9897bfc3aab309cb3867af8f154b601118d366c9:/rsb-lz.c diff --git a/rsb-lz.c b/rsb-lz.c index 64a1a47..ed0c813 100644 --- a/rsb-lz.c +++ b/rsb-lz.c @@ -1,6 +1,109 @@ +#include +#include +#include +#include +#include +#include "rsb-crc.h" +#include "rsb-lz.h" + /* TODO: IMPLEMET THIS! */ /* Probably very broken lzw implementation by Agilent: * + * 59508: e3a00078 mov r0, #120 ; 0x78 + * 5950c: ee010f10 mcr 15, 0, r0, cr1, cr0, {0} + * 59510: e3a00000 mov r0, #0 ; 0x0 + * 59514: ee070f15 mcr 15, 0, r0, cr7, cr5, {0} + * 59518: ee070f16 mcr 15, 0, r0, cr7, cr6, {0} + * 5951c: ee020f30 mcr 15, 0, r0, cr2, cr0, {1} + * 59520: ee020f10 mcr 15, 0, r0, cr2, cr0, {0} + * 59524: ee030f10 mcr 15, 0, r0, cr3, cr0, {0} + * 59528: ee050f70 mcr 15, 0, r0, cr5, cr0, {3} + * 5952c: ee050f50 mcr 15, 0, r0, cr5, cr0, {2} + * 59530: ee050f30 mcr 15, 0, r0, cr5, cr0, {1} + * 59534: ee050f10 mcr 15, 0, r0, cr5, cr0, {0} + * 59538: e3a00016 mov r0, #22 ; 0x16 + * 5953c: ee060f10 mcr 15, 0, r0, cr6, cr0, {0} + * 59540: ee060f11 mcr 15, 0, r0, cr6, cr1, {0} + * 59544: ee060f12 mcr 15, 0, r0, cr6, cr2, {0} + * 59548: ee060f13 mcr 15, 0, r0, cr6, cr3, {0} + * 5954c: ee060f14 mcr 15, 0, r0, cr6, cr4, {0} + * 59550: ee060f15 mcr 15, 0, r0, cr6, cr5, {0} + * 59554: ee060f16 mcr 15, 0, r0, cr6, cr6, {0} + * 59558: ee060f17 mcr 15, 0, r0, cr6, cr7, {0} + * 5955c: e1a0f00e mov r15, r14 + * 59560: e3a01000 mov r1, #0 ; 0x0 + * 59564: ee071f15 mcr 15, 0, r1, cr7, cr5, {0} + * 59568: ee071f16 mcr 15, 0, r1, cr7, cr6, {0} + * 5956c: e3800078 orr r0, r0, #120 ; 0x78 + * 59570: ee010f10 mcr 15, 0, r0, cr1, cr0, {0} + * 59574: e1a0f00e mov r15, r14 + * 59578: e92d00f0 push {r4, r5, r6, r7} + * 5957c: e3500007 cmp r0, #7 ; 0x7 + * 59580: 8a00003c bhi 0x59678 + * 59584: e3e04ef0 mvn r4, #3840 ; 0xf00 + * 59588: e22440ff eor r4, r4, #255 ; 0xff + * 5958c: e1d14004 bics r4, r1, r4 + * 59590: 1a000038 bne 0x59678 + * 59594: e3a0403f mov r4, #63 ; 0x3f + * 59598: e1d24004 bics r4, r2, r4 + * 5959c: 1a000035 bne 0x59678 + * 595a0: e3a06001 mov r6, #1 ; 0x1 + * 595a4: e1a04423 lsr r4, r3, #8 + * 595a8: e2044001 and r4, r4, #1 ; 0x1 + * 595ac: ee125f30 mrc 15, 0, r5, cr2, cr0, {1} + * 595b0: e1c55016 bic r5, r5, r6, lsl r0 + * 595b4: e1855014 orr r5, r5, r4, lsl r0 + * 595b8: ee025f30 mcr 15, 0, r5, cr2, cr0, {1} + * 595bc: e1a044a3 lsr r4, r3, #9 + * 595c0: e2044001 and r4, r4, #1 ; 0x1 + * 595c4: ee125f10 mrc 15, 0, r5, cr2, cr0, {0} + * 595c8: e1c55016 bic r5, r5, r6, lsl r0 + * 595cc: e1855014 orr r5, r5, r4, lsl r0 + * 595d0: ee025f10 mcr 15, 0, r5, cr2, cr0, {0} + * 595d4: e1a04523 lsr r4, r3, #10 + * 595d8: e2044001 and r4, r4, #1 ; 0x1 + * 595dc: ee135f10 mrc 15, 0, r5, cr3, cr0, {0} + * 595e0: e1c55016 bic r5, r5, r6, lsl r0 + * 595e4: e1855014 orr r5, r5, r4, lsl r0 + * 595e8: ee035f10 mcr 15, 0, r5, cr3, cr0, {0} + * 595ec: e3a0600f mov r6, #15 ; 0xf + * 595f0: e3a07004 mov r7, #4 ; 0x4 + * 595f4: e0070790 mul r7, r0, r7 + * 595f8: e0034006 and r4, r3, r6 + * 595fc: ee155f70 mrc 15, 0, r5, cr5, cr0, {3} + * 59600: e1c55716 bic r5, r5, r6, lsl r7 + * 59604: e1855714 orr r5, r5, r4, lsl r7 + * 59608: ee055f70 mcr 15, 0, r5, cr5, cr0, {3} + * 5960c: e1a04223 lsr r4, r3, #4 + * 59610: e0044006 and r4, r4, r6 + * 59614: ee155f50 mrc 15, 0, r5, cr5, cr0, {2} + * 59618: e1c55716 bic r5, r5, r6, lsl r7 + * 5961c: e1855714 orr r5, r5, r4, lsl r7 + * 59620: ee055f50 mcr 15, 0, r5, cr5, cr0, {2} + * 59624: e1814002 orr r4, r1, r2 + * 59628: e08ff180 add r15, r15, r0, lsl #3 + * 5962c: e1a00000 nop (mov r0,r0) + * 59630: ee064f10 mcr 15, 0, r4, cr6, cr0, {0} + * 59634: ea00000c b 0x5966c + * 59638: ee064f11 mcr 15, 0, r4, cr6, cr1, {0} + * 5963c: ea00000a b 0x5966c + * 59640: ee064f12 mcr 15, 0, r4, cr6, cr2, {0} + * 59644: ea000008 b 0x5966c + * 59648: ee064f13 mcr 15, 0, r4, cr6, cr3, {0} + * 5964c: ea000006 b 0x5966c + * 59650: ee064f14 mcr 15, 0, r4, cr6, cr4, {0} + * 59654: ea000004 b 0x5966c + * 59658: ee064f15 mcr 15, 0, r4, cr6, cr5, {0} + * 5965c: ea000002 b 0x5966c + * 59660: ee064f16 mcr 15, 0, r4, cr6, cr6, {0} + * 59664: ea000000 b 0x5966c + * 59668: ee064f17 mcr 15, 0, r4, cr6, cr7, {0} + * 5966c: e3a00000 mov r0, #0 ; 0x0 + * 59670: e8bd00f0 pop {r4, r5, r6, r7} + * 59674: e1a0f00e mov r15, r14 + * 59678: e3e00000 mvn r0, #0 ; 0x0 + * 5967c: e8bd00f0 pop {r4, r5, r6, r7} + * 59680: e1a0f00e mov r15, r14 * 59684: e92d43f8 push {r3, r4, r5, r6, r7, r8, r9, r14} * 59688: eb000000 bl 0x59690 * 5968c: e8bd83f8 pop {r3, r4, r5, r6, r7, r8, r9, r15} @@ -322,3 +425,219 @@ * 59b7c: 14000410 strne r0, [r0], #-1040 * 59b80: 46335053 undefined */ + +void fn_59560(unsigned int arg1) +{ +} + +void fn_59578(unsigned int arg1, unsigned int arg2, unsigned int arg3, unsigned int arg4) +{ +} + +void fn_59788() +{ + fprintf(stderr,"error extracting...\n"); + exit(1); +} + +struct s_59b78 { + unsigned char *start; + unsigned char *stop; + unsigned char y; /* 8 */ + unsigned char x; /* 9 */ +}; + +unsigned int fn_59848(struct s_59b78 *data) +{ + return 0; +} + +unsigned int fn_598b4(struct s_59b78 *data, unsigned int arg2) +{ + return 0; +} + +void fn_5980c(unsigned int arg1, unsigned int mem[]) +{ + unsigned char *r1; + unsigned char *r2; + + r1 = (unsigned char*)mem[0]; + r2 = (unsigned char*)mem[1]; + + if (r1 >= r2) + fn_59788(); + + *r1 = arg1 & 0xff; + + r1++; + mem[0] = (unsigned int)r1; +} + +void fn_5993c(struct s_59b78 *data, unsigned int mem[]) +{ + unsigned int r5; + unsigned int r2; + unsigned int r4; + unsigned int r6; + unsigned int r7; + unsigned int r11; + unsigned char arr_59b64[1024]; + + r5 = 1; + + do { + do { + r2 = fn_59848(data); + if (r2 == 0) + break; + + r2 = fn_598b4(data, 8) & 0xff; + r4 = r2; + + fn_5980c(r4, mem); + arr_59b64[r5] = r4 & 0xff; + r2 = r5 + 1; + r2 = r2 << 22; + r2 = r2 >> 22; + r5 = r2; + } while(1); + + r11 = fn_598b4(data, 0x0a); + if(r11 == 0) + return; + + r2 = fn_598b4(data, 0x04); + r7 = r2 + 1; + r6 = 0; + do { + r2 = r6 + r11; + r2 = r2 << 22; + r2 = r2 >> 22; + r4 = arr_59b64[r2]; + fn_5980c(r4, mem); + arr_59b64[r5] = r4 & 0xff; + r2 = r5 + 1; + r2 = r2 << 22; + r2 = r2 >> 22; + r5 = r2; + r6++; + } while(r6 <= r7); + } while(1); +} + +unsigned int crc_check_59684(unsigned char *arg1, unsigned int arg2, unsigned int magic) +{ + unsigned int r3; + unsigned int r4; + unsigned int r5; + +#if 0 + if (r0 < 0xc0000000) + return 1; +#endif + + r4 = *((unsigned int*)arg1 + 0x20); + r5 = *((unsigned int*)arg1 + 0x24); + + if (r5 != magic) + return 2; + + if (arg2 >= r4) + r5 = 0; + else + return 3; + + r5 = ~rsb_crc(~0x00, arg1, r4); + r3 = *((unsigned int*)(arg1 + r4)); + printf("Checksums: 0x%02x <-> 0x%02x\n", r5, r3); + + if (r3 == r5) + return 0; + + return 4; +} + +void fn_59508() +{ +} + +void extract_lz_file(unsigned char *buf, unsigned char *name) +{ + unsigned char *r3; + unsigned int r5; + unsigned char *r7 = NULL; /* Arg1, mem start */ + unsigned char *r10 = NULL; /* Arg2, mem end */ + unsigned char *r11 = buf; /* Arg3 */ + struct s_59b78 struct1; + unsigned int arr_59b7c[1024]; + + r7 = malloc(1024*1024*1024); + r10 = r7 + (1024*1024*1024); + + if (r7 == NULL) { + perror("malloc"); + exit(1); + } + + fn_59578(0, 0, 0x3f, 0x33); + fn_59578(4, 0x10000000, 0x33, 0x366); + fn_59578(5, 0x14000000, 0x1b, 0x733); + fn_59578(7, 0xc0000000, 0x3b, 0x33); + fn_59560(0x1005); + + if (*((unsigned int*)r11) != LZ_MAGIC) + fn_59788(); + r3 = r11 + 4; + r5 = *((unsigned int*)r3); + printf(", Length: %d\n", r5); + + r3 = r7 + r5; + if (r3 > r10) + fn_59788(); + + struct1.start = r11 + 8; + struct1.stop = r5 + r11; + struct1.x = 0; + struct1.y = 0x80; + + arr_59b7c[0] = (unsigned int)r7; + arr_59b7c[1] = (unsigned int)(r5 + r7); + + fn_5993c(&struct1, arr_59b7c); + + r3 = r7 + 0x20; + r5 = *((unsigned int*)r3); + + if (crc_check_59684(r7, r5, 0x46335053) != 0) + fn_59788(); + + fn_59508(); + + free(r7); +} + +void search_lz_sections(unsigned char *fw, int len) +{ + int i; + unsigned char *j; + + for(i = 0; i < len - 4; i++) { + if (*((unsigned int*)(fw+i)) == LZ_MAGIC) { + j = fw + i - 1; + if (*j != 0x00) + continue; + printf("0x%02x: ", i); + j--; + while (j > fw) { + if (*j == 0x00) { + printf("%s", j+1); + extract_lz_file(fw + i, j+1); + break; + } + j--; + } + printf("\n"); + } + } +}