su_md5.c 14 KB
Newer Older
1 2 3 4
#define compile \
{ gcc -o su_md5 -O2 -g -Wall -DTEST -I. su_md5.c } ; exit 0
/* -*- c-style: java -*- */

Pekka Pessi's avatar
Pekka Pessi committed
5 6 7 8 9 10 11
/*
 * This file is part of the Sofia-SIP package
 *
 * Copyright (C) 2005 Nokia Corporation.
 *
 * Contact: Pekka Pessi <pekka.pessi@nokia.com>
 *
12
 * This library is free software; you can redistribute it and/or
Pekka Pessi's avatar
Pekka Pessi committed
13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
 * modify it under the terms of the GNU Lesser General Public License
 * as published by the Free Software Foundation; either version 2.1 of
 * the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 * 02110-1301 USA
 *
 */

29 30 31 32 33
/*
 * This code implements the MD5 message-digest algorithm. The algorithm is
 * due to Ron Rivest. This code was initially written by Colin Plumb in
 * 1993, no copyright is claimed. This code is in the public domain; do with
 * it what you wish.
Pekka Pessi's avatar
Pekka Pessi committed
34 35 36 37
 *
 * Equivalent code is available from RSA Data Security, Inc.  This code has
 * been tested against that, and is equivalent, except that you don't need
 * to include two pages of legalese with every copy.
38 39 40
 */

/** @ingroup su_md5
41
 *
42
 * @CFILE su_md5.c MD5 Implementation
Pekka Pessi's avatar
Pekka Pessi committed
43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60
 *
 * To compute the message digest of a chunk of bytes, declare an su_md5_t
 * context structure, pass it to su_md5_init(), call su_md5_update() as
 * needed on buffers full of bytes, and then call su_md5_digest(), which
 * will fill a supplied 16-byte array with the current digest.
 *
 * @note
 * This code was modified in 1997 by Jim Kingdon of Cyclic Software to
 * not require an integer type which is exactly 32 bits.  This work
 * draws on the changes for the same purpose by Tatu Ylonen
 * <ylo@cs.hut.fi> as part of SSH, but since I didn't actually use
 * that code, there is no copyright issue.  I hereby disclaim
 * copyright in any changes I have made; this code remains in the
 * public domain.
 *
 * @note Regarding su_* namespace: this avoids potential conflicts
 * with libraries such as some versions of Kerberos.  No particular
 * need to worry about whether the system supplies an MD5 library, as
61
 * this file is only about 3k of object code.
Pekka Pessi's avatar
Pekka Pessi committed
62 63 64 65 66
 *
 */

#include <string.h>	/* for memcpy() and memset() */

67
#include "sofia-sip/su_md5.h"
Pekka Pessi's avatar
Pekka Pessi committed
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

static void su_md5_transform(uint32_t buf[4], const unsigned char inraw[64]);

/* Little-endian byte-swapping routines.  Note that these do not depend on
   the size of datatypes such as cvs_uint32, nor do they require us to
   detect the endianness of the machine we are running on.  It is possible
   they should be macros for speed, but I would be surprised if they were a
   performance bottleneck for MD5. These are inlined by any sane compiler,
   anyways. */

static uint32_t getu32(const unsigned char *addr)
{
  return (((((unsigned long)addr[3] << 8) | addr[2]) << 8)
	  | addr[1]) << 8 | addr[0];
}

static void putu32(uint32_t data, unsigned char *addr)
{
  addr[0] = (unsigned char)data;
  addr[1] = (unsigned char)(data >> 8);
  addr[2] = (unsigned char)(data >> 16);
  addr[3] = (unsigned char)(data >> 24);
}

/** Initialize MD5 context.
 *
 * Start MD5 accumulation.  Set bit count to 0 and buffer to mysterious
 * initialization constants.
96
 *
Pekka Pessi's avatar
Pekka Pessi committed
97 98 99 100 101 102 103 104 105
 * @param ctx Pointer to context structure.
 */
void
su_md5_init(su_md5_t *ctx)
{
  ctx->buf[0] = 0x67452301;
  ctx->buf[1] = 0xefcdab89;
  ctx->buf[2] = 0x98badcfe;
  ctx->buf[3] = 0x10325476;
106

Pekka Pessi's avatar
Pekka Pessi committed
107 108 109 110 111 112 113
  ctx->bits[0] = 0;
  ctx->bits[1] = 0;
}

