mirror of
https://github.com/pineappleEA/pineapple-src.git
synced 2024-12-11 09:38:25 -05:00
264 lines
9.6 KiB
C
Executable File
264 lines
9.6 KiB
C
Executable File
/* $OpenBSD: sm4.c,v 1.1 2019/03/17 17:42:37 tb Exp $ */
|
|
/*
|
|
* Copyright (c) 2017, 2019 Ribose Inc
|
|
*
|
|
* Permission to use, copy, modify, and/or distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
*/
|
|
|
|
#include <openssl/opensslconf.h>
|
|
|
|
#ifndef OPENSSL_NO_SM4
|
|
#include <openssl/sm4.h>
|
|
|
|
struct sm4_key {
|
|
uint32_t rk[SM4_KEY_SCHEDULE];
|
|
};
|
|
|
|
static const uint8_t SM4_S[256] = {
|
|
0xD6, 0x90, 0xE9, 0xFE, 0xCC, 0xE1, 0x3D, 0xB7, 0x16, 0xB6, 0x14, 0xC2,
|
|
0x28, 0xFB, 0x2C, 0x05, 0x2B, 0x67, 0x9A, 0x76, 0x2A, 0xBE, 0x04, 0xC3,
|
|
0xAA, 0x44, 0x13, 0x26, 0x49, 0x86, 0x06, 0x99, 0x9C, 0x42, 0x50, 0xF4,
|
|
0x91, 0xEF, 0x98, 0x7A, 0x33, 0x54, 0x0B, 0x43, 0xED, 0xCF, 0xAC, 0x62,
|
|
0xE4, 0xB3, 0x1C, 0xA9, 0xC9, 0x08, 0xE8, 0x95, 0x80, 0xDF, 0x94, 0xFA,
|
|
0x75, 0x8F, 0x3F, 0xA6, 0x47, 0x07, 0xA7, 0xFC, 0xF3, 0x73, 0x17, 0xBA,
|
|
0x83, 0x59, 0x3C, 0x19, 0xE6, 0x85, 0x4F, 0xA8, 0x68, 0x6B, 0x81, 0xB2,
|
|
0x71, 0x64, 0xDA, 0x8B, 0xF8, 0xEB, 0x0F, 0x4B, 0x70, 0x56, 0x9D, 0x35,
|
|
0x1E, 0x24, 0x0E, 0x5E, 0x63, 0x58, 0xD1, 0xA2, 0x25, 0x22, 0x7C, 0x3B,
|
|
0x01, 0x21, 0x78, 0x87, 0xD4, 0x00, 0x46, 0x57, 0x9F, 0xD3, 0x27, 0x52,
|
|
0x4C, 0x36, 0x02, 0xE7, 0xA0, 0xC4, 0xC8, 0x9E, 0xEA, 0xBF, 0x8A, 0xD2,
|
|
0x40, 0xC7, 0x38, 0xB5, 0xA3, 0xF7, 0xF2, 0xCE, 0xF9, 0x61, 0x15, 0xA1,
|
|
0xE0, 0xAE, 0x5D, 0xA4, 0x9B, 0x34, 0x1A, 0x55, 0xAD, 0x93, 0x32, 0x30,
|
|
0xF5, 0x8C, 0xB1, 0xE3, 0x1D, 0xF6, 0xE2, 0x2E, 0x82, 0x66, 0xCA, 0x60,
|
|
0xC0, 0x29, 0x23, 0xAB, 0x0D, 0x53, 0x4E, 0x6F, 0xD5, 0xDB, 0x37, 0x45,
|
|
0xDE, 0xFD, 0x8E, 0x2F, 0x03, 0xFF, 0x6A, 0x72, 0x6D, 0x6C, 0x5B, 0x51,
|
|
0x8D, 0x1B, 0xAF, 0x92, 0xBB, 0xDD, 0xBC, 0x7F, 0x11, 0xD9, 0x5C, 0x41,
|
|
0x1F, 0x10, 0x5A, 0xD8, 0x0A, 0xC1, 0x31, 0x88, 0xA5, 0xCD, 0x7B, 0xBD,
|
|
0x2D, 0x74, 0xD0, 0x12, 0xB8, 0xE5, 0xB4, 0xB0, 0x89, 0x69, 0x97, 0x4A,
|
|
0x0C, 0x96, 0x77, 0x7E, 0x65, 0xB9, 0xF1, 0x09, 0xC5, 0x6E, 0xC6, 0x84,
|
|
0x18, 0xF0, 0x7D, 0xEC, 0x3A, 0xDC, 0x4D, 0x20, 0x79, 0xEE, 0x5F, 0x3E,
|
|
0xD7, 0xCB, 0x39, 0x48,
|
|
};
|
|
|
|
/*
|
|
* SM4_SBOX_T[j] == L(SM4_SBOX[j]).
|
|
*/
|
|
static const uint32_t SM4_SBOX_T[256] = {
|
|
0x8ED55B5B, 0xD0924242, 0x4DEAA7A7, 0x06FDFBFB, 0xFCCF3333, 0x65E28787,
|
|
0xC93DF4F4, 0x6BB5DEDE, 0x4E165858, 0x6EB4DADA, 0x44145050, 0xCAC10B0B,
|
|
0x8828A0A0, 0x17F8EFEF, 0x9C2CB0B0, 0x11051414, 0x872BACAC, 0xFB669D9D,
|
|
0xF2986A6A, 0xAE77D9D9, 0x822AA8A8, 0x46BCFAFA, 0x14041010, 0xCFC00F0F,
|
|
0x02A8AAAA, 0x54451111, 0x5F134C4C, 0xBE269898, 0x6D482525, 0x9E841A1A,
|
|
0x1E061818, 0xFD9B6666, 0xEC9E7272, 0x4A430909, 0x10514141, 0x24F7D3D3,
|
|
0xD5934646, 0x53ECBFBF, 0xF89A6262, 0x927BE9E9, 0xFF33CCCC, 0x04555151,
|
|
0x270B2C2C, 0x4F420D0D, 0x59EEB7B7, 0xF3CC3F3F, 0x1CAEB2B2, 0xEA638989,
|
|
0x74E79393, 0x7FB1CECE, 0x6C1C7070, 0x0DABA6A6, 0xEDCA2727, 0x28082020,
|
|
0x48EBA3A3, 0xC1975656, 0x80820202, 0xA3DC7F7F, 0xC4965252, 0x12F9EBEB,
|
|
0xA174D5D5, 0xB38D3E3E, 0xC33FFCFC, 0x3EA49A9A, 0x5B461D1D, 0x1B071C1C,
|
|
0x3BA59E9E, 0x0CFFF3F3, 0x3FF0CFCF, 0xBF72CDCD, 0x4B175C5C, 0x52B8EAEA,
|
|
0x8F810E0E, 0x3D586565, 0xCC3CF0F0, 0x7D196464, 0x7EE59B9B, 0x91871616,
|
|
0x734E3D3D, 0x08AAA2A2, 0xC869A1A1, 0xC76AADAD, 0x85830606, 0x7AB0CACA,
|
|
0xB570C5C5, 0xF4659191, 0xB2D96B6B, 0xA7892E2E, 0x18FBE3E3, 0x47E8AFAF,
|
|
0x330F3C3C, 0x674A2D2D, 0xB071C1C1, 0x0E575959, 0xE99F7676, 0xE135D4D4,
|
|
0x661E7878, 0xB4249090, 0x360E3838, 0x265F7979, 0xEF628D8D, 0x38596161,
|
|
0x95D24747, 0x2AA08A8A, 0xB1259494, 0xAA228888, 0x8C7DF1F1, 0xD73BECEC,
|
|
0x05010404, 0xA5218484, 0x9879E1E1, 0x9B851E1E, 0x84D75353, 0x00000000,
|
|
0x5E471919, 0x0B565D5D, 0xE39D7E7E, 0x9FD04F4F, 0xBB279C9C, 0x1A534949,
|
|
0x7C4D3131, 0xEE36D8D8, 0x0A020808, 0x7BE49F9F, 0x20A28282, 0xD4C71313,
|
|
0xE8CB2323, 0xE69C7A7A, 0x42E9ABAB, 0x43BDFEFE, 0xA2882A2A, 0x9AD14B4B,
|
|
0x40410101, 0xDBC41F1F, 0xD838E0E0, 0x61B7D6D6, 0x2FA18E8E, 0x2BF4DFDF,
|
|
0x3AF1CBCB, 0xF6CD3B3B, 0x1DFAE7E7, 0xE5608585, 0x41155454, 0x25A38686,
|
|
0x60E38383, 0x16ACBABA, 0x295C7575, 0x34A69292, 0xF7996E6E, 0xE434D0D0,
|
|
0x721A6868, 0x01545555, 0x19AFB6B6, 0xDF914E4E, 0xFA32C8C8, 0xF030C0C0,
|
|
0x21F6D7D7, 0xBC8E3232, 0x75B3C6C6, 0x6FE08F8F, 0x691D7474, 0x2EF5DBDB,
|
|
0x6AE18B8B, 0x962EB8B8, 0x8A800A0A, 0xFE679999, 0xE2C92B2B, 0xE0618181,
|
|
0xC0C30303, 0x8D29A4A4, 0xAF238C8C, 0x07A9AEAE, 0x390D3434, 0x1F524D4D,
|
|
0x764F3939, 0xD36EBDBD, 0x81D65757, 0xB7D86F6F, 0xEB37DCDC, 0x51441515,
|
|
0xA6DD7B7B, 0x09FEF7F7, 0xB68C3A3A, 0x932FBCBC, 0x0F030C0C, 0x03FCFFFF,
|
|
0xC26BA9A9, 0xBA73C9C9, 0xD96CB5B5, 0xDC6DB1B1, 0x375A6D6D, 0x15504545,
|
|
0xB98F3636, 0x771B6C6C, 0x13ADBEBE, 0xDA904A4A, 0x57B9EEEE, 0xA9DE7777,
|
|
0x4CBEF2F2, 0x837EFDFD, 0x55114444, 0xBDDA6767, 0x2C5D7171, 0x45400505,
|
|
0x631F7C7C, 0x50104040, 0x325B6969, 0xB8DB6363, 0x220A2828, 0xC5C20707,
|
|
0xF531C4C4, 0xA88A2222, 0x31A79696, 0xF9CE3737, 0x977AEDED, 0x49BFF6F6,
|
|
0x992DB4B4, 0xA475D1D1, 0x90D34343, 0x5A124848, 0x58BAE2E2, 0x71E69797,
|
|
0x64B6D2D2, 0x70B2C2C2, 0xAD8B2626, 0xCD68A5A5, 0xCB955E5E, 0x624B2929,
|
|
0x3C0C3030, 0xCE945A5A, 0xAB76DDDD, 0x867FF9F9, 0xF1649595, 0x5DBBE6E6,
|
|
0x35F2C7C7, 0x2D092424, 0xD1C61717, 0xD66FB9B9, 0xDEC51B1B, 0x94861212,
|
|
0x78186060, 0x30F3C3C3, 0x897CF5F5, 0x5CEFB3B3, 0xD23AE8E8, 0xACDF7373,
|
|
0x794C3535, 0xA0208080, 0x9D78E5E5, 0x56EDBBBB, 0x235E7D7D, 0xC63EF8F8,
|
|
0x8BD45F5F, 0xE7C82F2F, 0xDD39E4E4, 0x68492121,
|
|
};
|
|
|
|
static inline uint32_t
|
|
rotl(uint32_t a, uint8_t n)
|
|
{
|
|
return (a << n) | (a >> (32 - n));
|
|
}
|
|
|
|
static inline uint32_t
|
|
load_u32_be(const uint8_t *b, uint32_t n)
|
|
{
|
|
return ((uint32_t)b[4 * n] << 24) |
|
|
((uint32_t)b[4 * n + 1] << 16) |
|
|
((uint32_t)b[4 * n + 2] << 8) |
|
|
((uint32_t)b[4 * n + 3]);
|
|
}
|
|
|
|
static inline void
|
|
store_u32_be(uint32_t v, uint8_t *b)
|
|
{
|
|
b[0] = (uint8_t)(v >> 24);
|
|
b[1] = (uint8_t)(v >> 16);
|
|
b[2] = (uint8_t)(v >> 8);
|
|
b[3] = (uint8_t)(v);
|
|
}
|
|
|
|
static inline uint32_t
|
|
SM4_T_slow(uint32_t X)
|
|
{
|
|
uint32_t t = 0;
|
|
|
|
t |= ((uint32_t)SM4_S[(uint8_t)(X >> 24)]) << 24;
|
|
t |= ((uint32_t)SM4_S[(uint8_t)(X >> 16)]) << 16;
|
|
t |= ((uint32_t)SM4_S[(uint8_t)(X >> 8)]) << 8;
|
|
t |= SM4_S[(uint8_t)X];
|
|
|
|
/*
|
|
* L linear transform
|
|
*/
|
|
return t ^ rotl(t, 2) ^ rotl(t, 10) ^ rotl(t, 18) ^ rotl(t, 24);
|
|
}
|
|
|
|
static inline uint32_t
|
|
SM4_T(uint32_t X)
|
|
{
|
|
return SM4_SBOX_T[(uint8_t)(X >> 24)] ^
|
|
rotl(SM4_SBOX_T[(uint8_t)(X >> 16)], 24) ^
|
|
rotl(SM4_SBOX_T[(uint8_t)(X >> 8)], 16) ^
|
|
rotl(SM4_SBOX_T[(uint8_t)X], 8);
|
|
}
|
|
|
|
int
|
|
SM4_set_key(const uint8_t *key, SM4_KEY *k)
|
|
{
|
|
struct sm4_key *ks = (struct sm4_key *)k;
|
|
|
|
/*
|
|
* Family Key
|
|
*/
|
|
static const uint32_t FK[4] = {
|
|
0xa3b1bac6, 0x56aa3350, 0x677d9197, 0xb27022dc,
|
|
};
|
|
|
|
/*
|
|
* Constant Key
|
|
*/
|
|
static const uint32_t CK[32] = {
|
|
0x00070E15, 0x1C232A31, 0x383F464D, 0x545B6269,
|
|
0x70777E85, 0x8C939AA1, 0xA8AFB6BD, 0xC4CBD2D9,
|
|
0xE0E7EEF5, 0xFC030A11, 0x181F262D, 0x343B4249,
|
|
0x50575E65, 0x6C737A81, 0x888F969D, 0xA4ABB2B9,
|
|
0xC0C7CED5, 0xDCE3EAF1, 0xF8FF060D, 0x141B2229,
|
|
0x30373E45, 0x4C535A61, 0x686F767D, 0x848B9299,
|
|
0xA0A7AEB5, 0xBCC3CAD1, 0xD8DFE6ED, 0xF4FB0209,
|
|
0x10171E25, 0x2C333A41, 0x484F565D, 0x646B7279,
|
|
};
|
|
|
|
uint32_t K[4];
|
|
int i;
|
|
|
|
K[0] = load_u32_be(key, 0) ^ FK[0];
|
|
K[1] = load_u32_be(key, 1) ^ FK[1];
|
|
K[2] = load_u32_be(key, 2) ^ FK[2];
|
|
K[3] = load_u32_be(key, 3) ^ FK[3];
|
|
|
|
for (i = 0; i < SM4_KEY_SCHEDULE; i++) {
|
|
uint32_t X;
|
|
uint32_t t = 0;
|
|
|
|
X = K[(i + 1) % 4] ^ K[(i + 2) % 4] ^ K[(i + 3) % 4] ^ CK[i];
|
|
|
|
t |= ((uint32_t)SM4_S[(uint8_t)(X >> 24)]) << 24;
|
|
t |= ((uint32_t)SM4_S[(uint8_t)(X >> 16)]) << 16;
|
|
t |= ((uint32_t)SM4_S[(uint8_t)(X >> 8)]) << 8;
|
|
t |= SM4_S[(uint8_t)X];
|
|
|
|
t = t ^ rotl(t, 13) ^ rotl(t, 23);
|
|
K[i % 4] ^= t;
|
|
ks->rk[i] = K[i % 4];
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
|
|
#define SM4_ROUNDS(k0, k1, k2, k3, F) \
|
|
do { \
|
|
B0 ^= F(B1 ^ B2 ^ B3 ^ ks->rk[k0]); \
|
|
B1 ^= F(B0 ^ B2 ^ B3 ^ ks->rk[k1]); \
|
|
B2 ^= F(B0 ^ B1 ^ B3 ^ ks->rk[k2]); \
|
|
B3 ^= F(B0 ^ B1 ^ B2 ^ ks->rk[k3]); \
|
|
} while(0)
|
|
|
|
void
|
|
SM4_encrypt(const uint8_t *in, uint8_t *out, const SM4_KEY *k)
|
|
{
|
|
struct sm4_key *ks = (struct sm4_key *)k;
|
|
uint32_t B0 = load_u32_be(in, 0);
|
|
uint32_t B1 = load_u32_be(in, 1);
|
|
uint32_t B2 = load_u32_be(in, 2);
|
|
uint32_t B3 = load_u32_be(in, 3);
|
|
|
|
/*
|
|
* Uses byte-wise sbox in the first and last rounds to provide some
|
|
* protection from cache based side channels.
|
|
*/
|
|
SM4_ROUNDS( 0, 1, 2, 3, SM4_T_slow);
|
|
SM4_ROUNDS( 4, 5, 6, 7, SM4_T);
|
|
SM4_ROUNDS( 8, 9, 10, 11, SM4_T);
|
|
SM4_ROUNDS(12, 13, 14, 15, SM4_T);
|
|
SM4_ROUNDS(16, 17, 18, 19, SM4_T);
|
|
SM4_ROUNDS(20, 21, 22, 23, SM4_T);
|
|
SM4_ROUNDS(24, 25, 26, 27, SM4_T);
|
|
SM4_ROUNDS(28, 29, 30, 31, SM4_T_slow);
|
|
|
|
store_u32_be(B3, out);
|
|
store_u32_be(B2, out + 4);
|
|
store_u32_be(B1, out + 8);
|
|
store_u32_be(B0, out + 12);
|
|
}
|
|
|
|
void
|
|
SM4_decrypt(const uint8_t *in, uint8_t *out, const SM4_KEY *k)
|
|
{
|
|
struct sm4_key *ks = (struct sm4_key *)k;
|
|
uint32_t B0 = load_u32_be(in, 0);
|
|
uint32_t B1 = load_u32_be(in, 1);
|
|
uint32_t B2 = load_u32_be(in, 2);
|
|
uint32_t B3 = load_u32_be(in, 3);
|
|
|
|
SM4_ROUNDS(31, 30, 29, 28, SM4_T_slow);
|
|
SM4_ROUNDS(27, 26, 25, 24, SM4_T);
|
|
SM4_ROUNDS(23, 22, 21, 20, SM4_T);
|
|
SM4_ROUNDS(19, 18, 17, 16, SM4_T);
|
|
SM4_ROUNDS(15, 14, 13, 12, SM4_T);
|
|
SM4_ROUNDS(11, 10, 9, 8, SM4_T);
|
|
SM4_ROUNDS( 7, 6, 5, 4, SM4_T);
|
|
SM4_ROUNDS( 3, 2, 1, 0, SM4_T_slow);
|
|
|
|
store_u32_be(B3, out);
|
|
store_u32_be(B2, out + 4);
|
|
store_u32_be(B1, out + 8);
|
|
store_u32_be(B0, out + 12);
|
|
}
|
|
|
|
#endif /* OPENSSL_NO_SM4 */
|