韓國商用密碼ARIA128C語言實現

 韓國商用密碼ARIA128C語言實現

此版本與我之前寫的幾個代碼的輸入有點不同，這個要輸入16進制，未採用文件輸入輸出，且沒有采用***模式。

#include<stdio.h>

#define KeyLen 16
unsigned char plaintext[16];// input plain text
unsigned char keys[32];  // input key ,the master key
unsigned char KL[16];  //con KL
unsigned char KR[16];  //con KR
unsigned char W[4][16];  //var W[0...3]
unsigned char cipher[16]; // the encrypted/decrypted cipher
unsigned char CK[4][16];    //var CK[0...3]
unsigned char ek[16][16];   //ek[1....13] encryption keys for 12 rounds
unsigned char dk[16][16];   //dk[1....13] dncryption keys for 12 rounds

//!!!!!!!官方文檔的常數C居然還有一個錯的
unsigned char C[4][16] = {{0},
{0x51,0x7c,0xc1,0xb7,0x27,0x22,0x0a,0x94,0xfe,0x13,0xab,0xe8,0xfa,0x9a,0x6e,0xe0},
{0x6d,0xb1,0x4a,0xcc,0x9e,0x21,0xc8,0x20,0xff,0x28,0xb1,0xd5,0xef,0x5d,0xe2,0xb0},
{0xdb,0x92,0x37,0x1d,0x21,0x26,0xe9,0x70,0x03,0x24,0x97,0x75,0x04,0xe8,0xc9,0x0e}};

unsigned char SBoxOne[16][16]={
{0x63, 0x7c, 0x77, 0x7b, 0xf2, 0x6b, 0x6f, 0xc5, 0x30, 0x01, 0x67, 0x2b, 0xfe, 0xd7, 0xab, 0x76 },
{0xca, 0x82, 0xc9, 0x7d, 0xfa, 0x59, 0x47, 0xf0, 0xad, 0xd4, 0xa2, 0xaf, 0x9c, 0xa4, 0x72, 0xc0 },
{0xb7, 0xfd, 0x93, 0x26, 0x36, 0x3f, 0xf7, 0xcc, 0x34, 0xa5, 0xe5, 0xf1, 0x71, 0xd8, 0x31, 0x15 },
{0x04, 0xc7, 0x23, 0xc3, 0x18, 0x96, 0x05, 0x9a, 0x07, 0x12, 0x80, 0xe2, 0xeb, 0x27, 0xb2, 0x75 },
{0x09, 0x83, 0x2c, 0x1a, 0x1b, 0x6e, 0x5a, 0xa0, 0x52, 0x3b, 0xd6, 0xb3, 0x29, 0xe3, 0x2f, 0x84 },
{0x53, 0xd1, 0x00, 0xed, 0x20, 0xfc, 0xb1, 0x5b, 0x6a, 0xcb, 0xbe, 0x39, 0x4a, 0x4c, 0x58, 0xcf },
{0xd0, 0xef, 0xaa, 0xfb, 0x43, 0x4d, 0x33, 0x85, 0x45, 0xf9, 0x02, 0x7f, 0x50, 0x3c, 0x9f, 0xa8 },
{0x51, 0xa3, 0x40, 0x8f, 0x92, 0x9d, 0x38, 0xf5, 0xbc, 0xb6, 0xda, 0x21, 0x10, 0xff, 0xf3, 0xd2 },
{0xcd, 0x0c, 0x13, 0xec, 0x5f, 0x97, 0x44, 0x17, 0xc4, 0xa7, 0x7e, 0x3d, 0x64, 0x5d, 0x19, 0x73 },
{0x60, 0x81, 0x4f, 0xdc, 0x22, 0x2a, 0x90, 0x88, 0x46, 0xee, 0xb8, 0x14, 0xde, 0x5e, 0x0b, 0xdb },
{0xe0, 0x32, 0x3a, 0x0a, 0x49, 0x06, 0x24, 0x5c, 0xc2, 0xd3, 0xac, 0x62, 0x91, 0x95, 0xe4, 0x79 },
{0xe7, 0xc8, 0x37, 0x6d, 0x8d, 0xd5, 0x4e, 0xa9, 0x6c, 0x56, 0xf4, 0xea, 0x65, 0x7a, 0xae, 0x08 },
{0xba, 0x78, 0x25, 0x2e, 0x1c, 0xa6, 0xb4, 0xc6, 0xe8, 0xdd, 0x74, 0x1f, 0x4b, 0xbd, 0x8b, 0x8a },
{0x70, 0x3e, 0xb5, 0x66, 0x48, 0x03, 0xf6, 0x0e, 0x61, 0x35, 0x57, 0xb9, 0x86, 0xc1, 0x1d, 0x9e },
{0xe1, 0xf8, 0x98, 0x11, 0x69, 0xd9, 0x8e, 0x94, 0x9b, 0x1e, 0x87, 0xe9, 0xce, 0x55, 0x28, 0xdf },
{0x8c, 0xa1, 0x89, 0x0d, 0xbf, 0xe6, 0x42, 0x68, 0x41, 0x99, 0x2d, 0x0f, 0xb0, 0x54, 0xbb, 0x16 }};