/** Clear MD5 context.
 *
 * The function su_md5_deinit() clears MD5 context.
114
 *
Pekka Pessi's avatar
Pekka Pessi committed
115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133
 * @param context  Pointer to MD5 context structure.
 */
void su_md5_deinit(su_md5_t *context)
{
  memset(context, 0, sizeof *context);
}

/** Update MD5 context.
 *
 * Update context to reflect the concatenation of another buffer full
 * of bytes.
 *
 * @param ctx Pointer to context structure
 * @param b   Pointer to data
 * @param len Length of @a b as bytes
 */
void
su_md5_update(su_md5_t *ctx,
	      void const *b,
134
	      usize_t len)
Pekka Pessi's avatar
Pekka Pessi committed
135 136 137 138 139 140 141 142 143
{
  unsigned char const *buf = (unsigned char const *)b;
  uint32_t t;

  /* Update bitcount */

  t = ctx->bits[0];
  if ((ctx->bits[0] = (t + ((uint32_t)len << 3)) & 0xffffffff) < t)
    ctx->bits[1]++;	/* Carry from low to high */
144
  ctx->bits[1] += (uint32_t)(len >> 29);
145

Pekka Pessi's avatar
Pekka Pessi committed
146
  t = (t >> 3) & 0x3f;	/* Bytes already in shsInfo->data */
147

Pekka Pessi's avatar
Pekka Pessi committed
148
  /* Handle any leading odd-sized chunks */
149

Pekka Pessi's avatar
Pekka Pessi committed
150 151
  if ( t ) {
    unsigned char *p = ctx->in + t;
152

Pekka Pessi's avatar
Pekka Pessi committed
153 154 155 156 157 158 159 160 161 162 163 164
    t = 64 - t;

    if (len < t) {
      memcpy(p, buf, len);
      return;
    }

    memcpy(p, buf, t);
    su_md5_transform (ctx->buf, ctx->in);
    buf += t;
    len -= t;
  }
165

Pekka Pessi's avatar
Pekka Pessi committed
166
  /* Process data in 64-byte chunks */
167

Pekka Pessi's avatar
Pekka Pessi committed
168 169 170 171 172 173 174 175 176 177 178
  while (len >= 64) {
    su_md5_transform(ctx->buf, buf);
    buf += 64;
    len -= 64;
  }

  /* Handle any remaining bytes of data. */
  memcpy(ctx->in, buf, len);
}

/** Copy memory, fix case to lower. */
179
static
180
void mem_i_cpy(unsigned char *d, unsigned char const *s, size_t len)
Pekka Pessi's avatar
Pekka Pessi committed
181
{
182
  size_t i;
Pekka Pessi's avatar
Pekka Pessi committed
183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202

  for (i = 0; i < len; i++)
    if (s[i] >= 'A' && s[i] <= 'Z')
      d[i] = s[i] + ('a' - 'A');
    else
      d[i] = s[i];
}

/**Update MD5 context.
 *
 * The function su_md5_iupdate() updates context to reflect the
 * concatenation of another buffer full of case-independent characters.
 *
 * @param ctx Pointer to context structure
 * @param b   Pointer to data
 * @param len Length of @a b as bytes
 */
void
su_md5_iupdate(su_md5_t *ctx,
	       void const *b,
203
	       usize_t len)
Pekka Pessi's avatar
Pekka Pessi committed
204 205 206 207 208 209 210 211 212
{
  unsigned char const *buf = (unsigned char const *)b;
  uint32_t t;

  /* Update bitcount */

  t = ctx->bits[0];
  if ((ctx->bits[0] = (t + ((uint32_t)len << 3)) & 0xffffffff) < t)
    ctx->bits[1]++;	/* Carry from low to high */
213
  ctx->bits[1] += (uint32_t)(len >> 29);
214

Pekka Pessi's avatar
Pekka Pessi committed
215
  t = (t >> 3) & 0x3f;	/* Bytes already in shsInfo->data */
216

Pekka Pessi's avatar
Pekka Pessi committed
217
  /* Handle any leading odd-sized chunks */
218

Pekka Pessi's avatar
Pekka Pessi committed
219 220
  if ( t ) {
    unsigned char *p = ctx->in + t;
221

Pekka Pessi's avatar
Pekka Pessi committed
222 223 224
    t = sizeof(ctx->in) - t;

    if (len < t) {
225
      mem_i_cpy(p, buf, len);
Pekka Pessi's avatar
Pekka Pessi committed
226 227 228 229 230 231 232
      return;
    }
    mem_i_cpy(p, buf, t);
    su_md5_transform (ctx->buf, ctx->in);
    buf += t;
    len -= t;
  }
233

Pekka Pessi's avatar
Pekka Pessi committed
234 235 236 237 238 239 240 241 242
  /* Process data in 64-byte chunks */
  while (len >= sizeof(ctx->in)) {
    mem_i_cpy(ctx->in, buf, sizeof(ctx->in));
    su_md5_transform(ctx->buf, ctx->in);
    buf += sizeof(ctx->in);
    len -= sizeof(ctx->in);
  }

  /* Handle any remaining bytes of data. */
243
  mem_i_cpy(ctx->in, buf, len);
Pekka Pessi's avatar
Pekka Pessi committed
244 245 246 247 248 249 250 251 252 253 254 255
}

