diff --git a/build/tools/sctools/common/src/my_aes.c b/build/tools/sctools/common/src/my_aes.c new file mode 100644 index 0000000..bbf2e53 --- /dev/null +++ b/build/tools/sctools/common/src/my_aes.c @@ -0,0 +1,1285 @@ +#include + +#include +#include "my_aes.h" + + +#define STRICT_ALIGNMENT 1 +#if defined(__i386) || defined(__i386__) || \ + defined(__x86_64) || defined(__x86_64__) || \ + defined(_M_IX86) || defined(_M_AMD64) || defined(_M_X64) || \ + defined(__s390__) || defined(__s390x__) +# undef STRICT_ALIGNMENT +# define STRICT_ALIGNMENT 0 +#endif + + +typedef void (*block128_f)(const unsigned char in[16], unsigned char out[16], const void *key); + + +static void assert( int bool ) +{ + if( !bool ) { + OS_TPrintf( "Error: ptr\n"); + } +} + + +static void CRYPTO_cbc128_encrypt(const unsigned char *in, unsigned char *out, + size_t len, const void *key, + unsigned char ivec[16], block128_f block) +{ + size_t n; + const unsigned char *iv = ivec; + + assert(in && out && key && ivec); + +#if !defined(OPENSSL_SMALL_FOOTPRINT) + if (STRICT_ALIGNMENT && + ((size_t)in|(size_t)out|(size_t)ivec)%sizeof(size_t) != 0) { + while (len>=16) { + for(n=0; n<16; ++n) { + out[n] = (unsigned char)(in[n] ^ iv[n]); + } + (*block)(out, out, key); + iv = out; + len -= 16; + in += 16; + out += 16; + } + } else { + while (len>=16) { + for(n=0; n<16; n+=sizeof(size_t)) + *(size_t*)(out+n) = + *(size_t*)(in+n) ^ *(size_t*)(iv+n); + (*block)(out, out, key); + iv = out; + len -= 16; + in += 16; + out += 16; + } + } +#endif + while (len) { + for(n=0; n<16 && n=16) { + (*block)(in, out, key); + for(n=0; n<16; ++n) + out[n] ^= iv[n]; + iv = in; + len -= 16; + in += 16; + out += 16; + } + } + else { + while (len>=16) { + (*block)(in, out, key); + for(n=0; n<16; n+=sizeof(size_t)) + *(size_t *)(out+n) ^= *(size_t *)(iv+n); + iv = in; + len -= 16; + in += 16; + out += 16; + } + } + memcpy(ivec,iv,16); + } else { + if (STRICT_ALIGNMENT && + ((size_t)in|(size_t)out|(size_t)ivec)%sizeof(size_t) != 0) { + unsigned char c; + while (len>=16) { + (*block)(in, tmp.c, key); + for(n=0; n<16; ++n) { + c = in[n]; + out[n] = (unsigned char)(tmp.c[n] ^ ivec[n]); + ivec[n] = c; + } + len -= 16; + in += 16; + out += 16; + } + } + else { + size_t c; + while (len>=16) { + (*block)(in, tmp.c, key); + for(n=0; n<16; n+=sizeof(size_t)) { + c = *(size_t *)(in+n); + *(size_t *)(out+n) = + *(size_t *)(tmp.c+n) ^ *(size_t *)(ivec+n); + *(size_t *)(ivec+n) = c; + } + len -= 16; + in += 16; + out += 16; + } + } + } +#endif + while (len) { + unsigned char c; + (*block)(in, tmp.c, key); + for(n=0; n<16 && n> 24); (ct)[1] = (u8)((st) >> 16); (ct)[2] = (u8)((st) >> 8); (ct)[3] = (u8)(st); } + + +static const u32 Te0[256] = { + 0xc66363a5U, 0xf87c7c84U, 0xee777799U, 0xf67b7b8dU, + 0xfff2f20dU, 0xd66b6bbdU, 0xde6f6fb1U, 0x91c5c554U, + 0x60303050U, 0x02010103U, 0xce6767a9U, 0x562b2b7dU, + 0xe7fefe19U, 0xb5d7d762U, 0x4dababe6U, 0xec76769aU, + 0x8fcaca45U, 0x1f82829dU, 0x89c9c940U, 0xfa7d7d87U, + 0xeffafa15U, 0xb25959ebU, 0x8e4747c9U, 0xfbf0f00bU, + 0x41adadecU, 0xb3d4d467U, 0x5fa2a2fdU, 0x45afafeaU, + 0x239c9cbfU, 0x53a4a4f7U, 0xe4727296U, 0x9bc0c05bU, + 0x75b7b7c2U, 0xe1fdfd1cU, 0x3d9393aeU, 0x4c26266aU, + 0x6c36365aU, 0x7e3f3f41U, 0xf5f7f702U, 0x83cccc4fU, + 0x6834345cU, 0x51a5a5f4U, 0xd1e5e534U, 0xf9f1f108U, + 0xe2717193U, 0xabd8d873U, 0x62313153U, 0x2a15153fU, + 0x0804040cU, 0x95c7c752U, 0x46232365U, 0x9dc3c35eU, + 0x30181828U, 0x379696a1U, 0x0a05050fU, 0x2f9a9ab5U, + 0x0e070709U, 0x24121236U, 0x1b80809bU, 0xdfe2e23dU, + 0xcdebeb26U, 0x4e272769U, 0x7fb2b2cdU, 0xea75759fU, + 0x1209091bU, 0x1d83839eU, 0x582c2c74U, 0x341a1a2eU, + 0x361b1b2dU, 0xdc6e6eb2U, 0xb45a5aeeU, 0x5ba0a0fbU, + 0xa45252f6U, 0x763b3b4dU, 0xb7d6d661U, 0x7db3b3ceU, + 0x5229297bU, 0xdde3e33eU, 0x5e2f2f71U, 0x13848497U, + 0xa65353f5U, 0xb9d1d168U, 0x00000000U, 0xc1eded2cU, + 0x40202060U, 0xe3fcfc1fU, 0x79b1b1c8U, 0xb65b5bedU, + 0xd46a6abeU, 0x8dcbcb46U, 0x67bebed9U, 0x7239394bU, + 0x944a4adeU, 0x984c4cd4U, 0xb05858e8U, 0x85cfcf4aU, + 0xbbd0d06bU, 0xc5efef2aU, 0x4faaaae5U, 0xedfbfb16U, + 0x864343c5U, 0x9a4d4dd7U, 0x66333355U, 0x11858594U, + 0x8a4545cfU, 0xe9f9f910U, 0x04020206U, 0xfe7f7f81U, + 0xa05050f0U, 0x783c3c44U, 0x259f9fbaU, 0x4ba8a8e3U, + 0xa25151f3U, 0x5da3a3feU, 0x804040c0U, 0x058f8f8aU, + 0x3f9292adU, 0x219d9dbcU, 0x70383848U, 0xf1f5f504U, + 0x63bcbcdfU, 0x77b6b6c1U, 0xafdada75U, 0x42212163U, + 0x20101030U, 0xe5ffff1aU, 0xfdf3f30eU, 0xbfd2d26dU, + 0x81cdcd4cU, 0x180c0c14U, 0x26131335U, 0xc3ecec2fU, + 0xbe5f5fe1U, 0x359797a2U, 0x884444ccU, 0x2e171739U, + 0x93c4c457U, 0x55a7a7f2U, 0xfc7e7e82U, 0x7a3d3d47U, + 0xc86464acU, 0xba5d5de7U, 0x3219192bU, 0xe6737395U, + 0xc06060a0U, 0x19818198U, 0x9e4f4fd1U, 0xa3dcdc7fU, + 0x44222266U, 0x542a2a7eU, 0x3b9090abU, 0x0b888883U, + 0x8c4646caU, 0xc7eeee29U, 0x6bb8b8d3U, 0x2814143cU, + 0xa7dede79U, 0xbc5e5ee2U, 0x160b0b1dU, 0xaddbdb76U, + 0xdbe0e03bU, 0x64323256U, 0x743a3a4eU, 0x140a0a1eU, + 0x924949dbU, 0x0c06060aU, 0x4824246cU, 0xb85c5ce4U, + 0x9fc2c25dU, 0xbdd3d36eU, 0x43acacefU, 0xc46262a6U, + 0x399191a8U, 0x319595a4U, 0xd3e4e437U, 0xf279798bU, + 0xd5e7e732U, 0x8bc8c843U, 0x6e373759U, 0xda6d6db7U, + 0x018d8d8cU, 0xb1d5d564U, 0x9c4e4ed2U, 0x49a9a9e0U, + 0xd86c6cb4U, 0xac5656faU, 0xf3f4f407U, 0xcfeaea25U, + 0xca6565afU, 0xf47a7a8eU, 0x47aeaee9U, 0x10080818U, + 0x6fbabad5U, 0xf0787888U, 0x4a25256fU, 0x5c2e2e72U, + 0x381c1c24U, 0x57a6a6f1U, 0x73b4b4c7U, 0x97c6c651U, + 0xcbe8e823U, 0xa1dddd7cU, 0xe874749cU, 0x3e1f1f21U, + 0x964b4bddU, 0x61bdbddcU, 0x0d8b8b86U, 0x0f8a8a85U, + 0xe0707090U, 0x7c3e3e42U, 0x71b5b5c4U, 0xcc6666aaU, + 0x904848d8U, 0x06030305U, 0xf7f6f601U, 0x1c0e0e12U, + 0xc26161a3U, 0x6a35355fU, 0xae5757f9U, 0x69b9b9d0U, + 0x17868691U, 0x99c1c158U, 0x3a1d1d27U, 0x279e9eb9U, + 0xd9e1e138U, 0xebf8f813U, 0x2b9898b3U, 0x22111133U, + 0xd26969bbU, 0xa9d9d970U, 0x078e8e89U, 0x339494a7U, + 0x2d9b9bb6U, 0x3c1e1e22U, 0x15878792U, 0xc9e9e920U, + 0x87cece49U, 0xaa5555ffU, 0x50282878U, 0xa5dfdf7aU, + 0x038c8c8fU, 0x59a1a1f8U, 0x09898980U, 0x1a0d0d17U, + 0x65bfbfdaU, 0xd7e6e631U, 0x844242c6U, 0xd06868b8U, + 0x824141c3U, 0x299999b0U, 0x5a2d2d77U, 0x1e0f0f11U, + 0x7bb0b0cbU, 0xa85454fcU, 0x6dbbbbd6U, 0x2c16163aU, +}; +static const u32 Te1[256] = { + 0xa5c66363U, 0x84f87c7cU, 0x99ee7777U, 0x8df67b7bU, + 0x0dfff2f2U, 0xbdd66b6bU, 0xb1de6f6fU, 0x5491c5c5U, + 0x50603030U, 0x03020101U, 0xa9ce6767U, 0x7d562b2bU, + 0x19e7fefeU, 0x62b5d7d7U, 0xe64dababU, 0x9aec7676U, + 0x458fcacaU, 0x9d1f8282U, 0x4089c9c9U, 0x87fa7d7dU, + 0x15effafaU, 0xebb25959U, 0xc98e4747U, 0x0bfbf0f0U, + 0xec41adadU, 0x67b3d4d4U, 0xfd5fa2a2U, 0xea45afafU, + 0xbf239c9cU, 0xf753a4a4U, 0x96e47272U, 0x5b9bc0c0U, + 0xc275b7b7U, 0x1ce1fdfdU, 0xae3d9393U, 0x6a4c2626U, + 0x5a6c3636U, 0x417e3f3fU, 0x02f5f7f7U, 0x4f83ccccU, + 0x5c683434U, 0xf451a5a5U, 0x34d1e5e5U, 0x08f9f1f1U, + 0x93e27171U, 0x73abd8d8U, 0x53623131U, 0x3f2a1515U, + 0x0c080404U, 0x5295c7c7U, 0x65462323U, 0x5e9dc3c3U, + 0x28301818U, 0xa1379696U, 0x0f0a0505U, 0xb52f9a9aU, + 0x090e0707U, 0x36241212U, 0x9b1b8080U, 0x3ddfe2e2U, + 0x26cdebebU, 0x694e2727U, 0xcd7fb2b2U, 0x9fea7575U, + 0x1b120909U, 0x9e1d8383U, 0x74582c2cU, 0x2e341a1aU, + 0x2d361b1bU, 0xb2dc6e6eU, 0xeeb45a5aU, 0xfb5ba0a0U, + 0xf6a45252U, 0x4d763b3bU, 0x61b7d6d6U, 0xce7db3b3U, + 0x7b522929U, 0x3edde3e3U, 0x715e2f2fU, 0x97138484U, + 0xf5a65353U, 0x68b9d1d1U, 0x00000000U, 0x2cc1ededU, + 0x60402020U, 0x1fe3fcfcU, 0xc879b1b1U, 0xedb65b5bU, + 0xbed46a6aU, 0x468dcbcbU, 0xd967bebeU, 0x4b723939U, + 0xde944a4aU, 0xd4984c4cU, 0xe8b05858U, 0x4a85cfcfU, + 0x6bbbd0d0U, 0x2ac5efefU, 0xe54faaaaU, 0x16edfbfbU, + 0xc5864343U, 0xd79a4d4dU, 0x55663333U, 0x94118585U, + 0xcf8a4545U, 0x10e9f9f9U, 0x06040202U, 0x81fe7f7fU, + 0xf0a05050U, 0x44783c3cU, 0xba259f9fU, 0xe34ba8a8U, + 0xf3a25151U, 0xfe5da3a3U, 0xc0804040U, 0x8a058f8fU, + 0xad3f9292U, 0xbc219d9dU, 0x48703838U, 0x04f1f5f5U, + 0xdf63bcbcU, 0xc177b6b6U, 0x75afdadaU, 0x63422121U, + 0x30201010U, 0x1ae5ffffU, 0x0efdf3f3U, 0x6dbfd2d2U, + 0x4c81cdcdU, 0x14180c0cU, 0x35261313U, 0x2fc3ececU, + 0xe1be5f5fU, 0xa2359797U, 0xcc884444U, 0x392e1717U, + 0x5793c4c4U, 0xf255a7a7U, 0x82fc7e7eU, 0x477a3d3dU, + 0xacc86464U, 0xe7ba5d5dU, 0x2b321919U, 0x95e67373U, + 0xa0c06060U, 0x98198181U, 0xd19e4f4fU, 0x7fa3dcdcU, + 0x66442222U, 0x7e542a2aU, 0xab3b9090U, 0x830b8888U, + 0xca8c4646U, 0x29c7eeeeU, 0xd36bb8b8U, 0x3c281414U, + 0x79a7dedeU, 0xe2bc5e5eU, 0x1d160b0bU, 0x76addbdbU, + 0x3bdbe0e0U, 0x56643232U, 0x4e743a3aU, 0x1e140a0aU, + 0xdb924949U, 0x0a0c0606U, 0x6c482424U, 0xe4b85c5cU, + 0x5d9fc2c2U, 0x6ebdd3d3U, 0xef43acacU, 0xa6c46262U, + 0xa8399191U, 0xa4319595U, 0x37d3e4e4U, 0x8bf27979U, + 0x32d5e7e7U, 0x438bc8c8U, 0x596e3737U, 0xb7da6d6dU, + 0x8c018d8dU, 0x64b1d5d5U, 0xd29c4e4eU, 0xe049a9a9U, + 0xb4d86c6cU, 0xfaac5656U, 0x07f3f4f4U, 0x25cfeaeaU, + 0xafca6565U, 0x8ef47a7aU, 0xe947aeaeU, 0x18100808U, + 0xd56fbabaU, 0x88f07878U, 0x6f4a2525U, 0x725c2e2eU, + 0x24381c1cU, 0xf157a6a6U, 0xc773b4b4U, 0x5197c6c6U, + 0x23cbe8e8U, 0x7ca1ddddU, 0x9ce87474U, 0x213e1f1fU, + 0xdd964b4bU, 0xdc61bdbdU, 0x860d8b8bU, 0x850f8a8aU, + 0x90e07070U, 0x427c3e3eU, 0xc471b5b5U, 0xaacc6666U, + 0xd8904848U, 0x05060303U, 0x01f7f6f6U, 0x121c0e0eU, + 0xa3c26161U, 0x5f6a3535U, 0xf9ae5757U, 0xd069b9b9U, + 0x91178686U, 0x5899c1c1U, 0x273a1d1dU, 0xb9279e9eU, + 0x38d9e1e1U, 0x13ebf8f8U, 0xb32b9898U, 0x33221111U, + 0xbbd26969U, 0x70a9d9d9U, 0x89078e8eU, 0xa7339494U, + 0xb62d9b9bU, 0x223c1e1eU, 0x92158787U, 0x20c9e9e9U, + 0x4987ceceU, 0xffaa5555U, 0x78502828U, 0x7aa5dfdfU, + 0x8f038c8cU, 0xf859a1a1U, 0x80098989U, 0x171a0d0dU, + 0xda65bfbfU, 0x31d7e6e6U, 0xc6844242U, 0xb8d06868U, + 0xc3824141U, 0xb0299999U, 0x775a2d2dU, 0x111e0f0fU, + 0xcb7bb0b0U, 0xfca85454U, 0xd66dbbbbU, 0x3a2c1616U, +}; +static const u32 Te2[256] = { + 0x63a5c663U, 0x7c84f87cU, 0x7799ee77U, 0x7b8df67bU, + 0xf20dfff2U, 0x6bbdd66bU, 0x6fb1de6fU, 0xc55491c5U, + 0x30506030U, 0x01030201U, 0x67a9ce67U, 0x2b7d562bU, + 0xfe19e7feU, 0xd762b5d7U, 0xabe64dabU, 0x769aec76U, + 0xca458fcaU, 0x829d1f82U, 0xc94089c9U, 0x7d87fa7dU, + 0xfa15effaU, 0x59ebb259U, 0x47c98e47U, 0xf00bfbf0U, + 0xadec41adU, 0xd467b3d4U, 0xa2fd5fa2U, 0xafea45afU, + 0x9cbf239cU, 0xa4f753a4U, 0x7296e472U, 0xc05b9bc0U, + 0xb7c275b7U, 0xfd1ce1fdU, 0x93ae3d93U, 0x266a4c26U, + 0x365a6c36U, 0x3f417e3fU, 0xf702f5f7U, 0xcc4f83ccU, + 0x345c6834U, 0xa5f451a5U, 0xe534d1e5U, 0xf108f9f1U, + 0x7193e271U, 0xd873abd8U, 0x31536231U, 0x153f2a15U, + 0x040c0804U, 0xc75295c7U, 0x23654623U, 0xc35e9dc3U, + 0x18283018U, 0x96a13796U, 0x050f0a05U, 0x9ab52f9aU, + 0x07090e07U, 0x12362412U, 0x809b1b80U, 0xe23ddfe2U, + 0xeb26cdebU, 0x27694e27U, 0xb2cd7fb2U, 0x759fea75U, + 0x091b1209U, 0x839e1d83U, 0x2c74582cU, 0x1a2e341aU, + 0x1b2d361bU, 0x6eb2dc6eU, 0x5aeeb45aU, 0xa0fb5ba0U, + 0x52f6a452U, 0x3b4d763bU, 0xd661b7d6U, 0xb3ce7db3U, + 0x297b5229U, 0xe33edde3U, 0x2f715e2fU, 0x84971384U, + 0x53f5a653U, 0xd168b9d1U, 0x00000000U, 0xed2cc1edU, + 0x20604020U, 0xfc1fe3fcU, 0xb1c879b1U, 0x5bedb65bU, + 0x6abed46aU, 0xcb468dcbU, 0xbed967beU, 0x394b7239U, + 0x4ade944aU, 0x4cd4984cU, 0x58e8b058U, 0xcf4a85cfU, + 0xd06bbbd0U, 0xef2ac5efU, 0xaae54faaU, 0xfb16edfbU, + 0x43c58643U, 0x4dd79a4dU, 0x33556633U, 0x85941185U, + 0x45cf8a45U, 0xf910e9f9U, 0x02060402U, 0x7f81fe7fU, + 0x50f0a050U, 0x3c44783cU, 0x9fba259fU, 0xa8e34ba8U, + 0x51f3a251U, 0xa3fe5da3U, 0x40c08040U, 0x8f8a058fU, + 0x92ad3f92U, 0x9dbc219dU, 0x38487038U, 0xf504f1f5U, + 0xbcdf63bcU, 0xb6c177b6U, 0xda75afdaU, 0x21634221U, + 0x10302010U, 0xff1ae5ffU, 0xf30efdf3U, 0xd26dbfd2U, + 0xcd4c81cdU, 0x0c14180cU, 0x13352613U, 0xec2fc3ecU, + 0x5fe1be5fU, 0x97a23597U, 0x44cc8844U, 0x17392e17U, + 0xc45793c4U, 0xa7f255a7U, 0x7e82fc7eU, 0x3d477a3dU, + 0x64acc864U, 0x5de7ba5dU, 0x192b3219U, 0x7395e673U, + 0x60a0c060U, 0x81981981U, 0x4fd19e4fU, 0xdc7fa3dcU, + 0x22664422U, 0x2a7e542aU, 0x90ab3b90U, 0x88830b88U, + 0x46ca8c46U, 0xee29c7eeU, 0xb8d36bb8U, 0x143c2814U, + 0xde79a7deU, 0x5ee2bc5eU, 0x0b1d160bU, 0xdb76addbU, + 0xe03bdbe0U, 0x32566432U, 0x3a4e743aU, 0x0a1e140aU, + 0x49db9249U, 0x060a0c06U, 0x246c4824U, 0x5ce4b85cU, + 0xc25d9fc2U, 0xd36ebdd3U, 0xacef43acU, 0x62a6c462U, + 0x91a83991U, 0x95a43195U, 0xe437d3e4U, 0x798bf279U, + 0xe732d5e7U, 0xc8438bc8U, 0x37596e37U, 0x6db7da6dU, + 0x8d8c018dU, 0xd564b1d5U, 0x4ed29c4eU, 0xa9e049a9U, + 0x6cb4d86cU, 0x56faac56U, 0xf407f3f4U, 0xea25cfeaU, + 0x65afca65U, 0x7a8ef47aU, 0xaee947aeU, 0x08181008U, + 0xbad56fbaU, 0x7888f078U, 0x256f4a25U, 0x2e725c2eU, + 0x1c24381cU, 0xa6f157a6U, 0xb4c773b4U, 0xc65197c6U, + 0xe823cbe8U, 0xdd7ca1ddU, 0x749ce874U, 0x1f213e1fU, + 0x4bdd964bU, 0xbddc61bdU, 0x8b860d8bU, 0x8a850f8aU, + 0x7090e070U, 0x3e427c3eU, 0xb5c471b5U, 0x66aacc66U, + 0x48d89048U, 0x03050603U, 0xf601f7f6U, 0x0e121c0eU, + 0x61a3c261U, 0x355f6a35U, 0x57f9ae57U, 0xb9d069b9U, + 0x86911786U, 0xc15899c1U, 0x1d273a1dU, 0x9eb9279eU, + 0xe138d9e1U, 0xf813ebf8U, 0x98b32b98U, 0x11332211U, + 0x69bbd269U, 0xd970a9d9U, 0x8e89078eU, 0x94a73394U, + 0x9bb62d9bU, 0x1e223c1eU, 0x87921587U, 0xe920c9e9U, + 0xce4987ceU, 0x55ffaa55U, 0x28785028U, 0xdf7aa5dfU, + 0x8c8f038cU, 0xa1f859a1U, 0x89800989U, 0x0d171a0dU, + 0xbfda65bfU, 0xe631d7e6U, 0x42c68442U, 0x68b8d068U, + 0x41c38241U, 0x99b02999U, 0x2d775a2dU, 0x0f111e0fU, + 0xb0cb7bb0U, 0x54fca854U, 0xbbd66dbbU, 0x163a2c16U, +}; +static const u32 Te3[256] = { + 0x6363a5c6U, 0x7c7c84f8U, 0x777799eeU, 0x7b7b8df6U, + 0xf2f20dffU, 0x6b6bbdd6U, 0x6f6fb1deU, 0xc5c55491U, + 0x30305060U, 0x01010302U, 0x6767a9ceU, 0x2b2b7d56U, + 0xfefe19e7U, 0xd7d762b5U, 0xababe64dU, 0x76769aecU, + 0xcaca458fU, 0x82829d1fU, 0xc9c94089U, 0x7d7d87faU, + 0xfafa15efU, 0x5959ebb2U, 0x4747c98eU, 0xf0f00bfbU, + 0xadadec41U, 0xd4d467b3U, 0xa2a2fd5fU, 0xafafea45U, + 0x9c9cbf23U, 0xa4a4f753U, 0x727296e4U, 0xc0c05b9bU, + 0xb7b7c275U, 0xfdfd1ce1U, 0x9393ae3dU, 0x26266a4cU, + 0x36365a6cU, 0x3f3f417eU, 0xf7f702f5U, 0xcccc4f83U, + 0x34345c68U, 0xa5a5f451U, 0xe5e534d1U, 0xf1f108f9U, + 0x717193e2U, 0xd8d873abU, 0x31315362U, 0x15153f2aU, + 0x04040c08U, 0xc7c75295U, 0x23236546U, 0xc3c35e9dU, + 0x18182830U, 0x9696a137U, 0x05050f0aU, 0x9a9ab52fU, + 0x0707090eU, 0x12123624U, 0x80809b1bU, 0xe2e23ddfU, + 0xebeb26cdU, 0x2727694eU, 0xb2b2cd7fU, 0x75759feaU, + 0x09091b12U, 0x83839e1dU, 0x2c2c7458U, 0x1a1a2e34U, + 0x1b1b2d36U, 0x6e6eb2dcU, 0x5a5aeeb4U, 0xa0a0fb5bU, + 0x5252f6a4U, 0x3b3b4d76U, 0xd6d661b7U, 0xb3b3ce7dU, + 0x29297b52U, 0xe3e33eddU, 0x2f2f715eU, 0x84849713U, + 0x5353f5a6U, 0xd1d168b9U, 0x00000000U, 0xeded2cc1U, + 0x20206040U, 0xfcfc1fe3U, 0xb1b1c879U, 0x5b5bedb6U, + 0x6a6abed4U, 0xcbcb468dU, 0xbebed967U, 0x39394b72U, + 0x4a4ade94U, 0x4c4cd498U, 0x5858e8b0U, 0xcfcf4a85U, + 0xd0d06bbbU, 0xefef2ac5U, 0xaaaae54fU, 0xfbfb16edU, + 0x4343c586U, 0x4d4dd79aU, 0x33335566U, 0x85859411U, + 0x4545cf8aU, 0xf9f910e9U, 0x02020604U, 0x7f7f81feU, + 0x5050f0a0U, 0x3c3c4478U, 0x9f9fba25U, 0xa8a8e34bU, + 0x5151f3a2U, 0xa3a3fe5dU, 0x4040c080U, 0x8f8f8a05U, + 0x9292ad3fU, 0x9d9dbc21U, 0x38384870U, 0xf5f504f1U, + 0xbcbcdf63U, 0xb6b6c177U, 0xdada75afU, 0x21216342U, + 0x10103020U, 0xffff1ae5U, 0xf3f30efdU, 0xd2d26dbfU, + 0xcdcd4c81U, 0x0c0c1418U, 0x13133526U, 0xecec2fc3U, + 0x5f5fe1beU, 0x9797a235U, 0x4444cc88U, 0x1717392eU, + 0xc4c45793U, 0xa7a7f255U, 0x7e7e82fcU, 0x3d3d477aU, + 0x6464acc8U, 0x5d5de7baU, 0x19192b32U, 0x737395e6U, + 0x6060a0c0U, 0x81819819U, 0x4f4fd19eU, 0xdcdc7fa3U, + 0x22226644U, 0x2a2a7e54U, 0x9090ab3bU, 0x8888830bU, + 0x4646ca8cU, 0xeeee29c7U, 0xb8b8d36bU, 0x14143c28U, + 0xdede79a7U, 0x5e5ee2bcU, 0x0b0b1d16U, 0xdbdb76adU, + 0xe0e03bdbU, 0x32325664U, 0x3a3a4e74U, 0x0a0a1e14U, + 0x4949db92U, 0x06060a0cU, 0x24246c48U, 0x5c5ce4b8U, + 0xc2c25d9fU, 0xd3d36ebdU, 0xacacef43U, 0x6262a6c4U, + 0x9191a839U, 0x9595a431U, 0xe4e437d3U, 0x79798bf2U, + 0xe7e732d5U, 0xc8c8438bU, 0x3737596eU, 0x6d6db7daU, + 0x8d8d8c01U, 0xd5d564b1U, 0x4e4ed29cU, 0xa9a9e049U, + 0x6c6cb4d8U, 0x5656faacU, 0xf4f407f3U, 0xeaea25cfU, + 0x6565afcaU, 0x7a7a8ef4U, 0xaeaee947U, 0x08081810U, + 0xbabad56fU, 0x787888f0U, 0x25256f4aU, 0x2e2e725cU, + 0x1c1c2438U, 0xa6a6f157U, 0xb4b4c773U, 0xc6c65197U, + 0xe8e823cbU, 0xdddd7ca1U, 0x74749ce8U, 0x1f1f213eU, + 0x4b4bdd96U, 0xbdbddc61U, 0x8b8b860dU, 0x8a8a850fU, + 0x707090e0U, 0x3e3e427cU, 0xb5b5c471U, 0x6666aaccU, + 0x4848d890U, 0x03030506U, 0xf6f601f7U, 0x0e0e121cU, + 0x6161a3c2U, 0x35355f6aU, 0x5757f9aeU, 0xb9b9d069U, + 0x86869117U, 0xc1c15899U, 0x1d1d273aU, 0x9e9eb927U, + 0xe1e138d9U, 0xf8f813ebU, 0x9898b32bU, 0x11113322U, + 0x6969bbd2U, 0xd9d970a9U, 0x8e8e8907U, 0x9494a733U, + 0x9b9bb62dU, 0x1e1e223cU, 0x87879215U, 0xe9e920c9U, + 0xcece4987U, 0x5555ffaaU, 0x28287850U, 0xdfdf7aa5U, + 0x8c8c8f03U, 0xa1a1f859U, 0x89898009U, 0x0d0d171aU, + 0xbfbfda65U, 0xe6e631d7U, 0x4242c684U, 0x6868b8d0U, + 0x4141c382U, 0x9999b029U, 0x2d2d775aU, 0x0f0f111eU, + 0xb0b0cb7bU, 0x5454fca8U, 0xbbbbd66dU, 0x16163a2cU, +}; + +static const u32 Td0[256] = { + 0x51f4a750U, 0x7e416553U, 0x1a17a4c3U, 0x3a275e96U, + 0x3bab6bcbU, 0x1f9d45f1U, 0xacfa58abU, 0x4be30393U, + 0x2030fa55U, 0xad766df6U, 0x88cc7691U, 0xf5024c25U, + 0x4fe5d7fcU, 0xc52acbd7U, 0x26354480U, 0xb562a38fU, + 0xdeb15a49U, 0x25ba1b67U, 0x45ea0e98U, 0x5dfec0e1U, + 0xc32f7502U, 0x814cf012U, 0x8d4697a3U, 0x6bd3f9c6U, + 0x038f5fe7U, 0x15929c95U, 0xbf6d7aebU, 0x955259daU, + 0xd4be832dU, 0x587421d3U, 0x49e06929U, 0x8ec9c844U, + 0x75c2896aU, 0xf48e7978U, 0x99583e6bU, 0x27b971ddU, + 0xbee14fb6U, 0xf088ad17U, 0xc920ac66U, 0x7dce3ab4U, + 0x63df4a18U, 0xe51a3182U, 0x97513360U, 0x62537f45U, + 0xb16477e0U, 0xbb6bae84U, 0xfe81a01cU, 0xf9082b94U, + 0x70486858U, 0x8f45fd19U, 0x94de6c87U, 0x527bf8b7U, + 0xab73d323U, 0x724b02e2U, 0xe31f8f57U, 0x6655ab2aU, + 0xb2eb2807U, 0x2fb5c203U, 0x86c57b9aU, 0xd33708a5U, + 0x302887f2U, 0x23bfa5b2U, 0x02036abaU, 0xed16825cU, + 0x8acf1c2bU, 0xa779b492U, 0xf307f2f0U, 0x4e69e2a1U, + 0x65daf4cdU, 0x0605bed5U, 0xd134621fU, 0xc4a6fe8aU, + 0x342e539dU, 0xa2f355a0U, 0x058ae132U, 0xa4f6eb75U, + 0x0b83ec39U, 0x4060efaaU, 0x5e719f06U, 0xbd6e1051U, + 0x3e218af9U, 0x96dd063dU, 0xdd3e05aeU, 0x4de6bd46U, + 0x91548db5U, 0x71c45d05U, 0x0406d46fU, 0x605015ffU, + 0x1998fb24U, 0xd6bde997U, 0x894043ccU, 0x67d99e77U, + 0xb0e842bdU, 0x07898b88U, 0xe7195b38U, 0x79c8eedbU, + 0xa17c0a47U, 0x7c420fe9U, 0xf8841ec9U, 0x00000000U, + 0x09808683U, 0x322bed48U, 0x1e1170acU, 0x6c5a724eU, + 0xfd0efffbU, 0x0f853856U, 0x3daed51eU, 0x362d3927U, + 0x0a0fd964U, 0x685ca621U, 0x9b5b54d1U, 0x24362e3aU, + 0x0c0a67b1U, 0x9357e70fU, 0xb4ee96d2U, 0x1b9b919eU, + 0x80c0c54fU, 0x61dc20a2U, 0x5a774b69U, 0x1c121a16U, + 0xe293ba0aU, 0xc0a02ae5U, 0x3c22e043U, 0x121b171dU, + 0x0e090d0bU, 0xf28bc7adU, 0x2db6a8b9U, 0x141ea9c8U, + 0x57f11985U, 0xaf75074cU, 0xee99ddbbU, 0xa37f60fdU, + 0xf701269fU, 0x5c72f5bcU, 0x44663bc5U, 0x5bfb7e34U, + 0x8b432976U, 0xcb23c6dcU, 0xb6edfc68U, 0xb8e4f163U, + 0xd731dccaU, 0x42638510U, 0x13972240U, 0x84c61120U, + 0x854a247dU, 0xd2bb3df8U, 0xaef93211U, 0xc729a16dU, + 0x1d9e2f4bU, 0xdcb230f3U, 0x0d8652ecU, 0x77c1e3d0U, + 0x2bb3166cU, 0xa970b999U, 0x119448faU, 0x47e96422U, + 0xa8fc8cc4U, 0xa0f03f1aU, 0x567d2cd8U, 0x223390efU, + 0x87494ec7U, 0xd938d1c1U, 0x8ccaa2feU, 0x98d40b36U, + 0xa6f581cfU, 0xa57ade28U, 0xdab78e26U, 0x3fadbfa4U, + 0x2c3a9de4U, 0x5078920dU, 0x6a5fcc9bU, 0x547e4662U, + 0xf68d13c2U, 0x90d8b8e8U, 0x2e39f75eU, 0x82c3aff5U, + 0x9f5d80beU, 0x69d0937cU, 0x6fd52da9U, 0xcf2512b3U, + 0xc8ac993bU, 0x10187da7U, 0xe89c636eU, 0xdb3bbb7bU, + 0xcd267809U, 0x6e5918f4U, 0xec9ab701U, 0x834f9aa8U, + 0xe6956e65U, 0xaaffe67eU, 0x21bccf08U, 0xef15e8e6U, + 0xbae79bd9U, 0x4a6f36ceU, 0xea9f09d4U, 0x29b07cd6U, + 0x31a4b2afU, 0x2a3f2331U, 0xc6a59430U, 0x35a266c0U, + 0x744ebc37U, 0xfc82caa6U, 0xe090d0b0U, 0x33a7d815U, + 0xf104984aU, 0x41ecdaf7U, 0x7fcd500eU, 0x1791f62fU, + 0x764dd68dU, 0x43efb04dU, 0xccaa4d54U, 0xe49604dfU, + 0x9ed1b5e3U, 0x4c6a881bU, 0xc12c1fb8U, 0x4665517fU, + 0x9d5eea04U, 0x018c355dU, 0xfa877473U, 0xfb0b412eU, + 0xb3671d5aU, 0x92dbd252U, 0xe9105633U, 0x6dd64713U, + 0x9ad7618cU, 0x37a10c7aU, 0x59f8148eU, 0xeb133c89U, + 0xcea927eeU, 0xb761c935U, 0xe11ce5edU, 0x7a47b13cU, + 0x9cd2df59U, 0x55f2733fU, 0x1814ce79U, 0x73c737bfU, + 0x53f7cdeaU, 0x5ffdaa5bU, 0xdf3d6f14U, 0x7844db86U, + 0xcaaff381U, 0xb968c43eU, 0x3824342cU, 0xc2a3405fU, + 0x161dc372U, 0xbce2250cU, 0x283c498bU, 0xff0d9541U, + 0x39a80171U, 0x080cb3deU, 0xd8b4e49cU, 0x6456c190U, + 0x7bcb8461U, 0xd532b670U, 0x486c5c74U, 0xd0b85742U, +}; +static const u32 Td1[256] = { + 0x5051f4a7U, 0x537e4165U, 0xc31a17a4U, 0x963a275eU, + 0xcb3bab6bU, 0xf11f9d45U, 0xabacfa58U, 0x934be303U, + 0x552030faU, 0xf6ad766dU, 0x9188cc76U, 0x25f5024cU, + 0xfc4fe5d7U, 0xd7c52acbU, 0x80263544U, 0x8fb562a3U, + 0x49deb15aU, 0x6725ba1bU, 0x9845ea0eU, 0xe15dfec0U, + 0x02c32f75U, 0x12814cf0U, 0xa38d4697U, 0xc66bd3f9U, + 0xe7038f5fU, 0x9515929cU, 0xebbf6d7aU, 0xda955259U, + 0x2dd4be83U, 0xd3587421U, 0x2949e069U, 0x448ec9c8U, + 0x6a75c289U, 0x78f48e79U, 0x6b99583eU, 0xdd27b971U, + 0xb6bee14fU, 0x17f088adU, 0x66c920acU, 0xb47dce3aU, + 0x1863df4aU, 0x82e51a31U, 0x60975133U, 0x4562537fU, + 0xe0b16477U, 0x84bb6baeU, 0x1cfe81a0U, 0x94f9082bU, + 0x58704868U, 0x198f45fdU, 0x8794de6cU, 0xb7527bf8U, + 0x23ab73d3U, 0xe2724b02U, 0x57e31f8fU, 0x2a6655abU, + 0x07b2eb28U, 0x032fb5c2U, 0x9a86c57bU, 0xa5d33708U, + 0xf2302887U, 0xb223bfa5U, 0xba02036aU, 0x5ced1682U, + 0x2b8acf1cU, 0x92a779b4U, 0xf0f307f2U, 0xa14e69e2U, + 0xcd65daf4U, 0xd50605beU, 0x1fd13462U, 0x8ac4a6feU, + 0x9d342e53U, 0xa0a2f355U, 0x32058ae1U, 0x75a4f6ebU, + 0x390b83ecU, 0xaa4060efU, 0x065e719fU, 0x51bd6e10U, + 0xf93e218aU, 0x3d96dd06U, 0xaedd3e05U, 0x464de6bdU, + 0xb591548dU, 0x0571c45dU, 0x6f0406d4U, 0xff605015U, + 0x241998fbU, 0x97d6bde9U, 0xcc894043U, 0x7767d99eU, + 0xbdb0e842U, 0x8807898bU, 0x38e7195bU, 0xdb79c8eeU, + 0x47a17c0aU, 0xe97c420fU, 0xc9f8841eU, 0x00000000U, + 0x83098086U, 0x48322bedU, 0xac1e1170U, 0x4e6c5a72U, + 0xfbfd0effU, 0x560f8538U, 0x1e3daed5U, 0x27362d39U, + 0x640a0fd9U, 0x21685ca6U, 0xd19b5b54U, 0x3a24362eU, + 0xb10c0a67U, 0x0f9357e7U, 0xd2b4ee96U, 0x9e1b9b91U, + 0x4f80c0c5U, 0xa261dc20U, 0x695a774bU, 0x161c121aU, + 0x0ae293baU, 0xe5c0a02aU, 0x433c22e0U, 0x1d121b17U, + 0x0b0e090dU, 0xadf28bc7U, 0xb92db6a8U, 0xc8141ea9U, + 0x8557f119U, 0x4caf7507U, 0xbbee99ddU, 0xfda37f60U, + 0x9ff70126U, 0xbc5c72f5U, 0xc544663bU, 0x345bfb7eU, + 0x768b4329U, 0xdccb23c6U, 0x68b6edfcU, 0x63b8e4f1U, + 0xcad731dcU, 0x10426385U, 0x40139722U, 0x2084c611U, + 0x7d854a24U, 0xf8d2bb3dU, 0x11aef932U, 0x6dc729a1U, + 0x4b1d9e2fU, 0xf3dcb230U, 0xec0d8652U, 0xd077c1e3U, + 0x6c2bb316U, 0x99a970b9U, 0xfa119448U, 0x2247e964U, + 0xc4a8fc8cU, 0x1aa0f03fU, 0xd8567d2cU, 0xef223390U, + 0xc787494eU, 0xc1d938d1U, 0xfe8ccaa2U, 0x3698d40bU, + 0xcfa6f581U, 0x28a57adeU, 0x26dab78eU, 0xa43fadbfU, + 0xe42c3a9dU, 0x0d507892U, 0x9b6a5fccU, 0x62547e46U, + 0xc2f68d13U, 0xe890d8b8U, 0x5e2e39f7U, 0xf582c3afU, + 0xbe9f5d80U, 0x7c69d093U, 0xa96fd52dU, 0xb3cf2512U, + 0x3bc8ac99U, 0xa710187dU, 0x6ee89c63U, 0x7bdb3bbbU, + 0x09cd2678U, 0xf46e5918U, 0x01ec9ab7U, 0xa8834f9aU, + 0x65e6956eU, 0x7eaaffe6U, 0x0821bccfU, 0xe6ef15e8U, + 0xd9bae79bU, 0xce4a6f36U, 0xd4ea9f09U, 0xd629b07cU, + 0xaf31a4b2U, 0x312a3f23U, 0x30c6a594U, 0xc035a266U, + 0x37744ebcU, 0xa6fc82caU, 0xb0e090d0U, 0x1533a7d8U, + 0x4af10498U, 0xf741ecdaU, 0x0e7fcd50U, 0x2f1791f6U, + 0x8d764dd6U, 0x4d43efb0U, 0x54ccaa4dU, 0xdfe49604U, + 0xe39ed1b5U, 0x1b4c6a88U, 0xb8c12c1fU, 0x7f466551U, + 0x049d5eeaU, 0x5d018c35U, 0x73fa8774U, 0x2efb0b41U, + 0x5ab3671dU, 0x5292dbd2U, 0x33e91056U, 0x136dd647U, + 0x8c9ad761U, 0x7a37a10cU, 0x8e59f814U, 0x89eb133cU, + 0xeecea927U, 0x35b761c9U, 0xede11ce5U, 0x3c7a47b1U, + 0x599cd2dfU, 0x3f55f273U, 0x791814ceU, 0xbf73c737U, + 0xea53f7cdU, 0x5b5ffdaaU, 0x14df3d6fU, 0x867844dbU, + 0x81caaff3U, 0x3eb968c4U, 0x2c382434U, 0x5fc2a340U, + 0x72161dc3U, 0x0cbce225U, 0x8b283c49U, 0x41ff0d95U, + 0x7139a801U, 0xde080cb3U, 0x9cd8b4e4U, 0x906456c1U, + 0x617bcb84U, 0x70d532b6U, 0x74486c5cU, 0x42d0b857U, +}; +static const u32 Td2[256] = { + 0xa75051f4U, 0x65537e41U, 0xa4c31a17U, 0x5e963a27U, + 0x6bcb3babU, 0x45f11f9dU, 0x58abacfaU, 0x03934be3U, + 0xfa552030U, 0x6df6ad76U, 0x769188ccU, 0x4c25f502U, + 0xd7fc4fe5U, 0xcbd7c52aU, 0x44802635U, 0xa38fb562U, + 0x5a49deb1U, 0x1b6725baU, 0x0e9845eaU, 0xc0e15dfeU, + 0x7502c32fU, 0xf012814cU, 0x97a38d46U, 0xf9c66bd3U, + 0x5fe7038fU, 0x9c951592U, 0x7aebbf6dU, 0x59da9552U, + 0x832dd4beU, 0x21d35874U, 0x692949e0U, 0xc8448ec9U, + 0x896a75c2U, 0x7978f48eU, 0x3e6b9958U, 0x71dd27b9U, + 0x4fb6bee1U, 0xad17f088U, 0xac66c920U, 0x3ab47dceU, + 0x4a1863dfU, 0x3182e51aU, 0x33609751U, 0x7f456253U, + 0x77e0b164U, 0xae84bb6bU, 0xa01cfe81U, 0x2b94f908U, + 0x68587048U, 0xfd198f45U, 0x6c8794deU, 0xf8b7527bU, + 0xd323ab73U, 0x02e2724bU, 0x8f57e31fU, 0xab2a6655U, + 0x2807b2ebU, 0xc2032fb5U, 0x7b9a86c5U, 0x08a5d337U, + 0x87f23028U, 0xa5b223bfU, 0x6aba0203U, 0x825ced16U, + 0x1c2b8acfU, 0xb492a779U, 0xf2f0f307U, 0xe2a14e69U, + 0xf4cd65daU, 0xbed50605U, 0x621fd134U, 0xfe8ac4a6U, + 0x539d342eU, 0x55a0a2f3U, 0xe132058aU, 0xeb75a4f6U, + 0xec390b83U, 0xefaa4060U, 0x9f065e71U, 0x1051bd6eU, + 0x8af93e21U, 0x063d96ddU, 0x05aedd3eU, 0xbd464de6U, + 0x8db59154U, 0x5d0571c4U, 0xd46f0406U, 0x15ff6050U, + 0xfb241998U, 0xe997d6bdU, 0x43cc8940U, 0x9e7767d9U, + 0x42bdb0e8U, 0x8b880789U, 0x5b38e719U, 0xeedb79c8U, + 0x0a47a17cU, 0x0fe97c42U, 0x1ec9f884U, 0x00000000U, + 0x86830980U, 0xed48322bU, 0x70ac1e11U, 0x724e6c5aU, + 0xfffbfd0eU, 0x38560f85U, 0xd51e3daeU, 0x3927362dU, + 0xd9640a0fU, 0xa621685cU, 0x54d19b5bU, 0x2e3a2436U, + 0x67b10c0aU, 0xe70f9357U, 0x96d2b4eeU, 0x919e1b9bU, + 0xc54f80c0U, 0x20a261dcU, 0x4b695a77U, 0x1a161c12U, + 0xba0ae293U, 0x2ae5c0a0U, 0xe0433c22U, 0x171d121bU, + 0x0d0b0e09U, 0xc7adf28bU, 0xa8b92db6U, 0xa9c8141eU, + 0x198557f1U, 0x074caf75U, 0xddbbee99U, 0x60fda37fU, + 0x269ff701U, 0xf5bc5c72U, 0x3bc54466U, 0x7e345bfbU, + 0x29768b43U, 0xc6dccb23U, 0xfc68b6edU, 0xf163b8e4U, + 0xdccad731U, 0x85104263U, 0x22401397U, 0x112084c6U, + 0x247d854aU, 0x3df8d2bbU, 0x3211aef9U, 0xa16dc729U, + 0x2f4b1d9eU, 0x30f3dcb2U, 0x52ec0d86U, 0xe3d077c1U, + 0x166c2bb3U, 0xb999a970U, 0x48fa1194U, 0x642247e9U, + 0x8cc4a8fcU, 0x3f1aa0f0U, 0x2cd8567dU, 0x90ef2233U, + 0x4ec78749U, 0xd1c1d938U, 0xa2fe8ccaU, 0x0b3698d4U, + 0x81cfa6f5U, 0xde28a57aU, 0x8e26dab7U, 0xbfa43fadU, + 0x9de42c3aU, 0x920d5078U, 0xcc9b6a5fU, 0x4662547eU, + 0x13c2f68dU, 0xb8e890d8U, 0xf75e2e39U, 0xaff582c3U, + 0x80be9f5dU, 0x937c69d0U, 0x2da96fd5U, 0x12b3cf25U, + 0x993bc8acU, 0x7da71018U, 0x636ee89cU, 0xbb7bdb3bU, + 0x7809cd26U, 0x18f46e59U, 0xb701ec9aU, 0x9aa8834fU, + 0x6e65e695U, 0xe67eaaffU, 0xcf0821bcU, 0xe8e6ef15U, + 0x9bd9bae7U, 0x36ce4a6fU, 0x09d4ea9fU, 0x7cd629b0U, + 0xb2af31a4U, 0x23312a3fU, 0x9430c6a5U, 0x66c035a2U, + 0xbc37744eU, 0xcaa6fc82U, 0xd0b0e090U, 0xd81533a7U, + 0x984af104U, 0xdaf741ecU, 0x500e7fcdU, 0xf62f1791U, + 0xd68d764dU, 0xb04d43efU, 0x4d54ccaaU, 0x04dfe496U, + 0xb5e39ed1U, 0x881b4c6aU, 0x1fb8c12cU, 0x517f4665U, + 0xea049d5eU, 0x355d018cU, 0x7473fa87U, 0x412efb0bU, + 0x1d5ab367U, 0xd25292dbU, 0x5633e910U, 0x47136dd6U, + 0x618c9ad7U, 0x0c7a37a1U, 0x148e59f8U, 0x3c89eb13U, + 0x27eecea9U, 0xc935b761U, 0xe5ede11cU, 0xb13c7a47U, + 0xdf599cd2U, 0x733f55f2U, 0xce791814U, 0x37bf73c7U, + 0xcdea53f7U, 0xaa5b5ffdU, 0x6f14df3dU, 0xdb867844U, + 0xf381caafU, 0xc43eb968U, 0x342c3824U, 0x405fc2a3U, + 0xc372161dU, 0x250cbce2U, 0x498b283cU, 0x9541ff0dU, + 0x017139a8U, 0xb3de080cU, 0xe49cd8b4U, 0xc1906456U, + 0x84617bcbU, 0xb670d532U, 0x5c74486cU, 0x5742d0b8U, +}; +static const u32 Td3[256] = { + 0xf4a75051U, 0x4165537eU, 0x17a4c31aU, 0x275e963aU, + 0xab6bcb3bU, 0x9d45f11fU, 0xfa58abacU, 0xe303934bU, + 0x30fa5520U, 0x766df6adU, 0xcc769188U, 0x024c25f5U, + 0xe5d7fc4fU, 0x2acbd7c5U, 0x35448026U, 0x62a38fb5U, + 0xb15a49deU, 0xba1b6725U, 0xea0e9845U, 0xfec0e15dU, + 0x2f7502c3U, 0x4cf01281U, 0x4697a38dU, 0xd3f9c66bU, + 0x8f5fe703U, 0x929c9515U, 0x6d7aebbfU, 0x5259da95U, + 0xbe832dd4U, 0x7421d358U, 0xe0692949U, 0xc9c8448eU, + 0xc2896a75U, 0x8e7978f4U, 0x583e6b99U, 0xb971dd27U, + 0xe14fb6beU, 0x88ad17f0U, 0x20ac66c9U, 0xce3ab47dU, + 0xdf4a1863U, 0x1a3182e5U, 0x51336097U, 0x537f4562U, + 0x6477e0b1U, 0x6bae84bbU, 0x81a01cfeU, 0x082b94f9U, + 0x48685870U, 0x45fd198fU, 0xde6c8794U, 0x7bf8b752U, + 0x73d323abU, 0x4b02e272U, 0x1f8f57e3U, 0x55ab2a66U, + 0xeb2807b2U, 0xb5c2032fU, 0xc57b9a86U, 0x3708a5d3U, + 0x2887f230U, 0xbfa5b223U, 0x036aba02U, 0x16825cedU, + 0xcf1c2b8aU, 0x79b492a7U, 0x07f2f0f3U, 0x69e2a14eU, + 0xdaf4cd65U, 0x05bed506U, 0x34621fd1U, 0xa6fe8ac4U, + 0x2e539d34U, 0xf355a0a2U, 0x8ae13205U, 0xf6eb75a4U, + 0x83ec390bU, 0x60efaa40U, 0x719f065eU, 0x6e1051bdU, + 0x218af93eU, 0xdd063d96U, 0x3e05aeddU, 0xe6bd464dU, + 0x548db591U, 0xc45d0571U, 0x06d46f04U, 0x5015ff60U, + 0x98fb2419U, 0xbde997d6U, 0x4043cc89U, 0xd99e7767U, + 0xe842bdb0U, 0x898b8807U, 0x195b38e7U, 0xc8eedb79U, + 0x7c0a47a1U, 0x420fe97cU, 0x841ec9f8U, 0x00000000U, + 0x80868309U, 0x2bed4832U, 0x1170ac1eU, 0x5a724e6cU, + 0x0efffbfdU, 0x8538560fU, 0xaed51e3dU, 0x2d392736U, + 0x0fd9640aU, 0x5ca62168U, 0x5b54d19bU, 0x362e3a24U, + 0x0a67b10cU, 0x57e70f93U, 0xee96d2b4U, 0x9b919e1bU, + 0xc0c54f80U, 0xdc20a261U, 0x774b695aU, 0x121a161cU, + 0x93ba0ae2U, 0xa02ae5c0U, 0x22e0433cU, 0x1b171d12U, + 0x090d0b0eU, 0x8bc7adf2U, 0xb6a8b92dU, 0x1ea9c814U, + 0xf1198557U, 0x75074cafU, 0x99ddbbeeU, 0x7f60fda3U, + 0x01269ff7U, 0x72f5bc5cU, 0x663bc544U, 0xfb7e345bU, + 0x4329768bU, 0x23c6dccbU, 0xedfc68b6U, 0xe4f163b8U, + 0x31dccad7U, 0x63851042U, 0x97224013U, 0xc6112084U, + 0x4a247d85U, 0xbb3df8d2U, 0xf93211aeU, 0x29a16dc7U, + 0x9e2f4b1dU, 0xb230f3dcU, 0x8652ec0dU, 0xc1e3d077U, + 0xb3166c2bU, 0x70b999a9U, 0x9448fa11U, 0xe9642247U, + 0xfc8cc4a8U, 0xf03f1aa0U, 0x7d2cd856U, 0x3390ef22U, + 0x494ec787U, 0x38d1c1d9U, 0xcaa2fe8cU, 0xd40b3698U, + 0xf581cfa6U, 0x7ade28a5U, 0xb78e26daU, 0xadbfa43fU, + 0x3a9de42cU, 0x78920d50U, 0x5fcc9b6aU, 0x7e466254U, + 0x8d13c2f6U, 0xd8b8e890U, 0x39f75e2eU, 0xc3aff582U, + 0x5d80be9fU, 0xd0937c69U, 0xd52da96fU, 0x2512b3cfU, + 0xac993bc8U, 0x187da710U, 0x9c636ee8U, 0x3bbb7bdbU, + 0x267809cdU, 0x5918f46eU, 0x9ab701ecU, 0x4f9aa883U, + 0x956e65e6U, 0xffe67eaaU, 0xbccf0821U, 0x15e8e6efU, + 0xe79bd9baU, 0x6f36ce4aU, 0x9f09d4eaU, 0xb07cd629U, + 0xa4b2af31U, 0x3f23312aU, 0xa59430c6U, 0xa266c035U, + 0x4ebc3774U, 0x82caa6fcU, 0x90d0b0e0U, 0xa7d81533U, + 0x04984af1U, 0xecdaf741U, 0xcd500e7fU, 0x91f62f17U, + 0x4dd68d76U, 0xefb04d43U, 0xaa4d54ccU, 0x9604dfe4U, + 0xd1b5e39eU, 0x6a881b4cU, 0x2c1fb8c1U, 0x65517f46U, + 0x5eea049dU, 0x8c355d01U, 0x877473faU, 0x0b412efbU, + 0x671d5ab3U, 0xdbd25292U, 0x105633e9U, 0xd647136dU, + 0xd7618c9aU, 0xa10c7a37U, 0xf8148e59U, 0x133c89ebU, + 0xa927eeceU, 0x61c935b7U, 0x1ce5ede1U, 0x47b13c7aU, + 0xd2df599cU, 0xf2733f55U, 0x14ce7918U, 0xc737bf73U, + 0xf7cdea53U, 0xfdaa5b5fU, 0x3d6f14dfU, 0x44db8678U, + 0xaff381caU, 0x68c43eb9U, 0x24342c38U, 0xa3405fc2U, + 0x1dc37216U, 0xe2250cbcU, 0x3c498b28U, 0x0d9541ffU, + 0xa8017139U, 0x0cb3de08U, 0xb4e49cd8U, 0x56c19064U, + 0xcb84617bU, 0x32b670d5U, 0x6c5c7448U, 0xb85742d0U, +}; +static const u8 Td4[256] = { + 0x52U, 0x09U, 0x6aU, 0xd5U, 0x30U, 0x36U, 0xa5U, 0x38U, + 0xbfU, 0x40U, 0xa3U, 0x9eU, 0x81U, 0xf3U, 0xd7U, 0xfbU, + 0x7cU, 0xe3U, 0x39U, 0x82U, 0x9bU, 0x2fU, 0xffU, 0x87U, + 0x34U, 0x8eU, 0x43U, 0x44U, 0xc4U, 0xdeU, 0xe9U, 0xcbU, + 0x54U, 0x7bU, 0x94U, 0x32U, 0xa6U, 0xc2U, 0x23U, 0x3dU, + 0xeeU, 0x4cU, 0x95U, 0x0bU, 0x42U, 0xfaU, 0xc3U, 0x4eU, + 0x08U, 0x2eU, 0xa1U, 0x66U, 0x28U, 0xd9U, 0x24U, 0xb2U, + 0x76U, 0x5bU, 0xa2U, 0x49U, 0x6dU, 0x8bU, 0xd1U, 0x25U, + 0x72U, 0xf8U, 0xf6U, 0x64U, 0x86U, 0x68U, 0x98U, 0x16U, + 0xd4U, 0xa4U, 0x5cU, 0xccU, 0x5dU, 0x65U, 0xb6U, 0x92U, + 0x6cU, 0x70U, 0x48U, 0x50U, 0xfdU, 0xedU, 0xb9U, 0xdaU, + 0x5eU, 0x15U, 0x46U, 0x57U, 0xa7U, 0x8dU, 0x9dU, 0x84U, + 0x90U, 0xd8U, 0xabU, 0x00U, 0x8cU, 0xbcU, 0xd3U, 0x0aU, + 0xf7U, 0xe4U, 0x58U, 0x05U, 0xb8U, 0xb3U, 0x45U, 0x06U, + 0xd0U, 0x2cU, 0x1eU, 0x8fU, 0xcaU, 0x3fU, 0x0fU, 0x02U, + 0xc1U, 0xafU, 0xbdU, 0x03U, 0x01U, 0x13U, 0x8aU, 0x6bU, + 0x3aU, 0x91U, 0x11U, 0x41U, 0x4fU, 0x67U, 0xdcU, 0xeaU, + 0x97U, 0xf2U, 0xcfU, 0xceU, 0xf0U, 0xb4U, 0xe6U, 0x73U, + 0x96U, 0xacU, 0x74U, 0x22U, 0xe7U, 0xadU, 0x35U, 0x85U, + 0xe2U, 0xf9U, 0x37U, 0xe8U, 0x1cU, 0x75U, 0xdfU, 0x6eU, + 0x47U, 0xf1U, 0x1aU, 0x71U, 0x1dU, 0x29U, 0xc5U, 0x89U, + 0x6fU, 0xb7U, 0x62U, 0x0eU, 0xaaU, 0x18U, 0xbeU, 0x1bU, + 0xfcU, 0x56U, 0x3eU, 0x4bU, 0xc6U, 0xd2U, 0x79U, 0x20U, + 0x9aU, 0xdbU, 0xc0U, 0xfeU, 0x78U, 0xcdU, 0x5aU, 0xf4U, + 0x1fU, 0xddU, 0xa8U, 0x33U, 0x88U, 0x07U, 0xc7U, 0x31U, + 0xb1U, 0x12U, 0x10U, 0x59U, 0x27U, 0x80U, 0xecU, 0x5fU, + 0x60U, 0x51U, 0x7fU, 0xa9U, 0x19U, 0xb5U, 0x4aU, 0x0dU, + 0x2dU, 0xe5U, 0x7aU, 0x9fU, 0x93U, 0xc9U, 0x9cU, 0xefU, + 0xa0U, 0xe0U, 0x3bU, 0x4dU, 0xaeU, 0x2aU, 0xf5U, 0xb0U, + 0xc8U, 0xebU, 0xbbU, 0x3cU, 0x83U, 0x53U, 0x99U, 0x61U, + 0x17U, 0x2bU, 0x04U, 0x7eU, 0xbaU, 0x77U, 0xd6U, 0x26U, + 0xe1U, 0x69U, 0x14U, 0x63U, 0x55U, 0x21U, 0x0cU, 0x7dU, +}; +static const u32 rcon[] = { + 0x01000000, 0x02000000, 0x04000000, 0x08000000, + 0x10000000, 0x20000000, 0x40000000, 0x80000000, + 0x1B000000, 0x36000000, /* for 128-bit blocks, Rijndael never uses more than 10 rcon values */ +}; + +/** + * Expand the cipher key into the encryption key schedule. + */ +int AES_set_encrypt_key(const unsigned char *userKey, const int bits, + AES_KEY *key) { + + u32 *rk; + int i = 0; + u32 temp; + + if (!userKey || !key) + return -1; + if (bits != 128 && bits != 192 && bits != 256) + return -2; + + rk = key->rd_key; + + if (bits==128) + key->rounds = 10; + else if (bits==192) + key->rounds = 12; + else + key->rounds = 14; + + rk[0] = GETU32(userKey ); + rk[1] = GETU32(userKey + 4); + rk[2] = GETU32(userKey + 8); + rk[3] = GETU32(userKey + 12); + if (bits == 128) { + while (1) { + temp = rk[3]; + rk[4] = rk[0] ^ + (Te2[(temp >> 16) & 0xff] & 0xff000000) ^ + (Te3[(temp >> 8) & 0xff] & 0x00ff0000) ^ + (Te0[(temp ) & 0xff] & 0x0000ff00) ^ + (Te1[(temp >> 24) ] & 0x000000ff) ^ + rcon[i]; + rk[5] = rk[1] ^ rk[4]; + rk[6] = rk[2] ^ rk[5]; + rk[7] = rk[3] ^ rk[6]; + if (++i == 10) { + return 0; + } + rk += 4; + } + } + rk[4] = GETU32(userKey + 16); + rk[5] = GETU32(userKey + 20); + if (bits == 192) { + while (1) { + temp = rk[ 5]; + rk[ 6] = rk[ 0] ^ + (Te2[(temp >> 16) & 0xff] & 0xff000000) ^ + (Te3[(temp >> 8) & 0xff] & 0x00ff0000) ^ + (Te0[(temp ) & 0xff] & 0x0000ff00) ^ + (Te1[(temp >> 24) ] & 0x000000ff) ^ + rcon[i]; + rk[ 7] = rk[ 1] ^ rk[ 6]; + rk[ 8] = rk[ 2] ^ rk[ 7]; + rk[ 9] = rk[ 3] ^ rk[ 8]; + if (++i == 8) { + return 0; + } + rk[10] = rk[ 4] ^ rk[ 9]; + rk[11] = rk[ 5] ^ rk[10]; + rk += 6; + } + } + rk[6] = GETU32(userKey + 24); + rk[7] = GETU32(userKey + 28); + if (bits == 256) { + while (1) { + temp = rk[ 7]; + rk[ 8] = rk[ 0] ^ + (Te2[(temp >> 16) & 0xff] & 0xff000000) ^ + (Te3[(temp >> 8) & 0xff] & 0x00ff0000) ^ + (Te0[(temp ) & 0xff] & 0x0000ff00) ^ + (Te1[(temp >> 24) ] & 0x000000ff) ^ + rcon[i]; + rk[ 9] = rk[ 1] ^ rk[ 8]; + rk[10] = rk[ 2] ^ rk[ 9]; + rk[11] = rk[ 3] ^ rk[10]; + if (++i == 7) { + return 0; + } + temp = rk[11]; + rk[12] = rk[ 4] ^ + (Te2[(temp >> 24) ] & 0xff000000) ^ + (Te3[(temp >> 16) & 0xff] & 0x00ff0000) ^ + (Te0[(temp >> 8) & 0xff] & 0x0000ff00) ^ + (Te1[(temp ) & 0xff] & 0x000000ff); + rk[13] = rk[ 5] ^ rk[12]; + rk[14] = rk[ 6] ^ rk[13]; + rk[15] = rk[ 7] ^ rk[14]; + + rk += 8; + } + } + return 0; +} + +/** + * Expand the cipher key into the decryption key schedule. + */ +int AES_set_decrypt_key(const unsigned char *userKey, const int bits, + AES_KEY *key) { + + u32 *rk; + int i, j, status; + u32 temp; + + /* first, start with an encryption schedule */ + status = AES_set_encrypt_key(userKey, bits, key); + if (status < 0) + return status; + + rk = key->rd_key; + + /* invert the order of the round keys: */ + for (i = 0, j = 4*(key->rounds); i < j; i += 4, j -= 4) { + temp = rk[i ]; rk[i ] = rk[j ]; rk[j ] = temp; + temp = rk[i + 1]; rk[i + 1] = rk[j + 1]; rk[j + 1] = temp; + temp = rk[i + 2]; rk[i + 2] = rk[j + 2]; rk[j + 2] = temp; + temp = rk[i + 3]; rk[i + 3] = rk[j + 3]; rk[j + 3] = temp; + } + /* apply the inverse MixColumn transform to all round keys but the first and the last: */ + for (i = 1; i < (key->rounds); i++) { + rk += 4; + rk[0] = + Td0[Te1[(rk[0] >> 24) ] & 0xff] ^ + Td1[Te1[(rk[0] >> 16) & 0xff] & 0xff] ^ + Td2[Te1[(rk[0] >> 8) & 0xff] & 0xff] ^ + Td3[Te1[(rk[0] ) & 0xff] & 0xff]; + rk[1] = + Td0[Te1[(rk[1] >> 24) ] & 0xff] ^ + Td1[Te1[(rk[1] >> 16) & 0xff] & 0xff] ^ + Td2[Te1[(rk[1] >> 8) & 0xff] & 0xff] ^ + Td3[Te1[(rk[1] ) & 0xff] & 0xff]; + rk[2] = + Td0[Te1[(rk[2] >> 24) ] & 0xff] ^ + Td1[Te1[(rk[2] >> 16) & 0xff] & 0xff] ^ + Td2[Te1[(rk[2] >> 8) & 0xff] & 0xff] ^ + Td3[Te1[(rk[2] ) & 0xff] & 0xff]; + rk[3] = + Td0[Te1[(rk[3] >> 24) ] & 0xff] ^ + Td1[Te1[(rk[3] >> 16) & 0xff] & 0xff] ^ + Td2[Te1[(rk[3] >> 8) & 0xff] & 0xff] ^ + Td3[Te1[(rk[3] ) & 0xff] & 0xff]; + } + return 0; +} + + +void AES_encrypt(const unsigned char *in, unsigned char *out, + const AES_KEY *key) { + + const u32 *rk; + u32 s0, s1, s2, s3, t0, t1, t2, t3; +#ifndef FULL_UNROLL + int r; +#endif /* ?FULL_UNROLL */ + + assert(in && out && key); + rk = key->rd_key; + + /* + * map byte array block to cipher state + * and add initial round key: + */ + s0 = GETU32(in ) ^ rk[0]; + s1 = GETU32(in + 4) ^ rk[1]; + s2 = GETU32(in + 8) ^ rk[2]; + s3 = GETU32(in + 12) ^ rk[3]; +#ifdef FULL_UNROLL + /* round 1: */ + t0 = Te0[s0 >> 24] ^ Te1[(s1 >> 16) & 0xff] ^ Te2[(s2 >> 8) & 0xff] ^ Te3[s3 & 0xff] ^ rk[ 4]; + t1 = Te0[s1 >> 24] ^ Te1[(s2 >> 16) & 0xff] ^ Te2[(s3 >> 8) & 0xff] ^ Te3[s0 & 0xff] ^ rk[ 5]; + t2 = Te0[s2 >> 24] ^ Te1[(s3 >> 16) & 0xff] ^ Te2[(s0 >> 8) & 0xff] ^ Te3[s1 & 0xff] ^ rk[ 6]; + t3 = Te0[s3 >> 24] ^ Te1[(s0 >> 16) & 0xff] ^ Te2[(s1 >> 8) & 0xff] ^ Te3[s2 & 0xff] ^ rk[ 7]; + /* round 2: */ + s0 = Te0[t0 >> 24] ^ Te1[(t1 >> 16) & 0xff] ^ Te2[(t2 >> 8) & 0xff] ^ Te3[t3 & 0xff] ^ rk[ 8]; + s1 = Te0[t1 >> 24] ^ Te1[(t2 >> 16) & 0xff] ^ Te2[(t3 >> 8) & 0xff] ^ Te3[t0 & 0xff] ^ rk[ 9]; + s2 = Te0[t2 >> 24] ^ Te1[(t3 >> 16) & 0xff] ^ Te2[(t0 >> 8) & 0xff] ^ Te3[t1 & 0xff] ^ rk[10]; + s3 = Te0[t3 >> 24] ^ Te1[(t0 >> 16) & 0xff] ^ Te2[(t1 >> 8) & 0xff] ^ Te3[t2 & 0xff] ^ rk[11]; + /* round 3: */ + t0 = Te0[s0 >> 24] ^ Te1[(s1 >> 16) & 0xff] ^ Te2[(s2 >> 8) & 0xff] ^ Te3[s3 & 0xff] ^ rk[12]; + t1 = Te0[s1 >> 24] ^ Te1[(s2 >> 16) & 0xff] ^ Te2[(s3 >> 8) & 0xff] ^ Te3[s0 & 0xff] ^ rk[13]; + t2 = Te0[s2 >> 24] ^ Te1[(s3 >> 16) & 0xff] ^ Te2[(s0 >> 8) & 0xff] ^ Te3[s1 & 0xff] ^ rk[14]; + t3 = Te0[s3 >> 24] ^ Te1[(s0 >> 16) & 0xff] ^ Te2[(s1 >> 8) & 0xff] ^ Te3[s2 & 0xff] ^ rk[15]; + /* round 4: */ + s0 = Te0[t0 >> 24] ^ Te1[(t1 >> 16) & 0xff] ^ Te2[(t2 >> 8) & 0xff] ^ Te3[t3 & 0xff] ^ rk[16]; + s1 = Te0[t1 >> 24] ^ Te1[(t2 >> 16) & 0xff] ^ Te2[(t3 >> 8) & 0xff] ^ Te3[t0 & 0xff] ^ rk[17]; + s2 = Te0[t2 >> 24] ^ Te1[(t3 >> 16) & 0xff] ^ Te2[(t0 >> 8) & 0xff] ^ Te3[t1 & 0xff] ^ rk[18]; + s3 = Te0[t3 >> 24] ^ Te1[(t0 >> 16) & 0xff] ^ Te2[(t1 >> 8) & 0xff] ^ Te3[t2 & 0xff] ^ rk[19]; + /* round 5: */ + t0 = Te0[s0 >> 24] ^ Te1[(s1 >> 16) & 0xff] ^ Te2[(s2 >> 8) & 0xff] ^ Te3[s3 & 0xff] ^ rk[20]; + t1 = Te0[s1 >> 24] ^ Te1[(s2 >> 16) & 0xff] ^ Te2[(s3 >> 8) & 0xff] ^ Te3[s0 & 0xff] ^ rk[21]; + t2 = Te0[s2 >> 24] ^ Te1[(s3 >> 16) & 0xff] ^ Te2[(s0 >> 8) & 0xff] ^ Te3[s1 & 0xff] ^ rk[22]; + t3 = Te0[s3 >> 24] ^ Te1[(s0 >> 16) & 0xff] ^ Te2[(s1 >> 8) & 0xff] ^ Te3[s2 & 0xff] ^ rk[23]; + /* round 6: */ + s0 = Te0[t0 >> 24] ^ Te1[(t1 >> 16) & 0xff] ^ Te2[(t2 >> 8) & 0xff] ^ Te3[t3 & 0xff] ^ rk[24]; + s1 = Te0[t1 >> 24] ^ Te1[(t2 >> 16) & 0xff] ^ Te2[(t3 >> 8) & 0xff] ^ Te3[t0 & 0xff] ^ rk[25]; + s2 = Te0[t2 >> 24] ^ Te1[(t3 >> 16) & 0xff] ^ Te2[(t0 >> 8) & 0xff] ^ Te3[t1 & 0xff] ^ rk[26]; + s3 = Te0[t3 >> 24] ^ Te1[(t0 >> 16) & 0xff] ^ Te2[(t1 >> 8) & 0xff] ^ Te3[t2 & 0xff] ^ rk[27]; + /* round 7: */ + t0 = Te0[s0 >> 24] ^ Te1[(s1 >> 16) & 0xff] ^ Te2[(s2 >> 8) & 0xff] ^ Te3[s3 & 0xff] ^ rk[28]; + t1 = Te0[s1 >> 24] ^ Te1[(s2 >> 16) & 0xff] ^ Te2[(s3 >> 8) & 0xff] ^ Te3[s0 & 0xff] ^ rk[29]; + t2 = Te0[s2 >> 24] ^ Te1[(s3 >> 16) & 0xff] ^ Te2[(s0 >> 8) & 0xff] ^ Te3[s1 & 0xff] ^ rk[30]; + t3 = Te0[s3 >> 24] ^ Te1[(s0 >> 16) & 0xff] ^ Te2[(s1 >> 8) & 0xff] ^ Te3[s2 & 0xff] ^ rk[31]; + /* round 8: */ + s0 = Te0[t0 >> 24] ^ Te1[(t1 >> 16) & 0xff] ^ Te2[(t2 >> 8) & 0xff] ^ Te3[t3 & 0xff] ^ rk[32]; + s1 = Te0[t1 >> 24] ^ Te1[(t2 >> 16) & 0xff] ^ Te2[(t3 >> 8) & 0xff] ^ Te3[t0 & 0xff] ^ rk[33]; + s2 = Te0[t2 >> 24] ^ Te1[(t3 >> 16) & 0xff] ^ Te2[(t0 >> 8) & 0xff] ^ Te3[t1 & 0xff] ^ rk[34]; + s3 = Te0[t3 >> 24] ^ Te1[(t0 >> 16) & 0xff] ^ Te2[(t1 >> 8) & 0xff] ^ Te3[t2 & 0xff] ^ rk[35]; + /* round 9: */ + t0 = Te0[s0 >> 24] ^ Te1[(s1 >> 16) & 0xff] ^ Te2[(s2 >> 8) & 0xff] ^ Te3[s3 & 0xff] ^ rk[36]; + t1 = Te0[s1 >> 24] ^ Te1[(s2 >> 16) & 0xff] ^ Te2[(s3 >> 8) & 0xff] ^ Te3[s0 & 0xff] ^ rk[37]; + t2 = Te0[s2 >> 24] ^ Te1[(s3 >> 16) & 0xff] ^ Te2[(s0 >> 8) & 0xff] ^ Te3[s1 & 0xff] ^ rk[38]; + t3 = Te0[s3 >> 24] ^ Te1[(s0 >> 16) & 0xff] ^ Te2[(s1 >> 8) & 0xff] ^ Te3[s2 & 0xff] ^ rk[39]; + if (key->rounds > 10) { + /* round 10: */ + s0 = Te0[t0 >> 24] ^ Te1[(t1 >> 16) & 0xff] ^ Te2[(t2 >> 8) & 0xff] ^ Te3[t3 & 0xff] ^ rk[40]; + s1 = Te0[t1 >> 24] ^ Te1[(t2 >> 16) & 0xff] ^ Te2[(t3 >> 8) & 0xff] ^ Te3[t0 & 0xff] ^ rk[41]; + s2 = Te0[t2 >> 24] ^ Te1[(t3 >> 16) & 0xff] ^ Te2[(t0 >> 8) & 0xff] ^ Te3[t1 & 0xff] ^ rk[42]; + s3 = Te0[t3 >> 24] ^ Te1[(t0 >> 16) & 0xff] ^ Te2[(t1 >> 8) & 0xff] ^ Te3[t2 & 0xff] ^ rk[43]; + /* round 11: */ + t0 = Te0[s0 >> 24] ^ Te1[(s1 >> 16) & 0xff] ^ Te2[(s2 >> 8) & 0xff] ^ Te3[s3 & 0xff] ^ rk[44]; + t1 = Te0[s1 >> 24] ^ Te1[(s2 >> 16) & 0xff] ^ Te2[(s3 >> 8) & 0xff] ^ Te3[s0 & 0xff] ^ rk[45]; + t2 = Te0[s2 >> 24] ^ Te1[(s3 >> 16) & 0xff] ^ Te2[(s0 >> 8) & 0xff] ^ Te3[s1 & 0xff] ^ rk[46]; + t3 = Te0[s3 >> 24] ^ Te1[(s0 >> 16) & 0xff] ^ Te2[(s1 >> 8) & 0xff] ^ Te3[s2 & 0xff] ^ rk[47]; + if (key->rounds > 12) { + /* round 12: */ + s0 = Te0[t0 >> 24] ^ Te1[(t1 >> 16) & 0xff] ^ Te2[(t2 >> 8) & 0xff] ^ Te3[t3 & 0xff] ^ rk[48]; + s1 = Te0[t1 >> 24] ^ Te1[(t2 >> 16) & 0xff] ^ Te2[(t3 >> 8) & 0xff] ^ Te3[t0 & 0xff] ^ rk[49]; + s2 = Te0[t2 >> 24] ^ Te1[(t3 >> 16) & 0xff] ^ Te2[(t0 >> 8) & 0xff] ^ Te3[t1 & 0xff] ^ rk[50]; + s3 = Te0[t3 >> 24] ^ Te1[(t0 >> 16) & 0xff] ^ Te2[(t1 >> 8) & 0xff] ^ Te3[t2 & 0xff] ^ rk[51]; + /* round 13: */ + t0 = Te0[s0 >> 24] ^ Te1[(s1 >> 16) & 0xff] ^ Te2[(s2 >> 8) & 0xff] ^ Te3[s3 & 0xff] ^ rk[52]; + t1 = Te0[s1 >> 24] ^ Te1[(s2 >> 16) & 0xff] ^ Te2[(s3 >> 8) & 0xff] ^ Te3[s0 & 0xff] ^ rk[53]; + t2 = Te0[s2 >> 24] ^ Te1[(s3 >> 16) & 0xff] ^ Te2[(s0 >> 8) & 0xff] ^ Te3[s1 & 0xff] ^ rk[54]; + t3 = Te0[s3 >> 24] ^ Te1[(s0 >> 16) & 0xff] ^ Te2[(s1 >> 8) & 0xff] ^ Te3[s2 & 0xff] ^ rk[55]; + } + } + rk += key->rounds << 2; +#else /* !FULL_UNROLL */ + /* + * Nr - 1 full rounds: + */ + r = key->rounds >> 1; + for (;;) { + t0 = + Te0[(s0 >> 24) ] ^ + Te1[(s1 >> 16) & 0xff] ^ + Te2[(s2 >> 8) & 0xff] ^ + Te3[(s3 ) & 0xff] ^ + rk[4]; + t1 = + Te0[(s1 >> 24) ] ^ + Te1[(s2 >> 16) & 0xff] ^ + Te2[(s3 >> 8) & 0xff] ^ + Te3[(s0 ) & 0xff] ^ + rk[5]; + t2 = + Te0[(s2 >> 24) ] ^ + Te1[(s3 >> 16) & 0xff] ^ + Te2[(s0 >> 8) & 0xff] ^ + Te3[(s1 ) & 0xff] ^ + rk[6]; + t3 = + Te0[(s3 >> 24) ] ^ + Te1[(s0 >> 16) & 0xff] ^ + Te2[(s1 >> 8) & 0xff] ^ + Te3[(s2 ) & 0xff] ^ + rk[7]; + + rk += 8; + if (--r == 0) { + break; + } + + s0 = + Te0[(t0 >> 24) ] ^ + Te1[(t1 >> 16) & 0xff] ^ + Te2[(t2 >> 8) & 0xff] ^ + Te3[(t3 ) & 0xff] ^ + rk[0]; + s1 = + Te0[(t1 >> 24) ] ^ + Te1[(t2 >> 16) & 0xff] ^ + Te2[(t3 >> 8) & 0xff] ^ + Te3[(t0 ) & 0xff] ^ + rk[1]; + s2 = + Te0[(t2 >> 24) ] ^ + Te1[(t3 >> 16) & 0xff] ^ + Te2[(t0 >> 8) & 0xff] ^ + Te3[(t1 ) & 0xff] ^ + rk[2]; + s3 = + Te0[(t3 >> 24) ] ^ + Te1[(t0 >> 16) & 0xff] ^ + Te2[(t1 >> 8) & 0xff] ^ + Te3[(t2 ) & 0xff] ^ + rk[3]; + } +#endif /* ?FULL_UNROLL */ + /* + * apply last round and + * map cipher state to byte array block: + */ + s0 = + (Te2[(t0 >> 24) ] & 0xff000000) ^ + (Te3[(t1 >> 16) & 0xff] & 0x00ff0000) ^ + (Te0[(t2 >> 8) & 0xff] & 0x0000ff00) ^ + (Te1[(t3 ) & 0xff] & 0x000000ff) ^ + rk[0]; + PUTU32(out , s0); + s1 = + (Te2[(t1 >> 24) ] & 0xff000000) ^ + (Te3[(t2 >> 16) & 0xff] & 0x00ff0000) ^ + (Te0[(t3 >> 8) & 0xff] & 0x0000ff00) ^ + (Te1[(t0 ) & 0xff] & 0x000000ff) ^ + rk[1]; + PUTU32(out + 4, s1); + s2 = + (Te2[(t2 >> 24) ] & 0xff000000) ^ + (Te3[(t3 >> 16) & 0xff] & 0x00ff0000) ^ + (Te0[(t0 >> 8) & 0xff] & 0x0000ff00) ^ + (Te1[(t1 ) & 0xff] & 0x000000ff) ^ + rk[2]; + PUTU32(out + 8, s2); + s3 = + (Te2[(t3 >> 24) ] & 0xff000000) ^ + (Te3[(t0 >> 16) & 0xff] & 0x00ff0000) ^ + (Te0[(t1 >> 8) & 0xff] & 0x0000ff00) ^ + (Te1[(t2 ) & 0xff] & 0x000000ff) ^ + rk[3]; + PUTU32(out + 12, s3); +} + +/* + * Decrypt a single block + * in and out can overlap + */ +void AES_decrypt(const unsigned char *in, unsigned char *out, + const AES_KEY *key) { + + const u32 *rk; + u32 s0, s1, s2, s3, t0, t1, t2, t3; +#ifndef FULL_UNROLL + int r; +#endif /* ?FULL_UNROLL */ + + assert(in && out && key); + rk = key->rd_key; + + /* + * map byte array block to cipher state + * and add initial round key: + */ + s0 = GETU32(in ) ^ rk[0]; + s1 = GETU32(in + 4) ^ rk[1]; + s2 = GETU32(in + 8) ^ rk[2]; + s3 = GETU32(in + 12) ^ rk[3]; +#ifdef FULL_UNROLL + /* round 1: */ + t0 = Td0[s0 >> 24] ^ Td1[(s3 >> 16) & 0xff] ^ Td2[(s2 >> 8) & 0xff] ^ Td3[s1 & 0xff] ^ rk[ 4]; + t1 = Td0[s1 >> 24] ^ Td1[(s0 >> 16) & 0xff] ^ Td2[(s3 >> 8) & 0xff] ^ Td3[s2 & 0xff] ^ rk[ 5]; + t2 = Td0[s2 >> 24] ^ Td1[(s1 >> 16) & 0xff] ^ Td2[(s0 >> 8) & 0xff] ^ Td3[s3 & 0xff] ^ rk[ 6]; + t3 = Td0[s3 >> 24] ^ Td1[(s2 >> 16) & 0xff] ^ Td2[(s1 >> 8) & 0xff] ^ Td3[s0 & 0xff] ^ rk[ 7]; + /* round 2: */ + s0 = Td0[t0 >> 24] ^ Td1[(t3 >> 16) & 0xff] ^ Td2[(t2 >> 8) & 0xff] ^ Td3[t1 & 0xff] ^ rk[ 8]; + s1 = Td0[t1 >> 24] ^ Td1[(t0 >> 16) & 0xff] ^ Td2[(t3 >> 8) & 0xff] ^ Td3[t2 & 0xff] ^ rk[ 9]; + s2 = Td0[t2 >> 24] ^ Td1[(t1 >> 16) & 0xff] ^ Td2[(t0 >> 8) & 0xff] ^ Td3[t3 & 0xff] ^ rk[10]; + s3 = Td0[t3 >> 24] ^ Td1[(t2 >> 16) & 0xff] ^ Td2[(t1 >> 8) & 0xff] ^ Td3[t0 & 0xff] ^ rk[11]; + /* round 3: */ + t0 = Td0[s0 >> 24] ^ Td1[(s3 >> 16) & 0xff] ^ Td2[(s2 >> 8) & 0xff] ^ Td3[s1 & 0xff] ^ rk[12]; + t1 = Td0[s1 >> 24] ^ Td1[(s0 >> 16) & 0xff] ^ Td2[(s3 >> 8) & 0xff] ^ Td3[s2 & 0xff] ^ rk[13]; + t2 = Td0[s2 >> 24] ^ Td1[(s1 >> 16) & 0xff] ^ Td2[(s0 >> 8) & 0xff] ^ Td3[s3 & 0xff] ^ rk[14]; + t3 = Td0[s3 >> 24] ^ Td1[(s2 >> 16) & 0xff] ^ Td2[(s1 >> 8) & 0xff] ^ Td3[s0 & 0xff] ^ rk[15]; + /* round 4: */ + s0 = Td0[t0 >> 24] ^ Td1[(t3 >> 16) & 0xff] ^ Td2[(t2 >> 8) & 0xff] ^ Td3[t1 & 0xff] ^ rk[16]; + s1 = Td0[t1 >> 24] ^ Td1[(t0 >> 16) & 0xff] ^ Td2[(t3 >> 8) & 0xff] ^ Td3[t2 & 0xff] ^ rk[17]; + s2 = Td0[t2 >> 24] ^ Td1[(t1 >> 16) & 0xff] ^ Td2[(t0 >> 8) & 0xff] ^ Td3[t3 & 0xff] ^ rk[18]; + s3 = Td0[t3 >> 24] ^ Td1[(t2 >> 16) & 0xff] ^ Td2[(t1 >> 8) & 0xff] ^ Td3[t0 & 0xff] ^ rk[19]; + /* round 5: */ + t0 = Td0[s0 >> 24] ^ Td1[(s3 >> 16) & 0xff] ^ Td2[(s2 >> 8) & 0xff] ^ Td3[s1 & 0xff] ^ rk[20]; + t1 = Td0[s1 >> 24] ^ Td1[(s0 >> 16) & 0xff] ^ Td2[(s3 >> 8) & 0xff] ^ Td3[s2 & 0xff] ^ rk[21]; + t2 = Td0[s2 >> 24] ^ Td1[(s1 >> 16) & 0xff] ^ Td2[(s0 >> 8) & 0xff] ^ Td3[s3 & 0xff] ^ rk[22]; + t3 = Td0[s3 >> 24] ^ Td1[(s2 >> 16) & 0xff] ^ Td2[(s1 >> 8) & 0xff] ^ Td3[s0 & 0xff] ^ rk[23]; + /* round 6: */ + s0 = Td0[t0 >> 24] ^ Td1[(t3 >> 16) & 0xff] ^ Td2[(t2 >> 8) & 0xff] ^ Td3[t1 & 0xff] ^ rk[24]; + s1 = Td0[t1 >> 24] ^ Td1[(t0 >> 16) & 0xff] ^ Td2[(t3 >> 8) & 0xff] ^ Td3[t2 & 0xff] ^ rk[25]; + s2 = Td0[t2 >> 24] ^ Td1[(t1 >> 16) & 0xff] ^ Td2[(t0 >> 8) & 0xff] ^ Td3[t3 & 0xff] ^ rk[26]; + s3 = Td0[t3 >> 24] ^ Td1[(t2 >> 16) & 0xff] ^ Td2[(t1 >> 8) & 0xff] ^ Td3[t0 & 0xff] ^ rk[27]; + /* round 7: */ + t0 = Td0[s0 >> 24] ^ Td1[(s3 >> 16) & 0xff] ^ Td2[(s2 >> 8) & 0xff] ^ Td3[s1 & 0xff] ^ rk[28]; + t1 = Td0[s1 >> 24] ^ Td1[(s0 >> 16) & 0xff] ^ Td2[(s3 >> 8) & 0xff] ^ Td3[s2 & 0xff] ^ rk[29]; + t2 = Td0[s2 >> 24] ^ Td1[(s1 >> 16) & 0xff] ^ Td2[(s0 >> 8) & 0xff] ^ Td3[s3 & 0xff] ^ rk[30]; + t3 = Td0[s3 >> 24] ^ Td1[(s2 >> 16) & 0xff] ^ Td2[(s1 >> 8) & 0xff] ^ Td3[s0 & 0xff] ^ rk[31]; + /* round 8: */ + s0 = Td0[t0 >> 24] ^ Td1[(t3 >> 16) & 0xff] ^ Td2[(t2 >> 8) & 0xff] ^ Td3[t1 & 0xff] ^ rk[32]; + s1 = Td0[t1 >> 24] ^ Td1[(t0 >> 16) & 0xff] ^ Td2[(t3 >> 8) & 0xff] ^ Td3[t2 & 0xff] ^ rk[33]; + s2 = Td0[t2 >> 24] ^ Td1[(t1 >> 16) & 0xff] ^ Td2[(t0 >> 8) & 0xff] ^ Td3[t3 & 0xff] ^ rk[34]; + s3 = Td0[t3 >> 24] ^ Td1[(t2 >> 16) & 0xff] ^ Td2[(t1 >> 8) & 0xff] ^ Td3[t0 & 0xff] ^ rk[35]; + /* round 9: */ + t0 = Td0[s0 >> 24] ^ Td1[(s3 >> 16) & 0xff] ^ Td2[(s2 >> 8) & 0xff] ^ Td3[s1 & 0xff] ^ rk[36]; + t1 = Td0[s1 >> 24] ^ Td1[(s0 >> 16) & 0xff] ^ Td2[(s3 >> 8) & 0xff] ^ Td3[s2 & 0xff] ^ rk[37]; + t2 = Td0[s2 >> 24] ^ Td1[(s1 >> 16) & 0xff] ^ Td2[(s0 >> 8) & 0xff] ^ Td3[s3 & 0xff] ^ rk[38]; + t3 = Td0[s3 >> 24] ^ Td1[(s2 >> 16) & 0xff] ^ Td2[(s1 >> 8) & 0xff] ^ Td3[s0 & 0xff] ^ rk[39]; + if (key->rounds > 10) { + /* round 10: */ + s0 = Td0[t0 >> 24] ^ Td1[(t3 >> 16) & 0xff] ^ Td2[(t2 >> 8) & 0xff] ^ Td3[t1 & 0xff] ^ rk[40]; + s1 = Td0[t1 >> 24] ^ Td1[(t0 >> 16) & 0xff] ^ Td2[(t3 >> 8) & 0xff] ^ Td3[t2 & 0xff] ^ rk[41]; + s2 = Td0[t2 >> 24] ^ Td1[(t1 >> 16) & 0xff] ^ Td2[(t0 >> 8) & 0xff] ^ Td3[t3 & 0xff] ^ rk[42]; + s3 = Td0[t3 >> 24] ^ Td1[(t2 >> 16) & 0xff] ^ Td2[(t1 >> 8) & 0xff] ^ Td3[t0 & 0xff] ^ rk[43]; + /* round 11: */ + t0 = Td0[s0 >> 24] ^ Td1[(s3 >> 16) & 0xff] ^ Td2[(s2 >> 8) & 0xff] ^ Td3[s1 & 0xff] ^ rk[44]; + t1 = Td0[s1 >> 24] ^ Td1[(s0 >> 16) & 0xff] ^ Td2[(s3 >> 8) & 0xff] ^ Td3[s2 & 0xff] ^ rk[45]; + t2 = Td0[s2 >> 24] ^ Td1[(s1 >> 16) & 0xff] ^ Td2[(s0 >> 8) & 0xff] ^ Td3[s3 & 0xff] ^ rk[46]; + t3 = Td0[s3 >> 24] ^ Td1[(s2 >> 16) & 0xff] ^ Td2[(s1 >> 8) & 0xff] ^ Td3[s0 & 0xff] ^ rk[47]; + if (key->rounds > 12) { + /* round 12: */ + s0 = Td0[t0 >> 24] ^ Td1[(t3 >> 16) & 0xff] ^ Td2[(t2 >> 8) & 0xff] ^ Td3[t1 & 0xff] ^ rk[48]; + s1 = Td0[t1 >> 24] ^ Td1[(t0 >> 16) & 0xff] ^ Td2[(t3 >> 8) & 0xff] ^ Td3[t2 & 0xff] ^ rk[49]; + s2 = Td0[t2 >> 24] ^ Td1[(t1 >> 16) & 0xff] ^ Td2[(t0 >> 8) & 0xff] ^ Td3[t3 & 0xff] ^ rk[50]; + s3 = Td0[t3 >> 24] ^ Td1[(t2 >> 16) & 0xff] ^ Td2[(t1 >> 8) & 0xff] ^ Td3[t0 & 0xff] ^ rk[51]; + /* round 13: */ + t0 = Td0[s0 >> 24] ^ Td1[(s3 >> 16) & 0xff] ^ Td2[(s2 >> 8) & 0xff] ^ Td3[s1 & 0xff] ^ rk[52]; + t1 = Td0[s1 >> 24] ^ Td1[(s0 >> 16) & 0xff] ^ Td2[(s3 >> 8) & 0xff] ^ Td3[s2 & 0xff] ^ rk[53]; + t2 = Td0[s2 >> 24] ^ Td1[(s1 >> 16) & 0xff] ^ Td2[(s0 >> 8) & 0xff] ^ Td3[s3 & 0xff] ^ rk[54]; + t3 = Td0[s3 >> 24] ^ Td1[(s2 >> 16) & 0xff] ^ Td2[(s1 >> 8) & 0xff] ^ Td3[s0 & 0xff] ^ rk[55]; + } + } + rk += key->rounds << 2; +#else /* !FULL_UNROLL */ + /* + * Nr - 1 full rounds: + */ + r = key->rounds >> 1; + for (;;) { + t0 = + Td0[(s0 >> 24) ] ^ + Td1[(s3 >> 16) & 0xff] ^ + Td2[(s2 >> 8) & 0xff] ^ + Td3[(s1 ) & 0xff] ^ + rk[4]; + t1 = + Td0[(s1 >> 24) ] ^ + Td1[(s0 >> 16) & 0xff] ^ + Td2[(s3 >> 8) & 0xff] ^ + Td3[(s2 ) & 0xff] ^ + rk[5]; + t2 = + Td0[(s2 >> 24) ] ^ + Td1[(s1 >> 16) & 0xff] ^ + Td2[(s0 >> 8) & 0xff] ^ + Td3[(s3 ) & 0xff] ^ + rk[6]; + t3 = + Td0[(s3 >> 24) ] ^ + Td1[(s2 >> 16) & 0xff] ^ + Td2[(s1 >> 8) & 0xff] ^ + Td3[(s0 ) & 0xff] ^ + rk[7]; + + rk += 8; + if (--r == 0) { + break; + } + + s0 = + Td0[(t0 >> 24) ] ^ + Td1[(t3 >> 16) & 0xff] ^ + Td2[(t2 >> 8) & 0xff] ^ + Td3[(t1 ) & 0xff] ^ + rk[0]; + s1 = + Td0[(t1 >> 24) ] ^ + Td1[(t0 >> 16) & 0xff] ^ + Td2[(t3 >> 8) & 0xff] ^ + Td3[(t2 ) & 0xff] ^ + rk[1]; + s2 = + Td0[(t2 >> 24) ] ^ + Td1[(t1 >> 16) & 0xff] ^ + Td2[(t0 >> 8) & 0xff] ^ + Td3[(t3 ) & 0xff] ^ + rk[2]; + s3 = + Td0[(t3 >> 24) ] ^ + Td1[(t2 >> 16) & 0xff] ^ + Td2[(t1 >> 8) & 0xff] ^ + Td3[(t0 ) & 0xff] ^ + rk[3]; + } +#endif /* ?FULL_UNROLL */ + /* + * apply last round and + * map cipher state to byte array block: + */ + s0 = + (Td4[(t0 >> 24) ] << 24) ^ + (Td4[(t3 >> 16) & 0xff] << 16) ^ + (Td4[(t2 >> 8) & 0xff] << 8) ^ + (Td4[(t1 ) & 0xff]) ^ + rk[0]; + PUTU32(out , s0); + s1 = + (Td4[(t1 >> 24) ] << 24) ^ + (Td4[(t0 >> 16) & 0xff] << 16) ^ + (Td4[(t3 >> 8) & 0xff] << 8) ^ + (Td4[(t2 ) & 0xff]) ^ + rk[1]; + PUTU32(out + 4, s1); + s2 = + (Td4[(t2 >> 24) ] << 24) ^ + (Td4[(t1 >> 16) & 0xff] << 16) ^ + (Td4[(t0 >> 8) & 0xff] << 8) ^ + (Td4[(t3 ) & 0xff]) ^ + rk[2]; + PUTU32(out + 8, s2); + s3 = + (Td4[(t3 >> 24) ] << 24) ^ + (Td4[(t2 >> 16) & 0xff] << 16) ^ + (Td4[(t1 >> 8) & 0xff] << 8) ^ + (Td4[(t0 ) & 0xff]) ^ + rk[3]; + PUTU32(out + 12, s3); +} + + diff --git a/build/tools/sctools/common/src/my_aes.h b/build/tools/sctools/common/src/my_aes.h new file mode 100644 index 0000000..1567f94 --- /dev/null +++ b/build/tools/sctools/common/src/my_aes.h @@ -0,0 +1,44 @@ +#ifndef _MY_AES_H_ +#define _MY_AES_H_ + +#ifdef __cplusplus +extern "C" { +#endif + + +#define AES_ENCRYPT 1 +#define AES_DECRYPT 0 + +/* Because array size can't be a const in C, the following two are macros. + Both sizes are in bytes. */ +#define AES_MAXNR 14 +#define AES_BLOCK_SIZE 16 + + +typedef struct { + unsigned long rd_key[4 *(AES_MAXNR + 1)]; + int rounds; +} AES_KEY; + + +int AES_set_encrypt_key(const unsigned char *userKey, const int bits, + AES_KEY *key); +int AES_set_decrypt_key(const unsigned char *userKey, const int bits, + AES_KEY *key); + +void AES_encrypt(const unsigned char *in, unsigned char *out, + const AES_KEY *key); + +void AES_decrypt(const unsigned char *in, unsigned char *out, + const AES_KEY *key); + +void AES_cbc_encrypt(const unsigned char *in, unsigned char *out, + size_t length, const AES_KEY *key, + unsigned char *ivec, const int enc); + +#ifdef __cplusplus +} +#endif + + +#endif /* _MY_AES_H_ */ diff --git a/build/tools/sctools/common/src/my_fs_util.c b/build/tools/sctools/common/src/my_fs_util.c index a1028dd..b67ac2d 100644 --- a/build/tools/sctools/common/src/my_fs_util.c +++ b/build/tools/sctools/common/src/my_fs_util.c @@ -2822,7 +2822,9 @@ BOOL CleanSDCardFiles(char *log_file_name) } else if( STD_StrCmp(direntry.longname, "nup_log.txt") == 0 ) { } - else if( STD_StrCmp(direntry.longname, "tads") == 0 ) { + else if( STD_StrCmp(direntry.longname, "sdtads") == 0 ) { + } + else if( STD_StrCmp(direntry.longname, "sdtaddevs") == 0 ) { } else if( direntry.attributes & FS_ATTRIBUTE_DOS_VOLUME ) { } diff --git a/build/tools/sctools/common/src/my_fs_util.h b/build/tools/sctools/common/src/my_fs_util.h index 1c49960..ee12e1c 100644 --- a/build/tools/sctools/common/src/my_fs_util.h +++ b/build/tools/sctools/common/src/my_fs_util.h @@ -21,6 +21,7 @@ extern "C" { typedef struct { u64 tid; int is_personalized; + int version; BOOL install_success_flag; } MY_USER_APP_TID; diff --git a/build/tools/sctools/common/src/my_rsa_sign.c b/build/tools/sctools/common/src/my_rsa_sign.c new file mode 100644 index 0000000..45b9abd --- /dev/null +++ b/build/tools/sctools/common/src/my_rsa_sign.c @@ -0,0 +1,618 @@ +#include +#include +#include +#include +#include + +#define MY_RSA_SIGN_DEBUG 1 + + +#ifdef MY_RSA_SIGN_DEBUG +#include "text.h" +#include "mprintf.h" +#endif /* MY_RSA_SIGN_DEBUG */ + +#include "my_rsa_sign.h" + + +static const unsigned char rsa512_sec[]={ + 0x30,0x82,0x02,0x5c,0x02,0x01,0x00,0x02,0x81,0x81,0x00,0xeb,0x72,0xe2,0x05,0x45, + 0x37,0xd9,0x78,0x35,0xb5,0x8d,0x70,0x9a,0xe7,0x17,0x42,0xe9,0xf3,0x26,0x73,0x4e, + 0xdf,0x5e,0x96,0x5f,0xcf,0xf2,0xf1,0x2d,0xc0,0x41,0x31,0xb6,0x3b,0xe8,0xa4,0xd7, + 0x70,0xdb,0x3c,0xfd,0x66,0x0d,0xea,0x2f,0xb8,0x7b,0xf0,0x2d,0x70,0xe0,0xf1,0x05, + 0x55,0xe6,0x33,0x8f,0x3a,0xde,0x79,0xce,0xd0,0x11,0xbf,0xda,0x78,0xe1,0xef,0x8b, + 0x0e,0x2e,0xa7,0xe2,0x61,0x88,0x58,0x90,0x1d,0x0c,0x6d,0x5b,0x40,0xbf,0x6f,0xc7, + 0x18,0xde,0xe8,0xfd,0xd9,0xd9,0x1e,0xb9,0xe4,0xa3,0x4d,0x04,0x39,0x4b,0x8f,0x5b, + 0x13,0xad,0x14,0x0b,0xf8,0x53,0xbc,0xae,0x72,0x91,0x6b,0xcd,0xf9,0x39,0x8d,0x17, + 0x3d,0xc8,0xee,0xc9,0xcc,0x95,0x35,0x38,0xb0,0x80,0x53,0x02,0x03,0x01,0x00,0x01, + 0x02,0x81,0x80,0x52,0x5d,0x37,0xef,0xfc,0x0c,0xd3,0x88,0x97,0xd1,0x51,0x0f,0x49, + 0x40,0xfa,0x04,0x30,0x6f,0x1c,0xce,0x4d,0x93,0x1a,0x35,0xa4,0x82,0xcc,0x4b,0xce, + 0x63,0x68,0xeb,0x09,0x02,0xe0,0x19,0x7a,0x3c,0x42,0x95,0x8d,0x57,0x7c,0x1a,0xa6, + 0x62,0xf5,0x08,0x49,0xfd,0x28,0xd3,0x67,0xb8,0x6a,0xf5,0x32,0x6f,0xb7,0x90,0x08, + 0xe7,0x04,0xad,0xda,0xc8,0x70,0x10,0x3a,0x61,0x92,0x9b,0x03,0x96,0x8e,0xc7,0x59, + 0x0c,0x47,0xcb,0xbd,0xb6,0x6a,0x18,0xfc,0x29,0x69,0x80,0x17,0x82,0x90,0x59,0x1b, + 0xc6,0x3d,0x89,0x64,0x76,0x4d,0x73,0x63,0x7f,0xa5,0x3a,0xf8,0x81,0x7e,0x85,0xf0, + 0x4b,0xf3,0x9e,0x0c,0x9f,0x0f,0x59,0x91,0x25,0x32,0x84,0x5f,0x01,0xb8,0xa9,0xa2, + 0xad,0x05,0x31,0x02,0x41,0x00,0xff,0xa1,0x02,0xce,0x09,0xcb,0xde,0x21,0x8c,0xe9, + 0xa1,0xe6,0x6d,0x2a,0x94,0xee,0x7a,0x66,0xc7,0x9e,0x4e,0xea,0x7c,0xb7,0xcf,0xcf, + 0x1e,0x48,0xa9,0x67,0xfe,0x0d,0xc7,0xeb,0x45,0xdc,0x86,0x4d,0x12,0x79,0xcd,0x47, + 0x4a,0x82,0xf3,0x72,0x2b,0xdf,0x56,0x74,0x32,0x3f,0x13,0x83,0x2a,0xa5,0x1a,0xdd, + 0xc8,0x32,0x31,0x7a,0x6f,0xad,0x02,0x41,0x00,0xeb,0xca,0x5f,0x89,0x5e,0x94,0x1b, + 0xb9,0x40,0x14,0x11,0x9d,0xb5,0xa7,0xaa,0x41,0xf5,0xcc,0x3c,0x4c,0x0d,0x06,0x3b, + 0xac,0x77,0xb0,0x1a,0xf0,0x03,0x7f,0x1c,0x1b,0x19,0xea,0x71,0x0e,0x2f,0x08,0x7a, + 0x30,0xdc,0x16,0x5e,0xd5,0x4a,0x83,0x4a,0x2b,0x34,0x88,0x0b,0x34,0xba,0x78,0x17, + 0xc8,0x5c,0x1f,0x3e,0x83,0x8f,0x74,0xaf,0xff,0x02,0x41,0x00,0x9a,0x75,0xff,0xeb, + 0xdf,0x9f,0x80,0x29,0x65,0xac,0x06,0x57,0xe5,0xbe,0xc5,0x1f,0x14,0x76,0xe6,0x47, + 0x92,0x07,0xbe,0x34,0x93,0x2c,0xe3,0x6f,0xa4,0x6d,0x61,0xe5,0x91,0xd7,0x67,0xef, + 0x48,0x77,0x69,0xa2,0x8f,0x97,0x74,0x3e,0x8c,0x3b,0x80,0xa7,0x02,0xe6,0x53,0x36, + 0x29,0xe4,0x27,0xf0,0x7b,0xbb,0x67,0x2c,0x6d,0x19,0x3e,0x41,0x02,0x40,0x1a,0x2f, + 0x59,0x38,0xba,0x26,0x1c,0x86,0x10,0x15,0xaa,0x77,0x27,0x2b,0x3d,0x7f,0x21,0xba, + 0xd2,0x9f,0x67,0x7a,0xdf,0xb9,0xa1,0x79,0x0f,0x24,0xc4,0x5e,0xa3,0x52,0x67,0x28, + 0x5f,0xf1,0xc1,0x4b,0x61,0xb6,0x77,0x5a,0x8c,0xa1,0x87,0x2a,0xd9,0x5b,0xbe,0xf3, + 0xb4,0xba,0xe0,0x52,0x61,0xe1,0xc0,0x49,0x3f,0xfa,0x00,0x3e,0x67,0x25,0x02,0x40, + 0x58,0x37,0xc2,0x52,0x77,0x1b,0xd1,0xc9,0x05,0x62,0x18,0x12,0x5e,0xb4,0xad,0x0a, + 0x9e,0x15,0x29,0x3e,0xa5,0x25,0xdc,0x6c,0x83,0x12,0x8c,0x72,0x47,0xa2,0x1e,0x01, + 0xb9,0xc2,0xb9,0xa1,0xe9,0x83,0x34,0xb0,0xf0,0xc2,0xf7,0xfd,0x58,0x5a,0xfa,0xf7, + 0xbc,0x17,0x77,0x20,0x77,0xfa,0xcb,0xfd,0x2f,0xe4,0xf3,0x9f,0xea,0x10,0x5c,0x02 +}; + + +static const int rsa512_sec_len = sizeof rsa512_sec; + + +static void* MyAlloc(u32 size) +{ + void* ptr; + ptr = OS_Alloc(size); + return ptr; +} + +static void MyFree(void* ptr) +{ + OS_Free(ptr); +} + +#ifndef MIN +#define MIN(a, b) (((a) < (b)) ? (a) : (b)) +#endif + +static void* MyRealloc(void* ptr, u32 new_size, u32 old_size) +{ + void *buf; + if ((buf = OS_Alloc(new_size)) == NULL) + { + return NULL; + } + MI_CpuCopy8(ptr, buf, MIN(new_size, old_size)); + OS_Free(ptr); + return buf; +} + + +#define PrintResultEq( a, b, f ) \ + { OS_TPrintf( ((a) == (b)) ? "[--OK--] " : "[**NG**] " ); (f) = (f) && ((a) == (b)); } + +#define CheckAndPrintErr( result, str ) \ + { if(OS_IsRunOnTwl() == TRUE){ \ + if(result < 0) { OS_TPrintf( "Error: %d (%s)\n", result, str ); return FALSE;} \ + }else{ \ + if(result >= 0){ OS_TPrintf( "Error: %d (%s)\n", result, str ); return FALSE;} \ + } \ + } + +BOOL RsaTestInit(void) +{ + static BOOL init_flag = FALSE; + + if( init_flag == TRUE ) { + return TRUE; + } + + CRYPTO_SetMemAllocator(MyAlloc, MyFree, MyRealloc); + + init_flag = TRUE; + return TRUE; +} + + +int RsaTestDecrypt(char *input, int in_len, char *output, int outlen) +{ + s32 result; + s32 outcount = 0; + CRYPTORSAContext context; + CRYPTORSADecryptInitParam decinitparam; + CRYPTORSADecryptParam decparam; + + void *key; + + memset((void *)&context, 0, sizeof(CRYPTORSAContext)); + memset((void *)&decinitparam, 0, sizeof(CRYPTORSADecryptInitParam)); + memset((void *)&decparam, 0, sizeof(CRYPTORSADecryptParam)); + + /* RSA decode */ + /* + typedef struct CRYPTORSADecryptInitParam { + void *key; + u32 key_len; + } CRYPTORSADecryptInitParam; + + 要素 + key RSA秘密鍵を格納した文字列のアドレスを指定します。 + key_len RSA秘密鍵の文字列長を指定します。 + + 説明 + RSA復号のための初期化処理に必要な情報を指定するための構造体です。 + アプリケーション側から各メンバに値を設定してから関数を呼び出す必要があります。 + + メンバ keyで指定したアドレスにはDER形式のRSA秘密鍵イメージ全体を格納してください。 + */ + + key = (void *)OS_Alloc(rsa512_sec_len); + if( key == NULL ) { + OS_TPrintf("Error:alloc %s %d",__FUNCTION__,__LINE__); + return 0; + } + memcpy(key, (void*)rsa512_sec, rsa512_sec_len); + + + // decinitparam.key = (void*)rsa512_sec; + decinitparam.key = key; + decinitparam.key_len = rsa512_sec_len; + result = CRYPTO_RSA_DecryptInit(&context, &decinitparam); + CheckAndPrintErr(result, "CRYPTO_RSA_DecryptInit"); + + + /* + typedef struct CRYPTORSADecryptParam { + void *in; + u32 in_len; + void *out; + u32 out_size; + } CRYPTORSADecryptParam; + + 要素 + in RSAで復号する文字列のアドレスを指定します。 + in_len RSAで復号する文字列の長さを指定します。 + out 復号する文字列の出力先バッファアドレスを指定します + out_size outのバッファサイズを指定します + + 説明 + RSA復号処理を行う文字列および出力先に関する情報を指定するための構造体です。 + アプリケーション側から各メンバに値を設定してから関数を呼び出す必要があります。 + */ + + //BOOL RsaTestDecrypt(char *input, int in_len, char *output, int outlen) + + decparam.in = input; + decparam.in_len = (u32)in_len; + decparam.out = output; + decparam.out_size = (u32)outlen; + + outcount = 0; + + outcount = CRYPTO_RSA_Decrypt(&context, &decparam); + + CheckAndPrintErr(result, "CRYPTO_RSA_Decrypt"); + + result = CRYPTO_RSA_DecryptTerminate(&context); + CheckAndPrintErr(result, "CRYPTO_RSA_DecryptTerminate"); + + OS_Free(key); + // OS_TPrintf("in_len = %d outcount = %d\n",in_len, outcount); + + return outcount; +} + +/* ************* SHA256 ************** */ + +#define MD32_REG_T long + +#define SHA_LONG unsigned long +#define SHA_LBLOCK 16 +#define SHA_CBLOCK (SHA_LBLOCK*4) /* SHA treats input data as a + * contiguous array of 32 bit + * wide big-endian values. */ +#define SHA_LAST_BLOCK (SHA_CBLOCK-8) + +#define SHA256_CBLOCK (SHA_LBLOCK*4) /* SHA-256 treats input data as a + * contiguous array of 32 bit + * wide big-endian values. */ +#define SHA224_DIGEST_LENGTH 28 +#define SHA256_DIGEST_LENGTH 32 + +typedef struct SHA256state_st +{ + SHA_LONG h[8]; + SHA_LONG Nl,Nh; + SHA_LONG data[SHA_LBLOCK]; + unsigned int num,md_len; +} SHA256_CTX; + + +static int SHA256_Init(SHA256_CTX *c); +static int SHA256_Update(SHA256_CTX *c, const void *data, size_t len); +static int SHA256_Final(unsigned char *md, SHA256_CTX *c); + + +void SHA256(const unsigned char *d, size_t n, unsigned char *md) +{ + SHA256_CTX c; + SHA256_Init(&c); + SHA256_Update(&c,d,n); + SHA256_Final(md,&c); + // OPENSSL_cleanse(&c,sizeof(c)); +} + + +static int SHA256_Init (SHA256_CTX *c) +{ + memset (c,0,sizeof(*c)); + c->h[0]=0x6a09e667UL; c->h[1]=0xbb67ae85UL; + c->h[2]=0x3c6ef372UL; c->h[3]=0xa54ff53aUL; + c->h[4]=0x510e527fUL; c->h[5]=0x9b05688cUL; + c->h[6]=0x1f83d9abUL; c->h[7]=0x5be0cd19UL; + c->md_len=SHA256_DIGEST_LENGTH; + return 1; +} + + +#define HASH_BLOCK_DATA_ORDER sha256_block_data_order + +static void sha256_block_data_order (SHA256_CTX *ctx, const void *in, size_t num); + + +#define DATA_ORDER_IS_BIG_ENDIAN + +#define HASH_LONG SHA_LONG +#define HASH_CTX SHA256_CTX +#define HASH_CBLOCK SHA_CBLOCK + + + +#if defined(DATA_ORDER_IS_BIG_ENDIAN) + +#define HOST_c2l(c,l) (l =(((unsigned long)(*((c)++)))<<24), \ + l|=(((unsigned long)(*((c)++)))<<16), \ + l|=(((unsigned long)(*((c)++)))<< 8), \ + l|=(((unsigned long)(*((c)++))) )) + + +#define HOST_l2c(l,c) (*((c)++)=(unsigned char)(((l)>>24)&0xff), \ + *((c)++)=(unsigned char)(((l)>>16)&0xff), \ + *((c)++)=(unsigned char)(((l)>> 8)&0xff), \ + *((c)++)=(unsigned char)(((l) )&0xff)) + + + +#elif defined(DATA_ORDER_IS_LITTLE_ENDIAN) + +#define HOST_c2l(c,l) (l =(((unsigned long)(*((c)++))) ), \ + l|=(((unsigned long)(*((c)++)))<< 8), \ + l|=(((unsigned long)(*((c)++)))<<16), \ + l|=(((unsigned long)(*((c)++)))<<24)) + + +#define HOST_l2c(l,c) (*((c)++)=(unsigned char)(((l) )&0xff), \ + *((c)++)=(unsigned char)(((l)>> 8)&0xff), \ + *((c)++)=(unsigned char)(((l)>>16)&0xff), \ + *((c)++)=(unsigned char)(((l)>>24)&0xff)) + +#endif + + +#define HASH_MAKE_STRING(c,s) do { \ + unsigned long ll; \ + unsigned int nn; \ + switch ((c)->md_len) \ + { case SHA224_DIGEST_LENGTH: \ + for (nn=0;nnh[nn]; HOST_l2c(ll,(s)); } \ + break; \ + case SHA256_DIGEST_LENGTH: \ + for (nn=0;nnh[nn]; HOST_l2c(ll,(s)); } \ + break; \ + default: \ + if ((c)->md_len > SHA256_DIGEST_LENGTH) \ + return 0; \ + for (nn=0;nn<(c)->md_len/4;nn++) \ + { ll=(c)->h[nn]; HOST_l2c(ll,(s)); } \ + break; \ + } \ + } while (0) + + + + +static int SHA256_Update(HASH_CTX *c, const void *data_, size_t len) +{ + const unsigned char *data=data_; + unsigned char *p; + HASH_LONG l; + size_t n; + + if (len==0) return 1; + + l=(c->Nl+(((HASH_LONG)len)<<3))&0xffffffffUL; + /* 95-05-24 eay Fixed a bug with the overflow handling, thanks to + * Wei Dai for pointing it out. */ + if (l < c->Nl) /* overflow */ + c->Nh++; + c->Nh+=(HASH_LONG)(len>>29); /* might cause compiler warning on 16-bit */ + c->Nl=l; + + n = c->num; + if (n != 0) + { + p=(unsigned char *)c->data; + + if (len >= HASH_CBLOCK || len+n >= HASH_CBLOCK) + { + memcpy (p+n,data,HASH_CBLOCK-n); + HASH_BLOCK_DATA_ORDER (c,p,1); + n = HASH_CBLOCK-n; + data += n; + len -= n; + c->num = 0; + memset (p,0,HASH_CBLOCK); /* keep it zeroed */ + } + else + { + memcpy (p+n,data,len); + c->num += (unsigned int)len; + return 1; + } + } + + n = len/HASH_CBLOCK; + if (n > 0) + { + HASH_BLOCK_DATA_ORDER (c,data,n); + n *= HASH_CBLOCK; + data += n; + len -= n; + } + + if (len != 0) + { + p = (unsigned char *)c->data; + c->num = (unsigned int)len; + memcpy (p,data,len); + } + return 1; +} + + +static int SHA256_Final(unsigned char *md, HASH_CTX *c) +{ + unsigned char *p = (unsigned char *)c->data; + size_t n = c->num; + + p[n] = 0x80; /* there is always room for one */ + n++; + + if (n > (HASH_CBLOCK-8)) + { + memset (p+n,0,HASH_CBLOCK-n); + n=0; + HASH_BLOCK_DATA_ORDER (c,p,1); + } + memset (p+n,0,HASH_CBLOCK-8-n); + + p += HASH_CBLOCK-8; +#if defined(DATA_ORDER_IS_BIG_ENDIAN) + (void)HOST_l2c(c->Nh,p); + (void)HOST_l2c(c->Nl,p); +#elif defined(DATA_ORDER_IS_LITTLE_ENDIAN) + (void)HOST_l2c(c->Nl,p); + (void)HOST_l2c(c->Nh,p); +#endif + p -= HASH_CBLOCK; + HASH_BLOCK_DATA_ORDER (c,p,1); + c->num=0; + memset (p,0,HASH_CBLOCK); + +#ifndef HASH_MAKE_STRING +#error "HASH_MAKE_STRING must be defined!" +#else + HASH_MAKE_STRING(c,md); +#endif + + return 1; +} + + +static const SHA_LONG K256[64] = { + 0x428a2f98UL,0x71374491UL,0xb5c0fbcfUL,0xe9b5dba5UL, + 0x3956c25bUL,0x59f111f1UL,0x923f82a4UL,0xab1c5ed5UL, + 0xd807aa98UL,0x12835b01UL,0x243185beUL,0x550c7dc3UL, + 0x72be5d74UL,0x80deb1feUL,0x9bdc06a7UL,0xc19bf174UL, + 0xe49b69c1UL,0xefbe4786UL,0x0fc19dc6UL,0x240ca1ccUL, + 0x2de92c6fUL,0x4a7484aaUL,0x5cb0a9dcUL,0x76f988daUL, + 0x983e5152UL,0xa831c66dUL,0xb00327c8UL,0xbf597fc7UL, + 0xc6e00bf3UL,0xd5a79147UL,0x06ca6351UL,0x14292967UL, + 0x27b70a85UL,0x2e1b2138UL,0x4d2c6dfcUL,0x53380d13UL, + 0x650a7354UL,0x766a0abbUL,0x81c2c92eUL,0x92722c85UL, + 0xa2bfe8a1UL,0xa81a664bUL,0xc24b8b70UL,0xc76c51a3UL, + 0xd192e819UL,0xd6990624UL,0xf40e3585UL,0x106aa070UL, + 0x19a4c116UL,0x1e376c08UL,0x2748774cUL,0x34b0bcb5UL, + 0x391c0cb3UL,0x4ed8aa4aUL,0x5b9cca4fUL,0x682e6ff3UL, + 0x748f82eeUL,0x78a5636fUL,0x84c87814UL,0x8cc70208UL, + 0x90befffaUL,0xa4506cebUL,0xbef9a3f7UL,0xc67178f2UL }; + +#define ROTATE(a,n) (((a)<<(n))|(((a)&0xffffffff)>>(32-(n)))) + + +#define Sigma0(x) (ROTATE((x),30) ^ ROTATE((x),19) ^ ROTATE((x),10)) +#define Sigma1(x) (ROTATE((x),26) ^ ROTATE((x),21) ^ ROTATE((x),7)) +#define sigma0(x) (ROTATE((x),25) ^ ROTATE((x),14) ^ ((x)>>3)) +#define sigma1(x) (ROTATE((x),15) ^ ROTATE((x),13) ^ ((x)>>10)) + +#define Ch(x,y,z) (((x) & (y)) ^ ((~(x)) & (z))) +#define Maj(x,y,z) (((x) & (y)) ^ ((x) & (z)) ^ ((y) & (z))) + + +#define ROUND_00_15(i,a,b,c,d,e,f,g,h) do { \ + T1 += h + Sigma1(e) + Ch(e,f,g) + K256[i]; \ + h = Sigma0(a) + Maj(a,b,c); \ + d += T1; h += T1; } while (0) + +#define ROUND_16_63(i,a,b,c,d,e,f,g,h,X) do { \ + s0 = X[(i+1)&0x0f]; s0 = sigma0(s0); \ + s1 = X[(i+14)&0x0f]; s1 = sigma1(s1); \ + T1 = X[(i)&0x0f] += s0 + s1 + X[(i+9)&0x0f]; \ + ROUND_00_15(i,a,b,c,d,e,f,g,h); } while (0) + +static void sha256_block_data_order (SHA256_CTX *ctx, const void *in, size_t num) +{ + unsigned MD32_REG_T a,b,c,d,e,f,g,h,s0,s1,T1; + SHA_LONG X[16]; + int i; + const unsigned char *data=in; + const union { long one; char little; } is_endian = {1}; + + while (num--) { + + a = ctx->h[0]; b = ctx->h[1]; c = ctx->h[2]; d = ctx->h[3]; + e = ctx->h[4]; f = ctx->h[5]; g = ctx->h[6]; h = ctx->h[7]; + + if (!is_endian.little && sizeof(SHA_LONG)==4 && ((size_t)in%4)==0) + { + const SHA_LONG *W=(const SHA_LONG *)data; + + T1 = X[0] = W[0]; ROUND_00_15(0,a,b,c,d,e,f,g,h); + T1 = X[1] = W[1]; ROUND_00_15(1,h,a,b,c,d,e,f,g); + T1 = X[2] = W[2]; ROUND_00_15(2,g,h,a,b,c,d,e,f); + T1 = X[3] = W[3]; ROUND_00_15(3,f,g,h,a,b,c,d,e); + T1 = X[4] = W[4]; ROUND_00_15(4,e,f,g,h,a,b,c,d); + T1 = X[5] = W[5]; ROUND_00_15(5,d,e,f,g,h,a,b,c); + T1 = X[6] = W[6]; ROUND_00_15(6,c,d,e,f,g,h,a,b); + T1 = X[7] = W[7]; ROUND_00_15(7,b,c,d,e,f,g,h,a); + T1 = X[8] = W[8]; ROUND_00_15(8,a,b,c,d,e,f,g,h); + T1 = X[9] = W[9]; ROUND_00_15(9,h,a,b,c,d,e,f,g); + T1 = X[10] = W[10]; ROUND_00_15(10,g,h,a,b,c,d,e,f); + T1 = X[11] = W[11]; ROUND_00_15(11,f,g,h,a,b,c,d,e); + T1 = X[12] = W[12]; ROUND_00_15(12,e,f,g,h,a,b,c,d); + T1 = X[13] = W[13]; ROUND_00_15(13,d,e,f,g,h,a,b,c); + T1 = X[14] = W[14]; ROUND_00_15(14,c,d,e,f,g,h,a,b); + T1 = X[15] = W[15]; ROUND_00_15(15,b,c,d,e,f,g,h,a); + + data += SHA256_CBLOCK; + } + else + { + SHA_LONG l; + + HOST_c2l(data,l); T1 = X[0] = l; ROUND_00_15(0,a,b,c,d,e,f,g,h); + HOST_c2l(data,l); T1 = X[1] = l; ROUND_00_15(1,h,a,b,c,d,e,f,g); + HOST_c2l(data,l); T1 = X[2] = l; ROUND_00_15(2,g,h,a,b,c,d,e,f); + HOST_c2l(data,l); T1 = X[3] = l; ROUND_00_15(3,f,g,h,a,b,c,d,e); + HOST_c2l(data,l); T1 = X[4] = l; ROUND_00_15(4,e,f,g,h,a,b,c,d); + HOST_c2l(data,l); T1 = X[5] = l; ROUND_00_15(5,d,e,f,g,h,a,b,c); + HOST_c2l(data,l); T1 = X[6] = l; ROUND_00_15(6,c,d,e,f,g,h,a,b); + HOST_c2l(data,l); T1 = X[7] = l; ROUND_00_15(7,b,c,d,e,f,g,h,a); + HOST_c2l(data,l); T1 = X[8] = l; ROUND_00_15(8,a,b,c,d,e,f,g,h); + HOST_c2l(data,l); T1 = X[9] = l; ROUND_00_15(9,h,a,b,c,d,e,f,g); + HOST_c2l(data,l); T1 = X[10] = l; ROUND_00_15(10,g,h,a,b,c,d,e,f); + HOST_c2l(data,l); T1 = X[11] = l; ROUND_00_15(11,f,g,h,a,b,c,d,e); + HOST_c2l(data,l); T1 = X[12] = l; ROUND_00_15(12,e,f,g,h,a,b,c,d); + HOST_c2l(data,l); T1 = X[13] = l; ROUND_00_15(13,d,e,f,g,h,a,b,c); + HOST_c2l(data,l); T1 = X[14] = l; ROUND_00_15(14,c,d,e,f,g,h,a,b); + HOST_c2l(data,l); T1 = X[15] = l; ROUND_00_15(15,b,c,d,e,f,g,h,a); + } + + for (i=16;i<64;i+=8) + { + ROUND_16_63(i+0,a,b,c,d,e,f,g,h,X); + ROUND_16_63(i+1,h,a,b,c,d,e,f,g,X); + ROUND_16_63(i+2,g,h,a,b,c,d,e,f,X); + ROUND_16_63(i+3,f,g,h,a,b,c,d,e,X); + ROUND_16_63(i+4,e,f,g,h,a,b,c,d,X); + ROUND_16_63(i+5,d,e,f,g,h,a,b,c,X); + ROUND_16_63(i+6,c,d,e,f,g,h,a,b,X); + ROUND_16_63(i+7,b,c,d,e,f,g,h,a,X); + } + + ctx->h[0] += a; ctx->h[1] += b; ctx->h[2] += c; ctx->h[3] += d; + ctx->h[4] += e; ctx->h[5] += f; ctx->h[6] += g; ctx->h[7] += h; + + } +} + +/* ******************* */ + + +int my_rsa_sign( u8 *inbuf, u8 *outbuf, int buf_size, int *output_size ) +{ + int i; + u8 hash_data[MY_RSA_SIGN_HASH_SIZE]; + u8 hash_calc[MY_RSA_SIGN_HASH_SIZE]; + BOOL hash_check_flag = TRUE; + int decrypt_size = 0; + u8 decrypt_buf[MY_RSA_SIGN_RSA_SIZE]; + int org_file_size = 0; + + if( TRUE != RsaTestInit() ) { +#ifdef MY_RSA_SIGN_DEBUG + mprintf("RSA Init failed\n"); +#endif /* MY_RSA_SIGN_DEBUG */ + return MY_RSA_SIGN_ERROR_RSA_INIT_FAILED; + } +#ifdef MY_RSA_SIGN_DEBUG + mprintf("RSA Init success\n"); +#endif /* MY_RSA_SIGN_DEBUG */ + + if( 0 == RsaTestDecrypt((char *)inbuf, MY_RSA_SIGN_RSA_SIZE, (char *)outbuf, buf_size) ) { +#ifdef MY_RSA_SIGN_DEBUG + mprintf("RSA Decrypt failed\n"); +#endif /* MY_RSA_SIGN_DEBUG */ + return MY_RSA_SIGN_ERROR_RSA_HASH_DECRYPT_FAILED; + } +#ifdef MY_RSA_SIGN_DEBUG + mprintf("RSA Decrypt success 1\n"); +#endif /* MY_RSA_SIGN_DEBUG */ + + memcpy(hash_data, outbuf, MY_RSA_SIGN_HASH_SIZE); + + SHA256( inbuf + MY_RSA_SIGN_RSA_SIZE, (u32)(buf_size - MY_RSA_SIGN_RSA_SIZE), hash_calc); + + for( i = 0 ; i < MY_RSA_SIGN_HASH_SIZE ; i++ ) { + if( hash_calc[i] != hash_data[i] ) { + hash_check_flag = FALSE; + } + } + if( hash_check_flag == FALSE ) { + OS_TPrintf("invalid hash\n"); + return MY_RSA_SIGN_ERROR_HASH_CHECK_FAILED; + } +#ifdef MY_RSA_SIGN_DEBUG + mprintf("hash check pass!\n"); +#endif /* MY_RSA_SIGN_DEBUG */ + + org_file_size = *(int *)(inbuf + MY_RSA_SIGN_RSA_SIZE); + *output_size = 0; + + for( i = 0 ; i < org_file_size ; i += MY_RSA_SIGN_RSA_SIZE ) { + decrypt_size = RsaTestDecrypt((char *)(inbuf + MY_RSA_SIGN_RSA_SIZE + 4 + i), MY_RSA_SIGN_RSA_SIZE, + (char *)decrypt_buf, MY_RSA_SIGN_RSA_SIZE ); + if( 0 != decrypt_size ) { + //OS_TPrintf("RSA Decrypt success dec_size=%d\n",decrypt_size); + //mprintf("RSA Decrypt success 2\n"); + memcpy( (char *)(outbuf + *output_size), decrypt_buf, (u32)decrypt_size); + *output_size += decrypt_size; + } + else { +#ifdef MY_RSA_SIGN_DEBUG + mprintf("RSA Decrypt Error dec_size=%d\n",decrypt_size); +#endif /* MY_RSA_SIGN_DEBUG */ + return MY_RSA_SIGN_ERROR_RSA_CONTENT_DECRYPT_FAILED; + } + } + + OS_TPrintf("output_size = %d\n",*output_size ); + OS_TPrintf("org_file_size = %d\n",org_file_size ); + + return MY_RSA_SIGN_SUCCESS; +} + +/* ************************ */ diff --git a/build/tools/sctools/common/src/my_rsa_sign.h b/build/tools/sctools/common/src/my_rsa_sign.h new file mode 100644 index 0000000..750bb99 --- /dev/null +++ b/build/tools/sctools/common/src/my_rsa_sign.h @@ -0,0 +1,32 @@ +#ifndef _MY_RSA_SIGN_H_ +#define _MY_RSA_SIGN_H_ + +#ifdef __cplusplus +extern "C" { +#endif + +#define MY_RSA_SIGN_HASH_SIZE 32 +#define MY_RSA_SIGN_RSA_SIZE 128 + + + +#define MY_RSA_SIGN_SUCCESS 0 +#define MY_RSA_SIGN_ERROR_RSA_INIT_FAILED 1 +#define MY_RSA_SIGN_ERROR_RSA_HASH_DECRYPT_FAILED 2 +#define MY_RSA_SIGN_ERROR_HASH_CHECK_FAILED 3 +#define MY_RSA_SIGN_ERROR_RSA_CONTENT_DECRYPT_FAILED 4 + + +int my_rsa_sign( u8 *inbuf, u8 *outbuf, int buf_size, int *output_size ); + + +BOOL RsaTestInit(void); +int RsaTestDecrypt(char *input, int in_len, char *output, int outlen); +void SHA256(const unsigned char *d, size_t n, unsigned char *md); + +#ifdef __cplusplus +} +#endif + + +#endif /* _MY_RSA_SIGN_H_ */ diff --git a/build/tools/sctools/common/src/my_sign.c b/build/tools/sctools/common/src/my_sign.c new file mode 100644 index 0000000..9acd35e --- /dev/null +++ b/build/tools/sctools/common/src/my_sign.c @@ -0,0 +1,360 @@ +#include +#include +#include +#include "my_rsa_sign.h" +#include "my_aes.h" +#include "my_sign.h" + +#define AES_KEY_BIT_LEN 256 +#define AES_KEY_BYTE_LEN (AES_KEY_BIT_LEN/8) + + +static BOOL my_sign_check(MY_SIGN_SIGNATURE *encrypted_sign, u8 *buf, int buf_size) +{ + u8 hash_temp[MY_SIGN_HASH_SIZE] ATTRIBUTE_ALIGN(32); + MY_SIGN_SIGNATURE tmp_sign ATTRIBUTE_ALIGN(32); + int outlen; + int i; + + if( encrypted_sign == NULL ) { + OS_TPrintf("func=%s line=%d error!\n",__FUNCTION__,__LINE__); + return FALSE; + } + if( buf == NULL ) { + OS_TPrintf("func=%s line=%d error!\n",__FUNCTION__,__LINE__); + return FALSE; + } + if( buf_size == 0 ) { + OS_TPrintf("func=%s line=%d error!\n",__FUNCTION__,__LINE__); + return FALSE; + } + memset(hash_temp, 0, MY_SIGN_HASH_SIZE ); + memset((void *)&tmp_sign, 0, sizeof(MY_SIGN_SIGNATURE)); + SHA256(buf, (u32)buf_size, hash_temp); + + outlen = RsaTestDecrypt((char *)encrypted_sign, sizeof(MY_SIGN_SIGNATURE), + (char *)&tmp_sign, sizeof(MY_SIGN_SIGNATURE)); + + // OS_TPrintf("decrypt outlen = %d\n",outlen); + + if( outlen < MY_SIGN_HASH_SIZE ) { + OS_TPrintf("line=%d RSA Decrypt error! outlen=%d\n",__LINE__,outlen); + return FALSE; + } + + for( i = 0 ; i < MY_SIGN_HASH_SIZE ; i++ ) { + // OS_TPrintf("hash[0x%02x] chk=0x%02x cal=0x%02x\n",i,tmp_sign.hash[i],hash_temp[i]); + if( tmp_sign.hash[i] != hash_temp[i] ) { + OS_TPrintf("Hash check error i=%d chk=0x%02x cal=0x%02x\n", i , tmp_sign.hash[i] , hash_temp[i] ); + return FALSE; + } + } + return TRUE; +} + + +void my_sign_FS_InitFile(MY_SIGN_File *msfile) +{ + msfile->open_flag = FALSE; +} + +BOOL my_sign_FS_SeekFile(MY_SIGN_File *msfile, int offset, int whence) +{ + if( msfile->open_flag != TRUE ) { + return FALSE; /* error */ + } + switch( whence ) { + case FS_SEEK_SET: + msfile->pos = offset; + break; + case FS_SEEK_CUR: + msfile->pos += offset; + break; + case FS_SEEK_END: + msfile->pos = msfile->header.org_file_size + offset; + break; + } + if( msfile->pos < 0 ) { + msfile->pos = 0; + } + else if( msfile->pos >= msfile->header.org_file_size ) { + msfile->pos = msfile->header.org_file_size - 1; + } + return TRUE; +} + +BOOL my_sign_FS_SeekFileToBegin(MY_SIGN_File *msfile) +{ + if( msfile->open_flag != TRUE ) { + return FALSE; /* error */ + } + msfile->pos = 0; + return TRUE; +} + +u32 my_sign_FS_GetLength(MY_SIGN_File *msfile) +{ + if( msfile->open_flag != TRUE ) { + return 0; /* error */ + } + return (u32)(msfile->header.org_file_size); +} + +BOOL my_sign_FS_OpenFile(MY_SIGN_File *msfile, char *path) +{ + MY_SIGN_SIGNATURE temp_sign; + // MY_SIGN_SIGNATURE *L2_sign_table_temp; + // int rest_readlen = 0; + // int outlen = 0; + int readlen; + int L2_sign_table_size; + + if( msfile == NULL ) { + return FALSE; + } + + // OS_TPrintf("hash offset = %d\n",offsetof(MY_SIGN_SIGNATURE, hash)); + + + RsaTestInit(); + + FS_InitFile(&(msfile->f)); + if( FALSE == FS_OpenFileEx(&(msfile->f), path, FS_FILEMODE_R) ) { + OS_TPrintf("%s Failed Open File %s\n",__FUNCTION__,path); + return FALSE; + } + + /* + FILE format: + ----- + MY_SIGN_HEADER header; + MY_SIGN_SIGNATURE header_sign; + L2_sign_table[0]; + L2_sign_table[1]; + L2_sign_table[2]; + L2_sign_table[ ]; + . + . + aes_enc_data_block[0](32KB) + aes_enc_data_block[1](32KB) + aes_enc_data_block[2](32KB) + . + . + */ + + readlen = FS_ReadFile(&(msfile->f), &(msfile->header), sizeof(MY_SIGN_HEADER) ); + if( readlen != sizeof(MY_SIGN_HEADER) ) { + OS_TPrintf("%s Failed read File readlen=%d\n",__FUNCTION__, readlen); + return FALSE; + } + + // OS_TPrintf("%s %d\n",__FUNCTION__, __LINE__); + + /* ヘッダーの読み込み */ + readlen = FS_ReadFile(&(msfile->f), &temp_sign, sizeof(MY_SIGN_SIGNATURE) ); + if( readlen != sizeof(MY_SIGN_SIGNATURE) ) { + OS_TPrintf("%s Failed read File readlen=%d\n",__FUNCTION__, readlen); + return FALSE; + } + + /* ヘッダーの署名チェック */ + if( FALSE == my_sign_check(&temp_sign, (u8 *)&(msfile->header), sizeof(MY_SIGN_HEADER)) ) { + OS_TPrintf("line=%d Header signature chech error!\n",__LINE__); + return FALSE; + } + +#if 0 + OS_TPrintf("header.magic_code = 0x%08x\n",(int)msfile->header.magic_code); + OS_TPrintf("header.org_file_size = %d\n",(int)msfile->header.org_file_size); + OS_TPrintf("header.num_of_block = %d\n",(int)msfile->header.num_of_block); +#endif + + // rest_readlen = (int)msfile->header.org_file_size; + + // header.file_offset_L2_sign_table; + // header.file_offset_data_block; + L2_sign_table_size = (int)(msfile->header.num_of_block * sizeof(MY_SIGN_SIGNATURE)); + msfile->L2_sign_table = (MY_SIGN_SIGNATURE *)OS_Alloc( (u32)L2_sign_table_size ); + if(msfile->L2_sign_table == NULL ) { + OS_TPrintf("%s Failed alloc line=%d\n",__LINE__); + return FALSE; + } + + // L2_sign_table_temp = msfile->L2_sign_table; + + + readlen = FS_ReadFile(&(msfile->f), (u8 *)(msfile->L2_sign_table), L2_sign_table_size ); + if( readlen != L2_sign_table_size ) { + OS_TPrintf("%s Failed read File readlen=%d\n",__FUNCTION__, readlen); + return FALSE; + } + + /* L2署名テーブルの署名チェック */ + if( FALSE == my_sign_check(&(msfile->header.L2_sign), (u8 *)(msfile->L2_sign_table), L2_sign_table_size) ) { + OS_TPrintf("L2_sign Hash check error!\n"); + return FALSE; + } + + + msfile->block_buf_in = (u8 *)OS_Alloc( MY_SIGN_BLOCK_SIZE ); + if( msfile->block_buf_in == NULL ) { + return FALSE; + } + msfile->block_buf_out = (u8 *)OS_Alloc( MY_SIGN_BLOCK_SIZE ); + if( msfile->block_buf_out == NULL ) { + return FALSE; + } + + msfile->open_flag = TRUE; + msfile->pos = 0; /* original file pos */ + + // OS_TPrintf("%s %d\n",__FUNCTION__, __LINE__); + + end: + return TRUE; +} + + +int my_sign_FS_ReadFile(MY_SIGN_File *msfile, u8 *buf, int buf_size) +{ + int i; + int block_no; + int enc_file_pos; + MY_SIGN_SIGNATURE *L2_sign_table_temp; + AES_KEY aes_key; + u8 aes_key_buf[AES_KEY_BYTE_LEN]; + unsigned char aes_iv[ AES_BLOCK_SIZE ]; + int block_buf_out_pos; + int user_buf_size; + u8 *user_buf_ptr; + int num = 0; + int readlen; + + if( msfile->open_flag != TRUE ) { + return -1; /* error */ + } + + // msfile->pos = 0; /* original file pos */ + // MY_SIGN_BLOCK_SIZE + /* + typedef struct { + u32 magic_code; + u32 org_file_size; + u32 num_of_block; + u32 file_offset_L2_sign_table; + u32 file_offset_data_block; + u32 dummy[3]; + MY_SIGN_SIGNATURE L2_sign; + } MY_SIGN_HEADER; + */ + + // header.file_offset_data_block; + + + // OS_TPrintf("%s %d\n",__FUNCTION__, __LINE__); + + + + user_buf_size = buf_size; + user_buf_ptr = buf; + + if( msfile->pos >= (int)(msfile->header.org_file_size) ) { + return 0; + } + + + loop_0: + + block_no = msfile->pos / MY_SIGN_BLOCK_SIZE; + block_buf_out_pos = msfile->pos % MY_SIGN_BLOCK_SIZE; + + if( block_no >= (int)msfile->header.num_of_block ) { + return -1; + } + + + // OS_TPrintf("%s %d pos = %d block_no = %d\n",__FUNCTION__, __LINE__,msfile->pos, block_no); + + + enc_file_pos = (int)msfile->header.file_offset_data_block + block_no * MY_SIGN_BLOCK_SIZE; + if( FALSE == FS_SeekFile(&(msfile->f), enc_file_pos , FS_SEEK_SET) ) { + return -1; + } + + + readlen = FS_ReadFile(&(msfile->f), msfile->block_buf_in, MY_SIGN_BLOCK_SIZE); + if( readlen != MY_SIGN_BLOCK_SIZE ) { + OS_TPrintf("%s %d Failed read File readlen=%d\n",__FUNCTION__, __LINE__, readlen); + return -1; + } + + + + + L2_sign_table_temp = msfile->L2_sign_table + block_no; + + /* データブロックの署名チェック */ + if( FALSE == my_sign_check( L2_sign_table_temp, msfile->block_buf_in, MY_SIGN_BLOCK_SIZE) ) { + OS_TPrintf("Data Hash check Error!\n"); + return -1; + } + + /* AESキーのセット */ + for( i = 0 ; i < AES_KEY_BYTE_LEN ; i++ ) { + aes_key_buf[i] = (u8)i; + } + AES_set_decrypt_key(aes_key_buf, AES_KEY_BIT_LEN, &aes_key); + + for( i = 0 ; i < AES_BLOCK_SIZE ; i++ ) { + aes_iv[i] = (u8)i; + } + + memset(msfile->block_buf_out, 0 , MY_SIGN_BLOCK_SIZE); + + /* AES復号化 */ + for( i = 0 ; i < (MY_SIGN_BLOCK_SIZE / AES_BLOCK_SIZE) ; i++ ) { + AES_cbc_encrypt( &(msfile->block_buf_in[AES_BLOCK_SIZE*i]), &(msfile->block_buf_out[AES_BLOCK_SIZE*i]), + AES_BLOCK_SIZE, &aes_key, aes_iv, AES_DECRYPT ); + + } + + // block_no + while( user_buf_size ) { + if( msfile->pos >= (int)msfile->header.org_file_size ) { + goto end; + } + if( block_buf_out_pos >= MY_SIGN_BLOCK_SIZE ) { + break; + } + *user_buf_ptr++ = msfile->block_buf_out[block_buf_out_pos]; + block_buf_out_pos++; + msfile->pos++; + user_buf_size--; + num++; + } + if( user_buf_size > 0 ) { + goto loop_0; + } + end: + return num; +} + +BOOL my_sign_FS_CloseFile(MY_SIGN_File *msfile) +{ + if( msfile ) { + if( msfile->L2_sign_table ) { + OS_Free( msfile->L2_sign_table ); + } + if( msfile->block_buf_in ) { + OS_Free( msfile->block_buf_in ); + } + if( msfile->block_buf_out ) { + OS_Free( msfile->block_buf_out ); + } + } + (void)FS_CloseFile(&(msfile->f)); + return TRUE; +} + + + diff --git a/build/tools/sctools/common/src/my_sign.h b/build/tools/sctools/common/src/my_sign.h new file mode 100644 index 0000000..1af604b --- /dev/null +++ b/build/tools/sctools/common/src/my_sign.h @@ -0,0 +1,56 @@ +#ifndef _MY_SIGN_H_ +#define _MY_SIGN_H_ + + + +// #define MY_RSA_SIGN_HASH_SIZE 32 +// #define MY_RSA_SIGN_RSA_SIZE 128 +#define MY_SIGN_RSA_SIZE 128 +#define MY_SIGN_HASH_SIZE 0x20 +#define MY_SIGN_BLOCK_SIZE (32*1024) + + +#ifdef __cplusplus +extern "C" { +#endif + +typedef struct { + u8 pad[16]; + u8 hash[MY_SIGN_HASH_SIZE]; + u8 dummy[MY_SIGN_RSA_SIZE - MY_SIGN_HASH_SIZE - 16]; +} MY_SIGN_SIGNATURE; + +typedef struct { + u32 magic_code; + s32 org_file_size; + u32 num_of_block; + u32 file_offset_L2_sign_table; + u32 file_offset_data_block; + u32 dummy[3]; + MY_SIGN_SIGNATURE L2_sign; +} MY_SIGN_HEADER; + + +typedef struct { + FSFile f; + BOOL open_flag; + int pos; /* original file pos */ + MY_SIGN_SIGNATURE *L2_sign_table; + MY_SIGN_HEADER header; + u8 *block_buf_in; + u8 *block_buf_out; +} MY_SIGN_File; + +BOOL my_sign_FS_OpenFile(MY_SIGN_File *msfile, char *path); +int my_sign_FS_ReadFile(MY_SIGN_File *msfile, u8 *buf, int buf_size); +BOOL my_sign_FS_CloseFile(MY_SIGN_File *msfile); +u32 my_sign_FS_GetLength(MY_SIGN_File *msfile); +BOOL my_sign_FS_SeekFileToBegin(MY_SIGN_File *msfile); +BOOL my_sign_FS_SeekFile(MY_SIGN_File *msfile, int offset, int whence); +void my_sign_FS_InitFile(MY_SIGN_File *msfile); + +#ifdef __cplusplus +} +#endif + +#endif /* _MY_SIGN_H_ */ diff --git a/build/tools/sctools/common/src/mydata.h b/build/tools/sctools/common/src/mydata.h index 051f76a..723899f 100644 --- a/build/tools/sctools/common/src/mydata.h +++ b/build/tools/sctools/common/src/mydata.h @@ -3,7 +3,7 @@ #define MY_DATA_VERSION_MAJOR 1 -#define MY_DATA_VERSION_MINOR 5 +#define MY_DATA_VERSION_MINOR 6 typedef struct { u8 version_major; diff --git a/build/tools/sctools/common/src/myimport.c b/build/tools/sctools/common/src/myimport.c index 7364521..1388a8d 100644 --- a/build/tools/sctools/common/src/myimport.c +++ b/build/tools/sctools/common/src/myimport.c @@ -36,6 +36,27 @@ Grep started at Tue Apr 07 11:10:33 Grep finished (matches found) at Tue Apr 07 11:12:16 +typedef struct NAMTitleInfo +{ + NAMTitleId titleId; + u16 companyCode; + u16 version; + u32 publicSaveSize; + u32 privateSaveSize; + u32 blockSize; +} +NAMTitleInfo; + +typedef struct NAMTadInfo +{ + NAMTitleInfo titleInfo; + + u32 fileSize; +} +NAMTadInfo; + + + */ @@ -55,11 +76,12 @@ Grep finished (matches found) at Tue Apr 07 11:12:16 #include "logprintf.h" #include "my_fs_util.h" - +#include "my_sign.h" #include "myimport.h" #include "ecdl.h" #include "nam_common.h" +#include "nam_setup.h" #include "ese_int.h" @@ -69,28 +91,23 @@ Grep finished (matches found) at Tue Apr 07 11:12:16 #undef PRINT_RESULT #endif -#define PRINT_RESULT(x) OS_TPrintf("%s: %4d %5d\n", __FILE__, __LINE__, x ) -// #define PRINT_RESULT(x) (void)(0) +// #define PRINT_RESULT(x) OS_TPrintf("%s: %4d %5d\n", __FILE__, __LINE__, x ) +#define PRINT_RESULT(x) (void)(0) -//#define SD_CARD_TEST -#ifdef SD_CARD_TEST -#define BASE_TICKET_DIR "sdmc:/ticket" -#define BASE_TITLE_DIR "sdmc:/title" -#define BASE_IMPORT_DIR "sdmc:/import" -#define BASE_TMP_DIR "sdmc:/tmp" -#else +/* #define BASE_TICKET_DIR "nand:/ticket" #define BASE_TITLE_DIR "nand:/title" #define BASE_IMPORT_DIR "nand:/import" #define BASE_TMP_DIR "nand:/tmp" -#endif +*/ /* ************************************* */ typedef s32 (*NAMiTadFunc)(FSFile* pTadFile, void* arg); +typedef s32 (*NAMiSignTadFunc)(MY_SIGN_File* pTadFile, void* arg); #define TAD_ALIGN 64 // Please load tads to this alignment in memory @@ -264,9 +281,6 @@ BOOL myDeleteTitle(u64 tid, BOOL with_ticket, FSFile *log_fd) } - - - static BOOL IsValidTadHeader(NAMiTadInfo* pInfo, const NAMiTADHeader* pHeader, u32 tadFileSize) { u32 sizeCheck; @@ -331,6 +345,54 @@ static BOOL IsValidTadHeader(NAMiTadInfo* pInfo, const NAMiTADHeader* pHeader, u return TRUE; } + + + + +static s32 NAMi_Load_sign(MY_SIGN_File* my_pf, void** ppBuffer, u32 size, u32 offset, BOOL isSystem) +{ + *ppBuffer = NULL; + + if( size > 0 ) + { + void* buffer; + BOOL bSuccess; + s32 readLen; + + buffer = NAMi_Alloc(size); + + if( buffer == NULL ) + { + OS_TWarning("NAM::Load NAM_NO_MEMORY (%d)", size); + return NAM_NO_MEMORY; + } + + bSuccess = my_sign_FS_SeekFile(my_pf, (s32)offset, FS_SEEK_SET); + + if( ! bSuccess ) + { + OS_TWarning("NAM::Load NAM_SEEK_FILE_FAILED (%d)", offset); + NAMi_Free(buffer); + return isSystem ? NAM_SEEK_FILE_FAILED_SYSTEM: NAM_SEEK_FILE_FAILED_USER; + } + + readLen = my_sign_FS_ReadFile(my_pf, buffer, (s32)size); + + if( readLen != (s32)size ) + { + OS_TWarning("NAM::Load NAM_READ_FILE_FAILED (%d != %d)", readLen, size); + NAMi_Free(buffer); + return isSystem ? NAM_READ_FILE_FAILED_SYSTEM: NAM_READ_FILE_FAILED_USER; + } + + *ppBuffer = buffer; + } + + return NAM_OK; +} + + + static s32 LoadCertCrl(NAMiTadImportContext* pContext, FSFile* pTadFile, const NAMiTadInfo* pInfo) { s32 result1; @@ -356,6 +418,31 @@ static s32 LoadCertCrl(NAMiTadImportContext* pContext, FSFile* pTadFile, const N return NAM_OK; } +static s32 my_sign_LoadCertCrl(NAMiTadImportContext* pContext, MY_SIGN_File* pTadFile, const NAMiTadInfo* pInfo) +{ + s32 result1; + s32 result2; + void* cert = NULL; + void* crl = NULL; + + result1 = NAMi_Load_sign(pTadFile, &cert, pInfo->sizes.cert, pInfo->offsets.cert, FALSE); + NAMi_Work.currentSize += pInfo->sizes.cert; + result2 = NAMi_Load_sign(pTadFile, &crl, pInfo->sizes.crl, pInfo->offsets.crl, FALSE); + NAMi_Work.currentSize += pInfo->sizes.crl; + + if( (result1 != NAM_OK) || (result2 != NAM_OK) ) + { + NAMi_Free(crl); + NAMi_Free(cert); + return (result1 != NAM_OK) ? result1: result2; + } + + pContext->cert = cert; + pContext->crl = crl; + + return NAM_OK; +} + static void UnloadCertCrl(NAMiTadImportContext* pContext) { @@ -392,6 +479,7 @@ static s32 myReadTadHeader(FSFile* pTadFile, NAMiTadInfo* pInfo) isValid = IsValidTadHeader(pInfo, pHeader, fileSize); NAMi_Free(pHeader); + if( ! isValid ) { return NAM_INVALID_TAD_FORMAT; @@ -402,7 +490,42 @@ static s32 myReadTadHeader(FSFile* pTadFile, NAMiTadInfo* pInfo) -static s32 ImportTicket(FSFile* pTadFile, const NAMiTadInfo* pInfo, const NAMiTadImportContext* pContext) +static s32 my_sign_ReadTadHeader(MY_SIGN_File* pTadFile, NAMiTadInfo* pInfo) +{ + s32 result; + u32 fileSize; + NAMiTADHeader* pHeader; + BOOL isValid; + + fileSize = my_sign_FS_GetLength(pTadFile); + if( fileSize < sizeof(*pHeader) ) + { + OS_TPrintf("NAM::ReadTadHeader NAM_TOO_SMALL_FILE_USER (%d)", fileSize); + return NAM_TOO_SMALL_FILE_USER; + } + + // ヘッダを読む + result = NAMi_Load_sign(pTadFile, (void**)&pHeader, sizeof(*pHeader), 0, FALSE); + + if( result != NAM_OK ) + { + return result; + } + + isValid = IsValidTadHeader(pInfo, pHeader, fileSize); + NAMi_Free(pHeader); + + if( ! isValid ) + { + return NAM_INVALID_TAD_FORMAT; + } + + return NAM_OK; +} + + + +static s32 my_ImportTicket(FSFile* pTadFile, const NAMiTadInfo* pInfo, const NAMiTadImportContext* pContext) { s32 result; void* ticket = NULL; @@ -427,6 +550,31 @@ static s32 ImportTicket(FSFile* pTadFile, const NAMiTadInfo* pInfo, const NAMiTa return result; } +static s32 my_sign_ImportTicket(MY_SIGN_File* pTadFile, const NAMiTadInfo* pInfo, const NAMiTadImportContext* pContext) +{ + s32 result; + void* ticket = NULL; + + result = NAMi_Load_sign(pTadFile, &ticket, pInfo->sizes.ticket, pInfo->offsets.ticket, FALSE); + NAMi_Work.currentSize += pInfo->sizes.ticket; + + if( result != NAM_OK ) + { + return result; + } + + DC_FlushRange( ticket, pInfo->sizes.ticket ); + result = ES_ImportTicket( ticket, + pContext->cert, pInfo->sizes.cert, + pContext->crl, pInfo->sizes.crl, + ES_TRANSFER_SERVER ); + + NAMi_Work.currentSize += NAM_TAD_SIZE_ADJUST_IMPORTTICKET; + NAMi_Free(ticket); + + return result; +} + /* **************************** */ @@ -445,7 +593,7 @@ static s32 ImportTadTicketOnly(FSFile* pTadFile, const NAMiTadInfo* pInfo) } // eTicket をインポート - result = ImportTicket(pTadFile, pInfo, &tadContext); + result = my_ImportTicket(pTadFile, pInfo, &tadContext); if( result != NAM_OK ) { @@ -453,27 +601,7 @@ static s32 ImportTadTicketOnly(FSFile* pTadFile, const NAMiTadInfo* pInfo) return result; } - // 本体のインポート準備 -#if 0 - result = ImportTitleInit(pTadFile, pInfo, &tadContext); - if( result == NAM_OK ) - { - // コンテンツのインポート - for( idx = 0; idx < tadContext.numContents; ++idx ) - { - result = ImportContent(pTadFile, pInfo, &tadContext, idx); - - if( result != NAM_OK ) - { - break; - } - } - } - - // インポートの完了 - result = ImportTitleFinish(&tadContext, result); -#endif UnloadCertCrl(&tadContext); if( result != NAM_OK ) @@ -488,6 +616,45 @@ static s32 ImportTadTicketOnly(FSFile* pTadFile, const NAMiTadInfo* pInfo) return result; } +static s32 my_sign_ImportTadTicketOnly(MY_SIGN_File* pTadFile, const NAMiTadInfo* pInfo) +{ + s32 result; + // int idx; + NAMiTadImportContext tadContext; + + // cert と crl をメモリに読み込み + result = my_sign_LoadCertCrl(&tadContext, pTadFile, pInfo); + + if( result != NAM_OK ) + { + return result; + } + + // eTicket をインポート + result = my_sign_ImportTicket(pTadFile, pInfo, &tadContext); + + if( result != NAM_OK ) + { + UnloadCertCrl(&tadContext); + return result; + } + + + UnloadCertCrl(&tadContext); + + if( result != NAM_OK ) + { + return result; + } + + // セーブデータファイルのチェック + // Setup が必要なら行う + // shared2 ファイルの準備 + + return result; +} + + static s32 my_NAM_ImportTadWithFileTicketOnly(FSFile* pTadFile) @@ -531,12 +698,77 @@ static s32 my_NAM_ImportTadWithFileTicketOnly(FSFile* pTadFile) + +static s32 my_sign_NAM_ImportTadWithFileTicketOnly(MY_SIGN_File* pTadFile) +{ + extern NAMiWork NAMi_Work; + s32 result; + NAMiTadInfo tadInfo; + + SDK_POINTER_ASSERT(pTadFile); + (void)my_sign_FS_SeekFileToBegin(pTadFile); + + NAMi_Lock(); + + NAMi_Work.totalSize = 0; + NAMi_Work.currentSize = 0; + NAMi_Work.bRunning = TRUE; + + result = my_sign_ReadTadHeader(pTadFile, &tadInfo); + + if( result == NAM_OK ) + { + NAMi_Work.totalSize = tadInfo.sizes.cert + + tadInfo.sizes.crl + + tadInfo.sizes.ticket + + tadInfo.sizes.tmd + + tadInfo.sizes.content + + tadInfo.sizes.meta + + NAM_TAD_SIZE_ADJUST_SUM; + + NAMi_Work.currentSize += NAM_TAD_SIZE_ADJUST_INITLIB; + result = my_sign_ImportTadTicketOnly(pTadFile, &tadInfo); + } + + NAMi_Unlock(); + + NAMi_Work.bRunning = FALSE; + + return result; +} + + + + + + static s32 FuncImportTadTicketOnly(FSFile* pTadFile, void* arg) { #pragma unused(arg) return my_NAM_ImportTadWithFileTicketOnly(pTadFile); } + +static s32 FuncImportTadTicketOnly_sign(MY_SIGN_File* pTadFile, void* arg) +{ +#pragma unused(arg) + return my_sign_NAM_ImportTadWithFileTicketOnly(pTadFile); +} + + +static s32 NAMi_sign_CloseFile(MY_SIGN_File* pFile, BOOL isSystem) +{ + if( my_sign_FS_CloseFile(pFile) ) + { + return NAM_OK; + } + else + { + return isSystem ? NAM_CLOSE_FILE_FAILED_SYSTEM: NAM_CLOSE_FILE_FAILED_USER; + } +} + + static s32 TadFrameworkTicketOnly(const char* path, NAMiTadFunc pTadFunc, void* arg) { FSFile tadFile; @@ -559,6 +791,28 @@ static s32 TadFrameworkTicketOnly(const char* path, NAMiTadFunc pTadFunc, void* return (result == NAM_OK) ? resultClose: result; } +static s32 TadFrameworkTicketOnly_sign(const char* path, NAMiSignTadFunc pTadFunc, void* arg) +{ + MY_SIGN_File tadFile; + BOOL bSuccess; + s32 result; + s32 resultClose; + + my_sign_FS_InitFile(&tadFile); + + bSuccess = my_sign_FS_OpenFile(&tadFile, (char *)path); + if( ! bSuccess ) + { + return NAM_OPEN_FILE_FAILED_USER; + } + + result = pTadFunc(&tadFile, arg); + + resultClose = NAMi_sign_CloseFile(&tadFile, FALSE); + + return (result == NAM_OK) ? resultClose: result; +} + BOOL my_NAM_ImportTadTicketOnly(const char* path) { #if 1 @@ -601,10 +855,22 @@ BOOL my_NAM_ImportTadTicketOnly(const char* path) #endif } +BOOL my_NAM_ImportTadTicketOnly_sign(const char* path) +{ + s32 result; + + + result = TadFrameworkTicketOnly_sign(path, &FuncImportTadTicketOnly_sign, NULL); + + if(result != NAM_OK) { + return result; + } + return TRUE; +} + -#if 1 #define DEFINE_CALC_CONTENTS_BLOCKS(name,type,endianU16,endianU64) \ @@ -717,6 +983,52 @@ OS_TPrintf("ERROR:%s %s %d\n", __FILE__,__FUNCTION__,__LINE__); return NAM_OK; } +static s32 my_sign_NAM_ReadTadInfoWithFile(NAMTadInfo* pInfo, MY_SIGN_File* pTadFile) +{ + s32 result; + NAMiTadInfo tadInfo; + ESTitleMeta* pTmd; + + + SDK_POINTER_ASSERT(pInfo); + SDK_POINTER_ASSERT(pTadFile); + (void)my_sign_FS_SeekFileToBegin(pTadFile); + + result = my_sign_ReadTadHeader(pTadFile, &tadInfo); + + if( result != NAM_OK ) + { +OS_TPrintf("ERROR:%s %s %d\n", __FILE__,__FUNCTION__,__LINE__); + return result; + } + + // TMD を読む + result = NAMi_Load_sign( pTadFile, + (void**)&pTmd, + tadInfo.sizes.tmd, + tadInfo.offsets.tmd, + FALSE ); + if( result != NAM_OK ) + { +OS_TPrintf("ERROR:%s %s %d\n", __FILE__,__FUNCTION__,__LINE__); + + return result; + } + + NAMi_CopyTmdReservedInfo(&pInfo->titleInfo, &pTmd->head.reserved); + pInfo->titleInfo.titleId = NAMi_EndianU64(pTmd->head.titleId); + pInfo->titleInfo.companyCode = NAMi_EndianU16(pTmd->head.groupId); + pInfo->titleInfo.version = NAMi_EndianU16(pTmd->head.titleVersion); + pInfo->titleInfo.blockSize = my_NAMi_CalcTitleBlocksFromTmd(pTmd); + pInfo->fileSize = my_sign_FS_GetLength(pTadFile); + + NAMi_Free(pTmd); + + + + return NAM_OK; +} + @@ -725,6 +1037,10 @@ static s32 FuncReadTadInfo(FSFile* pTadFile, void* arg) return my_NAM_ReadTadInfoWithFile((NAMTadInfo*)arg, pTadFile); } +static s32 FuncSignReadTadInfo(MY_SIGN_File* pTadFile, void* arg) +{ + return my_sign_NAM_ReadTadInfoWithFile((NAMTadInfo*)arg, pTadFile); +} static s32 myTadFramework(const char* path, NAMiTadFunc pTadFunc, void* arg) { @@ -752,6 +1068,32 @@ static s32 myTadFramework(const char* path, NAMiTadFunc pTadFunc, void* arg) } +static s32 my_sign_TadFramework(const char* path, NAMiSignTadFunc pTadFunc, void* arg) +{ + MY_SIGN_File tadFile; + BOOL bSuccess; + s32 result; + s32 resultClose; + + my_sign_FS_InitFile(&tadFile); + + + bSuccess = my_sign_FS_OpenFile(&tadFile, (char *)path); + if( ! bSuccess ) + { + + return NAM_OPEN_FILE_FAILED_USER; + } + + result = pTadFunc(&tadFile, arg); + + + resultClose = NAMi_sign_CloseFile(&tadFile, FALSE); + + return (result == NAM_OK) ? resultClose: result; +} + + static BOOL my_NAM_ReadTadInfo(NAMTadInfo* pInfo, const char* path) { @@ -764,46 +1106,676 @@ static BOOL my_NAM_ReadTadInfo(NAMTadInfo* pInfo, const char* path) } -#else - - -static BOOL my_NAM_ReadTadInfo(NAMTadInfo* pInfo, char *path) +static BOOL my_sign_NAM_ReadTadInfo(NAMTadInfo* pInfo, const char* path) { - FSFile file; - BOOL bSuccess = TRUE; - BOOL ret_value = TRUE; - FSResult fsres; - // extern char *my_fs_util_get_fs_result_word( FSResult res ); + if( NAM_OK == my_sign_TadFramework(path, &FuncSignReadTadInfo, pInfo )) { - if( pInfo == NULL ) { - OS_TPrintf("%s pInfo NULL\n",__FUNCTION__); - return FALSE; - - } - if( path == NULL ) { - OS_TPrintf("%s path NULL\n",__FUNCTION__); - return FALSE; + return TRUE; } - FS_InitFile(&file); - - bSuccess = FS_OpenFile(&file, path); - if( bSuccess != TRUE ) { - OS_TPrintf("%s file open error %s\n",__FUNCTION__,path); - - fsres = FS_GetArchiveResultCode(path); - OS_TPrintf(" %s\n", my_fs_util_get_fs_result_word(fsres)); - return FALSE; - } - if( NAM_OK != NAM_ReadTadInfoWithFile(pInfo, &file) ) { - ret_value = FALSE; - } - (void)FS_CloseFile(&file); - return ret_value; + return FALSE; } -#endif +/* +### mwccarm.exe Compiler: +# 1104: result = NAMi_CheckTitleDataFile( tadContext.titleId, +# Error: ^^^^^^^^^^^^^^^^^^^^^^^ +# function has no prototype +### mwccarm.exe Compiler: +# 1114: result = NAMi_SetupTitleDataFileSecure( tadContext.titleId, +# Error: ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^ +# function has no prototype +### mwccarm.exe Compiler: +# 1125: result = NAMi_SetupTitleShared2Secure(tadContext.titleId); +*/ + + + + + +static s32 SetupContentInfo(NAMiTadImportContext* pContext, const ESTitleMeta* tmd) +{ + u32 i; + u32 offset; + NAMiTadContentInfo* pContentInfo = NULL; + const u16 numContents = NAMi_EndianU16(tmd->head.numContents); + + //---- コンテンツごとに NAMiTadContentInfo を確保し情報を格納します。 + + pContentInfo = NAMi_Alloc(sizeof(NAMiTadContentInfo) * numContents); + + if( pContentInfo == NULL ) + { + OS_TWarning("NAM::SetupContentInfo NAM_NO_MEMORY (%d)", sizeof(NAMiTadContentInfo) * numContents); + NAMi_Free(pContentInfo); + return NAM_NO_MEMORY; + } + + offset = 0; + for( i = 0; i < numContents; ++i ) + { + const ESContentMeta* pSrc = &tmd->contents[i]; + NAMiTadContentInfo* pDst = &pContentInfo[i]; + u64 contentSize = NAMi_EndianU64(pSrc->size); + u32 contentIndex = NAMi_EndianU16(pSrc->index); + + //---- tmd 中の ESContentMeta の並びと contentIndex は一致しているものとします。 + if( contentIndex != i ) + { + OS_TWarning("NAM::SetupContentInfo NAM_INVALID_CONTENT_INDEX: (%d != %d)", i, contentIndex); + NAMi_Free(pContentInfo); + return NAM_INVALID_CONTENT_INDEX; + } + //---- 32bit を超えるサイズのコンテンツはエラーとします。 + if( contentSize >= (1ull << 32) ) + { + OS_TWarning("NAM::SetupContentInfo NAM_TOO_LARGE_CONTENT_SIZE: %016llX %lld", contentSize, contentSize); + NAMi_Free(pContentInfo); + return NAM_TOO_LARGE_CONTENT_SIZE; + } + + pDst->id = NAMi_EndianU32(pSrc->cid); + pDst->index = contentIndex; + pDst->size = (u32)contentSize; + pDst->offset = offset; + + offset += MATH_ROUNDUP(pDst->size, 64); + } + + { + NAMiTmdReserved tmdReserved; + + // アライメントを気にしなくて良いように一旦コピーする + MI_CpuCopy8(tmd->head.reserved, &tmdReserved, sizeof(tmdReserved)); + + pContext->titleId = NAMi_EndianU64(tmd->head.titleId); + pContext->publicSaveSize = tmdReserved.publicSaveSize; + pContext->privateSaveSize = tmdReserved.privateSaveSize; + pContext->bCreateBanner = ((tmdReserved.flags & NAM_TMD_FLAG_NAND_BANNER) != 0); + pContext->numContents = numContents; + pContext->pContentInfo = pContentInfo; + } + + return NAM_OK; +} + + + +/*---------------------------------------------------------------------------* + Name: UnloadContentInfo + + Description: SetupContentInfo で行った前処理の解放を行います。 + + Arguments: pContext: 対象の ImportContext。 + + Returns: なし。 + *---------------------------------------------------------------------------*/ +static void UnloadContentInfo(NAMiTadImportContext* pContext) +{ + NAMi_Free(pContext->pContentInfo); + pContext->pContentInfo = NULL; +} + + +static s32 my_ImportTitleInit(FSFile* pTadFile, const NAMiTadInfo* pInfo, NAMiTadImportContext* pContext) +{ + s32 result; + void* tmd = NULL; + + result = NAMi_Load(pTadFile, &tmd, pInfo->sizes.tmd, pInfo->offsets.tmd, FALSE); + PRINT_RESULT(result); + NAMi_Work.currentSize += pInfo->sizes.tmd; + + if( result != NAM_OK ) + { + return result; + } + + //---- コンテンツインポート用の情報をキャッシュしておきます + result = SetupContentInfo(pContext, (ESTitleMeta*)tmd); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + NAMi_Free(tmd); + return result; + } + + DC_FlushRange( tmd, pInfo->sizes.tmd ); + result = ES_ImportTitleInit( tmd, pInfo->sizes.tmd, + pContext->cert, pInfo->sizes.cert, + pContext->crl, pInfo->sizes.crl, + ES_TRANSFER_SERVER, + 1 ); + PRINT_RESULT(result); + NAMi_Work.currentSize += NAM_TAD_SIZE_ADJUST_IMPORTTITLEINIT; + NAMi_Free(tmd); + + return result; +} + + +static s32 my_sign_ImportTitleInit(MY_SIGN_File* pTadFile, const NAMiTadInfo* pInfo, NAMiTadImportContext* pContext) +{ + s32 result; + void* tmd = NULL; + + result = NAMi_Load_sign(pTadFile, &tmd, pInfo->sizes.tmd, pInfo->offsets.tmd, FALSE); + PRINT_RESULT(result); + NAMi_Work.currentSize += pInfo->sizes.tmd; + + if( result != NAM_OK ) + { + return result; + } + + //---- コンテンツインポート用の情報をキャッシュしておきます + result = SetupContentInfo(pContext, (ESTitleMeta*)tmd); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + NAMi_Free(tmd); + return result; + } + + DC_FlushRange( tmd, pInfo->sizes.tmd ); + result = ES_ImportTitleInit( tmd, pInfo->sizes.tmd, + pContext->cert, pInfo->sizes.cert, + pContext->crl, pInfo->sizes.crl, + ES_TRANSFER_SERVER, + 1 ); + PRINT_RESULT(result); + NAMi_Work.currentSize += NAM_TAD_SIZE_ADJUST_IMPORTTITLEINIT; + NAMi_Free(tmd); + + return result; +} + + + +/*---------------------------------------------------------------------------* + Name: ImportTitleFinish + + Description: tad からの NAND アプリインポート後処理を行います。 + + Arguments: pContext: ImportContext。 + result: コンテンツインポート処理の結果。 + + Returns: 正常に処理が行われたなら NAM_OK を返します。 + *---------------------------------------------------------------------------*/ +static s32 my_ImportTitleFinish(NAMiTadImportContext* pContext, s32 result) +{ + UnloadContentInfo(pContext); + + if( result == NAM_OK ) + { + result = ES_ImportTitleDone(); + PRINT_RESULT(result); + NAMi_Work.currentSize += NAM_TAD_SIZE_ADJUST_IMPORTTITLEDONE; + } + else + { + s32 check = ES_ImportTitleCancel();; +#pragma unused(check) + SDK_WARNING( check == ES_ERR_OK, "ES_ImportTitleCancel failed %d", check ); + } + + return result; +} + + + +/*---------------------------------------------------------------------------* + Name: ImportContent + + Description: tad から NAND アプリコンテンツをインポートします。 + + Arguments: pTadFile: tad ファイル。 + pInfo: tad 構成情報。 + pContext: ImportContext。 + idx: インポートするコンテンツ番号。 + + Returns: 正常に処理が行われたなら NAM_OK を返します。 + *---------------------------------------------------------------------------*/ +static s32 my_ImportContent(FSFile* pTadFile, const NAMiTadInfo* pInfo, const NAMiTadImportContext* pContext, int idx) +{ + s32 fd; + const NAMiTadContentInfo* pContentInfo; + void* readBuffer; + u32 processedSize; + BOOL bSuccess; + s32 result; + s32 result2; + u32 offset; + + pContentInfo = &pContext->pContentInfo[idx]; + + offset = pInfo->offsets.content + pContentInfo->offset; + bSuccess = FS_SeekFile(pTadFile, (s32)offset, FS_SEEK_SET); + + if( ! bSuccess ) + { + OS_TWarning("NAM::ImportContent NAM_SEEK_FILE_FAILED_USER (%d)", offset); + return NAM_SEEK_FILE_FAILED_USER; + } + + readBuffer = NAMi_Alloc(NAM_STREAMING_BUFFER_SIZE); + + if( readBuffer == NULL ) + { + OS_TWarning("NAM::ImportContent NAM_NO_MEMORY (%d)", NAM_STREAMING_BUFFER_SIZE); + return NAM_NO_MEMORY; + } + + //---- コンテンツインポート前処理 + fd = ES_ImportContentBegin(pContext->titleId, pContentInfo->id); + + if( fd < 0 ) + { + NAMi_Free(readBuffer); + return fd; + } + + processedSize = 0; + + //---- コンテンツインポート処理 + while( processedSize < pContentInfo->size ) + { + u32 nextSize = MATH_MIN(NAM_STREAMING_BUFFER_SIZE, pContentInfo->size - processedSize); + u32 readSize; + + DC_InvalidateRange(readBuffer, NAM_STREAMING_BUFFER_SIZE); + readSize = (u32)FS_ReadFile(pTadFile, readBuffer, (s32)nextSize); + + if( readSize != nextSize ) + { + result = NAM_READ_FILE_FAILED_USER; + PRINT_RESULT(result); + break; + } + + DC_FlushRange( readBuffer, readSize ); + + result = ES_ImportContentData(fd, readBuffer, readSize); + PRINT_RESULT(result); + NAMi_Work.currentSize += readSize; + + if( result != ES_ERR_OK ) + { + break; + } + + processedSize += readSize; + } + + //---- コンテンツインポート後処理 + result2 = ES_ImportContentEnd(fd); + NAMi_Free(readBuffer); + + return (result == ES_ERR_OK) ? result2: result; +} + + +static s32 my_sign_ImportContent(MY_SIGN_File* pTadFile, const NAMiTadInfo* pInfo, const NAMiTadImportContext* pContext, int idx) +{ + s32 fd; + const NAMiTadContentInfo* pContentInfo; + void* readBuffer; + u32 processedSize; + BOOL bSuccess; + s32 result; + s32 result2; + u32 offset; + + pContentInfo = &pContext->pContentInfo[idx]; + + offset = pInfo->offsets.content + pContentInfo->offset; + bSuccess = my_sign_FS_SeekFile(pTadFile, (s32)offset, FS_SEEK_SET); + + if( ! bSuccess ) + { + OS_TWarning("NAM::ImportContent NAM_SEEK_FILE_FAILED_USER (%d)", offset); + return NAM_SEEK_FILE_FAILED_USER; + } + + readBuffer = NAMi_Alloc(NAM_STREAMING_BUFFER_SIZE); + + if( readBuffer == NULL ) + { + OS_TWarning("NAM::ImportContent NAM_NO_MEMORY (%d)", NAM_STREAMING_BUFFER_SIZE); + return NAM_NO_MEMORY; + } + + //---- コンテンツインポート前処理 + fd = ES_ImportContentBegin(pContext->titleId, pContentInfo->id); + + if( fd < 0 ) + { + NAMi_Free(readBuffer); + return fd; + } + + processedSize = 0; + + //---- コンテンツインポート処理 + while( processedSize < pContentInfo->size ) + { + u32 nextSize = MATH_MIN(NAM_STREAMING_BUFFER_SIZE, pContentInfo->size - processedSize); + u32 readSize; + + DC_InvalidateRange(readBuffer, NAM_STREAMING_BUFFER_SIZE); + readSize = (u32)my_sign_FS_ReadFile(pTadFile, readBuffer, (s32)nextSize); + + if( readSize != nextSize ) + { + result = NAM_READ_FILE_FAILED_USER; + PRINT_RESULT(result); + break; + } + + DC_FlushRange( readBuffer, readSize ); + + result = ES_ImportContentData(fd, readBuffer, readSize); + // PRINT_RESULT(result); + NAMi_Work.currentSize += readSize; + + if( result != ES_ERR_OK ) + { + break; + } + + processedSize += readSize; + } + + //---- コンテンツインポート後処理 + result2 = ES_ImportContentEnd(fd); + NAMi_Free(readBuffer); + + return (result == ES_ERR_OK) ? result2: result; +} + + +static s32 my_ImportTad(FSFile* pTadFile, const NAMiTadInfo* pInfo) +{ + s32 result; + int idx; + NAMiTadImportContext tadContext; + + // cert と crl をメモリに読み込み + result = LoadCertCrl(&tadContext, pTadFile, pInfo); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + return result; + } + + // eTicket をインポート + result = my_ImportTicket(pTadFile, pInfo, &tadContext); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + UnloadCertCrl(&tadContext); + return result; + } + + // 本体のインポート準備 + result = my_ImportTitleInit(pTadFile, pInfo, &tadContext); + PRINT_RESULT(result); + + if( result == NAM_OK ) + { + // コンテンツのインポート + for( idx = 0; idx < tadContext.numContents; ++idx ) + { + result = my_ImportContent(pTadFile, pInfo, &tadContext, idx); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + break; + } + } + } + + // インポートの完了 + result = my_ImportTitleFinish(&tadContext, result); + PRINT_RESULT(result); + UnloadCertCrl(&tadContext); + + if( result != NAM_OK ) + { + return result; + } + + // セーブデータファイルのチェック + result = NAMi_CheckTitleDataFile( tadContext.titleId, + NAM_DATA_FILE_ALL, + tadContext.publicSaveSize, + tadContext.privateSaveSize, + tadContext.bCreateBanner ); + PRINT_RESULT(result); + + // Setup が必要なら行う + if( result == NAM_REQUIRE_SETUP ) + { + result = NAMi_SetupTitleDataFileSecure( tadContext.titleId, + NAM_DATA_FILE_ALL, + tadContext.publicSaveSize, + tadContext.privateSaveSize, + tadContext.bCreateBanner ); + PRINT_RESULT(result); + } + + // shared2 ファイルの準備 + if( result == NAM_OK ) + { + result = NAMi_SetupTitleShared2Secure(tadContext.titleId); + } + + if( result != NAM_OK ) + { + // 失敗したのならタイトルを削除 + (void)NAM_DeleteTitle(tadContext.titleId); + return result; + } + + return result; +} + +static s32 my_sign_ImportTad(MY_SIGN_File* pTadFile, const NAMiTadInfo* pInfo) +{ + s32 result; + int idx; + NAMiTadImportContext tadContext; + + // cert と crl をメモリに読み込み + result = my_sign_LoadCertCrl(&tadContext, pTadFile, pInfo); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + return result; + } + + // eTicket をインポート + result = my_sign_ImportTicket(pTadFile, pInfo, &tadContext); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + UnloadCertCrl(&tadContext); + return result; + } + + // 本体のインポート準備 + result = my_sign_ImportTitleInit(pTadFile, pInfo, &tadContext); + PRINT_RESULT(result); + + if( result == NAM_OK ) + { + // コンテンツのインポート + for( idx = 0; idx < tadContext.numContents; ++idx ) + { + result = my_sign_ImportContent(pTadFile, pInfo, &tadContext, idx); + PRINT_RESULT(result); + + if( result != NAM_OK ) + { + break; + } + } + } + + // インポートの完了 + result = my_ImportTitleFinish(&tadContext, result); + PRINT_RESULT(result); + UnloadCertCrl(&tadContext); + + if( result != NAM_OK ) + { + return result; + } + + // セーブデータファイルのチェック + result = NAMi_CheckTitleDataFile( tadContext.titleId, + NAM_DATA_FILE_ALL, + tadContext.publicSaveSize, + tadContext.privateSaveSize, + tadContext.bCreateBanner ); + PRINT_RESULT(result); + + // Setup が必要なら行う + if( result == NAM_REQUIRE_SETUP ) + { + result = NAMi_SetupTitleDataFileSecure( tadContext.titleId, + NAM_DATA_FILE_ALL, + tadContext.publicSaveSize, + tadContext.privateSaveSize, + tadContext.bCreateBanner ); + PRINT_RESULT(result); + } + + // shared2 ファイルの準備 + if( result == NAM_OK ) + { + result = NAMi_SetupTitleShared2Secure(tadContext.titleId); + } + + if( result != NAM_OK ) + { + // 失敗したのならタイトルを削除 + (void)NAM_DeleteTitle(tadContext.titleId); + return result; + } + + return result; +} + +static s32 my_NAM_ImportTadWithFile(FSFile* pTadFile) +{ + s32 result; + NAMiTadInfo tadInfo; + + SDK_POINTER_ASSERT(pTadFile); + (void)FS_SeekFileToBegin(pTadFile); + + NAMi_Lock(); + + NAMi_Work.totalSize = 0; + NAMi_Work.currentSize = 0; + NAMi_Work.bRunning = TRUE; + + result = myReadTadHeader(pTadFile, &tadInfo); + PRINT_RESULT(result); + if( result == NAM_OK ) + { + NAMi_Work.totalSize = tadInfo.sizes.cert + + tadInfo.sizes.crl + + tadInfo.sizes.ticket + + tadInfo.sizes.tmd + + tadInfo.sizes.content + + tadInfo.sizes.meta + + NAM_TAD_SIZE_ADJUST_SUM; + + NAMi_Work.currentSize += NAM_TAD_SIZE_ADJUST_INITLIB; + result = my_ImportTad(pTadFile, &tadInfo); + PRINT_RESULT(result); + } + + NAMi_Unlock(); + + NAMi_Work.bRunning = FALSE; + + return result; +} + +static s32 my_sign_NAM_ImportTadWithFile(MY_SIGN_File* pTadFile) +{ + s32 result; + NAMiTadInfo tadInfo; + + SDK_POINTER_ASSERT(pTadFile); + (void)my_sign_FS_SeekFileToBegin(pTadFile); + + NAMi_Lock(); + + NAMi_Work.totalSize = 0; + NAMi_Work.currentSize = 0; + NAMi_Work.bRunning = TRUE; + + result = my_sign_ReadTadHeader(pTadFile, &tadInfo); + PRINT_RESULT(result); + if( result == NAM_OK ) + { + NAMi_Work.totalSize = tadInfo.sizes.cert + + tadInfo.sizes.crl + + tadInfo.sizes.ticket + + tadInfo.sizes.tmd + + tadInfo.sizes.content + + tadInfo.sizes.meta + + NAM_TAD_SIZE_ADJUST_SUM; + + NAMi_Work.currentSize += NAM_TAD_SIZE_ADJUST_INITLIB; + result = my_sign_ImportTad(pTadFile, &tadInfo); + PRINT_RESULT(result); + } + + NAMi_Unlock(); + + NAMi_Work.bRunning = FALSE; + + return result; +} + + +static s32 my_FuncImportTad(FSFile* pTadFile, void* arg) +{ +#pragma unused(arg) + return my_NAM_ImportTadWithFile(pTadFile); +} + +static s32 my_sign_FuncImportTad(MY_SIGN_File* pTadFile, void* arg) +{ +#pragma unused(arg) + return my_sign_NAM_ImportTadWithFile(pTadFile); +} + +static s32 my_NAM_ImportTad(const char* path) +{ + return myTadFramework(path, &my_FuncImportTad, NULL); +} + + +static s32 my_sign_NAM_ImportTad(const char* path) +{ + return my_sign_TadFramework(path, &my_sign_FuncImportTad, NULL); +} + + @@ -816,8 +1788,7 @@ static BOOL my_NAM_ReadTadInfo(NAMTadInfo* pInfo, char *path) Returns: None. *---------------------------------------------------------------------------*/ -//BOOL myImportTad(char* file_name, FSFile *log_fd) -BOOL myImportTad(char* full_path, FSFile *log_fd) +BOOL myImportTad(char* full_path, int org_version, FSFile *log_fd) { NAMTadInfo tadInfo; NAMTitleInfo titleInfoTmp; @@ -828,22 +1799,23 @@ BOOL myImportTad(char* full_path, FSFile *log_fd) // フルパスを作成 // STD_StrCpy(full_path, file_name); + // OS_TPrintf("import from ROM(%s)\n", full_path); miya_log_fprintf(log_fd,"start myImportTad %s\n",full_path); // tadファイルの情報取得 -#if 0 - if (NAM_ReadTadInfo(&tadInfo, full_path) != NAM_OK) { - miya_log_fprintf(log_fd,"Error:NAM_ReadTadInfo failed %s\n",full_path); - return FALSE; - } -#else if ( my_NAM_ReadTadInfo(&tadInfo, full_path) != TRUE ) { miya_log_fprintf(log_fd,"Error:NAM_ReadTadInfo failed %s\n",full_path); return FALSE; } -#endif + + miya_log_fprintf(log_fd,"tadfile.ver=%d org.ver=%d\n", tadInfo.titleInfo.version,org_version); + if( org_version > tadInfo.titleInfo.version ) { + miya_log_fprintf(log_fd,"Error:org.ver=%d tadfile.ver=%d %s\n",full_path); + return FALSE; + } + /* 1851879012 -> 0x6E616E64 */ /* HNCAだったらはねる。無線ファーム */ @@ -897,7 +1869,111 @@ BOOL myImportTad(char* full_path, FSFile *log_fd) } miya_log_fprintf(log_fd,"Import %s Start.\n", full_path ); - nam_result = NAM_ImportTad( full_path ); + // nam_result = NAM_ImportTad( full_path ); + nam_result = my_NAM_ImportTad( full_path ); + + if ( nam_result == NAM_OK ) { + miya_log_fprintf(log_fd, "Import Success!\n"); + ret = TRUE; + } + else { + /* + [ES] verify publickey sign failed: 7 + [ES] verify ticket failed rv=7 + Error:NAM_ImportTad RetCode=7 + */ + miya_log_fprintf(log_fd,"Error:NAM_ImportTad RetCode=%d\n", nam_result); + } + // InstalledSoftBoxCount, FreeSoftBoxCount の値を現在のNANDの状態に合わせて更新します。 + NAMUT_UpdateSoftBoxCount(); + + return ret; +} + + + +BOOL myImportTad_sign(char* full_path, int org_version, FSFile *log_fd) +{ + NAMTadInfo tadInfo; + NAMTitleInfo titleInfoTmp; + // char full_path[FS_ENTRY_LONGNAME_MAX+6]; + BOOL ret = FALSE; + s32 nam_result; + BOOL overwrite = FALSE; + + // フルパスを作成 + // STD_StrCpy(full_path, file_name); + // OS_TPrintf("import from SD Card(%s)\n", full_path); + + miya_log_fprintf(log_fd,"start my_sign_ImportTad %s\n",full_path); + + + // tadファイルの情報取得 + if ( my_sign_NAM_ReadTadInfo(&tadInfo, full_path) != TRUE ) { + miya_log_fprintf(log_fd,"Error:NAM_ReadTadInfo failed %s\n",full_path); + return FALSE; + } + + miya_log_fprintf(log_fd,"tadfile.ver=%d org.ver=%d\n", tadInfo.titleInfo.version,org_version); + if( org_version > tadInfo.titleInfo.version ) { + miya_log_fprintf(log_fd,"Error:org.ver=%d tadfile.ver=%d %s\n",full_path); + return FALSE; + } + + /* 1851879012 -> 0x6E616E64 */ + /* HNCAだったらはねる。無線ファーム */ + + // NANDの情報を取得 + if ( NAM_ReadTitleInfo(&titleInfoTmp, tadInfo.titleInfo.titleId) == NAM_OK ) { + // NANDに既にインストールされているかどうか確認する + if (tadInfo.titleInfo.titleId == titleInfoTmp.titleId) { + miya_log_fprintf(log_fd,"id=0x%08x already installed\n",titleInfoTmp.titleId); + miya_log_fprintf(log_fd," (%s)\n",full_path); + + miya_log_fprintf(log_fd," delete title..\n"); + if( NAM_OK != NAM_DeleteTitleCompletely( titleInfoTmp.titleId ) ) { + miya_log_fprintf(log_fd," Error: NAM_DeleteTitle id = 0x%08x\n", titleInfoTmp.titleId); + return FALSE; + } + } + } + else { + /* インストールされていない。 */ + // miya_log_fprintf(log_fd,"Error:NAM_ReadTitleInfo failed 0x%08x\n",tadInfo.titleInfo.titleId); + // return FALSE; + } + + // NOT_LAUNCH_FLAG または DATA_ONLY_FLAG が立っていないタイトルの場合 + // freeSoftBoxCountに空きがなければインポートしない + if (!(tadInfo.titleInfo.titleId & (TITLE_ID_NOT_LAUNCH_FLAG_MASK | TITLE_ID_DATA_ONLY_FLAG_MASK))) { + // 上書きインポートの場合はfreeSoftBoxCountはチェックしない + // miya_log_fprintf(log_fd,"%s %s %d\n",__FILE__,__FUNCTION__,__LINE__); + if (!overwrite) { + u8 installed, free; + if (!NAMUT_GetSoftBoxCount( &installed, &free )) { + miya_log_fprintf(log_fd,"Error:%s %s %d\n",__FILE__,__FUNCTION__,__LINE__); + return FALSE; + } + + if (free == 0) { + miya_log_fprintf(log_fd,"Error:NAND FreeSoftBoxCount == 0"); + return FALSE; + } + // miya_log_fprintf(log_fd,"%s %s %d\n",__FILE__,__FUNCTION__,__LINE__); + } + + // ESの仕様で古い e-ticket があると新しい e-ticket を使ったインポートができない + // 暫定対応として該当タイトルを完全削除してからインポートする + nam_result = NAM_DeleteTitleCompletely(tadInfo.titleInfo.titleId); + if ( nam_result != NAM_OK ) { + miya_log_fprintf(log_fd,"Error:NAM_DeleteTitleCompletely RetCode=%x\n", nam_result); + return FALSE; + } + } + miya_log_fprintf(log_fd,"Import %s Start.\n", full_path ); + + // nam_result = NAM_ImportTad( full_path ); + nam_result = my_sign_NAM_ImportTad( full_path ); if ( nam_result == NAM_OK ) { miya_log_fprintf(log_fd, "Import Success!\n"); diff --git a/build/tools/sctools/common/src/myimport.h b/build/tools/sctools/common/src/myimport.h index 2b0aadc..fe8996c 100644 --- a/build/tools/sctools/common/src/myimport.h +++ b/build/tools/sctools/common/src/myimport.h @@ -5,9 +5,11 @@ extern "C" { #endif -BOOL myImportTad(char* file_name, FSFile *log_fd); +BOOL myImportTad(char* file_name, int org_version, FSFile *log_fd); +BOOL myImportTad_sign(char* full_path, int org_version, FSFile *log_fd); BOOL myDeleteTitle(u64 tid, BOOL with_ticket, FSFile *log_fd); BOOL my_NAM_ImportTadTicketOnly(const char* path); +BOOL my_NAM_ImportTadTicketOnly_sign(const char* path); #ifdef __cplusplus } diff --git a/build/tools/sctools/common/src/pre_install.c b/build/tools/sctools/common/src/pre_install.c index cadb666..edca138 100644 --- a/build/tools/sctools/common/src/pre_install.c +++ b/build/tools/sctools/common/src/pre_install.c @@ -12,46 +12,51 @@ #include "my_fs_util.h" #include "myimport.h" +#include "my_sign.h" #include "pre_install.h" #define PRE_INSTALL_TABLE_FILE_NAND "rom:/tads/tad_table.txt" #define PRE_INSTALL_TABLE_DEV_FILE_NAND "rom:/taddevs/taddev_table.txt" -#define PRE_INSTALL_TABLE_FILE_SD "sdmc:/tads/tad_table.txt" +#define PRE_INSTALL_TABLE_FILE_SD "sdmc:/sdtads/en_sdtad_table.txt" +#define PRE_INSTALL_TABLE_DEV_FILE_SD "sdmc:/sdtaddevs/en_sdtad_table.txt" static PRE_INSTALL_FILE *pre_install_file_list = NULL; +#if 1 +//char *pre_install_search_tid(u64 tid, FSFile *log_fd); +static BOOL pre_install_discard_list(void); +static void pre_install_print_list(FSFile *log_fd); +#endif + + +BOOL pre_install_get_version(u64 tid, u16 *version) +{ + NAMTitleInfo titleInfoTmp; + + if ( NAM_ReadTitleInfo(&titleInfoTmp, tid) == NAM_OK ) { + // NANDに既にインストールされているかどうか確認する + if (tid == titleInfoTmp.titleId) { + if( version != NULL ) { + *version = titleInfoTmp.version; + OS_TPrintf( "tid=0x%08x%08x version = %d\n", + (u32)(titleInfoTmp.titleId >> 32), (u32)(titleInfoTmp.titleId & 0xffffffff), titleInfoTmp.version); + return TRUE; + } + } + } + return FALSE; +} + + BOOL pre_install_check_download_or_pre_install(u64 tid, int *flag, FSFile *log_fd) { ESError rv; ESTicketView *ticketViews; u32 numTickets; - + u32 i; -#if 0 - typedef u32 ESId; /* 32-bit device identity */ - - typedef struct { - ESVersion version; /* eTicket data structure version */ - ESTicketId ticketId; /* eTicket ID */ - ESId deviceId; /* device ID 0->common else->personalized */ - ESTitleId titleId; /* title ID */ - ESSysAccessMask sysAccessMask; /* 16 bit cidx mask */ - u16 ticketVersion; /* 16 bit ticket version */ - u32 accessTitleId; /* 32 bit title id for access control*/ - u32 accessTitleMask; /* 32 bit title id mask */ - u8 licenseType; /* for infrastructure use */ - ESTicketReserved reserved; /* 48 bytes reserved info */ - u8 audit; /* for infrastructure use */ - ESCidxMask cidxMask; /* 512 bits of cidx mask */ - ESLpEntry limits[ES_MAX_LIMIT_TYPE]; /* limit algorithm and limit */ - } ESTicketView; - - - ESError ES_GetTicketViews(ESTitleId titleId, ESTicketView* ticketViewList, u32* ticketViewCnt); -#endif - if( flag == NULL ) { return FALSE; } @@ -67,22 +72,27 @@ BOOL pre_install_check_download_or_pre_install(u64 tid, int *flag, FSFile *log_f if(numTickets) { ticketViews = OS_Alloc(sizeof(ESTicketView) * numTickets); + if( ticketViews == NULL ) { + miya_log_fprintf(log_fd,"%s OS_Alloc failed: tid=0x%08x%08x\n", + __FUNCTION__, (u32)(tid >> 32) , (u32)(tid & 0xffffffff)); + return FALSE; + } rv = ES_GetTicketViews(tid, ticketViews, &numTickets); if (rv != ES_ERR_OK) { miya_log_fprintf(log_fd,"ES_GetTicketViews failed: %d tid=0x%08x%08x\n", rv, (u32)(tid >> 32) , (u32)(tid & 0xffffffff) ); + OS_Free(ticketViews ); return FALSE; - } } else { -#if 0 - miya_log_fprintf(log_fd,"ES_GetTicketViews failed numTickets = 0: %d tid=0x%08x%08x\n", + miya_log_fprintf(log_fd,"ES_GetTicketViews numTickets = 0: %d tid=0x%08x%08x\n", rv, (u32)(tid >> 32) , (u32)(tid & 0xffffffff) ); + +#if 0 return FALSE; #endif /* error ??? */ - *flag = 0; return TRUE; } @@ -94,15 +104,23 @@ BOOL pre_install_check_download_or_pre_install(u64 tid, int *flag, FSFile *log_f rv = ES_CheckLaunchRights(t->titleId, &t->ticketViews[0]); #endif - if( ticketViews[0].deviceId == 0 ) { - /* common */ - *flag = 1; - } - else { - /* personalized */ - *flag = 2; + for( i = 0 ; i < numTickets ; i++ ) { + if( ticketViews[i].deviceId == 0 ) { + /* common */ + *flag = 1; + /* １個でもcommonがあればcommon扱い！？ */ + break; + } + else { + /* personalized */ + *flag = 2; + } } + + if( ticketViews ) { + OS_Free(ticketViews ); + } return TRUE; } @@ -140,11 +158,10 @@ static BOOL pre_install_add_list(u64 tid, u8 region, u8 country_code, char *temp } temp_list->next = temp_pre_install_file; } - return TRUE; } -char *pre_install_search_tid(u64 tid, FSFile *log_fd) +static char *pre_install_search_tid(u64 tid, FSFile *log_fd, BOOL *is_in_sd) { PRE_INSTALL_FILE *temp_list; @@ -153,6 +170,12 @@ char *pre_install_search_tid(u64 tid, FSFile *log_fd) miya_log_fprintf(log_fd,"\ntad file entry tid=0x%08x%08x\n%s\n", (u32)(tid >> 32) , (u32)(tid & 0xffffffff), temp_list->file_name ); + if( !STD_StrNCmp( temp_list->file_name, "sdmc:" , STD_StrLen("sdmc:")) ) { + *is_in_sd = TRUE; + } + else { + *is_in_sd = FALSE; + } return temp_list->file_name; } } @@ -162,7 +185,7 @@ char *pre_install_search_tid(u64 tid, FSFile *log_fd) } -BOOL pre_install_discard_list(void) +static BOOL pre_install_discard_list(void) { PRE_INSTALL_FILE *temp_list; PRE_INSTALL_FILE *temp_list2; @@ -177,8 +200,7 @@ BOOL pre_install_discard_list(void) return TRUE; } - -void pre_install_print_list(FSFile *log_fd) +static void pre_install_print_list(FSFile *log_fd) { PRE_INSTALL_FILE *temp_list; u64 tid; @@ -190,8 +212,6 @@ void pre_install_print_list(FSFile *log_fd) } } - - static int ReadLine(FSFile *f, char *buf, int buf_size) { char c; @@ -212,7 +232,37 @@ static int ReadLine(FSFile *f, char *buf, int buf_size) *buf = '\0'; break; } + *buf = c; + buf++; + if( count > buf_size ) { + buf--; + *buf = '\0'; + break; + } + } + return count; +} +static int my_sign_ReadLine(MY_SIGN_File *f, char *buf, int buf_size) +{ + char c; + s32 readSize; + int count = 0; + while( 1 ) { + readSize = my_sign_FS_ReadFile(f, (void *)&c, (s32)1 ); + if( readSize == 0 ) { + /* EOF */ + break; + } + count++; + if( c == '\r' ) { + *buf = '\0'; + break; + } + else if(c == '\n' ) { + *buf = '\0'; + break; + } *buf = c; buf++; if( count > buf_size ) { @@ -238,7 +288,8 @@ static int my_char_to_hex(char c) return -1; /* error */ } -BOOL pre_install_load_file(char *path, FSFile *log_fd) +/* main() -> pre_install_process() -> pre_install_load_file()で呼ばれる。 */ +static BOOL pre_install_load_file(char *path, FSFile *log_fd) { FSFile file; BOOL bSuccess = TRUE; @@ -401,6 +452,169 @@ label_last: } +static BOOL pre_install_load_sd_file(char *path, FSFile *log_fd) +{ + MY_SIGN_File file; + BOOL bSuccess = TRUE; + // s32 result; + s32 readSize; + // FSResult fsres; + + int buf_counter; + int buf_state; + +#define LINE_BUF_SIZE 512 + char line_buf[LINE_BUF_SIZE]; + // PRE_INSTALL_FILE temp_pre_install_file; + char temp_file_name[FS_FILE_NAME_MAX]; + + u64 temp_tid; + u8 temp_region; + u8 temp_country_code; + int temp_hex; + int temp_filename_count; + char c; + + my_sign_FS_InitFile(&file); + + bSuccess = my_sign_FS_OpenFile(&file, path); + if( ! bSuccess ) { + // fsres = FS_GetArchiveResultCode(path); + miya_log_fprintf(log_fd,"Error:%s %s open file failed %s\n",__FILE__,__FUNCTION__,path); + // miya_log_fprintf(log_fd, " Failed open file:%s\n", my_fs_util_get_fs_result_word( fsres )); + return FALSE; /* open error! */ + } + + /* + title id + 0x00000000 00000000, region , country code, file name, + */ + + while( 1 ) { + next_line_read: + buf_state = 0; + readSize = my_sign_ReadLine(&file, line_buf, LINE_BUF_SIZE ); + if( readSize == 0 ) { + /* EOF */ + OS_TPrintf("%s %s %d : End of File\n", __FILE__,__FUNCTION__,__LINE__); + break; + } + + if( !STD_StrNCmp( line_buf, "0x" , STD_StrLen("0x")) ) { + + OS_TPrintf("%s\n", line_buf); + + buf_counter = STD_StrLen("0x"); + buf_state = 1; + temp_tid = 0; + temp_region = 0; + temp_country_code = 0; + temp_filename_count = 0; + + while( readSize > buf_counter ) { + c = line_buf[buf_counter]; + + switch( buf_state ) { + case 1: /* TID */ + if( c == ',') { + if( buf_counter == 18 ) { + // OS_TPrintf("temp_tid=0x%08x %08x\n", (u32)(temp_tid >> 32) , (u32)(temp_tid & 0xffffffff)); + buf_state = 2; /* next state */ + } + else { + /* format error */ + miya_log_fprintf(log_fd,"Error:%s %s %d format error \n",__FILE__,__FUNCTION__,__LINE__); + goto next_line_read; + // break; + } + } + else { + temp_hex = my_char_to_hex(c); + if( temp_hex != -1 ) { + temp_tid |= ( ((u64)temp_hex) << (64 - (4 * (buf_counter-1))) ); + } + else { + /* format error */ + miya_log_fprintf(log_fd,"Error:%s %s %d format error\n",__FILE__,__FUNCTION__,__LINE__); + goto next_line_read; + // break; + } + } + break; + case 2: /* region */ + if( c == ' ' ) { + } + else if( c == ',' ) { + buf_state = 3; /* next state */ + } + else { + temp_hex = my_char_to_hex(c); + if( temp_hex != -1 ) { + temp_region = (u8)temp_hex; + } + else { + /* format error */ + miya_log_fprintf(log_fd,"Error:%s %s %d format error\n",__FILE__,__FUNCTION__,__LINE__); + goto next_line_read; + } + } + break; + case 3: /* country code */ + if( c == ' ' ) { + } + else if( c == ',' ) { + buf_state = 4; /* next state */ + } + else { + temp_hex = my_char_to_hex(c); + if( temp_hex != -1 ) { + temp_country_code = (u8)temp_hex; + } + else { + /* format error */ + miya_log_fprintf(log_fd,"Error:%s %s %d format error\n",__FILE__,__FUNCTION__,__LINE__); + goto next_line_read; + } + } + break; + + case 4: /* file name */ + if( c == ',' ) { + temp_file_name[temp_filename_count] = '\0'; + /* add list */ + if( TRUE != pre_install_add_list(temp_tid, temp_region, temp_country_code, temp_file_name, log_fd) ) { + OS_TPrintf("Error: add list error %s %s %d\n", __FILE__,__FUNCTION__,__LINE__); + } + buf_state = 5; /* next state */ + } + else { + if( c != ' ' ) { + temp_file_name[temp_filename_count] = c; + temp_filename_count++; + } + } + break; + case 5: /* until line end */ + break; + default: + /* error */ + break; + } + buf_counter++; + } + } + else { + /* 妙なフォーマットは全部コメント扱い. */ + } + } + +label_last: + (void)my_sign_FS_CloseFile(&file); + + return bSuccess; +} + + BOOL pre_install_Cleanup_User_Titles( FSFile *log_fd ) { @@ -481,6 +695,7 @@ BOOL pre_install_Cleanup_User_Titles( FSFile *log_fd ) } + BOOL pre_install_command(FSFile *log_fd, u64 *tid_array, int tid_count, int command, BOOL development_version_flag ) { char *tad_file_name; @@ -488,14 +703,20 @@ BOOL pre_install_command(FSFile *log_fd, u64 *tid_array, int tid_count, int com u64 tid; char game_code_buf[5]; BOOL ret_flag; + BOOL is_in_sd = FALSE; + int org_version =-1; if( development_version_flag ) { + (void)pre_install_load_sd_file(PRE_INSTALL_TABLE_DEV_FILE_SD, log_fd); (void)pre_install_load_file(PRE_INSTALL_TABLE_DEV_FILE_NAND, log_fd); } else { + (void)pre_install_load_sd_file(PRE_INSTALL_TABLE_FILE_SD, log_fd); (void)pre_install_load_file(PRE_INSTALL_TABLE_FILE_NAND, log_fd); } + pre_install_print_list(log_fd); + switch( command ) { case 1: mprintf("Install App.\n"); @@ -513,6 +734,8 @@ BOOL pre_install_command(FSFile *log_fd, u64 *tid_array, int tid_count, int com break; } + + for( i = 0 ; i < tid_count ; i++ ) { ret_flag = TRUE; tid = tid_array[i]; @@ -528,18 +751,28 @@ BOOL pre_install_command(FSFile *log_fd, u64 *tid_array, int tid_count, int com case 1: mprintf("IA "); miya_log_fprintf(log_fd, "IA "); - tad_file_name = pre_install_search_tid( tid , log_fd); + tad_file_name = pre_install_search_tid( tid , log_fd, &is_in_sd); if( tad_file_name ) { - ret_flag = myImportTad( tad_file_name , log_fd ); + if( is_in_sd == TRUE ) { + ret_flag = myImportTad_sign( tad_file_name , org_version, log_fd ); + } + else { + ret_flag = myImportTad( tad_file_name , org_version, log_fd ); + } } break; case 2: mprintf("TO "); miya_log_fprintf(log_fd, "TO "); - tad_file_name = pre_install_search_tid( tid , log_fd); + tad_file_name = pre_install_search_tid( tid , log_fd, &is_in_sd); if( tad_file_name ) { - ret_flag = my_NAM_ImportTadTicketOnly( tad_file_name ); + if( is_in_sd == TRUE ) { + ret_flag = my_NAM_ImportTadTicketOnly_sign( tad_file_name ); + } + else { + ret_flag = my_NAM_ImportTadTicketOnly( tad_file_name ); + } } break; case 3: @@ -583,6 +816,22 @@ BOOL pre_install_command(FSFile *log_fd, u64 *tid_array, int tid_count, int com } + +BOOL pre_install_debug(FSFile *log_fd, BOOL development_version_flag ) +{ + if( development_version_flag ) { + (void)pre_install_load_sd_file(PRE_INSTALL_TABLE_DEV_FILE_SD, log_fd); + (void)pre_install_load_file(PRE_INSTALL_TABLE_DEV_FILE_NAND, log_fd); + } + else { + (void)pre_install_load_sd_file(PRE_INSTALL_TABLE_FILE_SD, log_fd); + (void)pre_install_load_file(PRE_INSTALL_TABLE_FILE_NAND, log_fd); + } + + pre_install_print_list(NULL); + return TRUE; +} + BOOL pre_install_process( FSFile *log_fd, MY_USER_APP_TID *title_id_buf_ptr, int title_id_count, u64 *ticket_id_array, int ticket_id_count, BOOL development_version_flag ) { @@ -591,25 +840,21 @@ BOOL pre_install_process( FSFile *log_fd, MY_USER_APP_TID *title_id_buf_ptr, int u64 tid; char game_code_buf[5]; BOOL ret_flag = TRUE; - - -#if 0 - /* セキュリティ的にちょっと・・・ */ - (void)pre_install_load_file(PRE_INSTALL_TABLE_FILE_SD, log_fd); -#endif + BOOL is_in_sd = FALSE; + int version; if( development_version_flag ) { + (void)pre_install_load_sd_file(PRE_INSTALL_TABLE_DEV_FILE_SD, log_fd); (void)pre_install_load_file(PRE_INSTALL_TABLE_DEV_FILE_NAND, log_fd); } else { + (void)pre_install_load_sd_file(PRE_INSTALL_TABLE_FILE_SD, log_fd); (void)pre_install_load_file(PRE_INSTALL_TABLE_FILE_NAND, log_fd); } - pre_install_print_list(NULL); - /* チケットだけのインストール */ for( i = 0 ; i < ticket_id_count ; i++ ) { tid = ticket_id_array[i]; @@ -621,9 +866,16 @@ BOOL pre_install_process( FSFile *log_fd, MY_USER_APP_TID *title_id_buf_ptr, int continue; } - tad_file_name = pre_install_search_tid( tid , log_fd); + tad_file_name = pre_install_search_tid( tid , log_fd, &is_in_sd); if( tad_file_name ) { - if( FALSE == my_NAM_ImportTadTicketOnly( tad_file_name ) ) { + if( is_in_sd == TRUE ) { + ret_flag = my_NAM_ImportTadTicketOnly_sign( tad_file_name ); + } + else { + ret_flag = my_NAM_ImportTadTicketOnly( tad_file_name ); + } + + if( FALSE == ret_flag ) { /* error チケットインストール失敗？ */ miya_log_fprintf(log_fd, "NG.\n"); m_set_palette(tc[0], M_TEXT_COLOR_RED ); /* green */ @@ -666,13 +918,23 @@ BOOL pre_install_process( FSFile *log_fd, MY_USER_APP_TID *title_id_buf_ptr, int 0x000300044B47554A "rom:/tads/TWL-HNGJ-v256.tad.out" */ tid = title_id_buf_ptr[i].tid; + version = title_id_buf_ptr[i].version; + + (void)my_fs_Tid_To_GameCode(tid, game_code_buf); mprintf(" AP %08X %08X [%s] ", (u32)(tid >> 32), (u32)tid, game_code_buf); miya_log_fprintf(log_fd, " AP %08X %08X [%s] ", (u32)(tid >> 32), (u32)tid, game_code_buf); - tad_file_name = pre_install_search_tid( tid , log_fd); + tad_file_name = pre_install_search_tid( tid , log_fd, &is_in_sd); if( tad_file_name ) { - if( FALSE == myImportTad( tad_file_name , log_fd) ) { + + if( is_in_sd == TRUE ) { + ret_flag = myImportTad_sign( tad_file_name , version, log_fd); + } + else { + ret_flag = myImportTad( tad_file_name , version, log_fd); + } + if( FALSE == ret_flag ) { miya_log_fprintf(log_fd, "NG.\n"); m_set_palette(tc[0], M_TEXT_COLOR_RED ); /* green */ mprintf("NG.\n"); @@ -705,173 +967,3 @@ BOOL pre_install_process( FSFile *log_fd, MY_USER_APP_TID *title_id_buf_ptr, int (void)pre_install_discard_list(); return ret_flag; } - - - -#if 0 - -// リージョンコード -typedef enum OSTWLRegionCode -{ - OS_TWL_REGION_JAPAN = 0, - OS_TWL_REGION_AMERICA = 1, - OS_TWL_REGION_EUROPE = 2, - OS_TWL_REGION_AUSTRALIA = 3, - OS_TWL_REGION_CHINA = 4, - OS_TWL_REGION_KOREA = 5, - OS_TWL_REGION_MAX -} OSTWLRegion; - - -// 言語設定コード -typedef enum LCFGTWLCountryCode -{ - LCFG_TWL_COUNTRY_UNDEFINED = 0, // 未設定 - - // JPNリージョン - LCFG_TWL_COUNTRY_JAPAN = 1, // 日本 - - // USAリージョン - LCFG_TWL_COUNTRY_Anguilla = 8, // アンギラ - LCFG_TWL_COUNTRY_ANTIGUA_AND_BARBUDA, // アンティグア・バーブーダ - LCFG_TWL_COUNTRY_ARGENTINA = 10, // アルゼンチン - LCFG_TWL_COUNTRY_ARUBA, // アルバ - LCFG_TWL_COUNTRY_BAHAMAS, // バハマ - LCFG_TWL_COUNTRY_BARBADOS, // バルバドス - LCFG_TWL_COUNTRY_BELIZE, // ベリーズ - LCFG_TWL_COUNTRY_BOLIVIA, // ボリビア - LCFG_TWL_COUNTRY_BRAZIL, // ブラジル - LCFG_TWL_COUNTRY_BRITISH_VIRGIN_ISLANDS, // 英領ヴァージン諸島 - LCFG_TWL_COUNTRY_CANADA, // カナダ - LCFG_TWL_COUNTRY_CAYMAN_ISLANDS, // ケイマン諸島 - LCFG_TWL_COUNTRY_CHILE = 20, // チリ - LCFG_TWL_COUNTRY_COLOMBIA, // コロンビア - LCFG_TWL_COUNTRY_COSTA_RICA, // コスタリカ - LCFG_TWL_COUNTRY_DOMINICA, // ドミニカ国 - LCFG_TWL_COUNTRY_DOMINICAN_REPUBLIC, // ドミニカ共和国 - LCFG_TWL_COUNTRY_ECUADOR, // エクアドル - LCFG_TWL_COUNTRY_EL_SALVADOR, // エルサルバドル - LCFG_TWL_COUNTRY_FRENCH_GUIANA, // フランス領ギアナ - LCFG_TWL_COUNTRY_GRENADA, // グレナダ - LCFG_TWL_COUNTRY_GUADELOUPE, // グアドループ - LCFG_TWL_COUNTRY_GUATEMALA = 30, // グアテマラ - LCFG_TWL_COUNTRY_GUYANA, // ガイアナ - LCFG_TWL_COUNTRY_HAITI, // ハイチ - LCFG_TWL_COUNTRY_HONDURAS, // ホンジュラス - LCFG_TWL_COUNTRY_JAMAICA, // ジャマイカ - LCFG_TWL_COUNTRY_MARTINIQUE, // マルティニーク - LCFG_TWL_COUNTRY_MEXICO, // メキシコ - LCFG_TWL_COUNTRY_MONTSERRAT, // モントセラト - LCFG_TWL_COUNTRY_NETHERLANDS_ANTILLES, // オランダ領アンティル - LCFG_TWL_COUNTRY_NICARAGUA, // ニカラグア - LCFG_TWL_COUNTRY_PANAMA = 40, // パナマ - LCFG_TWL_COUNTRY_PARAGUAY, // パラグアイ - LCFG_TWL_COUNTRY_PERU, // ペルー - LCFG_TWL_COUNTRY_ST_KITTS_AND_NEVIS, // セントキッツ・ネイビス - LCFG_TWL_COUNTRY_ST_LUCIA, // セントルシア - LCFG_TWL_COUNTRY_ST_VINCENT_AND_THE_GRENADINES, // セントビンセント・グレナディーン - LCFG_TWL_COUNTRY_SURINAME, // スリナム - LCFG_TWL_COUNTRY_TRINIDAD_AND_TOBAGO, // トリニダード・トバゴ - LCFG_TWL_COUNTRY_TURKS_AND_CAICOS_ISLANDS, // タークス・カイコス諸島 - LCFG_TWL_COUNTRY_UNITED_STATES, // アメリカ - LCFG_TWL_COUNTRY_URUGUAY = 50, // ウルグアイ - LCFG_TWL_COUNTRY_US_VIRGIN_ISLANDS, // 米領バージン諸島 - LCFG_TWL_COUNTRY_VENEZUELA, // ベネズエラ - - // EUR, NAL リージョン - LCFG_TWL_COUNTRY_ALBANIA = 64, // アルバニア - LCFG_TWL_COUNTRY_AUSTRALIA, // オーストラリア - LCFG_TWL_COUNTRY_AUSTRIA, // オーストリア - LCFG_TWL_COUNTRY_BELGIUM, // ベルギー - LCFG_TWL_COUNTRY_BOSNIA_AND_HERZEGOVINA, // ボスニア・ヘルツェゴビナ - LCFG_TWL_COUNTRY_BOTSWANA, // ボツワナ - LCFG_TWL_COUNTRY_BULGARIA = 70, // ブルガリア - LCFG_TWL_COUNTRY_CROATIA, // クロアチア - LCFG_TWL_COUNTRY_CYPRUS, // キプロス - LCFG_TWL_COUNTRY_CZECH_REPUBLIC, // チェコ - LCFG_TWL_COUNTRY_DENMARK, // デンマーク - LCFG_TWL_COUNTRY_ESTONIA, // エストニア - LCFG_TWL_COUNTRY_FINLAND, // フィンランド - LCFG_TWL_COUNTRY_FRANCE, // フランス - LCFG_TWL_COUNTRY_GERMANY, // ドイツ - LCFG_TWL_COUNTRY_GREECE, // ギリシャ - LCFG_TWL_COUNTRY_HUNGARY = 80, // ハンガリー - LCFG_TWL_COUNTRY_ICELAND, // アイスランド - LCFG_TWL_COUNTRY_IRELAND, // アイルランド - LCFG_TWL_COUNTRY_ITALY, // イタリア - LCFG_TWL_COUNTRY_LATVIA, // ラトビア - LCFG_TWL_COUNTRY_LESOTHO, // レソト - LCFG_TWL_COUNTRY_LIECHTENSTEIN, // リヒテンシュタイン - LCFG_TWL_COUNTRY_LITHUANIA, // リトアニア - LCFG_TWL_COUNTRY_LUXEMBOURG, // ルクセンブルク - LCFG_TWL_COUNTRY_MACEDONIA, // マケドニア - LCFG_TWL_COUNTRY_MALTA = 90, // マルタ - LCFG_TWL_COUNTRY_MONTENEGRO, // モンテネグロ - LCFG_TWL_COUNTRY_MOZAMBIQUE, // モザンビーク - LCFG_TWL_COUNTRY_NAMIBIA, // ナミビア - LCFG_TWL_COUNTRY_NETHERLANDS, // オランダ - LCFG_TWL_COUNTRY_NEW_ZEALAND, // ニュージーランド - LCFG_TWL_COUNTRY_NORWAY, // ノルウェー - LCFG_TWL_COUNTRY_POLAND, // ポーランド - LCFG_TWL_COUNTRY_PORTUGAL, // ポルトガル - LCFG_TWL_COUNTRY_ROMANIA, // ルーマニア - LCFG_TWL_COUNTRY_RUSSIA = 100, // ロシア - LCFG_TWL_COUNTRY_SERBIA, // セルビア - LCFG_TWL_COUNTRY_SLOVAKIA, // スロバキア - LCFG_TWL_COUNTRY_SLOVENIA, // スロベニア - LCFG_TWL_COUNTRY_SOUTH_AFRICA, // 南アフリカ - LCFG_TWL_COUNTRY_SPAIN, // スペイン - LCFG_TWL_COUNTRY_SWAZILAND, // スワジランド - LCFG_TWL_COUNTRY_SWEDEN, // スウェーデン - LCFG_TWL_COUNTRY_SWITZERLAND, // スイス - LCFG_TWL_COUNTRY_TURKEY, // トルコ - LCFG_TWL_COUNTRY_UNITED_KINGDOM = 110, // イギリス - LCFG_TWL_COUNTRY_ZAMBIA, // ザンビア - LCFG_TWL_COUNTRY_ZIMBABWE, // ジンバブエ - - // TWNリージョン - LCFG_TWL_COUNTRY_TAIWAN = 128, // 台湾 - - // KORリージョン - LCFG_TWL_COUNTRY_SOUTH_KOREA = 136, // 韓国 - - // HKGリージョン（Wiiの国リストに存在） - LCFG_TWL_COUNTRY_HONG_KONG = 144, // ホンコン - LCFG_TWL_COUNTRY_MACAU, // マカオ - - // ASIリージョン（Wiiの国リストに存在） - LCFG_TWL_COUNTRY_INDONESIA = 152, // インドネシア - - // USAリージョン - LCFG_TWL_COUNTRY_SINGAPORE = 153, // シンガポール - - // ASIリージョン（再び） - LCFG_TWL_COUNTRY_THAILAND = 154, // タイ - LCFG_TWL_COUNTRY_PHILIPPINES, // フィリピン - LCFG_TWL_COUNTRY_MALAYSIA, // マレーシア - - // 未定義リージョン（IQueリージョン？） - LCFG_TWL_COUNTRY_CHINA = 160, // 中国 - - // USAリージョン - LCFG_TWL_COUNTRY_UAE = 168, // アラブ首長国連邦 - - // 未定義リージョン - LCFG_TWL_COUNTRY_INDIA = 169, // インド - LCFG_TWL_COUNTRY_EGYPT = 170, // エジプト - LCFG_TWL_COUNTRY_OMAN, // オマーン - LCFG_TWL_COUNTRY_QATAR, // カタール - LCFG_TWL_COUNTRY_KUWAIT, // クウェート - LCFG_TWL_COUNTRY_SAUDI_ARABIA, // サウジアラビア - LCFG_TWL_COUNTRY_SYRIA, // シリア - LCFG_TWL_COUNTRY_BAHRAIN, // バーレーン - LCFG_TWL_COUNTRY_JORDAN, // ヨルダン - - LCFG_TWL_COUNTRY_OTHERS = 254, - LCFG_TWL_COUNTRY_UNKNOWN = 255, - - LCFG_TWL_COUNTRY_MAX - -} LCFGTWLCountryCode; - -#endif diff --git a/build/tools/sctools/common/src/pre_install.h b/build/tools/sctools/common/src/pre_install.h index d5c73a3..91e9fe9 100644 --- a/build/tools/sctools/common/src/pre_install.h +++ b/build/tools/sctools/common/src/pre_install.h @@ -16,13 +16,13 @@ extern "C" { #endif BOOL pre_install_Cleanup_User_Titles( FSFile *log_fd ); -BOOL pre_install_load_file(char *path, FSFile *log_fd); -char *pre_install_search_tid(u64 tid, FSFile *log_fd); -BOOL pre_install_discard_list(void); BOOL pre_install_process( FSFile *log_fd, MY_USER_APP_TID *title_id_buf_ptr, int tile_id_count, u64 *ticket_id_array, int ticket_id_count ,BOOL development_version_flag ); + BOOL pre_install_check_download_or_pre_install(u64 tid, int *flag, FSFile *log_fd); -void pre_install_print_list(FSFile *log_fd); +BOOL pre_install_get_version(u64 tid, u16 *version); + +BOOL pre_install_debug(FSFile *log_fd, BOOL development_version_flag ); BOOL pre_install_command(FSFile *log_fd, u64 *tid_array, int tid_count, int command, BOOL development_version_flag ); #ifdef __cplusplus diff --git a/build/tools/sctools/common/src/stream.c b/build/tools/sctools/common/src/stream.c index 2e85831..8aa644b 100644 --- a/build/tools/sctools/common/src/stream.c +++ b/build/tools/sctools/common/src/stream.c @@ -90,12 +90,9 @@ static u8 strm_rbuf[STRM_BUF_SIZE] ATTRIBUTE_ALIGN(32); static u8 strm_tmp[STRM_BUF_PAGESIZE * 2] ATTRIBUTE_ALIGN(32); // ファイル名 -//const char filename2[] = "kart_title.32.wav"; -//const char filename1[] = "fanfare.32.wav"; const char filename0[] = "cursor.wav"; const char filename1[] = "ok.wav"; const char filename2[] = "ng.wav"; -//const char filename3[] = "fanfare.32.wav"; static StreamInfo strm; diff --git a/build/tools/sctools/copy_dst/Makefile b/build/tools/sctools/copy_dst/Makefile index 17c3e45..6610068 100644 --- a/build/tools/sctools/copy_dst/Makefile +++ b/build/tools/sctools/copy_dst/Makefile @@ -27,7 +27,9 @@ SRCS = main.c mfiler.c key.c font.c text.c mprintf.c logprintf.c \ hatamotolib.cpp miya_mcu.c error_report.c \ sitedefs.c wcm_control.c netconnect.c mywlan.c \ mynuc.c nuc_error_msg.c stream.c myfilename.c menu_version.c \ - ntp.c myimport.c pre_install.c + ntp.c myimport.c pre_install.c \ + my_rsa_sign.c my_aes.c my_sign.c + TARGET_BIN = copy_dst.srl ROM_SPEC = copy_dst.rsf diff --git a/build/tools/sctools/copy_dst/src/hatamotolib.cpp b/build/tools/sctools/copy_dst/src/hatamotolib.cpp index e2a9de4..3928f72 100644 --- a/build/tools/sctools/copy_dst/src/hatamotolib.cpp +++ b/build/tools/sctools/copy_dst/src/hatamotolib.cpp @@ -855,6 +855,9 @@ static BOOL DownloadTitles(MY_USER_APP_TID* pTitleIds, u32 numTitleIds) return ret_flag; } + + + //int ECDownload(const NAMTitleId* pTitleIds, u32 numTitleIds) int ECDownload(MY_USER_APP_TID *pTitleIds, u32 numTitleIds) { @@ -911,6 +914,7 @@ int ECDownload(MY_USER_APP_TID *pTitleIds, u32 numTitleIds) miya_log_fprintf(log_fd, " already registered. please delete acount.\n"); return ECDOWNLOAD_FAILURE; } + else if( (status != 'P') && (status != 'T') ) { m_set_palette(tc[0], M_TEXT_COLOR_RED ); mprintf("NG.\n"); @@ -1011,6 +1015,315 @@ int ECDownload(MY_USER_APP_TID *pTitleIds, u32 numTitleIds) } +static BOOL DownloadTitles_Auto(MY_USER_APP_TID* pTitleIds, u32 numTitleIds) +{ + s32 progress; + NAMTitleId tid; + BOOL ret_flag = TRUE; + // ECDL_LOG("download"); + char game_code_buf[5]; + + for( u32 i = 0; i < numTitleIds; i++ ) { + // tid = pTitleIds[i]; + if( pTitleIds[i].is_personalized == 1 ) { + /* + personalized ticketのときは何もしない、というかプリンストールもの + pTitleIds[i].is_personalized = 1 -> common + pTitleIds[i].is_personalized = 2 -> personalized + */ + } + else { + tid = pTitleIds[i].tid; + + /* + +typedef struct { + char amount [EC_AMOUNT_BUF_SIZE]; + char currency[EC_CURRENCY_BUF_SIZE]; + +} ECMoney; + +typedef ECMoney ECPrice; + +typedef struct +{ + // The id should be set to empty string + // (i.e., id[0] = 0;) to use the default + // account for the device. When id[0] == 0, + // the device accountId and deviceToken are used. + + char id[EC_ACCOUNT_ID_BUF_SIZE]; + char password[EC_ACCOUNT_PW_BUF_SIZE]; + +} ECAccountPayment; + +typedef struct { + u32 code; // limit algorithm + u32 limit; // and limit + u32 consumed; + s32 hasConsumption; + +} ECTitleLimit; + + function getTitleLimits() + { + // Examples of using ECTitleLimit and ECTitleLimits + + // /********** + + var limits = new ECTitleLimits (); + limits.set(0, "TR", 60*60*24*31); // 31 days + limits.set(1, "LR", 10); // 10 launches + limits.set("1", "LR", "10"); // 10 launches + + limits.set(8, "TR", 60*60*24*31); // invalid index + showLimits (limits); + + // or + + var limits2 = new ECTitleLimits (); + setTitleLimits (limits2); // passes obj by reference + showLimits (limits2); + + // or + + var limits3 = getTitleLimits2() + showLimits (limits3); + + // or + var no_limits = new ECTitleLimits (); // default is PR + + return no_limits; + } + + + { + var downloadContent = true; + var itemId = "109792"; // lab7 + var amount = "0"; + var currency = "POINTS" + var price = new ECPrice (amount, currency); + var payment = new ECAccountPayment(); // buy with points + + var limits = getTitleLimits(); + + var purchaseInfo = null; + var taxes = null; + var discount = null; + + var progress = ec.purchaseTitle (titleId, itemId, + price, payment, + limits, + downloadContent, // optional + taxes, // optional + purchaseInfo, // optional + discount); // optional + + +s32 EC_PurchaseTitleEx (ESTitleId titleId, + s32 itemId, + ECPrice price, + const ECPayment *payment, + const ESLpEntry *limits, + u32 nLimits, + s32 downloadContent, + const char* taxes, + const char* purchaseInfo, + const char* discount); + + s32 EC_PurchaseTitle (ESTitleId titleId, + s32 itemId, + s32 points, + const ESLpEntry *limits, + u32 nLimits); + */ + + progress = EC_DownloadTitle(tid, EC_DT_UPDATE_REQUIRED_CONTENTS); + // mprintf("-check registration.. "); + (void)my_fs_Tid_To_GameCode((u64)tid, game_code_buf); + game_code_buf[4] = '\0'; + mprintf(" downloading.. [%s] ", game_code_buf); + if( FALSE == WaitEC_with_NG_print(progress) ) { + /* EC_ERROR_NET_CONTENTはずす？エラーにせずにバックアップだけ復活してやるか？ */ + miya_log_fprintf(log_fd, " %s download NG.\n",game_code_buf); + ret_flag = FALSE; + } + else { + pTitleIds[i].install_success_flag = TRUE; + + m_set_palette(tc[0], M_TEXT_COLOR_GREEN ); /* green */ + mprintf("OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + miya_log_fprintf(log_fd, " %s download OK.\n",game_code_buf); + } + } + } + return ret_flag; +} + + +int ECDownload_Auto(MY_USER_APP_TID *pTitleIds, u32 numTitleIds) +{ + char challenge[EC_CHALLENGE_BUF_SIZE]; + char status; + // BOOL ret_flag; + + STD_MemSet((void *)challenge,(int)0, EC_CHALLENGE_BUF_SIZE); + + /*********************************/ + mprintf("-check registration.. "); + miya_log_fprintf(log_fd, "-check registration..."); + + if( FALSE == CheckRegistration( &status ) ) { + return ECDOWNLOAD_FAILURE; + } + + // U unregistered + // R registered + // P pending + // T transfered + if( status == '\0' ) { + miya_log_fprintf(log_fd, "NG.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_RED ); + mprintf("NG.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + + mprintf(" my error.\n"); + miya_log_fprintf(log_fd, " my error.\n"); + return ECDOWNLOAD_FAILURE; + } + else if( status == 'U') { + miya_log_fprintf(log_fd, "NG.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_RED ); + mprintf("NG.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_YELLOW ); + mprintf(" acount not transfered yet.\n"); + // mprintf(" OR, acount already cleared\n\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + miya_log_fprintf(log_fd, " acount not transfered yet.\n"); + // miya_log_fprintf(log_fd, " OR acount already cleared by user.\n"); + // 「ご利用記録の削除」をした場合、ここでエラーになる。 + // ここでＯＫにする？ + return ECDOWNLOAD_FAILURE; + // return ECDOWNLOAD_NO_REGISTER; + } + else if( status == 'R') { + /* auto_pre_install のときだけ外す？ */ + /* miya 2009/06/09 */ + goto ok_label; + + miya_log_fprintf(log_fd, "NG.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_RED ); + mprintf("NG.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_YELLOW ); + mprintf(" already registered.\n please delete acount.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + miya_log_fprintf(log_fd, " already registered. please delete acount.\n"); + return ECDOWNLOAD_FAILURE; + } + + else if( (status != 'P') && (status != 'T') ) { + m_set_palette(tc[0], M_TEXT_COLOR_RED ); + mprintf("NG.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_YELLOW ); + mprintf(" invalid registration status '%c'\n", status ); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + miya_log_fprintf(log_fd, " invalid registration status '%c'\n", status ); + return ECDOWNLOAD_FAILURE; + } + else { + ok_label: + miya_log_fprintf(log_fd, "OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_GREEN ); + mprintf("OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + } + +#if 0 /* miya 2009/06/09 */ + /*********************************/ + miya_log_fprintf(log_fd, "-get challenge1.."); + mprintf("-get challenge1 "); + if( FALSE == GetChallenge(challenge) ) { + return ECDOWNLOAD_FAILURE; + } + else { + miya_log_fprintf(log_fd, "OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_GREEN ); + mprintf("OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + } + + /*********************************/ + miya_log_fprintf(log_fd, "-transfer.. "); + mprintf("-transfer "); + if( FALSE == Transfer(challenge) ) { + return ECDOWNLOAD_FAILURE; + } + else { + miya_log_fprintf(log_fd, "OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_GREEN ); /* green */ + mprintf("OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + } +#endif + + /*********************************/ + miya_log_fprintf(log_fd, "-get challenge.. "); + mprintf("-get challenge2 "); + if( FALSE == GetChallenge(challenge) ) { + return ECDOWNLOAD_FAILURE; + } + else { + miya_log_fprintf(log_fd, "OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_GREEN ); /* green */ + mprintf("OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + } + + /*********************************/ + miya_log_fprintf(log_fd, "-sync registration.."); + mprintf("-sync registration "); + if( FALSE == SyncRegistration(challenge) ) { + return ECDOWNLOAD_FAILURE; + } + else { + miya_log_fprintf(log_fd, "OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_GREEN ); /* green */ + mprintf("OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + } + + /*********************************/ + miya_log_fprintf(log_fd, "-sync tickets.."); + mprintf("-sync tickets "); + if( FALSE == SyncTickets() ) { + return ECDOWNLOAD_FAILURE; + } + else { + miya_log_fprintf(log_fd, "OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_GREEN ); /* green */ + mprintf("OK.\n"); + m_set_palette(tc[0], M_TEXT_COLOR_WHITE ); + } + + /*********************************/ + // ここでアプリをダウンロードしている + miya_log_fprintf(log_fd, "-download titles\n"); + mprintf("-download titles\n"); + + if( FALSE == DownloadTitles_Auto(pTitleIds, numTitleIds) ) { + return ECDOWNLOAD_FAILURE; + } + + //#define ECDOWNLOAD_DUMMY 0 + //#define ECDOWNLOAD_SUCCESS 1 + //#define ECDOWNLOAD_NO_REGISTER 2 + //#define ECDOWNLOAD_FAILURE 3 + + return ECDOWNLOAD_SUCCESS; +} + + BOOL KPSClient() { s32 progress; diff --git a/build/tools/sctools/copy_dst/src/hatamotolib.h b/build/tools/sctools/copy_dst/src/hatamotolib.h index 59b0761..6a91e80 100644 --- a/build/tools/sctools/copy_dst/src/hatamotolib.h +++ b/build/tools/sctools/copy_dst/src/hatamotolib.h @@ -13,6 +13,7 @@ extern "C" { // int ECDownload(const NAMTitleId* pTitleIds, u32 numTitleIds); int ECDownload(MY_USER_APP_TID * pTitleIds, u32 numTitleIds); +int ECDownload_Auto(MY_USER_APP_TID *pTitleIds, u32 numTitleIds); BOOL KPSClient(); // BOOL WaitEC(ECOpId opId); diff --git a/build/tools/sctools/copy_dst/src/main.c b/build/tools/sctools/copy_dst/src/main.c index 17fe8fd..0a3f093 100644 --- a/build/tools/sctools/copy_dst/src/main.c +++ b/build/tools/sctools/copy_dst/src/main.c @@ -1611,6 +1611,7 @@ void TwlMain(void) Gfx_Set_BG1_line_Color(1, 2, (u16)M_TEXT_COLOR_ORANGE); + while( 1 ) { Gfx_Render( vram_num_main , vram_num_sub ); OS_WaitVBlankIntr(); @@ -1664,22 +1665,7 @@ void TwlMain(void) MydataLoadDecrypt_dir_flag = TRUE; MydataLoadDecrypt_success_flag = TRUE; -#if 1 start_my_thread( THREAD_COMMAND_WIFI_FUNCTION ); -#else - if( TRUE == RestoreFromSDCard3() ) { - if( TRUE == stream_play_is_end() ) { - stream_play1(); /* ok.aiff */ - } - Gfx_Set_BG1_Color((u16)M_TEXT_COLOR_DARKGREEN); - } - else { - if( TRUE == stream_play_is_end() ) { - stream_play2(); /* ng.aiff */ - } - Gfx_Set_BG1_Color((u16)M_TEXT_COLOR_DARKRED); - } -#endif } else if( user_and_wifi_config_data_trans_flag == TRUE ) { /* ユーザー設定と無線設定のみリストアする */ @@ -1689,22 +1675,8 @@ void TwlMain(void) MydataLoadDecrypt_message_flag = TRUE; MydataLoadDecrypt_dir_flag = TRUE; MydataLoadDecrypt_success_flag = TRUE; -#if 1 + start_my_thread( THREAD_COMMAND_USERDATA_AND_WIFI_FUNCTION ); -#else - if( (TRUE == RestoreFromSDCard4()) && (TRUE == RestoreFromSDCard3() ) ) { - if( TRUE == stream_play_is_end() ) { - stream_play1(); /* ok.aiff */ - } - Gfx_Set_BG1_Color((u16)M_TEXT_COLOR_DARKGREEN); - } - else { - if( TRUE == stream_play_is_end() ) { - stream_play2(); /* ng.aiff */ - } - Gfx_Set_BG1_Color((u16)M_TEXT_COLOR_DARKRED); - } -#endif } else { mprintf("Personal data. restore "); diff --git a/build/tools/sctools/copy_org/src/main.c b/build/tools/sctools/copy_org/src/main.c index b2ae383..026fb78 100644 --- a/build/tools/sctools/copy_org/src/main.c +++ b/build/tools/sctools/copy_org/src/main.c @@ -100,7 +100,10 @@ static LCFGTWLHWSecureInfo hws_info; #define NAM_TITLE_ID_S 128 static NAMTitleId array_eticket_only_titles[NAM_TITLE_ID_S]; +// static int array_eticket_only_titles_version[NAM_TITLE_ID_S]; static NAMTitleId array_app_titles[NAM_TITLE_ID_S]; +// static int array_app_titles_version[NAM_TITLE_ID_S]; + static int num_of_eticket_only_titles = 0; static int num_of_app_titles = 0; static int num_of_all_titles = 0; @@ -167,6 +170,7 @@ static int Check_User_Titles_ETicket_Only(void) u64 id; char game_code[5]; int common_or_personalized_flag; + // u16 version = 0; // num = NAM_GetNumTitles(); num = NAM_GetNumInstalledTitles(); @@ -216,15 +220,20 @@ static int Check_User_Titles_ETicket_Only(void) if( common_or_personalized_flag == 1 ) { OS_TPrintf(" usr.:%3d:0x%llx %s common\n", i, id, game_code); array_eticket_only_titles[user_title_count] = id; +#if 0 + if( TRUE == pre_install_get_version(id, &version) ) { + array_eticket_only_titles_version[user_title_count] = (int)version; + } + else { + array_eticket_only_titles_version[user_title_count] = -1; + } +#endif user_title_count++; } else { OS_TPrintf(" usr.:%3d:0x%llx %s personalized\n", i, id, game_code); } } - - - } } } @@ -247,6 +256,7 @@ static int Check_User_Titles(void) int user_tilte_count = 0; u64 id; char game_code[5]; + // u16 version; num = NAM_GetNumTitles(); if( num >= 0 ) { @@ -283,6 +293,14 @@ static int Check_User_Titles(void) OS_TPrintf(" usr.:%3d:0x%llx %s\n", i, id, game_code); user_tilte_count++; } +#if 0 + if( TRUE == pre_install_get_version(id, &version) ) { + array_app_titles_version[i] = (int)version; + } + else { + array_app_titles_version[i] = -1; + } +#endif } } else { @@ -545,6 +563,7 @@ static BOOL SDBackupToSDCard7(void) int j; BOOL flag = TRUE; int common_or_presonalized_flag; + u16 version; /* タイトルリストの生成 */ /* @@ -618,6 +637,20 @@ static BOOL SDBackupToSDCard7(void) } if( TRUE == pre_install_check_download_or_pre_install(ptr->tid, &common_or_presonalized_flag, NULL) ) { + + if( TRUE == pre_install_get_version(ptr->tid, &version) ) { + ptr->version = (int)version; + } + else { + ptr->version = -1; + } + OS_TPrintf(" ver.%d",ptr->version); + mfprintf(tc[2]," ver.%d",ptr->version); + if( no_sd_clean_flag == TRUE ) { + mprintf(" ver.%d",ptr->version); + } + + ptr->is_personalized = common_or_presonalized_flag; if( ptr->is_personalized == 1 ) { OS_TPrintf(" common"); diff --git a/build/tools/sctools/cryptopc/Makefile b/build/tools/sctools/cryptopc/Makefile new file mode 100644 index 0000000..0bd45ed --- /dev/null +++ b/build/tools/sctools/cryptopc/Makefile @@ -0,0 +1,46 @@ +PACKAGE = cryptopc + +OPENSSL_DIR = c:/OpenSSL/openssl-1.0.0-beta2 + +# SRCS = main.c +SRCS = m.c + +HEADS = my_sign.h + +OBJS = $(SRCS:.c=.o) + +CC := C:/Cygwin/bin/gcc + + +CFLAGS = -mno-cygwin -Wall + +# openssl-1.0.0-beta2 + +CPPFLAGS= -I. -I$(OPENSSL_DIR)/include -I$(OPENSSL_DIR)/crypto/ec + +LD = C:/Cygwin/bin/gcc +LDFLAGS = -Wl,--subsystem,console -mwindows -mno-cygwin -L$(OPENSSL_DIR) +LDLIBS = -lcrypto -lssl + + +.SUFFIXES: +.SUFFIXES: .o .c + +all: $(PACKAGE) + +# install: $(PACKAGE) +# install -c -m 777 $(PACKAGE) ../bin + +$(PACKAGE): $(OBJS) + $(LD) $(LDFLAGS) $(OBJS) -o $@ $(LDLIBS) + +$(OBJS): $(HEADS) Makefile + +.c.o: + $(CC) $(CFLAGS) $(CPPFLAGS) -c $< -o $@ + + +.PHONY: clean clobber +clean clobber: + $(RM) $(OBJS) $(PACKAGE).exe + diff --git a/build/tools/sctools/cryptopc/main.c b/build/tools/sctools/cryptopc/main.c new file mode 100644 index 0000000..80a333e --- /dev/null +++ b/build/tools/sctools/cryptopc/main.c @@ -0,0 +1,455 @@ +/* cryptopc *.der infile outfile + cryptopc miya1024.der main.c main.enc +*/ + +#include +#include +#include +#include +#include +#include +#include + +#include + +#include +#include +#include +#include + +typedef signed char s8; +typedef unsigned char u8; +typedef unsigned short u16; +typedef unsigned long u32; +typedef unsigned long long u64; + + +#include "my_sign.h" +/* + データのハッシュの単位は３２ＫＢ + + ・ヘッダー + ・ヘッダーの署名（ハッシュは３２バイトだがRSAが１２８バイトなんで１２８バイト） + ・ + + オリジナルのファイルサイズ / 32KB -> ハッシュの数。 + num_of_block = org_file_size / 32KB; + if( org_file_size % 32KB ) { + num_of_block += 1 + } + + L2ハッシュサイズ * num_of_block -> L2ハッシュブロックサイズ + L2_hash_block_size = 32B * num_of_block; + + +*/ + + +/* + flen must be less than RSA_size(rsa) - 11 for the PKCS #1 v1.5 based + padding modes, and less than RSA_size(rsa) - 41 for + RSA_PKCS1_OAEP_PADDING. The random number generator must be seeded + prior to calling RSA_public_encrypt(). + */ + + +/* + FILE format: + ----- + MY_SIGN_HEADER header; + MY_SIGN_SIGNATURE header_sign; + L2_sign[0]; + L2_sign[1]; + L2_sign[2]; + L2_sign[ ]; + . + . + enc_data_block[0](32KB) + enc_data_block[1](32KB) + enc_data_block[2](32KB) + . + . + */ + +static FILE *fp_key = NULL; +static int rsaSize; + +static int my_sign_make(MY_SIGN_SIGNATURE *encrypted_sign, u8 *buf, int buf_size) +{ + MY_SIGN_SIGNATURE temp_sign; + int outlen = 0; + RSA *rsa_key; + // int i; + + if( 0 != fseek(fp_key, 0 , SEEK_SET) ) { + fprintf(stderr,"fseek error %s %d\n",__FUNCTION__,__LINE__); + return -1; + } + + rsa_key = RSA_new(); + + if( rsa_key == NULL ) { + fprintf(stdout,"Error:RSA_new(key alloc) NULL!\n"); + return -1; + } + d2i_RSAPrivateKey_fp(fp_key, &rsa_key); + // d2i_RSAPublicKey_fp(fp_key, &key); + + if( rsa_key != NULL ) { + // RSA_print_fp(stdout, key, 0); + rsaSize = RSA_size( rsa_key ); + // printf("rsaSize = %d bit\n",rsaSize * 8); + } + else { + fprintf(stderr, "Error:d2i_RSAPrivateKey_fp(read key) NULL!\n"); + return -1; + } + + + memset((u8 *)&temp_sign, 0 , sizeof(MY_SIGN_SIGNATURE)); + memset((u8 *)encrypted_sign, 0 , sizeof(MY_SIGN_SIGNATURE)); + + // printf( "%s buf_size = %d\n",__FUNCTION__, buf_size); + SHA256(buf, buf_size, temp_sign.hash); +#if 0 + for( i = 0 ; i < 32 ; i++ ) { + printf("hash[0x%02x]=0x%02x\n",i,temp_sign.hash[i]); + } +#endif + temp_sign.pad[0] = 1; + temp_sign.pad[1] = 1; + temp_sign.pad[2] = 1; + temp_sign.pad[3] = 1; + + //RSA_PKCS1_OAEP_PADDING + //RSA_NO_PADDING +#if 0 +#define RSA_PKCS1_PADDING 1 +#define RSA_SSLV23_PADDING 2 +#define RSA_NO_PADDING 3 +#define RSA_PKCS1_OAEP_PADDING 4 +#define RSA_X931_PADDING 5 + +#define RSA_PKCS1_PADDING_SIZE 11 +#endif + +#if 1 + if(rsaSize != (outlen = RSA_public_encrypt(rsaSize - RSA_PKCS1_PADDING_SIZE, + (u8 *)&temp_sign, (u8 *)encrypted_sign, + rsa_key, RSA_PKCS1_PADDING ))) { + + fprintf(stderr,"encrypt error rsaSize=%d outlen=%d\n",rsaSize, outlen); + return -1; + } +#else + if(rsaSize != (outlen = RSA_public_encrypt(rsaSize, (u8 *)&temp_sign, (u8 *)encrypted_sign, + rsa_key, RSA_NO_PADDING ))) { + fprintf(stderr,"encrypt error rsaSize=%d outlen=%d\n",rsaSize, outlen); + return -1; + } +#endif + RSA_free(rsa_key); + + return 0; +} + + +int main(int ac, char *argv[]) +{ + FILE *fp_in = NULL; + FILE *fp_out = NULL; + + struct stat st_buf; + int readlen; + int outlen = 0; + int rsa_error_flag = 0; + int i; + MY_SIGN_HEADER header; + MY_SIGN_SIGNATURE header_sign; + MY_SIGN_SIGNATURE *L2_sign_table; + MY_SIGN_SIGNATURE *L2_sign_table_temp; + int L2_sign_table_size; + int block_no; + u8 block_buf_in[MY_SIGN_BLOCK_SIZE]; + u8 block_buf_out[MY_SIGN_BLOCK_SIZE]; + + + u8 aes_key_buf[AES_KEY_BYTE_LEN]; + AES_KEY aes_key; + unsigned char aes_iv[ AES_BLOCK_SIZE ]; + + + printf("hash offset = %d\n",offsetof(MY_SIGN_SIGNATURE, hash)); + + ERR_load_crypto_strings(); + + if( ac == 4 ) { + if( 0 != stat( argv[2], &st_buf) ) { + fprintf(stderr, "failed to stat %s\n",argv[2]); + goto end; + } + + if( (fp_key = fopen( argv[1], "rb" )) == NULL ) { + fprintf(stderr, "failed to fopen %s\n",argv[1]); + goto end; + } + else { +#if 0 + rsa_key = RSA_new(); + + if( rsa_key == NULL ) { + fprintf(stdout,"Error:RSA_new(key alloc) NULL!\n"); + } + d2i_RSAPrivateKey_fp(fp_key, &rsa_key); + // d2i_RSAPublicKey_fp(fp_key, &key); + + if( rsa_key != NULL ) { + // RSA_print_fp(stdout, key, 0); + rsaSize = RSA_size( rsa_key ); + printf("rsaSize = %d bit\n",rsaSize * 8); + } + else { + fprintf(stderr, "Error:d2i_RSAPrivateKey_fp(read key) NULL!\n"); + goto end; + } +#endif + } + + if( (fp_in = fopen( argv[2], "rb" )) == NULL ) { + fprintf(stderr, "Error:failed to fopen input file(%s)\n",argv[2]); + goto end; + } + + if( (fp_out = fopen( argv[3], "wb+" )) == NULL ) { + fprintf(stderr, "failed to fopen output file(%s)\n",argv[3]); + goto end; + } + + /* + FILE format: + ----- + MY_SIGN_HEADER header; + MY_SIGN_SIGNATURE header_sign; + L2_sign_table[0]; + L2_sign_table[1]; + L2_sign_table[2]; + L2_sign_table[ ]; + . + . + aes_enc_data_block[0](32KB) + aes_enc_data_block[1](32KB) + aes_enc_data_block[2](32KB) + . + . + . + . + + + #define RSA_SIZE 128 + #define HASH_SIZE 0x20 + #define BLOCK_SIZE (32*1024) + + typedef struct { + u8 hash[HASH_SIZE]; + u8 dummy[RSA_SIZE - HASH_SIZE]; + } SIGNATURE; + + typedef struct { + u32 magic_code; + u32 org_file_size; + u32 num_of_block; + u32 file_offset_L2_sign_table; + u32 file_offset_data_block; + SIGNATURE L2_sign; + } HEADER; + + */ + + memset(&header, 0 , sizeof(MY_SIGN_HEADER)); + header.magic_code = 0xdeadbeef; + header.org_file_size = st_buf.st_size; + header.num_of_block = st_buf.st_size / MY_SIGN_BLOCK_SIZE; + if( st_buf.st_size % MY_SIGN_BLOCK_SIZE ) { + header.num_of_block += 1; + } + + header.file_offset_L2_sign_table = sizeof(MY_SIGN_HEADER) + sizeof(MY_SIGN_SIGNATURE); + + L2_sign_table_size = sizeof(MY_SIGN_SIGNATURE) * header.num_of_block; + + header.file_offset_data_block = header.file_offset_L2_sign_table + L2_sign_table_size; + + + printf("header.org_file_size = %d\n",(int)header.org_file_size); + printf("header.num_of_block = %d\n",(int)header.num_of_block); + + + L2_sign_table = (MY_SIGN_SIGNATURE *)malloc( L2_sign_table_size ); + if( L2_sign_table == NULL ) { + fprintf(stderr,"L2_sign_table malloc error %s %d\n",__FUNCTION__,__LINE__); + goto end; + } + memset(L2_sign_table, 0 , L2_sign_table_size ); + L2_sign_table_temp = L2_sign_table; + + +#if 1 + if( 0 != fseek(fp_out, header.file_offset_data_block , SEEK_SET) ) { + fprintf(stderr,"fseek error %s %d\n",__FUNCTION__,__LINE__); + goto end; + } +#else + if( sizeof(MY_SIGN_HEADER) != (outlen = fwrite( &header, 1, sizeof(MY_SIGN_HEADER), fp_out)) ) { + fprintf(stderr, "Error:fwrite line=%d outlen=%d\n", __LINE__,outlen); + rsa_error_flag = 1; + goto end; + } + + + /* ヘッダーの署名を出力ファイルに書き込み */ + + if( sizeof(MY_SIGN_SIGNATURE) != (outlen = fwrite( &header_sign, 1, sizeof(MY_SIGN_SIGNATURE), fp_out)) ) { + fprintf(stderr, "Error:fwrite line=%d outlen=%d\n", __LINE__,outlen); + rsa_error_flag = 1; + goto end; + } + + /* L2_signテーブルを出力ファイルに書き込み */ + +#endif + + + block_no = 0; + + while( (readlen = fread(block_buf_in, 1, MY_SIGN_BLOCK_SIZE, fp_in)) > 0 ) { + + if( readlen < MY_SIGN_BLOCK_SIZE ) { + for( i = readlen ; i < MY_SIGN_BLOCK_SIZE ; i++ ) { + block_buf_in[i] = 0; /* padding.. */ + } + } + + + /* AESキーのセット */ + for( i = 0 ; i < AES_KEY_BYTE_LEN ; i++ ) { + aes_key_buf[i] = (u8)i; + } + AES_set_encrypt_key(aes_key_buf, AES_KEY_BIT_LEN, &aes_key); + for( i = 0 ; i < AES_BLOCK_SIZE ; i++ ) { + aes_iv[i] = (u8)i; + } + + memset(block_buf_out, 0 , MY_SIGN_BLOCK_SIZE); + for( i = 0 ; i < (MY_SIGN_BLOCK_SIZE / AES_BLOCK_SIZE) ; i++ ) { + // AES_encrypt( &(block_buf_in[AES_BLOCK_SIZE*i]), &(block_buf_out[AES_BLOCK_SIZE*i]),&aes_key); + AES_cbc_encrypt( &(block_buf_in[AES_BLOCK_SIZE*i]), &(block_buf_out[AES_BLOCK_SIZE*i]), + AES_BLOCK_SIZE, &aes_key, aes_iv, AES_ENCRYPT ); + + } + + if( MY_SIGN_BLOCK_SIZE != (outlen = fwrite( block_buf_out, 1, MY_SIGN_BLOCK_SIZE, fp_out)) ) { + fprintf(stderr,"Error:fwrite line=%d outlen=%d\n", __LINE__,outlen); + fprintf(stderr,"%s\n", ERR_error_string(ERR_get_error(), NULL)); + rsa_error_flag = 1; + goto end; + } + + /* データブロックの署名計算 */ + if( 0 != my_sign_make( L2_sign_table_temp , block_buf_out, MY_SIGN_BLOCK_SIZE ) ) { + fprintf(stderr,"make Data Block signature error line=%d\n",__LINE__); + rsa_error_flag = 1; + goto end; + } + + + + L2_sign_table_temp++; + block_no++; + } + + printf("last block no = %d\n",block_no); + + + /* L2signテーブルの署名計算 */ + if( 0 != my_sign_make(&header.L2_sign, (u8 *)L2_sign_table, L2_sign_table_size ) ) { + fprintf(stderr,"make L2_sign signature error line=%d\n",__LINE__); + rsa_error_flag = 1; + goto end; + } + + + /* ヘッダーの署名計算 */ + if( 0 != my_sign_make(&header_sign, (u8 *)&header, sizeof(MY_SIGN_HEADER)) ) { + fprintf(stderr,"make signature error line=%d\n",__LINE__); + rsa_error_flag = 1; + goto end; + } + + + + + /* ヘッダーを出力ファイルに書き込み */ + if( 0 != fseek(fp_out, 0 , SEEK_SET) ) { + fprintf(stderr,"fseek error %s %d\n",__FUNCTION__,__LINE__); + goto end; + } + + if( sizeof(MY_SIGN_HEADER) != (outlen = fwrite( &header, 1, sizeof(MY_SIGN_HEADER), fp_out)) ) { + fprintf(stderr, "Error:fwrite line=%d outlen=%d\n", __LINE__,outlen); + rsa_error_flag = 1; + goto end; + } + + + /* ヘッダーの署名を出力ファイルに書き込み */ + + if( sizeof(MY_SIGN_SIGNATURE) != (outlen = fwrite( &header_sign, 1, sizeof(MY_SIGN_SIGNATURE), fp_out)) ) { + fprintf(stderr, "Error:fwrite line=%d outlen=%d\n", __LINE__,outlen); + rsa_error_flag = 1; + goto end; + } + + /* L2_signテーブルを出力ファイルに書き込み */ + if( L2_sign_table_size != (outlen = fwrite( (u8 *)L2_sign_table, 1, L2_sign_table_size, fp_out)) ) { + fprintf(stderr, "Error:fwrite line=%d outlen=%d\n", __LINE__,outlen); + rsa_error_flag = 1; + goto end; + } + + + if( rsa_error_flag == 1 ) { + printf("Error: %s %s %d\n",__FILE__,__FUNCTION__,__LINE__); + } + + end: + + if( L2_sign_table != NULL ) { + free( L2_sign_table ); + } + + if( fp_in ) { + fclose(fp_in); + } + + if( fp_out ) { + fclose(fp_out); + } + + if( fp_key ) { + fclose(fp_key); + } + + if( rsa_error_flag == 0 ) { + printf("success\n"); + } + + // fprintf(stderr,"Invalid argument!\n"); + // fprintf(stderr,"Usage: %s\n", argv[0]); + // fprintf(stderr,"Usage: %s SerialNo.(32bit) filename.dat\n", argv[0]); + + } + return 0; +} + + + diff --git a/build/tools/sctools/make_tad_table/make_tad_table.c b/build/tools/sctools/make_tad_table/make_tad_table.c index 35b70fc..370b804 100644 --- a/build/tools/sctools/make_tad_table/make_tad_table.c +++ b/build/tools/sctools/make_tad_table/make_tad_table.c @@ -1,12 +1,6 @@ /* - gcc -mwindows -Wl,--subsystem,console -mno-cygwin -o titleidchecker titleidchecker.c - - titleidchecker TWL-HNGJ-v256.tad.out - titleidchecker nandAppSample.tad - - - Makefile.TadIncludesも作る。 - + [ROM用] make_tad_table.exe -dir . -o table_file.txt -var MAKEROM_TAD_ROMFILES -fdir tads -mk Makefile.inc + [SD用] make_tad_table.exe -dir . -o table_file.txt -fdir tads_sd */ #include diff --git a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.a b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.a index c81bc1f..1172117 100644 Binary files a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.a and b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.a differ diff --git a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.thumb.a b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.thumb.a index 19463d7..43e0aaa 100644 Binary files a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.thumb.a and b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnhttp.nssl.TWL.LTD.thumb.a differ diff --git a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.a b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.a index d5412a9..fec4ab4 100644 Binary files a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.a and b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.a differ diff --git a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.thumb.a b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.thumb.a index 6cbeaee..9d34747 100644 Binary files a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.thumb.a and b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnssl.TWL.LTD.thumb.a differ diff --git a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.a b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.a index 4ae07fb..4f14147 100644 Binary files a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.a and b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.a differ diff --git a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.thumb.a b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.thumb.a index a5cbf68..548e41f 100644 Binary files a/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.thumb.a and b/build/tools/sctools/wifilib/ARM9-TS.LTD/Release/libnuc.TWL.LTD.thumb.a differ