unsigned char SBoxOneRever[16][16]={
{0x52, 0x09, 0x6a, 0xd5, 0x30, 0x36, 0xa5, 0x38, 0xbf, 0x40, 0xa3, 0x9e, 0x81, 0xf3, 0xd7, 0xfb},
{0x7c, 0xe3, 0x39, 0x82, 0x9b, 0x2f, 0xff, 0x87, 0x34, 0x8e, 0x43, 0x44, 0xc4, 0xde, 0xe9, 0xcb},
{0x54, 0x7b, 0x94, 0x32, 0xa6, 0xc2, 0x23, 0x3d, 0xee, 0x4c, 0x95, 0x0b, 0x42, 0xfa, 0xc3, 0x4e},
{0x08, 0x2e, 0xa1, 0x66, 0x28, 0xd9, 0x24, 0xb2, 0x76, 0x5b, 0xa2, 0x49, 0x6d, 0x8b, 0xd1, 0x25},
{0x72, 0xf8, 0xf6, 0x64, 0x86, 0x68, 0x98, 0x16, 0xd4, 0xa4, 0x5c, 0xcc, 0x5d, 0x65, 0xb6, 0x92},
{0x6c, 0x70, 0x48, 0x50, 0xfd, 0xed, 0xb9, 0xda, 0x5e, 0x15, 0x46, 0x57, 0xa7, 0x8d, 0x9d, 0x84},
{0x90, 0xd8, 0xab, 0x00, 0x8c, 0xbc, 0xd3, 0x0a, 0xf7, 0xe4, 0x58, 0x05, 0xb8, 0xb3, 0x45, 0x06},
{0xd0, 0x2c, 0x1e, 0x8f, 0xca, 0x3f, 0x0f, 0x02, 0xc1, 0xaf, 0xbd, 0x03, 0x01, 0x13, 0x8a, 0x6b},
{0x3a, 0x91, 0x11, 0x41, 0x4f, 0x67, 0xdc, 0xea, 0x97, 0xf2, 0xcf, 0xce, 0xf0, 0xb4, 0xe6, 0x73},
{0x96, 0xac, 0x74, 0x22, 0xe7, 0xad, 0x35, 0x85, 0xe2, 0xf9, 0x37, 0xe8, 0x1c, 0x75, 0xdf, 0x6e},
{0x47, 0xf1, 0x1a, 0x71, 0x1d, 0x29, 0xc5, 0x89, 0x6f, 0xb7, 0x62, 0x0e, 0xaa, 0x18, 0xbe, 0x1b},
{0xfc, 0x56, 0x3e, 0x4b, 0xc6, 0xd2, 0x79, 0x20, 0x9a, 0xdb, 0xc0, 0xfe, 0x78, 0xcd, 0x5a, 0xf4},
{0x1f, 0xdd, 0xa8, 0x33, 0x88, 0x07, 0xc7, 0x31, 0xb1, 0x12, 0x10, 0x59, 0x27, 0x80, 0xec, 0x5f},
{0x60, 0x51, 0x7f, 0xa9, 0x19, 0xb5, 0x4a, 0x0d, 0x2d, 0xe5, 0x7a, 0x9f, 0x93, 0xc9, 0x9c, 0xef},
{0xa0, 0xe0, 0x3b, 0x4d, 0xae, 0x2a, 0xf5, 0xb0, 0xc8, 0xeb, 0xbb, 0x3c, 0x83, 0x53, 0x99, 0x61},
{0x17, 0x2b, 0x04, 0x7e, 0xba, 0x77, 0xd6, 0x26, 0xe1, 0x69, 0x14, 0x63, 0x55, 0x21, 0x0c, 0x7d}};

