forked from LeenkxTeam/LNXSDK
		
	
		
			
	
	
		
			269 lines
		
	
	
		
			7.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			269 lines
		
	
	
		
			7.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 *  Elliptic curve Diffie-Hellman
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 *  Copyright (C) 2006-2015, ARM Limited, All Rights Reserved
							 | 
						||
| 
								 | 
							
								 *  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.
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 *  This file is part of mbed TLS (https://tls.mbed.org)
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * References:
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * SEC1 http://www.secg.org/index.php?action=secg,docs_secg
							 | 
						||
| 
								 | 
							
								 * RFC 4492
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#if !defined(MBEDTLS_CONFIG_FILE)
							 | 
						||
| 
								 | 
							
								#include "mbedtls/config.h"
							 | 
						||
| 
								 | 
							
								#else
							 | 
						||
| 
								 | 
							
								#include MBEDTLS_CONFIG_FILE
							 | 
						||
| 
								 | 
							
								#endif
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#if defined(MBEDTLS_ECDH_C)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#include "mbedtls/ecdh.h"
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#include <string.h>
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#if !defined(MBEDTLS_ECDH_GEN_PUBLIC_ALT)
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Generate public key: simple wrapper around mbedtls_ecp_gen_keypair
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_gen_public( mbedtls_ecp_group *grp, mbedtls_mpi *d, mbedtls_ecp_point *Q,
							 | 
						||
| 
								 | 
							
								                     int (*f_rng)(void *, unsigned char *, size_t),
							 | 
						||
| 
								 | 
							
								                     void *p_rng )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    return mbedtls_ecp_gen_keypair( grp, d, Q, f_rng, p_rng );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								#endif /* MBEDTLS_ECDH_GEN_PUBLIC_ALT */
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#if !defined(MBEDTLS_ECDH_COMPUTE_SHARED_ALT)
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Compute shared secret (SEC1 3.3.1)
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_compute_shared( mbedtls_ecp_group *grp, mbedtls_mpi *z,
							 | 
						||
| 
								 | 
							
								                         const mbedtls_ecp_point *Q, const mbedtls_mpi *d,
							 | 
						||
| 
								 | 
							
								                         int (*f_rng)(void *, unsigned char *, size_t),
							 | 
						||
| 
								 | 
							
								                         void *p_rng )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int ret;
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_point P;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_point_init( &P );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    /*
							 | 
						||
| 
								 | 
							
								     * Make sure Q is a valid pubkey before using it
							 | 
						||
| 
								 | 
							
								     */
							 | 
						||
| 
								 | 
							
								    MBEDTLS_MPI_CHK( mbedtls_ecp_check_pubkey( grp, Q ) );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    MBEDTLS_MPI_CHK( mbedtls_ecp_mul( grp, &P, d, Q, f_rng, p_rng ) );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( mbedtls_ecp_is_zero( &P ) )
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								        ret = MBEDTLS_ERR_ECP_BAD_INPUT_DATA;
							 | 
						||
| 
								 | 
							
								        goto cleanup;
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    MBEDTLS_MPI_CHK( mbedtls_mpi_copy( z, &P.X ) );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								cleanup:
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_point_free( &P );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return( ret );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								#endif /* MBEDTLS_ECDH_COMPUTE_SHARED_ALT */
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Initialize context
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								void mbedtls_ecdh_init( mbedtls_ecdh_context *ctx )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    memset( ctx, 0, sizeof( mbedtls_ecdh_context ) );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Free context
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								void mbedtls_ecdh_free( mbedtls_ecdh_context *ctx )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    if( ctx == NULL )
							 | 
						||
| 
								 | 
							
								        return;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_group_free( &ctx->grp );
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_point_free( &ctx->Q   );
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_point_free( &ctx->Qp  );
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_point_free( &ctx->Vi  );
							 | 
						||
| 
								 | 
							
								    mbedtls_ecp_point_free( &ctx->Vf  );
							 | 
						||
| 
								 | 
							
								    mbedtls_mpi_free( &ctx->d  );
							 | 
						||
| 
								 | 
							
								    mbedtls_mpi_free( &ctx->z  );
							 | 
						||
| 
								 | 
							
								    mbedtls_mpi_free( &ctx->_d );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Setup and write the ServerKeyExhange parameters (RFC 4492)
							 | 
						||
| 
								 | 
							
								 *      struct {
							 | 
						||
| 
								 | 
							
								 *          ECParameters    curve_params;
							 | 
						||
| 
								 | 
							
								 *          ECPoint         public;
							 | 
						||
| 
								 | 
							
								 *      } ServerECDHParams;
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_make_params( mbedtls_ecdh_context *ctx, size_t *olen,
							 | 
						||
| 
								 | 
							
								                      unsigned char *buf, size_t blen,
							 | 
						||
| 
								 | 
							
								                      int (*f_rng)(void *, unsigned char *, size_t),
							 | 
						||
| 
								 | 
							
								                      void *p_rng )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int ret;
							 | 
						||
| 
								 | 
							
								    size_t grp_len, pt_len;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ctx == NULL || ctx->grp.pbits == 0 )
							 | 
						||
| 
								 | 
							
								        return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecdh_gen_public( &ctx->grp, &ctx->d, &ctx->Q, f_rng, p_rng ) )
							 | 
						||
