]> git.zerfleddert.de Git - rsbs2/blobdiff - rsb-lz.c
more paranoia (check consistency after patching the image, too)
[rsbs2] / rsb-lz.c
index 495d8d855c92a5123bc3d0c7b4b1164ca8f61031..3e6e63820f6ab8c5251b367cac208e6c7d56f6b5 100644 (file)
--- a/rsb-lz.c
+++ b/rsb-lz.c
@@ -1,3 +1,13 @@
+#include <stdio.h>
+#include <stdlib.h>
+#include <strings.h>
+#include <string.h>
+#include <unistd.h>
+#include <errno.h>
+#include "rsb-crc.h"
+#include "rsb-lz.h"
+#include "extract.h"
+
 /* TODO: IMPLEMET THIS! */
 /* Probably very broken lzw implementation by Agilent:
  *
  * 59b7c:      14000410        strne   r0, [r0], #-1040
  * 59b80:      46335053        undefined
  */
+
+void fn_59788(const char *fname)
+{
+       fprintf(stderr,"%s: error extracting...\n", fname);
+       exit(1);
+}
+
+struct s_59b78 {
+       unsigned char *start; /* 0 */
+       unsigned char *stop; /* 4 */
+       unsigned char y; /* 8 */
+       unsigned char x; /* 9 */
+};
+
+unsigned char fn_597c8(struct s_59b78 *r6_data)
+{
+       unsigned char *r0;
+       unsigned char *r1;
+       unsigned char r5;
+
+       r5 = 0;
+
+       r0 = r6_data->start;
+       r1 = r6_data->stop;
+
+       if (r1 < r0)
+               fn_59788(__func__);
+
+       r5 = *r0;
+       r0++;
+       r6_data->start = r0;
+
+       return r5;
+}
+
+unsigned int fn_59848(struct s_59b78 *r6_data)
+{
+       unsigned char r1;
+       unsigned char r2;
+       unsigned int r5;
+
+       r1 = r6_data->y;
+       if (r1 == 0x80) {
+               r6_data->x = fn_597c8(r6_data);
+       }
+       r1 = r6_data->y;
+       r2 = r6_data->x;
+       r1 = r1 & r2;
+       r5 = r1 & 0xff;
+
+       r1 = r6_data->y;
+       r1 = r1 >> 1;
+       r6_data->y = r1;
+       if (r1 == 0) {
+               r1 = 0x80;
+               r6_data->y = r1;
+       }
+
+       if (r5 == 0)
+               return 0;
+
+       return 1;
+}
+
+unsigned int fn_598b4(struct s_59b78 *r11_data, unsigned int r10_arg2)
+{
+       unsigned int r1;
+       unsigned int r2;
+       unsigned int r6;
+       unsigned int r7;
+
+       r1 = r10_arg2 - 1;
+       r6 = 1 << r1;
+
+       r7 = 0;
+       while (r6 != 0) {
+               r1 = r11_data->y;
+               if (r1 == 0x80) {
+                       r1 = fn_597c8(r11_data);
+                       r11_data->x = r1;
+               }
+               r1 = r11_data->y;
+               r2 = r11_data->x;
+               r1 = r1 & r2;
+               if (r1 != 0)
+                       r7 = r7 | r6;
+
+               r6 = r6 >> 1;
+
+               r2 = r11_data->y;
+               r2 = r2 >> 1;
+               r11_data->y = r2;
+
+               r1 = r11_data->y;
+               if(r1 == 0) {
+                       r11_data->y = 0x80;
+               }
+       }
+
+       return r7;
+}
+
+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) {
+               printf("r1: 0x%08x, r2: 0x%08x\n", (unsigned int)r1, (unsigned int)r2);
+               fn_59788(__func__);
+       }
+
+       *r1 = arg1 & 0xff;
+
+       r1++;
+       mem[0] = (unsigned int)r1;
+}
+
+void fn_5993c(struct s_59b78 *r10_data, unsigned int r13_mem[])
+{
+       unsigned int r5;
+       unsigned int r2;
+       unsigned char r4;
+       unsigned int r6;
+       unsigned int r7;
+       unsigned int r11;
+       unsigned char arr_59b64[2048];
+
+       r5 = 1;
+
+       while (1) {
+               while (1) {
+                       r2 = fn_59848(r10_data);
+                       if (r2 == 0)
+                               break;
+
+                       r2 = fn_598b4(r10_data, 8) & 0xff;
+                       r4 = r2;
+
+                       fn_5980c(r4, r13_mem);
+                       arr_59b64[r5] = r4 & 0xff;
+                       r2 = r5 + 1;
+                       r2 = r2 << 22;
+                       r2 = r2 >> 22;
+                       r5 = r2;
+               }
+
+               r11 = fn_598b4(r10_data, 0x0a);
+               if(r11 == 0)
+                       return;
+
+               r2 = fn_598b4(r10_data, 0x04);
+               r7 = r2 + 1;
+               r6 = 0;
+               while (r6 <= r7) {
+                       r2 = r6 + r11;
+                       r2 = r2 << 22;
+                       r2 = r2 >> 22;
+                       r4 = arr_59b64[r2];
+                       fn_5980c(r4, r13_mem);
+                       arr_59b64[r5] = r4;
+                       r2 = r5 + 1;
+                       r2 = r2 << 22;
+                       r2 = r2 >> 22;
+                       r5 = r2;
+                       r6++;
+               }
+       }
+}
+
+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);
+
+       printf("magic: 0x%08x <-> 0x%08x\n", r5, magic);
+       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 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];
+
+       if (*((unsigned int*)r11) != LZ_MAGIC)
+               fn_59788(__func__);
+
+       r3 = r11 + 4;
+       r5 = *((unsigned int*)r3);
+       printf(", length: %d", r5);
+
+       if ((r7 = malloc(r5)) == NULL) {
+               perror("malloc");
+               exit(1);
+       }
+       r10 = r7 + r5;
+       bzero(r7, r5);
+
+       r3 = r7 + r5;
+       if (r3 > r10)
+               fn_59788(__func__);
+       
+       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);
+
+#if 0
+       /* This seems to still be completely broken */
+       r3 = r7 + 0x20;
+       r5 = *((unsigned int*)r3);
+
+       if ((ret = crc_check_59684(r7, r5, 0x46335053)) != 0) {
+               printf("crc_check return: %d\n", ret);
+               fn_59788(__func__);
+       }
+#endif
+
+       write_file((char*)name, r7, r5);
+       
+       free(r7);
+}
Impressum, Datenschutz