unsigned char SBoxTwo[16][16] = {
{0xe2, 0x4e, 0x54, 0xfc, 0x94, 0xc2, 0x4a, 0xcc, 0x62, 0x0d, 0x6a, 0x46, 0x3c, 0x4d, 0x8b, 0xd1},
{0x5e, 0xfa, 0x64, 0xcb, 0xb4, 0x97, 0xbe, 0x2b, 0xbc, 0x77, 0x2e, 0x03, 0xd3, 0x19, 0x59, 0xc1},
{0x1d, 0x06, 0x41, 0x6b, 0x55, 0xf0, 0x99, 0x69, 0xea, 0x9c, 0x18, 0xae, 0x63, 0xdf, 0xe7, 0xbb},
{0x00, 0x73, 0x66, 0xfb, 0x96, 0x4c, 0x85, 0xe4, 0x3a, 0x09, 0x45, 0xaa, 0x0f, 0xee, 0x10, 0xeb},
{0x2d, 0x7f, 0xf4, 0x29, 0xac, 0xcf, 0xad, 0x91, 0x8d, 0x78, 0xc8, 0x95, 0xf9, 0x2f, 0xce, 0xcd},
{0x08, 0x7a, 0x88, 0x38, 0x5c, 0x83, 0x2a, 0x28, 0x47, 0xdb, 0xb8, 0xc7, 0x93, 0xa4, 0x12, 0x53},
{0xff, 0x87, 0x0e, 0x31, 0x36, 0x21, 0x58, 0x48, 0x01, 0x8e, 0x37, 0x74, 0x32, 0xca, 0xe9, 0xb1},
{0xb7, 0xab, 0x0c, 0xd7, 0xc4, 0x56, 0x42, 0x26, 0x07, 0x98, 0x60, 0xd9, 0xb6, 0xb9, 0x11, 0x40},
{0xec, 0x20, 0x8c, 0xbd, 0xa0, 0xc9, 0x84, 0x04, 0x49, 0x23, 0xf1, 0x4f, 0x50, 0x1f, 0x13, 0xdc},
{0xd8, 0xc0, 0x9e, 0x57, 0xe3, 0xc3, 0x7b, 0x65, 0x3b, 0x02, 0x8f, 0x3e, 0xe8, 0x25, 0x92, 0xe5},
{0x15, 0xdd, 0xfd, 0x17, 0xa9, 0xbf, 0xd4, 0x9a, 0x7e, 0xc5, 0x39, 0x67, 0xfe, 0x76, 0x9d, 0x43},
{0xa7, 0xe1, 0xd0, 0xf5, 0x68, 0xf2, 0x1b, 0x34, 0x70, 0x05, 0xa3, 0x8a, 0xd5, 0x79, 0x86, 0xa8},
{0x30, 0xc6, 0x51, 0x4b, 0x1e, 0xa6, 0x27, 0xf6, 0x35, 0xd2, 0x6e, 0x24, 0x16, 0x82, 0x5f, 0xda},
{0xe6, 0x75, 0xa2, 0xef, 0x2c, 0xb2, 0x1c, 0x9f, 0x5d, 0x6f, 0x80, 0x0a, 0x72, 0x44, 0x9b, 0x6c},
{0x90, 0x0b, 0x5b, 0x33, 0x7d, 0x5a, 0x52, 0xf3, 0x61, 0xa1, 0xf7, 0xb0, 0xd6, 0x3f, 0x7c, 0x6d},
{0xed, 0x14, 0xe0, 0xa5, 0x3d, 0x22, 0xb3, 0xf8, 0x89, 0xde, 0x71, 0x1a, 0xaf, 0xba, 0xb5, 0x81}};

