update .gitignore (forgot it after last renaming...)

[rsbs2] / rsb-lz.c

#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 "filesystem.h"

void err_exit(const char *fname)
{
	fprintf(stderr,"%s: error extracting...\n", fname);
	exit(1);
}

struct data_in_s {
	unsigned char *start;
	unsigned char *stop;
	unsigned char bitpos;
	unsigned char byte;
};

struct data_out_s {
	unsigned char *pos;
	unsigned char *end;
};

unsigned char get_next_in_byte(struct data_in_s *data_in)
{
	unsigned char byte;

	if (data_in->stop < data_in->start)
		err_exit(__func__);

	byte = *(data_in->start);
	data_in->start++;

	return byte;
}

unsigned char get_next_bit(struct data_in_s *data_in)
{
	unsigned char bitval;

	if (data_in->bitpos == 0x80) {
		data_in->byte = get_next_in_byte(data_in);
	}

	bitval = data_in->bitpos & data_in->byte;

	data_in->bitpos >>= 1;
	if (data_in->bitpos == 0) {
		data_in->bitpos = 0x80;
	}

	if (bitval == 0)
		return 0;

	return 1;
}

unsigned int get_next_bits(struct data_in_s *data_in, unsigned int bits)
{
	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);
		}

		if ((data_in->bitpos & data_in->byte) != 0)
			next_bits = next_bits | bit;

		bit = bit >> 1;

		data_in->bitpos >>= 1;

		if(data_in->bitpos == 0) {
			data_in->bitpos = 0x80;
		}
	}

	return next_bits;
}

void write_byte(unsigned char byte, struct data_out_s *data_out)
{
	if (data_out->pos > data_out->end) {
		err_exit(__func__);
	}

	*(data_out->pos) = byte;
	data_out->pos++;
}

void lz_expand(struct data_in_s *data_in, struct data_out_s *data_out)
{
	unsigned int pos;
	unsigned int offset;
	unsigned int i;
	unsigned char byte;
	unsigned int num;
	unsigned char buf[1024];

	pos = 1;

	while (1) {
		while (1) {
			if (get_next_bit(data_in) == 0)
				break;

			byte = get_next_bits(data_in, 8);

			write_byte(byte, data_out);
			buf[pos] = byte;
			pos = (pos + 1) & 0x3ff;
		}

		offset = get_next_bits(data_in, 0x0a);
		if(offset == 0)
			return;

		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;
	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;
}
#endif

void extract_lz_file(unsigned char *inbuf, unsigned char *name)
{
	unsigned int len;
	unsigned char *outbuf;
	struct data_in_s data_in;
	struct data_out_s data_out;

	if (*((unsigned int*)inbuf) != LZ_MAGIC)
		err_exit(__func__);

	len = *((unsigned int*)(inbuf + 4));
	printf(", length: %d", len);

	if ((outbuf = malloc(len)) == NULL) {
		perror("malloc");
		exit(1);
	}

	bzero(outbuf, len);

	data_in.start = inbuf + 8;
	data_in.stop = inbuf + len;
	data_in.byte = 0x00;
	data_in.bitpos = 0x80;

	data_out.pos = outbuf;
	data_out.end = outbuf + len;

	lz_expand(&data_in, &data_out);

#if 0
	/* Checksum is only used for the compressed firmware in 'firmware' */
	r3 = r7 + 0x20;
	r5 = *((unsigned int*)r3);

	if ((ret = crc_check_59684(r7, r5, 0x46335053)) != 0) {
		printf("crc_check return: %d\n", ret);
		err_exit(__func__);
	}
#endif

	write_file((char*)name, outbuf, len);
	
	free(outbuf);
}