1 |
#include <memory> /* for memcpy() */ |
2 |
|
3 |
#include <svsconfig.h> |
4 |
#include "md5.h" |
5 |
|
6 |
#ifndef HIGHFIRST |
7 |
#define byteReverse(buf, len) /* Nothing */ |
8 |
#else |
9 |
/** |
10 |
* Note: this code is harmless on little-endian machines. |
11 |
*/ |
12 |
void |
13 |
byteReverse (unsigned char *buf, unsigned longs) |
14 |
{ |
15 |
uint32_t t; |
16 |
do |
17 |
{ |
18 |
t = (uint32_t) ((unsigned) buf[3] << 8 | buf[2]) << 16 | ((unsigned) buf[1] << 8 | buf[0]); |
19 |
*(uint32_t *) buf = t; |
20 |
buf += 4; |
21 |
} |
22 |
while (--longs); |
23 |
} |
24 |
#endif |
25 |
|
26 |
/** |
27 |
* Start MD5 accumulation. Set bit count to 0 and buffer to mysterious |
28 |
* initialization constants. |
29 |
*/ |
30 |
void |
31 |
MD5Init (MD5Context *ctx) |
32 |
{ |
33 |
ctx->buf[0] = 0x67452301; |
34 |
ctx->buf[1] = 0xefcdab89; |
35 |
ctx->buf[2] = 0x98badcfe; |
36 |
ctx->buf[3] = 0x10325476; |
37 |
|
38 |
ctx->bits[0] = 0; |
39 |
ctx->bits[1] = 0; |
40 |
} |
41 |
|
42 |
/** |
43 |
* Update context to reflect the concatenation of another buffer full |
44 |
* of bytes. |
45 |
*/ |
46 |
void |
47 |
MD5Update (MD5Context *ctx, unsigned char const *buf, unsigned len) |
48 |
{ |
49 |
uint32_t t; |
50 |
|
51 |
/* Update bitcount */ |
52 |
|
53 |
t = ctx->bits[0]; |
54 |
if ((ctx->bits[0] = t + ((uint32_t) len << 3)) < t) |
55 |
ctx->bits[1]++; /* Carry from low to high */ |
56 |
ctx->bits[1] += len >> 29; |
57 |
|
58 |
t = (t >> 3) & 0x3f; /* Bytes already in shsInfo->data */ |
59 |
|
60 |
/* Handle any leading odd-sized chunks */ |
61 |
|
62 |
if (t) |
63 |
{ |
64 |
unsigned char *p = (unsigned char *) ctx->in + t; |
65 |
|
66 |
t = 64 - t; |
67 |
if (len < t) |
68 |
{ |
69 |
std::memcpy (p, buf, len); |
70 |
return; |
71 |
} |
72 |
std::memcpy (p, buf, t); |
73 |
byteReverse (ctx->in, 16); |
74 |
MD5Transform (ctx->buf, (uint32_t *) ctx->in); |
75 |
buf += t; |
76 |
len -= t; |
77 |
} |
78 |
/* Process data in 64-byte chunks */ |
79 |
|
80 |
while (len >= 64) |
81 |
{ |
82 |
std::memcpy (ctx->in, buf, 64); |
83 |
byteReverse (ctx->in, 16); |
84 |
MD5Transform (ctx->buf, (uint32_t *) ctx->in); |
85 |
buf += 64; |
86 |
len -= 64; |
87 |
} |
88 |
|
89 |
/* Handle any remaining bytes of data. */ |
90 |
|
91 |
std::memcpy (ctx->in, buf, len); |
92 |
} |
93 |
|
94 |
/** |
95 |
* Final wrapup - pad to 64-byte boundary with the bit pattern |
96 |
* 1 0* (64-bit count of bits processed, MSB-first) |
97 |
*/ |
98 |
void |
99 |
MD5Final (unsigned char digest[16], MD5Context *ctx) |
100 |
{ |
101 |
unsigned count; |
102 |
unsigned char *p; |
103 |
|
104 |
/* Compute number of bytes mod 64 */ |
105 |
count = (ctx->bits[0] >> 3) & 0x3F; |
106 |
|
107 |
/* Set the first char of padding to 0x80. This is safe since there is |
108 |
always at least one byte free */ |
109 |
p = ctx->in + count; |
110 |
*p++ = 0x80; |
111 |
|
112 |
/* Bytes of padding needed to make 64 bytes */ |
113 |
count = 64 - 1 - count; |
114 |
|
115 |
/* Pad out to 56 mod 64 */ |
116 |
if (count < 8) |
117 |
{ |
118 |
/* Two lots of padding: Pad the first block to 64 bytes */ |
119 |
memset (p, 0, count); |
120 |
byteReverse (ctx->in, 16); |
121 |
MD5Transform (ctx->buf, (uint32_t *) ctx->in); |
122 |
|
123 |
/* Now fill the next block with 56 bytes */ |
124 |
memset (ctx->in, 0, 56); |
125 |
} |
126 |
else |
127 |
{ |
128 |
/* Pad block to 56 bytes */ |
129 |
memset (p, 0, count - 8); |
130 |
} |
131 |
byteReverse (ctx->in, 14); |
132 |
|
133 |
/* Append length in bits and transform */ |
134 |
((uint32_t *) ctx->in)[14] = ctx->bits[0]; |
135 |
((uint32_t *) ctx->in)[15] = ctx->bits[1]; |
136 |
|
137 |
MD5Transform (ctx->buf, (uint32_t *) ctx->in); |
138 |
byteReverse ((unsigned char *) ctx->buf, 4); |
139 |
std::memcpy (digest, ctx->buf, 16); |
140 |
memset (ctx, 0, sizeof (ctx)); /* In case it's sensitive */ |
141 |
} |
142 |
|
143 |
|
144 |
/* The four core functions - F1 is optimized somewhat */ |
145 |
|
146 |
/* #define F1(x, y, z) (x & y | ~x & z) */ |
147 |
inline uint32_t F1 (uint32_t x, uint32_t y, uint32_t z) { return z ^ (x & (y ^ z)); } |
148 |
inline uint32_t F2 (uint32_t x, uint32_t y, uint32_t z) { return F1(z, x, y); } |
149 |
inline uint32_t F3 (uint32_t x, uint32_t y, uint32_t z) { return (x ^ y ^ z); } |
150 |
inline uint32_t F4 (uint32_t x, uint32_t y, uint32_t z) { return (y ^ (x | ~z)); } |
151 |
|
152 |
/* This is the central step in the MD5 algorithm. */ |
153 |
inline void |
154 |
MD5STEP (uint32_t (*f)(uint32_t, uint32_t, uint32_t), uint32_t &w, uint32_t &x, uint32_t &y, uint32_t &z, unsigned data, int s) |
155 |
{ |
156 |
w += f (x, y, z) + data; |
157 |
w = w << s | w >> (32 - s); |
158 |
w += x; |
159 |
} |
160 |
|
161 |
/** |
162 |
* The core of the MD5 algorithm, this alters an existing MD5 hash to |
163 |
* reflect the addition of 16 longwords of new data. MD5Update blocks |
164 |
* the data and converts bytes into longwords for this routine. |
165 |
*/ |
166 |
void |
167 |
MD5Transform (uint32_t buf[4], uint32_t in[16]) |
168 |
{ |
169 |
register uint32_t a, b, c, d; |
170 |
|
171 |
a = buf[0]; |
172 |
b = buf[1]; |
173 |
c = buf[2]; |
174 |
d = buf[3]; |
175 |
|
176 |
MD5STEP (&F1, a, b, c, d, in[0] + 0xd76aa478, 7); |
177 |
MD5STEP (&F1, d, a, b, c, in[1] + 0xe8c7b756, 12); |
178 |
MD5STEP (&F1, c, d, a, b, in[2] + 0x242070db, 17); |
179 |
MD5STEP (&F1, b, c, d, a, in[3] + 0xc1bdceee, 22); |
180 |
MD5STEP (&F1, a, b, c, d, in[4] + 0xf57c0faf, 7); |
181 |
MD5STEP (&F1, d, a, b, c, in[5] + 0x4787c62a, 12); |
182 |
MD5STEP (&F1, c, d, a, b, in[6] + 0xa8304613, 17); |
183 |
MD5STEP (&F1, b, c, d, a, in[7] + 0xfd469501, 22); |
184 |
MD5STEP (&F1, a, b, c, d, in[8] + 0x698098d8, 7); |
185 |
MD5STEP (&F1, d, a, b, c, in[9] + 0x8b44f7af, 12); |
186 |
MD5STEP (&F1, c, d, a, b, in[10] + 0xffff5bb1, 17); |
187 |
MD5STEP (&F1, b, c, d, a, in[11] + 0x895cd7be, 22); |
188 |
MD5STEP (&F1, a, b, c, d, in[12] + 0x6b901122, 7); |
189 |
MD5STEP (&F1, d, a, b, c, in[13] + 0xfd987193, 12); |
190 |
MD5STEP (&F1, c, d, a, b, in[14] + 0xa679438e, 17); |
191 |
MD5STEP (&F1, b, c, d, a, in[15] + 0x49b40821, 22); |
192 |
|
193 |
MD5STEP (&F2, a, b, c, d, in[1] + 0xf61e2562, 5); |
194 |
MD5STEP (&F2, d, a, b, c, in[6] + 0xc040b340, 9); |
195 |
MD5STEP (&F2, c, d, a, b, in[11] + 0x265e5a51, 14); |
196 |
MD5STEP (&F2, b, c, d, a, in[0] + 0xe9b6c7aa, 20); |
197 |
MD5STEP (&F2, a, b, c, d, in[5] + 0xd62f105d, 5); |
198 |
MD5STEP (&F2, d, a, b, c, in[10] + 0x02441453, 9); |
199 |
MD5STEP (&F2, c, d, a, b, in[15] + 0xd8a1e681, 14); |
200 |
MD5STEP (&F2, b, c, d, a, in[4] + 0xe7d3fbc8, 20); |
201 |
MD5STEP (&F2, a, b, c, d, in[9] + 0x21e1cde6, 5); |
202 |
MD5STEP (&F2, d, a, b, c, in[14] + 0xc33707d6, 9); |
203 |
MD5STEP (&F2, c, d, a, b, in[3] + 0xf4d50d87, 14); |
204 |
MD5STEP (&F2, b, c, d, a, in[8] + 0x455a14ed, 20); |
205 |
MD5STEP (&F2, a, b, c, d, in[13] + 0xa9e3e905, 5); |
206 |
MD5STEP (&F2, d, a, b, c, in[2] + 0xfcefa3f8, 9); |
207 |
MD5STEP (&F2, c, d, a, b, in[7] + 0x676f02d9, 14); |
208 |
MD5STEP (&F2, b, c, d, a, in[12] + 0x8d2a4c8a, 20); |
209 |
|
210 |
MD5STEP (&F3, a, b, c, d, in[5] + 0xfffa3942, 4); |
211 |
MD5STEP (&F3, d, a, b, c, in[8] + 0x8771f681, 11); |
212 |
MD5STEP (&F3, c, d, a, b, in[11] + 0x6d9d6122, 16); |
213 |
MD5STEP (&F3, b, c, d, a, in[14] + 0xfde5380c, 23); |
214 |
MD5STEP (&F3, a, b, c, d, in[1] + 0xa4beea44, 4); |
215 |
MD5STEP (&F3, d, a, b, c, in[4] + 0x4bdecfa9, 11); |
216 |
MD5STEP (&F3, c, d, a, b, in[7] + 0xf6bb4b60, 16); |
217 |
MD5STEP (&F3, b, c, d, a, in[10] + 0xbebfbc70, 23); |
218 |
MD5STEP (&F3, a, b, c, d, in[13] + 0x289b7ec6, 4); |
219 |
MD5STEP (&F3, d, a, b, c, in[0] + 0xeaa127fa, 11); |
220 |
MD5STEP (&F3, c, d, a, b, in[3] + 0xd4ef3085, 16); |
221 |
MD5STEP (&F3, b, c, d, a, in[6] + 0x04881d05, 23); |
222 |
MD5STEP (&F3, a, b, c, d, in[9] + 0xd9d4d039, 4); |
223 |
MD5STEP (&F3, d, a, b, c, in[12] + 0xe6db99e5, 11); |
224 |
MD5STEP (&F3, c, d, a, b, in[15] + 0x1fa27cf8, 16); |
225 |
MD5STEP (&F3, b, c, d, a, in[2] + 0xc4ac5665, 23); |
226 |
|
227 |
MD5STEP (&F4, a, b, c, d, in[0] + 0xf4292244, 6); |
228 |
MD5STEP (&F4, d, a, b, c, in[7] + 0x432aff97, 10); |
229 |
MD5STEP (&F4, c, d, a, b, in[14] + 0xab9423a7, 15); |
230 |
MD5STEP (&F4, b, c, d, a, in[5] + 0xfc93a039, 21); |
231 |
MD5STEP (&F4, a, b, c, d, in[12] + 0x655b59c3, 6); |
232 |
MD5STEP (&F4, d, a, b, c, in[3] + 0x8f0ccc92, 10); |
233 |
MD5STEP (&F4, c, d, a, b, in[10] + 0xffeff47d, 15); |
234 |
MD5STEP (&F4, b, c, d, a, in[1] + 0x85845dd1, 21); |
235 |
MD5STEP (&F4, a, b, c, d, in[8] + 0x6fa87e4f, 6); |
236 |
MD5STEP (&F4, d, a, b, c, in[15] + 0xfe2ce6e0, 10); |
237 |
MD5STEP (&F4, c, d, a, b, in[6] + 0xa3014314, 15); |
238 |
MD5STEP (&F4, b, c, d, a, in[13] + 0x4e0811a1, 21); |
239 |
MD5STEP (&F4, a, b, c, d, in[4] + 0xf7537e82, 6); |
240 |
MD5STEP (&F4, d, a, b, c, in[11] + 0xbd3af235, 10); |
241 |
MD5STEP (&F4, c, d, a, b, in[2] + 0x2ad7d2bb, 15); |
242 |
MD5STEP (&F4, b, c, d, a, in[9] + 0xeb86d391, 21); |
243 |
|
244 |
buf[0] += a; |
245 |
buf[1] += b; |
246 |
buf[2] += c; |
247 |
buf[3] += d; |
248 |
} |