/** Update MD5 context with contents of string.
 *
 * The function su_md5_strupdate() updates context to reflect the
 * concatenation of NUL-terminated string.
 *
 * @param ctx Pointer to context structure
 * @param s   Pointer to string
 */
void su_md5_strupdate(su_md5_t *ctx, char const *s)
{
256
  if (s)
Pekka Pessi's avatar
Pekka Pessi committed
257 258 259 260 261 262 263 264 265 266 267 268 269
    su_md5_update(ctx, s, strlen(s));
}

/** Update MD5 context with contents of string, including final NUL.
 *
 * The function su_md5_str0update() updates context to reflect the
 * concatenation of NUL-terminated string, including the final NUL.
 *
 * @param ctx Pointer to context structure
 * @param s   Pointer to string
 */
void su_md5_str0update(su_md5_t *ctx, char const *s)
{
270
  if (!s)
Pekka Pessi's avatar
Pekka Pessi committed
271 272 273 274 275 276 277 278 279 280 281 282 283 284 285
    s = "";

  su_md5_update(ctx, s, strlen(s) + 1);
}

/** Update MD5 context with contents of case-independent string.
 *
 * The function su_md5_striupdate() updates context to reflect the
 * concatenation of NUL-terminated string.
 *
 * @param ctx Pointer to context structure
 * @param s   Pointer to string
 */
void su_md5_striupdate(su_md5_t *ctx, char const *s)
{
286
  if (s)
Pekka Pessi's avatar
Pekka Pessi committed
287 288 289 290 291 292 293 294 295 296 297 298 299 300
    su_md5_iupdate(ctx, s, strlen(s));
}

/** Update MD5 context with contents of case-independent string, including
 * final NUL.
 *
 * The function su_md5_stri0update() updates context to reflect the
 * concatenation of NUL-terminated string, including the final NUL.
 *
 * @param ctx Pointer to context structure
 * @param s   Pointer to string
 */
void su_md5_stri0update(su_md5_t *ctx, char const *s)
{
301
  if (!s)
Pekka Pessi's avatar
Pekka Pessi committed
302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325
    s = "";

  su_md5_iupdate(ctx, s, strlen(s) + 1);
}


/** Generate digest.
 *
 * Final wrapup. Pad message to 64-byte boundary with the bit pattern 1 0*
 * (64-bit count of bits processed, MSB-first), then concatenate message
 * with its length (measured in bits) as 64-byte big-endian integer.
 *
 * @param context  Pointer to context structure
 * @param digest   Digest array to be filled
 */
void
su_md5_digest(su_md5_t const *context, uint8_t digest[16])
{
  unsigned count;
  unsigned char *p;

  su_md5_t ctx[1];

  ctx[0] = context[0];
326

Pekka Pessi's avatar
Pekka Pessi committed
327 328
  /* Compute number of bytes mod 64 */
  count = (ctx->bits[0] >> 3) & 0x3F;
329

Pekka Pessi's avatar
Pekka Pessi committed
330 331 332 333
  /* Set the first char of padding to 0x80.  This is safe since there is
     always at least one byte free */
  p = ctx->in + count;
  *p++ = 0x80;
334

335
  /* Bytes of padding needed to make 64 bytes */
Pekka Pessi's avatar
Pekka Pessi committed
336
  count = 64 - 1 - count;
337

Pekka Pessi's avatar
Pekka Pessi committed
338 339 340 341 342
  /* Pad out to 56 mod 64 */
  if (count < 8) {
    /* Two lots of padding:  Pad the first block to 64 bytes */
    memset(p, 0, count);
    su_md5_transform (ctx->buf, ctx->in);
343

Pekka Pessi's avatar
Pekka Pessi committed
344 345 346 347 348 349
    /* Now fill the next block with 56 bytes */
    memset(ctx->in, 0, 56);
  } else {
    /* Pad block to 56 bytes */
    memset(p, 0, count-8);
  }
350

Pekka Pessi's avatar
Pekka Pessi committed
351 352 353
  /* Append length in bits and transform */
  putu32(ctx->bits[0], ctx->in + 56);
  putu32(ctx->bits[1], ctx->in + 60);
354

Pekka Pessi's avatar
Pekka Pessi committed
355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491
  su_md5_transform(ctx->buf, ctx->in);
  putu32(ctx->buf[0], digest);
  putu32(ctx->buf[1], digest + 4);
  putu32(ctx->buf[2], digest + 8);
  putu32(ctx->buf[3], digest + 12);
  memset(ctx, 0, sizeof(ctx));	/* In case it's sensitive */
}

