DES加解密演算法
阿新 • • 發佈：2022-05-28
#include "DES.h" #include <string.h> #define uchar unsigned char #define uint unsigned int uchar oo[4]={0,0,}; uchar pp[4]={0,0,}; uchar fnc[4]={0,0,0,0}; uchar enckey[96]={0,0,}; uchar deckey[96]={0,0,}; const uchar S_BOX1[64]= { 0xe,0x0,0x4,0xf,0xd,0x7,0x1,0x4, 0x2,0xe,0xf,0x2,0xb,0xd,0x8,0x1, 0x3,0xa,0xa,0x6,0x6,0xc,0xc,0xb, 0x5,0x9,0x9,0x5,0x0,0x3,0x7,0x8, 0x4,0xf,0x1,0xc,0xe,0x8,0x8,0x2, 0xd,0x4,0x6,0x9,0x2,0x1,0xb,0x7, 0xf,0x5,0xc,0xb,0x9,0x3,0x7,0xe, 0x3,0xa,0xa,0x0,0x5,0x6,0x0,0xd, }, S_BOX2[64]= { 0xf,0x3,0x1,0xd,0x8,0x4,0xe,0x7, 0x6,0xf,0xb,0x2,0x3,0x8,0x4,0xe,0x9,0xc,0x7,0x0,0x2,0x1,0xd,0xa, 0xc,0x6,0x0,0x9,0x5,0xb,0xa,0x5, 0x0,0xd,0xe,0x8,0x7,0xa,0xb,0x1, 0xa,0x3,0x4,0xf,0xd,0x4,0x1,0x2, 0x5,0xb,0x8,0x6,0xc,0x7,0x6,0xc, 0x9,0x0,0x3,0x5,0x2,0xe,0xf,0x9, }, S_BOX3[64]= { 0xa,0xd,0x0,0x7,0x9,0x0,0xe,0x9, 0x6,0x3,0x3,0x4,0xf,0x6,0x5,0xa, 0x1,0x2,0xd,0x8,0xc,0x5,0x7,0xe, 0xb,0xc,0x4,0xb,0x2,0xf,0x8,0x1, 0xd,0x1,0x6,0xa,0x4,0xd,0x9,0x0, 0x8,0x6,0xf,0x9,0x3,0x8,0x0,0x7, 0xb,0x4,0x1,0xf,0x2,0xe,0xc,0x3, 0x5,0xb,0xa,0x5,0xe,0x2,0x7,0xc, }, S_BOX4[64]= { 0x7,0xd,0xd,0x8,0xe,0xb,0x3,0x5, 0x0,0x6,0x6,0xf,0x9,0x0,0xa,0x3, 0x1,0x4,0x2,0x7,0x8,0x2,0x5,0xc, 0xb,0x1,0xc,0xa,0x4,0xe,0xf,0x9, 0xa,0x3,0x6,0xf,0x9,0x0,0x0,0x6, 0xc,0xa,0xb,0x1,0x7,0xd,0xd,0x8, 0xf,0x9,0x1,0x4,0x3,0x5,0xe,0xb, 0x5,0xc,0x2,0x7,0x8,0x2,0x4,0xe, }, S_BOX5[64]= { 0x2,0xe,0xc,0xb,0x4,0x2,0x1,0xc, 0x7,0x4,0xa,0x7,0xb,0xd,0x6,0x1, 0x8,0x5,0x5,0x0,0x3,0xf,0xf,0xa, 0xd,0x3,0x0,0x9,0xe,0x8,0x9,0x6, 0x4,0xb,0x2,0x8,0x1,0xc,0xb,0x7, 0xa,0x1,0xd,0xe,0x7,0x2,0x8,0xd, 0xf,0x6,0x9,0xf,0xc,0x0,0x5,0x9, 0x6,0xa,0x3,0x4,0x0,0x5,0xe,0x3, }, S_BOX6[64]= { 0xc,0xa,0x1,0xf,0xa,0x4,0xf,0x2, 0x9,0x7,0x2,0xc,0x6,0x9,0x8,0x5, 0x0,0x6,0xd,0x1,0x3,0xd,0x4,0xe, 0xe,0x0,0x7,0xb,0x5,0x3,0xb,0x8, 0x9,0x4,0xe,0x3,0xf,0x2,0x5,0xc, 0x2,0x9,0x8,0x5,0xc,0xf,0x3,0xa, 0x7,0xb,0x0,0xe,0x4,0x1,0xa,0x7, 0x1,0x6,0xd,0x0,0xb,0x8,0x6,0xd, }, S_BOX7[64]= { 0x4,0xd,0xb,0x0,0x2,0xb,0xe,0x7, 0xf,0x4,0x0,0x9,0x8,0x1,0xd,0xa, 0x3,0xe,0xc,0x3,0x9,0x5,0x7,0xc, 0x5,0x2,0xa,0xf,0x6,0x8,0x1,0x6, 0x1,0x6,0x4,0xb,0xb,0xd,0xd,0x8, 0xc,0x1,0x3,0x4,0x7,0xa,0xe,0x7, 0xa,0x9,0xf,0x5,0x6,0x0,0x8,0xf, 0x0,0xe,0x5,0x2,0x9,0x3,0x2,0xc, }, S_BOX8[64]= { 0xd,0x1,0x2,0xf,0x8,0xd,0x4,0x8, 0x6,0xa,0xf,0x3,0xb,0x7,0x1,0x4, 0xa,0xc,0x9,0x5,0x3,0x6,0xe,0xb, 0x5,0x0,0x0,0xe,0xc,0x9,0x7,0x2, 0x7,0x2,0xb,0x1,0x4,0xe,0x1,0x7, 0x9,0x4,0xc,0xa,0xe,0x8,0x2,0xd, 0x0,0xf,0x6,0xc,0xa,0x9,0xd,0x0, 0xf,0x3,0x3,0x5,0x5,0x6,0x8,0xb, }; void SubKey_Generation(uchar *key) { uchar i,j; uchar skey[6]={0,0,}; uchar ls[16]={1,1,2,2,2,2,2,2,1,2,2,2,2,2,2,1}; uchar lk[4]={0,0,0,0}; uchar rk[4]={0,0,0,0}; memset (lk, 0, 4); memset (rk, 0, 4); // now PC1 permutation lk[3] = (lk[3] | (key[7] >> 7 & 0x01)) << 1; // lk[3] = (lk[3] | (key[6] >> 7 & 0x01)) << 1; lk[3] = (lk[3] | (key[5] >> 7 & 0x01)) << 1; lk[3] = (lk[3] | (key[4] >> 7 & 0x01)); lk[2] = (lk[2] | (key[3] >> 7 & 0x01)) << 1; lk[2] = (lk[2] | (key[2] >> 7 & 0x01)) << 1; lk[2] = (lk[2] | (key[1] >> 7 & 0x01)) << 1; lk[2] = (lk[2] | (key[0] >> 7 & 0x01)) << 1; lk[2] = (lk[2] | (key[7] >> 6 & 0x01)) << 1; lk[2] = (lk[2] | (key[6] >> 6 & 0x01)) << 1; lk[2] = (lk[2] | (key[5] >> 6 & 0x01)) << 1; lk[2] = (lk[2] | (key[4] >> 6 & 0x01)); lk[1] = (lk[1] | (key[3] >> 6 & 0x01)) << 1; lk[1] = (lk[1] | (key[2] >> 6 & 0x01)) << 1; lk[1] = (lk[1] | (key[1] >> 6 & 0x01)) << 1; lk[1] = (lk[1] | (key[0] >> 6 & 0x01)) << 1; lk[1] = (lk[1] | (key[7] >> 5 & 0x01)) << 1; lk[1] = (lk[1] | (key[6] >> 5 & 0x01)) << 1; lk[1] = (lk[1] | (key[5] >> 5 & 0x01)) << 1; lk[1] = (lk[1] | (key[4] >> 5 & 0x01)); lk[0] = (lk[0] | (key[3] >> 5 & 0x01)) << 1; lk[0] = (lk[0] | (key[2] >> 5 & 0x01)) << 1; lk[0] = (lk[0] | (key[1] >> 5 & 0x01)) << 1; lk[0] = (lk[0] | (key[0] >> 5 & 0x01)) << 1; lk[0] = (lk[0] | (key[7] >> 4 & 0x01)) << 1; lk[0] = (lk[0] | (key[6] >> 4 & 0x01)) << 1; lk[0] = (lk[0] | (key[5] >> 4 & 0x01)) << 1; lk[0] = (lk[0] | (key[4] >> 4 & 0x01)); rk[3] = (rk[3] | (key[7] >> 1 & 0x01)) << 1; rk[3] = (rk[3] | (key[6] >> 1 & 0x01)) << 1; rk[3] = (rk[3] | (key[5] >> 1 & 0x01)) << 1; rk[3] = (rk[3] | (key[4] >> 1 & 0x01)); rk[2] = (rk[2] | (key[3] >> 1 & 0x01)) << 1; rk[2] = (rk[2] | (key[2] >> 1 & 0x01)) << 1; rk[2] = (rk[2] | (key[1] >> 1 & 0x01)) << 1; rk[2] = (rk[2] | (key[0] >> 1 & 0x01)) << 1; rk[2] = (rk[2] | (key[7] >> 2 & 0x01)) << 1; rk[2] = (rk[2] | (key[6] >> 2 & 0x01)) << 1; rk[2] = (rk[2] | (key[5] >> 2 & 0x01)) << 1; rk[2] = (rk[2] | (key[4] >> 2 & 0x01)); rk[1] = (rk[1] | (key[3] >> 2 & 0x01)) << 1; rk[1] = (rk[1] | (key[2] >> 2 & 0x01)) << 1; rk[1] = (rk[1] | (key[1] >> 2 & 0x01)) << 1; rk[1] = (rk[1] | (key[0] >> 2 & 0x01)) << 1; rk[1] = (rk[1] | (key[7] >> 3 & 0x01)) << 1; rk[1] = (rk[1] | (key[6] >> 3 & 0x01)) << 1; rk[1] = (rk[1] | (key[5] >> 3 & 0x01)) << 1; rk[1] = (rk[1] | (key[4] >> 3 & 0x01)); rk[0] = (rk[0] | (key[3] >> 3 & 0x01)) << 1; rk[0] = (rk[0] | (key[2] >> 3 & 0x01)) << 1; rk[0] = (rk[0] | (key[1] >> 3 & 0x01)) << 1; rk[0] = (rk[0] | (key[0] >> 3 & 0x01)) << 1; rk[0] = (rk[0] | (key[3] >> 4 & 0x01)) << 1; rk[0] = (rk[0] | (key[2] >> 4 & 0x01)) << 1; rk[0] = (rk[0] | (key[1] >> 4 & 0x01)) << 1; rk[0] = (rk[0] | (key[0] >> 4 & 0x01)); lk[3] &= 0x0F; rk[3] &= 0x0F; for(i=0; i<=16; i++) { j = 6*i; skey[5]=0; skey[4]=0; skey[3]=0; skey[2]=0; skey[1]=0; skey[0]=0; if(ls[i] == 1) { lk[3] = (lk[3] << 1 | lk[2] >> 7); lk[2] = (lk[2] << 1 | lk[1] >> 7); lk[1] = (lk[1] << 1 | lk[0] >> 7); lk[0] = (lk[0] << 1 | lk[3] >> 4); lk[3] &= 0x0F; rk[3] = (rk[3] << 1 | rk[2] >> 7); rk[2] = (rk[2] << 1 | rk[1] >> 7); rk[1] = (rk[1] << 1 | rk[0] >> 7); rk[0] = (rk[0] << 1 | rk[3] >> 4); rk[3] &= 0x0F; } else // ls[i] == 2 { lk[3] = (lk[3] << 2 | lk[2] >> 6); lk[2] = (lk[2] << 2 | lk[1] >> 6); lk[1] = (lk[1] << 2 | lk[0] >> 6); lk[0] = (lk[0] << 2 | lk[3] >> 4); lk[3] &= 0x0F; rk[3] = (rk[3] << 2 | rk[2] >> 6); rk[2] = (rk[2] << 2 | rk[1] >> 6); rk[1] = (rk[1] << 2 | rk[0] >> 6); rk[0] = (rk[0] << 2 | rk[3] >> 4); rk[3] &= 0x0F; } // now PC2 permutation skey[5] = (skey[5] | (lk[1] >> 6 & 0x01)) << 1; skey[5] = (skey[5] | (lk[1] >> 3 & 0x01)) << 1; skey[5] = (skey[5] | (lk[2] >> 1 & 0x01)) << 1; skey[5] = (skey[5] | (lk[0] >> 4 & 0x01)) << 1; skey[5] = (skey[5] | (lk[3] >> 3 & 0x01)) << 1; skey[5] = (skey[5] | (lk[2] >> 7 & 0x01)) << 1; skey[5] = (skey[5] | (lk[3] >> 1 & 0x01)) << 1; skey[5] = (skey[5] | (lk[0] & 0x01)); enckey[j+5] = skey[5]; skey[4] = (skey[4] | (lk[1] >> 5 & 0x01)) << 1; skey[4] = (skey[4] | (lk[2] >> 6 & 0x01)) << 1; skey[4] = (skey[4] | (lk[0] >> 7 & 0x01)) << 1; skey[4] = (skey[4] | (lk[2] >> 2 & 0x01)) << 1; skey[4] = (skey[4] | (lk[0] >> 5 & 0x01)) << 1; skey[4] = (skey[4] | (lk[1] >> 1 & 0x01)) << 1; skey[4] = (skey[4] | (lk[2] & 0x01)) << 1; skey[4] = (skey[4] | (lk[3] & 0x01)); enckey[j+4] = skey[4]; skey[3] = (skey[3] | (lk[0] >> 2 & 0x01)) << 1; skey[3] = (skey[3] | (lk[2] >> 4 & 0x01)) << 1; skey[3] = (skey[3] | (lk[1] >> 4 & 0x01)) << 1; skey[3] = (skey[3] | (lk[2] >> 5 & 0x01)) << 1; skey[3] = (skey[3] | (lk[0] >> 1 & 0x01)) << 1; skey[3] = (skey[3] | (lk[1] & 0x01)) << 1; skey[3] = (skey[3] | (lk[1] >> 7 & 0x01)) << 1; skey[3] = (skey[3] | (lk[3] >> 2 & 0x01)); enckey[j+3] = skey[3]; skey[2] = (skey[2] | (rk[1] >> 7 & 0x01)) << 1; skey[2] = (skey[2] | (rk[0] >> 4 & 0x01)) << 1; skey[2] = (skey[2] | (rk[3] >> 1 & 0x01)) << 1; skey[2] = (skey[2] | (rk[2] >> 3 & 0x01)) << 1; skey[2] = (skey[2] | (rk[1] >> 1 & 0x01)) << 1; skey[2] = (skey[2] | (rk[0] >> 1 & 0x01)) << 1; skey[2] = (skey[2] | (rk[3] >> 2 & 0x01)) << 1; skey[2] = (skey[2] | (rk[2] & 0x01)); enckey[j+2] = skey[2]; skey[1] = (skey[1] | (rk[0] >> 5 & 0x01)) << 1; skey[1] = (skey[1] | (rk[1] >> 3 & 0x01)) << 1; skey[1] = (skey[1] | (rk[2] >> 7 & 0x01)) << 1; skey[1] = (skey[1] | (rk[1] & 0x01)) << 1; skey[1] = (skey[1] | (rk[1] >> 4 & 0x01)) << 1; skey[1] = (skey[1] | (rk[0] >> 7 & 0x01)) << 1; skey[1] = (skey[1] | (rk[2] >> 1 & 0x01)) << 1; skey[1] = (skey[1] | (rk[0] & 0x01)); enckey[j+1] = skey[1]; skey[0] = (skey[0] | (rk[2] >> 6 & 0x01)) << 1; skey[0] = (skey[0] | (rk[0] >> 3 & 0x01)) << 1; skey[0] = (skey[0] | (rk[1] >> 2 & 0x01)) << 1; skey[0] = (skey[0] | (rk[1] >> 6 & 0x01)) << 1; skey[0] = (skey[0] | (rk[0] >> 6 & 0x01)) << 1; skey[0] = (skey[0] | (rk[2] >> 4 & 0x01)) << 1; skey[0] = (skey[0] | (rk[3] >> 3 & 0x01)) << 1; skey[0] = (skey[0] | (rk[3] & 0x01)); enckey[j] = skey[0]; } for(i=0;i<8;i++) // create decription subkeys... { memcpy(deckey+6*i, enckey+(90-6*i), 6); memcpy(deckey+(90-6*i), enckey+6*i, 6); } } void IniPer(uchar *src) { memset(oo, 0, 4); memset(pp, 0, 4); // oo[3] = src[7].6 | src[6].6 | src[5].6 | src[4].6 | src[3].6 | src[2].6 | src[1].6 | src[0].6; oo[3] = (oo[3] | (src[7] >> 6 & 0x01)) << 1; oo[3] = (oo[3] | (src[6] >> 6 & 0x01)) << 1; oo[3] = (oo[3] | (src[5] >> 6 & 0x01)) << 1; oo[3] = (oo[3] | (src[4] >> 6 & 0x01)) << 1; oo[3] = (oo[3] | (src[3] >> 6 & 0x01)) << 1; oo[3] = (oo[3] | (src[2] >> 6 & 0x01)) << 1; oo[3] = (oo[3] | (src[1] >> 6 & 0x01)) << 1; oo[3] = (oo[3] | (src[0] >> 6 & 0x01)); // oo[2] = src[7].4 | src[6].4 | src[5].4 | src[4].4 | src[3].4 | src[2].4 | src[1].4 | src[0].4; oo[2] = (oo[2] | (src[7] >> 4 & 0x01)) << 1; oo[2] = (oo[2] | (src[6] >> 4 & 0x01)) << 1; oo[2] = (oo[2] | (src[5] >> 4 & 0x01)) << 1; oo[2] = (oo[2] | (src[4] >> 4 & 0x01)) << 1; oo[2] = (oo[2] | (src[3] >> 4 & 0x01)) << 1; oo[2] = (oo[2] | (src[2] >> 4 & 0x01)) << 1; oo[2] = (oo[2] | (src[1] >> 4 & 0x01)) << 1; oo[2] = (oo[2] | (src[0] >> 4 & 0x01)); // oo[1] = src[7].2 | src[6].2 | src[5].2 | src[4].2 | src[3].2 | src[2].2 | src[1].2 | src[0].2; oo[1] = (oo[1] | (src[7] >> 2 & 0x01)) << 1; oo[1] = (oo[1] | (src[6] >> 2 & 0x01)) << 1; oo[1] = (oo[1] | (src[5] >> 2 & 0x01)) << 1; oo[1] = (oo[1] | (src[4] >> 2 & 0x01)) << 1; oo[1] = (oo[1] | (src[3] >> 2 & 0x01)) << 1; oo[1] = (oo[1] | (src[2] >> 2 & 0x01)) << 1; oo[1] = (oo[1] | (src[1] >> 2 & 0x01)) << 1; oo[1] = (oo[1] | (src[0] >> 2 & 0x01)); // oo[0] = src[7].0 | src[6].0 | src[5].0 | src[4].0 | src[3].0 | src[2].0 | src[1].0 | src[0].0; oo[0] = (oo[0] | (src[7] & 0x01)) << 1; oo[0] = (oo[0] | (src[6] & 0x01)) << 1; oo[0] = (oo[0] | (src[5] & 0x01)) << 1; oo[0] = (oo[0] | (src[4] & 0x01)) << 1; oo[0] = (oo[0] | (src[3] & 0x01)) << 1; oo[0] = (oo[0] | (src[2] & 0x01)) << 1; oo[0] = (oo[0] | (src[1] & 0x01)) << 1; oo[0] = (oo[0] | (src[0] & 0x01)); // pp[3] = src[7].7 | src[6].7 | src[5].7 | src[4].7 | src[3].7 | src[2].7 | src[1].7 | src[0].7; pp[3] = (pp[3] | (src[7] >> 7 & 0x01)) << 1; pp[3] = (pp[3] | (src[6] >> 7 & 0x01)) << 1; pp[3] = (pp[3] | (src[5] >> 7 & 0x01)) << 1; pp[3] = (pp[3] | (src[4] >> 7 & 0x01)) << 1; pp[3] = (pp[3] | (src[3] >> 7 & 0x01)) << 1; pp[3] = (pp[3] | (src[2] >> 7 & 0x01)) << 1; pp[3] = (pp[3] | (src[1] >> 7 & 0x01)) << 1; pp[3] = (pp[3] | (src[0] >> 7 & 0x01)); // pp[2] = src[7].5 | src[6].5 | src[5].5 | src[4].5 | src[3].5 | src[2].5 | src[1].5 | src[0].5; pp[2] = (pp[2] | (src[7] >> 5 & 0x01)) << 1; pp[2] = (pp[2] | (src[6] >> 5 & 0x01)) << 1; pp[2] = (pp[2] | (src[5] >> 5 & 0x01)) << 1; pp[2] = (pp[2] | (src[4] >> 5 & 0x01)) << 1; pp[2] = (pp[2] | (src[3] >> 5 & 0x01)) << 1; pp[2] = (pp[2] | (src[2] >> 5 & 0x01)) << 1; pp[2] = (pp[2] | (src[1] >> 5 & 0x01)) << 1; pp[2] = (pp[2] | (src[0] >> 5 & 0x01)); // pp[1] = src[7].3 | src[6].3 | src[5].3 | src[4].3 | src[3].3 | src[2].3 | src[1].3 | src[0].3; pp[1] = (pp[1] | (src[7] >> 3 & 0x01)) << 1; pp[1] = (pp[1] | (src[6] >> 3 & 0x01)) << 1; pp[1] = (pp[1] | (src[5] >> 3 & 0x01)) << 1; pp[1] = (pp[1] | (src[4] >> 3 & 0x01)) << 1; pp[1] = (pp[1] | (src[3] >> 3 & 0x01)) << 1; pp[1] = (pp[1] | (src[2] >> 3 & 0x01)) << 1; pp[1] = (pp[1] | (src[1] >> 3 & 0x01)) << 1; pp[1] = (pp[1] | (src[0] >> 3 & 0x01)); // pp[0] = src[7].1 | src[6].1 | src[5].1 | src[4].1 | src[3].1 | src[2].1 | src[1].1 | src[0].1; pp[0] = (pp[0] | (src[7] >> 1 & 0x01)) << 1; pp[0] = (pp[0] | (src[6] >> 1 & 0x01)) << 1; pp[0] = (pp[0] | (src[5] >> 1 & 0x01)) << 1; pp[0] = (pp[0] | (src[4] >> 1 & 0x01)) << 1; pp[0] = (pp[0] | (src[3] >> 1 & 0x01)) << 1; pp[0] = (pp[0] | (src[2] >> 1 & 0x01)) << 1; pp[0] = (pp[0] | (src[1] >> 1 & 0x01)) << 1; pp[0] = (pp[0] | (src[0] >> 1 & 0x01)); } void desfun(uchar *subkey) { uchar blck[9]={0,0,0,}; memset(blck, 0, 9); fnc[0] = 0; fnc[1] = 0; fnc[2] = 0; fnc[3] = 0; blck[8] = (pp[0] & 0x0F) << 1; blck[7] = (pp[0] >> 4 & 0x0F) << 1; blck[6] = (pp[1] & 0x0F) << 1; blck[5] = (pp[1] >> 4 & 0x0F) << 1; blck[4] = (pp[2] & 0x0F) << 1; blck[3] = (pp[2] >> 4 & 0x0F) << 1; blck[2] = (pp[3] & 0x0F) << 1; blck[1] = (pp[3] >> 4 & 0x0F) << 1; blck[1] |= (blck[8] & 0x02) << 4; blck[1] |= (blck[2] & 0x10) >> 4; blck[2] |= (blck[1] & 0x02) << 4; blck[2] |= (blck[3] & 0x10) >> 4; blck[3] |= (blck[2] & 0x02) << 4; blck[3] |= (blck[4] & 0x10) >> 4; blck[4] |= (blck[3] & 0x02) << 4; blck[4] |= (blck[5] & 0x10) >> 4; blck[5] |= (blck[4] & 0x02) << 4; blck[5] |= (blck[6] & 0x10) >> 4; blck[6] |= (blck[5] & 0x02) << 4; blck[6] |= (blck[7] & 0x10) >> 4; blck[7] |= (blck[6] & 0x02) << 4; blck[7] |= (blck[8] & 0x10) >> 4; blck[8] |= (blck[7] & 0x02) << 4; blck[8] |= (blck[1] & 0x10) >> 4; blck[1] ^= (subkey[5] & 0xfc) >> 2; blck[2] ^= ((subkey[5] & 0x03) << 4) | ((subkey[4] & 0xf0) >> 4); blck[3] ^= ((subkey[4] & 0x0f) << 2) | ((subkey[3] & 0xc0) >> 6); blck[4] ^= subkey[3] & 0x3f; blck[5] ^= (subkey[2] & 0xfc) >> 2; blck[6] ^= ((subkey[2] & 0x03) << 4) | ((subkey[1] & 0xf0) >> 4); blck[7] ^= ((subkey[1] & 0x0f) << 2) | ((subkey[0] & 0xc0) >> 6); blck[8] ^= subkey[0] & 0x3f; blck[1] = S_BOX1[blck[1]]; blck[2] = S_BOX2[blck[2]]; blck[3] = S_BOX3[blck[3]]; blck[4] = S_BOX4[blck[4]]; blck[5] = S_BOX5[blck[5]]; blck[6] = S_BOX6[blck[6]]; blck[7] = S_BOX7[blck[7]]; blck[8] = S_BOX8[blck[8]]; //fnc[3] = b[4].0 | b[2].1 | b[5].0 | b[6].3 | b[8].3 | b[3].0 | b[7].0 | b[5].3; fnc[3] = (fnc[3] | (blck[4] & 0x01)) << 1; fnc[3] = (fnc[3] | (blck[2] >> 1 & 0x01)) << 1; fnc[3] = (fnc[3] | (blck[5] & 0x01)) << 1; fnc[3] = (fnc[3] | (blck[6] >> 3 & 0x01)) << 1; fnc[3] = (fnc[3] | (blck[8] >> 3 & 0x01)) << 1; fnc[3] = (fnc[3] | (blck[3] & 0x01)) << 1; fnc[3] = (fnc[3] | (blck[7] & 0x01)) << 1; fnc[3] = (fnc[3] | (blck[5] >> 3 & 0x01)); //fnc[2] = b[1].3 | b[4].1 | b[6].1 | b[7].2 | b[2].3 | b[5].2 | b[8].1 | b[3].2; fnc[2] = (fnc[2] | (blck[1] >> 3 & 0x01)) << 1; fnc[2] = (fnc[2] | (blck[4] >> 1 & 0x01)) << 1; fnc[2] = (fnc[2] | (blck[6] >> 1 & 0x01)) << 1; fnc[2] = (fnc[2] | (blck[7] >> 2 & 0x01)) << 1; fnc[2] = (fnc[2] | (blck[2] >> 3 & 0x01)) << 1; fnc[2] = (fnc[2] | (blck[5] >> 2 & 0x01)) << 1; fnc[2] = (fnc[2] | (blck[8] >> 1 & 0x01)) << 1; fnc[2] = (fnc[2] | (blck[3] >> 2 & 0x01)); //fnc[1] = b[1].2 | b[2].0 | b[6].0 | b[4].2 | b[8].0 | b[7].1 | b[1].1 | b[3].3; fnc[1] = (fnc[1] | (blck[1] >> 2 & 0x01)) << 1; fnc[1] = (fnc[1] | (blck[2] & 0x01)) << 1; fnc[1] = (fnc[1] | (blck[6] & 0x01)) << 1; fnc[1] = (fnc[1] | (blck[4] >> 2 & 0x01)) << 1; fnc[1] = (fnc[1] | (blck[8] & 0x01)) << 1; fnc[1] = (fnc[1] | (blck[7] >> 1 & 0x01)) << 1; fnc[1] = (fnc[1] | (blck[1] >> 1 & 0x01)) << 1; fnc[1] = (fnc[1] | (blck[3] >> 3 & 0x01)); //fnc[0] = b[5].1 | b[4].3 | b[8].2 | b[2].2 | b[6].2 | b[3].1 | b[1].0 | b[7].3; fnc[0] = (fnc[0] | (blck[5] >> 1 & 0x01)) << 1; fnc[0] = (fnc[0] | (blck[4] >> 3 & 0x01)) << 1; fnc[0] = (fnc[0] | (blck[8] >> 2 & 0x01)) << 1; fnc[0] = (fnc[0] | (blck[2] >> 2 & 0x01)) << 1; fnc[0] = (fnc[0] | (blck[6] >> 2 & 0x01)) << 1; fnc[0] = (fnc[0] | (blck[3] >> 1 & 0x01)) << 1; fnc[0] = (fnc[0] | (blck[1] & 0x01)) << 1; fnc[0] = (fnc[0] | (blck[7] >> 3 & 0x01)); } void FinalPer(uchar *result) { memset(result, 0, 8); // result[0] = pp[3].0 | oo[3].0 | pp[2].0 | oo[2].0 | pp[1].0 | oo[1].0 | pp[0].0 | oo[0].0; result[0] = (result[0] | (pp[3] & 0x01)) << 1; result[0] = (result[0] | (oo[3] & 0x01)) << 1; result[0] = (result[0] | (pp[2] & 0x01)) << 1; result[0] = (result[0] | (oo[2] & 0x01)) << 1; result[0] = (result[0] | (pp[1] & 0x01)) << 1; result[0] = (result[0] | (oo[1] & 0x01)) << 1; result[0] = (result[0] | (pp[0] & 0x01)) << 1; result[0] = (result[0] | (oo[0] & 0x01)); // result[1] = pp[3].1 | oo[3].1 | pp[2].1 | oo[2].1 | pp[1].1 | oo[1].1 | pp[0].1 | oo[0].1; result[1] = (result[1] | (pp[3] >> 1 & 0x01)) << 1; result[1] = (result[1] | (oo[3] >> 1 & 0x01)) << 1; result[1] = (result[1] | (pp[2] >> 1 & 0x01)) << 1; result[1] = (result[1] | (oo[2] >> 1 & 0x01)) << 1; result[1] = (result[1] | (pp[1] >> 1 & 0x01)) << 1; result[1] = (result[1] | (oo[1] >> 1 & 0x01)) << 1; result[1] = (result[1] | (pp[0] >> 1 & 0x01)) << 1; result[1] = (result[1] | (oo[0] >> 1 & 0x01)); // result[2] = pp[3].2 | oo[3].2 | pp[2].2 | oo[2].2 | pp[1].2 | oo[1].2 | pp[0].2 | oo[0].2; result[2] = (result[2] | (pp[3] >> 2 & 0x01)) << 1; result[2] = (result[2] | (oo[3] >> 2 & 0x01)) << 1; result[2] = (result[2] | (pp[2] >> 2 & 0x01)) << 1; result[2] = (result[2] | (oo[2] >> 2 & 0x01)) << 1; result[2] = (result[2] | (pp[1] >> 2 & 0x01)) << 1; result[2] = (result[2] | (oo[1] >> 2 & 0x01)) << 1; result[2] = (result[2] | (pp[0] >> 2 & 0x01)) << 1; result[2] = (result[2] | (oo[0] >> 2 & 0x01)); // result[3] = pp[3].3 | oo[3].3 | pp[2].3 | oo[2].3 | pp[1].3 | oo[1].3 | pp[0].3 | oo[0].3; result[3] = (result[3] | (pp[3] >> 3 & 0x01)) << 1; result[3] = (result[3] | (oo[3] >> 3 & 0x01)) << 1; result[3] = (result[3] | (pp[2] >> 3 & 0x01)) << 1; result[3] = (result[3] | (oo[2] >> 3 & 0x01)) << 1; result[3] = (result[3] | (pp[1] >> 3 & 0x01)) << 1; result[3] = (result[3] | (oo[1] >> 3 & 0x01)) << 1; result[3] = (result[3] | (pp[0] >> 3 & 0x01)) << 1; result[3] = (result[3] | (oo[0] >> 3 & 0x01)); // result[4] = pp[3].4 | oo[3].4 | pp[2].4 | oo[2].4 | pp[1].4 | oo[1].4 | pp[0].4 | oo[0].4; result[4] = (result[4] | (pp[3] >> 4 & 0x01)) << 1; result[4] = (result[4] | (oo[3] >> 4 & 0x01)) << 1; result[4] = (result[4] | (pp[2] >> 4 & 0x01)) << 1; result[4] = (result[4] | (oo[2] >> 4 & 0x01)) << 1; result[4] = (result[4] | (pp[1] >> 4 & 0x01)) << 1; result[4] = (result[4] | (oo[1] >> 4 & 0x01)) << 1; result[4] = (result[4] | (pp[0] >> 4 & 0x01)) << 1; result[4] = (result[4] | (oo[0] >> 4 & 0x01)); // result[5] = pp[3].5 | oo[3].5 | pp[2].5 | oo[2].5 | pp[1].5 | oo[1].5 | pp[0].5 | oo[0].5; result[5] = (result[5] | (pp[3] >> 5 & 0x01)) << 1; result[5] = (result[5] | (oo[3] >> 5 & 0x01)) << 1; result[5] = (result[5] | (pp[2] >> 5 & 0x01)) << 1; result[5] = (result[5] | (oo[2] >> 5 & 0x01)) << 1; result[5] = (result[5] | (pp[1] >> 5 & 0x01)) << 1; result[5] = (result[5] | (oo[1] >> 5 & 0x01)) << 1; result[5] = (result[5] | (pp[0] >> 5 & 0x01)) << 1; result[5] = (result[5] | (oo[0] >> 5 & 0x01)); // result[6] = pp[3].6 | oo[3].6 | pp[2].6 | oo[2].6 | pp[1].6 | oo[1].6 | pp[0].6 | oo[0].6; result[6] = (result[6] | (pp[3] >> 6 & 0x01)) << 1; result[6] = (result[6] | (oo[3] >> 6 & 0x01)) << 1; result[6] = (result[6] | (pp[2] >> 6 & 0x01)) << 1; result[6] = (result[6] | (oo[2] >> 6 & 0x01)) << 1; result[6] = (result[6] | (pp[1] >> 6 & 0x01)) << 1; result[6] = (result[6] | (oo[1] >> 6 & 0x01)) << 1; result[6] = (result[6] | (pp[0] >> 6 & 0x01)) << 1; result[6] = (result[6] | (oo[0] >> 6 & 0x01)); // result[7] = pp[3].7 | oo[3].7 | pp[2].7 | oo[2].7 | pp[1].7 | oo[1].7 | pp[0].7 | oo[0].7; result[7] = (result[7] | (pp[3] >> 7 & 0x01)) << 1; result[7] = (result[7] | (oo[3] >> 7 & 0x01)) << 1; result[7] = (result[7] | (pp[2] >> 7 & 0x01)) << 1; result[7] = (result[7] | (oo[2] >> 7 & 0x01)) << 1; result[7] = (result[7] | (pp[1] >> 7 & 0x01)) << 1; result[7] = (result[7] | (oo[1] >> 7 & 0x01)) << 1; result[7] = (result[7] | (pp[0] >> 7 & 0x01)) << 1; result[7] = (result[7] | (oo[0] >> 7 & 0x01)); } void des_16(uchar *src, uchar *subkey, uchar *result) { uchar i,j; uchar fout[4]={0,0,0,0}; IniPer(src); // output : for(i=0;i<15;i++) { j = i*6; desfun(subkey+j); // create fnc[3]..fnc[0] fout[3] = oo[3]^fnc[3]; fout[2] = oo[2]^fnc[2]; fout[1] = oo[1]^fnc[1]; fout[0] = oo[0]^fnc[0]; memcpy(oo, pp, 4); memcpy(pp, fout, 4); } j = i*6; desfun(subkey+j); oo[3] ^= fnc[3]; oo[2] ^= fnc[2]; oo[1] ^= fnc[1]; oo[0] ^= fnc[0]; FinalPer(result); // create grslt[0]..grslt[7] } void Single_DES_Encrypt(uchar *src, uchar *key, uchar *result) //加密 { SubKey_Generation(key); // enckey[6*16], deckey[6*16] des_16(src, enckey, result); // encrypted data } void Single_DES_Decrypt(uchar *src, uchar *key, uchar *result) //解密 { SubKey_Generation(key); des_16(src, deckey, result); // decrypted data 解密了的資料 } //////////////////////////////////////////////////////// //函式功能：3DES加密運算
//引數：SRC：需要加密的資料
//key:進行加密的金鑰
//輸出：result 加密結果 //////////////////////////////////////////////////////// void Single_3DES_Encrypt(uchar * src,uchar *key, uchar *result) { uchar result1[8],result2[8]; Single_DES_Encrypt(src, key, result1); //¼Ó A Single_DES_Decrypt(result1, &key[8], result2);//½â B Single_DES_Encrypt(result2, key, result); //¼Ó A } //////////////////////////////////////////////////////// //8位元組的異或計算 //////////////////////////////////////////////////////// void HexXor(uchar * Data1,uchar *Data2, uchar *DataOut) { uchar i; for(i=0;i<8;i++) { DataOut[i]=Data1[i]^Data2[i]; } } //////////////////////////////////////////////////////// //對金鑰種子一級分散 //////////////////////////////////////////////////////// void DisperseKey_1(uchar * src,uchar *key, uchar *result) { uchar buff1[8]={0,0,0,0,0,0,0,0}; Single_3DES_Encrypt(src,key,result); HexNot(src,8,buff1); Single_3DES_Encrypt(buff1,key,&result[8]); } //////////////////////////////////////////////////////// //對金鑰種子進行一級。二級。三級分散 //////////////////////////////////////////////////////// void DisperseKey(uchar Times, uchar * src,uchar *key, uchar *result) { uchar buff1[16]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}; uchar buff2[16]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}; switch(Times) { case 1 : DisperseKey_1(src,key,result); break; case 2 : DisperseKey_1(src,key,buff1); //1級分散，儲存結果到buff1 DisperseKey_1(&src[8],buff1,result); //二級分散 break; case 3 : DisperseKey_1(src,key,buff1); DisperseKey_1(&src[8],buff1,buff2); DisperseKey_1(&src[16],buff2,result); break; } } ////////////////////////////////////////////////////////
//函式功能：對位元組的取反
//////////////////////////////////////////////////////// void HexNot(uchar * Data1, uchar Len,uchar *DataOut) { uchar i; for(i=0;i<Len;i++) { DataOut[i]=~Data1[i]; } } //////////////////////////////////////////////////////// //函式功能：PBOC MAC計算//引數：key:參加運算的金鑰//InitialValue : 初始值，由隨機數產生 8個位元組 //DataIn: 計算的資料塊 以8位元組一塊為單位分為 N塊 //Len:輸入資料長度 //輸出：DataOut MAC計算出的8個位元組的結果 //////////////////////////////////////////////////////// void PBOC_MAC(uchar * Key, uchar *InitialValue, uchar *DataIn,uchar Len, uchar *DataOut) { uchar x,y; uchar i,j,k=0; uchar Dbuff[64]; uchar buff1[8]={0,0,0,0,0,0,0,0}; uchar buff2[8]={0,0,0,0,0,0,0,0}; memset(Dbuff, 0x00, 64); x=Len/8; //算出總共有多少塊 y=Len%8; //算出還剩多少位元組 for(i=0;i<x;i++) { for(j=0;j<8;j++) { Dbuff[k]=DataIn[k]; k++; } } if(y==0) { Dbuff[k++]=0x80; for(j=0;j<7;j++) { Dbuff[k++]=0; } } else //如果Y！=0，有剩餘位元組，則剩餘位元組後面補齊共8個位元組，以80為開頭，其他位元組為0 { for(j=0;j<y;j++) { Dbuff[k]=DataIn[k]; k++; } i=8-y; //算出還剩多少位元組 Dbuff[k++]=0x80; for(j=0;j<i-1;j++) { Dbuff[k++]=0; } } j=0; memcpy(buff2, InitialValue, 4); //初始值放入BUFF2為下一步運算做準備//用長度為8 位元組的金鑰產生MAC演算法 for(i=0;i<x+1;i++) //x+1 總的資料塊 { HexXor(buff2,&Dbuff[j], buff1); //異或演算法 Single_DES_Encrypt(buff1, Key, buff2);//DES加密 金鑰左邊位元組 j+=8; //下一組資料塊 } //用長度16位元組的金鑰產生MAC演算法 Single_DES_Decrypt(buff2, &Key[8], buff1);//16 位元組的金鑰右邊位元組解密 Single_DES_Encrypt(buff1, Key,DataOut ); //16 位元組的金鑰左邊位元組解密 } // void Single_3DES_Decrypt(uchar * src,uchar *key, uchar *result) { uchar result1[8],result2[8]; Single_DES_Encrypt(src, key, result1); Single_DES_Decrypt(result1, &key[8], result2); Single_DES_Encrypt(result2, key, result); } /* data:密文資料 data_len:密文資料長度 out_data:輸出的明文資料 key:解密祕鑰 */ void DES_Decrypt(u8 *out_data,u8 *data,u16 data_len,u8 *key) { u16 i = 0; u16 len = data_len/8; u8 data_tmp[8]={0}; u8 out_data_tmp[8] ={0}; // if(data_len%8) // len ++; for(i = 0; i<len;i++) { Single_DES_Decrypt(&data[i*8], key, &out_data[i*8]); } if(data_len%8) { memcpy(data_tmp,data,data_len%8); Single_DES_Decrypt(data_tmp, key, out_data_tmp); memcpy(out_data,out_data_tmp,data_len%8); //memcpy(deckey+6*i, enckey+(90-6*i), 6); } }
#ifndef _DES_H_ #define _DES_H_ #include "libsagedrv.h" #define uchar unsigned char //#define uint unsigned int void desfun(uchar *subkey); void IniPer(uchar *src); void FinalPer(uchar *result); void SubKey_Generation(uchar *key); void des_16(uchar *src, uchar *subkey, uchar *result); void Single_DES_Encrypt(uchar *src, uchar *key, uchar *result); void Single_DES_Decrypt(uchar *src, uchar *key, uchar *result); void Single_3DES_Encrypt(uchar * src,uchar *key, uchar *result); void HexXor(uchar * Data1,uchar *Data2, uchar *DataOut); void DisperseKey_1(uchar * src,uchar *key, uchar *result); void DisperseKey(uchar Times, uchar * src,uchar *key, uchar *result); void HexNot(uchar * Data1, uchar Len,uchar *DataOut); void PBOC_MAC(uchar * Key, uchar *InitialValue, uchar *DataIn,uchar Len, uchar *DataOut); void Single_3DES_Decrypt(uchar * src,uchar *key, uchar *result) ; //src*3Åã void DES_Decrypt(u8 *out_data,u8 *data,u16 data_len,u8 *key); #endif
//示例： ascll_to_Hex(rx_buffer,send_pkt,len/2); strncpy(rx_buffer,send_pkt,len/2); len = len/2; memset(send_pkt,0,sizeof(send_pkt)); DES_Decrypt(send_pkt,rx_buffer,len,usrcfg->QRKey);