Created
August 26, 2016 20:26
-
-
Save thejsa/705a59a6c63989f752a32ce94b1849aa to your computer and use it in GitHub Desktop.
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
/*----------------------------------------------------------------------------*/ | |
/*-- blz.c - Bottom LZ coding for Nintendo GBA/DS --*/ | |
/*-- Copyright (C) 2011 CUE --*/ | |
/*-- --*/ | |
/*-- This program is free software: you can redistribute it and/or modify --*/ | |
/*-- it under the terms of the GNU General Public License as published by --*/ | |
/*-- the Free Software Foundation, either version 3 of the License, or --*/ | |
/*-- (at your option) any later version. --*/ | |
/*-- --*/ | |
/*-- This program is distributed in the hope that it will be useful, --*/ | |
/*-- but WITHOUT ANY WARRANTY; without even the implied warranty of --*/ | |
/*-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the --*/ | |
/*-- GNU General Public License for more details. --*/ | |
/*-- --*/ | |
/*-- You should have received a copy of the GNU General Public License --*/ | |
/*-- along with this program. If not, see <http://www.gnu.org/licenses/>. --*/ | |
/*----------------------------------------------------------------------------*/ | |
/*----------------------------------------------------------------------------*/ | |
#include <stdio.h> | |
#include <stdlib.h> | |
#include <string.h> | |
#define strcmpi strcasecmp | |
#include <sys/stat.h> | |
long filelength(int fd) | |
{ | |
struct stat st; | |
fstat(fd, &st); | |
return st.st_size; | |
} | |
/*----------------------------------------------------------------------------*/ | |
#define CMD_DECODE 0x00 // decode | |
#define CMD_ENCODE 0x01 // encode | |
#define BLZ_NORMAL 0 // normal mode | |
#define BLZ_BEST 1 // best mode | |
#define BLZ_SHIFT 1 // bits to shift | |
#define BLZ_MASK 0x80 // bits to check: | |
// ((((1 << BLZ_SHIFT) - 1) << (8 - BLZ_SHIFT) | |
#define BLZ_THRESHOLD 2 // max number of bytes to not encode | |
#define BLZ_N 0x1002 // max offset ((1 << 12) + 2) | |
#define BLZ_F 0x12 // max coded ((1 << 4) + BLZ_THRESHOLD) | |
#define RAW_MINIM 0x00000000 // empty file, 0 bytes | |
#define RAW_MAXIM 0x00FFFFFF // 3-bytes length, 16MB - 1 | |
#define BLZ_MINIM 0x00000004 // header only (empty RAW file) | |
#define BLZ_MAXIM 0x01400000 // 0x0120000A, padded to 20MB: | |
// * length, RAW_MAXIM | |
// * flags, (RAW_MAXIM + 7) / 8 | |
// * header, 11 | |
// 0x00FFFFFF + 0x00200000 + 12 + padding | |
/*----------------------------------------------------------------------------*/ | |
#define BREAK(text) { printf(text); return; } | |
#define EXIT(text) { printf(text); exit(-1); } | |
/*----------------------------------------------------------------------------*/ | |
void Title(void); | |
void Usage(void); | |
char *Load(char *filename, int *length, int min, int max); | |
void Save(char *filename, char *buffer, int length); | |
char *Memory(int length, int size); | |
void BLZ_Decode(char *filename); | |
void BLZ_Encode(char *filename, int mode); | |
char *BLZ_Code(unsigned char *raw_buffer, int raw_len, int *new_len, int best); | |
void BLZ_Invert(char *buffer, int length); | |
/*----------------------------------------------------------------------------*/ | |
int main(int argc, char **argv) { | |
int cmd, mode; | |
int arg; | |
Title(); | |
if (argc < 2) Usage(); | |
if (!strcmpi(argv[1], "-d")) { cmd = CMD_DECODE; } | |
else if (!strcmpi(argv[1], "-en")) { cmd = CMD_ENCODE; mode = BLZ_NORMAL; } | |
else if (!strcmpi(argv[1], "-eo")) { cmd = CMD_ENCODE; mode = BLZ_BEST; } | |
else EXIT("Command not supported\n"); | |
if (argc < 3) EXIT("Filename not specified\n"); | |
switch (cmd) { | |
case CMD_DECODE: | |
for (arg = 2; arg < argc; arg++) BLZ_Decode(argv[arg]); | |
break; | |
case CMD_ENCODE: | |
for (arg = 2; arg < argc; arg++) BLZ_Encode(argv[arg], mode); | |
break; | |
default: | |
break; | |
} | |
printf("\nDone\n"); | |
return(0); | |
} | |
/*----------------------------------------------------------------------------*/ | |
void Title(void) { | |
printf( | |
"\n" | |
"BLZ - (c) CUE 2011\n" | |
"Bottom LZ coding for Nintendo GBA/DS\n" | |
"\n" | |
); | |
} | |
/*----------------------------------------------------------------------------*/ | |
void Usage(void) { | |
EXIT( | |
"Usage: BLZ command filename [filename [...]]\n" | |
"\n" | |
"command:\n" | |
" -d .... decode 'filename'\n" | |
" -en ... encode 'filename', normal mode\n" | |
" -eo ... encode 'filename', optimal mode (LZ-CUE)\n" | |
"\n" | |
"* multiple filenames and wildcards are permitted\n" | |
"* the original file is overwritten with the new file\n" | |
"* this codification is used in the DS overlay files\n" | |
); | |
} | |
/*----------------------------------------------------------------------------*/ | |
char *Load(char *filename, int *length, int min, int max) { | |
FILE *fp; | |
int fs; | |
char *fb; | |
if ((fp = fopen(filename, "rb")) == NULL) EXIT("\nFile open error\n"); | |
fs = filelength(fileno(fp)); | |
if ((fs < min) || (fs > max)) EXIT("\nFile size error\n"); | |
fb = Memory(fs + 3, sizeof(char)); | |
if (fread(fb, 1, fs, fp) != fs) EXIT("\nFile read error\n"); | |
if (fclose(fp) == EOF) EXIT("\nFile close error\n"); | |
*length = fs; | |
return(fb); | |
} | |
/*----------------------------------------------------------------------------*/ | |
void Save(char *filename, char *buffer, int length) { | |
FILE *fp; | |
if ((fp = fopen(filename, "wb")) == NULL) EXIT("\nFile create error\n"); | |
if (fwrite(buffer, 1, length, fp) != length) EXIT("\nFile write error\n"); | |
if (fclose(fp) == EOF) EXIT("\nFile close error\n"); | |
} | |
/*----------------------------------------------------------------------------*/ | |
char *Memory(int length, int size) { | |
char *fb; | |
fb = (char *) calloc(length * size, size); | |
if (fb == NULL) EXIT("\nMemory error\n"); | |
return(fb); | |
} | |
/*----------------------------------------------------------------------------*/ | |
void BLZ_Decode(char *filename) { | |
unsigned char *pak_buffer, *raw_buffer, *pak, *raw, *pak_end, *raw_end; | |
unsigned int pak_len, raw_len, len, pos, inc_len, hdr_len, enc_len, dec_len; | |
unsigned char flags, mask; | |
printf("- decoding '%s'", filename); | |
pak_buffer = Load(filename, &pak_len, BLZ_MINIM, BLZ_MAXIM); | |
inc_len = *(unsigned int *)(pak_buffer + pak_len - 4); | |
if (!inc_len) { | |
enc_len = 0; | |
dec_len = pak_len - 4; | |
pak_len = 0; | |
raw_len = dec_len; | |
} else { | |
if (pak_len < 8) EXIT("File has a bad header\n"); | |
hdr_len = pak_buffer[pak_len - 5]; | |
if ((hdr_len < 0x08) || (hdr_len > 0x0B)) EXIT("Bad header length\n"); | |
if (pak_len <= hdr_len) EXIT("Bad length\n"); | |
enc_len = *(unsigned int *)(pak_buffer + pak_len - 8) & 0x00FFFFFF; | |
dec_len = pak_len - enc_len; | |
pak_len = enc_len - hdr_len; | |
raw_len = dec_len + enc_len + inc_len; | |
if (raw_len > RAW_MAXIM) EXIT("Bad decoded length\n"); | |
} | |
raw_buffer = (unsigned char *) Memory(raw_len, sizeof(char)); | |
pak = pak_buffer; | |
raw = raw_buffer; | |
pak_end = pak_buffer + dec_len + pak_len; | |
raw_end = raw_buffer + raw_len; | |
for (len = 0; len < dec_len; len++) *raw++ = *pak++; | |
BLZ_Invert(pak_buffer + dec_len, pak_len); | |
mask = 0; | |
while (raw < raw_end) { | |
if (!(mask >>= BLZ_SHIFT)) { | |
if (pak == pak_end) break; | |
flags = *pak++; | |
mask = BLZ_MASK; | |
} | |
if (!(flags & mask)) { | |
if (pak == pak_end) break; | |
*raw++ = *pak++; | |
} else { | |
if (pak + 1 >= pak_end) break; | |
pos = *pak++ << 8; | |
pos |= *pak++; | |
len = (pos >> 12) + BLZ_THRESHOLD + 1; | |
if (raw + len > raw_end) { | |
printf(", WARNING: wrong decoded length!"); | |
len = raw_end - raw; | |
} | |
pos = (pos & 0xFFF) + 3; | |
while (len--) *raw++ = *(raw - pos); | |
} | |
} | |
BLZ_Invert(raw_buffer + dec_len, raw_len - dec_len); | |
raw_len = raw - raw_buffer; | |
if (raw != raw_end) printf(", WARNING: unexpected end of encoded file!"); | |
Save(filename, raw_buffer, raw_len); | |
free(raw_buffer); | |
free(pak_buffer); | |
printf("\n"); | |
} | |
/*----------------------------------------------------------------------------*/ | |
void BLZ_Encode(char *filename, int mode) { | |
unsigned char *raw_buffer, *pak_buffer, *new_buffer; | |
unsigned int raw_len, pak_len, new_len; | |
printf("- encoding '%s'", filename); | |
raw_buffer = Load(filename, &raw_len, RAW_MINIM, RAW_MAXIM); | |
pak_buffer = NULL; | |
pak_len = BLZ_MAXIM + 1; | |
new_buffer = BLZ_Code(raw_buffer, raw_len, &new_len, mode); | |
if (new_len < pak_len) { | |
if (pak_buffer != NULL) free(pak_buffer); | |
pak_buffer = new_buffer; | |
pak_len = new_len; | |
} | |
Save(filename, pak_buffer, pak_len); | |
free(pak_buffer); | |
free(raw_buffer); | |
printf("\n"); | |
} | |
/*----------------------------------------------------------------------------*/ | |
char *BLZ_Code(unsigned char *raw_buffer, int raw_len, int *new_len, int best) { | |
unsigned char *pak_buffer, *pak, *raw, *raw_end, *flg, *tmp; | |
unsigned int pak_len, inc_len, hdr_len, enc_len, len, pos, max; | |
unsigned int len_best, pos_best, len_next, pos_next, len_post, pos_post; | |
unsigned int pak_tmp, raw_tmp; | |
unsigned char mask; | |
#define SEARCH(l,p) { \ | |
l = BLZ_THRESHOLD; \ | |
\ | |
max = raw - raw_buffer >= BLZ_N ? BLZ_N : raw - raw_buffer; \ | |
for (pos = 3; pos <= max; pos++) { \ | |
for (len = 0; len < BLZ_F; len++) { \ | |
if (raw + len == raw_end) break; \ | |
if (len >= pos) break; \ | |
if (*(raw + len) != *(raw + len - pos)) break; \ | |
} \ | |
\ | |
if (len > l) { \ | |
p = pos; \ | |
if ((l = len) == BLZ_F) break; \ | |
} \ | |
} \ | |
} | |
pak_tmp = 0; | |
raw_tmp = raw_len; | |
pak_len = raw_len + ((raw_len + 7) / 8) + 11; | |
pak_buffer = (unsigned char *) Memory(pak_len, sizeof(char)); | |
BLZ_Invert(raw_buffer, raw_len); | |
pak = pak_buffer; | |
raw = raw_buffer; | |
raw_end = raw_buffer + raw_len; | |
mask = 0; | |
while (raw < raw_end) { | |
if (!(mask >>= BLZ_SHIFT)) { | |
*(flg = pak++) = 0; | |
mask = BLZ_MASK; | |
} | |
SEARCH(len_best, pos_best); | |
// LZ-CUE optimization start | |
if (best) { | |
if (len_best > BLZ_THRESHOLD) { | |
if (raw + len_best < raw_end) { | |
raw += len_best; | |
SEARCH(len_next, pos_next); | |
raw -= len_best - 1; | |
SEARCH(len_post, pos_post); | |
raw--; | |
if (len_next <= BLZ_THRESHOLD) len_next = 1; | |
if (len_post <= BLZ_THRESHOLD) len_post = 1; | |
if (len_best + len_next <= 1 + len_post) len_best = 1; | |
} | |
} | |
} | |
// LZ-CUE optimization end | |
*flg <<= 1; | |
if (len_best > BLZ_THRESHOLD) { | |
raw += len_best; | |
*flg |= 1; | |
*pak++ = ((len_best - (BLZ_THRESHOLD+1)) << 4) | ((pos_best - 3) >> 8); | |
*pak++ = (pos_best - 3) & 0xFF; | |
} else { | |
*pak++ = *raw++; | |
} | |
if (pak - pak_buffer + raw_len - (raw - raw_buffer) < pak_tmp + raw_tmp) { | |
pak_tmp = pak - pak_buffer; | |
raw_tmp = raw_len - (raw - raw_buffer); | |
} | |
} | |
while (mask && (mask != 1)) { | |
mask >>= BLZ_SHIFT; | |
*flg <<= 1; | |
} | |
pak_len = pak - pak_buffer; | |
BLZ_Invert(raw_buffer, raw_len); | |
BLZ_Invert(pak_buffer, pak_len); | |
if (!pak_tmp || (raw_len + 4 < ((pak_tmp + raw_tmp + 3) & -4) + 8)) { | |
pak = pak_buffer; | |
raw = raw_buffer; | |
raw_end = raw_buffer + raw_len; | |
while (raw < raw_end) *pak++ = *raw++; | |
while ((pak - pak_buffer) & 3) *pak++ = 0; | |
*(unsigned int *)pak = 0; pak += 4; | |
} else { | |
tmp = (unsigned char *) Memory(raw_tmp + pak_tmp + 11, sizeof(char)); | |
for (len = 0; len < raw_tmp; len++) | |
tmp[len] = raw_buffer[len]; | |
for (len = 0; len < pak_tmp; len++) | |
tmp[raw_tmp + len] = pak_buffer[len + pak_len - pak_tmp]; | |
pak = pak_buffer; | |
pak_buffer = tmp; | |
free(pak); | |
pak = pak_buffer + raw_tmp + pak_tmp; | |
enc_len = pak_tmp; | |
hdr_len = 8; | |
inc_len = raw_len - pak_tmp - raw_tmp; | |
while ((pak - pak_buffer) & 3) { | |
*pak++ = 0xFF; | |
hdr_len++; | |
} | |
*(unsigned int *)pak = enc_len + hdr_len; pak += 3; | |
*pak++ = hdr_len; | |
*(unsigned int *)pak = inc_len - hdr_len; pak += 4; | |
} | |
*new_len = pak - pak_buffer; | |
return(pak_buffer); | |
} | |
/*----------------------------------------------------------------------------*/ | |
void BLZ_Invert(char *buffer, int length) { | |
char *bottom, ch; | |
bottom = buffer + length - 1; | |
while (buffer < bottom) { | |
ch = *buffer; | |
*buffer++ = *bottom; | |
*bottom-- = ch; | |
} | |
} | |
/*----------------------------------------------------------------------------*/ | |
/*-- EOF Copyright (C) 2011 CUE --*/ | |
/*----------------------------------------------------------------------------*/ |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment