Kenji Arai / mbed-os_TYBLE16

mbed-os5 only for TYBLE16

Dependents:   TYBLE16_simple_data_logger TYBLE16_MP3_Air

features/mbedtls/src/pkcs11.c@0:5b88d5760320, 2019-12-17 (annotated)

Committer:
kenjiArai
Date:
Tue Dec 17 23:23:45 2019 +0000
Revision:
0:5b88d5760320
mbed-os5 only for TYBLE16

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kenjiArai 0:5b88d5760320 1 /**
kenjiArai 0:5b88d5760320 2 * \file pkcs11.c
kenjiArai 0:5b88d5760320 3 *
kenjiArai 0:5b88d5760320 4 * \brief Wrapper for PKCS#11 library libpkcs11-helper
kenjiArai 0:5b88d5760320 5 *
kenjiArai 0:5b88d5760320 6 * \author Adriaan de Jong <dejong@fox-it.com>
kenjiArai 0:5b88d5760320 7 *
kenjiArai 0:5b88d5760320 8 * Copyright (C) 2006-2015, ARM Limited, All Rights Reserved
kenjiArai 0:5b88d5760320 9 * SPDX-License-Identifier: Apache-2.0
kenjiArai 0:5b88d5760320 10 *
kenjiArai 0:5b88d5760320 11 * Licensed under the Apache License, Version 2.0 (the "License"); you may
kenjiArai 0:5b88d5760320 12 * not use this file except in compliance with the License.
kenjiArai 0:5b88d5760320 13 * You may obtain a copy of the License at
kenjiArai 0:5b88d5760320 14 *
kenjiArai 0:5b88d5760320 15 * http://www.apache.org/licenses/LICENSE-2.0
kenjiArai 0:5b88d5760320 16 *
kenjiArai 0:5b88d5760320 17 * Unless required by applicable law or agreed to in writing, software
kenjiArai 0:5b88d5760320 18 * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
kenjiArai 0:5b88d5760320 19 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kenjiArai 0:5b88d5760320 20 * See the License for the specific language governing permissions and
kenjiArai 0:5b88d5760320 21 * limitations under the License.
kenjiArai 0:5b88d5760320 22 *
kenjiArai 0:5b88d5760320 23 * This file is part of mbed TLS (https://tls.mbed.org)
kenjiArai 0:5b88d5760320 24 */
kenjiArai 0:5b88d5760320 25
kenjiArai 0:5b88d5760320 26 #include "mbedtls/pkcs11.h"
kenjiArai 0:5b88d5760320 27
kenjiArai 0:5b88d5760320 28 #if defined(MBEDTLS_PKCS11_C)
kenjiArai 0:5b88d5760320 29
kenjiArai 0:5b88d5760320 30 #include "mbedtls/md.h"
kenjiArai 0:5b88d5760320 31 #include "mbedtls/oid.h"
kenjiArai 0:5b88d5760320 32 #include "mbedtls/x509_crt.h"
kenjiArai 0:5b88d5760320 33
kenjiArai 0:5b88d5760320 34 #if defined(MBEDTLS_PLATFORM_C)
kenjiArai 0:5b88d5760320 35 #include "mbedtls/platform.h"
kenjiArai 0:5b88d5760320 36 #else
kenjiArai 0:5b88d5760320 37 #include <stdlib.h>
kenjiArai 0:5b88d5760320 38 #define mbedtls_calloc calloc
kenjiArai 0:5b88d5760320 39 #define mbedtls_free free
kenjiArai 0:5b88d5760320 40 #endif
kenjiArai 0:5b88d5760320 41
kenjiArai 0:5b88d5760320 42 #include <string.h>
kenjiArai 0:5b88d5760320 43
kenjiArai 0:5b88d5760320 44 void mbedtls_pkcs11_init( mbedtls_pkcs11_context *ctx )
kenjiArai 0:5b88d5760320 45 {
kenjiArai 0:5b88d5760320 46 memset( ctx, 0, sizeof( mbedtls_pkcs11_context ) );
kenjiArai 0:5b88d5760320 47 }
kenjiArai 0:5b88d5760320 48
kenjiArai 0:5b88d5760320 49 int mbedtls_pkcs11_x509_cert_bind( mbedtls_x509_crt *cert, pkcs11h_certificate_t pkcs11_cert )
kenjiArai 0:5b88d5760320 50 {
kenjiArai 0:5b88d5760320 51 int ret = 1;
kenjiArai 0:5b88d5760320 52 unsigned char *cert_blob = NULL;
kenjiArai 0:5b88d5760320 53 size_t cert_blob_size = 0;
kenjiArai 0:5b88d5760320 54
kenjiArai 0:5b88d5760320 55 if( cert == NULL )
kenjiArai 0:5b88d5760320 56 {
kenjiArai 0:5b88d5760320 57 ret = 2;
kenjiArai 0:5b88d5760320 58 goto cleanup;
kenjiArai 0:5b88d5760320 59 }
kenjiArai 0:5b88d5760320 60
kenjiArai 0:5b88d5760320 61 if( pkcs11h_certificate_getCertificateBlob( pkcs11_cert, NULL,
kenjiArai 0:5b88d5760320 62 &cert_blob_size ) != CKR_OK )
kenjiArai 0:5b88d5760320 63 {
kenjiArai 0:5b88d5760320 64 ret = 3;
kenjiArai 0:5b88d5760320 65 goto cleanup;
kenjiArai 0:5b88d5760320 66 }
kenjiArai 0:5b88d5760320 67
kenjiArai 0:5b88d5760320 68 cert_blob = mbedtls_calloc( 1, cert_blob_size );
kenjiArai 0:5b88d5760320 69 if( NULL == cert_blob )
kenjiArai 0:5b88d5760320 70 {
kenjiArai 0:5b88d5760320 71 ret = 4;
kenjiArai 0:5b88d5760320 72 goto cleanup;
kenjiArai 0:5b88d5760320 73 }
kenjiArai 0:5b88d5760320 74
kenjiArai 0:5b88d5760320 75 if( pkcs11h_certificate_getCertificateBlob( pkcs11_cert, cert_blob,
kenjiArai 0:5b88d5760320 76 &cert_blob_size ) != CKR_OK )
kenjiArai 0:5b88d5760320 77 {
kenjiArai 0:5b88d5760320 78 ret = 5;
kenjiArai 0:5b88d5760320 79 goto cleanup;
kenjiArai 0:5b88d5760320 80 }
kenjiArai 0:5b88d5760320 81
kenjiArai 0:5b88d5760320 82 if( 0 != mbedtls_x509_crt_parse( cert, cert_blob, cert_blob_size ) )
kenjiArai 0:5b88d5760320 83 {
kenjiArai 0:5b88d5760320 84 ret = 6;
kenjiArai 0:5b88d5760320 85 goto cleanup;
kenjiArai 0:5b88d5760320 86 }
kenjiArai 0:5b88d5760320 87
kenjiArai 0:5b88d5760320 88 ret = 0;
kenjiArai 0:5b88d5760320 89
kenjiArai 0:5b88d5760320 90 cleanup:
kenjiArai 0:5b88d5760320 91 if( NULL != cert_blob )
kenjiArai 0:5b88d5760320 92 mbedtls_free( cert_blob );
kenjiArai 0:5b88d5760320 93
kenjiArai 0:5b88d5760320 94 return( ret );
kenjiArai 0:5b88d5760320 95 }
kenjiArai 0:5b88d5760320 96
kenjiArai 0:5b88d5760320 97
kenjiArai 0:5b88d5760320 98 int mbedtls_pkcs11_priv_key_bind( mbedtls_pkcs11_context *priv_key,
kenjiArai 0:5b88d5760320 99 pkcs11h_certificate_t pkcs11_cert )
kenjiArai 0:5b88d5760320 100 {
kenjiArai 0:5b88d5760320 101 int ret = 1;
kenjiArai 0:5b88d5760320 102 mbedtls_x509_crt cert;
kenjiArai 0:5b88d5760320 103
kenjiArai 0:5b88d5760320 104 mbedtls_x509_crt_init( &cert );
kenjiArai 0:5b88d5760320 105
kenjiArai 0:5b88d5760320 106 if( priv_key == NULL )
kenjiArai 0:5b88d5760320 107 goto cleanup;
kenjiArai 0:5b88d5760320 108
kenjiArai 0:5b88d5760320 109 if( 0 != mbedtls_pkcs11_x509_cert_bind( &cert, pkcs11_cert ) )
kenjiArai 0:5b88d5760320 110 goto cleanup;
kenjiArai 0:5b88d5760320 111
kenjiArai 0:5b88d5760320 112 priv_key->len = mbedtls_pk_get_len( &cert.pk );
kenjiArai 0:5b88d5760320 113 priv_key->pkcs11h_cert = pkcs11_cert;
kenjiArai 0:5b88d5760320 114
kenjiArai 0:5b88d5760320 115 ret = 0;
kenjiArai 0:5b88d5760320 116
kenjiArai 0:5b88d5760320 117 cleanup:
kenjiArai 0:5b88d5760320 118 mbedtls_x509_crt_free( &cert );
kenjiArai 0:5b88d5760320 119
kenjiArai 0:5b88d5760320 120 return( ret );
kenjiArai 0:5b88d5760320 121 }
kenjiArai 0:5b88d5760320 122
kenjiArai 0:5b88d5760320 123 void mbedtls_pkcs11_priv_key_free( mbedtls_pkcs11_context *priv_key )
kenjiArai 0:5b88d5760320 124 {
kenjiArai 0:5b88d5760320 125 if( NULL != priv_key )
kenjiArai 0:5b88d5760320 126 pkcs11h_certificate_freeCertificate( priv_key->pkcs11h_cert );
kenjiArai 0:5b88d5760320 127 }
kenjiArai 0:5b88d5760320 128
kenjiArai 0:5b88d5760320 129 int mbedtls_pkcs11_decrypt( mbedtls_pkcs11_context *ctx,
kenjiArai 0:5b88d5760320 130 int mode, size_t *olen,
kenjiArai 0:5b88d5760320 131 const unsigned char *input,
kenjiArai 0:5b88d5760320 132 unsigned char *output,
kenjiArai 0:5b88d5760320 133 size_t output_max_len )
kenjiArai 0:5b88d5760320 134 {
kenjiArai 0:5b88d5760320 135 size_t input_len, output_len;
kenjiArai 0:5b88d5760320 136
kenjiArai 0:5b88d5760320 137 if( NULL == ctx )
kenjiArai 0:5b88d5760320 138 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 139
kenjiArai 0:5b88d5760320 140 if( MBEDTLS_RSA_PRIVATE != mode )
kenjiArai 0:5b88d5760320 141 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 142
kenjiArai 0:5b88d5760320 143 output_len = input_len = ctx->len;
kenjiArai 0:5b88d5760320 144
kenjiArai 0:5b88d5760320 145 if( input_len < 16 || input_len > output_max_len )
kenjiArai 0:5b88d5760320 146 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 147
kenjiArai 0:5b88d5760320 148 /* Determine size of output buffer */
kenjiArai 0:5b88d5760320 149 if( pkcs11h_certificate_decryptAny( ctx->pkcs11h_cert, CKM_RSA_PKCS, input,
kenjiArai 0:5b88d5760320 150 input_len, NULL, &output_len ) != CKR_OK )
kenjiArai 0:5b88d5760320 151 {
kenjiArai 0:5b88d5760320 152 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 153 }
kenjiArai 0:5b88d5760320 154
kenjiArai 0:5b88d5760320 155 if( output_len > output_max_len )
kenjiArai 0:5b88d5760320 156 return( MBEDTLS_ERR_RSA_OUTPUT_TOO_LARGE );
kenjiArai 0:5b88d5760320 157
kenjiArai 0:5b88d5760320 158 if( pkcs11h_certificate_decryptAny( ctx->pkcs11h_cert, CKM_RSA_PKCS, input,
kenjiArai 0:5b88d5760320 159 input_len, output, &output_len ) != CKR_OK )
kenjiArai 0:5b88d5760320 160 {
kenjiArai 0:5b88d5760320 161 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 162 }
kenjiArai 0:5b88d5760320 163 *olen = output_len;
kenjiArai 0:5b88d5760320 164 return( 0 );
kenjiArai 0:5b88d5760320 165 }
kenjiArai 0:5b88d5760320 166
kenjiArai 0:5b88d5760320 167 int mbedtls_pkcs11_sign( mbedtls_pkcs11_context *ctx,
kenjiArai 0:5b88d5760320 168 int mode,
kenjiArai 0:5b88d5760320 169 mbedtls_md_type_t md_alg,
kenjiArai 0:5b88d5760320 170 unsigned int hashlen,
kenjiArai 0:5b88d5760320 171 const unsigned char *hash,
kenjiArai 0:5b88d5760320 172 unsigned char *sig )
kenjiArai 0:5b88d5760320 173 {
kenjiArai 0:5b88d5760320 174 size_t sig_len = 0, asn_len = 0, oid_size = 0;
kenjiArai 0:5b88d5760320 175 unsigned char *p = sig;
kenjiArai 0:5b88d5760320 176 const char *oid;
kenjiArai 0:5b88d5760320 177
kenjiArai 0:5b88d5760320 178 if( NULL == ctx )
kenjiArai 0:5b88d5760320 179 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 180
kenjiArai 0:5b88d5760320 181 if( MBEDTLS_RSA_PRIVATE != mode )
kenjiArai 0:5b88d5760320 182 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 183
kenjiArai 0:5b88d5760320 184 if( md_alg != MBEDTLS_MD_NONE )
kenjiArai 0:5b88d5760320 185 {
kenjiArai 0:5b88d5760320 186 const mbedtls_md_info_t *md_info = mbedtls_md_info_from_type( md_alg );
kenjiArai 0:5b88d5760320 187 if( md_info == NULL )
kenjiArai 0:5b88d5760320 188 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 189
kenjiArai 0:5b88d5760320 190 if( mbedtls_oid_get_oid_by_md( md_alg, &oid, &oid_size ) != 0 )
kenjiArai 0:5b88d5760320 191 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 192
kenjiArai 0:5b88d5760320 193 hashlen = mbedtls_md_get_size( md_info );
kenjiArai 0:5b88d5760320 194 asn_len = 10 + oid_size;
kenjiArai 0:5b88d5760320 195 }
kenjiArai 0:5b88d5760320 196
kenjiArai 0:5b88d5760320 197 sig_len = ctx->len;
kenjiArai 0:5b88d5760320 198 if( hashlen > sig_len || asn_len > sig_len ||
kenjiArai 0:5b88d5760320 199 hashlen + asn_len > sig_len )
kenjiArai 0:5b88d5760320 200 {
kenjiArai 0:5b88d5760320 201 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 202 }
kenjiArai 0:5b88d5760320 203
kenjiArai 0:5b88d5760320 204 if( md_alg != MBEDTLS_MD_NONE )
kenjiArai 0:5b88d5760320 205 {
kenjiArai 0:5b88d5760320 206 /*
kenjiArai 0:5b88d5760320 207 * DigestInfo ::= SEQUENCE {
kenjiArai 0:5b88d5760320 208 * digestAlgorithm DigestAlgorithmIdentifier,
kenjiArai 0:5b88d5760320 209 * digest Digest }
kenjiArai 0:5b88d5760320 210 *
kenjiArai 0:5b88d5760320 211 * DigestAlgorithmIdentifier ::= AlgorithmIdentifier
kenjiArai 0:5b88d5760320 212 *
kenjiArai 0:5b88d5760320 213 * Digest ::= OCTET STRING
kenjiArai 0:5b88d5760320 214 */
kenjiArai 0:5b88d5760320 215 *p++ = MBEDTLS_ASN1_SEQUENCE | MBEDTLS_ASN1_CONSTRUCTED;
kenjiArai 0:5b88d5760320 216 *p++ = (unsigned char) ( 0x08 + oid_size + hashlen );
kenjiArai 0:5b88d5760320 217 *p++ = MBEDTLS_ASN1_SEQUENCE | MBEDTLS_ASN1_CONSTRUCTED;
kenjiArai 0:5b88d5760320 218 *p++ = (unsigned char) ( 0x04 + oid_size );
kenjiArai 0:5b88d5760320 219 *p++ = MBEDTLS_ASN1_OID;
kenjiArai 0:5b88d5760320 220 *p++ = oid_size & 0xFF;
kenjiArai 0:5b88d5760320 221 memcpy( p, oid, oid_size );
kenjiArai 0:5b88d5760320 222 p += oid_size;
kenjiArai 0:5b88d5760320 223 *p++ = MBEDTLS_ASN1_NULL;
kenjiArai 0:5b88d5760320 224 *p++ = 0x00;
kenjiArai 0:5b88d5760320 225 *p++ = MBEDTLS_ASN1_OCTET_STRING;
kenjiArai 0:5b88d5760320 226 *p++ = hashlen;
kenjiArai 0:5b88d5760320 227 }
kenjiArai 0:5b88d5760320 228
kenjiArai 0:5b88d5760320 229 memcpy( p, hash, hashlen );
kenjiArai 0:5b88d5760320 230
kenjiArai 0:5b88d5760320 231 if( pkcs11h_certificate_signAny( ctx->pkcs11h_cert, CKM_RSA_PKCS, sig,
kenjiArai 0:5b88d5760320 232 asn_len + hashlen, sig, &sig_len ) != CKR_OK )
kenjiArai 0:5b88d5760320 233 {
kenjiArai 0:5b88d5760320 234 return( MBEDTLS_ERR_RSA_BAD_INPUT_DATA );
kenjiArai 0:5b88d5760320 235 }
kenjiArai 0:5b88d5760320 236
kenjiArai 0:5b88d5760320 237 return( 0 );
kenjiArai 0:5b88d5760320 238 }
kenjiArai 0:5b88d5760320 239
kenjiArai 0:5b88d5760320 240 #endif /* defined(MBEDTLS_PKCS11_C) */