国密对称SM4（修正版）

/* sms4.c ** SMS4 Encryption algorithm for wireless networks ** ** $Id: sms4.c 2009-12-31 14:41:57 tao.tang <$">emhmily@gmail.com>$ ** ** ** This program is free software; you can redistribute it and/or ** modify it under the terms of the GNU General Public License ** as published by the Free Software Foundation; either version 2 ** of the License, or (at your option) any later version. ** ** This program is distributed in the hope that it will be useful, ** but WITHOUT ANY WARRANTY; without even the implied warranty of ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the ** GNU General Public License for more details. ** ** You should have received a copy of the GNU General Public License ** along with this program; if not, write to the Free Software ** Foundation, Inc. **/ #include <string.h> #include <stdio.h> /*#include "sms4.h"*/ #ifndef unlong typedef unsigned long unlong; #endif /* unlong */ #ifndef unchar typedef unsigned char unchar; #endif /* unchar */ /* define SMS4CROL for rotating left */ #define SMS4CROL(uval, bits) ((uval << bits) | (uval >> (0x20 - bits))) /* define MASK code for selecting expected bits from a 32 bits value */ #define SMS4MASK3 0xFF000000 #define SMS4MASK2 0x00FF0000 #define SMS4MASK1 0x0000FF00 #define SMS4MASK0 0x000000FF /* Sbox table: 8bits input convert to 8 bits output*/ static unchar SboxTable[16][16] = { {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} }; /* Encryption key: 128bits */ static unlong MK[4] = {0x01234567,0x89abcdef,0xfedcba98,0x76543210}; /* System parameter */ static unlong FK[4] = {0xa3b1bac6,0x56aa3350,0x677d9197,0xb27022dc}; /* fixed parameter */ static unlong 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 }; /* buffer for round encryption key */ static unlong ENRK[32]; static unlong DERK[32]; /* original contents for debugging */ unlong pData[4] = { 0x01234567, 0x89abcdef, 0xfedcba98, 0x76543210 }; /* original contents for debugging */ unlong pData2[9] = { 0x01234567, 0x89abcdef, 0xfedcba98, 0x76543210, 0x12121212, 0x34343434, 0x56565656, 0x78787878, 0x12341234 }; /*============================================================================= ** private function: ** look up in SboxTable and get the related value. ** args: [in] inch: 0x00~0xFF (8 bits unsigned value). **============================================================================*/ static unchar SMS4Sbox(unchar inch) { unchar *pTable = (unchar *)SboxTable; unchar retVal = (unchar)(pTable[inch]); return retVal; } /*============================================================================= ** private function: ** "T algorithm" == "L algorithm" + "t algorithm". ** args: [in] a: a is a 32 bits unsigned value; ** return: c: c is calculated with line algorithm "L" and nonline algorithm "t" **============================================================================*/ static unlong SMS4Lt(unlong a) { unlong b = 0; unlong c = 0; unchar a0 = (unchar)(a & SMS4MASK0); unchar a1 = (unchar)((a & SMS4MASK1) >> 8); unchar a2 = (unchar)((a & SMS4MASK2) >> 16); unchar a3 = (unchar)((a & SMS4MASK3) >> 24); unchar b0 = SMS4Sbox(a0); unchar b1 = SMS4Sbox(a1); unchar b2 = SMS4Sbox(a2); unchar b3 = SMS4Sbox(a3); b =b0 | (b1 << 8) | (b2 << 16) | (b3 << 24); c =b^(SMS4CROL(b, 2))^(SMS4CROL(b, 10))^(SMS4CROL(b, 18))^(SMS4CROL(b, 24)); return c; } /*============================================================================= ** private function: ** Calculating round encryption key. ** args: [in] a: a is a 32 bits unsigned value; ** return: ENRK[i]: i{0,1,2,3,...31}. **============================================================================*/ static unlong SMS4CalciRK(unlong a) { unlong b = 0; unlong rk = 0; unchar a0 = (unchar)(a & SMS4MASK0); unchar a1 = (unchar)((a & SMS4MASK1) >> 8); unchar a2 = (unchar)((a & SMS4MASK2) >> 16); unchar a3 = (unchar)((a & SMS4MASK3) >> 24); unchar b0 = SMS4Sbox(a0); unchar b1 = SMS4Sbox(a1); unchar b2 = SMS4Sbox(a2); unchar b3 = SMS4Sbox(a3); b = b0 | (b1 << 8) | (b2 << 16) | (b3 << 24); rk = b^(SMS4CROL(b, 13))^(SMS4CROL(b, 23)); return rk; } /*============================================================================= ** private function: ** Calculating round encryption key. ** args: [in] ulflag: if 0: not calculate DERK , else calculate; ** return: NONE. **============================================================================*/ static void SMS4CalcRK(unlong ulflag) { unlong k[36]; unlong i = 0; k[0] = MK[0]^FK[0]; k[1] = MK[1]^FK[1]; k[2] = MK[2]^FK[2]; k[3] = MK[3]^FK[3]; for(; i<32; i++) { k[i+4] = k[i] ^ (SMS4CalciRK(k[i+1]^k[i+2]^k[i+3]^CK[i])); ENRK[i] = k[i+4]; } if (ulflag != 0x00) { for (i=0; i<32; i++) { DERK[i] = ENRK[31-i]; } } } /*============================================================================= ** private function: ** "T algorithm" == "L algorithm" + "t algorithm". ** args: [in] a: a is a 32 bits unsigned value. **============================================================================*/ static unlong SMS4T(unlong a) { return (SMS4Lt(a)); } /*============================================================================= ** private function: ** Calculating and getting encryption/decryption contents. ** args: [in] x0: original contents; ** args: [in] x1: original contents; ** args: [in] x2: original contents; ** args: [in] x3: original contents; ** args: [in] rk: encryption/decryption key; ** return the contents of encryption/decryption contents. **============================================================================*/ static unlong SMS4F(unlong x0, unlong x1, unlong x2, unlong x3, unlong rk) { return (x0^SMS4Lt(x1^x2^x3^rk)); } /*============================================================================= ** public function: ** "T algorithm" == "L algorithm" + "t algorithm". ** args: [in] ulkey: password defined by user(NULL: default encryption key); ** arg