00001
00016 #include "includes.h"
00017
00018 #include "common.h"
00019 #include "md5.h"
00020 #include "md5_i.h"
00021 #include "crypto.h"
00022
00023
00024 static void MD5Transform(u32 buf[4], u32 const in[16]);
00025
00026
00027 typedef struct MD5Context MD5_CTX;
00028
00029
00039 int md5_vector(size_t num_elem, const u8 *addr[], const size_t *len, u8 *mac)
00040 {
00041 MD5_CTX ctx;
00042 size_t i;
00043
00044 MD5Init(&ctx);
00045 for (i = 0; i < num_elem; i++)
00046 MD5Update(&ctx, addr[i], len[i]);
00047 MD5Final(mac, &ctx);
00048 return 0;
00049 }
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070 #ifndef WORDS_BIGENDIAN
00071 #define byteReverse(buf, len)
00072 #else
00073
00074
00075
00076 static void byteReverse(unsigned char *buf, unsigned longs)
00077 {
00078 u32 t;
00079 do {
00080 t = (u32) ((unsigned) buf[3] << 8 | buf[2]) << 16 |
00081 ((unsigned) buf[1] << 8 | buf[0]);
00082 *(u32 *) buf = t;
00083 buf += 4;
00084 } while (--longs);
00085 }
00086 #endif
00087
00088
00089
00090
00091
00092 void MD5Init(struct MD5Context *ctx)
00093 {
00094 ctx->buf[0] = 0x67452301;
00095 ctx->buf[1] = 0xefcdab89;
00096 ctx->buf[2] = 0x98badcfe;
00097 ctx->buf[3] = 0x10325476;
00098
00099 ctx->bits[0] = 0;
00100 ctx->bits[1] = 0;
00101 }
00102
00103
00104
00105
00106
00107 void MD5Update(struct MD5Context *ctx, unsigned char const *buf, unsigned len)
00108 {
00109 u32 t;
00110
00111
00112
00113 t = ctx->bits[0];
00114 if ((ctx->bits[0] = t + ((u32) len << 3)) < t)
00115 ctx->bits[1]++;
00116 ctx->bits[1] += len >> 29;
00117
00118 t = (t >> 3) & 0x3f;
00119
00120
00121
00122 if (t) {
00123 unsigned char *p = (unsigned char *) ctx->in + t;
00124
00125 t = 64 - t;
00126 if (len < t) {
00127 os_memcpy(p, buf, len);
00128 return;
00129 }
00130 os_memcpy(p, buf, t);
00131 byteReverse(ctx->in, 16);
00132 MD5Transform(ctx->buf, (u32 *) ctx->in);
00133 buf += t;
00134 len -= t;
00135 }
00136
00137
00138 while (len >= 64) {
00139 os_memcpy(ctx->in, buf, 64);
00140 byteReverse(ctx->in, 16);
00141 MD5Transform(ctx->buf, (u32 *) ctx->in);
00142 buf += 64;
00143 len -= 64;
00144 }
00145
00146
00147
00148 os_memcpy(ctx->in, buf, len);
00149 }
00150
00151
00152
00153
00154
00155 void MD5Final(unsigned char digest[16], struct MD5Context *ctx)
00156 {
00157 unsigned count;
00158 unsigned char *p;
00159
00160
00161 count = (ctx->bits[0] >> 3) & 0x3F;
00162
00163
00164
00165 p = ctx->in + count;
00166 *p++ = 0x80;
00167
00168
00169 count = 64 - 1 - count;
00170
00171
00172 if (count < 8) {
00173
00174 os_memset(p, 0, count);
00175 byteReverse(ctx->in, 16);
00176 MD5Transform(ctx->buf, (u32 *) ctx->in);
00177
00178
00179 os_memset(ctx->in, 0, 56);
00180 } else {
00181
00182 os_memset(p, 0, count - 8);
00183 }
00184 byteReverse(ctx->in, 14);
00185
00186
00187 ((u32 *) ctx->in)[14] = ctx->bits[0];
00188 ((u32 *) ctx->in)[15] = ctx->bits[1];
00189
00190 MD5Transform(ctx->buf, (u32 *) ctx->in);
00191 byteReverse((unsigned char *) ctx->buf, 4);
00192 os_memcpy(digest, ctx->buf, 16);
00193 os_memset(ctx, 0, sizeof(ctx));
00194 }
00195
00196
00197
00198
00199 #define F1(x, y, z) (z ^ (x & (y ^ z)))
00200 #define F2(x, y, z) F1(z, x, y)
00201 #define F3(x, y, z) (x ^ y ^ z)
00202 #define F4(x, y, z) (y ^ (x | ~z))
00203
00204
00205 #define MD5STEP(f, w, x, y, z, data, s) \
00206 ( w += f(x, y, z) + data, w = w<<s | w>>(32-s), w += x )
00207
00208
00209
00210
00211
00212
00213 static void MD5Transform(u32 buf[4], u32 const in[16])
00214 {
00215 register u32 a, b, c, d;
00216
00217 a = buf[0];
00218 b = buf[1];
00219 c = buf[2];
00220 d = buf[3];
00221
00222 MD5STEP(F1, a, b, c, d, in[0] + 0xd76aa478, 7);
00223 MD5STEP(F1, d, a, b, c, in[1] + 0xe8c7b756, 12);
00224 MD5STEP(F1, c, d, a, b, in[2] + 0x242070db, 17);
00225 MD5STEP(F1, b, c, d, a, in[3] + 0xc1bdceee, 22);
00226 MD5STEP(F1, a, b, c, d, in[4] + 0xf57c0faf, 7);
00227 MD5STEP(F1, d, a, b, c, in[5] + 0x4787c62a, 12);
00228 MD5STEP(F1, c, d, a, b, in[6] + 0xa8304613, 17);
00229 MD5STEP(F1, b, c, d, a, in[7] + 0xfd469501, 22);
00230 MD5STEP(F1, a, b, c, d, in[8] + 0x698098d8, 7);
00231 MD5STEP(F1, d, a, b, c, in[9] + 0x8b44f7af, 12);
00232 MD5STEP(F1, c, d, a, b, in[10] + 0xffff5bb1, 17);
00233 MD5STEP(F1, b, c, d, a, in[11] + 0x895cd7be, 22);
00234 MD5STEP(F1, a, b, c, d, in[12] + 0x6b901122, 7);
00235 MD5STEP(F1, d, a, b, c, in[13] + 0xfd987193, 12);
00236 MD5STEP(F1, c, d, a, b, in[14] + 0xa679438e, 17);
00237 MD5STEP(F1, b, c, d, a, in[15] + 0x49b40821, 22);
00238
00239 MD5STEP(F2, a, b, c, d, in[1] + 0xf61e2562, 5);
00240 MD5STEP(F2, d, a, b, c, in[6] + 0xc040b340, 9);
00241 MD5STEP(F2, c, d, a, b, in[11] + 0x265e5a51, 14);
00242 MD5STEP(F2, b, c, d, a, in[0] + 0xe9b6c7aa, 20);
00243 MD5STEP(F2, a, b, c, d, in[5] + 0xd62f105d, 5);
00244 MD5STEP(F2, d, a, b, c, in[10] + 0x02441453, 9);
00245 MD5STEP(F2, c, d, a, b, in[15] + 0xd8a1e681, 14);
00246 MD5STEP(F2, b, c, d, a, in[4] + 0xe7d3fbc8, 20);
00247 MD5STEP(F2, a, b, c, d, in[9] + 0x21e1cde6, 5);
00248 MD5STEP(F2, d, a, b, c, in[14] + 0xc33707d6, 9);
00249 MD5STEP(F2, c, d, a, b, in[3] + 0xf4d50d87, 14);
00250 MD5STEP(F2, b, c, d, a, in[8] + 0x455a14ed, 20);
00251 MD5STEP(F2, a, b, c, d, in[13] + 0xa9e3e905, 5);
00252 MD5STEP(F2, d, a, b, c, in[2] + 0xfcefa3f8, 9);
00253 MD5STEP(F2, c, d, a, b, in[7] + 0x676f02d9, 14);
00254 MD5STEP(F2, b, c, d, a, in[12] + 0x8d2a4c8a, 20);
00255
00256 MD5STEP(F3, a, b, c, d, in[5] + 0xfffa3942, 4);
00257 MD5STEP(F3, d, a, b, c, in[8] + 0x8771f681, 11);
00258 MD5STEP(F3, c, d, a, b, in[11] + 0x6d9d6122, 16);
00259 MD5STEP(F3, b, c, d, a, in[14] + 0xfde5380c, 23);
00260 MD5STEP(F3, a, b, c, d, in[1] + 0xa4beea44, 4);
00261 MD5STEP(F3, d, a, b, c, in[4] + 0x4bdecfa9, 11);
00262 MD5STEP(F3, c, d, a, b, in[7] + 0xf6bb4b60, 16);
00263 MD5STEP(F3, b, c, d, a, in[10] + 0xbebfbc70, 23);
00264 MD5STEP(F3, a, b, c, d, in[13] + 0x289b7ec6, 4);
00265 MD5STEP(F3, d, a, b, c, in[0] + 0xeaa127fa, 11);
00266 MD5STEP(F3, c, d, a, b, in[3] + 0xd4ef3085, 16);
00267 MD5STEP(F3, b, c, d, a, in[6] + 0x04881d05, 23);
00268 MD5STEP(F3, a, b, c, d, in[9] + 0xd9d4d039, 4);
00269 MD5STEP(F3, d, a, b, c, in[12] + 0xe6db99e5, 11);
00270 MD5STEP(F3, c, d, a, b, in[15] + 0x1fa27cf8, 16);
00271 MD5STEP(F3, b, c, d, a, in[2] + 0xc4ac5665, 23);
00272
00273 MD5STEP(F4, a, b, c, d, in[0] + 0xf4292244, 6);
00274 MD5STEP(F4, d, a, b, c, in[7] + 0x432aff97, 10);
00275 MD5STEP(F4, c, d, a, b, in[14] + 0xab9423a7, 15);
00276 MD5STEP(F4, b, c, d, a, in[5] + 0xfc93a039, 21);
00277 MD5STEP(F4, a, b, c, d, in[12] + 0x655b59c3, 6);
00278 MD5STEP(F4, d, a, b, c, in[3] + 0x8f0ccc92, 10);
00279 MD5STEP(F4, c, d, a, b, in[10] + 0xffeff47d, 15);
00280 MD5STEP(F4, b, c, d, a, in[1] + 0x85845dd1, 21);
00281 MD5STEP(F4, a, b, c, d, in[8] + 0x6fa87e4f, 6);
00282 MD5STEP(F4, d, a, b, c, in[15] + 0xfe2ce6e0, 10);
00283 MD5STEP(F4, c, d, a, b, in[6] + 0xa3014314, 15);
00284 MD5STEP(F4, b, c, d, a, in[13] + 0x4e0811a1, 21);
00285 MD5STEP(F4, a, b, c, d, in[4] + 0xf7537e82, 6);
00286 MD5STEP(F4, d, a, b, c, in[11] + 0xbd3af235, 10);
00287 MD5STEP(F4, c, d, a, b, in[2] + 0x2ad7d2bb, 15);
00288 MD5STEP(F4, b, c, d, a, in[9] + 0xeb86d391, 21);
00289
00290 buf[0] += a;
00291 buf[1] += b;
00292 buf[2] += c;
00293 buf[3] += d;
00294 }
00295
00296