/
des.c
228 lines (211 loc) · 11.2 KB
/
des.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
#include <r_types.h>
#include <r_util.h>
#define ROTL28(rs, sh) ((((rs) << (sh)) | ((rs) >> (28 - (sh)))) & 0x0FFFFFFF) // left 28
#define ROTL(rs, sh) (((rs) << (sh)) | ((rs) >> (32 - (sh)))) // left 32
#define ROTR(rs, sh) (((rs) >> (sh)) | ((rs) << (32 - (sh)))) // right 32
/* des sboxes */
static const ut32 sbox1[64] = {
0x01010400, 0x00000000, 0x00010000, 0x01010404, 0x01010004, 0x00010404, 0x00000004, 0x00010000,
0x00000400, 0x01010400, 0x01010404, 0x00000400, 0x01000404, 0x01010004, 0x01000000, 0x00000004,
0x00000404, 0x01000400, 0x01000400, 0x00010400, 0x00010400, 0x01010000, 0x01010000, 0x01000404,
0x00010004, 0x01000004, 0x01000004, 0x00010004, 0x00000000, 0x00000404, 0x00010404, 0x01000000,
0x00010000, 0x01010404, 0x00000004, 0x01010000, 0x01010400, 0x01000000, 0x01000000, 0x00000400,
0x01010004, 0x00010000, 0x00010400, 0x01000004, 0x00000400, 0x00000004, 0x01000404, 0x00010404,
0x01010404, 0x00010004, 0x01010000, 0x01000404, 0x01000004, 0x00000404, 0x00010404, 0x01010400,
0x00000404, 0x01000400, 0x01000400, 0x00000000, 0x00010004, 0x00010400, 0x00000000, 0x01010004
};
static const ut32 sbox2[64] = {
0x80108020, 0x80008000, 0x00008000, 0x00108020, 0x00100000, 0x00000020, 0x80100020, 0x80008020,
0x80000020, 0x80108020, 0x80108000, 0x80000000, 0x80008000, 0x00100000, 0x00000020, 0x80100020,
0x00108000, 0x00100020, 0x80008020, 0x00000000, 0x80000000, 0x00008000, 0x00108020, 0x80100000,
0x00100020, 0x80000020, 0x00000000, 0x00108000, 0x00008020, 0x80108000, 0x80100000, 0x00008020,
0x00000000, 0x00108020, 0x80100020, 0x00100000, 0x80008020, 0x80100000, 0x80108000, 0x00008000,
0x80100000, 0x80008000, 0x00000020, 0x80108020, 0x00108020, 0x00000020, 0x00008000, 0x80000000,
0x00008020, 0x80108000, 0x00100000, 0x80000020, 0x00100020, 0x80008020, 0x80000020, 0x00100020,
0x00108000, 0x00000000, 0x80008000, 0x00008020, 0x80000000, 0x80100020, 0x80108020, 0x00108000
};
static const ut32 sbox3[64] = {
0x00000208, 0x08020200, 0x00000000, 0x08020008, 0x08000200, 0x00000000, 0x00020208, 0x08000200,
0x00020008, 0x08000008, 0x08000008, 0x00020000, 0x08020208, 0x00020008, 0x08020000, 0x00000208,
0x08000000, 0x00000008, 0x08020200, 0x00000200, 0x00020200, 0x08020000, 0x08020008, 0x00020208,
0x08000208, 0x00020200, 0x00020000, 0x08000208, 0x00000008, 0x08020208, 0x00000200, 0x08000000,
0x08020200, 0x08000000, 0x00020008, 0x00000208, 0x00020000, 0x08020200, 0x08000200, 0x00000000,
0x00000200, 0x00020008, 0x08020208, 0x08000200, 0x08000008, 0x00000200, 0x00000000, 0x08020008,
0x08000208, 0x00020000, 0x08000000, 0x08020208, 0x00000008, 0x00020208, 0x00020200, 0x08000008,
0x08020000, 0x08000208, 0x00000208, 0x08020000, 0x00020208, 0x00000008, 0x08020008, 0x00020200
};
static const ut32 sbox4[64] = {
0x00802001, 0x00002081, 0x00002081, 0x00000080, 0x00802080, 0x00800081, 0x00800001, 0x00002001,
0x00000000, 0x00802000, 0x00802000, 0x00802081, 0x00000081, 0x00000000, 0x00800080, 0x00800001,
0x00000001, 0x00002000, 0x00800000, 0x00802001, 0x00000080, 0x00800000, 0x00002001, 0x00002080,
0x00800081, 0x00000001, 0x00002080, 0x00800080, 0x00002000, 0x00802080, 0x00802081, 0x00000081,
0x00800080, 0x00800001, 0x00802000, 0x00802081, 0x00000081, 0x00000000, 0x00000000, 0x00802000,
0x00002080, 0x00800080, 0x00800081, 0x00000001, 0x00802001, 0x00002081, 0x00002081, 0x00000080,
0x00802081, 0x00000081, 0x00000001, 0x00002000, 0x00800001, 0x00002001, 0x00802080, 0x00800081,
0x00002001, 0x00002080, 0x00800000, 0x00802001, 0x00000080, 0x00800000, 0x00002000, 0x00802080
};
static const ut32 sbox5[64] = {
0x00000100, 0x02080100, 0x02080000, 0x42000100, 0x00080000, 0x00000100, 0x40000000, 0x02080000,
0x40080100, 0x00080000, 0x02000100, 0x40080100, 0x42000100, 0x42080000, 0x00080100, 0x40000000,
0x02000000, 0x40080000, 0x40080000, 0x00000000, 0x40000100, 0x42080100, 0x42080100, 0x02000100,
0x42080000, 0x40000100, 0x00000000, 0x42000000, 0x02080100, 0x02000000, 0x42000000, 0x00080100,
0x00080000, 0x42000100, 0x00000100, 0x02000000, 0x40000000, 0x02080000, 0x42000100, 0x40080100,
0x02000100, 0x40000000, 0x42080000, 0x02080100, 0x40080100, 0x00000100, 0x02000000, 0x42080000,
0x42080100, 0x00080100, 0x42000000, 0x42080100, 0x02080000, 0x00000000, 0x40080000, 0x42000000,
0x00080100, 0x02000100, 0x40000100, 0x00080000, 0x00000000, 0x40080000, 0x02080100, 0x40000100
};
static const ut32 sbox6[64] = {
0x20000010, 0x20400000, 0x00004000, 0x20404010, 0x20400000, 0x00000010, 0x20404010, 0x00400000,
0x20004000, 0x00404010, 0x00400000, 0x20000010, 0x00400010, 0x20004000, 0x20000000, 0x00004010,
0x00000000, 0x00400010, 0x20004010, 0x00004000, 0x00404000, 0x20004010, 0x00000010, 0x20400010,
0x20400010, 0x00000000, 0x00404010, 0x20404000, 0x00004010, 0x00404000, 0x20404000, 0x20000000,
0x20004000, 0x00000010, 0x20400010, 0x00404000, 0x20404010, 0x00400000, 0x00004010, 0x20000010,
0x00400000, 0x20004000, 0x20000000, 0x00004010, 0x20000010, 0x20404010, 0x00404000, 0x20400000,
0x00404010, 0x20404000, 0x00000000, 0x20400010, 0x00000010, 0x00004000, 0x20400000, 0x00404010,
0x00004000, 0x00400010, 0x20004010, 0x00000000, 0x20404000, 0x20000000, 0x00400010, 0x20004010
};
static const ut32 sbox7[64] = {
0x00200000, 0x04200002, 0x04000802, 0x00000000, 0x00000800, 0x04000802, 0x00200802, 0x04200800,
0x04200802, 0x00200000, 0x00000000, 0x04000002, 0x00000002, 0x04000000, 0x04200002, 0x00000802,
0x04000800, 0x00200802, 0x00200002, 0x04000800, 0x04000002, 0x04200000, 0x04200800, 0x00200002,
0x04200000, 0x00000800, 0x00000802, 0x04200802, 0x00200800, 0x00000002, 0x04000000, 0x00200800,
0x04000000, 0x00200800, 0x00200000, 0x04000802, 0x04000802, 0x04200002, 0x04200002, 0x00000002,
0x00200002, 0x04000000, 0x04000800, 0x00200000, 0x04200800, 0x00000802, 0x00200802, 0x04200800,
0x00000802, 0x04000002, 0x04200802, 0x04200000, 0x00200800, 0x00000000, 0x00000002, 0x04200802,
0x00000000, 0x00200802, 0x04200000, 0x00000800, 0x04000002, 0x04000800, 0x00000800, 0x00200002
};
static const ut32 sbox8[64] = {
0x10001040, 0x00001000, 0x00040000, 0x10041040, 0x10000000, 0x10001040, 0x00000040, 0x10000000,
0x00040040, 0x10040000, 0x10041040, 0x00041000, 0x10041000, 0x00041040, 0x00001000, 0x00000040,
0x10040000, 0x10000040, 0x10001000, 0x00001040, 0x00041000, 0x00040040, 0x10040040, 0x10041000,
0x00001040, 0x00000000, 0x00000000, 0x10040040, 0x10000040, 0x10001000, 0x00041040, 0x00040000,
0x00041040, 0x00040000, 0x10041000, 0x00001000, 0x00000040, 0x10040040, 0x00001000, 0x00041040,
0x10001000, 0x00000040, 0x10000040, 0x10040000, 0x10040040, 0x10000000, 0x00040000, 0x10001040,
0x00000000, 0x10041040, 0x00040040, 0x10000040, 0x10040000, 0x10001000, 0x10001040, 0x00000000,
0x10041040, 0x00041000, 0x00041000, 0x00001040, 0x00001040, 0x00040040, 0x10000000, 0x10041000
};
R_API void r_des_permute_key (ut32 *keylo, ut32 *keyhi) {
if (!keylo || !keyhi) {
return;
}
ut32 perm = ((*keylo >> 4) ^ *keyhi) & 0x0F0F0F0F;
*keyhi ^= perm; *keylo ^= (perm << 4);
perm = ((*keyhi >> 16) ^ *keylo) & 0x0000FFFF;
*keylo ^= perm; *keyhi ^= (perm << 16);
perm = ((*keylo >> 2) ^ *keyhi) & 0x33333333;
*keyhi ^= perm; *keylo ^= (perm << 2);
perm = ((*keyhi >> 16) ^ *keylo) & 0x0000FFFF;
*keylo ^= perm; *keyhi ^= (perm << 16);
perm = ((*keylo >> 1) ^ *keyhi) & 0x55555555;
*keyhi ^= perm; *keylo ^= (perm << 1);
perm = ((*keyhi >> 8) ^ *keylo) & 0x00FF00FF;
*keylo ^= perm; *keyhi ^= (perm << 8);
perm = ((*keylo >> 1) ^ *keyhi) & 0x55555555;
*keyhi ^= perm; *keylo ^= (perm << 1);
perm = (*keylo << 8) | ((*keyhi >> 20) & 0x000000F0);
*keylo = ((*keyhi << 20) & 0x0FF00000);
*keylo |= ((*keyhi << 4) & 0x000FF000);
*keylo |= ((*keyhi >> 12) & 0x00000FF0);
*keylo |= ((*keyhi >> 28) & 0x0000000F);
*keyhi = perm >> 4;
}
// first permutation of the block
R_API void r_des_permute_block0 (ut32 *blocklo, ut32 *blockhi) {
if (!blocklo || !blockhi) {
return;
}
ut32 lo = *blocklo;
ut32 hi = *blockhi;
ut32 perm = ((lo >> 4) ^ hi) & 0x0F0F0F0F;
hi ^= perm; lo ^= perm << 4;
perm = ((lo >> 16) ^ hi) & 0x0000FFFF;
hi ^= perm; lo ^= perm << 16;
perm = ((hi >> 2) ^ lo) & 0x33333333;
lo ^= perm; hi ^= perm << 2;
perm = ((hi >> 8) ^ lo) & 0x00FF00FF;
lo ^= perm; hi ^= perm << 8;
perm = ((lo >> 1) ^ hi) & 0x55555555;
hi ^= perm; lo ^= perm << 1;
*blocklo = ROTL (lo, 1);
*blockhi = ROTL (hi, 1);
}
// last permutation of the block
R_API void r_des_permute_block1 (ut32 *blocklo, ut32 *blockhi) {
if (!blocklo || !blockhi) {
return;
}
ut32 lo = *blocklo;
ut32 hi = *blockhi;
lo = ROTR (lo, 1);
hi = ROTR (hi, 1);
ut32 perm = ((lo >> 1) ^ hi) & 0x55555555;
hi ^= perm; lo ^= perm << 1;
perm = ((hi >> 8) ^ lo) & 0x00FF00FF;
lo ^= perm; hi ^= perm << 8;
perm = ((hi >> 2) ^ lo) & 0x33333333;
lo ^= perm; hi ^= perm << 2;
perm = ((lo >> 16) ^ hi) & 0x0000FFFF;
hi ^= perm; lo ^= perm << 16;
perm = ((lo >> 4) ^ hi) & 0x0F0F0F0F;
hi ^= perm; lo ^= perm << 4;
*blocklo = lo;
*blockhi = hi;
}
// keylo & keyhi are the derivated round keys
// deskeylo & deskeyhi are the des derivated keys
R_API void r_des_round_key (int i, ut32 *keylo, ut32 *keyhi, ut32 *deskeylo, ut32 *deskeyhi) {
if (!keylo || !keyhi || !deskeylo || !deskeyhi) {
return;
}
if (i == 0 || i == 1 || i == 8 || i == 15) {
*deskeylo = ROTL28 (*deskeylo, 1);
*deskeyhi = ROTL28 (*deskeyhi, 1);
} else {
*deskeylo = ROTL28 (*deskeylo, 2);
*deskeyhi = ROTL28 (*deskeyhi, 2);
}
ut32 deslo = *deskeylo;
ut32 deshi = *deskeyhi;
*keylo =((deslo << 4) & 0x24000000) | ((deslo << 28) & 0x10000000) |
((deslo << 14) & 0x08000000) | ((deslo << 18) & 0x02080000) |
((deslo << 6) & 0x01000000) | ((deslo << 9) & 0x00200000) |
((deslo >> 1) & 0x00100000) | ((deslo << 10) & 0x00040000) |
((deslo << 2) & 0x00020000) | ((deslo >> 10) & 0x00010000) |
((deshi >> 13) & 0x00002000) | ((deshi >> 4) & 0x00001000) |
((deshi << 6) & 0x00000800) | ((deshi >> 1) & 0x00000400) |
((deshi >> 14) & 0x00000200) | ((deshi) & 0x00000100) |
((deshi >> 5) & 0x00000020) | ((deshi >> 10) & 0x00000010) |
((deshi >> 3) & 0x00000008) | ((deshi >> 18) & 0x00000004) |
((deshi >> 26) & 0x00000002) | ((deshi >> 24) & 0x00000001);
*keyhi =((deslo << 15) & 0x20000000) | ((deslo << 17) & 0x10000000) |
((deslo << 10) & 0x08000000) | ((deslo << 22) & 0x04000000) |
((deslo >> 2) & 0x02000000) | ((deslo << 1) & 0x01000000) |
((deslo << 16) & 0x00200000) | ((deslo << 11) & 0x00100000) |
((deslo << 3) & 0x00080000) | ((deslo >> 6) & 0x00040000) |
((deslo << 15) & 0x00020000) | ((deslo >> 4) & 0x00010000) |
((deshi >> 2) & 0x00002000) | ((deshi << 8) & 0x00001000) |
((deshi >> 14) & 0x00000808) | ((deshi >> 9) & 0x00000400) |
((deshi) & 0x00000200) | ((deshi << 7) & 0x00000100) |
((deshi >> 7) & 0x00000020) | ((deshi >> 3) & 0x00000011) |
((deshi << 2) & 0x00000004) | ((deshi >> 21) & 0x00000002);
}
R_API void r_des_round (ut32 *buflo, ut32 *bufhi, ut32 *roundkeylo, ut32 *roundkeyhi) {
if (!buflo || !bufhi || !roundkeylo || !roundkeyhi) {
return;
}
ut32 lo = *buflo;
ut32 hi = *bufhi;
ut32 perm = hi ^ (*roundkeylo);
lo ^= sbox2[(perm >> 24) & 0x3F];
lo ^= sbox4[(perm >> 16) & 0x3F];
lo ^= sbox6[(perm >> 8) & 0x3F];
lo ^= sbox8[perm & 0x3F];
perm = ROTR (hi, 4) ^ (*roundkeyhi);
lo ^= sbox1[(perm >> 24) & 0x3F];
lo ^= sbox3[(perm >> 16) & 0x3F];
lo ^= sbox5[(perm >> 8) & 0x3F];
lo ^= sbox7[perm & 0x3F];
perm = hi;
*bufhi = lo;
*buflo = perm;
}