git.sur5r.net Git - freertos/blob - FreeRTOS-Plus/Source/CyaSSL/ctaocrypt/src/md5.c

   1 /* md5.c
   2  *
   3  * Copyright (C) 2006-2014 wolfSSL Inc.
   4  *
   5  * This file is part of CyaSSL.
   6  *
   7  * CyaSSL is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * CyaSSL is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
  20  */
  21
  22
  23 #ifdef HAVE_CONFIG_H
  24     #include <config.h>
  25 #endif
  26
  27 #include <cyassl/ctaocrypt/settings.h>
  28
  29 #if !defined(NO_MD5)
  30
  31 #ifdef CYASSL_PIC32MZ_HASH
  32 #define InitMd5   InitMd5_sw
  33 #define Md5Update Md5Update_sw
  34 #define Md5Final  Md5Final_sw
  35 #endif
  36
  37 #include <cyassl/ctaocrypt/md5.h>
  38 #include <cyassl/ctaocrypt/error-crypt.h>
  39
  40 #ifdef NO_INLINE
  41     #include <cyassl/ctaocrypt/misc.h>
  42 #else
  43     #include <ctaocrypt/src/misc.c>
  44 #endif
  45
  46 #ifdef FREESCALE_MMCAU
  47     #include "cau_api.h"
  48     #define XTRANSFORM(S,B)  cau_md5_hash_n((B), 1, (unsigned char*)(S)->digest)
  49 #else
  50     #define XTRANSFORM(S,B)  Transform((S))
  51 #endif
  52
  53
  54 #ifdef STM32F2_HASH
  55     /*
  56      * STM32F2 hardware MD5 support through the STM32F2 standard peripheral
  57      * library. Documentation located in STM32F2xx Standard Peripheral Library
  58      * document (See note in README).
  59      */
  60     #include "stm32f2xx.h"
  61
  62     void InitMd5(Md5* md5)
  63     {
  64         /* STM32F2 struct notes:
  65          * md5->buffer  = first 4 bytes used to hold partial block if needed
  66          * md5->buffLen = num bytes currently stored in md5->buffer
  67          * md5->loLen   = num bytes that have been written to STM32 FIFO
  68          */
  69         XMEMSET(md5->buffer, 0, MD5_REG_SIZE);
  70
  71         md5->buffLen = 0;
  72         md5->loLen = 0;
  73
  74         /* initialize HASH peripheral */
  75         HASH_DeInit();
  76
  77         /* configure algo used, algo mode, datatype */
  78         HASH->CR &= ~ (HASH_CR_ALGO | HASH_CR_DATATYPE | HASH_CR_MODE);
  79         HASH->CR |= (HASH_AlgoSelection_MD5 | HASH_AlgoMode_HASH
  80                  | HASH_DataType_8b);
  81
  82         /* reset HASH processor */
  83         HASH->CR |= HASH_CR_INIT;
  84     }
  85
  86     void Md5Update(Md5* md5, const byte* data, word32 len)
  87     {
  88         word32 i = 0;
  89         word32 fill = 0;
  90         word32 diff = 0;
  91
  92         /* if saved partial block is available */
  93         if (md5->buffLen > 0) {
  94             fill = 4 - md5->buffLen;
  95
  96             /* if enough data to fill, fill and push to FIFO */
  97             if (fill <= len) {
  98                 XMEMCPY((byte*)md5->buffer + md5->buffLen, data, fill);
  99                 HASH_DataIn(*(uint32_t*)md5->buffer);
 100
 101                 data += fill;
 102                 len -= fill;
 103                 md5->loLen += 4;
 104                 md5->buffLen = 0;
 105             } else {
 106                 /* append partial to existing stored block */
 107                 XMEMCPY((byte*)md5->buffer + md5->buffLen, data, len);
 108                 md5->buffLen += len;
 109                 return;
 110             }
 111         }
 112
 113         /* write input block in the IN FIFO */
 114         for (i = 0; i < len; i += 4)
 115         {
 116             diff = len - i;
 117             if (diff < 4) {
 118                 /* store incomplete last block, not yet in FIFO */
 119                 XMEMSET(md5->buffer, 0, MD5_REG_SIZE);
 120                 XMEMCPY((byte*)md5->buffer, data, diff);
 121                 md5->buffLen = diff;
 122             } else {
 123                 HASH_DataIn(*(uint32_t*)data);
 124                 data+=4;
 125             }
 126         }
 127
 128         /* keep track of total data length thus far */
 129         md5->loLen += (len - md5->buffLen);
 130     }
 131
 132     void Md5Final(Md5* md5, byte* hash)
 133     {
 134         __IO uint16_t nbvalidbitsdata = 0;
 135
 136         /* finish reading any trailing bytes into FIFO */
 137         if (md5->buffLen > 0) {
 138             HASH_DataIn(*(uint32_t*)md5->buffer);
 139             md5->loLen += md5->buffLen;
 140         }
 141
 142         /* calculate number of valid bits in last word of input data */
 143         nbvalidbitsdata = 8 * (md5->loLen % MD5_REG_SIZE);
 144
 145         /* configure number of valid bits in last word of the data */
 146         HASH_SetLastWordValidBitsNbr(nbvalidbitsdata);
 147
 148         /* start HASH processor */
 149         HASH_StartDigest();
 150
 151         /* wait until Busy flag == RESET */
 152         while (HASH_GetFlagStatus(HASH_FLAG_BUSY) != RESET) {}
 153
 154         /* read message digest */
 155         md5->digest[0] = HASH->HR[0];
 156         md5->digest[1] = HASH->HR[1];
 157         md5->digest[2] = HASH->HR[2];
 158         md5->digest[3] = HASH->HR[3];
 159
 160         ByteReverseWords(md5->digest, md5->digest, MD5_DIGEST_SIZE);
 161
 162         XMEMCPY(hash, md5->digest, MD5_DIGEST_SIZE);
 163
 164         InitMd5(md5);  /* reset state */
 165     }
 166
 167 #else /* CTaoCrypt software implementation */
 168
 169 #ifndef min
 170
 171     static INLINE word32 min(word32 a, word32 b)
 172     {
 173         return a > b ? b : a;
 174     }
 175
 176 #endif /* min */
 177
 178
 179 void InitMd5(Md5* md5)
 180 {
 181     md5->digest[0] = 0x67452301L;
 182     md5->digest[1] = 0xefcdab89L;
 183     md5->digest[2] = 0x98badcfeL;
 184     md5->digest[3] = 0x10325476L;
 185
 186     md5->buffLen = 0;
 187     md5->loLen   = 0;
 188     md5->hiLen   = 0;
 189 }
 190
 191 #ifndef FREESCALE_MMCAU
 192
 193 static void Transform(Md5* md5)
 194 {
 195 #define F1(x, y, z) (z ^ (x & (y ^ z)))
 196 #define F2(x, y, z) F1(z, x, y)
 197 #define F3(x, y, z) (x ^ y ^ z)
 198 #define F4(x, y, z) (y ^ (x | ~z))
 199
 200 #define MD5STEP(f, w, x, y, z, data, s) \
 201     w = rotlFixed(w + f(x, y, z) + data, s) + x
 202
 203     /* Copy context->state[] to working vars  */
 204     word32 a = md5->digest[0];
 205     word32 b = md5->digest[1];
 206     word32 c = md5->digest[2];
 207     word32 d = md5->digest[3];
 208
 209     MD5STEP(F1, a, b, c, d, md5->buffer[0]  + 0xd76aa478,  7);
 210     MD5STEP(F1, d, a, b, c, md5->buffer[1]  + 0xe8c7b756, 12);
 211     MD5STEP(F1, c, d, a, b, md5->buffer[2]  + 0x242070db, 17);
 212     MD5STEP(F1, b, c, d, a, md5->buffer[3]  + 0xc1bdceee, 22);
 213     MD5STEP(F1, a, b, c, d, md5->buffer[4]  + 0xf57c0faf,  7);
 214     MD5STEP(F1, d, a, b, c, md5->buffer[5]  + 0x4787c62a, 12);
 215     MD5STEP(F1, c, d, a, b, md5->buffer[6]  + 0xa8304613, 17);
 216     MD5STEP(F1, b, c, d, a, md5->buffer[7]  + 0xfd469501, 22);
 217     MD5STEP(F1, a, b, c, d, md5->buffer[8]  + 0x698098d8,  7);
 218     MD5STEP(F1, d, a, b, c, md5->buffer[9]  + 0x8b44f7af, 12);
 219     MD5STEP(F1, c, d, a, b, md5->buffer[10] + 0xffff5bb1, 17);
 220     MD5STEP(F1, b, c, d, a, md5->buffer[11] + 0x895cd7be, 22);
 221     MD5STEP(F1, a, b, c, d, md5->buffer[12] + 0x6b901122,  7);
 222     MD5STEP(F1, d, a, b, c, md5->buffer[13] + 0xfd987193, 12);
 223     MD5STEP(F1, c, d, a, b, md5->buffer[14] + 0xa679438e, 17);
 224     MD5STEP(F1, b, c, d, a, md5->buffer[15] + 0x49b40821, 22);
 225
 226     MD5STEP(F2, a, b, c, d, md5->buffer[1]  + 0xf61e2562,  5);
 227     MD5STEP(F2, d, a, b, c, md5->buffer[6]  + 0xc040b340,  9);
 228     MD5STEP(F2, c, d, a, b, md5->buffer[11] + 0x265e5a51, 14);
 229     MD5STEP(F2, b, c, d, a, md5->buffer[0]  + 0xe9b6c7aa, 20);
 230     MD5STEP(F2, a, b, c, d, md5->buffer[5]  + 0xd62f105d,  5);
 231     MD5STEP(F2, d, a, b, c, md5->buffer[10] + 0x02441453,  9);
 232     MD5STEP(F2, c, d, a, b, md5->buffer[15] + 0xd8a1e681, 14);
 233     MD5STEP(F2, b, c, d, a, md5->buffer[4]  + 0xe7d3fbc8, 20);
 234     MD5STEP(F2, a, b, c, d, md5->buffer[9]  + 0x21e1cde6,  5);
 235     MD5STEP(F2, d, a, b, c, md5->buffer[14] + 0xc33707d6,  9);
 236     MD5STEP(F2, c, d, a, b, md5->buffer[3]  + 0xf4d50d87, 14);
 237     MD5STEP(F2, b, c, d, a, md5->buffer[8]  + 0x455a14ed, 20);
 238     MD5STEP(F2, a, b, c, d, md5->buffer[13] + 0xa9e3e905,  5);
 239     MD5STEP(F2, d, a, b, c, md5->buffer[2]  + 0xfcefa3f8,  9);
 240     MD5STEP(F2, c, d, a, b, md5->buffer[7]  + 0x676f02d9, 14);
 241     MD5STEP(F2, b, c, d, a, md5->buffer[12] + 0x8d2a4c8a, 20);
 242
 243     MD5STEP(F3, a, b, c, d, md5->buffer[5]  + 0xfffa3942,  4);
 244     MD5STEP(F3, d, a, b, c, md5->buffer[8]  + 0x8771f681, 11);
 245     MD5STEP(F3, c, d, a, b, md5->buffer[11] + 0x6d9d6122, 16);
 246     MD5STEP(F3, b, c, d, a, md5->buffer[14] + 0xfde5380c, 23);
 247     MD5STEP(F3, a, b, c, d, md5->buffer[1]  + 0xa4beea44,  4);
 248     MD5STEP(F3, d, a, b, c, md5->buffer[4]  + 0x4bdecfa9, 11);
 249     MD5STEP(F3, c, d, a, b, md5->buffer[7]  + 0xf6bb4b60, 16);
 250     MD5STEP(F3, b, c, d, a, md5->buffer[10] + 0xbebfbc70, 23);
 251     MD5STEP(F3, a, b, c, d, md5->buffer[13] + 0x289b7ec6,  4);
 252     MD5STEP(F3, d, a, b, c, md5->buffer[0]  + 0xeaa127fa, 11);
 253     MD5STEP(F3, c, d, a, b, md5->buffer[3]  + 0xd4ef3085, 16);
 254     MD5STEP(F3, b, c, d, a, md5->buffer[6]  + 0x04881d05, 23);
 255     MD5STEP(F3, a, b, c, d, md5->buffer[9]  + 0xd9d4d039,  4);
 256     MD5STEP(F3, d, a, b, c, md5->buffer[12] + 0xe6db99e5, 11);
 257     MD5STEP(F3, c, d, a, b, md5->buffer[15] + 0x1fa27cf8, 16);
 258     MD5STEP(F3, b, c, d, a, md5->buffer[2]  + 0xc4ac5665, 23);
 259
 260     MD5STEP(F4, a, b, c, d, md5->buffer[0]  + 0xf4292244,  6);
 261     MD5STEP(F4, d, a, b, c, md5->buffer[7]  + 0x432aff97, 10);
 262     MD5STEP(F4, c, d, a, b, md5->buffer[14] + 0xab9423a7, 15);
 263     MD5STEP(F4, b, c, d, a, md5->buffer[5]  + 0xfc93a039, 21);
 264     MD5STEP(F4, a, b, c, d, md5->buffer[12] + 0x655b59c3,  6);
 265     MD5STEP(F4, d, a, b, c, md5->buffer[3]  + 0x8f0ccc92, 10);
 266     MD5STEP(F4, c, d, a, b, md5->buffer[10] + 0xffeff47d, 15);
 267     MD5STEP(F4, b, c, d, a, md5->buffer[1]  + 0x85845dd1, 21);
 268     MD5STEP(F4, a, b, c, d, md5->buffer[8]  + 0x6fa87e4f,  6);
 269     MD5STEP(F4, d, a, b, c, md5->buffer[15] + 0xfe2ce6e0, 10);
 270     MD5STEP(F4, c, d, a, b, md5->buffer[6]  + 0xa3014314, 15);
 271     MD5STEP(F4, b, c, d, a, md5->buffer[13] + 0x4e0811a1, 21);
 272     MD5STEP(F4, a, b, c, d, md5->buffer[4]  + 0xf7537e82,  6);
 273     MD5STEP(F4, d, a, b, c, md5->buffer[11] + 0xbd3af235, 10);
 274     MD5STEP(F4, c, d, a, b, md5->buffer[2]  + 0x2ad7d2bb, 15);
 275     MD5STEP(F4, b, c, d, a, md5->buffer[9]  + 0xeb86d391, 21);
 276
 277     /* Add the working vars back into digest state[]  */
 278     md5->digest[0] += a;
 279     md5->digest[1] += b;
 280     md5->digest[2] += c;
 281     md5->digest[3] += d;
 282 }
 283
 284 #endif /* FREESCALE_MMCAU */
 285
 286
 287 static INLINE void AddLength(Md5* md5, word32 len)
 288 {
 289     word32 tmp = md5->loLen;
 290     if ( (md5->loLen += len) < tmp)
 291         md5->hiLen++;                       /* carry low to high */
 292 }
 293
 294
 295 void Md5Update(Md5* md5, const byte* data, word32 len)
 296 {
 297     /* do block size increments */
 298     byte* local = (byte*)md5->buffer;
 299
 300     while (len) {
 301         word32 add = min(len, MD5_BLOCK_SIZE - md5->buffLen);
 302         XMEMCPY(&local[md5->buffLen], data, add);
 303
 304         md5->buffLen += add;
 305         data         += add;
 306         len          -= add;
 307
 308         if (md5->buffLen == MD5_BLOCK_SIZE) {
 309             #if defined(BIG_ENDIAN_ORDER) && !defined(FREESCALE_MMCAU)
 310                 ByteReverseWords(md5->buffer, md5->buffer, MD5_BLOCK_SIZE);
 311             #endif
 312             XTRANSFORM(md5, local);
 313             AddLength(md5, MD5_BLOCK_SIZE);
 314             md5->buffLen = 0;
 315         }
 316     }
 317 }
 318
 319
 320 void Md5Final(Md5* md5, byte* hash)
 321 {
 322     byte* local = (byte*)md5->buffer;
 323
 324     AddLength(md5, md5->buffLen);  /* before adding pads */
 325
 326     local[md5->buffLen++] = 0x80;  /* add 1 */
 327
 328     /* pad with zeros */
 329     if (md5->buffLen > MD5_PAD_SIZE) {
 330         XMEMSET(&local[md5->buffLen], 0, MD5_BLOCK_SIZE - md5->buffLen);
 331         md5->buffLen += MD5_BLOCK_SIZE - md5->buffLen;
 332
 333         #if defined(BIG_ENDIAN_ORDER) && !defined(FREESCALE_MMCAU)
 334             ByteReverseWords(md5->buffer, md5->buffer, MD5_BLOCK_SIZE);
 335         #endif
 336         XTRANSFORM(md5, local);
 337         md5->buffLen = 0;
 338     }
 339     XMEMSET(&local[md5->buffLen], 0, MD5_PAD_SIZE - md5->buffLen);
 340
 341     /* put lengths in bits */
 342     md5->hiLen = (md5->loLen >> (8*sizeof(md5->loLen) - 3)) +
 343                  (md5->hiLen << 3);
 344     md5->loLen = md5->loLen << 3;
 345
 346     /* store lengths */
 347     #if defined(BIG_ENDIAN_ORDER) && !defined(FREESCALE_MMCAU)
 348         ByteReverseWords(md5->buffer, md5->buffer, MD5_BLOCK_SIZE);
 349     #endif
 350     /* ! length ordering dependent on digest endian type ! */
 351     XMEMCPY(&local[MD5_PAD_SIZE], &md5->loLen, sizeof(word32));
 352     XMEMCPY(&local[MD5_PAD_SIZE + sizeof(word32)], &md5->hiLen, sizeof(word32));
 353
 354     XTRANSFORM(md5, local);
 355     #ifdef BIG_ENDIAN_ORDER
 356         ByteReverseWords(md5->digest, md5->digest, MD5_DIGEST_SIZE);
 357     #endif
 358     XMEMCPY(hash, md5->digest, MD5_DIGEST_SIZE);
 359
 360     InitMd5(md5);  /* reset state */
 361 }
 362
 363 #endif /* STM32F2_HASH */
 364
 365
 366 int Md5Hash(const byte* data, word32 len, byte* hash)
 367 {
 368 #ifdef CYASSL_SMALL_STACK
 369     Md5* md5;
 370 #else
 371     Md5 md5[1];
 372 #endif
 373
 374 #ifdef CYASSL_SMALL_STACK
 375     md5 = (Md5*)XMALLOC(sizeof(Md5), NULL, DYNAMIC_TYPE_TMP_BUFFER);
 376     if (md5 == NULL)
 377         return MEMORY_E;
 378 #endif
 379
 380     InitMd5(md5);
 381     Md5Update(md5, data, len);
 382     Md5Final(md5, hash);
 383
 384 #ifdef CYASSL_SMALL_STACK
 385     XFREE(md5, NULL, DYNAMIC_TYPE_TMP_BUFFER);
 386 #endif
 387
 388     return 0;
 389 }
 390
 391 #endif /* NO_MD5 */