396 lines
11 KiB
C
396 lines
11 KiB
C
|
/*
|
||
|
|
* SHA-1 implementation with hardware ESP32 support added.
|
||
|
|
* Uses mbedTLS software implementation for failover when concurrent
|
||
|
|
* SHA operations are in use.
|
||
|
|
*
|
||
|
|
* Copyright (C) 2006-2015, ARM Limited, All Rights Reserved
|
||
|
|
* Additions Copyright (C) 2016, Espressif Systems (Shanghai) PTE LTD
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Licensed under the Apache License, Version 2.0 (the "License"); you may
|
||
|
|
* not use this file except in compliance with the License.
|
||
|
|
* You may obtain a copy of the License at
|
||
|
|
*
|
||
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
||
|
|
*
|
||
|
|
* Unless required by applicable law or agreed to in writing, software
|
||
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
||
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
|
|
* See the License for the specific language governing permissions and
|
||
|
|
* limitations under the License.
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
/*
|
||
|
|
* The SHA-1 standard was published by NIST in 1993.
|
||
|
|
*
|
||
|
|
* http://www.itl.nist.gov/fipspubs/fip180-1.htm
|
||
|
|
*/
|
||
|
|
|
||
|
|
#if !defined(MBEDTLS_CONFIG_FILE)
|
||
|
|
#include "mbedtls/config.h"
|
||
|
|
#else
|
||
|
|
#include MBEDTLS_CONFIG_FILE
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#if defined(MBEDTLS_SHA1_C) && defined(MBEDTLS_SHA1_ALT)
|
||
|
|
|
||
|
|
#include "mbedtls/sha1.h"
|
||
|
|
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
#if defined(MBEDTLS_SELF_TEST)
|
||
|
|
#if defined(MBEDTLS_PLATFORM_C)
|
||
|
|
#include "mbedtls/platform.h"
|
||
|
|
#else
|
||
|
|
#include <stdio.h>
|
||
|
|
#define mbedtls_printf printf
|
||
|
|
#endif /* MBEDTLS_PLATFORM_C */
|
||
|
|
#endif /* MBEDTLS_SELF_TEST */
|
||
|
|
|
||
|
|
#include "hwcrypto/sha.h"
|
||
|
|
|
||
|
|
/* Implementation that should never be optimized out by the compiler */
|
||
|
|
static void mbedtls_zeroize( void *v, size_t n ) {
|
||
|
|
volatile unsigned char *p = (unsigned char*)v; while( n-- ) *p++ = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* 32-bit integer manipulation macros (big endian)
|
||
|
|
*/
|
||
|
|
#ifndef GET_UINT32_BE
|
||
|
|
#define GET_UINT32_BE(n,b,i) \
|
||
|
|
{ \
|
||
|
|
(n) = ( (uint32_t) (b)[(i) ] << 24 ) \
|
||
|
|
| ( (uint32_t) (b)[(i) + 1] << 16 ) \
|
||
|
|
| ( (uint32_t) (b)[(i) + 2] << 8 ) \
|
||
|
|
| ( (uint32_t) (b)[(i) + 3] ); \
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifndef PUT_UINT32_BE
|
||
|
|
#define PUT_UINT32_BE(n,b,i) \
|
||
|
|
{ \
|
||
|
|
(b)[(i) ] = (unsigned char) ( (n) >> 24 ); \
|
||
|
|
(b)[(i) + 1] = (unsigned char) ( (n) >> 16 ); \
|
||
|
|
(b)[(i) + 2] = (unsigned char) ( (n) >> 8 ); \
|
||
|
|
(b)[(i) + 3] = (unsigned char) ( (n) ); \
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
void mbedtls_sha1_init( mbedtls_sha1_context *ctx )
|
||
|
|
{
|
||
|
|
memset( ctx, 0, sizeof( mbedtls_sha1_context ) );
|
||
|
|
}
|
||
|
|
|
||
|
|
void mbedtls_sha1_free( mbedtls_sha1_context *ctx )
|
||
|
|
{
|
||
|
|
if( ctx == NULL )
|
||
|
|
return;
|
||
|
|
|
||
|
|
if (ctx->mode == ESP_MBEDTLS_SHA1_HARDWARE) {
|
||
|
|
esp_sha_unlock_engine(SHA1);
|
||
|
|
}
|
||
|
|
mbedtls_zeroize( ctx, sizeof( mbedtls_sha1_context ) );
|
||
|
|
}
|
||
|
|
|
||
|
|
void mbedtls_sha1_clone( mbedtls_sha1_context *dst,
|
||
|
|
const mbedtls_sha1_context *src )
|
||
|
|
{
|
||
|
|
*dst = *src;
|
||
|
|
|
||
|
|
if (src->mode == ESP_MBEDTLS_SHA1_HARDWARE) {
|
||
|
|
/* Copy hardware digest state out to cloned state,
|
||
|
|
which will be a software digest.
|
||
|
|
*/
|
||
|
|
esp_sha_read_digest_state(SHA1, dst->state);
|
||
|
|
dst->mode = ESP_MBEDTLS_SHA1_SOFTWARE;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/*
|
||
|
|
* SHA-1 context setup
|
||
|
|
*/
|
||
|
|
void mbedtls_sha1_starts( mbedtls_sha1_context *ctx )
|
||
|
|
{
|
||
|
|
ctx->total[0] = 0;
|
||
|
|
ctx->total[1] = 0;
|
||
|
|
|
||
|
|
ctx->state[0] = 0x67452301;
|
||
|
|
ctx->state[1] = 0xEFCDAB89;
|
||
|
|
ctx->state[2] = 0x98BADCFE;
|
||
|
|
ctx->state[3] = 0x10325476;
|
||
|
|
ctx->state[4] = 0xC3D2E1F0;
|
||
|
|
|
||
|
|
if (ctx->mode == ESP_MBEDTLS_SHA1_HARDWARE) {
|
||
|
|
esp_sha_unlock_engine(SHA1);
|
||
|
|
}
|
||
|
|
ctx->mode = ESP_MBEDTLS_SHA1_UNUSED;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void mbedtls_sha1_software_process( mbedtls_sha1_context *ctx, const unsigned char data[64] );
|
||
|
|
|
||
|
|
void mbedtls_sha1_process( mbedtls_sha1_context *ctx, const unsigned char data[64] )
|
||
|
|
{
|
||
|
|
bool first_block = false;
|
||
|
|
if (ctx->mode == ESP_MBEDTLS_SHA1_UNUSED) {
|
||
|
|
/* try to use hardware for this digest */
|
||
|
|
if (esp_sha_try_lock_engine(SHA1)) {
|
||
|
|
ctx->mode = ESP_MBEDTLS_SHA1_HARDWARE;
|
||
|
|
first_block = true;
|
||
|
|
} else {
|
||
|
|
ctx->mode = ESP_MBEDTLS_SHA1_SOFTWARE;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ctx->mode == ESP_MBEDTLS_SHA1_HARDWARE) {
|
||
|
|
esp_sha_block(SHA1, data, first_block);
|
||
|
|
} else {
|
||
|
|
mbedtls_sha1_software_process(ctx, data);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
static void mbedtls_sha1_software_process( mbedtls_sha1_context *ctx, const unsigned char data[64] )
|
||
|
|
{
|
||
|
|
uint32_t temp, W[16], A, B, C, D, E;
|
||
|
|
|
||
|
|
GET_UINT32_BE( W[ 0], data, 0 );
|
||
|
|
GET_UINT32_BE( W[ 1], data, 4 );
|
||
|
|
GET_UINT32_BE( W[ 2], data, 8 );
|
||
|
|
GET_UINT32_BE( W[ 3], data, 12 );
|
||
|
|
GET_UINT32_BE( W[ 4], data, 16 );
|
||
|
|
GET_UINT32_BE( W[ 5], data, 20 );
|
||
|
|
GET_UINT32_BE( W[ 6], data, 24 );
|
||
|
|
GET_UINT32_BE( W[ 7], data, 28 );
|
||
|
|
GET_UINT32_BE( W[ 8], data, 32 );
|
||
|
|
GET_UINT32_BE( W[ 9], data, 36 );
|
||
|
|
GET_UINT32_BE( W[10], data, 40 );
|
||
|
|
GET_UINT32_BE( W[11], data, 44 );
|
||
|
|
GET_UINT32_BE( W[12], data, 48 );
|
||
|
|
GET_UINT32_BE( W[13], data, 52 );
|
||
|
|
GET_UINT32_BE( W[14], data, 56 );
|
||
|
|
GET_UINT32_BE( W[15], data, 60 );
|
||
|
|
|
||
|
|
#define S(x,n) ((x << n) | ((x & 0xFFFFFFFF) >> (32 - n)))
|
||
|
|
|
||
|
|
#define R(t) \
|
||
|
|
( \
|
||
|
|
temp = W[( t - 3 ) & 0x0F] ^ W[( t - 8 ) & 0x0F] ^ \
|
||
|
|
W[( t - 14 ) & 0x0F] ^ W[ t & 0x0F], \
|
||
|
|
( W[t & 0x0F] = S(temp,1) ) \
|
||
|
|
)
|
||
|
|
|
||
|
|
#define P(a,b,c,d,e,x) \
|
||
|
|
{ \
|
||
|
|
e += S(a,5) + F(b,c,d) + K + x; b = S(b,30); \
|
||
|
|
}
|
||
|
|
|
||
|
|
A = ctx->state[0];
|
||
|
|
B = ctx->state[1];
|
||
|
|
C = ctx->state[2];
|
||
|
|
D = ctx->state[3];
|
||
|
|
E = ctx->state[4];
|
||
|
|
|
||
|
|
#define F(x,y,z) (z ^ (x & (y ^ z)))
|
||
|
|
#define K 0x5A827999
|
||
|
|
|
||
|
|
P( A, B, C, D, E, W[0] );
|
||
|
|
P( E, A, B, C, D, W[1] );
|
||
|
|
P( D, E, A, B, C, W[2] );
|
||
|
|
P( C, D, E, A, B, W[3] );
|
||
|
|
P( B, C, D, E, A, W[4] );
|
||
|
|
P( A, B, C, D, E, W[5] );
|
||
|
|
P( E, A, B, C, D, W[6] );
|
||
|
|
P( D, E, A, B, C, W[7] );
|
||
|
|
P( C, D, E, A, B, W[8] );
|
||
|
|
P( B, C, D, E, A, W[9] );
|
||
|
|
P( A, B, C, D, E, W[10] );
|
||
|
|
P( E, A, B, C, D, W[11] );
|
||
|
|
P( D, E, A, B, C, W[12] );
|
||
|
|
P( C, D, E, A, B, W[13] );
|
||
|
|
P( B, C, D, E, A, W[14] );
|
||
|
|
P( A, B, C, D, E, W[15] );
|
||
|
|
P( E, A, B, C, D, R(16) );
|
||
|
|
P( D, E, A, B, C, R(17) );
|
||
|
|
P( C, D, E, A, B, R(18) );
|
||
|
|
P( B, C, D, E, A, R(19) );
|
||
|
|
|
||
|
|
#undef K
|
||
|
|
#undef F
|
||
|
|
|
||
|
|
#define F(x,y,z) (x ^ y ^ z)
|
||
|
|
#define K 0x6ED9EBA1
|
||
|
|
|
||
|
|
P( A, B, C, D, E, R(20) );
|
||
|
|
P( E, A, B, C, D, R(21) );
|
||
|
|
P( D, E, A, B, C, R(22) );
|
||
|
|
P( C, D, E, A, B, R(23) );
|
||
|
|
P( B, C, D, E, A, R(24) );
|
||
|
|
P( A, B, C, D, E, R(25) );
|
||
|
|
P( E, A, B, C, D, R(26) );
|
||
|
|
P( D, E, A, B, C, R(27) );
|
||
|
|
P( C, D, E, A, B, R(28) );
|
||
|
|
P( B, C, D, E, A, R(29) );
|
||
|
|
P( A, B, C, D, E, R(30) );
|
||
|
|
P( E, A, B, C, D, R(31) );
|
||
|
|
P( D, E, A, B, C, R(32) );
|
||
|
|
P( C, D, E, A, B, R(33) );
|
||
|
|
P( B, C, D, E, A, R(34) );
|
||
|
|
P( A, B, C, D, E, R(35) );
|
||
|
|
P( E, A, B, C, D, R(36) );
|
||
|
|
P( D, E, A, B, C, R(37) );
|
||
|
|
P( C, D, E, A, B, R(38) );
|
||
|
|
P( B, C, D, E, A, R(39) );
|
||
|
|
|
||
|
|
#undef K
|
||
|
|
#undef F
|
||
|
|
|
||
|
|
#define F(x,y,z) ((x & y) | (z & (x | y)))
|
||
|
|
#define K 0x8F1BBCDC
|
||
|
|
|
||
|
|
P( A, B, C, D, E, R(40) );
|
||
|
|
P( E, A, B, C, D, R(41) );
|
||
|
|
P( D, E, A, B, C, R(42) );
|
||
|
|
P( C, D, E, A, B, R(43) );
|
||
|
|
P( B, C, D, E, A, R(44) );
|
||
|
|
P( A, B, C, D, E, R(45) );
|
||
|
|
P( E, A, B, C, D, R(46) );
|
||
|
|
P( D, E, A, B, C, R(47) );
|
||
|
|
P( C, D, E, A, B, R(48) );
|
||
|
|
P( B, C, D, E, A, R(49) );
|
||
|
|
P( A, B, C, D, E, R(50) );
|
||
|
|
P( E, A, B, C, D, R(51) );
|
||
|
|
P( D, E, A, B, C, R(52) );
|
||
|
|
P( C, D, E, A, B, R(53) );
|
||
|
|
P( B, C, D, E, A, R(54) );
|
||
|
|
P( A, B, C, D, E, R(55) );
|
||
|
|
P( E, A, B, C, D, R(56) );
|
||
|
|
P( D, E, A, B, C, R(57) );
|
||
|
|
P( C, D, E, A, B, R(58) );
|
||
|
|
P( B, C, D, E, A, R(59) );
|
||
|
|
|
||
|
|
#undef K
|
||
|
|
#undef F
|
||
|
|
|
||
|
|
#define F(x,y,z) (x ^ y ^ z)
|
||
|
|
#define K 0xCA62C1D6
|
||
|
|
|
||
|
|
P( A, B, C, D, E, R(60) );
|
||
|
|
P( E, A, B, C, D, R(61) );
|
||
|
|
P( D, E, A, B, C, R(62) );
|
||
|
|
P( C, D, E, A, B, R(63) );
|
||
|
|
P( B, C, D, E, A, R(64) );
|
||
|
|
P( A, B, C, D, E, R(65) );
|
||
|
|
P( E, A, B, C, D, R(66) );
|
||
|
|
P( D, E, A, B, C, R(67) );
|
||
|
|
P( C, D, E, A, B, R(68) );
|
||
|
|
P( B, C, D, E, A, R(69) );
|
||
|
|
P( A, B, C, D, E, R(70) );
|
||
|
|
P( E, A, B, C, D, R(71) );
|
||
|
|
P( D, E, A, B, C, R(72) );
|
||
|
|
P( C, D, E, A, B, R(73) );
|
||
|
|
P( B, C, D, E, A, R(74) );
|
||
|
|
P( A, B, C, D, E, R(75) );
|
||
|
|
P( E, A, B, C, D, R(76) );
|
||
|
|
P( D, E, A, B, C, R(77) );
|
||
|
|
P( C, D, E, A, B, R(78) );
|
||
|
|
P( B, C, D, E, A, R(79) );
|
||
|
|
|
||
|
|
#undef K
|
||
|
|
#undef F
|
||
|
|
|
||
|
|
ctx->state[0] += A;
|
||
|
|
ctx->state[1] += B;
|
||
|
|
ctx->state[2] += C;
|
||
|
|
ctx->state[3] += D;
|
||
|
|
ctx->state[4] += E;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* SHA-1 process buffer
|
||
|
|
*/
|
||
|
|
void mbedtls_sha1_update( mbedtls_sha1_context *ctx, const unsigned char *input, size_t ilen )
|
||
|
|
{
|
||
|
|
size_t fill;
|
||
|
|
uint32_t left;
|
||
|
|
|
||
|
|
if( ilen == 0 )
|
||
|
|
return;
|
||
|
|
|
||
|
|
left = ctx->total[0] & 0x3F;
|
||
|
|
fill = 64 - left;
|
||
|
|
|
||
|
|
ctx->total[0] += (uint32_t) ilen;
|
||
|
|
ctx->total[0] &= 0xFFFFFFFF;
|
||
|
|
|
||
|
|
if( ctx->total[0] < (uint32_t) ilen )
|
||
|
|
ctx->total[1]++;
|
||
|
|
|
||
|
|
if( left && ilen >= fill )
|
||
|
|
{
|
||
|
|
memcpy( (void *) (ctx->buffer + left), input, fill );
|
||
|
|
mbedtls_sha1_process( ctx, ctx->buffer );
|
||
|
|
input += fill;
|
||
|
|
ilen -= fill;
|
||
|
|
left = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
while( ilen >= 64 )
|
||
|
|
{
|
||
|
|
mbedtls_sha1_process( ctx, input );
|
||
|
|
input += 64;
|
||
|
|
ilen -= 64;
|
||
|
|
}
|
||
|
|
|
||
|
|
if( ilen > 0 )
|
||
|
|
memcpy( (void *) (ctx->buffer + left), input, ilen );
|
||
|
|
}
|
||
|
|
|
||
|
|
static const unsigned char sha1_padding[64] =
|
||
|
|
{
|
||
|
|
0x80, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
|
||
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
|
||
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
|
||
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
|
||
|
|
};
|
||
|
|
|
||
|
|
/*
|
||
|
|
* SHA-1 final digest
|
||
|
|
*/
|
||
|
|
void mbedtls_sha1_finish( mbedtls_sha1_context *ctx, unsigned char output[20] )
|
||
|
|
{
|
||
|
|
uint32_t last, padn;
|
||
|
|
uint32_t high, low;
|
||
|
|
unsigned char msglen[8];
|
||
|
|
|
||
|
|
high = ( ctx->total[0] >> 29 )
|
||
|
|
| ( ctx->total[1] << 3 );
|
||
|
|
low = ( ctx->total[0] << 3 );
|
||
|
|
|
||
|
|
PUT_UINT32_BE( high, msglen, 0 );
|
||
|
|
PUT_UINT32_BE( low, msglen, 4 );
|
||
|
|
|
||
|
|
last = ctx->total[0] & 0x3F;
|
||
|
|
padn = ( last < 56 ) ? ( 56 - last ) : ( 120 - last );
|
||
|
|
|
||
|
|
mbedtls_sha1_update( ctx, sha1_padding, padn );
|
||
|
|
mbedtls_sha1_update( ctx, msglen, 8 );
|
||
|
|
|
||
|
|
/* if state is in hardware, read it out */
|
||
|
|
if (ctx->mode == ESP_MBEDTLS_SHA1_HARDWARE) {
|
||
|
|
esp_sha_read_digest_state(SHA1, ctx->state);
|
||
|
|
esp_sha_unlock_engine(SHA1);
|
||
|
|
ctx->mode = ESP_MBEDTLS_SHA1_SOFTWARE;
|
||
|
|
}
|
||
|
|
|
||
|
|
PUT_UINT32_BE( ctx->state[0], output, 0 );
|
||
|
|
PUT_UINT32_BE( ctx->state[1], output, 4 );
|
||
|
|
PUT_UINT32_BE( ctx->state[2], output, 8 );
|
||
|
|
PUT_UINT32_BE( ctx->state[3], output, 12 );
|
||
|
|
PUT_UINT32_BE( ctx->state[4], output, 16 );
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif /* MBEDTLS_SHA1_C && MBEDTLS_SHA1_ALT */
|