#include "util.h"

struct unpack_eat_t {
	FILE *fp;
	uint8_t len;
	uint16_t bits;
	uint8_t *dst;
};

static struct unpack_eat_t uneat;

static int next_bit(struct unpack_eat_t *u) {
	const int bit = (u->bits & (1 << (16 - u->len))) != 0;
	--u->len;
	if (u->len == 0) {
		u->bits = fread_le16(u->fp);
		u->len = 16;
	}
	return bit;
}

static int zero_bits(struct unpack_eat_t *u, int count) {
	int i = 0;
	for (; i < count; ++i) {
		if (next_bit(u)) {
			break;
		}
	}
	return i;
}

static uint8_t get_bits(struct unpack_eat_t *u, int count) {
	assert(count < 8);
	uint8_t val = 0;
	for (int i = 0; i < count; ++i) {
		val = (val << 1) | next_bit(u);
	}
	return val;
}

static void copy_reference(struct unpack_eat_t *u, int count, int offset_hi, int offset_lo) {
	const int16_t offset = offset_hi * 256 + offset_lo;
	for (int i = 0; i < count; ++i) {
		const uint8_t value = u->dst[offset];
		*u->dst++ = value;
	}
}

static int unpack_eat(FILE *in, struct unpack_eat_t *u) {
	uint8_t buffer[17];
	const int header_size = fread(buffer, 1, sizeof(buffer), in);
	if (header_size != 17 || READ_LE_UINT16(buffer + 4) != 0x899D || READ_LE_UINT16(buffer + 6) != 0x6C64) {
		print_error("Unexpected signature for .eat file");
		return 0;
	}
	const uint16_t crc = READ_LE_UINT16(buffer + 12);
	const int output_size = (buffer[14] << 14) + READ_LE_UINT16(buffer + 15);
	print_debug(DBG_UNPACK, "uncompressed size %d crc 0x%04x", output_size, crc);

	uint8_t *output_buffer = (uint8_t *)malloc(output_size);
	if (!output_buffer) {
		print_error("Failed to allocate EAT unpack buffer, %d bytes", output_size);
		return 0;
	}
	u->fp = in;
	u->dst = output_buffer;
	u->len = 16;
	u->bits = fread_le16(u->fp);
	while (1) {
		while (next_bit(u)) {
			*u->dst++ = fgetc(u->fp);
		}
		const int b = next_bit(u);
		const int offset_lo = fgetc(u->fp);
		if (b) {
			int offset_hi = 0xFE | next_bit(u);
			if (!next_bit(u)) {
				int i = 1;
				for (; i < 4 && !next_bit(u); ++i) {
					offset_hi = (offset_hi << 1) | next_bit(u);
				}
				offset_hi -= (1 << i);
			}
			const int n = zero_bits(u, 4);
			if (n != 4) {
				copy_reference(u, n + 3, offset_hi, offset_lo);
			} else if (next_bit(u)) {
				copy_reference(u, next_bit(u) + 7, offset_hi, offset_lo);
			} else if (!next_bit(u)) {
				copy_reference(u, get_bits(u, 3) + 9, offset_hi, offset_lo);
			} else {
				copy_reference(u, fgetc(u->fp) + 17, offset_hi, offset_lo);
			}
		} else {
			if (next_bit(u)) {
				const int offset_hi = (0xF8 | get_bits(u, 3)) - 1;
				copy_reference(u, 2, offset_hi, offset_lo);
			} else if (offset_lo == 0xFF) {
				break;
			} else {
				copy_reference(u, 2, 0xFF, offset_lo);
			}
		}
	}
	assert((u->dst - output_buffer) == output_size);
	u->dst = output_buffer;
	return output_size;
}

struct unpack_sqz_t {
	uint16_t top_code;
	uint8_t code_size;
	uint16_t new_codes;
	uint8_t *dst;
	int bits_left;
	uint32_t current_bits;
	uint8_t last_code;
	uint16_t previous_code;
	uint16_t prefix[0x1000];
	uint8_t str[0x1000];
	uint8_t stack[0x1000];
};

#define SQZ_CODE_WIDTH 9
#define SQZ_CODE_BASE (1 << (SQZ_CODE_WIDTH - 1))

static const int SQZ_CLEAR_CODE = SQZ_CODE_BASE;
static const int SQZ_END_CODE   = SQZ_CODE_BASE + 1;
static const int SQZ_NEW_CODES  = SQZ_CODE_BASE + 2;

static struct unpack_sqz_t unsqz;

static uint16_t unpack_sqz_get_bits(FILE *in, struct unpack_sqz_t *u, int count) {
	u->current_bits <<= 8;
	u->current_bits |= fgetc(in);
	u->bits_left += 8;
	if (u->bits_left < count) {
		u->current_bits <<= 8;
		u->current_bits |= fgetc(in);
		u->bits_left += 8;
	}
	const uint32_t code = u->current_bits >> (u->bits_left - count);
	u->bits_left -= count;
	u->current_bits &= (1 << u->bits_left) - 1;
	return code;
}

static uint16_t unpack_sqz_get_code(FILE *in, struct unpack_sqz_t *u) {
	if (u->top_code == u->new_codes && u->code_size != 12) {
		++u->code_size;
		u->top_code <<= 1;
	}
	return unpack_sqz_get_bits(in, u, u->code_size);
}

static uint16_t unpack_sqz_clear_code(FILE *in, struct unpack_sqz_t *u) {
	u->top_code = 1 << SQZ_CODE_WIDTH;
	u->code_size = SQZ_CODE_WIDTH;
	u->new_codes = SQZ_NEW_CODES;
	const uint16_t code = unpack_sqz_get_code(in, u);
	if (code != SQZ_END_CODE) {
		u->previous_code = code;
		*u->dst++ = u->last_code = code & 255;
	}
	return code;
}

