算法-3DES

#ifndef _ALG3DES_C
#define _ALG3DES_C

#include "ToppayDef.h"

uint8 szSubKeys[2][16][48]={0};            //储存2个16组48位密钥,第2个用于3DES
uint8 szCiphertextRaw[64]="";            //储存二进制密文(64个Bits) int 0,1
uint8 szPlaintextRaw[64]="";            //储存二进制密文(64个Bits) int 0,1
uint8 szCiphertextInBytes[8]="";        //储存8位密文
uint8 szPlaintextInBytes[8]="";            //储存8位明文字符串

uint8 szCiphertextInBinary[65]="";        //储存二进制密文(64个Bits) char '0','1',最后一位存'\0'
uint8 szCiphertextInHex[17]="";            //储存十六进制密文,最后一位存'\0'
uint8 szPlaintext[9]="";                //储存8位明文字符串,最后一位存'\0'

uint8 szFCiphertextAnyLength[8192]="";    //任意长度密文
uint8 szFPlaintextAnyLength[8192]="";    //任意长度明文字符串

// permuted choice table (PC1)
uint8 PC1_Table[56] = {
    57, 49, 41, 33, 25, 17,  9,  1, 58, 50, 42, 34, 26, 18,
    10,  2, 59, 51, 43, 35, 27, 19, 11,  3, 60, 52, 44, 36,
    63, 55, 47, 39, 31, 23, 15,  7, 62, 54, 46, 38, 30, 22,
    14,  6, 61, 53, 45, 37, 29, 21, 13,  5, 28, 20, 12,  4
};
// permuted choice key (PC2)
uint8 PC2_Table[48] = {
    14, 17, 11, 24,  1,  5,  3, 28, 15,  6, 21, 10,
    23, 19, 12,  4, 26,  8, 16,  7, 27, 20, 13,  2,
    41, 52, 31, 37, 47, 55, 30, 40, 51, 45, 33, 48,
    44, 49, 39, 56, 34, 53, 46, 42, 50, 36, 29, 32
};
// number left rotations of pc1
uint8 Shift_Table[16] = {
    1,1,2,2,2,2,2,2,1,2,2,2,2,2,2,1
};
// initial permutation (IP)
uint8 IP_Table[64] = {
    58, 50, 42, 34, 26, 18, 10, 2, 60, 52, 44, 36, 28, 20, 12, 4,
    62, 54, 46, 38, 30, 22, 14, 6, 64, 56, 48, 40, 32, 24, 16, 8,
    57, 49, 41, 33, 25, 17,  9, 1, 59, 51, 43, 35, 27, 19, 11, 3,
    61, 53, 45, 37, 29, 21, 13, 5, 63, 55, 47, 39, 31, 23, 15, 7
};
// expansion operation matrix (E)
uint8 E_Table[48] = {
    32,  1,  2,  3,  4,  5,  4,  5,  6,  7,  8,  9,
    8,  9, 10, 11, 12, 13, 12, 13, 14, 15, 16, 17,
    16, 17, 18, 19, 20, 21, 20, 21, 22, 23, 24, 25,
    24, 25, 26, 27, 28, 29, 28, 29, 30, 31, 32,  1
};
// The (in)famous S-boxes
uint8 S_Box[8][4][16] = {
    // S1
    {{14,  4,    13,  1,  2, 15, 11,  8,  3, 10,  6, 12,  5,  9,  0,  7},
    {0, 15,  7,  4, 14,  2, 13,  1, 10,  6, 12, 11,  9,  5,  3,  8},
    {4,  1, 14,  8, 13,  6,  2, 11, 15, 12,  9,  7,  3, 10,  5,  0},
    {15, 12,  8,  2,  4,  9,  1,  7,  5, 11,  3, 14, 10,  0,  6, 13}},
    // S2
    {{15,  1,  8, 14,  6, 11,  3,  4,  9,  7,  2, 13, 12,  0,  5, 10},
    {3, 13,  4,  7, 15,  2,  8, 14, 12,  0,  1, 10,  6,  9, 11,  5},
    {0, 14,  7, 11, 10,  4, 13,  1,  5,  8, 12,  6,  9,  3,  2, 15},
    {13,  8, 10,  1,  3, 15,  4,  2, 11,  6,  7, 12,  0,  5, 14,  9}},
    // S3
    {{10,  0,  9, 14,  6,  3, 15,  5,  1, 13, 12,  7, 11,  4,  2,  8},
    {13,  7,  0,  9,  3,  4,  6, 10,  2,  8,  5, 14, 12, 11, 15,  1},
    {13,  6,  4,  9,  8, 15,  3,  0, 11,  1,  2, 12,  5, 10, 14,  7},
    {1, 10, 13,  0,  6,  9,  8,  7,  4, 15, 14,  3, 11,  5,  2, 12}},
    // S4
    {{7, 13, 14,  3,  0,  6,  9, 10,  1,  2,  8,  5, 11, 12,  4, 15},
    {13,  8, 11,  5,  6, 15,  0,  3,  4,  7,  2, 12,  1, 10, 14,  9},
    {10,  6,  9,  0, 12, 11,  7, 13, 15,  1,  3, 14,  5,  2,  8,  4},
    {3, 15,  0,  6, 10,  1, 13,  8,  9,  4,  5, 11, 12,  7,  2, 14}},
    // S5
    {{2, 12,  4,  1,  7, 10, 11,  6,  8,  5,  3, 15, 13,  0, 14,  9},
    {14, 11,  2, 12,  4,  7, 13,  1,  5,  0, 15, 10,  3,  9,  8,  6},
    {4,  2,  1, 11, 10, 13,  7,  8, 15,  9, 12,  5,  6,  3,  0, 14},
    {11,  8, 12,  7,  1, 14,  2, 13,  6, 15,  0,  9, 10,  4,  5,  3}},
    // S6
    {{12,  1, 10, 15,  9,  2,  6,  8,  0, 13,  3,  4, 14,  7,  5, 11},
    {10, 15,  4,  2,  7, 12,  9,  5,  6,  1, 13, 14,  0, 11,  3,  8},
    {9, 14, 15,  5,  2,  8, 12,  3,  7,  0,  4, 10,  1, 13, 11,  6},
    {4,  3,  2, 12,  9,  5, 15, 10, 11, 14,  1,  7,  6,  0,  8, 13}},
    // S7
    {{4, 11,  2, 14, 15,  0,  8, 13,  3, 12,  9,  7,  5, 10,  6,  1},
    {13,  0, 11,  7,  4,  9,  1, 10, 14,  3,  5, 12,  2, 15,  8,  6},
    {1,  4, 11, 13, 12,  3,  7, 14, 10, 15,  6,  8,  0,  5,  9,  2},
    {6, 11, 13,  8,  1,  4, 10,  7,  9,  5,  0, 15, 14,  2,  3, 12}},
    // S8
    {{13,  2,  8,  4,  6, 15, 11,  1, 10,  9,  3, 14,  5,  0, 12,  7},
    {1, 15, 13,  8, 10,  3,  7,  4, 12,  5,  6, 11,  0, 14,  9,  2},
    {7, 11,  4,  1,  9, 12, 14,  2,  0,  6, 10, 13, 15,  3,  5,  8},
    {2,  1, 14,  7,  4, 10,  8, 13, 15, 12,  9,  0,  3,  5,  6, 11}}
};
// 32-bit permutation function P used on the output of the S-boxes
uint8 P_Table[32] = {
    16, 7, 20, 21, 29, 12, 28, 17, 1,  15, 23, 26, 5,  18, 31, 10,
    2,  8, 24, 14, 32, 27, 3,  9,  19, 13, 30, 6,  22, 11, 4,  25
};
// final permutation IP^-1
uint8 IPR_Table[64] = {
    40, 8, 48, 16, 56, 24, 64, 32, 39, 7, 47, 15, 55, 23, 63, 31,
    38, 6, 46, 14, 54, 22, 62, 30, 37, 5, 45, 13, 53, 21, 61, 29,
    36, 4, 44, 12, 52, 20, 60, 28, 35, 3, 43, 11, 51, 19, 59, 27,
    34, 2, 42, 10, 50, 18, 58, 26, 33, 1, 41,  9, 49, 17, 57, 25
};

