+/*****************************************************************************
+ * Digest: update the MD5 digest with 64 bytes of data
+ *****************************************************************************/
+static void Digest( struct md5_s *p_md5, uint32_t *p_input )
+{
+ uint32_t a, b, c, d;
+
+ REVERSE( p_input, 16 );
+
+ a = p_md5->p_digest[ 0 ];
+ b = p_md5->p_digest[ 1 ];
+ c = p_md5->p_digest[ 2 ];
+ d = p_md5->p_digest[ 3 ];
+
+ MD5_DO( F1, a, b, c, d, p_input[ 0 ] + 0xd76aa478, 7 );
+ MD5_DO( F1, d, a, b, c, p_input[ 1 ] + 0xe8c7b756, 12 );
+ MD5_DO( F1, c, d, a, b, p_input[ 2 ] + 0x242070db, 17 );
+ MD5_DO( F1, b, c, d, a, p_input[ 3 ] + 0xc1bdceee, 22 );
+ MD5_DO( F1, a, b, c, d, p_input[ 4 ] + 0xf57c0faf, 7 );
+ MD5_DO( F1, d, a, b, c, p_input[ 5 ] + 0x4787c62a, 12 );
+ MD5_DO( F1, c, d, a, b, p_input[ 6 ] + 0xa8304613, 17 );
+ MD5_DO( F1, b, c, d, a, p_input[ 7 ] + 0xfd469501, 22 );
+ MD5_DO( F1, a, b, c, d, p_input[ 8 ] + 0x698098d8, 7 );
+ MD5_DO( F1, d, a, b, c, p_input[ 9 ] + 0x8b44f7af, 12 );
+ MD5_DO( F1, c, d, a, b, p_input[ 10 ] + 0xffff5bb1, 17 );
+ MD5_DO( F1, b, c, d, a, p_input[ 11 ] + 0x895cd7be, 22 );
+ MD5_DO( F1, a, b, c, d, p_input[ 12 ] + 0x6b901122, 7 );
+ MD5_DO( F1, d, a, b, c, p_input[ 13 ] + 0xfd987193, 12 );
+ MD5_DO( F1, c, d, a, b, p_input[ 14 ] + 0xa679438e, 17 );
+ MD5_DO( F1, b, c, d, a, p_input[ 15 ] + 0x49b40821, 22 );
+
+ MD5_DO( F2, a, b, c, d, p_input[ 1 ] + 0xf61e2562, 5 );
+ MD5_DO( F2, d, a, b, c, p_input[ 6 ] + 0xc040b340, 9 );
+ MD5_DO( F2, c, d, a, b, p_input[ 11 ] + 0x265e5a51, 14 );
+ MD5_DO( F2, b, c, d, a, p_input[ 0 ] + 0xe9b6c7aa, 20 );
+ MD5_DO( F2, a, b, c, d, p_input[ 5 ] + 0xd62f105d, 5 );
+ MD5_DO( F2, d, a, b, c, p_input[ 10 ] + 0x02441453, 9 );
+ MD5_DO( F2, c, d, a, b, p_input[ 15 ] + 0xd8a1e681, 14 );
+ MD5_DO( F2, b, c, d, a, p_input[ 4 ] + 0xe7d3fbc8, 20 );
+ MD5_DO( F2, a, b, c, d, p_input[ 9 ] + 0x21e1cde6, 5 );
+ MD5_DO( F2, d, a, b, c, p_input[ 14 ] + 0xc33707d6, 9 );
+ MD5_DO( F2, c, d, a, b, p_input[ 3 ] + 0xf4d50d87, 14 );
+ MD5_DO( F2, b, c, d, a, p_input[ 8 ] + 0x455a14ed, 20 );
+ MD5_DO( F2, a, b, c, d, p_input[ 13 ] + 0xa9e3e905, 5 );
+ MD5_DO( F2, d, a, b, c, p_input[ 2 ] + 0xfcefa3f8, 9 );
+ MD5_DO( F2, c, d, a, b, p_input[ 7 ] + 0x676f02d9, 14 );
+ MD5_DO( F2, b, c, d, a, p_input[ 12 ] + 0x8d2a4c8a, 20 );
+
+ MD5_DO( F3, a, b, c, d, p_input[ 5 ] + 0xfffa3942, 4 );
+ MD5_DO( F3, d, a, b, c, p_input[ 8 ] + 0x8771f681, 11 );
+ MD5_DO( F3, c, d, a, b, p_input[ 11 ] + 0x6d9d6122, 16 );
+ MD5_DO( F3, b, c, d, a, p_input[ 14 ] + 0xfde5380c, 23 );
+ MD5_DO( F3, a, b, c, d, p_input[ 1 ] + 0xa4beea44, 4 );
+ MD5_DO( F3, d, a, b, c, p_input[ 4 ] + 0x4bdecfa9, 11 );
+ MD5_DO( F3, c, d, a, b, p_input[ 7 ] + 0xf6bb4b60, 16 );
+ MD5_DO( F3, b, c, d, a, p_input[ 10 ] + 0xbebfbc70, 23 );
+ MD5_DO( F3, a, b, c, d, p_input[ 13 ] + 0x289b7ec6, 4 );
+ MD5_DO( F3, d, a, b, c, p_input[ 0 ] + 0xeaa127fa, 11 );
+ MD5_DO( F3, c, d, a, b, p_input[ 3 ] + 0xd4ef3085, 16 );
+ MD5_DO( F3, b, c, d, a, p_input[ 6 ] + 0x04881d05, 23 );
+ MD5_DO( F3, a, b, c, d, p_input[ 9 ] + 0xd9d4d039, 4 );
+ MD5_DO( F3, d, a, b, c, p_input[ 12 ] + 0xe6db99e5, 11 );
+ MD5_DO( F3, c, d, a, b, p_input[ 15 ] + 0x1fa27cf8, 16 );
+ MD5_DO( F3, b, c, d, a, p_input[ 2 ] + 0xc4ac5665, 23 );
+
+ MD5_DO( F4, a, b, c, d, p_input[ 0 ] + 0xf4292244, 6 );
+ MD5_DO( F4, d, a, b, c, p_input[ 7 ] + 0x432aff97, 10 );
+ MD5_DO( F4, c, d, a, b, p_input[ 14 ] + 0xab9423a7, 15 );
+ MD5_DO( F4, b, c, d, a, p_input[ 5 ] + 0xfc93a039, 21 );
+ MD5_DO( F4, a, b, c, d, p_input[ 12 ] + 0x655b59c3, 6 );
+ MD5_DO( F4, d, a, b, c, p_input[ 3 ] + 0x8f0ccc92, 10 );
+ MD5_DO( F4, c, d, a, b, p_input[ 10 ] + 0xffeff47d, 15 );
+ MD5_DO( F4, b, c, d, a, p_input[ 1 ] + 0x85845dd1, 21 );
+ MD5_DO( F4, a, b, c, d, p_input[ 8 ] + 0x6fa87e4f, 6 );
+ MD5_DO( F4, d, a, b, c, p_input[ 15 ] + 0xfe2ce6e0, 10 );
+ MD5_DO( F4, c, d, a, b, p_input[ 6 ] + 0xa3014314, 15 );
+ MD5_DO( F4, b, c, d, a, p_input[ 13 ] + 0x4e0811a1, 21 );
+ MD5_DO( F4, a, b, c, d, p_input[ 4 ] + 0xf7537e82, 6 );
+ MD5_DO( F4, d, a, b, c, p_input[ 11 ] + 0xbd3af235, 10 );
+ MD5_DO( F4, c, d, a, b, p_input[ 2 ] + 0x2ad7d2bb, 15 );
+ MD5_DO( F4, b, c, d, a, p_input[ 9 ] + 0xeb86d391, 21 );
+
+ p_md5->p_digest[ 0 ] += a;
+ p_md5->p_digest[ 1 ] += b;
+ p_md5->p_digest[ 2 ] += c;
+ p_md5->p_digest[ 3 ] += d;