void su_md5_hexdigest(su_md5_t const *ctx,
		      char digest[2 * SU_MD5_DIGEST_SIZE + 1])
{
  uint8_t b, bin[SU_MD5_DIGEST_SIZE];
  short i, j;

  su_md5_digest(ctx, bin);

  for (i = j = 0; i < 16; i++) {
    b = (bin[i] >> 4) & 15;
    digest[j++] = b + (b > 9 ? 'a' - 10 : '0');
    b = bin[i] & 15;
    digest[j++] = b + (b > 9 ? 'a' - 10 : '0');
  }

  digest[j] = '\0';
}

#ifndef ASM_MD5

/* The four core functions - F1 is optimized somewhat */

/* #define F1(x, y, z) (x & y | ~x & z) */
#define F1(x, y, z) (z ^ (x & (y ^ z)))
#define F2(x, y, z) F1(z, x, y)
#define F3(x, y, z) (x ^ y ^ z)
#define F4(x, y, z) (y ^ (x | ~z))

/* This is the central step in the MD5 algorithm. */
#define MD5STEP(f, w, x, y, z, data, s) \
	( w += f(x, y, z) + data, w &= 0xffffffff, w = w<<s | w>>(32-s), w += x )

/** @internal
 *
 * Add 64 bytes of data to hash.
 *
 * The core of the MD5 algorithm, this alters an existing MD5 hash to
 * reflect the addition of 16 longwords of new data.  MD5Update blocks
 * the data and converts bytes into longwords for this routine.
 */