void FunctionF(pint8 sz_Li,pint8 sz_Ri,uint32 iKey,uint32 keyN);
void InitialPermuteData(pint8 _src,pint8 _dst);
void ExpansionR(pint8 _src,pint8 _dst);
void CompressFuncS(pint8 _src48, pint8 _dst32);
void PermutationP(pint8 _src,pint8 _dst);
void Bytes2Bits(pint8 srcBytes, pint8 dstBits, uint8 sizeBits);
void Bits2Bytes(puint8 dstBytes, puint8 srcBits, uint32 sizeBits);
void Int2Bits(uint32 _src, puint8 dstBits);
void Bits2Hex(puint8 dstHex, puint8 srcBits, uint32 sizeBits);
void InitializeKey(pint8 srcBytes,uint32 keyN);
void EncryptData(pint8 _srcBytes,uint32 keyN);
void DecryptData(pint8 _srcBytes,uint32 keyN);
pint8 GetCiphertextInBytes();
pint8 GetPlaintext();

void Des_Encrypt(puint8 binput, puint8 boutput, puint8 bkey)
{
    pint8 out;
    InitializeKey((pint8)bkey, 0);
    EncryptData((pint8)binput, 0);
    out = GetCiphertextInBytes();
    memcpy(boutput, out, 8);
}