unsigned char SBoxTwoRev[16][16] = {
{0x30, 0x68, 0x99, 0x1b, 0x87, 0xb9, 0x21, 0x78, 0x50, 0x39, 0xdb, 0xe1, 0x72, 0x09, 0x62, 0x3c},
{0x3e, 0x7e, 0x5e, 0x8e, 0xf1, 0xa0, 0xcc, 0xa3, 0x2a, 0x1d, 0xfb, 0xb6, 0xd6, 0x20, 0xc4, 0x8d},
{0x81, 0x65, 0xf5, 0x89, 0xcb, 0x9d, 0x77, 0xc6, 0x57, 0x43, 0x56, 0x17, 0xd4, 0x40, 0x1a, 0x4d},
{0xc0, 0x63, 0x6c, 0xe3, 0xb7, 0xc8, 0x64, 0x6a, 0x53, 0xaa, 0x38, 0x98, 0x0c, 0xf4, 0x9b, 0xed},
{0x7f, 0x22, 0x76, 0xaf, 0xdd, 0x3a, 0x0b, 0x58, 0x67, 0x88, 0x06, 0xc3, 0x35, 0x0d, 0x01, 0x8b},
{0x8c, 0xc2, 0xe6, 0x5f, 0x02, 0x24, 0x75, 0x93, 0x66, 0x1e, 0xe5, 0xe2, 0x54, 0xd8, 0x10, 0xce},
{0x7a, 0xe8, 0x08, 0x2c, 0x12, 0x97, 0x32, 0xab, 0xb4, 0x27, 0x0a, 0x23, 0xdf, 0xef, 0xca, 0xd9},
{0xb8, 0xfa, 0xdc, 0x31, 0x6b, 0xd1, 0xad, 0x19, 0x49, 0xbd, 0x51, 0x96, 0xee, 0xe4, 0xa8, 0x41},
{0xda, 0xff, 0xcd, 0x55, 0x86, 0x36, 0xbe, 0x61, 0x52, 0xf8, 0xbb, 0x0e, 0x82, 0x48, 0x69, 0x9a},
{0xe0, 0x47, 0x9e, 0x5c, 0x04, 0x4b, 0x34, 0x15, 0x79, 0x26, 0xa7, 0xde, 0x29, 0xae, 0x92, 0xd7},
{0x84, 0xe9, 0xd2, 0xba, 0x5d, 0xf3, 0xc5, 0xb0, 0xbf, 0xa4, 0x3b, 0x71, 0x44, 0x46, 0x2b, 0xfc},
{0xeb, 0x6f, 0xd5, 0xf6, 0x14, 0xfe, 0x7c, 0x70, 0x5a, 0x7d, 0xfd, 0x2f, 0x18, 0x83, 0x16, 0xa5},
{0x91, 0x1f, 0x05, 0x95, 0x74, 0xa9, 0xc1, 0x5b, 0x4a, 0x85, 0x6d, 0x13, 0x07, 0x4f, 0x4e, 0x45},
{0xb2, 0x0f, 0xc9, 0x1c, 0xa6, 0xbc, 0xec, 0x73, 0x90, 0x7b, 0xcf, 0x59, 0x8f, 0xa1, 0xf9, 0x2d},
{0xf2, 0xb1, 0x00, 0x94, 0x37, 0x9f, 0xd0, 0x2e, 0x9c, 0x6e, 0x28, 0x3f, 0x80, 0xf0, 0x3d, 0xd3},
{0x25, 0x8a, 0xb5, 0xe7, 0x42, 0xb3, 0xc7, 0xea, 0xf7, 0x4c, 0x11, 0x33, 0x03, 0xa2, 0xac, 0x60}};

