md5.c (3857B)
1 /* public domain md5 implementation based on rfc1321 and libtomcrypt */ 2 #include <stdint.h> 3 #include <string.h> 4 5 #include "../md5.h" 6 7 static uint32_t rol(uint32_t n, int k) { return (n << k) | (n >> (32-k)); } 8 #define F(x,y,z) (z ^ (x & (y ^ z))) 9 #define G(x,y,z) (y ^ (z & (y ^ x))) 10 #define H(x,y,z) (x ^ y ^ z) 11 #define I(x,y,z) (y ^ (x | ~z)) 12 #define FF(a,b,c,d,w,s,t) a += F(b,c,d) + w + t; a = rol(a,s) + b 13 #define GG(a,b,c,d,w,s,t) a += G(b,c,d) + w + t; a = rol(a,s) + b 14 #define HH(a,b,c,d,w,s,t) a += H(b,c,d) + w + t; a = rol(a,s) + b 15 #define II(a,b,c,d,w,s,t) a += I(b,c,d) + w + t; a = rol(a,s) + b 16 17 static const uint32_t tab[64] = { 18 0xd76aa478, 0xe8c7b756, 0x242070db, 0xc1bdceee, 0xf57c0faf, 0x4787c62a, 0xa8304613, 0xfd469501, 19 0x698098d8, 0x8b44f7af, 0xffff5bb1, 0x895cd7be, 0x6b901122, 0xfd987193, 0xa679438e, 0x49b40821, 20 0xf61e2562, 0xc040b340, 0x265e5a51, 0xe9b6c7aa, 0xd62f105d, 0x02441453, 0xd8a1e681, 0xe7d3fbc8, 21 0x21e1cde6, 0xc33707d6, 0xf4d50d87, 0x455a14ed, 0xa9e3e905, 0xfcefa3f8, 0x676f02d9, 0x8d2a4c8a, 22 0xfffa3942, 0x8771f681, 0x6d9d6122, 0xfde5380c, 0xa4beea44, 0x4bdecfa9, 0xf6bb4b60, 0xbebfbc70, 23 0x289b7ec6, 0xeaa127fa, 0xd4ef3085, 0x04881d05, 0xd9d4d039, 0xe6db99e5, 0x1fa27cf8, 0xc4ac5665, 24 0xf4292244, 0x432aff97, 0xab9423a7, 0xfc93a039, 0x655b59c3, 0x8f0ccc92, 0xffeff47d, 0x85845dd1, 25 0x6fa87e4f, 0xfe2ce6e0, 0xa3014314, 0x4e0811a1, 0xf7537e82, 0xbd3af235, 0x2ad7d2bb, 0xeb86d391 26 }; 27 28 static void 29 processblock(struct md5 *s, const uint8_t *buf) 30 { 31 uint32_t i, W[16], a, b, c, d; 32 33 for (i = 0; i < 16; i++) { 34 W[i] = buf[4*i]; 35 W[i] |= (uint32_t)buf[4*i+1]<<8; 36 W[i] |= (uint32_t)buf[4*i+2]<<16; 37 W[i] |= (uint32_t)buf[4*i+3]<<24; 38 } 39 40 a = s->h[0]; 41 b = s->h[1]; 42 c = s->h[2]; 43 d = s->h[3]; 44 45 i = 0; 46 while (i < 16) { 47 FF(a,b,c,d, W[i], 7, tab[i]); i++; 48 FF(d,a,b,c, W[i], 12, tab[i]); i++; 49 FF(c,d,a,b, W[i], 17, tab[i]); i++; 50 FF(b,c,d,a, W[i], 22, tab[i]); i++; 51 } 52 while (i < 32) { 53 GG(a,b,c,d, W[(5*i+1)%16], 5, tab[i]); i++; 54 GG(d,a,b,c, W[(5*i+1)%16], 9, tab[i]); i++; 55 GG(c,d,a,b, W[(5*i+1)%16], 14, tab[i]); i++; 56 GG(b,c,d,a, W[(5*i+1)%16], 20, tab[i]); i++; 57 } 58 while (i < 48) { 59 HH(a,b,c,d, W[(3*i+5)%16], 4, tab[i]); i++; 60 HH(d,a,b,c, W[(3*i+5)%16], 11, tab[i]); i++; 61 HH(c,d,a,b, W[(3*i+5)%16], 16, tab[i]); i++; 62 HH(b,c,d,a, W[(3*i+5)%16], 23, tab[i]); i++; 63 } 64 while (i < 64) { 65 II(a,b,c,d, W[7*i%16], 6, tab[i]); i++; 66 II(d,a,b,c, W[7*i%16], 10, tab[i]); i++; 67 II(c,d,a,b, W[7*i%16], 15, tab[i]); i++; 68 II(b,c,d,a, W[7*i%16], 21, tab[i]); i++; 69 } 70 71 s->h[0] += a; 72 s->h[1] += b; 73 s->h[2] += c; 74 s->h[3] += d; 75 } 76 77 static void 78 pad(struct md5 *s) 79 { 80 unsigned r = s->len % 64; 81 82 s->buf[r++] = 0x80; 83 if (r > 56) { 84 memset(s->buf + r, 0, 64 - r); 85 r = 0; 86 processblock(s, s->buf); 87 } 88 memset(s->buf + r, 0, 56 - r); 89 s->len *= 8; 90 s->buf[56] = s->len; 91 s->buf[57] = s->len >> 8; 92 s->buf[58] = s->len >> 16; 93 s->buf[59] = s->len >> 24; 94 s->buf[60] = s->len >> 32; 95 s->buf[61] = s->len >> 40; 96 s->buf[62] = s->len >> 48; 97 s->buf[63] = s->len >> 56; 98 processblock(s, s->buf); 99 } 100 101 void 102 md5_init(void *ctx) 103 { 104 struct md5 *s = ctx; 105 s->len = 0; 106 s->h[0] = 0x67452301; 107 s->h[1] = 0xefcdab89; 108 s->h[2] = 0x98badcfe; 109 s->h[3] = 0x10325476; 110 } 111 112 void 113 md5_sum(void *ctx, uint8_t md[MD5_DIGEST_LENGTH]) 114 { 115 struct md5 *s = ctx; 116 int i; 117 118 pad(s); 119 for (i = 0; i < 4; i++) { 120 md[4*i] = s->h[i]; 121 md[4*i+1] = s->h[i] >> 8; 122 md[4*i+2] = s->h[i] >> 16; 123 md[4*i+3] = s->h[i] >> 24; 124 } 125 } 126 127 void 128 md5_update(void *ctx, const void *m, unsigned long len) 129 { 130 struct md5 *s = ctx; 131 const uint8_t *p = m; 132 unsigned r = s->len % 64; 133 134 s->len += len; 135 if (r) { 136 if (len < 64 - r) { 137 memcpy(s->buf + r, p, len); 138 return; 139 } 140 memcpy(s->buf + r, p, 64 - r); 141 len -= 64 - r; 142 p += 64 - r; 143 processblock(s, s->buf); 144 } 145 for (; len >= 64; len -= 64, p += 64) 146 processblock(s, p); 147 memcpy(s->buf, p, len); 148 }