static int unpack_sqz(FILE *in, struct unpack_sqz_t *u) {
	uint8_t buf[4];
	fread(buf, 1, sizeof(buf), in);
	assert((buf[1] & 0xF0) == 0x10);
	const int output_size = ((buf[0] & 15) << 16) | READ_LE_UINT16(buf + 2);
	print_debug(DBG_UNPACK, "SQZ uncompressed size %d", output_size);
	uint8_t *output_buffer = (uint8_t *)malloc(output_size);
	if (!output_buffer) {
		print_error("Failed to allocate SQZ unpack buffer, %d bytes", output_size);
		return 0;
	}
	u->dst = output_buffer;
	uint16_t code = unpack_sqz_clear_code(in, u);
	assert(code != SQZ_END_CODE);
	while (1) {
		code = unpack_sqz_get_code(in, u);
		if (code == SQZ_END_CODE) {
			print_debug(DBG_UNPACK, "lzw end code");
			break;
		} else if (code == SQZ_CLEAR_CODE) {
			print_debug(DBG_UNPACK, "lzw clear code");
			unpack_sqz_clear_code(in, u);
			continue;
		}
		const uint16_t current_code = code;
		uint8_t *sp = u->stack;
		if (u->new_codes <= code) {
			*sp++ = u->last_code;
			code = u->previous_code;
		}
		while (code >= SQZ_CODE_BASE) {
			*sp++ = u->str[code];
			code = u->prefix[code];
		}
		*sp++ = u->last_code = code & 255;
		do {
			--sp;
			*u->dst++ = *sp;
		} while (sp != u->stack);
		const uint16_t index = u->new_codes;
		if (index < 0x1000) {
			u->str[index] = u->last_code;
			u->prefix[index] = u->previous_code;
			++u->new_codes;
		}
		u->previous_code = current_code;
	}
	const int count = (u->dst - output_buffer);
	print_debug(DBG_UNPACK, "lzw output size %d (expected %d)", count, output_size);
	assert(count == output_size);
	u->dst = output_buffer;
	return count;
}

struct unpack_sqv_t {
	uint8_t dict_buf[0x200 * 2];
	uint8_t rd[0x1000];
	uint8_t *dst;
};

static struct unpack_sqv_t unsqv;

static int unpack_sqv(FILE *in, struct unpack_sqv_t *u) {

	fread(u->rd, 1, 6, in);
	const int uncompressed_size = (READ_LE_UINT16(u->rd) << 16) + READ_LE_UINT16(u->rd + 2);
	const int dict_len = READ_LE_UINT16(u->rd + 4);
	print_debug(DBG_UNPACK, "SQV uncompressed size %d dict_len %d", uncompressed_size, dict_len);
	assert(dict_len <= 0x400);
	fread(u->dict_buf, 1, dict_len, in);

	uint8_t *output_buffer = (uint8_t *)malloc(uncompressed_size);
	if (!output_buffer) {
		print_error("Failed to allocate SQV unpack buffer, %d bytes", uncompressed_size);
		return 0;
	}

	uint8_t *dst = output_buffer;

	const uint8_t *src = u->rd;
	int bits_count = 1;
	int bytes_count = 2;
	int state = 0;
	int count = 0;
	uint8_t code, prev;
	uint16_t bits = 0;
	uint16_t val = 0;
	while ((dst - output_buffer) < uncompressed_size) {
		--bits_count;
		if (bits_count == 0) {
			bytes_count -= 2;
			if (bytes_count == 0) {
				bytes_count = fread(u->rd, 1, 0x1000, in);
				if (bytes_count == 0) {
					break;
				}
				bytes_count += (bytes_count & 1);
				src = u->rd;
			}
			bits = READ_BE_UINT16(src); src += 2;
			bits_count = 16;
		}
		const bool carry = (bits & 0x8000) != 0;
		bits <<= 1;
		if (carry) {
			val += 2;
		}
		assert((val & 1) == 0);
		assert(val < dict_len);
		val = READ_LE_UINT16(u->dict_buf + val);
		if ((val & 0x8000) == 0) {
			continue;
		}
		val &= ~0x8000;
		switch (state) {
		case 0:
			code = val & 255;
			if (val >> 8) {
				switch (code) {
				case 0:
					state = 1;
					break;
				case 1:
					state = 2;
					break;
				default:
					memset(dst, prev, code);
					dst += code;
					break;
				}
			} else {
				*dst++ = prev = code;
			}
			break;
		case 1:
			memset(dst, prev, val);
			dst += val;
			state = 0;
			break;
		case 2:
			count = (val & 255) << 8;
			state = 3;
			break;
		case 3:
			count |= val & 255;
			memset(dst, prev, count);
			dst += count;
			state = 0;
			break;
		}
		val = 0;
	}
	assert((dst - output_buffer) == uncompressed_size);
	u->dst = output_buffer;
	return uncompressed_size;
}

uint8_t *unpack(FILE *in, int *uncompressed_size) {
	const uint16_t sig = fread_le16(in);
	fseek(in, 0, SEEK_SET);
	if (sig == 0x4CB4) {
		memset(&uneat, 0, sizeof(uneat));
		*uncompressed_size = unpack_eat(in, &uneat);
		return uneat.dst;
	} else if ((sig >> 8) == 0x10) {
		memset(&unsqz, 0, sizeof(unsqz));
		*uncompressed_size = unpack_sqz(in, &unsqz);
		return unsqz.dst;
	} else {
		memset(&unsqv, 0, sizeof(unsqv));
		*uncompressed_size = unpack_sqv(in, &unsqv);
		return unsqv.dst;
	}
	*uncompressed_size = 0;
	return 0;
}