takashi kadono / Mbed OS Nucleo_446

Dependencies:   ssd1331

Committer:
kadonotakashi
Date:
Thu Oct 11 02:27:46 2018 +0000
Revision:
3:f3764f852aa8
Parent:
0:8fdf9a60065b
Nucreo 446 + SSD1331 test version;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kadonotakashi 0:8fdf9a60065b 1 /*
kadonotakashi 0:8fdf9a60065b 2 * Privacy Enhanced Mail (PEM) decoding
kadonotakashi 0:8fdf9a60065b 3 *
kadonotakashi 0:8fdf9a60065b 4 * Copyright (C) 2006-2015, ARM Limited, All Rights Reserved
kadonotakashi 0:8fdf9a60065b 5 * SPDX-License-Identifier: Apache-2.0
kadonotakashi 0:8fdf9a60065b 6 *
kadonotakashi 0:8fdf9a60065b 7 * Licensed under the Apache License, Version 2.0 (the "License"); you may
kadonotakashi 0:8fdf9a60065b 8 * not use this file except in compliance with the License.
kadonotakashi 0:8fdf9a60065b 9 * You may obtain a copy of the License at
kadonotakashi 0:8fdf9a60065b 10 *
kadonotakashi 0:8fdf9a60065b 11 * http://www.apache.org/licenses/LICENSE-2.0
kadonotakashi 0:8fdf9a60065b 12 *
kadonotakashi 0:8fdf9a60065b 13 * Unless required by applicable law or agreed to in writing, software
kadonotakashi 0:8fdf9a60065b 14 * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
kadonotakashi 0:8fdf9a60065b 15 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kadonotakashi 0:8fdf9a60065b 16 * See the License for the specific language governing permissions and
kadonotakashi 0:8fdf9a60065b 17 * limitations under the License.
kadonotakashi 0:8fdf9a60065b 18 *
kadonotakashi 0:8fdf9a60065b 19 * This file is part of mbed TLS (https://tls.mbed.org)
kadonotakashi 0:8fdf9a60065b 20 */
kadonotakashi 0:8fdf9a60065b 21
kadonotakashi 0:8fdf9a60065b 22 #if !defined(MBEDTLS_CONFIG_FILE)
kadonotakashi 0:8fdf9a60065b 23 #include "mbedtls/config.h"
kadonotakashi 0:8fdf9a60065b 24 #else
kadonotakashi 0:8fdf9a60065b 25 #include MBEDTLS_CONFIG_FILE
kadonotakashi 0:8fdf9a60065b 26 #endif
kadonotakashi 0:8fdf9a60065b 27
kadonotakashi 0:8fdf9a60065b 28 #if defined(MBEDTLS_PEM_PARSE_C) || defined(MBEDTLS_PEM_WRITE_C)
kadonotakashi 0:8fdf9a60065b 29
kadonotakashi 0:8fdf9a60065b 30 #include "mbedtls/pem.h"
kadonotakashi 0:8fdf9a60065b 31 #include "mbedtls/base64.h"
kadonotakashi 0:8fdf9a60065b 32 #include "mbedtls/des.h"
kadonotakashi 0:8fdf9a60065b 33 #include "mbedtls/aes.h"
kadonotakashi 0:8fdf9a60065b 34 #include "mbedtls/md5.h"
kadonotakashi 0:8fdf9a60065b 35 #include "mbedtls/cipher.h"
kadonotakashi 0:8fdf9a60065b 36 #include "mbedtls/platform_util.h"
kadonotakashi 0:8fdf9a60065b 37
kadonotakashi 0:8fdf9a60065b 38 #include <string.h>
kadonotakashi 0:8fdf9a60065b 39
kadonotakashi 0:8fdf9a60065b 40 #if defined(MBEDTLS_PLATFORM_C)
kadonotakashi 0:8fdf9a60065b 41 #include "mbedtls/platform.h"
kadonotakashi 0:8fdf9a60065b 42 #else
kadonotakashi 0:8fdf9a60065b 43 #include <stdlib.h>
kadonotakashi 0:8fdf9a60065b 44 #define mbedtls_calloc calloc
kadonotakashi 0:8fdf9a60065b 45 #define mbedtls_free free
kadonotakashi 0:8fdf9a60065b 46 #endif
kadonotakashi 0:8fdf9a60065b 47
kadonotakashi 0:8fdf9a60065b 48 #if defined(MBEDTLS_PEM_PARSE_C)
kadonotakashi 0:8fdf9a60065b 49 void mbedtls_pem_init( mbedtls_pem_context *ctx )
kadonotakashi 0:8fdf9a60065b 50 {
kadonotakashi 0:8fdf9a60065b 51 memset( ctx, 0, sizeof( mbedtls_pem_context ) );
kadonotakashi 0:8fdf9a60065b 52 }
kadonotakashi 0:8fdf9a60065b 53
kadonotakashi 0:8fdf9a60065b 54 #if defined(MBEDTLS_MD5_C) && defined(MBEDTLS_CIPHER_MODE_CBC) && \
kadonotakashi 0:8fdf9a60065b 55 ( defined(MBEDTLS_DES_C) || defined(MBEDTLS_AES_C) )
kadonotakashi 0:8fdf9a60065b 56 /*
kadonotakashi 0:8fdf9a60065b 57 * Read a 16-byte hex string and convert it to binary
kadonotakashi 0:8fdf9a60065b 58 */
kadonotakashi 0:8fdf9a60065b 59 static int pem_get_iv( const unsigned char *s, unsigned char *iv,
kadonotakashi 0:8fdf9a60065b 60 size_t iv_len )
kadonotakashi 0:8fdf9a60065b 61 {
kadonotakashi 0:8fdf9a60065b 62 size_t i, j, k;
kadonotakashi 0:8fdf9a60065b 63
kadonotakashi 0:8fdf9a60065b 64 memset( iv, 0, iv_len );
kadonotakashi 0:8fdf9a60065b 65
kadonotakashi 0:8fdf9a60065b 66 for( i = 0; i < iv_len * 2; i++, s++ )
kadonotakashi 0:8fdf9a60065b 67 {
kadonotakashi 0:8fdf9a60065b 68 if( *s >= '0' && *s <= '9' ) j = *s - '0'; else
kadonotakashi 0:8fdf9a60065b 69 if( *s >= 'A' && *s <= 'F' ) j = *s - '7'; else
kadonotakashi 0:8fdf9a60065b 70 if( *s >= 'a' && *s <= 'f' ) j = *s - 'W'; else
kadonotakashi 0:8fdf9a60065b 71 return( MBEDTLS_ERR_PEM_INVALID_ENC_IV );
kadonotakashi 0:8fdf9a60065b 72
kadonotakashi 0:8fdf9a60065b 73 k = ( ( i & 1 ) != 0 ) ? j : j << 4;
kadonotakashi 0:8fdf9a60065b 74
kadonotakashi 0:8fdf9a60065b 75 iv[i >> 1] = (unsigned char)( iv[i >> 1] | k );
kadonotakashi 0:8fdf9a60065b 76 }
kadonotakashi 0:8fdf9a60065b 77
kadonotakashi 0:8fdf9a60065b 78 return( 0 );
kadonotakashi 0:8fdf9a60065b 79 }
kadonotakashi 0:8fdf9a60065b 80
kadonotakashi 0:8fdf9a60065b 81 static int pem_pbkdf1( unsigned char *key, size_t keylen,
kadonotakashi 0:8fdf9a60065b 82 unsigned char *iv,
kadonotakashi 0:8fdf9a60065b 83 const unsigned char *pwd, size_t pwdlen )
kadonotakashi 0:8fdf9a60065b 84 {
kadonotakashi 0:8fdf9a60065b 85 mbedtls_md5_context md5_ctx;
kadonotakashi 0:8fdf9a60065b 86 unsigned char md5sum[16];
kadonotakashi 0:8fdf9a60065b 87 size_t use_len;
kadonotakashi 0:8fdf9a60065b 88 int ret;
kadonotakashi 0:8fdf9a60065b 89
kadonotakashi 0:8fdf9a60065b 90 mbedtls_md5_init( &md5_ctx );
kadonotakashi 0:8fdf9a60065b 91
kadonotakashi 0:8fdf9a60065b 92 /*
kadonotakashi 0:8fdf9a60065b 93 * key[ 0..15] = MD5(pwd || IV)
kadonotakashi 0:8fdf9a60065b 94 */
kadonotakashi 0:8fdf9a60065b 95 if( ( ret = mbedtls_md5_starts_ret( &md5_ctx ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 96 goto exit;
kadonotakashi 0:8fdf9a60065b 97 if( ( ret = mbedtls_md5_update_ret( &md5_ctx, pwd, pwdlen ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 98 goto exit;
kadonotakashi 0:8fdf9a60065b 99 if( ( ret = mbedtls_md5_update_ret( &md5_ctx, iv, 8 ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 100 goto exit;
kadonotakashi 0:8fdf9a60065b 101 if( ( ret = mbedtls_md5_finish_ret( &md5_ctx, md5sum ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 102 goto exit;
kadonotakashi 0:8fdf9a60065b 103
kadonotakashi 0:8fdf9a60065b 104 if( keylen <= 16 )
kadonotakashi 0:8fdf9a60065b 105 {
kadonotakashi 0:8fdf9a60065b 106 memcpy( key, md5sum, keylen );
kadonotakashi 0:8fdf9a60065b 107 goto exit;
kadonotakashi 0:8fdf9a60065b 108 }
kadonotakashi 0:8fdf9a60065b 109
kadonotakashi 0:8fdf9a60065b 110 memcpy( key, md5sum, 16 );
kadonotakashi 0:8fdf9a60065b 111
kadonotakashi 0:8fdf9a60065b 112 /*
kadonotakashi 0:8fdf9a60065b 113 * key[16..23] = MD5(key[ 0..15] || pwd || IV])
kadonotakashi 0:8fdf9a60065b 114 */
kadonotakashi 0:8fdf9a60065b 115 if( ( ret = mbedtls_md5_starts_ret( &md5_ctx ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 116 goto exit;
kadonotakashi 0:8fdf9a60065b 117 if( ( ret = mbedtls_md5_update_ret( &md5_ctx, md5sum, 16 ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 118 goto exit;
kadonotakashi 0:8fdf9a60065b 119 if( ( ret = mbedtls_md5_update_ret( &md5_ctx, pwd, pwdlen ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 120 goto exit;
kadonotakashi 0:8fdf9a60065b 121 if( ( ret = mbedtls_md5_update_ret( &md5_ctx, iv, 8 ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 122 goto exit;
kadonotakashi 0:8fdf9a60065b 123 if( ( ret = mbedtls_md5_finish_ret( &md5_ctx, md5sum ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 124 goto exit;
kadonotakashi 0:8fdf9a60065b 125
kadonotakashi 0:8fdf9a60065b 126 use_len = 16;
kadonotakashi 0:8fdf9a60065b 127 if( keylen < 32 )
kadonotakashi 0:8fdf9a60065b 128 use_len = keylen - 16;
kadonotakashi 0:8fdf9a60065b 129
kadonotakashi 0:8fdf9a60065b 130 memcpy( key + 16, md5sum, use_len );
kadonotakashi 0:8fdf9a60065b 131
kadonotakashi 0:8fdf9a60065b 132 exit:
kadonotakashi 0:8fdf9a60065b 133 mbedtls_md5_free( &md5_ctx );
kadonotakashi 0:8fdf9a60065b 134 mbedtls_platform_zeroize( md5sum, 16 );
kadonotakashi 0:8fdf9a60065b 135
kadonotakashi 0:8fdf9a60065b 136 return( ret );
kadonotakashi 0:8fdf9a60065b 137 }
kadonotakashi 0:8fdf9a60065b 138
kadonotakashi 0:8fdf9a60065b 139 #if defined(MBEDTLS_DES_C)
kadonotakashi 0:8fdf9a60065b 140 /*
kadonotakashi 0:8fdf9a60065b 141 * Decrypt with DES-CBC, using PBKDF1 for key derivation
kadonotakashi 0:8fdf9a60065b 142 */
kadonotakashi 0:8fdf9a60065b 143 static int pem_des_decrypt( unsigned char des_iv[8],
kadonotakashi 0:8fdf9a60065b 144 unsigned char *buf, size_t buflen,
kadonotakashi 0:8fdf9a60065b 145 const unsigned char *pwd, size_t pwdlen )
kadonotakashi 0:8fdf9a60065b 146 {
kadonotakashi 0:8fdf9a60065b 147 mbedtls_des_context des_ctx;
kadonotakashi 0:8fdf9a60065b 148 unsigned char des_key[8];
kadonotakashi 0:8fdf9a60065b 149 int ret;
kadonotakashi 0:8fdf9a60065b 150
kadonotakashi 0:8fdf9a60065b 151 mbedtls_des_init( &des_ctx );
kadonotakashi 0:8fdf9a60065b 152
kadonotakashi 0:8fdf9a60065b 153 if( ( ret = pem_pbkdf1( des_key, 8, des_iv, pwd, pwdlen ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 154 goto exit;
kadonotakashi 0:8fdf9a60065b 155
kadonotakashi 0:8fdf9a60065b 156 if( ( ret = mbedtls_des_setkey_dec( &des_ctx, des_key ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 157 goto exit;
kadonotakashi 0:8fdf9a60065b 158 ret = mbedtls_des_crypt_cbc( &des_ctx, MBEDTLS_DES_DECRYPT, buflen,
kadonotakashi 0:8fdf9a60065b 159 des_iv, buf, buf );
kadonotakashi 0:8fdf9a60065b 160
kadonotakashi 0:8fdf9a60065b 161 exit:
kadonotakashi 0:8fdf9a60065b 162 mbedtls_des_free( &des_ctx );
kadonotakashi 0:8fdf9a60065b 163 mbedtls_platform_zeroize( des_key, 8 );
kadonotakashi 0:8fdf9a60065b 164
kadonotakashi 0:8fdf9a60065b 165 return( ret );
kadonotakashi 0:8fdf9a60065b 166 }
kadonotakashi 0:8fdf9a60065b 167
kadonotakashi 0:8fdf9a60065b 168 /*
kadonotakashi 0:8fdf9a60065b 169 * Decrypt with 3DES-CBC, using PBKDF1 for key derivation
kadonotakashi 0:8fdf9a60065b 170 */
kadonotakashi 0:8fdf9a60065b 171 static int pem_des3_decrypt( unsigned char des3_iv[8],
kadonotakashi 0:8fdf9a60065b 172 unsigned char *buf, size_t buflen,
kadonotakashi 0:8fdf9a60065b 173 const unsigned char *pwd, size_t pwdlen )
kadonotakashi 0:8fdf9a60065b 174 {
kadonotakashi 0:8fdf9a60065b 175 mbedtls_des3_context des3_ctx;
kadonotakashi 0:8fdf9a60065b 176 unsigned char des3_key[24];
kadonotakashi 0:8fdf9a60065b 177 int ret;
kadonotakashi 0:8fdf9a60065b 178
kadonotakashi 0:8fdf9a60065b 179 mbedtls_des3_init( &des3_ctx );
kadonotakashi 0:8fdf9a60065b 180
kadonotakashi 0:8fdf9a60065b 181 if( ( ret = pem_pbkdf1( des3_key, 24, des3_iv, pwd, pwdlen ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 182 goto exit;
kadonotakashi 0:8fdf9a60065b 183
kadonotakashi 0:8fdf9a60065b 184 if( ( ret = mbedtls_des3_set3key_dec( &des3_ctx, des3_key ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 185 goto exit;
kadonotakashi 0:8fdf9a60065b 186 ret = mbedtls_des3_crypt_cbc( &des3_ctx, MBEDTLS_DES_DECRYPT, buflen,
kadonotakashi 0:8fdf9a60065b 187 des3_iv, buf, buf );
kadonotakashi 0:8fdf9a60065b 188
kadonotakashi 0:8fdf9a60065b 189 exit:
kadonotakashi 0:8fdf9a60065b 190 mbedtls_des3_free( &des3_ctx );
kadonotakashi 0:8fdf9a60065b 191 mbedtls_platform_zeroize( des3_key, 24 );
kadonotakashi 0:8fdf9a60065b 192
kadonotakashi 0:8fdf9a60065b 193 return( ret );
kadonotakashi 0:8fdf9a60065b 194 }
kadonotakashi 0:8fdf9a60065b 195 #endif /* MBEDTLS_DES_C */
kadonotakashi 0:8fdf9a60065b 196
kadonotakashi 0:8fdf9a60065b 197 #if defined(MBEDTLS_AES_C)
kadonotakashi 0:8fdf9a60065b 198 /*
kadonotakashi 0:8fdf9a60065b 199 * Decrypt with AES-XXX-CBC, using PBKDF1 for key derivation
kadonotakashi 0:8fdf9a60065b 200 */
kadonotakashi 0:8fdf9a60065b 201 static int pem_aes_decrypt( unsigned char aes_iv[16], unsigned int keylen,
kadonotakashi 0:8fdf9a60065b 202 unsigned char *buf, size_t buflen,
kadonotakashi 0:8fdf9a60065b 203 const unsigned char *pwd, size_t pwdlen )
kadonotakashi 0:8fdf9a60065b 204 {
kadonotakashi 0:8fdf9a60065b 205 mbedtls_aes_context aes_ctx;
kadonotakashi 0:8fdf9a60065b 206 unsigned char aes_key[32];
kadonotakashi 0:8fdf9a60065b 207 int ret;
kadonotakashi 0:8fdf9a60065b 208
kadonotakashi 0:8fdf9a60065b 209 mbedtls_aes_init( &aes_ctx );
kadonotakashi 0:8fdf9a60065b 210
kadonotakashi 0:8fdf9a60065b 211 if( ( ret = pem_pbkdf1( aes_key, keylen, aes_iv, pwd, pwdlen ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 212 goto exit;
kadonotakashi 0:8fdf9a60065b 213
kadonotakashi 0:8fdf9a60065b 214 if( ( ret = mbedtls_aes_setkey_dec( &aes_ctx, aes_key, keylen * 8 ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 215 goto exit;
kadonotakashi 0:8fdf9a60065b 216 ret = mbedtls_aes_crypt_cbc( &aes_ctx, MBEDTLS_AES_DECRYPT, buflen,
kadonotakashi 0:8fdf9a60065b 217 aes_iv, buf, buf );
kadonotakashi 0:8fdf9a60065b 218
kadonotakashi 0:8fdf9a60065b 219 exit:
kadonotakashi 0:8fdf9a60065b 220 mbedtls_aes_free( &aes_ctx );
kadonotakashi 0:8fdf9a60065b 221 mbedtls_platform_zeroize( aes_key, keylen );
kadonotakashi 0:8fdf9a60065b 222
kadonotakashi 0:8fdf9a60065b 223 return( ret );
kadonotakashi 0:8fdf9a60065b 224 }
kadonotakashi 0:8fdf9a60065b 225 #endif /* MBEDTLS_AES_C */
kadonotakashi 0:8fdf9a60065b 226
kadonotakashi 0:8fdf9a60065b 227 #endif /* MBEDTLS_MD5_C && MBEDTLS_CIPHER_MODE_CBC &&
kadonotakashi 0:8fdf9a60065b 228 ( MBEDTLS_AES_C || MBEDTLS_DES_C ) */
kadonotakashi 0:8fdf9a60065b 229
kadonotakashi 0:8fdf9a60065b 230 int mbedtls_pem_read_buffer( mbedtls_pem_context *ctx, const char *header, const char *footer,
kadonotakashi 0:8fdf9a60065b 231 const unsigned char *data, const unsigned char *pwd,
kadonotakashi 0:8fdf9a60065b 232 size_t pwdlen, size_t *use_len )
kadonotakashi 0:8fdf9a60065b 233 {
kadonotakashi 0:8fdf9a60065b 234 int ret, enc;
kadonotakashi 0:8fdf9a60065b 235 size_t len;
kadonotakashi 0:8fdf9a60065b 236 unsigned char *buf;
kadonotakashi 0:8fdf9a60065b 237 const unsigned char *s1, *s2, *end;
kadonotakashi 0:8fdf9a60065b 238 #if defined(MBEDTLS_MD5_C) && defined(MBEDTLS_CIPHER_MODE_CBC) && \
kadonotakashi 0:8fdf9a60065b 239 ( defined(MBEDTLS_DES_C) || defined(MBEDTLS_AES_C) )
kadonotakashi 0:8fdf9a60065b 240 unsigned char pem_iv[16];
kadonotakashi 0:8fdf9a60065b 241 mbedtls_cipher_type_t enc_alg = MBEDTLS_CIPHER_NONE;
kadonotakashi 0:8fdf9a60065b 242 #else
kadonotakashi 0:8fdf9a60065b 243 ((void) pwd);
kadonotakashi 0:8fdf9a60065b 244 ((void) pwdlen);
kadonotakashi 0:8fdf9a60065b 245 #endif /* MBEDTLS_MD5_C && MBEDTLS_CIPHER_MODE_CBC &&
kadonotakashi 0:8fdf9a60065b 246 ( MBEDTLS_AES_C || MBEDTLS_DES_C ) */
kadonotakashi 0:8fdf9a60065b 247
kadonotakashi 0:8fdf9a60065b 248 if( ctx == NULL )
kadonotakashi 0:8fdf9a60065b 249 return( MBEDTLS_ERR_PEM_BAD_INPUT_DATA );
kadonotakashi 0:8fdf9a60065b 250
kadonotakashi 0:8fdf9a60065b 251 s1 = (unsigned char *) strstr( (const char *) data, header );
kadonotakashi 0:8fdf9a60065b 252
kadonotakashi 0:8fdf9a60065b 253 if( s1 == NULL )
kadonotakashi 0:8fdf9a60065b 254 return( MBEDTLS_ERR_PEM_NO_HEADER_FOOTER_PRESENT );
kadonotakashi 0:8fdf9a60065b 255
kadonotakashi 0:8fdf9a60065b 256 s2 = (unsigned char *) strstr( (const char *) data, footer );
kadonotakashi 0:8fdf9a60065b 257
kadonotakashi 0:8fdf9a60065b 258 if( s2 == NULL || s2 <= s1 )
kadonotakashi 0:8fdf9a60065b 259 return( MBEDTLS_ERR_PEM_NO_HEADER_FOOTER_PRESENT );
kadonotakashi 0:8fdf9a60065b 260
kadonotakashi 0:8fdf9a60065b 261 s1 += strlen( header );
kadonotakashi 0:8fdf9a60065b 262 if( *s1 == ' ' ) s1++;
kadonotakashi 0:8fdf9a60065b 263 if( *s1 == '\r' ) s1++;
kadonotakashi 0:8fdf9a60065b 264 if( *s1 == '\n' ) s1++;
kadonotakashi 0:8fdf9a60065b 265 else return( MBEDTLS_ERR_PEM_NO_HEADER_FOOTER_PRESENT );
kadonotakashi 0:8fdf9a60065b 266
kadonotakashi 0:8fdf9a60065b 267 end = s2;
kadonotakashi 0:8fdf9a60065b 268 end += strlen( footer );
kadonotakashi 0:8fdf9a60065b 269 if( *end == ' ' ) end++;
kadonotakashi 0:8fdf9a60065b 270 if( *end == '\r' ) end++;
kadonotakashi 0:8fdf9a60065b 271 if( *end == '\n' ) end++;
kadonotakashi 0:8fdf9a60065b 272 *use_len = end - data;
kadonotakashi 0:8fdf9a60065b 273
kadonotakashi 0:8fdf9a60065b 274 enc = 0;
kadonotakashi 0:8fdf9a60065b 275
kadonotakashi 0:8fdf9a60065b 276 if( s2 - s1 >= 22 && memcmp( s1, "Proc-Type: 4,ENCRYPTED", 22 ) == 0 )
kadonotakashi 0:8fdf9a60065b 277 {
kadonotakashi 0:8fdf9a60065b 278 #if defined(MBEDTLS_MD5_C) && defined(MBEDTLS_CIPHER_MODE_CBC) && \
kadonotakashi 0:8fdf9a60065b 279 ( defined(MBEDTLS_DES_C) || defined(MBEDTLS_AES_C) )
kadonotakashi 0:8fdf9a60065b 280 enc++;
kadonotakashi 0:8fdf9a60065b 281
kadonotakashi 0:8fdf9a60065b 282 s1 += 22;
kadonotakashi 0:8fdf9a60065b 283 if( *s1 == '\r' ) s1++;
kadonotakashi 0:8fdf9a60065b 284 if( *s1 == '\n' ) s1++;
kadonotakashi 0:8fdf9a60065b 285 else return( MBEDTLS_ERR_PEM_INVALID_DATA );
kadonotakashi 0:8fdf9a60065b 286
kadonotakashi 0:8fdf9a60065b 287
kadonotakashi 0:8fdf9a60065b 288 #if defined(MBEDTLS_DES_C)
kadonotakashi 0:8fdf9a60065b 289 if( s2 - s1 >= 23 && memcmp( s1, "DEK-Info: DES-EDE3-CBC,", 23 ) == 0 )
kadonotakashi 0:8fdf9a60065b 290 {
kadonotakashi 0:8fdf9a60065b 291 enc_alg = MBEDTLS_CIPHER_DES_EDE3_CBC;
kadonotakashi 0:8fdf9a60065b 292
kadonotakashi 0:8fdf9a60065b 293 s1 += 23;
kadonotakashi 0:8fdf9a60065b 294 if( s2 - s1 < 16 || pem_get_iv( s1, pem_iv, 8 ) != 0 )
kadonotakashi 0:8fdf9a60065b 295 return( MBEDTLS_ERR_PEM_INVALID_ENC_IV );
kadonotakashi 0:8fdf9a60065b 296
kadonotakashi 0:8fdf9a60065b 297 s1 += 16;
kadonotakashi 0:8fdf9a60065b 298 }
kadonotakashi 0:8fdf9a60065b 299 else if( s2 - s1 >= 18 && memcmp( s1, "DEK-Info: DES-CBC,", 18 ) == 0 )
kadonotakashi 0:8fdf9a60065b 300 {
kadonotakashi 0:8fdf9a60065b 301 enc_alg = MBEDTLS_CIPHER_DES_CBC;
kadonotakashi 0:8fdf9a60065b 302
kadonotakashi 0:8fdf9a60065b 303 s1 += 18;
kadonotakashi 0:8fdf9a60065b 304 if( s2 - s1 < 16 || pem_get_iv( s1, pem_iv, 8) != 0 )
kadonotakashi 0:8fdf9a60065b 305 return( MBEDTLS_ERR_PEM_INVALID_ENC_IV );
kadonotakashi 0:8fdf9a60065b 306
kadonotakashi 0:8fdf9a60065b 307 s1 += 16;
kadonotakashi 0:8fdf9a60065b 308 }
kadonotakashi 0:8fdf9a60065b 309 #endif /* MBEDTLS_DES_C */
kadonotakashi 0:8fdf9a60065b 310
kadonotakashi 0:8fdf9a60065b 311 #if defined(MBEDTLS_AES_C)
kadonotakashi 0:8fdf9a60065b 312 if( s2 - s1 >= 14 && memcmp( s1, "DEK-Info: AES-", 14 ) == 0 )
kadonotakashi 0:8fdf9a60065b 313 {
kadonotakashi 0:8fdf9a60065b 314 if( s2 - s1 < 22 )
kadonotakashi 0:8fdf9a60065b 315 return( MBEDTLS_ERR_PEM_UNKNOWN_ENC_ALG );
kadonotakashi 0:8fdf9a60065b 316 else if( memcmp( s1, "DEK-Info: AES-128-CBC,", 22 ) == 0 )
kadonotakashi 0:8fdf9a60065b 317 enc_alg = MBEDTLS_CIPHER_AES_128_CBC;
kadonotakashi 0:8fdf9a60065b 318 else if( memcmp( s1, "DEK-Info: AES-192-CBC,", 22 ) == 0 )
kadonotakashi 0:8fdf9a60065b 319 enc_alg = MBEDTLS_CIPHER_AES_192_CBC;
kadonotakashi 0:8fdf9a60065b 320 else if( memcmp( s1, "DEK-Info: AES-256-CBC,", 22 ) == 0 )
kadonotakashi 0:8fdf9a60065b 321 enc_alg = MBEDTLS_CIPHER_AES_256_CBC;
kadonotakashi 0:8fdf9a60065b 322 else
kadonotakashi 0:8fdf9a60065b 323 return( MBEDTLS_ERR_PEM_UNKNOWN_ENC_ALG );
kadonotakashi 0:8fdf9a60065b 324
kadonotakashi 0:8fdf9a60065b 325 s1 += 22;
kadonotakashi 0:8fdf9a60065b 326 if( s2 - s1 < 32 || pem_get_iv( s1, pem_iv, 16 ) != 0 )
kadonotakashi 0:8fdf9a60065b 327 return( MBEDTLS_ERR_PEM_INVALID_ENC_IV );
kadonotakashi 0:8fdf9a60065b 328
kadonotakashi 0:8fdf9a60065b 329 s1 += 32;
kadonotakashi 0:8fdf9a60065b 330 }
kadonotakashi 0:8fdf9a60065b 331 #endif /* MBEDTLS_AES_C */
kadonotakashi 0:8fdf9a60065b 332
kadonotakashi 0:8fdf9a60065b 333 if( enc_alg == MBEDTLS_CIPHER_NONE )
kadonotakashi 0:8fdf9a60065b 334 return( MBEDTLS_ERR_PEM_UNKNOWN_ENC_ALG );
kadonotakashi 0:8fdf9a60065b 335
kadonotakashi 0:8fdf9a60065b 336 if( *s1 == '\r' ) s1++;
kadonotakashi 0:8fdf9a60065b 337 if( *s1 == '\n' ) s1++;
kadonotakashi 0:8fdf9a60065b 338 else return( MBEDTLS_ERR_PEM_INVALID_DATA );
kadonotakashi 0:8fdf9a60065b 339 #else
kadonotakashi 0:8fdf9a60065b 340 return( MBEDTLS_ERR_PEM_FEATURE_UNAVAILABLE );
kadonotakashi 0:8fdf9a60065b 341 #endif /* MBEDTLS_MD5_C && MBEDTLS_CIPHER_MODE_CBC &&
kadonotakashi 0:8fdf9a60065b 342 ( MBEDTLS_AES_C || MBEDTLS_DES_C ) */
kadonotakashi 0:8fdf9a60065b 343 }
kadonotakashi 0:8fdf9a60065b 344
kadonotakashi 0:8fdf9a60065b 345 if( s1 >= s2 )
kadonotakashi 0:8fdf9a60065b 346 return( MBEDTLS_ERR_PEM_INVALID_DATA );
kadonotakashi 0:8fdf9a60065b 347
kadonotakashi 0:8fdf9a60065b 348 ret = mbedtls_base64_decode( NULL, 0, &len, s1, s2 - s1 );
kadonotakashi 0:8fdf9a60065b 349
kadonotakashi 0:8fdf9a60065b 350 if( ret == MBEDTLS_ERR_BASE64_INVALID_CHARACTER )
kadonotakashi 0:8fdf9a60065b 351 return( MBEDTLS_ERR_PEM_INVALID_DATA + ret );
kadonotakashi 0:8fdf9a60065b 352
kadonotakashi 0:8fdf9a60065b 353 if( ( buf = mbedtls_calloc( 1, len ) ) == NULL )
kadonotakashi 0:8fdf9a60065b 354 return( MBEDTLS_ERR_PEM_ALLOC_FAILED );
kadonotakashi 0:8fdf9a60065b 355
kadonotakashi 0:8fdf9a60065b 356 if( ( ret = mbedtls_base64_decode( buf, len, &len, s1, s2 - s1 ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 357 {
kadonotakashi 0:8fdf9a60065b 358 mbedtls_platform_zeroize( buf, len );
kadonotakashi 0:8fdf9a60065b 359 mbedtls_free( buf );
kadonotakashi 0:8fdf9a60065b 360 return( MBEDTLS_ERR_PEM_INVALID_DATA + ret );
kadonotakashi 0:8fdf9a60065b 361 }
kadonotakashi 0:8fdf9a60065b 362
kadonotakashi 0:8fdf9a60065b 363 if( enc != 0 )
kadonotakashi 0:8fdf9a60065b 364 {
kadonotakashi 0:8fdf9a60065b 365 #if defined(MBEDTLS_MD5_C) && defined(MBEDTLS_CIPHER_MODE_CBC) && \
kadonotakashi 0:8fdf9a60065b 366 ( defined(MBEDTLS_DES_C) || defined(MBEDTLS_AES_C) )
kadonotakashi 0:8fdf9a60065b 367 if( pwd == NULL )
kadonotakashi 0:8fdf9a60065b 368 {
kadonotakashi 0:8fdf9a60065b 369 mbedtls_platform_zeroize( buf, len );
kadonotakashi 0:8fdf9a60065b 370 mbedtls_free( buf );
kadonotakashi 0:8fdf9a60065b 371 return( MBEDTLS_ERR_PEM_PASSWORD_REQUIRED );
kadonotakashi 0:8fdf9a60065b 372 }
kadonotakashi 0:8fdf9a60065b 373
kadonotakashi 0:8fdf9a60065b 374 ret = 0;
kadonotakashi 0:8fdf9a60065b 375
kadonotakashi 0:8fdf9a60065b 376 #if defined(MBEDTLS_DES_C)
kadonotakashi 0:8fdf9a60065b 377 if( enc_alg == MBEDTLS_CIPHER_DES_EDE3_CBC )
kadonotakashi 0:8fdf9a60065b 378 ret = pem_des3_decrypt( pem_iv, buf, len, pwd, pwdlen );
kadonotakashi 0:8fdf9a60065b 379 else if( enc_alg == MBEDTLS_CIPHER_DES_CBC )
kadonotakashi 0:8fdf9a60065b 380 ret = pem_des_decrypt( pem_iv, buf, len, pwd, pwdlen );
kadonotakashi 0:8fdf9a60065b 381 #endif /* MBEDTLS_DES_C */
kadonotakashi 0:8fdf9a60065b 382
kadonotakashi 0:8fdf9a60065b 383 #if defined(MBEDTLS_AES_C)
kadonotakashi 0:8fdf9a60065b 384 if( enc_alg == MBEDTLS_CIPHER_AES_128_CBC )
kadonotakashi 0:8fdf9a60065b 385 ret = pem_aes_decrypt( pem_iv, 16, buf, len, pwd, pwdlen );
kadonotakashi 0:8fdf9a60065b 386 else if( enc_alg == MBEDTLS_CIPHER_AES_192_CBC )
kadonotakashi 0:8fdf9a60065b 387 ret = pem_aes_decrypt( pem_iv, 24, buf, len, pwd, pwdlen );
kadonotakashi 0:8fdf9a60065b 388 else if( enc_alg == MBEDTLS_CIPHER_AES_256_CBC )
kadonotakashi 0:8fdf9a60065b 389 ret = pem_aes_decrypt( pem_iv, 32, buf, len, pwd, pwdlen );
kadonotakashi 0:8fdf9a60065b 390 #endif /* MBEDTLS_AES_C */
kadonotakashi 0:8fdf9a60065b 391
kadonotakashi 0:8fdf9a60065b 392 if( ret != 0 )
kadonotakashi 0:8fdf9a60065b 393 {
kadonotakashi 0:8fdf9a60065b 394 mbedtls_free( buf );
kadonotakashi 0:8fdf9a60065b 395 return( ret );
kadonotakashi 0:8fdf9a60065b 396 }
kadonotakashi 0:8fdf9a60065b 397
kadonotakashi 0:8fdf9a60065b 398 /*
kadonotakashi 0:8fdf9a60065b 399 * The result will be ASN.1 starting with a SEQUENCE tag, with 1 to 3
kadonotakashi 0:8fdf9a60065b 400 * length bytes (allow 4 to be sure) in all known use cases.
kadonotakashi 0:8fdf9a60065b 401 *
kadonotakashi 0:8fdf9a60065b 402 * Use that as a heuristic to try to detect password mismatches.
kadonotakashi 0:8fdf9a60065b 403 */
kadonotakashi 0:8fdf9a60065b 404 if( len <= 2 || buf[0] != 0x30 || buf[1] > 0x83 )
kadonotakashi 0:8fdf9a60065b 405 {
kadonotakashi 0:8fdf9a60065b 406 mbedtls_platform_zeroize( buf, len );
kadonotakashi 0:8fdf9a60065b 407 mbedtls_free( buf );
kadonotakashi 0:8fdf9a60065b 408 return( MBEDTLS_ERR_PEM_PASSWORD_MISMATCH );
kadonotakashi 0:8fdf9a60065b 409 }
kadonotakashi 0:8fdf9a60065b 410 #else
kadonotakashi 0:8fdf9a60065b 411 mbedtls_platform_zeroize( buf, len );
kadonotakashi 0:8fdf9a60065b 412 mbedtls_free( buf );
kadonotakashi 0:8fdf9a60065b 413 return( MBEDTLS_ERR_PEM_FEATURE_UNAVAILABLE );
kadonotakashi 0:8fdf9a60065b 414 #endif /* MBEDTLS_MD5_C && MBEDTLS_CIPHER_MODE_CBC &&
kadonotakashi 0:8fdf9a60065b 415 ( MBEDTLS_AES_C || MBEDTLS_DES_C ) */
kadonotakashi 0:8fdf9a60065b 416 }
kadonotakashi 0:8fdf9a60065b 417
kadonotakashi 0:8fdf9a60065b 418 ctx->buf = buf;
kadonotakashi 0:8fdf9a60065b 419 ctx->buflen = len;
kadonotakashi 0:8fdf9a60065b 420
kadonotakashi 0:8fdf9a60065b 421 return( 0 );
kadonotakashi 0:8fdf9a60065b 422 }
kadonotakashi 0:8fdf9a60065b 423
kadonotakashi 0:8fdf9a60065b 424 void mbedtls_pem_free( mbedtls_pem_context *ctx )
kadonotakashi 0:8fdf9a60065b 425 {
kadonotakashi 0:8fdf9a60065b 426 if( ctx->buf != NULL )
kadonotakashi 0:8fdf9a60065b 427 mbedtls_platform_zeroize( ctx->buf, ctx->buflen );
kadonotakashi 0:8fdf9a60065b 428 mbedtls_free( ctx->buf );
kadonotakashi 0:8fdf9a60065b 429 mbedtls_free( ctx->info );
kadonotakashi 0:8fdf9a60065b 430
kadonotakashi 0:8fdf9a60065b 431 mbedtls_platform_zeroize( ctx, sizeof( mbedtls_pem_context ) );
kadonotakashi 0:8fdf9a60065b 432 }
kadonotakashi 0:8fdf9a60065b 433 #endif /* MBEDTLS_PEM_PARSE_C */
kadonotakashi 0:8fdf9a60065b 434
kadonotakashi 0:8fdf9a60065b 435 #if defined(MBEDTLS_PEM_WRITE_C)
kadonotakashi 0:8fdf9a60065b 436 int mbedtls_pem_write_buffer( const char *header, const char *footer,
kadonotakashi 0:8fdf9a60065b 437 const unsigned char *der_data, size_t der_len,
kadonotakashi 0:8fdf9a60065b 438 unsigned char *buf, size_t buf_len, size_t *olen )
kadonotakashi 0:8fdf9a60065b 439 {
kadonotakashi 0:8fdf9a60065b 440 int ret;
kadonotakashi 0:8fdf9a60065b 441 unsigned char *encode_buf = NULL, *c, *p = buf;
kadonotakashi 0:8fdf9a60065b 442 size_t len = 0, use_len, add_len = 0;
kadonotakashi 0:8fdf9a60065b 443
kadonotakashi 0:8fdf9a60065b 444 mbedtls_base64_encode( NULL, 0, &use_len, der_data, der_len );
kadonotakashi 0:8fdf9a60065b 445 add_len = strlen( header ) + strlen( footer ) + ( use_len / 64 ) + 1;
kadonotakashi 0:8fdf9a60065b 446
kadonotakashi 0:8fdf9a60065b 447 if( use_len + add_len > buf_len )
kadonotakashi 0:8fdf9a60065b 448 {
kadonotakashi 0:8fdf9a60065b 449 *olen = use_len + add_len;
kadonotakashi 0:8fdf9a60065b 450 return( MBEDTLS_ERR_BASE64_BUFFER_TOO_SMALL );
kadonotakashi 0:8fdf9a60065b 451 }
kadonotakashi 0:8fdf9a60065b 452
kadonotakashi 0:8fdf9a60065b 453 if( use_len != 0 &&
kadonotakashi 0:8fdf9a60065b 454 ( ( encode_buf = mbedtls_calloc( 1, use_len ) ) == NULL ) )
kadonotakashi 0:8fdf9a60065b 455 return( MBEDTLS_ERR_PEM_ALLOC_FAILED );
kadonotakashi 0:8fdf9a60065b 456
kadonotakashi 0:8fdf9a60065b 457 if( ( ret = mbedtls_base64_encode( encode_buf, use_len, &use_len, der_data,
kadonotakashi 0:8fdf9a60065b 458 der_len ) ) != 0 )
kadonotakashi 0:8fdf9a60065b 459 {
kadonotakashi 0:8fdf9a60065b 460 mbedtls_free( encode_buf );
kadonotakashi 0:8fdf9a60065b 461 return( ret );
kadonotakashi 0:8fdf9a60065b 462 }
kadonotakashi 0:8fdf9a60065b 463
kadonotakashi 0:8fdf9a60065b 464 memcpy( p, header, strlen( header ) );
kadonotakashi 0:8fdf9a60065b 465 p += strlen( header );
kadonotakashi 0:8fdf9a60065b 466 c = encode_buf;
kadonotakashi 0:8fdf9a60065b 467
kadonotakashi 0:8fdf9a60065b 468 while( use_len )
kadonotakashi 0:8fdf9a60065b 469 {
kadonotakashi 0:8fdf9a60065b 470 len = ( use_len > 64 ) ? 64 : use_len;
kadonotakashi 0:8fdf9a60065b 471 memcpy( p, c, len );
kadonotakashi 0:8fdf9a60065b 472 use_len -= len;
kadonotakashi 0:8fdf9a60065b 473 p += len;
kadonotakashi 0:8fdf9a60065b 474 c += len;
kadonotakashi 0:8fdf9a60065b 475 *p++ = '\n';
kadonotakashi 0:8fdf9a60065b 476 }
kadonotakashi 0:8fdf9a60065b 477
kadonotakashi 0:8fdf9a60065b 478 memcpy( p, footer, strlen( footer ) );
kadonotakashi 0:8fdf9a60065b 479 p += strlen( footer );
kadonotakashi 0:8fdf9a60065b 480
kadonotakashi 0:8fdf9a60065b 481 *p++ = '\0';
kadonotakashi 0:8fdf9a60065b 482 *olen = p - buf;
kadonotakashi 0:8fdf9a60065b 483
kadonotakashi 0:8fdf9a60065b 484 mbedtls_free( encode_buf );
kadonotakashi 0:8fdf9a60065b 485 return( 0 );
kadonotakashi 0:8fdf9a60065b 486 }
kadonotakashi 0:8fdf9a60065b 487 #endif /* MBEDTLS_PEM_WRITE_C */
kadonotakashi 0:8fdf9a60065b 488 #endif /* MBEDTLS_PEM_PARSE_C || MBEDTLS_PEM_WRITE_C */