Austin Blackstone / Mbed 2 deprecated mbed-client-classic-example-lwip

mbed client on ethernet with LWIP

Dependencies:   mbed Socket lwip-eth lwip-sys lwip

Fork of mbed-client-classic-example-lwip by sandbox

mbedtls/source/asn1write.c@11:cada08fc8a70, 2016-06-09 (annotated)

Committer:
mbedAustin
Date:
Thu Jun 09 17:08:36 2016 +0000
Revision:
11:cada08fc8a70
Commit for public Consumption

Who changed what in which revision?

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