void Des_Decrypt(puint8 binput, puint8 boutput, puint8 bkey)
{
    pint8 out;
    InitializeKey((pint8)bkey, 0);
    DecryptData((pint8)binput, 0);
    out = GetPlaintext();
    memset(boutput,0,8);
    memcpy(boutput, out, 8);
}

void TripleDes_Encrypt(puint8 binput, puint8 boutput, puint8 bkey)
{
    uint8 tmp[9];
    memset(boutput,0,8);
    Des_Encrypt(binput, boutput, bkey);
    memset(tmp, 0, sizeof(tmp));
    Des_Decrypt(boutput, tmp, bkey+8);
    memset(boutput,0,8);
    Des_Encrypt(tmp, boutput, bkey);
}

void TripleDes_Decrypt(puint8 binput, puint8 boutput, puint8 bkey)
{
    pint8 out;
    InitializeKey((pint8)bkey, 0);
    InitializeKey((pint8)bkey+8, 1);
    DecryptData((pint8)binput, 0);
    EncryptData(GetPlaintext(), 1);
    DecryptData(GetCiphertextInBytes(), 0);
    out = GetPlaintext();
    memcpy(boutput, out, 8);
}

void CreateSubKey(puint8 sz_56key,uint32 keyN)
{
    uint8 szTmpL[28] = {0};
    uint8 szTmpR[28] = {0};
    uint8 szCi[28] = {0};
    uint8 szDi[28] = {0};
    uint8 szTmp56[56] = {0};
    uint8 i, j;

    memcpy(szTmpL,sz_56key,28);
    memcpy(szTmpR,sz_56key + 28,28);

    for(i=0;i<16;i++)
    {
        //shift to left
        //Left 28 bits
        memcpy(szCi,szTmpL + Shift_Table[i],28 - Shift_Table[i]);
        memcpy(szCi + 28 - Shift_Table[i],szTmpL,Shift_Table[i]);
        //Right 28 bits
        memcpy(szDi,szTmpR + Shift_Table[i],28 - Shift_Table[i]);
        memcpy(szDi + 28 - Shift_Table[i],szTmpR,Shift_Table[i]);

        //permuted choice 48 bits key
        memcpy(szTmp56,szCi,28);
        memcpy(szTmp56 + 28,szDi,28);
        for(j=0;j<48;j++)
        {
            szSubKeys[keyN][i][j] = szTmp56[PC2_Table[j]-1];
        }
        //Evaluate new szTmpL and szTmpR
        memcpy(szTmpL,szCi,28);
        memcpy(szTmpR,szDi,28);
    }
}

