mirror of
https://github.com/guanzhi/GmSSL.git
synced 2026-08-14 10:03:43 +08:00
Update ZUC algorithm with EVP module
128-EEA3, 128-EIA3, byte-order and tests need to be updated.
This commit is contained in:
Zhi Guan
@@ -1,5 +1,5 @@
|
||||
/* ====================================================================
|
||||
* Copyright (c) 2015 - 2016 The GmSSL Project. All rights reserved.
|
||||
* Copyright (c) 2015 - 2018 The GmSSL Project. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
@@ -47,19 +47,16 @@
|
||||
* ====================================================================
|
||||
*/
|
||||
|
||||
/* code from ZUC 3GPP Specifications, version 1.6
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <openssl/zuc.h>
|
||||
#include "zuc_spec.h"
|
||||
|
||||
typedef struct {
|
||||
uint32_t S[16];
|
||||
uint32_t R1;
|
||||
uint32_t R2;
|
||||
} zuc_key_t;
|
||||
static const ZUC_UINT15 KD[16] = {
|
||||
0x44D7,0x26BC,0x626B,0x135E,0x5789,0x35E2,0x7135,0x09AF,
|
||||
0x4D78,0x2F13,0x6BC4,0x1AF1,0x5E26,0x3C4D,0x789A,0x47AC,
|
||||
};
|
||||
|
||||
static const unsigned char S0[256] = {
|
||||
static const uint8_t S0[256] = {
|
||||
0x3e,0x72,0x5b,0x47,0xca,0xe0,0x00,0x33,0x04,0xd1,0x54,0x98,0x09,0xb9,0x6d,0xcb,
|
||||
0x7b,0x1b,0xf9,0x32,0xaf,0x9d,0x6a,0xa5,0xb8,0x2d,0xfc,0x1d,0x08,0x53,0x03,0x90,
|
||||
0x4d,0x4e,0x84,0x99,0xe4,0xce,0xd9,0x91,0xdd,0xb6,0x85,0x48,0x8b,0x29,0x6e,0xac,
|
||||
@@ -78,7 +75,7 @@ static const unsigned char S0[256] = {
|
||||
0x8d,0x27,0x1a,0xdb,0x81,0xb3,0xa0,0xf4,0x45,0x7a,0x19,0xdf,0xee,0x78,0x34,0x60,
|
||||
};
|
||||
|
||||
static const unsigned char S1[256] = {
|
||||
static const uint8_t S1[256] = {
|
||||
0x55,0xc2,0x63,0x71,0x3b,0xc8,0x47,0x86,0x9f,0x3c,0xda,0x5b,0x29,0xaa,0xfd,0x77,
|
||||
0x8c,0xc5,0x94,0x0c,0xa6,0x1a,0x13,0x00,0xe3,0xa8,0x16,0x72,0x40,0xf9,0xf8,0x42,
|
||||
0x44,0x26,0x68,0x96,0x81,0xd9,0x45,0x3e,0x10,0x76,0xc6,0xa7,0x8b,0x39,0x43,0xe1,
|
||||
@@ -97,130 +94,63 @@ static const unsigned char S1[256] = {
|
||||
0x64,0xbe,0x85,0x9b,0x2f,0x59,0x8a,0xd7,0xb0,0x25,0xac,0xaf,0x12,0x03,0xe2,0xf2,
|
||||
};
|
||||
|
||||
static uint32_t const EK_d[16] = {
|
||||
0x44D7,0x26BC,0x626B,0x135E,0x5789,0x35E2,0x7135,0x09AF,
|
||||
0x4D78,0x2F13,0x6BC4,0x1AF1,0x5E26,0x3C4D,0x789A,0x47AC,
|
||||
};
|
||||
|
||||
inline uint32_t zuc_madd(uint32_t a, uint32_t b)
|
||||
{
|
||||
uint32_t c = a + b;
|
||||
return (c & 0x7FFFFFFF) + (c >> 31);
|
||||
}
|
||||
#define ADD31(a,b) a += (b); a = (a & 0x7fffffff) + (a >> 31)
|
||||
#define ROT31(a,k) ((((a) << (k)) | ((a) >> (31 - (k)))) & 0x7FFFFFFF)
|
||||
#define ROT32(a,k) (((a) << (k)) | ((a) >> (32 - (k))))
|
||||
|
||||
#define L1(X) \
|
||||
((X) ^ \
|
||||
ROT32((X), 2) ^ \
|
||||
ROT32((X), 10) ^ \
|
||||
ROT32((X), 18) ^ \
|
||||
ROT32((X), 24))
|
||||
|
||||
#define L2(X) \
|
||||
((X) ^ \
|
||||
ROT32((X), 8) ^ \
|
||||
ROT32((X), 14) ^ \
|
||||
ROT32((X), 22) ^ \
|
||||
ROT32((X), 30))
|
||||
|
||||
#define LFSRWithInitialisationMode(u) \
|
||||
V = LFSR[0]; \
|
||||
ADD31(V, ROT31(LFSR[0], 8)); \
|
||||
ADD31(V, ROT31(LFSR[4], 20)); \
|
||||
ADD31(V, ROT31(LFSR[10], 21)); \
|
||||
ADD31(V, ROT31(LFSR[13], 17)); \
|
||||
ADD31(V, ROT31(LFSR[15], 15)); \
|
||||
ADD31(V, (u)); \
|
||||
{int j; for (j=0; j<15;j++) LFSR[j]=LFSR[j+1];} \
|
||||
LFSR[15] = V
|
||||
|
||||
#define LFSRWithWorkMode() \
|
||||
V = LFSR[0]; \
|
||||
ADD31(V, ROT31(LFSR[0], 8)); \
|
||||
ADD31(V, ROT31(LFSR[4], 20)); \
|
||||
ADD31(V, ROT31(LFSR[10], 21)); \
|
||||
ADD31(V, ROT31(LFSR[13], 17)); \
|
||||
ADD31(V, ROT31(LFSR[15], 15)); \
|
||||
{int j; for (j=0; j<15;j++) LFSR[j]=LFSR[j+1];} \
|
||||
LFSR[15] = V
|
||||
|
||||
#define BitReconstruction2(X1,X2) \
|
||||
X1 = ((LFSR[11] & 0xFFFF) << 16) | (LFSR[9] >> 15); \
|
||||
X2 = ((LFSR[7] & 0xFFFF) << 16) | (LFSR[5] >> 15)
|
||||
|
||||
#define BitReconstruction3(X0,X1,X2) \
|
||||
X0 = ((LFSR[15] & 0x7FFF8000) << 1) | (LFSR[14] & 0xFFFF); \
|
||||
BitReconstruction2(X1,X2)
|
||||
|
||||
#define BitReconstruction4(X0,X1,X2,X3) \
|
||||
BitReconstruction3(X0,X1,X2); \
|
||||
X3 = ((LFSR[2] & 0xFFFF) << 16) | (LFSR[0] >> 15)
|
||||
|
||||
|
||||
/* LFSR with initialization mode */
|
||||
#define MulByPow2(x, k) ((((x) << (k)) | ((x) >> (31 - (k)))) & 0x7FFFFFFF)
|
||||
|
||||
void zuc_lfsr_init(zuc_key_t *key, uint32_t u)
|
||||
{
|
||||
uint32_t f, v;
|
||||
f = key->lfsr_s[0];
|
||||
|
||||
v = MulByPow2(key->lfsr_s[0], 8);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[4], 20);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[10], 21);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[13], 17);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[15], 15);
|
||||
f = AddM(f, v);
|
||||
f = AddM(f, u);
|
||||
|
||||
/* update the state */
|
||||
key->lfsr_s[0] = key->lfsr_s[1];
|
||||
key->lfsr_s[1] = key->lfsr_s[2];
|
||||
key->lfsr_s[2] = key->lfsr_s[3];
|
||||
key->lfsr_s[3] = key->lfsr_s[4];
|
||||
key->lfsr_s[4] = key->lfsr_s[5];
|
||||
key->lfsr_s[5] = key->lfsr_s[6];
|
||||
key->lfsr_s[6] = key->lfsr_s[7];
|
||||
key->lfsr_s[7] = key->lfsr_s[8];
|
||||
key->lfsr_s[8] = key->lfsr_s[9];
|
||||
key->lfsr_s[9] = key->lfsr_s[10];
|
||||
key->lfsr_s[10] = key->lfsr_s[11];
|
||||
key->lfsr_s[11] = key->lfsr_s[12];
|
||||
key->lfsr_s[12] = key->lfsr_s[13];
|
||||
key->lfsr_s[13] = key->lfsr_s[14];
|
||||
key->lfsr_s[14] = key->lfsr_s[15];
|
||||
key->lfsr_s[15] = f;
|
||||
}
|
||||
|
||||
void zuc_lfst_word(zuc_key_t *key)
|
||||
{
|
||||
u32 f, v;
|
||||
f = key->lfsr_s[0];
|
||||
v = MulByPow2(key->lfsr_s[0], 8);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[4], 20);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[10], 21);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[13], 17);
|
||||
f = AddM(f, v);
|
||||
v = MulByPow2(key->lfsr_s[15], 15);
|
||||
f = AddM(f, v);
|
||||
|
||||
key->lfsr_s[0] = key->lfsr_s[1];
|
||||
key->lfsr_s[1] = key->lfsr_s[2];
|
||||
key->lfsr_s[2] = key->lfsr_s[3];
|
||||
key->lfsr_s[3] = key->lfsr_s[4];
|
||||
key->lfsr_s[4] = key->lfsr_s[5];
|
||||
key->lfsr_s[5] = key->lfsr_s[6];
|
||||
key->lfsr_s[6] = key->lfsr_s[7];
|
||||
key->lfsr_s[7] = key->lfsr_s[8];
|
||||
key->lfsr_s[8] = key->lfsr_s[9];
|
||||
key->lfsr_s[9] = key->lfsr_s[10];
|
||||
key->lfsr_s[10] = key->lfsr_s[11];
|
||||
key->lfsr_s[11] = key->lfsr_s[12];
|
||||
key->lfsr_s[12] = key->lfsr_s[13];
|
||||
key->lfsr_s[13] = key->lfsr_s[14];
|
||||
key->lfsr_s[14] = key->lfsr_s[15];
|
||||
key->lfsr_s[15] = f;
|
||||
}
|
||||
|
||||
void zuc_bit_reorganization(zuc_key_t *key)
|
||||
{
|
||||
key->brc_x[0] = ((key->lfsr_s[15] & 0x7FFF8000) << 1) | (key->lfsr_s[14] & 0xFFFF);
|
||||
key->brc_x[1] = ((key->lfsr_s[11] & 0xFFFF) << 16) | (key->lfsr_s[9] >> 15);
|
||||
key->brc_x[2] = ((key->lfsr_s[7] & 0xFFFF) << 16) | (key->lfsr_s[5] >> 15);
|
||||
key->brc_x[3] = ((key->lfsr_s[2] & 0xFFFF) << 16) | (key->lfsr_s[0] >> 15);
|
||||
}
|
||||
|
||||
#define ZUC_BIT_REORG(x,x0,x1,x2,x3) \
|
||||
x0 = ((s[15] & 0x7FFF8000) << 1) | (s[14] & 0xFFFF); \
|
||||
x1 = ((s[11] & 0xFFFF) << 16) | (s[9] >> 15); \
|
||||
x2 = ((s[7] & 0xFFFF) << 16) | (s[5] >> 15); \
|
||||
x3 = ((s[2] & 0xFFFF) << 16) | (s[0] >> 15)
|
||||
|
||||
#define ROT32(a, k) (((a) << k) | ((a) >> (32 - k)))
|
||||
|
||||
#define L1(x) \
|
||||
((x) ^ \
|
||||
ROT32((x), 2) ^ \
|
||||
ROT32((x), 10) ^ \
|
||||
ROT32((x), 18) ^ \
|
||||
ROT32((x), 24))
|
||||
|
||||
#define L2(x) \
|
||||
((x) ^ \
|
||||
ROT32((x), 8) ^ \
|
||||
ROT32((x), 14) ^ \
|
||||
ROT32((x), 22) ^ \
|
||||
ROT32((x), 30))
|
||||
|
||||
#define GET32(pc) ( \
|
||||
((uint32_t)(pc)[0] << 24) ^ \
|
||||
((uint32_t)(pc)[1] << 16) ^ \
|
||||
((uint32_t)(pc)[2] << 8) ^ \
|
||||
((uint32_t)(pc)[3]))
|
||||
|
||||
#define PUT32(st, ct) \
|
||||
(ct)[0] = (uint8_t)((st) >> 24); \
|
||||
(ct)[1] = (uint8_t)((st) >> 16); \
|
||||
(ct)[2] = (uint8_t)((st) >> 8); \
|
||||
#define MAKEU31(k,d,iv) \
|
||||
(((uint32_t)(k) << 23) | \
|
||||
((uint32_t)(d) << 8) | \
|
||||
(uint32_t)(iv))
|
||||
|
||||
#define MAKEU32(a, b, c, d) \
|
||||
(((uint32_t)(a) << 24) | \
|
||||
@@ -228,74 +158,86 @@ void zuc_bit_reorganization(zuc_key_t *key)
|
||||
((uint32_t)(c) << 8) | \
|
||||
((uint32_t)(d)))
|
||||
|
||||
#define MAKEU31(a, b, c) \
|
||||
(((uint32_t)(a) << 23) | \
|
||||
((uint32_t)(b) << 8) | \
|
||||
(uint32_t)(c))
|
||||
#define F_(X1,X2) \
|
||||
W1 = R1 + X1; \
|
||||
W2 = R2 ^ X2; \
|
||||
U = L1((W1 << 16) | (W2 >> 16)); \
|
||||
V = L2((W2 << 16) | (W1 >> 16)); \
|
||||
R1 = MAKEU32( S0[U >> 24], \
|
||||
S1[(U >> 16) & 0xFF], \
|
||||
S0[(U >> 8) & 0xFF], \
|
||||
S1[U & 0xFF]); \
|
||||
R2 = MAKEU32( S0[V >> 24], \
|
||||
S1[(V >> 16) & 0xFF], \
|
||||
S0[(V >> 8) & 0xFF], \
|
||||
S1[V & 0xFF])
|
||||
|
||||
#define F(X0,X1,X2) \
|
||||
(X0 ^ R1) + R2; \
|
||||
F_(X1, X2)
|
||||
|
||||
uint32_t F(zuc_key_t *key)
|
||||
void ZUC_set_key(ZUC_KEY *key, const unsigned char *user_key, const unsigned char *iv)
|
||||
{
|
||||
uint32_t W, W1, W2, u, v;
|
||||
|
||||
W = (key->brc_x[0] ^ key->f_r[1]) + key->f_r[2];
|
||||
W1 = key->f_r[1] + key->brc_x[1];
|
||||
W2 = key->f_r[2] ^ key->brc_x[2];
|
||||
u = L1((W1 << 16) | (W2 >> 16));
|
||||
v = L2((W2 << 16) | (W1 >> 16));
|
||||
|
||||
key->f_r[1] = MAKEU32(
|
||||
S0[u >> 24],
|
||||
S1[(u >> 16) & 0xFF],
|
||||
S0[(u >> 8) & 0xFF],
|
||||
S1[u & 0xFF]);
|
||||
|
||||
key->f_r[2] = MAKEU32(
|
||||
S0[v >> 24],
|
||||
S1[(v >> 16) & 0xFF],
|
||||
S0[(v >> 8) & 0xFF],
|
||||
S1[v & 0xFF]);
|
||||
|
||||
return W;
|
||||
}
|
||||
|
||||
void zuc_set_key(zuc_key_t *key, const unsigned char *user_key, const unsigned char *iv)
|
||||
{
|
||||
uint32_t w;
|
||||
ZUC_UINT31 *LFSR = key->LFSR;
|
||||
uint32_t R1, R2;
|
||||
uint32_t X0, X1, X2;
|
||||
uint32_t W, W1, W2, U, V;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 16; i++) {
|
||||
key->lfsr_s[i] = MAKEU31(user_key[i], EK_d[i], iv[i]);
|
||||
LFSR[i] = MAKEU31(user_key[i], KD[i], iv[i]);
|
||||
}
|
||||
|
||||
key->f_r[1] = 0;
|
||||
key->f_r[2] = 0;
|
||||
R1 = 0;
|
||||
R2 = 0;
|
||||
|
||||
for (i = 0; i < 32; i++) {
|
||||
zuc_bit_reorganization(key);
|
||||
w = F(key);
|
||||
zuc_lfsr_init(w >> 1);
|
||||
BitReconstruction3(X0, X1, X2);
|
||||
W = F(X0, X1, X2);
|
||||
LFSRWithInitialisationMode(W >> 1);
|
||||
}
|
||||
|
||||
BitReconstruction2(X1, X2);
|
||||
F_(X1, X2);
|
||||
LFSRWithWorkMode();
|
||||
|
||||
key->R1 = R1;
|
||||
key->R2 = R2;
|
||||
}
|
||||
|
||||
void zuc_generate_keystream(zuc_key_t *key, size_t num, uint32_t *keystream)
|
||||
uint32_t ZUC_generate_keyword(ZUC_KEY *key)
|
||||
{
|
||||
ZUC_UINT31 *LFSR = key->LFSR;
|
||||
uint32_t R1 = key->R1;
|
||||
uint32_t R2 = key->R2;
|
||||
uint32_t X0, X1, X2, X3;
|
||||
uint32_t W1, W2, U, V;
|
||||
uint32_t Z;
|
||||
|
||||
BitReconstruction4(X0, X1, X2, X3);
|
||||
Z = X3 ^ F(X0, X1, X2);
|
||||
LFSRWithWorkMode();
|
||||
|
||||
key->R1 = R1;
|
||||
key->R2 = R2;
|
||||
|
||||
return Z;
|
||||
}
|
||||
|
||||
void ZUC_generate_keystream(ZUC_KEY *key, size_t nwords, uint32_t *keystream)
|
||||
{
|
||||
ZUC_UINT31 *LFSR = key->LFSR;
|
||||
uint32_t R1 = key->R1;
|
||||
uint32_t R2 = key->R2;
|
||||
uint32_t X0, X1, X2, X3;
|
||||
uint32_t W1, W2, U, V;
|
||||
size_t i;
|
||||
|
||||
zuc_bit_reorg(key);
|
||||
(void)F(key);
|
||||
zuc_lfsr_work(key);
|
||||
|
||||
for (i = 0; i < num; i ++) {
|
||||
zuc_bit_reorg(key);
|
||||
keystream[i] = F(key) ^ key->brc_x[3];
|
||||
zuc_lfsr_work(key);
|
||||
for (i = 0; i < nwords; i ++) {
|
||||
BitReconstruction4(X0, X1, X2, X3);
|
||||
keystream[i] = X3 ^ F(X0, X1, X2);
|
||||
LFSRWithWorkMode();
|
||||
}
|
||||
}
|
||||
|
||||
void ZUC(const unsigned char *key, const unsigned char *iv, uint32_t *keystream, int num)
|
||||
{
|
||||
zuc_key_t zuc;
|
||||
zuc_key_init(&zuc, key, iv);
|
||||
zuc_generate_keystream(&zuc, keystream, num);
|
||||
key->R1 = R1;
|
||||
key->R2 = R2;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user