Plugson/src/Core/ventoy_md5.c

   1 /******************************************************************************
   2  * ventoy_md5.c  ---- ventoy md5
   3  *
   4  * Copyright (c) 2021, longpanda <admin@ventoy.net>
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License as
   8  * published by the Free Software Foundation; either version 3 of the
   9  * License, or (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful, but
  12  * WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18  *
  19  */
  20 #include <stdio.h>
  21 #include <stdlib.h>
  22 #include <stdint.h>
  23 #include <string.h>
  24 #include <errno.h>
  25
  26 const static uint32_t k[64] =
  27 {
  28     0xd76aa478, 0xe8c7b756, 0x242070db, 0xc1bdceee,
  29     0xf57c0faf, 0x4787c62a, 0xa8304613, 0xfd469501,
  30     0x698098d8, 0x8b44f7af, 0xffff5bb1, 0x895cd7be,
  31     0x6b901122, 0xfd987193, 0xa679438e, 0x49b40821,
  32     0xf61e2562, 0xc040b340, 0x265e5a51, 0xe9b6c7aa,
  33     0xd62f105d, 0x02441453, 0xd8a1e681, 0xe7d3fbc8,
  34     0x21e1cde6, 0xc33707d6, 0xf4d50d87, 0x455a14ed,
  35     0xa9e3e905, 0xfcefa3f8, 0x676f02d9, 0x8d2a4c8a,
  36     0xfffa3942, 0x8771f681, 0x6d9d6122, 0xfde5380c,
  37     0xa4beea44, 0x4bdecfa9, 0xf6bb4b60, 0xbebfbc70,
  38     0x289b7ec6, 0xeaa127fa, 0xd4ef3085, 0x04881d05,
  39     0xd9d4d039, 0xe6db99e5, 0x1fa27cf8, 0xc4ac5665,
  40     0xf4292244, 0x432aff97, 0xab9423a7, 0xfc93a039,
  41     0x655b59c3, 0x8f0ccc92, 0xffeff47d, 0x85845dd1,
  42     0x6fa87e4f, 0xfe2ce6e0, 0xa3014314, 0x4e0811a1,
  43     0xf7537e82, 0xbd3af235, 0x2ad7d2bb, 0xeb86d391
  44 };
  45
  46 const static uint32_t r[] =
  47 {
  48     7, 12, 17, 22, 7, 12, 17, 22, 7, 12, 17, 22, 7, 12, 17, 22,
  49     5,  9, 14, 20, 5,  9, 14, 20, 5,  9, 14, 20, 5,  9, 14, 20,
  50     4, 11, 16, 23, 4, 11, 16, 23, 4, 11, 16, 23, 4, 11, 16, 23,
  51     6, 10, 15, 21, 6, 10, 15, 21, 6, 10, 15, 21, 6, 10, 15, 21
  52 };
  53
  54 #define LEFTROTATE(x, c) (((x) << (c)) | ((x) >> (32 - (c))))
  55 #define to_bytes(val, bytes) *((uint32_t *)(bytes)) = (val)
  56
  57 #define ROTATE_CALC() \
  58 {\
  59     temp = d; \
  60     d = c; \
  61     c = b; \
  62     b = b + LEFTROTATE((a + f + k[i] + w[g]), r[i]); \
  63     a = temp; \
  64 }
  65
  66 void ventoy_md5(const void *data, uint32_t len, uint8_t *md5)
  67 {
  68     uint32_t h0, h1, h2, h3;
  69     uint32_t w[16];
  70     uint32_t a, b, c, d, i, f, g, temp;
  71     uint32_t offset, mod, delta;
  72     uint8_t postbuf[128] = {0};
  73
  74     // Initialize variables - simple count in nibbles:
  75     h0 = 0x67452301;
  76     h1 = 0xefcdab89;
  77     h2 = 0x98badcfe;
  78     h3 = 0x10325476;
  79
  80     //Pre-processing:
  81     //append "1" bit to message
  82     //append "0" bits until message length in bits ¡Ô 448 (mod 512)
  83     //append length mod (2^64) to message
  84
  85     mod = len % 64;
  86     if (mod)
  87     {
  88         memcpy(postbuf, (const uint8_t *)data + len - mod, mod);
  89     }
  90
  91     postbuf[mod] = 0x80;
  92     if (mod < 56)
  93     {
  94         to_bytes(len * 8, postbuf + 56);
  95         to_bytes(len >> 29, postbuf + 60);
  96         delta = 64;
  97     }
  98     else
  99     {
 100         to_bytes(len * 8, postbuf + 120);
 101         to_bytes(len >> 29, postbuf + 124);
 102         delta = 128;
 103     }
 104
 105     len -= mod;
 106
 107     for (offset = 0; offset < len + delta; offset += 64)
 108     {
 109         if (offset < len)
 110         {
 111             memcpy(w, (const uint8_t *)data + offset, 64);
 112         }
 113         else
 114         {
 115             memcpy(w, postbuf + offset - len, 64);
 116         }
 117
 118         // Initialize hash value for this chunk:
 119         a = h0;
 120         b = h1;
 121         c = h2;
 122         d = h3;
 123
 124         // Main loop:
 125         for (i = 0; i < 16; i++)
 126         {
 127             f = (b & c) | ((~b) & d);
 128             g = i;
 129             ROTATE_CALC();
 130         }
 131
 132         for (i = 16; i < 32; i++)
 133         {
 134             f = (d & b) | ((~d) & c);
 135             g = (5 * i + 1) % 16;
 136             ROTATE_CALC();
 137         }
 138
 139         for (i = 32; i < 48; i++)
 140         {
 141             f = b ^ c ^ d;
 142             g = (3 * i + 5) % 16;
 143             ROTATE_CALC();
 144         }
 145
 146         for (i = 48; i < 64; i++)
 147         {
 148             f = c ^ (b | (~d));
 149             g = (7 * i) % 16;
 150             ROTATE_CALC();
 151         }
 152
 153         // Add this chunk's hash to result so far:
 154         h0 += a;
 155         h1 += b;
 156         h2 += c;
 157         h3 += d;
 158     }
 159
 160     //var char md5[16] := h0 append h1 append h2 append h3 //(Output is in little-endian)
 161     to_bytes(h0, md5);
 162     to_bytes(h1, md5 + 4);
 163     to_bytes(h2, md5 + 8);
 164     to_bytes(h3, md5 + 12);
 165 }
 166