unsigned char matrix[16][16] = {
{0, 0, 0, 1, 1, 0, 1, 0, 1, 1, 0, 0, 0, 1, 1, 0},
{0, 0, 1, 0, 0, 1, 0, 1, 1, 1, 0, 0, 1, 0, 0, 1},
{0, 1, 0, 0, 1, 0, 1, 0, 0, 0, 1, 1, 1, 0, 0, 1},
{1, 0, 0, 0, 0, 1, 0, 1, 0, 0, 1, 1, 0, 1, 1, 0},
{1, 0, 1, 0, 0, 1, 0, 0, 1, 0, 0, 1, 0, 0, 1, 1},
{0, 1, 0, 1, 1, 0, 0, 0, 0, 1, 1, 0, 0, 0, 1, 1},
{1, 0, 1, 0, 0, 0, 0, 1, 0, 1, 1, 0, 1, 1, 0, 0},
{0, 1, 0, 1, 0, 0, 1, 0, 1, 0, 0, 1, 1, 1, 0, 0},
{1, 1, 0, 0, 1, 0, 0, 1, 0, 0, 1, 0, 0, 1, 0, 1},
{1, 1, 0, 0, 0, 1, 1, 0, 0, 0, 0, 1, 1, 0, 1, 0},
{0, 0, 1, 1, 0, 1, 1, 0, 1, 0, 0, 0, 0, 1, 0, 1},
{0, 0, 1, 1, 1, 0, 0, 1, 0, 1, 0, 0, 1, 0, 1, 0},
{0, 1, 1, 0, 0, 0, 1, 1, 0, 1, 0, 1, 1, 0, 0, 0},
{1, 0, 0, 1, 0, 0, 1, 1, 1, 0, 1, 0, 0, 1, 0, 0},
{1, 0, 0, 1, 1, 1, 0, 0, 0, 1, 0, 1, 0, 0, 1, 0},
{0, 1, 1, 0, 1, 1, 0, 0, 1, 0, 1, 0, 0, 0, 0, 1}};

/*
the main entry of aria128.
mode -- the type ('e' for encrypt, 'd' for decrypt);
*/
int aria128( char mode);
/*
key scheduling function:
input:
key[] -- the master key, input
mode -- the type ('e' for encrypt, 'd' for decrypt);
output:
 ek[1...13] or dk[1...13] -- the keys
*/
void genKeys(const unsigned char key[], char mode);
/*
encryption/decryption function:
input:
thekeys[0...15][0...16] --加密 或 解密密鑰
output:
 cipher[] -- the cipher or the plaintext
*/
void crypt(unsigned char thekeys[16][16]);
/*
the copy function
input:
Lop[0...15], Ans[0...15];
output:
Ans[0...15] = Lop[0...15]
*/
void copy_128(unsigned char Lop[16],unsigned char Ans[16]);
/*
the xor function
input:
Lop[0...15], Rop[0...15], Ans[0...15]
ouput:
Ans[0...15] = Lop[0...15] XOR Rop[0...15]
*/
void Xor_128(unsigned char Lop[16],unsigned char Rop[16],unsigned char Ans[16] );
/*
SBox funtion
input:
input -- the num to parase
s_num -- the num of the SBox (1--SBoxOne, 2--SBoxOneRev, 3--SBoxTwo, 4-- SBoxTwoRev)
output:
the releted num in SBox
*/
unsigned char getSBox(unsigned char input, int s_num);
/*
SBox Layer Type One
*/
void SLOne(unsigned char Lop[16],unsigned char Ans[16]);
/*
SBox Layer Type Two
*/
void SLTwo(unsigned char Lop[16],unsigned char Ans[16]);
/*
function A -- the diffusion layer
*/
void funcA(unsigned char x[16],unsigned char Ans[16]);
/*
循環移位函數
輸入：
Lop[0...15] -- 待循環移位的操作數
num -- 循環移動的位數 （num爲正數是右移num，num爲負數時左移-num
輸出：
結果保留在Ans[0...15]
*/
void shiftNum(unsigned char Lop[16],int num, unsigned char Ans[16]);
/*
FO 與 FE 函數用於生成W[0...3]
*/
void FO(unsigned char Lop[16],unsigned char Rop[16],unsigned char Ans[16]);
void FE(unsigned char Lop[16],unsigned char Rop[16],unsigned char Ans[16]);

