EL4121 Embedded System / mbed-os

mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

features/mbedtls/src/asn1write.c@0:b74591d5ab33, 2017-12-11 (annotated)

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /*
be_bryan 0:b74591d5ab33 2 * ASN.1 buffer writing functionality
be_bryan 0:b74591d5ab33 3 *
be_bryan 0:b74591d5ab33 4 * Copyright (C) 2006-2015, ARM Limited, All Rights Reserved
be_bryan 0:b74591d5ab33 5 * SPDX-License-Identifier: Apache-2.0
be_bryan 0:b74591d5ab33 6 *
be_bryan 0:b74591d5ab33 7 * Licensed under the Apache License, Version 2.0 (the "License"); you may
be_bryan 0:b74591d5ab33 8 * not use this file except in compliance with the License.
be_bryan 0:b74591d5ab33 9 * You may obtain a copy of the License at
be_bryan 0:b74591d5ab33 10 *
be_bryan 0:b74591d5ab33 11 * http://www.apache.org/licenses/LICENSE-2.0
be_bryan 0:b74591d5ab33 12 *
be_bryan 0:b74591d5ab33 13 * Unless required by applicable law or agreed to in writing, software
be_bryan 0:b74591d5ab33 14 * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
be_bryan 0:b74591d5ab33 15 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
be_bryan 0:b74591d5ab33 16 * See the License for the specific language governing permissions and
be_bryan 0:b74591d5ab33 17 * limitations under the License.
be_bryan 0:b74591d5ab33 18 *
be_bryan 0:b74591d5ab33 19 * This file is part of mbed TLS (https://tls.mbed.org)
be_bryan 0:b74591d5ab33 20 */
be_bryan 0:b74591d5ab33 21
be_bryan 0:b74591d5ab33 22 #if !defined(MBEDTLS_CONFIG_FILE)
be_bryan 0:b74591d5ab33 23 #include "mbedtls/config.h"
be_bryan 0:b74591d5ab33 24 #else
be_bryan 0:b74591d5ab33 25 #include MBEDTLS_CONFIG_FILE
be_bryan 0:b74591d5ab33 26 #endif
be_bryan 0:b74591d5ab33 27
be_bryan 0:b74591d5ab33 28 #if defined(MBEDTLS_ASN1_WRITE_C)
be_bryan 0:b74591d5ab33 29
be_bryan 0:b74591d5ab33 30 #include "mbedtls/asn1write.h"
be_bryan 0:b74591d5ab33 31
be_bryan 0:b74591d5ab33 32 #include <string.h>
be_bryan 0:b74591d5ab33 33
be_bryan 0:b74591d5ab33 34 #if defined(MBEDTLS_PLATFORM_C)
be_bryan 0:b74591d5ab33 35 #include "mbedtls/platform.h"
be_bryan 0:b74591d5ab33 36 #else
be_bryan 0:b74591d5ab33 37 #include <stdlib.h>
be_bryan 0:b74591d5ab33 38 #define mbedtls_calloc calloc
be_bryan 0:b74591d5ab33 39 #define mbedtls_free free
be_bryan 0:b74591d5ab33 40 #endif
be_bryan 0:b74591d5ab33 41
be_bryan 0:b74591d5ab33 42 int mbedtls_asn1_write_len( unsigned char **p, unsigned char *start, size_t len )
be_bryan 0:b74591d5ab33 43 {
be_bryan 0:b74591d5ab33 44 if( len < 0x80 )
be_bryan 0:b74591d5ab33 45 {
be_bryan 0:b74591d5ab33 46 if( *p - start < 1 )
be_bryan 0:b74591d5ab33 47 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 48
be_bryan 0:b74591d5ab33 49 *--(*p) = (unsigned char) len;
be_bryan 0:b74591d5ab33 50 return( 1 );
be_bryan 0:b74591d5ab33 51 }
be_bryan 0:b74591d5ab33 52
be_bryan 0:b74591d5ab33 53 if( len <= 0xFF )
be_bryan 0:b74591d5ab33 54 {
be_bryan 0:b74591d5ab33 55 if( *p - start < 2 )
be_bryan 0:b74591d5ab33 56 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 57
be_bryan 0:b74591d5ab33 58 *--(*p) = (unsigned char) len;
be_bryan 0:b74591d5ab33 59 *--(*p) = 0x81;
be_bryan 0:b74591d5ab33 60 return( 2 );
be_bryan 0:b74591d5ab33 61 }
be_bryan 0:b74591d5ab33 62
be_bryan 0:b74591d5ab33 63 if( len <= 0xFFFF )
be_bryan 0:b74591d5ab33 64 {
be_bryan 0:b74591d5ab33 65 if( *p - start < 3 )
be_bryan 0:b74591d5ab33 66 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 67
be_bryan 0:b74591d5ab33 68 *--(*p) = ( len ) & 0xFF;
be_bryan 0:b74591d5ab33 69 *--(*p) = ( len >> 8 ) & 0xFF;
be_bryan 0:b74591d5ab33 70 *--(*p) = 0x82;
be_bryan 0:b74591d5ab33 71 return( 3 );
be_bryan 0:b74591d5ab33 72 }
be_bryan 0:b74591d5ab33 73
be_bryan 0:b74591d5ab33 74 if( len <= 0xFFFFFF )
be_bryan 0:b74591d5ab33 75 {
be_bryan 0:b74591d5ab33 76 if( *p - start < 4 )
be_bryan 0:b74591d5ab33 77 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 78
be_bryan 0:b74591d5ab33 79 *--(*p) = ( len ) & 0xFF;
be_bryan 0:b74591d5ab33 80 *--(*p) = ( len >> 8 ) & 0xFF;
be_bryan 0:b74591d5ab33 81 *--(*p) = ( len >> 16 ) & 0xFF;
be_bryan 0:b74591d5ab33 82 *--(*p) = 0x83;
be_bryan 0:b74591d5ab33 83 return( 4 );
be_bryan 0:b74591d5ab33 84 }
be_bryan 0:b74591d5ab33 85
be_bryan 0:b74591d5ab33 86 if( len <= 0xFFFFFFFF )
be_bryan 0:b74591d5ab33 87 {
be_bryan 0:b74591d5ab33 88 if( *p - start < 5 )
be_bryan 0:b74591d5ab33 89 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 90
be_bryan 0:b74591d5ab33 91 *--(*p) = ( len ) & 0xFF;
be_bryan 0:b74591d5ab33 92 *--(*p) = ( len >> 8 ) & 0xFF;
be_bryan 0:b74591d5ab33 93 *--(*p) = ( len >> 16 ) & 0xFF;
be_bryan 0:b74591d5ab33 94 *--(*p) = ( len >> 24 ) & 0xFF;
be_bryan 0:b74591d5ab33 95 *--(*p) = 0x84;
be_bryan 0:b74591d5ab33 96 return( 5 );
be_bryan 0:b74591d5ab33 97 }
be_bryan 0:b74591d5ab33 98
be_bryan 0:b74591d5ab33 99 return( MBEDTLS_ERR_ASN1_INVALID_LENGTH );
be_bryan 0:b74591d5ab33 100 }
be_bryan 0:b74591d5ab33 101
be_bryan 0:b74591d5ab33 102 int mbedtls_asn1_write_tag( unsigned char **p, unsigned char *start, unsigned char tag )
be_bryan 0:b74591d5ab33 103 {
be_bryan 0:b74591d5ab33 104 if( *p - start < 1 )
be_bryan 0:b74591d5ab33 105 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 106
be_bryan 0:b74591d5ab33 107 *--(*p) = tag;
be_bryan 0:b74591d5ab33 108
be_bryan 0:b74591d5ab33 109 return( 1 );
be_bryan 0:b74591d5ab33 110 }
be_bryan 0:b74591d5ab33 111
be_bryan 0:b74591d5ab33 112 int mbedtls_asn1_write_raw_buffer( unsigned char **p, unsigned char *start,
be_bryan 0:b74591d5ab33 113 const unsigned char *buf, size_t size )
be_bryan 0:b74591d5ab33 114 {
be_bryan 0:b74591d5ab33 115 size_t len = 0;
be_bryan 0:b74591d5ab33 116
be_bryan 0:b74591d5ab33 117 if( *p < start || (size_t)( *p - start ) < size )
be_bryan 0:b74591d5ab33 118 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 119
be_bryan 0:b74591d5ab33 120 len = size;
be_bryan 0:b74591d5ab33 121 (*p) -= len;
be_bryan 0:b74591d5ab33 122 memcpy( *p, buf, len );
be_bryan 0:b74591d5ab33 123
be_bryan 0:b74591d5ab33 124 return( (int) len );
be_bryan 0:b74591d5ab33 125 }
be_bryan 0:b74591d5ab33 126
be_bryan 0:b74591d5ab33 127 #if defined(MBEDTLS_BIGNUM_C)
be_bryan 0:b74591d5ab33 128 int mbedtls_asn1_write_mpi( unsigned char **p, unsigned char *start, const mbedtls_mpi *X )
be_bryan 0:b74591d5ab33 129 {
be_bryan 0:b74591d5ab33 130 int ret;
be_bryan 0:b74591d5ab33 131 size_t len = 0;
be_bryan 0:b74591d5ab33 132
be_bryan 0:b74591d5ab33 133 // Write the MPI
be_bryan 0:b74591d5ab33 134 //
be_bryan 0:b74591d5ab33 135 len = mbedtls_mpi_size( X );
be_bryan 0:b74591d5ab33 136
be_bryan 0:b74591d5ab33 137 if( *p < start || (size_t)( *p - start ) < len )
be_bryan 0:b74591d5ab33 138 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 139
be_bryan 0:b74591d5ab33 140 (*p) -= len;
be_bryan 0:b74591d5ab33 141 MBEDTLS_MPI_CHK( mbedtls_mpi_write_binary( X, *p, len ) );
be_bryan 0:b74591d5ab33 142
be_bryan 0:b74591d5ab33 143 // DER format assumes 2s complement for numbers, so the leftmost bit
be_bryan 0:b74591d5ab33 144 // should be 0 for positive numbers and 1 for negative numbers.
be_bryan 0:b74591d5ab33 145 //
be_bryan 0:b74591d5ab33 146 if( X->s ==1 && **p & 0x80 )
be_bryan 0:b74591d5ab33 147 {
be_bryan 0:b74591d5ab33 148 if( *p - start < 1 )
be_bryan 0:b74591d5ab33 149 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 150
be_bryan 0:b74591d5ab33 151 *--(*p) = 0x00;
be_bryan 0:b74591d5ab33 152 len += 1;
be_bryan 0:b74591d5ab33 153 }
be_bryan 0:b74591d5ab33 154
be_bryan 0:b74591d5ab33 155 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 156 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_INTEGER ) );
be_bryan 0:b74591d5ab33 157
be_bryan 0:b74591d5ab33 158 ret = (int) len;
be_bryan 0:b74591d5ab33 159
be_bryan 0:b74591d5ab33 160 cleanup:
be_bryan 0:b74591d5ab33 161 return( ret );
be_bryan 0:b74591d5ab33 162 }
be_bryan 0:b74591d5ab33 163 #endif /* MBEDTLS_BIGNUM_C */
be_bryan 0:b74591d5ab33 164
be_bryan 0:b74591d5ab33 165 int mbedtls_asn1_write_null( unsigned char **p, unsigned char *start )
be_bryan 0:b74591d5ab33 166 {
be_bryan 0:b74591d5ab33 167 int ret;
be_bryan 0:b74591d5ab33 168 size_t len = 0;
be_bryan 0:b74591d5ab33 169
be_bryan 0:b74591d5ab33 170 // Write NULL
be_bryan 0:b74591d5ab33 171 //
be_bryan 0:b74591d5ab33 172 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, 0) );
be_bryan 0:b74591d5ab33 173 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_NULL ) );
be_bryan 0:b74591d5ab33 174
be_bryan 0:b74591d5ab33 175 return( (int) len );
be_bryan 0:b74591d5ab33 176 }
be_bryan 0:b74591d5ab33 177
be_bryan 0:b74591d5ab33 178 int mbedtls_asn1_write_oid( unsigned char **p, unsigned char *start,
be_bryan 0:b74591d5ab33 179 const char *oid, size_t oid_len )
be_bryan 0:b74591d5ab33 180 {
be_bryan 0:b74591d5ab33 181 int ret;
be_bryan 0:b74591d5ab33 182 size_t len = 0;
be_bryan 0:b74591d5ab33 183
be_bryan 0:b74591d5ab33 184 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_raw_buffer( p, start,
be_bryan 0:b74591d5ab33 185 (const unsigned char *) oid, oid_len ) );
be_bryan 0:b74591d5ab33 186 MBEDTLS_ASN1_CHK_ADD( len , mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 187 MBEDTLS_ASN1_CHK_ADD( len , mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_OID ) );
be_bryan 0:b74591d5ab33 188
be_bryan 0:b74591d5ab33 189 return( (int) len );
be_bryan 0:b74591d5ab33 190 }
be_bryan 0:b74591d5ab33 191
be_bryan 0:b74591d5ab33 192 int mbedtls_asn1_write_algorithm_identifier( unsigned char **p, unsigned char *start,
be_bryan 0:b74591d5ab33 193 const char *oid, size_t oid_len,
be_bryan 0:b74591d5ab33 194 size_t par_len )
be_bryan 0:b74591d5ab33 195 {
be_bryan 0:b74591d5ab33 196 int ret;
be_bryan 0:b74591d5ab33 197 size_t len = 0;
be_bryan 0:b74591d5ab33 198
be_bryan 0:b74591d5ab33 199 if( par_len == 0 )
be_bryan 0:b74591d5ab33 200 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_null( p, start ) );
be_bryan 0:b74591d5ab33 201 else
be_bryan 0:b74591d5ab33 202 len += par_len;
be_bryan 0:b74591d5ab33 203
be_bryan 0:b74591d5ab33 204 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_oid( p, start, oid, oid_len ) );
be_bryan 0:b74591d5ab33 205
be_bryan 0:b74591d5ab33 206 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 207 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start,
be_bryan 0:b74591d5ab33 208 MBEDTLS_ASN1_CONSTRUCTED | MBEDTLS_ASN1_SEQUENCE ) );
be_bryan 0:b74591d5ab33 209
be_bryan 0:b74591d5ab33 210 return( (int) len );
be_bryan 0:b74591d5ab33 211 }
be_bryan 0:b74591d5ab33 212
be_bryan 0:b74591d5ab33 213 int mbedtls_asn1_write_bool( unsigned char **p, unsigned char *start, int boolean )
be_bryan 0:b74591d5ab33 214 {
be_bryan 0:b74591d5ab33 215 int ret;
be_bryan 0:b74591d5ab33 216 size_t len = 0;
be_bryan 0:b74591d5ab33 217
be_bryan 0:b74591d5ab33 218 if( *p - start < 1 )
be_bryan 0:b74591d5ab33 219 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 220
be_bryan 0:b74591d5ab33 221 *--(*p) = (boolean) ? 255 : 0;
be_bryan 0:b74591d5ab33 222 len++;
be_bryan 0:b74591d5ab33 223
be_bryan 0:b74591d5ab33 224 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 225 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_BOOLEAN ) );
be_bryan 0:b74591d5ab33 226
be_bryan 0:b74591d5ab33 227 return( (int) len );
be_bryan 0:b74591d5ab33 228 }
be_bryan 0:b74591d5ab33 229
be_bryan 0:b74591d5ab33 230 int mbedtls_asn1_write_int( unsigned char **p, unsigned char *start, int val )
be_bryan 0:b74591d5ab33 231 {
be_bryan 0:b74591d5ab33 232 int ret;
be_bryan 0:b74591d5ab33 233 size_t len = 0;
be_bryan 0:b74591d5ab33 234
be_bryan 0:b74591d5ab33 235 // TODO negative values and values larger than 128
be_bryan 0:b74591d5ab33 236 // DER format assumes 2s complement for numbers, so the leftmost bit
be_bryan 0:b74591d5ab33 237 // should be 0 for positive numbers and 1 for negative numbers.
be_bryan 0:b74591d5ab33 238 //
be_bryan 0:b74591d5ab33 239 if( *p - start < 1 )
be_bryan 0:b74591d5ab33 240 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 241
be_bryan 0:b74591d5ab33 242 len += 1;
be_bryan 0:b74591d5ab33 243 *--(*p) = val;
be_bryan 0:b74591d5ab33 244
be_bryan 0:b74591d5ab33 245 if( val > 0 && **p & 0x80 )
be_bryan 0:b74591d5ab33 246 {
be_bryan 0:b74591d5ab33 247 if( *p - start < 1 )
be_bryan 0:b74591d5ab33 248 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 249
be_bryan 0:b74591d5ab33 250 *--(*p) = 0x00;
be_bryan 0:b74591d5ab33 251 len += 1;
be_bryan 0:b74591d5ab33 252 }
be_bryan 0:b74591d5ab33 253
be_bryan 0:b74591d5ab33 254 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 255 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_INTEGER ) );
be_bryan 0:b74591d5ab33 256
be_bryan 0:b74591d5ab33 257 return( (int) len );
be_bryan 0:b74591d5ab33 258 }
be_bryan 0:b74591d5ab33 259
be_bryan 0:b74591d5ab33 260 int mbedtls_asn1_write_printable_string( unsigned char **p, unsigned char *start,
be_bryan 0:b74591d5ab33 261 const char *text, size_t text_len )
be_bryan 0:b74591d5ab33 262 {
be_bryan 0:b74591d5ab33 263 int ret;
be_bryan 0:b74591d5ab33 264 size_t len = 0;
be_bryan 0:b74591d5ab33 265
be_bryan 0:b74591d5ab33 266 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_raw_buffer( p, start,
be_bryan 0:b74591d5ab33 267 (const unsigned char *) text, text_len ) );
be_bryan 0:b74591d5ab33 268
be_bryan 0:b74591d5ab33 269 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 270 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_PRINTABLE_STRING ) );
be_bryan 0:b74591d5ab33 271
be_bryan 0:b74591d5ab33 272 return( (int) len );
be_bryan 0:b74591d5ab33 273 }
be_bryan 0:b74591d5ab33 274
be_bryan 0:b74591d5ab33 275 int mbedtls_asn1_write_ia5_string( unsigned char **p, unsigned char *start,
be_bryan 0:b74591d5ab33 276 const char *text, size_t text_len )
be_bryan 0:b74591d5ab33 277 {
be_bryan 0:b74591d5ab33 278 int ret;
be_bryan 0:b74591d5ab33 279 size_t len = 0;
be_bryan 0:b74591d5ab33 280
be_bryan 0:b74591d5ab33 281 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_raw_buffer( p, start,
be_bryan 0:b74591d5ab33 282 (const unsigned char *) text, text_len ) );
be_bryan 0:b74591d5ab33 283
be_bryan 0:b74591d5ab33 284 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 285 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_IA5_STRING ) );
be_bryan 0:b74591d5ab33 286
be_bryan 0:b74591d5ab33 287 return( (int) len );
be_bryan 0:b74591d5ab33 288 }
be_bryan 0:b74591d5ab33 289
be_bryan 0:b74591d5ab33 290 int mbedtls_asn1_write_bitstring( unsigned char **p, unsigned char *start,
be_bryan 0:b74591d5ab33 291 const unsigned char *buf, size_t bits )
be_bryan 0:b74591d5ab33 292 {
be_bryan 0:b74591d5ab33 293 int ret;
be_bryan 0:b74591d5ab33 294 size_t len = 0, size;
be_bryan 0:b74591d5ab33 295
be_bryan 0:b74591d5ab33 296 size = ( bits / 8 ) + ( ( bits % 8 ) ? 1 : 0 );
be_bryan 0:b74591d5ab33 297
be_bryan 0:b74591d5ab33 298 // Calculate byte length
be_bryan 0:b74591d5ab33 299 //
be_bryan 0:b74591d5ab33 300 if( *p < start || (size_t)( *p - start ) < size + 1 )
be_bryan 0:b74591d5ab33 301 return( MBEDTLS_ERR_ASN1_BUF_TOO_SMALL );
be_bryan 0:b74591d5ab33 302
be_bryan 0:b74591d5ab33 303 len = size + 1;
be_bryan 0:b74591d5ab33 304 (*p) -= size;
be_bryan 0:b74591d5ab33 305 memcpy( *p, buf, size );
be_bryan 0:b74591d5ab33 306
be_bryan 0:b74591d5ab33 307 // Write unused bits
be_bryan 0:b74591d5ab33 308 //
be_bryan 0:b74591d5ab33 309 *--(*p) = (unsigned char) (size * 8 - bits);
be_bryan 0:b74591d5ab33 310
be_bryan 0:b74591d5ab33 311 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 312 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_BIT_STRING ) );
be_bryan 0:b74591d5ab33 313
be_bryan 0:b74591d5ab33 314 return( (int) len );
be_bryan 0:b74591d5ab33 315 }
be_bryan 0:b74591d5ab33 316
be_bryan 0:b74591d5ab33 317 int mbedtls_asn1_write_octet_string( unsigned char **p, unsigned char *start,
be_bryan 0:b74591d5ab33 318 const unsigned char *buf, size_t size )
be_bryan 0:b74591d5ab33 319 {
be_bryan 0:b74591d5ab33 320 int ret;
be_bryan 0:b74591d5ab33 321 size_t len = 0;
be_bryan 0:b74591d5ab33 322
be_bryan 0:b74591d5ab33 323 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_raw_buffer( p, start, buf, size ) );
be_bryan 0:b74591d5ab33 324
be_bryan 0:b74591d5ab33 325 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_len( p, start, len ) );
be_bryan 0:b74591d5ab33 326 MBEDTLS_ASN1_CHK_ADD( len, mbedtls_asn1_write_tag( p, start, MBEDTLS_ASN1_OCTET_STRING ) );
be_bryan 0:b74591d5ab33 327
be_bryan 0:b74591d5ab33 328 return( (int) len );
be_bryan 0:b74591d5ab33 329 }
be_bryan 0:b74591d5ab33 330
be_bryan 0:b74591d5ab33 331 mbedtls_asn1_named_data *mbedtls_asn1_store_named_data( mbedtls_asn1_named_data **head,
be_bryan 0:b74591d5ab33 332 const char *oid, size_t oid_len,
be_bryan 0:b74591d5ab33 333 const unsigned char *val,
be_bryan 0:b74591d5ab33 334 size_t val_len )
be_bryan 0:b74591d5ab33 335 {
be_bryan 0:b74591d5ab33 336 mbedtls_asn1_named_data *cur;
be_bryan 0:b74591d5ab33 337
be_bryan 0:b74591d5ab33 338 if( ( cur = mbedtls_asn1_find_named_data( *head, oid, oid_len ) ) == NULL )
be_bryan 0:b74591d5ab33 339 {
be_bryan 0:b74591d5ab33 340 // Add new entry if not present yet based on OID
be_bryan 0:b74591d5ab33 341 //
be_bryan 0:b74591d5ab33 342 cur = (mbedtls_asn1_named_data*)mbedtls_calloc( 1,
be_bryan 0:b74591d5ab33 343 sizeof(mbedtls_asn1_named_data) );
be_bryan 0:b74591d5ab33 344 if( cur == NULL )
be_bryan 0:b74591d5ab33 345 return( NULL );
be_bryan 0:b74591d5ab33 346
be_bryan 0:b74591d5ab33 347 cur->oid.len = oid_len;
be_bryan 0:b74591d5ab33 348 cur->oid.p = mbedtls_calloc( 1, oid_len );
be_bryan 0:b74591d5ab33 349 if( cur->oid.p == NULL )
be_bryan 0:b74591d5ab33 350 {
be_bryan 0:b74591d5ab33 351 mbedtls_free( cur );
be_bryan 0:b74591d5ab33 352 return( NULL );
be_bryan 0:b74591d5ab33 353 }
be_bryan 0:b74591d5ab33 354
be_bryan 0:b74591d5ab33 355 memcpy( cur->oid.p, oid, oid_len );
be_bryan 0:b74591d5ab33 356
be_bryan 0:b74591d5ab33 357 cur->val.len = val_len;
be_bryan 0:b74591d5ab33 358 cur->val.p = mbedtls_calloc( 1, val_len );
be_bryan 0:b74591d5ab33 359 if( cur->val.p == NULL )
be_bryan 0:b74591d5ab33 360 {
be_bryan 0:b74591d5ab33 361 mbedtls_free( cur->oid.p );
be_bryan 0:b74591d5ab33 362 mbedtls_free( cur );
be_bryan 0:b74591d5ab33 363 return( NULL );
be_bryan 0:b74591d5ab33 364 }
be_bryan 0:b74591d5ab33 365
be_bryan 0:b74591d5ab33 366 cur->next = *head;
be_bryan 0:b74591d5ab33 367 *head = cur;
be_bryan 0:b74591d5ab33 368 }
be_bryan 0:b74591d5ab33 369 else if( cur->val.len < val_len )
be_bryan 0:b74591d5ab33 370 {
be_bryan 0:b74591d5ab33 371 /*
be_bryan 0:b74591d5ab33 372 * Enlarge existing value buffer if needed
be_bryan 0:b74591d5ab33 373 * Preserve old data until the allocation succeeded, to leave list in
be_bryan 0:b74591d5ab33 374 * a consistent state in case allocation fails.
be_bryan 0:b74591d5ab33 375 */
be_bryan 0:b74591d5ab33 376 void *p = mbedtls_calloc( 1, val_len );
be_bryan 0:b74591d5ab33 377 if( p == NULL )
be_bryan 0:b74591d5ab33 378 return( NULL );
be_bryan 0:b74591d5ab33 379
be_bryan 0:b74591d5ab33 380 mbedtls_free( cur->val.p );
be_bryan 0:b74591d5ab33 381 cur->val.p = p;
be_bryan 0:b74591d5ab33 382 cur->val.len = val_len;
be_bryan 0:b74591d5ab33 383 }
be_bryan 0:b74591d5ab33 384
be_bryan 0:b74591d5ab33 385 if( val != NULL )
be_bryan 0:b74591d5ab33 386 memcpy( cur->val.p, val, val_len );
be_bryan 0:b74591d5ab33 387
be_bryan 0:b74591d5ab33 388 return( cur );
be_bryan 0:b74591d5ab33 389 }
be_bryan 0:b74591d5ab33 390 #endif /* MBEDTLS_ASN1_WRITE_C */