mirror from https://www.codeaurora.org/git/projects/hisense-ts7008/repository/
[huawei.git] / AMSS / diagd3des.c
diff --git a/AMSS/diagd3des.c b/AMSS/diagd3des.c
new file mode 100644 (file)
index 0000000..ec02fa3
--- /dev/null
@@ -0,0 +1,403 @@
+/* D3DES \r
+ *\r
+ * A portable, public domain, version of the Data Encryption Standard.\r
+ *\r
+ * Copyright (c) 2004 by Hisense Incorporated. All Rights Reserved.\r
+ */\r
+\r
+#include "diagd3des.h"\r
+\r
+static void diag_scrunch(unsigned char *, unsigned long *);\r
+static void diag_unscrun(unsigned long *, unsigned char *);\r
+static void diag_desfunc(unsigned long *, unsigned long *);\r
+static void diag_cookey(unsigned long *);\r
+\r
+static unsigned long diag_knl[32] = { 0L };\r
+\r
+static const unsigned short diag_bytebit[8]    = {\r
+       0200, 0100, 040, 020, 010, 04, 02, 01 };\r
+\r
+static const unsigned long diag_bigbyte[24] = {\r
+       0x800000L,      0x400000L,      0x200000L,      0x100000L,\r
+       0x80000L,       0x40000L,       0x20000L,       0x10000L,\r
+       0x8000L,        0x4000L,        0x2000L,        0x1000L,\r
+       0x800L,         0x400L,         0x200L,         0x100L,\r
+       0x80L,          0x40L,          0x20L,          0x10L,\r
+       0x8L,           0x4L,           0x2L,           0x1L    };\r
+\r
+/* Use the key schedule specified in the Standard (ANSI X3.92-1981). */\r
+\r
+static const unsigned char diag_pc1[56] = {\r
+       56, 48, 40, 32, 24, 16,  8,      0, 57, 49, 41, 33, 25, 17,\r
+        9,  1, 58, 50, 42, 34, 26,     18, 10,  2, 59, 51, 43, 35,\r
+       62, 54, 46, 38, 30, 22, 14,      6, 61, 53, 45, 37, 29, 21,\r
+       13,  5, 60, 52, 44, 36, 28,     20, 12,  4, 27, 19, 11,  3 };\r
+\r
+static const unsigned char diag_totrot[16] = {\r
+       1,2,4,6,8,10,12,14,15,17,19,21,23,25,27,28 };\r
+\r
+static const unsigned char diag_pc2[48] = {\r
+       13, 16, 10, 23,  0,  4,  2, 27, 14,  5, 20,  9,\r
+       22, 18, 11,  3, 25,  7, 15,  6, 26, 19, 12,  1,\r
+       40, 51, 30, 36, 46, 54, 29, 39, 50, 44, 32, 47,\r
+       43, 48, 38, 55, 33, 52, 45, 41, 49, 35, 28, 31 };\r
+\r
+void diag_deskey(unsigned char *key, short edf)        /* Thanks to James Gillogly & Phil Karn! */\r
+{\r
+       register int i, j, l, m, n;\r
+       unsigned char diag_pc1m[56], pcr[56];\r
+       unsigned long kn[32];\r
+\r
+       for ( j = 0; j < 56; j++ ) {\r
+               l = diag_pc1[j];\r
+               m = l & 07;\r
+               diag_pc1m[j] = (key[l >> 3] & diag_bytebit[m]) ? 1 : 0;\r
+               }\r
+       for( i = 0; i < 16; i++ ) {\r
+               if( edf == DE1 ) m = (15 - i) << 1;\r
+               else m = i << 1;\r
+               n = m + 1;\r
+               kn[m] = kn[n] = 0L;\r
+               for( j = 0; j < 28; j++ ) {\r
+                       l = j + diag_totrot[i];\r
+                       if( l < 28 ) pcr[j] = diag_pc1m[l];\r
+                       else pcr[j] = diag_pc1m[l - 28];\r
+                       }\r
+               for( j = 28; j < 56; j++ ) {\r
+                   l = j + diag_totrot[i];\r
+                   if( l < 56 ) pcr[j] = diag_pc1m[l];\r
+                   else pcr[j] = diag_pc1m[l - 28];\r
+                   }\r
+               for( j = 0; j < 24; j++ ) {\r
+                       if( pcr[diag_pc2[j]] ) kn[m] |= diag_bigbyte[j];\r
+                       if( pcr[diag_pc2[j+24]] ) kn[n] |= diag_bigbyte[j];\r
+                       }\r
+               }\r
+       diag_cookey(kn);\r
+       return;\r
+       }\r
+\r
+static void diag_cookey(register unsigned long *raw1)\r
+{\r
+       register unsigned long *cook, *raw0;\r
+       unsigned long dough[32];\r
+       register int i;\r
+\r
+       cook = dough;\r
+       for( i = 0; i < 16; i++, raw1++ ) {\r
+               raw0 = raw1++;\r
+               *cook    = (*raw0 & 0x00fc0000L) << 6;\r
+               *cook   |= (*raw0 & 0x00000fc0L) << 10;\r
+               *cook   |= (*raw1 & 0x00fc0000L) >> 10;\r
+               *cook++ |= (*raw1 & 0x00000fc0L) >> 6;\r
+               *cook    = (*raw0 & 0x0003f000L) << 12;\r
+               *cook   |= (*raw0 & 0x0000003fL) << 16;\r
+               *cook   |= (*raw1 & 0x0003f000L) >> 4;\r
+               *cook++ |= (*raw1 & 0x0000003fL);\r
+               }\r
+       diag_usekey(dough);\r
+       return;\r
+       }\r
+\r
+void diag_cpkey(register unsigned long *into)\r
+{\r
+       register unsigned long *from, *endp;\r
+\r
+       from = diag_knl, endp = &diag_knl[32];\r
+       while( from < endp ) *into++ = *from++;\r
+       return;\r
+       }\r
+\r
+void diag_usekey(register unsigned long *from)\r
+{\r
+       register unsigned long *to, *endp;\r
+\r
+       to = diag_knl, endp = &diag_knl[32];\r
+       while( to < endp ) *to++ = *from++;\r
+       return;\r
+       }\r
+\r
+void diag_des(unsigned char *inblock, unsigned char *outblock)\r
+{\r
+       unsigned long work[2];\r
+\r
+       diag_scrunch(inblock, work);\r
+       diag_desfunc(work, diag_knl);\r
+       diag_unscrun(work, outblock);\r
+       return;\r
+       }\r
+\r
+static void diag_scrunch(register unsigned char *outof, register unsigned long *into)\r
+{\r
+       *into    = (*outof++ & 0xffL) << 24;\r
+       *into   |= (*outof++ & 0xffL) << 16;\r
+       *into   |= (*outof++ & 0xffL) << 8;\r
+       *into++ |= (*outof++ & 0xffL);\r
+       *into    = (*outof++ & 0xffL) << 24;\r
+       *into   |= (*outof++ & 0xffL) << 16;\r
+       *into   |= (*outof++ & 0xffL) << 8;\r
+       *into   |= (*outof   & 0xffL);\r
+       return;\r
+       }\r
+\r
+static void diag_unscrun(register unsigned long *outof, register unsigned char *into)\r
+{\r
+       *into++ = (*outof >> 24) & 0xffL;\r
+       *into++ = (*outof >> 16) & 0xffL;\r
+       *into++ = (*outof >>  8) & 0xffL;\r
+       *into++ =  *outof++      & 0xffL;\r
+       *into++ = (*outof >> 24) & 0xffL;\r
+       *into++ = (*outof >> 16) & 0xffL;\r
+       *into++ = (*outof >>  8) & 0xffL;\r
+       *into   =  *outof        & 0xffL;\r
+       return;\r
+       }\r
+\r
+static const unsigned long diag_SP1[64] = {\r
+       0x01010400L, 0x00000000L, 0x00010000L, 0x01010404L,\r
+       0x01010004L, 0x00010404L, 0x00000004L, 0x00010000L,\r
+       0x00000400L, 0x01010400L, 0x01010404L, 0x00000400L,\r
+       0x01000404L, 0x01010004L, 0x01000000L, 0x00000004L,\r
+       0x00000404L, 0x01000400L, 0x01000400L, 0x00010400L,\r
+       0x00010400L, 0x01010000L, 0x01010000L, 0x01000404L,\r
+       0x00010004L, 0x01000004L, 0x01000004L, 0x00010004L,\r
+       0x00000000L, 0x00000404L, 0x00010404L, 0x01000000L,\r
+       0x00010000L, 0x01010404L, 0x00000004L, 0x01010000L,\r
+       0x01010400L, 0x01000000L, 0x01000000L, 0x00000400L,\r
+       0x01010004L, 0x00010000L, 0x00010400L, 0x01000004L,\r
+       0x00000400L, 0x00000004L, 0x01000404L, 0x00010404L,\r
+       0x01010404L, 0x00010004L, 0x01010000L, 0x01000404L,\r
+       0x01000004L, 0x00000404L, 0x00010404L, 0x01010400L,\r
+       0x00000404L, 0x01000400L, 0x01000400L, 0x00000000L,\r
+       0x00010004L, 0x00010400L, 0x00000000L, 0x01010004L };\r
+\r
+static const unsigned long diag_SP2[64] = {\r
+       0x80108020L, 0x80008000L, 0x00008000L, 0x00108020L,\r
+       0x00100000L, 0x00000020L, 0x80100020L, 0x80008020L,\r
+       0x80000020L, 0x80108020L, 0x80108000L, 0x80000000L,\r
+       0x80008000L, 0x00100000L, 0x00000020L, 0x80100020L,\r
+       0x00108000L, 0x00100020L, 0x80008020L, 0x00000000L,\r
+       0x80000000L, 0x00008000L, 0x00108020L, 0x80100000L,\r
+       0x00100020L, 0x80000020L, 0x00000000L, 0x00108000L,\r
+       0x00008020L, 0x80108000L, 0x80100000L, 0x00008020L,\r
+       0x00000000L, 0x00108020L, 0x80100020L, 0x00100000L,\r
+       0x80008020L, 0x80100000L, 0x80108000L, 0x00008000L,\r
+       0x80100000L, 0x80008000L, 0x00000020L, 0x80108020L,\r
+       0x00108020L, 0x00000020L, 0x00008000L, 0x80000000L,\r
+       0x00008020L, 0x80108000L, 0x00100000L, 0x80000020L,\r
+       0x00100020L, 0x80008020L, 0x80000020L, 0x00100020L,\r
+       0x00108000L, 0x00000000L, 0x80008000L, 0x00008020L,\r
+       0x80000000L, 0x80100020L, 0x80108020L, 0x00108000L };\r
+\r
+static const unsigned long diag_SP3[64] = {\r
+       0x00000208L, 0x08020200L, 0x00000000L, 0x08020008L,\r
+       0x08000200L, 0x00000000L, 0x00020208L, 0x08000200L,\r
+       0x00020008L, 0x08000008L, 0x08000008L, 0x00020000L,\r
+       0x08020208L, 0x00020008L, 0x08020000L, 0x00000208L,\r
+       0x08000000L, 0x00000008L, 0x08020200L, 0x00000200L,\r
+       0x00020200L, 0x08020000L, 0x08020008L, 0x00020208L,\r
+       0x08000208L, 0x00020200L, 0x00020000L, 0x08000208L,\r
+       0x00000008L, 0x08020208L, 0x00000200L, 0x08000000L,\r
+       0x08020200L, 0x08000000L, 0x00020008L, 0x00000208L,\r
+       0x00020000L, 0x08020200L, 0x08000200L, 0x00000000L,\r
+       0x00000200L, 0x00020008L, 0x08020208L, 0x08000200L,\r
+       0x08000008L, 0x00000200L, 0x00000000L, 0x08020008L,\r
+       0x08000208L, 0x00020000L, 0x08000000L, 0x08020208L,\r
+       0x00000008L, 0x00020208L, 0x00020200L, 0x08000008L,\r
+       0x08020000L, 0x08000208L, 0x00000208L, 0x08020000L,\r
+       0x00020208L, 0x00000008L, 0x08020008L, 0x00020200L };\r
+\r
+static const unsigned long diag_SP4[64] = {\r
+       0x00802001L, 0x00002081L, 0x00002081L, 0x00000080L,\r
+       0x00802080L, 0x00800081L, 0x00800001L, 0x00002001L,\r
+       0x00000000L, 0x00802000L, 0x00802000L, 0x00802081L,\r
+       0x00000081L, 0x00000000L, 0x00800080L, 0x00800001L,\r
+       0x00000001L, 0x00002000L, 0x00800000L, 0x00802001L,\r
+       0x00000080L, 0x00800000L, 0x00002001L, 0x00002080L,\r
+       0x00800081L, 0x00000001L, 0x00002080L, 0x00800080L,\r
+       0x00002000L, 0x00802080L, 0x00802081L, 0x00000081L,\r
+       0x00800080L, 0x00800001L, 0x00802000L, 0x00802081L,\r
+       0x00000081L, 0x00000000L, 0x00000000L, 0x00802000L,\r
+       0x00002080L, 0x00800080L, 0x00800081L, 0x00000001L,\r
+       0x00802001L, 0x00002081L, 0x00002081L, 0x00000080L,\r
+       0x00802081L, 0x00000081L, 0x00000001L, 0x00002000L,\r
+       0x00800001L, 0x00002001L, 0x00802080L, 0x00800081L,\r
+       0x00002001L, 0x00002080L, 0x00800000L, 0x00802001L,\r
+       0x00000080L, 0x00800000L, 0x00002000L, 0x00802080L };\r
+\r
+static const unsigned long diag_SP5[64] = {\r
+       0x00000100L, 0x02080100L, 0x02080000L, 0x42000100L,\r
+       0x00080000L, 0x00000100L, 0x40000000L, 0x02080000L,\r
+       0x40080100L, 0x00080000L, 0x02000100L, 0x40080100L,\r
+       0x42000100L, 0x42080000L, 0x00080100L, 0x40000000L,\r
+       0x02000000L, 0x40080000L, 0x40080000L, 0x00000000L,\r
+       0x40000100L, 0x42080100L, 0x42080100L, 0x02000100L,\r
+       0x42080000L, 0x40000100L, 0x00000000L, 0x42000000L,\r
+       0x02080100L, 0x02000000L, 0x42000000L, 0x00080100L,\r
+       0x00080000L, 0x42000100L, 0x00000100L, 0x02000000L,\r
+       0x40000000L, 0x02080000L, 0x42000100L, 0x40080100L,\r
+       0x02000100L, 0x40000000L, 0x42080000L, 0x02080100L,\r
+       0x40080100L, 0x00000100L, 0x02000000L, 0x42080000L,\r
+       0x42080100L, 0x00080100L, 0x42000000L, 0x42080100L,\r
+       0x02080000L, 0x00000000L, 0x40080000L, 0x42000000L,\r
+       0x00080100L, 0x02000100L, 0x40000100L, 0x00080000L,\r
+       0x00000000L, 0x40080000L, 0x02080100L, 0x40000100L };\r
+\r
+static const unsigned long diag_SP6[64] = {\r
+       0x20000010L, 0x20400000L, 0x00004000L, 0x20404010L,\r
+       0x20400000L, 0x00000010L, 0x20404010L, 0x00400000L,\r
+       0x20004000L, 0x00404010L, 0x00400000L, 0x20000010L,\r
+       0x00400010L, 0x20004000L, 0x20000000L, 0x00004010L,\r
+       0x00000000L, 0x00400010L, 0x20004010L, 0x00004000L,\r
+       0x00404000L, 0x20004010L, 0x00000010L, 0x20400010L,\r
+       0x20400010L, 0x00000000L, 0x00404010L, 0x20404000L,\r
+       0x00004010L, 0x00404000L, 0x20404000L, 0x20000000L,\r
+       0x20004000L, 0x00000010L, 0x20400010L, 0x00404000L,\r
+       0x20404010L, 0x00400000L, 0x00004010L, 0x20000010L,\r
+       0x00400000L, 0x20004000L, 0x20000000L, 0x00004010L,\r
+       0x20000010L, 0x20404010L, 0x00404000L, 0x20400000L,\r
+       0x00404010L, 0x20404000L, 0x00000000L, 0x20400010L,\r
+       0x00000010L, 0x00004000L, 0x20400000L, 0x00404010L,\r
+       0x00004000L, 0x00400010L, 0x20004010L, 0x00000000L,\r
+       0x20404000L, 0x20000000L, 0x00400010L, 0x20004010L };\r
+\r
+static const unsigned long diag_SP7[64] = {\r
+       0x00200000L, 0x04200002L, 0x04000802L, 0x00000000L,\r
+       0x00000800L, 0x04000802L, 0x00200802L, 0x04200800L,\r
+       0x04200802L, 0x00200000L, 0x00000000L, 0x04000002L,\r
+       0x00000002L, 0x04000000L, 0x04200002L, 0x00000802L,\r
+       0x04000800L, 0x00200802L, 0x00200002L, 0x04000800L,\r
+       0x04000002L, 0x04200000L, 0x04200800L, 0x00200002L,\r
+       0x04200000L, 0x00000800L, 0x00000802L, 0x04200802L,\r
+       0x00200800L, 0x00000002L, 0x04000000L, 0x00200800L,\r
+       0x04000000L, 0x00200800L, 0x00200000L, 0x04000802L,\r
+       0x04000802L, 0x04200002L, 0x04200002L, 0x00000002L,\r
+       0x00200002L, 0x04000000L, 0x04000800L, 0x00200000L,\r
+       0x04200800L, 0x00000802L, 0x00200802L, 0x04200800L,\r
+       0x00000802L, 0x04000002L, 0x04200802L, 0x04200000L,\r
+       0x00200800L, 0x00000000L, 0x00000002L, 0x04200802L,\r
+       0x00000000L, 0x00200802L, 0x04200000L, 0x00000800L,\r
+       0x04000002L, 0x04000800L, 0x00000800L, 0x00200002L };\r
+\r
+static const unsigned long diag_SP8[64] = {\r
+       0x10001040L, 0x00001000L, 0x00040000L, 0x10041040L,\r
+       0x10000000L, 0x10001040L, 0x00000040L, 0x10000000L,\r
+       0x00040040L, 0x10040000L, 0x10041040L, 0x00041000L,\r
+       0x10041000L, 0x00041040L, 0x00001000L, 0x00000040L,\r
+       0x10040000L, 0x10000040L, 0x10001000L, 0x00001040L,\r
+       0x00041000L, 0x00040040L, 0x10040040L, 0x10041000L,\r
+       0x00001040L, 0x00000000L, 0x00000000L, 0x10040040L,\r
+       0x10000040L, 0x10001000L, 0x00041040L, 0x00040000L,\r
+       0x00041040L, 0x00040000L, 0x10041000L, 0x00001000L,\r
+       0x00000040L, 0x10040040L, 0x00001000L, 0x00041040L,\r
+       0x10001000L, 0x00000040L, 0x10000040L, 0x10040000L,\r
+       0x10040040L, 0x10000000L, 0x00040000L, 0x10001040L,\r
+       0x00000000L, 0x10041040L, 0x00040040L, 0x10000040L,\r
+       0x10040000L, 0x10001000L, 0x10001040L, 0x00000000L,\r
+       0x10041040L, 0x00041000L, 0x00041000L, 0x00001040L,\r
+       0x00001040L, 0x00040040L, 0x10000000L, 0x10041000L };\r
+\r
+static void diag_desfunc(register unsigned long *block, register unsigned long *keys)\r
+{\r
+       register unsigned long fval, work, right, leftt;\r
+       register int round;\r
+\r
+       leftt = block[0];\r
+       right = block[1];\r
+       work = ((leftt >> 4) ^ right) & 0x0f0f0f0fL;\r
+       right ^= work;\r
+       leftt ^= (work << 4);\r
+       work = ((leftt >> 16) ^ right) & 0x0000ffffL;\r
+       right ^= work;\r
+       leftt ^= (work << 16);\r
+       work = ((right >> 2) ^ leftt) & 0x33333333L;\r
+       leftt ^= work;\r
+       right ^= (work << 2);\r
+       work = ((right >> 8) ^ leftt) & 0x00ff00ffL;\r
+       leftt ^= work;\r
+       right ^= (work << 8);\r
+       right = ((right << 1) | ((right >> 31) & 1L)) & 0xffffffffL;\r
+       work = (leftt ^ right) & 0xaaaaaaaaL;\r
+       leftt ^= work;\r
+       right ^= work;\r
+       leftt = ((leftt << 1) | ((leftt >> 31) & 1L)) & 0xffffffffL;\r
+\r
+       for( round = 0; round < 8; round++ ) {\r
+               work  = (right << 28) | (right >> 4);\r
+               work ^= *keys++;\r
+               fval  = diag_SP7[ work           & 0x3fL];\r
+               fval |= diag_SP5[(work >>  8) & 0x3fL];\r
+               fval |= diag_SP3[(work >> 16) & 0x3fL];\r
+               fval |= diag_SP1[(work >> 24) & 0x3fL];\r
+               work  = right ^ *keys++;\r
+               fval |= diag_SP8[ work           & 0x3fL];\r
+               fval |= diag_SP6[(work >>  8) & 0x3fL];\r
+               fval |= diag_SP4[(work >> 16) & 0x3fL];\r
+               fval |= diag_SP2[(work >> 24) & 0x3fL];\r
+               leftt ^= fval;\r
+               work  = (leftt << 28) | (leftt >> 4);\r
+               work ^= *keys++;\r
+               fval  = diag_SP7[ work           & 0x3fL];\r
+               fval |= diag_SP5[(work >>  8) & 0x3fL];\r
+               fval |= diag_SP3[(work >> 16) & 0x3fL];\r
+               fval |= diag_SP1[(work >> 24) & 0x3fL];\r
+               work  = leftt ^ *keys++;\r
+               fval |= diag_SP8[ work           & 0x3fL];\r
+               fval |= diag_SP6[(work >>  8) & 0x3fL];\r
+               fval |= diag_SP4[(work >> 16) & 0x3fL];\r
+               fval |= diag_SP2[(work >> 24) & 0x3fL];\r
+               right ^= fval;\r
+               }\r
+\r
+       right = (right << 31) | (right >> 1);\r
+       work = (leftt ^ right) & 0xaaaaaaaaL;\r
+       leftt ^= work;\r
+       right ^= work;\r
+       leftt = (leftt << 31) | (leftt >> 1);\r
+       work = ((leftt >> 8) ^ right) & 0x00ff00ffL;\r
+       right ^= work;\r
+       leftt ^= (work << 8);\r
+       work = ((leftt >> 2) ^ right) & 0x33333333L;\r
+       right ^= work;\r
+       leftt ^= (work << 2);\r
+       work = ((right >> 16) ^ leftt) & 0x0000ffffL;\r
+       leftt ^= work;\r
+       right ^= (work << 16);\r
+       work = ((right >> 4) ^ leftt) & 0x0f0f0f0fL;\r
+       leftt ^= work;\r
+       right ^= (work << 4);\r
+       *block++ = right;\r
+       *block = leftt;\r
+       return;\r
+       }\r
+\r
+ /*\r
+ *Validation sets:\r
+ *\r
+ * Single-length key, single-length plaintext -\r
+ * Key   : 0123 4567 89ab cdef\r
+ * Plain  : 0123 4567 89ab cde7\r
+ * Cipher : c957 4425 6a5e d31d\r
+ *\r
+ * Double-length key, single-length plaintext -\r
+ * Key   : 0123 4567 89ab cdef fedc ba98 7654 3210\r
+ * Plain  : 0123 4567 89ab cde7\r
+ * Cipher : 7f1d 0a77 826b 8aff\r
+ *\r
+ * Double-length key, double-length plaintext -\r
+ * Key   : 0123 4567 89ab cdef fedc ba98 7654 3210\r
+ * Plain  : 0123 4567 89ab cdef 0123 4567 89ab cdff\r
+ * Cipher : 27a0 8440 406a df60 278f 47cf 42d6 15d7\r
+ *\r
+ * Triple-length key, single-length plaintext -\r
+ * Key   : 0123 4567 89ab cdef fedc ba98 7654 3210 89ab cdef 0123 4567\r
+ * Plain  : 0123 4567 89ab cde7\r
+ * Cipher : de0b 7c06 ae5e 0ed5\r
+ *\r
+ * Triple-length key, double-length plaintext -\r
+ * Key   : 0123 4567 89ab cdef fedc ba98 7654 3210 89ab cdef 0123 4567\r
+ * Plain  : 0123 4567 89ab cdef 0123 4567 89ab cdff\r
+ * Cipher : ad0d 1b30 ac17 cf07 0ed1 1c63 81e4 4de5\r
+ *\r
+ * d3des V5.0a rwo 9208.07 18:44 Graven Imagery\r
+ */\r