void InitializeKey(pint8 srcBytes,uint32 keyN)
{
    //convert 8 char-bytes key to 64 binary-bits
    uint8 sz_64key[64] = {0};
    uint8 sz_56key[56] = {0};
    uint8 k;
    Bytes2Bits(srcBytes,sz_64key,64);
    //PC 1
    for(k=0;k<56;k++)
    {
        sz_56key[k] = sz_64key[PC1_Table[k]-1];
    }
    CreateSubKey(sz_56key,keyN);
}

void EncryptData(pint8 _srcBytes,uint32 keyN)
{
    uint8 szSrcBits[64] = {0};
    uint8 sz_IP[64] = {0};
    uint8 sz_Li[32] = {0};
    uint8 sz_Ri[32] = {0};
    uint8 sz_Final64[64] = {0};
    uint8 i,j;

    Bytes2Bits(_srcBytes,szSrcBits,64);
    //IP
    InitialPermuteData(szSrcBits,sz_IP);
    memcpy(sz_Li,sz_IP,32);
    memcpy(sz_Ri,sz_IP + 32,32);

    for(i=0;i<16;i++)
    {
        FunctionF(sz_Li,sz_Ri,i,keyN);
    }
    //so D=LR

    memcpy(sz_Final64,sz_Ri,32);
    memcpy(sz_Final64 + 32,sz_Li,32);

    //~IP
    for(j=0;j<64;j++)
    {
        szCiphertextRaw[j] = sz_Final64[IPR_Table[j]-1];
    }
    Bits2Bytes(szCiphertextInBytes,szCiphertextRaw,64);
}

void DecryptData(pint8 _srcBytes,uint32 keyN)
{
    uint8 szSrcBits[64] = {0};
    uint8 sz_IP[64] = {0};
    uint8 sz_Li[32] = {0};
    uint8 sz_Ri[32] = {0};
    uint8 sz_Final64[64] = {0};
    uint8 i,j;
    Bytes2Bits(_srcBytes,szSrcBits,64);
    //IP --- return is sz_IP
    InitialPermuteData(szSrcBits,sz_IP);
    //divide the 64 bits data to two parts
    memcpy(sz_Ri,sz_IP,32); //exchange L to R
    memcpy(sz_Li,sz_IP + 32,32);  //exchange R to L
    //16 rounds F and xor and exchange
    for( i=0;i<16;i++)
    {
        FunctionF(sz_Ri,sz_Li,15-i,keyN);
    }
    memcpy(sz_Final64,sz_Li,32);
    memcpy(sz_Final64 + 32,sz_Ri,32);
    // ~IP
    for( j=0;j<64;j++)
    {
        szPlaintextRaw[j] = sz_Final64[IPR_Table[j]-1];
    }
    Bits2Bytes(szPlaintextInBytes,szPlaintextRaw,64);
}

void FunctionF(pint8 sz_Li,pint8 sz_Ri,uint32 iKey,uint32 keyN)
{
    uint8 sz_48R[48] = {0};
    uint8 sz_xor48[48] = {0};
    uint8 sz_P32[32] = {0};
    uint8 sz_Rii[32] = {0};
    uint8 sz_Key[48] = {0};
    uint8 s_Compress32[32] = {0};
    memcpy(sz_Key,szSubKeys[keyN][iKey],48);
    ExpansionR(sz_Ri,sz_48R);
    XOR(sz_48R,sz_Key,sz_xor48,48);

    CompressFuncS(sz_xor48,s_Compress32);
    PermutationP(s_Compress32,sz_P32);
    XOR(sz_P32,sz_Li,sz_Rii,32);
    memcpy(sz_Li,sz_Ri,32);
    memcpy(sz_Ri,sz_Rii,32);
}

