X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/rsbs2/blobdiff_plain/e515e1d73160e0564fe39295664e4798072a6bc4..56a9a862f25a794fc7ef28f7a109762fe01d0c7c:/rsb-lz.c diff --git a/rsb-lz.c b/rsb-lz.c index b45f0f8..93e9d79 100644 --- a/rsb-lz.c +++ b/rsb-lz.c @@ -15,10 +15,10 @@ void err_exit(const char *fname) } struct data_in_s { - unsigned char *start; /* 0 */ - unsigned char *stop; /* 4 */ - unsigned char bit; /* 8 */ - unsigned char x; /* 9 */ + unsigned char *start; + unsigned char *stop; + unsigned char bitpos; + unsigned char byte; }; struct data_out_s { @@ -26,165 +26,117 @@ struct data_out_s { unsigned char *end; }; -unsigned char fn_597c8(struct data_in_s *r6_data) +unsigned char get_next_in_byte(struct data_in_s *data_in) { - unsigned char *r0; - unsigned char *r1; - unsigned char r5; + unsigned char byte; - r5 = 0; - - r0 = r6_data->start; - r1 = r6_data->stop; - - if (r1 < r0) + if (data_in->stop < data_in->start) err_exit(__func__); - r5 = *r0; - r0++; - r6_data->start = r0; + byte = *(data_in->start); + data_in->start++; - return r5; + return byte; } -unsigned int fn_59848(struct data_in_s *r6_data) +unsigned char get_next_bit(struct data_in_s *data_in) { - unsigned char r1; - unsigned char r2; - unsigned int r5; + unsigned char bitval; - r1 = r6_data->bit; - if (r1 == 0x80) { - r6_data->x = fn_597c8(r6_data); + if (data_in->bitpos == 0x80) { + data_in->byte = get_next_in_byte(data_in); } - r1 = r6_data->bit; - r2 = r6_data->x; - r1 = r1 & r2; - r5 = r1 & 0xff; - - r1 = r6_data->bit; - r1 = r1 >> 1; - r6_data->bit = r1; - if (r1 == 0) { - r1 = 0x80; - r6_data->bit = r1; + + bitval = data_in->bitpos & data_in->byte; + + data_in->bitpos >>= 1; + if (data_in->bitpos == 0) { + data_in->bitpos = 0x80; } - if (r5 == 0) + if (bitval == 0) return 0; return 1; } -unsigned int fn_598b4(struct data_in_s *r11_data, unsigned int r10_arg2) +unsigned int get_next_bits(struct data_in_s *data_in, unsigned int bits) { - 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->bit; - if (r1 == 0x80) { - r1 = fn_597c8(r11_data); - r11_data->x = r1; + unsigned int bit; + unsigned int next_bits; + + bit = 1 << (bits - 1); + + next_bits = 0; + while (bit != 0) { + if (data_in->bitpos == 0x80) { + data_in->byte = get_next_in_byte(data_in); } - r1 = r11_data->bit; - r2 = r11_data->x; - r1 = r1 & r2; - if (r1 != 0) - r7 = r7 | r6; - r6 = r6 >> 1; + if ((data_in->bitpos & data_in->byte) != 0) + next_bits = next_bits | bit; - r2 = r11_data->bit; - r2 = r2 >> 1; - r11_data->bit = r2; + bit = bit >> 1; - r1 = r11_data->bit; - if(r1 == 0) { - r11_data->bit = 0x80; + data_in->bitpos >>= 1; + + if(data_in->bitpos == 0) { + data_in->bitpos = 0x80; } } - return r7; + return next_bits; } -void fn_5980c(unsigned int arg1, struct data_out_s *data_out) +void write_byte(unsigned char byte, struct data_out_s *data_out) { - unsigned char *r1; - unsigned char *r2; - - r1 = data_out->pos; - r2 = data_out->end; - - if (r1 > r2) { - printf("r1: 0x%08x, r2: 0x%08x\n", (unsigned int)r1, (unsigned int)r2); + if (data_out->pos > data_out->end) { err_exit(__func__); } - *r1 = arg1 & 0xff; - - r1++; - data_out->pos = r1; + *(data_out->pos) = byte; + data_out->pos++; } -void lz_expand(struct data_in_s *r10_data, struct data_out_s *data_out) +void lz_expand(struct data_in_s *data_in, struct data_out_s *data_out) { - unsigned int r5; - unsigned int r2; - unsigned char r4; - unsigned int r6; - unsigned int r7; - unsigned int r11; - unsigned char arr_59b64[2048]; + unsigned int pos; + unsigned int offset; + unsigned int i; + unsigned char byte; + unsigned int num; + unsigned char buf[1024]; - r5 = 1; + pos = 1; while (1) { while (1) { - r2 = fn_59848(r10_data); - if (r2 == 0) + if (get_next_bit(data_in) == 0) break; - r2 = fn_598b4(r10_data, 8) & 0xff; - r4 = r2; + byte = get_next_bits(data_in, 8); - fn_5980c(r4, data_out); - arr_59b64[r5] = r4 & 0xff; - r2 = r5 + 1; - r2 = r2 << 22; - r2 = r2 >> 22; - r5 = r2; + write_byte(byte, data_out); + buf[pos] = byte; + pos = (pos + 1) & 0x3ff; } - r11 = fn_598b4(r10_data, 0x0a); - if(r11 == 0) + offset = get_next_bits(data_in, 0x0a); + if(offset == 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, data_out); - arr_59b64[r5] = r4; - r2 = r5 + 1; - r2 = r2 << 22; - r2 = r2 >> 22; - r5 = r2; - r6++; + num = get_next_bits(data_in, 0x04) + 1; + for (i = 0; i <= num; i++) { + byte = buf[(offset + i) & 0x3ff]; + write_byte(byte, data_out); + buf[pos] = byte; + pos = (pos + 1) & 0x3ff; } } } +/* Checksum is only used for the compressed firmware in 'firmware' */ +#if 0 unsigned int crc_check_59684(unsigned char *arg1, unsigned int arg2, unsigned int magic) { unsigned int r3; @@ -218,6 +170,7 @@ unsigned int crc_check_59684(unsigned char *arg1, unsigned int arg2, unsigned in return 4; } +#endif void extract_lz_file(unsigned char *inbuf, unsigned char *name) { @@ -241,8 +194,8 @@ void extract_lz_file(unsigned char *inbuf, unsigned char *name) data_in.start = inbuf + 8; data_in.stop = inbuf + len; - data_in.x = 0; - data_in.bit = 0x80; + data_in.byte = 0x00; + data_in.bitpos = 0x80; data_out.pos = outbuf; data_out.end = outbuf + len; @@ -250,7 +203,7 @@ void extract_lz_file(unsigned char *inbuf, unsigned char *name) lz_expand(&data_in, &data_out); #if 0 - /* This seems to still be completely broken */ + /* Checksum is only used for the compressed firmware in 'firmware' */ r3 = r7 + 0x20; r5 = *((unsigned int*)r3);