void show_128(unsigned char in[16], char str[15])
{
    /* int i = 0 ;
    printf("%15s: ", str);
    for(i = 0 ; i < 16 ; i++)
        printf("%02x",in[i]);
    printf("\n"); */
//  system("pause");
}
int main()
{
    int i = 0 ;
    char mode;
    printf("請選擇加解密方式(加密(e),解密(d))：");
    scanf("%c", &mode);

    printf("請輸入數據(16進制）：");
    for(i = 0 ; i < 16 ; i++)
    {
        scanf("%2x", plaintext + i);
    }
    printf("請輸入密鑰(16進制）：");
    for(i = 0 ; i < 16 ; i++)
    {
        scanf("%2x", keys + i);
    }
    show_128(keys, "key");
    show_128(plaintext, "plain");

    aria128(mode);
    printf("    對應的輸出:");
    for(i = 0 ; i < 16 ; i++)
        printf("%02x",cipher[i]);

/*  show_128(cipher, "cipher");
    printf("\n");
    copy_128(cipher, plaintext);
    show_128(plaintext, "cipher");
    aria128( 'd');
    show_128(cipher, "plaintext"); */
}

int aria128( char mode)
{
    genKeys(keys,mode);
    if(mode == 'd')
        crypt(dk);
    else
        crypt(ek);
}

/*
gen keys -- key scheduling
mode -- choose 'e' to encrypt , choose 'd' to decrypt
*/
void genKeys(const unsigned char key[] , char mode)
{
    int i = 0;
    //right padding 0
    for(i = KeyLen; i < 32; i++)
        keys[i] = 0;
    //set KL and KR
    for(i = 0 ; i < 16; i++)
    {
        KL[i] = keys[i];
        KR[i] = keys[i + 16];
    }
    show_128(KL,"KL");
    show_128(KR, "KR");
    //set CK
    copy_128(C[1], CK[1]);
    copy_128(C[2], CK[2]);
    copy_128(C[3], CK[3]);
    show_128(CK[1], "CK[1]");
    show_128(CK[2], "CK[3]");
    show_128(CK[3], "CK[3]");

    //set W[0...3]
    copy_128(KL, W[0]);
    show_128(W[0], "W[0]");
    unsigned char tmpAns[16];
    FO(W[0], CK[1], tmpAns);
    //show_128(tmpAns,"tmpAns");
    Xor_128(tmpAns, KR, W[1]);
    show_128(W[1], "W[1]");
    //maybe tmpAns should be cleared to 0s
    FE(W[1], CK[2], tmpAns);
    Xor_128(tmpAns, W[0], W[2]);
    show_128(W[2], "W[2]");

    FO(W[2], CK[3], tmpAns);
    Xor_128(tmpAns, W[1], W[3]);
    show_128(W[3], "W[3]");
    //gen encrypt keys
    int numtype[3] = {19,31,-61};//循環移位的大小
    int j;
    for(i = 0; i < 3; i++)
    {
        for(j = 0; j < 4; j++)
        {
            shiftNum(W[(j+1)%4],numtype[i],tmpAns);
            Xor_128(W[j],tmpAns, ek[i*4+j+1]);
        //  show_128(ek[i*4+j+1], "ek");
        }
    }
    shiftNum(W[1],-31,tmpAns);
    Xor_128(W[0],tmpAns, ek[13]);
    // gen decrypt keys
    if(mode == 'd')
    {
        for(i =0 ; i < 16 ; i++)
            dk[1][i] = ek[12+1][i];
        for(i = 2; i <= 12; i++)
            funcA(ek[12 - i + 2], dk[i]);
        for(i = 0 ; i <16 ; i++)
            dk[13][i] = ek[1][i];
    }
}
void crypt(unsigned char thekeys[16][16])
{
    int index = 1, i = 0;
    copy_128(plaintext, cipher);
    unsigned char tmpAns[16];
    for(index = 1; index < 12; index++)
    {
        Xor_128(cipher, thekeys[index], tmpAns);
        if(index % 2 == 1)
            SLOne(tmpAns, cipher);
        else
            SLTwo(tmpAns, cipher);
        funcA(cipher, tmpAns);
        copy_128(tmpAns, cipher);
    }
    Xor_128(cipher, thekeys[12], tmpAns);
    SLTwo(tmpAns, cipher);
    Xor_128(cipher, thekeys[12+1], tmpAns);
    copy_128(tmpAns, cipher);
}

