/source/vba/common/Patch.cpp
https://github.com/dborth/vbagx · C++ · 445 lines · 366 code · 69 blank · 10 comment · 149 complexity · f73114ce1c91c2b154a761dd225c52e1 MD5 · raw file
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <zlib.h>
-
- #include "Patch.h"
-
- #ifndef _MSC_VER
- #define _stricmp strcasecmp
- #endif // ! _MSC_VER
-
- static int readInt2(MFILE *f)
- {
- int res = 0;
- int c = memfgetc(f);
- if(c == MEOF)
- return -1;
- res = c;
- c = memfgetc(f);
- if(c == MEOF)
- return -1;
- return c + (res<<8);
- }
-
- static int readInt3(MFILE *f)
- {
- int res = 0;
- int c = memfgetc(f);
- if(c == MEOF)
- return -1;
- res = c;
- c = memfgetc(f);
- if(c == MEOF)
- return -1;
- res = c + (res<<8);
- c = memfgetc(f);
- if(c == MEOF)
- return -1;
- return c + (res<<8);
- }
-
- static s64 readInt4(MFILE *f)
- {
- s64 tmp, res = 0;
- int c;
-
- for (int i = 0; i < 4; i++) {
- c = memfgetc(f);
- if (c == MEOF)
- return -1;
- tmp = c;
- res = res + (tmp << (i*8));
- }
-
- return res;
- }
-
- static s64 readInt8(MFILE *f)
- {
- s64 tmp, res = 0;
- int c;
-
- for (int i = 0; i < 8; i++) {
- c = memfgetc(f);
- if (c == MEOF)
- return -1;
- tmp = c;
- res = res + (tmp << (i*8));
- }
-
- return res;
- }
-
- static s64 readVarPtr(MFILE *f)
- {
- s64 offset = 0, shift = 1;
- for (;;) {
- int c = memfgetc(f);
- if (c == MEOF) return 0;
- offset += (c & 0x7F) * shift;
- if (c & 0x80) break;
- shift <<= 7;
- offset += shift;
- }
- return offset;
- }
-
- #ifndef MIN
- #define MIN(a,b) (((a)<(b))?(a):(b))
- #endif
-
- static uLong computePatchCRC(MFILE *f, unsigned int size)
- {
- Bytef buf[4096];
- long readed;
-
- uLong crc = crc32(0L, Z_NULL, 0);
- do {
- readed = memfread(buf, 1, MIN(size, sizeof(buf)), f);
- crc = crc32(crc, buf, readed);
- size -= readed;
- } while (readed > 0);
- return crc;
- }
-
- bool patchApplyIPS(MFILE *f, u8 **r, int *s)
- {
- // from the IPS spec at http://zerosoft.zophar.net/ips.htm
-
- bool result = false;
-
- u8 *rom = *r;
- int size = *s;
- if(memfgetc(f) == 'P' &&
- memfgetc(f) == 'A' &&
- memfgetc(f) == 'T' &&
- memfgetc(f) == 'C' &&
- memfgetc(f) == 'H') {
- int b;
- int offset;
- int len;
-
- result = true;
-
- for(;;) {
- // read offset
- offset = readInt3(f);
- // if offset == MEOF, end of patch
- if(offset == 0x454f46 || offset == -1)
- break;
- // read length
- len = readInt2(f);
- if(!len) {
- // len == 0, RLE block
- len = readInt2(f);
- // byte to fill
- int c = memfgetc(f);
- if(c == -1)
- break;
- b = (u8)c;
- } else
- b= -1;
- // check if we need to reallocate our ROM
- if((offset + len) >= size) {
- #ifdef GEKKO
- size = offset + len;
- #else
- size *= 2;
- rom = (u8 *)realloc(rom, size);
- #endif
- *r = rom;
- *s = size;
- }
- if(b == -1) {
- // normal block, just read the data
- if(memfread(&rom[offset], 1, len, f) != (size_t)len)
- break;
- } else {
- // fill the region with the given byte
- while(len--) {
- rom[offset++] = b;
- }
- }
- }
- }
-
- return result;
- }
-
- bool patchApplyUPS(MFILE *f, u8 **rom, int *size)
- {
- s64 srcCRC, dstCRC, patchCRC;
-
- memfseek(f, 0, MSEEK_END);
- long int patchSize = memftell(f);
- if (patchSize < 20) {
- return false;
- }
-
- memfseek(f, 0, MSEEK_SET);
- if(memfgetc(f) != 'U' || memfgetc(f) != 'P' || memfgetc(f) != 'S' || memfgetc(f) != '1') {
- return false;
- }
-
- memfseek(f, -12, MSEEK_END);
- srcCRC = readInt4(f);
- dstCRC = readInt4(f);
- patchCRC = readInt4(f);
- if (srcCRC == -1 || dstCRC == -1 || patchCRC == -1) {
- return false;
- }
-
- memfseek(f, 0, MSEEK_SET);
- u32 crc = computePatchCRC(f, patchSize-4);
-
- if (crc != patchCRC) {
- return false;
- }
-
- crc = crc32(0L, Z_NULL, 0);
- crc = crc32(crc, *rom, *size);
-
- memfseek(f, 4, MSEEK_SET);
- s64 dataSize;
- s64 srcSize = readVarPtr(f);
- s64 dstSize = readVarPtr(f);
-
- if (crc == srcCRC) {
- if (srcSize != *size) {
- return false;
- }
- dataSize = dstSize;
- } else if (crc == dstCRC) {
- if (dstSize != *size) {
- return false;
- }
- dataSize = srcSize;
- } else {
- return false;
- }
- if (dataSize > *size) {
- *rom = (u8*)realloc(*rom, dataSize);
- memset(*rom + *size, 0, dataSize - *size);
- *size = dataSize;
- }
-
- s64 relative = 0;
- u8 *mem;
- while(memftell(f) < patchSize - 12) {
- relative += readVarPtr(f);
- if (relative > dataSize) continue;
- mem = *rom + relative;
- for(s64 i = relative; i < dataSize; i++) {
- int x = memfgetc(f);
- relative++;
- if (!x) break;
- if (i < dataSize) {
- *mem++ ^= x;
- }
- }
- }
-
- return true;
- }
-
- static int ppfVersion(MFILE *f)
- {
- memfseek(f, 0, MSEEK_SET);
- if (memfgetc(f) != 'P' || memfgetc(f) != 'P' || memfgetc(f) != 'F') //-V501
- return 0;
- switch(memfgetc(f)){
- case '1': return 1;
- case '2': return 2;
- case '3': return 3;
- default: return 0;
- }
- }
-
- static int ppfFileIdLen(MFILE *f, int version)
- {
- if (version == 2) {
- memfseek(f, -8, MSEEK_END);
- } else {
- memfseek(f, -6, MSEEK_END);
- }
-
- if (memfgetc(f) != '.' || memfgetc(f) != 'D' || memfgetc(f) != 'I' || memfgetc(f) != 'Z')
- return 0;
-
- return (version == 2) ? readInt4(f) : readInt2(f);
- }
-
- static bool patchApplyPPF1(MFILE *f, u8 **rom, int *size)
- {
- memfseek(f, 0, MSEEK_END);
- int count = memftell(f);
- if (count < 56)
- return false;
- count -= 56;
-
- memfseek(f, 56, MSEEK_SET);
-
- u8 *mem = *rom;
-
- while (count > 0) {
- int offset = readInt4(f);
- if (offset == -1)
- break;
- int len = memfgetc(f);
- if (len == MEOF)
- break;
- if (offset+len > *size)
- break;
- if (memfread(&mem[offset], 1, len, f) != (size_t)len)
- break;
- count -= 4 + 1 + len;
- }
-
- return (count == 0);
- }
-
- static bool patchApplyPPF2(MFILE *f, u8 **rom, int *size)
- {
- memfseek(f, 0, MSEEK_END);
- int count = memftell(f);
- if (count < 56+4+1024)
- return false;
- count -= 56+4+1024;
-
- memfseek(f, 56, MSEEK_SET);
-
- int datalen = readInt4(f);
- if (datalen != *size)
- return false;
-
- u8 *mem = *rom;
-
- u8 block[1024];
- memfread(&block, 1, 1024, f);
- if (memcmp(&mem[0x9320], &block, 1024) != 0)
- return false;
-
- int idlen = ppfFileIdLen(f, 2);
- if (idlen > 0)
- count -= 16 + 16 + idlen;
-
- memfseek(f, 56+4+1024, MSEEK_SET);
-
- while (count > 0) {
- int offset = readInt4(f);
- if (offset == -1)
- break;
- int len = memfgetc(f);
- if (len == MEOF)
- break;
- if (offset+len > *size)
- break;
- if (memfread(&mem[offset], 1, len, f) != (size_t)len)
- break;
- count -= 4 + 1 + len;
- }
-
- return (count == 0);
- }
-
- static bool patchApplyPPF3(MFILE *f, u8 **rom, int *size)
- {
- memfseek(f, 0, MSEEK_END);
- int count = memftell(f);
- if (count < 56+4+1024)
- return false;
- count -= 56+4;
-
- memfseek(f, 56, MSEEK_SET);
-
- int imagetype = memfgetc(f);
- int blockcheck = memfgetc(f);
- int undo = memfgetc(f);
- memfgetc(f);
-
- u8 *mem = *rom;
-
- if (blockcheck) {
- u8 block[1024];
- memfread(&block, 1, 1024, f);
- if (memcmp(&mem[(imagetype == 0) ? 0x9320 : 0x80A0], &block, 1024) != 0)
- return false;
- count -= 1024;
- }
-
- int idlen = ppfFileIdLen(f, 2);
- if (idlen > 0)
- count -= 16 + 16 + idlen;
-
- memfseek(f, 56+4+(blockcheck ? 1024 : 0), MSEEK_SET);
-
- while (count > 0) {
- s64 offset = readInt8(f);
- if (offset == -1)
- break;
- int len = memfgetc(f);
- if (len == MEOF)
- break;
- if (offset+len > *size)
- break;
- if (memfread(&mem[offset], 1, len, f) != (size_t)len)
- break;
- if (undo) memfseek(f, len, MSEEK_CUR);
- count -= 8 + 1 + len;
- if (undo) count -= len;
- }
-
- return (count == 0);
- }
-
- bool patchApplyPPF(MFILE *f, u8 **rom, int *size)
- {
- bool res = false;
-
- int version = ppfVersion(f);
- switch (version) {
- case 1: res = patchApplyPPF1(f, rom, size); break;
- case 2: res = patchApplyPPF2(f, rom, size); break;
- case 3: res = patchApplyPPF3(f, rom, size); break;
- }
-
- return res;
- }
-
- bool applyPatch(const char *patchname, u8 **rom, int *size)
- {
- bool result = false;
-
- if (strlen(patchname) < 5)
- return false;
- const char * p = strrchr(patchname, '.');
- if (p == NULL)
- return false;
-
- FILE *f = fopen(patchname, "rb");
- if (!f)
- return false;
-
- // read in file
- fseek(f, 0, SEEK_END); // go to end of file
- int filesize = ftell(f); // get filesize
- fseek(f, 0, SEEK_SET); // go to start of file
- char * pbuffer = (char *) malloc(filesize);
- fread (pbuffer, 1, filesize, f);
- fclose(f);
-
- MFILE * mf = memfopen(pbuffer, filesize); // create memory file
-
- if (_stricmp(p, ".ips") == 0)
- result = patchApplyIPS(mf, rom, size);
- else if (_stricmp(p, ".ups") == 0)
- result = patchApplyUPS(mf, rom, size);
- else if (_stricmp(p, ".ppf") == 0)
- result = patchApplyPPF(mf, rom, size);
-
- memfclose(mf); // close memory file
- free(pbuffer); // free buffer
-
- return result;
- }