diff --git a/src/libvgmstream.vcxproj b/src/libvgmstream.vcxproj index 82824dc0..b5a8a41b 100644 --- a/src/libvgmstream.vcxproj +++ b/src/libvgmstream.vcxproj @@ -140,6 +140,7 @@ + @@ -174,6 +175,7 @@ + @@ -741,6 +743,7 @@ + diff --git a/src/libvgmstream.vcxproj.filters b/src/libvgmstream.vcxproj.filters index e8009d21..fe4f39b3 100644 --- a/src/libvgmstream.vcxproj.filters +++ b/src/libvgmstream.vcxproj.filters @@ -245,6 +245,9 @@ meta\Header Files + + meta\Header Files + meta\Header Files @@ -347,6 +350,9 @@ util\Header Files + + util\Header Files + util\Header Files @@ -2044,6 +2050,9 @@ util\Source Files + + util\Source Files + util\Source Files diff --git a/src/meta/adx_keys.h b/src/meta/adx_keys.h index f74f8cf8..acd79ce7 100644 --- a/src/meta/adx_keys.h +++ b/src/meta/adx_keys.h @@ -202,12 +202,15 @@ static const adxkey_info adxkey8_list[] = { /* Mirai Nikki: 13-ninme no Nikki Shoyuusha Re-Write (PSP) */ {0x58a3,0x66f5,0x599f, "FDRW17th",0}, - /* Shoujo Yoshitsune-den Ni - Toki wo Koeru Chigiri (PS2) */ + /* Shoujo Yoshitsune-den Ni: Toki wo Koeru Chigiri (PS2) */ {0x62d7,0x483d,0x4fb7, "YOSHI2",0}, - /* Junjou Romantica - Koi no Doki Doki Daisakusen (PS2) (Marvelous) */ + /* Junjou Romantica: Koi no Doki Doki Daisakusen (PS2) */ {0x5827,0x612d,0x5585, "Endress-SETSUNAI!",0}, + /* Corpse Party: Book of Shadows (PSP) */ + {0x60ad,0x5689,0x5281, "\x83\x76\x83\x89\x83\x60\x83\x69Lovers_Day",0}, // "プラチナLovers_Day" in SHIFT-JIS + }; static const adxkey_info adxkey9_list[] = { diff --git a/src/meta/ktsr.c b/src/meta/ktsr.c index dcc354af..8666e0c0 100644 --- a/src/meta/ktsr.c +++ b/src/meta/ktsr.c @@ -2,6 +2,7 @@ #include "../coding/coding.h" #include "../layout/layout.h" #include "../util/companion_files.h" +#include "ktsr_streamfile.h" typedef enum { NONE, MSADPCM, DSP, GCADPCM, ATRAC9, RIFF_ATRAC9, KOVS, KTSS, } ktsr_codec; @@ -231,15 +232,20 @@ fail: return NULL; } -// TODO improve, unity with other metas that do similar stuff +// TODO improve, unify with other metas that do similar stuff static VGMSTREAM* init_vgmstream_ktsr_sub(STREAMFILE* sf_b, ktsr_header* ktsr, VGMSTREAM* (*init_vgmstream)(STREAMFILE* sf), const char* ext) { VGMSTREAM* sub_vgmstream = NULL; - STREAMFILE* temp_sf = setup_subfile_streamfile(sf_b, ktsr->stream_offsets[0], ktsr->stream_sizes[0], ext); + STREAMFILE* temp_sf = NULL; + + temp_sf = setup_ktsr_streamfile(sf_b, ktsr->is_external, ktsr->stream_offsets[0], ktsr->stream_sizes[0], ext); if (!temp_sf) return NULL; sub_vgmstream = init_vgmstream(temp_sf); close_streamfile(temp_sf); - if (!sub_vgmstream) return NULL; + if (!sub_vgmstream) { + VGM_LOG("ktsr: can't open subfile at %x (size %x)\n", ktsr->stream_offsets[0], ktsr->stream_sizes[0]); + return NULL; + } sub_vgmstream->stream_size = ktsr->stream_sizes[0]; sub_vgmstream->num_streams = ktsr->total_subsongs; @@ -378,9 +384,11 @@ static int parse_ktsr_subfile(ktsr_header* ktsr, STREAMFILE* sf, uint32_t offset case 0x3DEA478D: /* external [Nioh (PC)] (smaller) */ case 0xDF92529F: /* external [Atelier Ryza (PC)] */ case 0x6422007C: /* external [Atelier Ryza (PC)] */ + case 0x793A1FD7: /* external [Stranger of Paradise (PS4)]-encrypted */ + case 0xA0F4FC6C: /* external [Stranger of Paradise (PS4)]-encrypted */ /* 08 subtype? (ex. 0x522B86B9) * 0c channels - * 10 ? (always 0x002706B8) + * 10 ? (always 0x002706B8 / 7864523D in SoP) * 14 external codec * 18 sample rate * 1c num samples diff --git a/src/meta/ktsr_streamfile.h b/src/meta/ktsr_streamfile.h new file mode 100644 index 00000000..b0cc027d --- /dev/null +++ b/src/meta/ktsr_streamfile.h @@ -0,0 +1,152 @@ +#ifndef _KTSR_STREAMFILE_H_ +#define _KTSR_STREAMFILE_H_ + +#include "../streamfile.h" +#include "../util/log.h" +#include "../util/cipher_blowfish.h" + +/* decrypts blowfish in realtime (as done by games) */ +typedef struct { + uint8_t key[0x20]; + uint8_t block[0x08]; + blowfish_ctx* ctx; +} ktsr_io_data; + +static int ktsr_io_init(STREAMFILE* sf, ktsr_io_data* data) { + /* ktsr keys start with size then random bytes (usually 7), assumed max 0x20 */ + if (data->key[0] >= sizeof(data->key) - 1) + return -1; + + data->ctx = blowfish_init_ecb(data->key + 1, data->key[0]); + if (!data->ctx) + return -1; + return 0; +} + +static void ktsr_io_close(STREAMFILE* sf, ktsr_io_data* data) { + blowfish_free(data->ctx); +} + + +static int read_part(STREAMFILE* sf, uint8_t* dest, off_t offset, size_t length, ktsr_io_data* data) { + + off_t offset_rem = offset % 0x08; + offset -= offset_rem; + + if (offset_rem == 0 && length >= 0x08) /* handled in main */ + return 0; + + /* read one full block, regardless of requested length */ + int bytes = read_streamfile(data->block, offset, 0x08, sf); + + /* useless since KTSR data is padded and blocks don't work otherwise but for determinability */ + if (bytes < 0x08) + memset(data->block + bytes, 0, 0x08 - bytes); + + blowfish_decrypt_ecb(data->ctx, data->block); + + int max_copy = bytes - offset_rem; + if (max_copy > length) + max_copy = length; + + memcpy(dest, data->block + offset_rem, max_copy); + + return max_copy; +} + +static int read_main(STREAMFILE* sf, uint8_t* dest, off_t offset, size_t length, ktsr_io_data* data) { + int read = 0; + + off_t offset_rem = offset % 0x08; + size_t length_rem = length % 0x08; + length -= length_rem; + + if (offset_rem != 0 || length == 0) /* handled in part */ + return 0; + + int bytes = read_streamfile(dest, offset, length, sf); + + while (read < bytes) { + blowfish_decrypt_ecb(data->ctx, dest); + dest += 0x08; + read += 0x08; + } + + return bytes; +} + +/* blowfish is a 64-bit block cipher, so arbitrary reads will need to handle partial cases. ex + * - reading 0x00 to 0x20: direct decrypt (4 blocks of 0x08) + * - reading 0x03 to 0x07: decrypt 0x00 to 0x08 but copy 4 bytes at 0x03 + * - reading 0x03 to 0x22: handle as 0x00 to 0x08 (head, copy 5 at 0x3), 0x08 to 0x20 (body, direct), and 0x20 to 0x28 (tail, copy 2 at 0x0). */ +static size_t ktsr_io_read(STREAMFILE* sf, uint8_t* dest, off_t offset, size_t length, ktsr_io_data* data) { + int bytes = 0; + + + /* head */ + if (length) { + int done = read_part(sf, dest, offset, length, data); + dest += done; + offset += done; + length -= done; + + bytes += done; + } + + /* body */ + if (length) { + int done = read_main(sf, dest, offset, length, data); + dest += done; + offset += done; + length -= done; + + bytes += done; + } + + /* tail */ + if (length) { + int done = read_part(sf, dest, offset, length, data); + dest += done; + offset += done; + length -= done; + + bytes += done; + } + + return bytes; +} + + + +/* Decrypts blowfish KTSR streams */ +static STREAMFILE* setup_ktsr_streamfile(STREAMFILE* sf, bool is_external, uint32_t subfile_offset, uint32_t subfile_size, const char* extension) { + STREAMFILE* new_sf = NULL; + ktsr_io_data io_data = {0}; + + if (is_external) { + uint32_t offset = 0x00; + if (is_id32be(0x00, sf, "TSRS")) + offset += 0x10; + if (!is_id32be(offset + 0x00, sf, "KTSR")) + goto fail; + + read_streamfile(io_data.key, offset + 0x20, sizeof(io_data.key), sf); + } + + /* setup subfile */ + new_sf = open_wrap_streamfile(sf); + + /* no apparent flag other than key at offset. Only data at subfile is encrypted, so this reader assumes it will be clamped */ + if (io_data.key[0] != 0) + new_sf = open_io_streamfile_ex_f(new_sf, &io_data, sizeof(ktsr_io_data), ktsr_io_read, NULL, ktsr_io_init, ktsr_io_close); + + new_sf = open_clamp_streamfile_f(new_sf, subfile_offset, subfile_size); + if (extension) + new_sf = open_fakename_streamfile_f(new_sf, NULL, extension); + + return new_sf; +fail: + return NULL; +} + +#endif diff --git a/src/meta/meta.h b/src/meta/meta.h index 8b97a6af..e4eda761 100644 --- a/src/meta/meta.h +++ b/src/meta/meta.h @@ -846,6 +846,7 @@ VGMSTREAM * init_vgmstream_nub_xma(STREAMFILE *streamFile); VGMSTREAM * init_vgmstream_nub_dsp(STREAMFILE * streamFile); VGMSTREAM * init_vgmstream_nub_idsp(STREAMFILE * streamFile); VGMSTREAM * init_vgmstream_nub_is14(STREAMFILE * streamFile); +VGMSTREAM* init_vgmstream_nub_caf(STREAMFILE* sf); VGMSTREAM* init_vgmstream_xwv_valve(STREAMFILE* sf); @@ -871,6 +872,7 @@ VGMSTREAM * init_vgmstream_tgc(STREAMFILE *streamFile); VGMSTREAM* init_vgmstream_kwb(STREAMFILE* sf); VGMSTREAM* init_vgmstream_xws(STREAMFILE* sf); +VGMSTREAM* init_vgmstream_snd_koei(STREAMFILE* sf); VGMSTREAM * init_vgmstream_lrmd(STREAMFILE* sf); diff --git a/src/meta/nub.c b/src/meta/nub.c index cec97abc..a309c8cb 100644 --- a/src/meta/nub.c +++ b/src/meta/nub.c @@ -30,7 +30,7 @@ VGMSTREAM* init_vgmstream_nub(STREAMFILE* sf) { goto fail; /* .nub: standard - * .nub2: rare [iDOLM@STER - Gravure For You (PS3)] */ + * .nub2: rare [iDOLM@STER: Gravure For You (PS3), Noby Noby Boy (iOS)] */ if (!check_extensions(sf, "nub,nub2")) goto fail; @@ -97,47 +97,52 @@ VGMSTREAM* init_vgmstream_nub(STREAMFILE* sf) { header_size = align_size_to_block(subheader_start + subheader_size, 0x10); switch(codec) { - case 0x00: /* (none) (xma1) */ + case 0x00: /* xma1 */ fake_ext = "xma"; init_vgmstream_function = init_vgmstream_nub_xma; break; - case 0x01: /* "wav\0" */ + case 0x01: fake_ext = "wav"; init_vgmstream_function = init_vgmstream_nub_wav; break; - case 0x02: /* "vag\0" */ + case 0x02: fake_ext = "vag"; init_vgmstream_function = init_vgmstream_nub_vag; break; - case 0x03: /* "at3\0" */ + case 0x03: fake_ext = "at3"; init_vgmstream_function = init_vgmstream_nub_at3; break; - case 0x04: /* "xma\0" (xma2 old) */ - case 0x08: /* "xma\0" (xma2 new) */ + case 0x04: /* xma2 old */ + case 0x08: /* xma2 new */ fake_ext = "xma"; init_vgmstream_function = init_vgmstream_nub_xma; break; - case 0x05: /* "dsp\0" */ + case 0x05: fake_ext = "dsp"; init_vgmstream_function = init_vgmstream_nub_dsp; break; - case 0x06: /* "idsp" */ + case 0x06: fake_ext = "idsp"; init_vgmstream_function = init_vgmstream_nub_idsp; break; - case 0x07: /* "is14" */ + case 0x07: fake_ext = "is14"; init_vgmstream_function = init_vgmstream_nub_is14; break; + case 0x09: + fake_ext = "caf"; + init_vgmstream_function = init_vgmstream_nub_caf; + break; + default: VGM_LOG("NUB: unknown codec %x\n", codec); goto fail; @@ -235,9 +240,10 @@ static STREAMFILE* setup_nub_streamfile(STREAMFILE* sf, off_t header_offset, siz //todo could be simplified -/* .nub wav - from Namco NUB archives [Ridge Racer 7 (PS3)] */ +/* .nub wav - from Namco NUB archives [Ridge Racer 7 (PS3), Noby Noby Boy (iOS)] */ VGMSTREAM* init_vgmstream_nub_wav(STREAMFILE* sf) { VGMSTREAM* vgmstream = NULL; + STREAMFILE* temp_sf = NULL; off_t start_offset; int loop_flag, channel_count, sample_rate; size_t data_size, loop_start, loop_length; @@ -246,10 +252,10 @@ VGMSTREAM* init_vgmstream_nub_wav(STREAMFILE* sf) { /* checks */ + if (!is_id32be(0x00,sf, "wav\0")) + return NULL; if (!check_extensions(sf, "wav,lwav")) - goto fail; - if (read_32bitBE(0x00,sf) != 0x77617600) /* "wav\0" "*/ - goto fail; + return NULL; if (guess_endian32(0x1c, sf)) { read_32bit = read_32bitBE; @@ -276,6 +282,21 @@ VGMSTREAM* init_vgmstream_nub_wav(STREAMFILE* sf) { start_offset = 0xD0; + /* seen in Noby Noby Boy (iOS), not sure about flags */ + if (is_id32be(start_offset, sf, "RIFF")) { + uint32_t subfile_offset = start_offset; + uint32_t subfile_size = read_32bitLE(subfile_offset + 0x04, sf) + 0x08; /* RIFF size */ + + temp_sf = setup_subfile_streamfile(sf, subfile_offset,subfile_size, NULL); + if (!temp_sf) goto fail; + + vgmstream = init_vgmstream_riff(temp_sf); + if (!vgmstream) goto fail; + + close_streamfile(temp_sf); + return vgmstream; + } + /* build the VGMSTREAM */ vgmstream = allocate_vgmstream(channel_count,loop_flag); @@ -296,6 +317,7 @@ VGMSTREAM* init_vgmstream_nub_wav(STREAMFILE* sf) { return vgmstream; fail: + close_streamfile(temp_sf); close_vgmstream(vgmstream); return NULL; } @@ -310,10 +332,10 @@ VGMSTREAM* init_vgmstream_nub_vag(STREAMFILE* sf) { /* checks */ + if (!is_id32be(0x00,sf, "vag\0")) + return NULL; if ( !check_extensions(sf, "vag")) - goto fail; - if (read_32bitBE(0x00,sf) != 0x76616700) /* "vag\0" */ - goto fail; + return NULL; if (guess_endian32(0x1c, sf)) { read_32bit = read_32bitBE; @@ -362,15 +384,13 @@ fail: VGMSTREAM* init_vgmstream_nub_at3(STREAMFILE* sf) { VGMSTREAM* vgmstream = NULL; STREAMFILE* temp_sf = NULL; - off_t subfile_offset = 0; - size_t subfile_size = 0; /* checks */ + if (!is_id32be(0x00,sf, "at3\0")) + return NULL; if (!check_extensions(sf,"at3")) - goto fail; - if (read_32bitBE(0x00,sf) != 0x61743300) /* "at3\0" */ - goto fail; + return NULL; /* info header */ /* 0x20: loop start (in samples) */ @@ -381,8 +401,8 @@ VGMSTREAM* init_vgmstream_nub_at3(STREAMFILE* sf) { /* format header: mini fmt (WAVEFORMATEX) + fact chunks LE (clone of RIFF's) */ /* we can just ignore and use RIFF at data start since it has the same info */ - subfile_offset = 0x100; - subfile_size = read_32bitLE(subfile_offset + 0x04, sf) + 0x08; /* RIFF size */ + uint32_t subfile_offset = 0x100; + uint32_t subfile_size = read_32bitLE(subfile_offset + 0x04, sf) + 0x08; /* RIFF size */ temp_sf = setup_subfile_streamfile(sf, subfile_offset,subfile_size, NULL); if (!temp_sf) goto fail; @@ -410,9 +430,9 @@ VGMSTREAM* init_vgmstream_nub_xma(STREAMFILE* sf) { /* checks */ if (!check_extensions(sf,"xma")) - goto fail; + return NULL; - if (read_32bitBE(0x00,sf) == 0x786D6100) { /* "xma\0" */ + if (is_id32be(0x00,sf, "xma\0")) { /* nub v2.1 */ nus_codec = read_32bitBE(0x0C,sf); data_size = read_32bitBE(0x14,sf); @@ -435,7 +455,7 @@ VGMSTREAM* init_vgmstream_nub_xma(STREAMFILE* sf) { chunk_size = header_size; } else { - goto fail; + return NULL; } start_offset = align_size_to_block(chunk_offset + header_size, 0x10); @@ -520,10 +540,10 @@ VGMSTREAM* init_vgmstream_nub_dsp(STREAMFILE* sf) { /* checks */ + if (!is_id32be(0x00,sf, "dsp\0")) + return NULL; if (!check_extensions(sf,"dsp")) - goto fail; - if (read_32bitBE(0x00,sf) != 0x64737000) /* "dsp\0" */ - goto fail; + return NULL; /* paste header+data together and pass to meta, which has loop info too */ header_offset = 0xBC; @@ -554,10 +574,10 @@ VGMSTREAM* init_vgmstream_nub_idsp(STREAMFILE* sf) { /* checks */ + if (!is_id32be(0x00,sf, "idsp")) + return NULL; if (!check_extensions(sf,"idsp")) - goto fail; - if (read_32bitBE(0x00,sf) != 0x69647370) /* "idsp" */ - goto fail; + return NULL; /* info header */ /* 0x20: loop start (in samples) */ @@ -595,10 +615,10 @@ VGMSTREAM* init_vgmstream_nub_is14(STREAMFILE* sf) { /* checks */ + if (!is_id32be(0x00,sf, "is14")) + return NULL; if (!check_extensions(sf,"is14")) - goto fail; - if (read_32bitBE(0x00,sf) != 0x69733134) /* "is14" */ - goto fail; + return NULL; if (guess_endian32(0x1c, sf)) { read_32bit = read_32bitBE; @@ -632,3 +652,41 @@ fail: close_vgmstream(vgmstream); return NULL; } + +/* .nub is14 - from Namco NUB archives [Noby Noby Boy (iOS)] */ +VGMSTREAM* init_vgmstream_nub_caf(STREAMFILE* sf) { + VGMSTREAM* vgmstream = NULL; + STREAMFILE* temp_sf = NULL; + + + /* checks */ + if (!is_id32be(0x00,sf, "caf\0")) + return NULL; + if (!check_extensions(sf,"caf")) + return NULL; + + /* info header */ + /* 0x20: loop start (in samples) */ + /* 0x24: loop length (in samples) */ + /* 0x28: loop flag */ + /* 0x2c: null */ + + /* format header: simplified caff with some chunks */ + /* we can just ignore and use caff at data start since it has the same info */ + + uint32_t subfile_offset = 0x110; + uint32_t subfile_size = read_u32le(0x14, sf); /* padded but not fully validated */ + + temp_sf = setup_subfile_streamfile(sf, subfile_offset, subfile_size, NULL); + if (!temp_sf) goto fail; + + vgmstream = init_vgmstream_apple_caff(temp_sf); + if (!vgmstream) goto fail; + + close_streamfile(temp_sf); + return vgmstream; +fail: + close_streamfile(temp_sf); + close_vgmstream(vgmstream); + return NULL; +} diff --git a/src/meta/psb.c b/src/meta/psb.c index f674627f..6ced033f 100644 --- a/src/meta/psb.c +++ b/src/meta/psb.c @@ -4,7 +4,7 @@ #include "../layout/layout.h" -#define PSB_MAX_LAYERS 2 +#define PSB_MAX_LAYERS 6 /* MGS Master Collection Vo.1 (Switch) */ typedef enum { PCM, RIFF_AT3, XMA2, MSADPCM, XWMA, DSP, OPUSNX, RIFF_AT9, VAG } psb_codec_t; typedef struct { diff --git a/src/util/cipher_blowfish.c b/src/util/cipher_blowfish.c new file mode 100644 index 00000000..bbbef254 --- /dev/null +++ b/src/util/cipher_blowfish.c @@ -0,0 +1,303 @@ +#include +#include "cipher_blowfish.h" +#include "reader_get.h" +#include "reader_put.h" + + +/* Simple blowfish implementation, mainly for learning purposes and not really optimized. + * Original algorithm: + * - https://www.schneier.com/academic/archives/1994/09/description_of_a_new.html + */ + +/* ~0x48 + 0x1008, could be done in stack */ +struct blowfish_ctx { + uint32_t P[18]; /* P-array */ + uint32_t S[4][256]; /* S-boxes */ +}; + + +/* hex calculation of the fractional part of pi, first P then S-boxes + * (not a base change but calc'd in hex directly, unsure about the algorithm). + * Pi was chosen for being a "nothing up my sleeves" number. */ +static const uint32_t INIT_P[18] = { /* 16 rounds + 2 extra positions */ + 0x243F6A88, 0x85A308D3, 0x13198A2E, 0x03707344, 0xA4093822, 0x299F31D0, 0x082EFA98, 0xEC4E6C89, + 0x452821E6, 0x38D01377, 0xBE5466CF, 0x34E90C6C, 0xC0AC29B7, 0xC97C50DD, 0x3F84D5B5, 0xB5470917, + 0x9216D5D9, 0x8979FB1B +}; + +static const uint32_t INIT_S[4][256] = { + { + 0xD1310BA6, 0x98DFB5AC, 0x2FFD72DB, 0xD01ADFB7, 0xB8E1AFED, 0x6A267E96, 0xBA7C9045, 0xF12C7F99, + 0x24A19947, 0xB3916CF7, 0x0801F2E2, 0x858EFC16, 0x636920D8, 0x71574E69, 0xA458FEA3, 0xF4933D7E, + 0x0D95748F, 0x728EB658, 0x718BCD58, 0x82154AEE, 0x7B54A41D, 0xC25A59B5, 0x9C30D539, 0x2AF26013, + 0xC5D1B023, 0x286085F0, 0xCA417918, 0xB8DB38EF, 0x8E79DCB0, 0x603A180E, 0x6C9E0E8B, 0xB01E8A3E, + 0xD71577C1, 0xBD314B27, 0x78AF2FDA, 0x55605C60, 0xE65525F3, 0xAA55AB94, 0x57489862, 0x63E81440, + 0x55CA396A, 0x2AAB10B6, 0xB4CC5C34, 0x1141E8CE, 0xA15486AF, 0x7C72E993, 0xB3EE1411, 0x636FBC2A, + 0x2BA9C55D, 0x741831F6, 0xCE5C3E16, 0x9B87931E, 0xAFD6BA33, 0x6C24CF5C, 0x7A325381, 0x28958677, + 0x3B8F4898, 0x6B4BB9AF, 0xC4BFE81B, 0x66282193, 0x61D809CC, 0xFB21A991, 0x487CAC60, 0x5DEC8032, + 0xEF845D5D, 0xE98575B1, 0xDC262302, 0xEB651B88, 0x23893E81, 0xD396ACC5, 0x0F6D6FF3, 0x83F44239, + 0x2E0B4482, 0xA4842004, 0x69C8F04A, 0x9E1F9B5E, 0x21C66842, 0xF6E96C9A, 0x670C9C61, 0xABD388F0, + 0x6A51A0D2, 0xD8542F68, 0x960FA728, 0xAB5133A3, 0x6EEF0B6C, 0x137A3BE4, 0xBA3BF050, 0x7EFB2A98, + 0xA1F1651D, 0x39AF0176, 0x66CA593E, 0x82430E88, 0x8CEE8619, 0x456F9FB4, 0x7D84A5C3, 0x3B8B5EBE, + 0xE06F75D8, 0x85C12073, 0x401A449F, 0x56C16AA6, 0x4ED3AA62, 0x363F7706, 0x1BFEDF72, 0x429B023D, + 0x37D0D724, 0xD00A1248, 0xDB0FEAD3, 0x49F1C09B, 0x075372C9, 0x80991B7B, 0x25D479D8, 0xF6E8DEF7, + 0xE3FE501A, 0xB6794C3B, 0x976CE0BD, 0x04C006BA, 0xC1A94FB6, 0x409F60C4, 0x5E5C9EC2, 0x196A2463, + 0x68FB6FAF, 0x3E6C53B5, 0x1339B2EB, 0x3B52EC6F, 0x6DFC511F, 0x9B30952C, 0xCC814544, 0xAF5EBD09, + 0xBEE3D004, 0xDE334AFD, 0x660F2807, 0x192E4BB3, 0xC0CBA857, 0x45C8740F, 0xD20B5F39, 0xB9D3FBDB, + 0x5579C0BD, 0x1A60320A, 0xD6A100C6, 0x402C7279, 0x679F25FE, 0xFB1FA3CC, 0x8EA5E9F8, 0xDB3222F8, + 0x3C7516DF, 0xFD616B15, 0x2F501EC8, 0xAD0552AB, 0x323DB5FA, 0xFD238760, 0x53317B48, 0x3E00DF82, + 0x9E5C57BB, 0xCA6F8CA0, 0x1A87562E, 0xDF1769DB, 0xD542A8F6, 0x287EFFC3, 0xAC6732C6, 0x8C4F5573, + 0x695B27B0, 0xBBCA58C8, 0xE1FFA35D, 0xB8F011A0, 0x10FA3D98, 0xFD2183B8, 0x4AFCB56C, 0x2DD1D35B, + 0x9A53E479, 0xB6F84565, 0xD28E49BC, 0x4BFB9790, 0xE1DDF2DA, 0xA4CB7E33, 0x62FB1341, 0xCEE4C6E8, + 0xEF20CADA, 0x36774C01, 0xD07E9EFE, 0x2BF11FB4, 0x95DBDA4D, 0xAE909198, 0xEAAD8E71, 0x6B93D5A0, + 0xD08ED1D0, 0xAFC725E0, 0x8E3C5B2F, 0x8E7594B7, 0x8FF6E2FB, 0xF2122B64, 0x8888B812, 0x900DF01C, + 0x4FAD5EA0, 0x688FC31C, 0xD1CFF191, 0xB3A8C1AD, 0x2F2F2218, 0xBE0E1777, 0xEA752DFE, 0x8B021FA1, + 0xE5A0CC0F, 0xB56F74E8, 0x18ACF3D6, 0xCE89E299, 0xB4A84FE0, 0xFD13E0B7, 0x7CC43B81, 0xD2ADA8D9, + 0x165FA266, 0x80957705, 0x93CC7314, 0x211A1477, 0xE6AD2065, 0x77B5FA86, 0xC75442F5, 0xFB9D35CF, + 0xEBCDAF0C, 0x7B3E89A0, 0xD6411BD3, 0xAE1E7E49, 0x00250E2D, 0x2071B35E, 0x226800BB, 0x57B8E0AF, + 0x2464369B, 0xF009B91E, 0x5563911D, 0x59DFA6AA, 0x78C14389, 0xD95A537F, 0x207D5BA2, 0x02E5B9C5, + 0x83260376, 0x6295CFA9, 0x11C81968, 0x4E734A41, 0xB3472DCA, 0x7B14A94A, 0x1B510052, 0x9A532915, + 0xD60F573F, 0xBC9BC6E4, 0x2B60A476, 0x81E67400, 0x08BA6FB5, 0x571BE91F, 0xF296EC6B, 0x2A0DD915, + 0xB6636521, 0xE7B9F9B6, 0xFF34052E, 0xC5855664, 0x53B02D5D, 0xA99F8FA1, 0x08BA4799, 0x6E85076A, + }, + { + 0x4B7A70E9, 0xB5B32944, 0xDB75092E, 0xC4192623, 0xAD6EA6B0, 0x49A7DF7D, 0x9CEE60B8, 0x8FEDB266, + 0xECAA8C71, 0x699A17FF, 0x5664526C, 0xC2B19EE1, 0x193602A5, 0x75094C29, 0xA0591340, 0xE4183A3E, + 0x3F54989A, 0x5B429D65, 0x6B8FE4D6, 0x99F73FD6, 0xA1D29C07, 0xEFE830F5, 0x4D2D38E6, 0xF0255DC1, + 0x4CDD2086, 0x8470EB26, 0x6382E9C6, 0x021ECC5E, 0x09686B3F, 0x3EBAEFC9, 0x3C971814, 0x6B6A70A1, + 0x687F3584, 0x52A0E286, 0xB79C5305, 0xAA500737, 0x3E07841C, 0x7FDEAE5C, 0x8E7D44EC, 0x5716F2B8, + 0xB03ADA37, 0xF0500C0D, 0xF01C1F04, 0x0200B3FF, 0xAE0CF51A, 0x3CB574B2, 0x25837A58, 0xDC0921BD, + 0xD19113F9, 0x7CA92FF6, 0x94324773, 0x22F54701, 0x3AE5E581, 0x37C2DADC, 0xC8B57634, 0x9AF3DDA7, + 0xA9446146, 0x0FD0030E, 0xECC8C73E, 0xA4751E41, 0xE238CD99, 0x3BEA0E2F, 0x3280BBA1, 0x183EB331, + 0x4E548B38, 0x4F6DB908, 0x6F420D03, 0xF60A04BF, 0x2CB81290, 0x24977C79, 0x5679B072, 0xBCAF89AF, + 0xDE9A771F, 0xD9930810, 0xB38BAE12, 0xDCCF3F2E, 0x5512721F, 0x2E6B7124, 0x501ADDE6, 0x9F84CD87, + 0x7A584718, 0x7408DA17, 0xBC9F9ABC, 0xE94B7D8C, 0xEC7AEC3A, 0xDB851DFA, 0x63094366, 0xC464C3D2, + 0xEF1C1847, 0x3215D908, 0xDD433B37, 0x24C2BA16, 0x12A14D43, 0x2A65C451, 0x50940002, 0x133AE4DD, + 0x71DFF89E, 0x10314E55, 0x81AC77D6, 0x5F11199B, 0x043556F1, 0xD7A3C76B, 0x3C11183B, 0x5924A509, + 0xF28FE6ED, 0x97F1FBFA, 0x9EBABF2C, 0x1E153C6E, 0x86E34570, 0xEAE96FB1, 0x860E5E0A, 0x5A3E2AB3, + 0x771FE71C, 0x4E3D06FA, 0x2965DCB9, 0x99E71D0F, 0x803E89D6, 0x5266C825, 0x2E4CC978, 0x9C10B36A, + 0xC6150EBA, 0x94E2EA78, 0xA5FC3C53, 0x1E0A2DF4, 0xF2F74EA7, 0x361D2B3D, 0x1939260F, 0x19C27960, + 0x5223A708, 0xF71312B6, 0xEBADFE6E, 0xEAC31F66, 0xE3BC4595, 0xA67BC883, 0xB17F37D1, 0x018CFF28, + 0xC332DDEF, 0xBE6C5AA5, 0x65582185, 0x68AB9802, 0xEECEA50F, 0xDB2F953B, 0x2AEF7DAD, 0x5B6E2F84, + 0x1521B628, 0x29076170, 0xECDD4775, 0x619F1510, 0x13CCA830, 0xEB61BD96, 0x0334FE1E, 0xAA0363CF, + 0xB5735C90, 0x4C70A239, 0xD59E9E0B, 0xCBAADE14, 0xEECC86BC, 0x60622CA7, 0x9CAB5CAB, 0xB2F3846E, + 0x648B1EAF, 0x19BDF0CA, 0xA02369B9, 0x655ABB50, 0x40685A32, 0x3C2AB4B3, 0x319EE9D5, 0xC021B8F7, + 0x9B540B19, 0x875FA099, 0x95F7997E, 0x623D7DA8, 0xF837889A, 0x97E32D77, 0x11ED935F, 0x16681281, + 0x0E358829, 0xC7E61FD6, 0x96DEDFA1, 0x7858BA99, 0x57F584A5, 0x1B227263, 0x9B83C3FF, 0x1AC24696, + 0xCDB30AEB, 0x532E3054, 0x8FD948E4, 0x6DBC3128, 0x58EBF2EF, 0x34C6FFEA, 0xFE28ED61, 0xEE7C3C73, + 0x5D4A14D9, 0xE864B7E3, 0x42105D14, 0x203E13E0, 0x45EEE2B6, 0xA3AAABEA, 0xDB6C4F15, 0xFACB4FD0, + 0xC742F442, 0xEF6ABBB5, 0x654F3B1D, 0x41CD2105, 0xD81E799E, 0x86854DC7, 0xE44B476A, 0x3D816250, + 0xCF62A1F2, 0x5B8D2646, 0xFC8883A0, 0xC1C7B6A3, 0x7F1524C3, 0x69CB7492, 0x47848A0B, 0x5692B285, + 0x095BBF00, 0xAD19489D, 0x1462B174, 0x23820E00, 0x58428D2A, 0x0C55F5EA, 0x1DADF43E, 0x233F7061, + 0x3372F092, 0x8D937E41, 0xD65FECF1, 0x6C223BDB, 0x7CDE3759, 0xCBEE7460, 0x4085F2A7, 0xCE77326E, + 0xA6078084, 0x19F8509E, 0xE8EFD855, 0x61D99735, 0xA969A7AA, 0xC50C06C2, 0x5A04ABFC, 0x800BCADC, + 0x9E447A2E, 0xC3453484, 0xFDD56705, 0x0E1E9EC9, 0xDB73DBD3, 0x105588CD, 0x675FDA79, 0xE3674340, + 0xC5C43465, 0x713E38D8, 0x3D28F89E, 0xF16DFF20, 0x153E21E7, 0x8FB03D4A, 0xE6E39F2B, 0xDB83ADF7, + }, + { + 0xE93D5A68, 0x948140F7, 0xF64C261C, 0x94692934, 0x411520F7, 0x7602D4F7, 0xBCF46B2E, 0xD4A20068, + 0xD4082471, 0x3320F46A, 0x43B7D4B7, 0x500061AF, 0x1E39F62E, 0x97244546, 0x14214F74, 0xBF8B8840, + 0x4D95FC1D, 0x96B591AF, 0x70F4DDD3, 0x66A02F45, 0xBFBC09EC, 0x03BD9785, 0x7FAC6DD0, 0x31CB8504, + 0x96EB27B3, 0x55FD3941, 0xDA2547E6, 0xABCA0A9A, 0x28507825, 0x530429F4, 0x0A2C86DA, 0xE9B66DFB, + 0x68DC1462, 0xD7486900, 0x680EC0A4, 0x27A18DEE, 0x4F3FFEA2, 0xE887AD8C, 0xB58CE006, 0x7AF4D6B6, + 0xAACE1E7C, 0xD3375FEC, 0xCE78A399, 0x406B2A42, 0x20FE9E35, 0xD9F385B9, 0xEE39D7AB, 0x3B124E8B, + 0x1DC9FAF7, 0x4B6D1856, 0x26A36631, 0xEAE397B2, 0x3A6EFA74, 0xDD5B4332, 0x6841E7F7, 0xCA7820FB, + 0xFB0AF54E, 0xD8FEB397, 0x454056AC, 0xBA489527, 0x55533A3A, 0x20838D87, 0xFE6BA9B7, 0xD096954B, + 0x55A867BC, 0xA1159A58, 0xCCA92963, 0x99E1DB33, 0xA62A4A56, 0x3F3125F9, 0x5EF47E1C, 0x9029317C, + 0xFDF8E802, 0x04272F70, 0x80BB155C, 0x05282CE3, 0x95C11548, 0xE4C66D22, 0x48C1133F, 0xC70F86DC, + 0x07F9C9EE, 0x41041F0F, 0x404779A4, 0x5D886E17, 0x325F51EB, 0xD59BC0D1, 0xF2BCC18F, 0x41113564, + 0x257B7834, 0x602A9C60, 0xDFF8E8A3, 0x1F636C1B, 0x0E12B4C2, 0x02E1329E, 0xAF664FD1, 0xCAD18115, + 0x6B2395E0, 0x333E92E1, 0x3B240B62, 0xEEBEB922, 0x85B2A20E, 0xE6BA0D99, 0xDE720C8C, 0x2DA2F728, + 0xD0127845, 0x95B794FD, 0x647D0862, 0xE7CCF5F0, 0x5449A36F, 0x877D48FA, 0xC39DFD27, 0xF33E8D1E, + 0x0A476341, 0x992EFF74, 0x3A6F6EAB, 0xF4F8FD37, 0xA812DC60, 0xA1EBDDF8, 0x991BE14C, 0xDB6E6B0D, + 0xC67B5510, 0x6D672C37, 0x2765D43B, 0xDCD0E804, 0xF1290DC7, 0xCC00FFA3, 0xB5390F92, 0x690FED0B, + 0x667B9FFB, 0xCEDB7D9C, 0xA091CF0B, 0xD9155EA3, 0xBB132F88, 0x515BAD24, 0x7B9479BF, 0x763BD6EB, + 0x37392EB3, 0xCC115979, 0x8026E297, 0xF42E312D, 0x6842ADA7, 0xC66A2B3B, 0x12754CCC, 0x782EF11C, + 0x6A124237, 0xB79251E7, 0x06A1BBE6, 0x4BFB6350, 0x1A6B1018, 0x11CAEDFA, 0x3D25BDD8, 0xE2E1C3C9, + 0x44421659, 0x0A121386, 0xD90CEC6E, 0xD5ABEA2A, 0x64AF674E, 0xDA86A85F, 0xBEBFE988, 0x64E4C3FE, + 0x9DBC8057, 0xF0F7C086, 0x60787BF8, 0x6003604D, 0xD1FD8346, 0xF6381FB0, 0x7745AE04, 0xD736FCCC, + 0x83426B33, 0xF01EAB71, 0xB0804187, 0x3C005E5F, 0x77A057BE, 0xBDE8AE24, 0x55464299, 0xBF582E61, + 0x4E58F48F, 0xF2DDFDA2, 0xF474EF38, 0x8789BDC2, 0x5366F9C3, 0xC8B38E74, 0xB475F255, 0x46FCD9B9, + 0x7AEB2661, 0x8B1DDF84, 0x846A0E79, 0x915F95E2, 0x466E598E, 0x20B45770, 0x8CD55591, 0xC902DE4C, + 0xB90BACE1, 0xBB8205D0, 0x11A86248, 0x7574A99E, 0xB77F19B6, 0xE0A9DC09, 0x662D09A1, 0xC4324633, + 0xE85A1F02, 0x09F0BE8C, 0x4A99A025, 0x1D6EFE10, 0x1AB93D1D, 0x0BA5A4DF, 0xA186F20F, 0x2868F169, + 0xDCB7DA83, 0x573906FE, 0xA1E2CE9B, 0x4FCD7F52, 0x50115E01, 0xA70683FA, 0xA002B5C4, 0x0DE6D027, + 0x9AF88C27, 0x773F8641, 0xC3604C06, 0x61A806B5, 0xF0177A28, 0xC0F586E0, 0x006058AA, 0x30DC7D62, + 0x11E69ED7, 0x2338EA63, 0x53C2DD94, 0xC2C21634, 0xBBCBEE56, 0x90BCB6DE, 0xEBFC7DA1, 0xCE591D76, + 0x6F05E409, 0x4B7C0188, 0x39720A3D, 0x7C927C24, 0x86E3725F, 0x724D9DB9, 0x1AC15BB4, 0xD39EB8FC, + 0xED545578, 0x08FCA5B5, 0xD83D7CD3, 0x4DAD0FC4, 0x1E50EF5E, 0xB161E6F8, 0xA28514D9, 0x6C51133C, + 0x6FD5C7E7, 0x56E14EC4, 0x362ABFCE, 0xDDC6C837, 0xD79A3234, 0x92638212, 0x670EFA8E, 0x406000E0, + }, + { 0x3A39CE37, 0xD3FAF5CF, 0xABC27737, 0x5AC52D1B, 0x5CB0679E, 0x4FA33742, 0xD3822740, 0x99BC9BBE, + 0xD5118E9D, 0xBF0F7315, 0xD62D1C7E, 0xC700C47B, 0xB78C1B6B, 0x21A19045, 0xB26EB1BE, 0x6A366EB4, + 0x5748AB2F, 0xBC946E79, 0xC6A376D2, 0x6549C2C8, 0x530FF8EE, 0x468DDE7D, 0xD5730A1D, 0x4CD04DC6, + 0x2939BBDB, 0xA9BA4650, 0xAC9526E8, 0xBE5EE304, 0xA1FAD5F0, 0x6A2D519A, 0x63EF8CE2, 0x9A86EE22, + 0xC089C2B8, 0x43242EF6, 0xA51E03AA, 0x9CF2D0A4, 0x83C061BA, 0x9BE96A4D, 0x8FE51550, 0xBA645BD6, + 0x2826A2F9, 0xA73A3AE1, 0x4BA99586, 0xEF5562E9, 0xC72FEFD3, 0xF752F7DA, 0x3F046F69, 0x77FA0A59, + 0x80E4A915, 0x87B08601, 0x9B09E6AD, 0x3B3EE593, 0xE990FD5A, 0x9E34D797, 0x2CF0B7D9, 0x022B8B51, + 0x96D5AC3A, 0x017DA67D, 0xD1CF3ED6, 0x7C7D2D28, 0x1F9F25CF, 0xADF2B89B, 0x5AD6B472, 0x5A88F54C, + 0xE029AC71, 0xE019A5E6, 0x47B0ACFD, 0xED93FA9B, 0xE8D3C48D, 0x283B57CC, 0xF8D56629, 0x79132E28, + 0x785F0191, 0xED756055, 0xF7960E44, 0xE3D35E8C, 0x15056DD4, 0x88F46DBA, 0x03A16125, 0x0564F0BD, + 0xC3EB9E15, 0x3C9057A2, 0x97271AEC, 0xA93A072A, 0x1B3F6D9B, 0x1E6321F5, 0xF59C66FB, 0x26DCF319, + 0x7533D928, 0xB155FDF5, 0x03563482, 0x8ABA3CBB, 0x28517711, 0xC20AD9F8, 0xABCC5167, 0xCCAD925F, + 0x4DE81751, 0x3830DC8E, 0x379D5862, 0x9320F991, 0xEA7A90C2, 0xFB3E7BCE, 0x5121CE64, 0x774FBE32, + 0xA8B6E37E, 0xC3293D46, 0x48DE5369, 0x6413E680, 0xA2AE0810, 0xDD6DB224, 0x69852DFD, 0x09072166, + 0xB39A460A, 0x6445C0DD, 0x586CDECF, 0x1C20C8AE, 0x5BBEF7DD, 0x1B588D40, 0xCCD2017F, 0x6BB4E3BB, + 0xDDA26A7E, 0x3A59FF45, 0x3E350A44, 0xBCB4CDD5, 0x72EACEA8, 0xFA6484BB, 0x8D6612AE, 0xBF3C6F47, + 0xD29BE463, 0x542F5D9E, 0xAEC2771B, 0xF64E6370, 0x740E0D8D, 0xE75B1357, 0xF8721671, 0xAF537D5D, + 0x4040CB08, 0x4EB4E2CC, 0x34D2466A, 0x0115AF84, 0xE1B00428, 0x95983A1D, 0x06B89FB4, 0xCE6EA048, + 0x6F3F3B82, 0x3520AB82, 0x011A1D4B, 0x277227F8, 0x611560B1, 0xE7933FDC, 0xBB3A792B, 0x344525BD, + 0xA08839E1, 0x51CE794B, 0x2F32C9B7, 0xA01FBAC9, 0xE01CC87E, 0xBCC7D1F6, 0xCF0111C3, 0xA1E8AAC7, + 0x1A908749, 0xD44FBD9A, 0xD0DADECB, 0xD50ADA38, 0x0339C32A, 0xC6913667, 0x8DF9317C, 0xE0B12B4F, + 0xF79E59B7, 0x43F5BB3A, 0xF2D519FF, 0x27D9459C, 0xBF97222C, 0x15E6FC2A, 0x0F91FC71, 0x9B941525, + 0xFAE59361, 0xCEB69CEB, 0xC2A86459, 0x12BAA8D1, 0xB6C1075E, 0xE3056A0C, 0x10D25065, 0xCB03A442, + 0xE0EC6E0E, 0x1698DB3B, 0x4C98A0BE, 0x3278E964, 0x9F1F9532, 0xE0D392DF, 0xD3A0342B, 0x8971F21E, + 0x1B0A7441, 0x4BA3348C, 0xC5BE7120, 0xC37632D8, 0xDF359F8D, 0x9B992F2E, 0xE60B6F47, 0x0FE3F11D, + 0xE54CDA54, 0x1EDAD891, 0xCE6279CF, 0xCD3E7E6F, 0x1618B166, 0xFD2C1D05, 0x848FD2C5, 0xF6FB2299, + 0xF523F357, 0xA6327623, 0x93A83531, 0x56CCCD02, 0xACF08162, 0x5A75EBB5, 0x6E163697, 0x88D273CC, + 0xDE966292, 0x81B949D0, 0x4C50901B, 0x71C65614, 0xE6C6C7BD, 0x327A140A, 0x45E1D006, 0xC3F27B9A, + 0xC9AA53FD, 0x62A80F00, 0xBB25BFE2, 0x35BDD2F6, 0x71126905, 0xB2040222, 0xB6CBCF7C, 0xCD769C2B, + 0x53113EC0, 0x1640E3D3, 0x38ABBD60, 0x2547ADF0, 0xBA38209C, 0xF746CE76, 0x77AFA1C5, 0x20756060, + 0x85CBFE4E, 0x8AE88DD8, 0x7AAAF9B0, 0x4CF9AA7E, 0x1948C25C, 0x02FB8A8C, 0x01C36AE4, 0xD6EBE1F9, + 0x90D4F869, 0xA65CDEA0, 0x3F09252D, 0xC208E69F, 0xB74E6132, 0xCE77E25B, 0x578FDFE3, 0x3AC372E6, + } +}; + + +static uint32_t blowfish_F(blowfish_ctx* ctx, uint32_t x) { + uint8_t a, b, c, d; + + /* divide xl into four eight-bit quarters */ + a = (x >> 24) & 0xFF; + b = (x >> 16) & 0xFF; + c = (x >> 8) & 0xFF; + d = (x >> 0) & 0xFF; + + return ((ctx->S[0][a] + ctx->S[1][b]) ^ ctx->S[2][c]) + ctx->S[3][d]; +} + + +void blowfish_encrypt(blowfish_ctx* ctx, uint32_t* p_xl, uint32_t* p_xr){ + uint32_t xl, xr, tmp; + + /* divide x into two 32-bit halves (external) */ + xl = *p_xl; + xr = *p_xr; + + for (int i = 0; i < 16; ++i) { + xl = xl ^ ctx->P[i]; + xr = blowfish_F(ctx, xl) ^ xr; + + /* swap */ + tmp = xl; + xl = xr; + xr = tmp; + } + + /* swap (undo last swap) */ + tmp = xl; + xl = xr; + xr = tmp; + + xr = xr ^ ctx->P[16 + 0]; + xl = xl ^ ctx->P[16 + 1]; + + /* recombine (external) */ + *p_xl = xl; + *p_xr = xr; +} + + +/* same as encryption but in reverse order */ +void blowfish_decrypt(blowfish_ctx* ctx, uint32_t* p_xl, uint32_t* p_xr) { + uint32_t xl, xr, tmp; + + /* divide x into two 32-bit halves (external) */ + xl = *p_xl; + xr = *p_xr; + + for (int i = 16 + 1; i > 1; --i) { + xl = xl ^ ctx->P[i]; + xr = blowfish_F(ctx, xl) ^ xr; + + /* swap */ + tmp = xl; + xl = xr; + xr = tmp; + } + + /* swap */ + tmp = xl; + xl = xr; + xr = tmp; + + xr = xr ^ ctx->P[1]; + xl = xl ^ ctx->P[0]; + + /* recombine (external) */ + *p_xl = xl; + *p_xr = xr; +} + + +blowfish_ctx* blowfish_init_ecb(uint8_t* key, int32_t key_len) { + uint32_t xl, xr; + uint8_t tmpkey[18*4]; + + blowfish_ctx* ctx = malloc(sizeof(blowfish_ctx)); + if (!ctx) return NULL; + + + /* preload key to simplify usage below; repeat if key is short */ + for (int i = 0; i < sizeof(tmpkey); i++) { + tmpkey[i] = key[i % key_len]; + } + + /* initialize p-array by XORing Pn by 32-bits of key */ + for (int i = 0; i < 18; i++) { + uint32_t tmp = get_u32be(tmpkey + i * 4); + ctx->P[i] = INIT_P[i] ^ tmp; + } + + /* initialize four S-boxes for use below */ + for (int i = 0; i < 4; i++) { + for (int j = 0; j < 256; j++) { + ctx->S[i][j] = INIT_S[i][j]; + } + } + + /* encrypt 0s with blowfish, using the calculated P subkeys, and replace Pn with each step */ + xl = 0x00000000; + xr = 0x00000000; + for (int i = 0; i < 18; i += 2) { + blowfish_encrypt(ctx, &xl, &xr); + /* Replace P1 and P2 with the output of step */ + ctx->P[i + 0] = xl; + ctx->P[i + 1] = xr; + } + + /* continue with four S-boxes in order with the continuous output */ + for (int i = 0; i < 4; i++) { + for (int j = 0; j < 256; j += 2) { + blowfish_encrypt(ctx, &xl, &xr); + ctx->S[i][j + 0] = xl; + ctx->S[i][j + 1] = xr; + } + } + + return ctx; +} + + +void blowfish_free(blowfish_ctx* ctx) { + free(ctx); +} + + +void blowfish_decrypt_ecb(blowfish_ctx* ctx, uint8_t* block) { + uint32_t xl = get_u32be(block + 0x00); + uint32_t xr = get_u32be(block + 0x04); + blowfish_decrypt(ctx, &xl, &xr); + put_u32be(block + 0x00, xl); + put_u32be(block + 0x04, xr); +} diff --git a/src/util/cipher_blowfish.h b/src/util/cipher_blowfish.h new file mode 100644 index 00000000..a31d4375 --- /dev/null +++ b/src/util/cipher_blowfish.h @@ -0,0 +1,14 @@ +#ifndef _CIPHER_BLOWFISH_H_ +#define _CIPHER_BLOWFISH_H_ +#include + +typedef struct blowfish_ctx blowfish_ctx; + +blowfish_ctx* blowfish_init_ecb(uint8_t* key, int key_len); +void blowfish_encrypt(blowfish_ctx *ctx, uint32_t* xl, uint32_t* xr); +void blowfish_decrypt(blowfish_ctx *ctx, uint32_t* xl, uint32_t* xr); +void blowfish_free(blowfish_ctx* ctx); + +/* assumed block size is at least 0x08 */ +void blowfish_decrypt_ecb(blowfish_ctx* ctx, uint8_t* block); +#endif