void InitialPermuteData(pint8 _src,pint8 _dst)
{
    uint8 i;
    //IP
    for( i=0;i<64;i++)
    {
        _dst[i] = _src[IP_Table[i]-1];
    }
}

void ExpansionR(pint8 _src,pint8 _dst)
{
    uint8 i;
    for( i=0;i<48;i++)
    {
        _dst[i] = _src[E_Table[i]-1];
    }
}

void CompressFuncS(pint8 _src48, pint8 _dst32)
{
    uint8 bTemp[8][6]={0};
    uint8 dstBits[4]={0};
    uint8 i,j, iX, iY;
    for(i=0;i<8;i++)
    {
        memcpy(bTemp[i],_src48+i*6,6);
        iX = (bTemp[i][0])*2 + (bTemp[i][5]);
        iY = 0;
        for( j=1;j<5;j++)
        {
            iY += bTemp[i][j]<<(4-j);
        }
        Int2Bits(S_Box[i][iX][iY], dstBits);
        memcpy(_dst32 + i * 4, dstBits, 4);
    }

}

void PermutationP(pint8 _src,pint8 _dst)
{
    uint8 i;
    for( i=0;i<32;i++)
    {
        _dst[i] = _src[P_Table[i]-1];
    }
}

void Bytes2Bits(pint8 srcBytes, pint8 dstBits, uint8 sizeBits)
{
    uint8 i;
    for( i=0; i < sizeBits; i++)
        dstBits[i] = ((srcBytes[i>>3]<<(i&7)) & 128)>>7;
}

void Bits2Bytes(puint8 dstBytes, puint8 srcBits, uint32 sizeBits)
{
    uint8 i;
    memset(dstBytes,0,sizeBits>>3);
    for( i=0; i < sizeBits; i++)
        dstBytes[i>>3] |= (srcBits[i] << (7 - (i & 7)));
}

void Int2Bits(uint32 _src, puint8 dstBits)
{
    uint8 i;
    for( i=0; i < 4; i++)
        dstBits[i] = ((_src<<i) & 8)>>3;
}

void Bits2Hex(puint8 dstHex, puint8 srcBits, uint32 sizeBits)
{
    uint8 i, j;

    memset(dstHex,0,sizeBits>>2);
    for( i=0; i < sizeBits; i++) //convert to int 0-15
        dstHex[i>>2] += (srcBits[i] << (3 - (i & 3)));
    for( j=0;j < (sizeBits>>2);j++)
        dstHex[j] += dstHex[j] > 9 ? 55 : 48; //convert to char '0'-'F'
}

pint8 GetCiphertextInBytes()
{
    return szCiphertextInBytes;
}

pint8 GetPlaintext()
{
    memcpy(szPlaintext,szPlaintextInBytes,8);
    szPlaintext[8] = '\0';
    return szPlaintext;
}

void Des3EncodeECB(puint8 key, puint8 date, puint8 encode_result, uint8 len_key)
{
    uint8 input[8] = {0}, output[8] = {0};
    uint8 i=0;
    for (i=0; i<len_key; i++)
    {
        memcpy(input, date+8*i, 8);
        TripleDes_Encrypt(input, output, key);
        memcpy(encode_result+8*i, output, 8);
    }
}

void Des3DecodeECB(puint8 key, puint8 date, puint8 decode_result, uint8 len_key)
{
    uint8 input[8] = {0}, output[8] = {0};
    uint8 i=0;
    for (i=0; i<len_key; i++)
    {
        memcpy(input, date+8*i, 8);
        TripleDes_Decrypt(input, output, key);
        memcpy(decode_result+8*i, output, 8);
    }
}

#endif