| 
								 | 
							
								                != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecp_tls_write_group( &ctx->grp, &grp_len, buf, blen ) )
							 | 
						||
| 
								 | 
							
								                != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    buf += grp_len;
							 | 
						||
| 
								 | 
							
								    blen -= grp_len;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecp_tls_write_point( &ctx->grp, &ctx->Q, ctx->point_format,
							 | 
						||
| 
								 | 
							
								                                     &pt_len, buf, blen ) ) != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    *olen = grp_len + pt_len;
							 | 
						||
| 
								 | 
							
								    return( 0 );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Read the ServerKeyExhange parameters (RFC 4492)
							 | 
						||
| 
								 | 
							
								 *      struct {
							 | 
						||
| 
								 | 
							
								 *          ECParameters    curve_params;
							 | 
						||
| 
								 | 
							
								 *          ECPoint         public;
							 | 
						||
| 
								 | 
							
								 *      } ServerECDHParams;
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_read_params( mbedtls_ecdh_context *ctx,
							 | 
						||
| 
								 | 
							
								                      const unsigned char **buf, const unsigned char *end )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int ret;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecp_tls_read_group( &ctx->grp, buf, end - *buf ) ) != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecp_tls_read_point( &ctx->grp, &ctx->Qp, buf, end - *buf ) )
							 | 
						||
| 
								 | 
							
								                != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return( 0 );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Get parameters from a keypair
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_get_params( mbedtls_ecdh_context *ctx, const mbedtls_ecp_keypair *key,
							 | 
						||
| 
								 | 
							
								                     mbedtls_ecdh_side side )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int ret;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecp_group_copy( &ctx->grp, &key->grp ) ) != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    /* If it's not our key, just import the public part as Qp */
							 | 
						||
| 
								 | 
							
								    if( side == MBEDTLS_ECDH_THEIRS )
							 | 
						||
| 
								 | 
							
								        return( mbedtls_ecp_copy( &ctx->Qp, &key->Q ) );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    /* Our key: import public (as Q) and private parts */
							 | 
						||
| 
								 | 
							
								    if( side != MBEDTLS_ECDH_OURS )
							 | 
						||
| 
								 | 
							
								        return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecp_copy( &ctx->Q, &key->Q ) ) != 0 ||
							 | 
						||
| 
								 | 
							
								        ( ret = mbedtls_mpi_copy( &ctx->d, &key->d ) ) != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return( 0 );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Setup and export the client public value
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_make_public( mbedtls_ecdh_context *ctx, size_t *olen,
							 | 
						||
| 
								 | 
							
								                      unsigned char *buf, size_t blen,
							 | 
						||
| 
								 | 
							
								                      int (*f_rng)(void *, unsigned char *, size_t),
							 | 
						||
| 
								 | 
							
								                      void *p_rng )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int ret;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ctx == NULL || ctx->grp.pbits == 0 )
							 | 
						||
| 
								 | 
							
								        return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecdh_gen_public( &ctx->grp, &ctx->d, &ctx->Q, f_rng, p_rng ) )
							 | 
						||
| 
								 | 
							
								                != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return mbedtls_ecp_tls_write_point( &ctx->grp, &ctx->Q, ctx->point_format,
							 | 
						||
| 
								 | 
							
								                                olen, buf, blen );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Parse and import the client's public value
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_read_public( mbedtls_ecdh_context *ctx,
							 | 
						||
| 
								 | 
							
								                      const unsigned char *buf, size_t blen )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int ret;
							 | 
						||
| 
								 | 
							
								    const unsigned char *p = buf;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ctx == NULL )
							 | 
						||
| 
								 | 
							
								        return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecp_tls_read_point( &ctx->grp, &ctx->Qp, &p, blen ) ) != 0 )
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( (size_t)( p - buf ) != blen )
							 | 
						||
| 
								 | 
							
								        return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return( 0 );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Derive and export the shared secret
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								int mbedtls_ecdh_calc_secret( mbedtls_ecdh_context *ctx, size_t *olen,
							 | 
						||
| 
								 | 
							
								                      unsigned char *buf, size_t blen,
							 | 
						||
| 
								 | 
							
								                      int (*f_rng)(void *, unsigned char *, size_t),
							 | 
						||
| 
								 | 
							
								                      void *p_rng )
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int ret;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ctx == NULL )
							 | 
						||
| 
								 | 
							
								        return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( ( ret = mbedtls_ecdh_compute_shared( &ctx->grp, &ctx->z, &ctx->Qp, &ctx->d,
							 | 
						||
| 
								 | 
							
								                                     f_rng, p_rng ) ) != 0 )
							 | 
						||
| 
								 | 
							
								    {
							 | 
						||
| 
								 | 
							
								        return( ret );
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if( mbedtls_mpi_size( &ctx->z ) > blen )
							 | 
						||
| 
								 | 
							
								        return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    *olen = ctx->grp.pbits / 8 + ( ( ctx->grp.pbits % 8 ) != 0 );
							 | 
						||
| 
								 | 
							
								    return mbedtls_mpi_write_binary( &ctx->z, buf, *olen );
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#endif /* MBEDTLS_ECDH_C */
							 |