static void
su_md5_transform(uint32_t buf[4], const unsigned char inraw[64])
{
  register uint32_t a, b, c, d;
  uint32_t in[16];
  int i;

  for (i = 0; i < 16; ++i)
    in[i] = getu32 (inraw + 4 * i);

  a = buf[0];
  b = buf[1];
  c = buf[2];
  d = buf[3];

  MD5STEP(F1, a, b, c, d, in[ 0]+0xd76aa478,  7);
  MD5STEP(F1, d, a, b, c, in[ 1]+0xe8c7b756, 12);
  MD5STEP(F1, c, d, a, b, in[ 2]+0x242070db, 17);
  MD5STEP(F1, b, c, d, a, in[ 3]+0xc1bdceee, 22);
  MD5STEP(F1, a, b, c, d, in[ 4]+0xf57c0faf,  7);
  MD5STEP(F1, d, a, b, c, in[ 5]+0x4787c62a, 12);
  MD5STEP(F1, c, d, a, b, in[ 6]+0xa8304613, 17);
  MD5STEP(F1, b, c, d, a, in[ 7]+0xfd469501, 22);
  MD5STEP(F1, a, b, c, d, in[ 8]+0x698098d8,  7);
  MD5STEP(F1, d, a, b, c, in[ 9]+0x8b44f7af, 12);
  MD5STEP(F1, c, d, a, b, in[10]+0xffff5bb1, 17);
  MD5STEP(F1, b, c, d, a, in[11]+0x895cd7be, 22);
  MD5STEP(F1, a, b, c, d, in[12]+0x6b901122,  7);
  MD5STEP(F1, d, a, b, c, in[13]+0xfd987193, 12);
  MD5STEP(F1, c, d, a, b, in[14]+0xa679438e, 17);
  MD5STEP(F1, b, c, d, a, in[15]+0x49b40821, 22);

  MD5STEP(F2, a, b, c, d, in[ 1]+0xf61e2562,  5);
  MD5STEP(F2, d, a, b, c, in[ 6]+0xc040b340,  9);
  MD5STEP(F2, c, d, a, b, in[11]+0x265e5a51, 14);
  MD5STEP(F2, b, c, d, a, in[ 0]+0xe9b6c7aa, 20);
  MD5STEP(F2, a, b, c, d, in[ 5]+0xd62f105d,  5);
  MD5STEP(F2, d, a, b, c, in[10]+0x02441453,  9);
  MD5STEP(F2, c, d, a, b, in[15]+0xd8a1e681, 14);
  MD5STEP(F2, b, c, d, a, in[ 4]+0xe7d3fbc8, 20);
  MD5STEP(F2, a, b, c, d, in[ 9]+0x21e1cde6,  5);
  MD5STEP(F2, d, a, b, c, in[14]+0xc33707d6,  9);
  MD5STEP(F2, c, d, a, b, in[ 3]+0xf4d50d87, 14);
  MD5STEP(F2, b, c, d, a, in[ 8]+0x455a14ed, 20);
  MD5STEP(F2, a, b, c, d, in[13]+0xa9e3e905,  5);
  MD5STEP(F2, d, a, b, c, in[ 2]+0xfcefa3f8,  9);
  MD5STEP(F2, c, d, a, b, in[ 7]+0x676f02d9, 14);
  MD5STEP(F2, b, c, d, a, in[12]+0x8d2a4c8a, 20);

  MD5STEP(F3, a, b, c, d, in[ 5]+0xfffa3942,  4);
  MD5STEP(F3, d, a, b, c, in[ 8]+0x8771f681, 11);
  MD5STEP(F3, c, d, a, b, in[11]+0x6d9d6122, 16);
  MD5STEP(F3, b, c, d, a, in[14]+0xfde5380c, 23);
  MD5STEP(F3, a, b, c, d, in[ 1]+0xa4beea44,  4);
  MD5STEP(F3, d, a, b, c, in[ 4]+0x4bdecfa9, 11);
  MD5STEP(F3, c, d, a, b, in[ 7]+0xf6bb4b60, 16);
  MD5STEP(F3, b, c, d, a, in[10]+0xbebfbc70, 23);
  MD5STEP(F3, a, b, c, d, in[13]+0x289b7ec6,  4);
  MD5STEP(F3, d, a, b, c, in[ 0]+0xeaa127fa, 11);
  MD5STEP(F3, c, d, a, b, in[ 3]+0xd4ef3085, 16);
  MD5STEP(F3, b, c, d, a, in[ 6]+0x04881d05, 23);
  MD5STEP(F3, a, b, c, d, in[ 9]+0xd9d4d039,  4);
  MD5STEP(F3, d, a, b, c, in[12]+0xe6db99e5, 11);
  MD5STEP(F3, c, d, a, b, in[15]+0x1fa27cf8, 16);
  MD5STEP(F3, b, c, d, a, in[ 2]+0xc4ac5665, 23);

  MD5STEP(F4, a, b, c, d, in[ 0]+0xf4292244,  6);
  MD5STEP(F4, d, a, b, c, in[ 7]+0x432aff97, 10);
  MD5STEP(F4, c, d, a, b, in[14]+0xab9423a7, 15);
  MD5STEP(F4, b, c, d, a, in[ 5]+0xfc93a039, 21);
  MD5STEP(F4, a, b, c, d, in[12]+0x655b59c3,  6);
  MD5STEP(F4, d, a, b, c, in[ 3]+0x8f0ccc92, 10);
  MD5STEP(F4, c, d, a, b, in[10]+0xffeff47d, 15);
  MD5STEP(F4, b, c, d, a, in[ 1]+0x85845dd1, 21);
  MD5STEP(F4, a, b, c, d, in[ 8]+0x6fa87e4f,  6);
  MD5STEP(F4, d, a, b, c, in[15]+0xfe2ce6e0, 10);
  MD5STEP(F4, c, d, a, b, in[ 6]+0xa3014314, 15);
  MD5STEP(F4, b, c, d, a, in[13]+0x4e0811a1, 21);
  MD5STEP(F4, a, b, c, d, in[ 4]+0xf7537e82,  6);
  MD5STEP(F4, d, a, b, c, in[11]+0xbd3af235, 10);
  MD5STEP(F4, c, d, a, b, in[ 2]+0x2ad7d2bb, 15);
  MD5STEP(F4, b, c, d, a, in[ 9]+0xeb86d391, 21);

  buf[0] += a;
  buf[1] += b;
  buf[2] += c;
  buf[3] += d;
}
#endif