void copy_128(unsigned char Lop[16],unsigned char Ans[16])
{
    int i = 0;
    for(i = 0 ; i < 16; i++)
    {
        Ans[i] = Lop[i];
    }
}
/*
Lop(128bit) xor Rop(128 bit) = Ans(128 bit);
*/
void Xor_128(unsigned char Lop[16],unsigned char Rop[16],unsigned char Ans[16] )
{
    int i = 0;
    for(i = 0; i < 16; i++)
    {
        Ans[i] = Lop[i]^Rop[i];
    }
}
/*
get sbox 1, 2, 3, 4
s_num -- the number of s box
*/
unsigned char getSBox(unsigned char input, int s_num)
{
    int row, col;
    row = (input >> 4);
    col = (input &0x0f);
    if(s_num == 1)
    {
        return SBoxOne[row][col];
    }
    else if(s_num == 2)
    {
        return SBoxOneRever[row][col];
    }
    else if(s_num == 3)
    {
        return SBoxTwo[row][col];
    }
    else
    {
        return SBoxTwoRev[row][col];
    }
}

/*
S layer type 1
*/
void SLOne(unsigned char Lop[16],unsigned char Ans[16])
{
    int type[4] = {1,3,2,4};
    int i = 0 ;
    for(i = 0 ; i < 16; i++)
    {
        Ans[i] = getSBox(Lop[i], type[i%4]);
    }
}

/*
S layer type 2
*/
void SLTwo(unsigned char Lop[16],unsigned char Ans[16])
{
    int type[4] = {2,4,1,3};
    int i = 0 ;
    for(i = 0 ; i < 16; i++)
    {
        Ans[i] = getSBox(Lop[i], type[i%4]);
    }
}
/*
function A
*/
void funcA(unsigned char x[16],unsigned char Ans[16])
{
    unsigned char tmpY[16];// tmp var to keep x
    int i = 0 , j = 0 ;
    for( i =0 ; i < 16; i++)
    {
        tmpY[i] = 0 ;
        for( j = 0 ; j < 16; j++)
        {
            if(matrix[i][j] == 1)
            {
                tmpY[i] ^= x[j];
            }
        }
    }
    for( i = 0 ; i < 16 ; i++)
    {
    //  x[i] = tmpY[i];
        Ans[i] = tmpY[i];
    }
}
/*
num + right rotate , - left rotate
and save to ans
*/
void shiftNum(unsigned char Lop[16],int num, unsigned char Ans[16])
{
    int i =0 , j = 0;
    for (i = 0 ; i < 16; i++)
        Ans[i] = 0;
    int row, col;
    for(i = 0; i < 16; i++)
    {
        for(j = 0; j < 8; j++)
        {
            row =((i<<3)+j + num +128)%128;
            col = row % 8;
            row = row / 8;
            int con = Lop[i]&(1<<(7-j));
            if(con != 0)
                Ans[row] |= (1<<(7-col));
        }
    }
}

void FO(unsigned char Lop[16],unsigned char Rop[16],unsigned char Ans[16])
{
    unsigned char tmpAnsOne[16], tmpAnsTwo[16];
    int i;
    for(i = 0; i < 16; i++)
    {
        tmpAnsOne[i] = 0 ;
        tmpAnsTwo[i] = 0 ;
    }
    Xor_128(Lop, Rop , tmpAnsOne);
//  show_128(tmpAnsOne, "tmpAnsOne");
    SLOne(tmpAnsOne, tmpAnsTwo);
//  show_128(tmpAnsTwo, "tmpAnsTwo");
    funcA(tmpAnsTwo, Ans);
//  show_128(Ans,"Ans");
}

void FE(unsigned char Lop[16],unsigned char Rop[16],unsigned char Ans[16])
{
    unsigned char tmpAnsOne[16], tmpAnsTwo[16];
    int i;
    for(i = 0; i < 16; i++)
    {
        tmpAnsOne[i] = 0 ;
        tmpAnsTwo[i] = 0 ;
    }
    Xor_128(Lop, Rop , tmpAnsOne);
    SLTwo(tmpAnsOne, tmpAnsTwo);
    funcA(tmpAnsTwo, Ans);
}