--- /dev/null
+/*\r
+ * Generic ASN.1 parsing\r
+ *\r
+ * Copyright (C) 2006-2015, ARM Limited, All Rights Reserved\r
+ * SPDX-License-Identifier: Apache-2.0\r
+ *\r
+ * Licensed under the Apache License, Version 2.0 (the "License"); you may\r
+ * not use this file except in compliance with the License.\r
+ * You may obtain a copy of the License at\r
+ *\r
+ * http://www.apache.org/licenses/LICENSE-2.0\r
+ *\r
+ * Unless required by applicable law or agreed to in writing, software\r
+ * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT\r
+ * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.\r
+ * See the License for the specific language governing permissions and\r
+ * limitations under the License.\r
+ *\r
+ * This file is part of mbed TLS (https://tls.mbed.org)\r
+ */\r
+\r
+#if !defined(MBEDTLS_CONFIG_FILE)\r
+#include "mbedtls/config.h"\r
+#else\r
+#include MBEDTLS_CONFIG_FILE\r
+#endif\r
+\r
+#if defined(MBEDTLS_ASN1_PARSE_C)\r
+\r
+#include "mbedtls/asn1.h"\r
+#include "mbedtls/platform_util.h"\r
+\r
+#include <string.h>\r
+\r
+#if defined(MBEDTLS_BIGNUM_C)\r
+#include "mbedtls/bignum.h"\r
+#endif\r
+\r
+#if defined(MBEDTLS_PLATFORM_C)\r
+#include "mbedtls/platform.h"\r
+#else\r
+#include <stdlib.h>\r
+#define mbedtls_calloc calloc\r
+#define mbedtls_free free\r
+#endif\r
+\r
+/*\r
+ * ASN.1 DER decoding routines\r
+ */\r
+int mbedtls_asn1_get_len( unsigned char **p,\r
+ const unsigned char *end,\r
+ size_t *len )\r
+{\r
+ if( ( end - *p ) < 1 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ if( ( **p & 0x80 ) == 0 )\r
+ *len = *(*p)++;\r
+ else\r
+ {\r
+ switch( **p & 0x7F )\r
+ {\r
+ case 1:\r
+ if( ( end - *p ) < 2 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ *len = (*p)[1];\r
+ (*p) += 2;\r
+ break;\r
+\r
+ case 2:\r
+ if( ( end - *p ) < 3 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ *len = ( (size_t)(*p)[1] << 8 ) | (*p)[2];\r
+ (*p) += 3;\r
+ break;\r
+\r
+ case 3:\r
+ if( ( end - *p ) < 4 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ *len = ( (size_t)(*p)[1] << 16 ) |\r
+ ( (size_t)(*p)[2] << 8 ) | (*p)[3];\r
+ (*p) += 4;\r
+ break;\r
+\r
+ case 4:\r
+ if( ( end - *p ) < 5 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ *len = ( (size_t)(*p)[1] << 24 ) | ( (size_t)(*p)[2] << 16 ) |\r
+ ( (size_t)(*p)[3] << 8 ) | (*p)[4];\r
+ (*p) += 5;\r
+ break;\r
+\r
+ default:\r
+ return( MBEDTLS_ERR_ASN1_INVALID_LENGTH );\r
+ }\r
+ }\r
+\r
+ if( *len > (size_t) ( end - *p ) )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ return( 0 );\r
+}\r
+\r
+int mbedtls_asn1_get_tag( unsigned char **p,\r
+ const unsigned char *end,\r
+ size_t *len, int tag )\r
+{\r
+ if( ( end - *p ) < 1 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ if( **p != tag )\r
+ return( MBEDTLS_ERR_ASN1_UNEXPECTED_TAG );\r
+\r
+ (*p)++;\r
+\r
+ return( mbedtls_asn1_get_len( p, end, len ) );\r
+}\r
+\r
+int mbedtls_asn1_get_bool( unsigned char **p,\r
+ const unsigned char *end,\r
+ int *val )\r
+{\r
+ int ret;\r
+ size_t len;\r
+\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &len, MBEDTLS_ASN1_BOOLEAN ) ) != 0 )\r
+ return( ret );\r
+\r
+ if( len != 1 )\r
+ return( MBEDTLS_ERR_ASN1_INVALID_LENGTH );\r
+\r
+ *val = ( **p != 0 ) ? 1 : 0;\r
+ (*p)++;\r
+\r
+ return( 0 );\r
+}\r
+\r
+int mbedtls_asn1_get_int( unsigned char **p,\r
+ const unsigned char *end,\r
+ int *val )\r
+{\r
+ int ret;\r
+ size_t len;\r
+\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &len, MBEDTLS_ASN1_INTEGER ) ) != 0 )\r
+ return( ret );\r
+\r
+ if( len == 0 || len > sizeof( int ) || ( **p & 0x80 ) != 0 )\r
+ return( MBEDTLS_ERR_ASN1_INVALID_LENGTH );\r
+\r
+ *val = 0;\r
+\r
+ while( len-- > 0 )\r
+ {\r
+ *val = ( *val << 8 ) | **p;\r
+ (*p)++;\r
+ }\r
+\r
+ return( 0 );\r
+}\r
+\r
+#if defined(MBEDTLS_BIGNUM_C)\r
+int mbedtls_asn1_get_mpi( unsigned char **p,\r
+ const unsigned char *end,\r
+ mbedtls_mpi *X )\r
+{\r
+ int ret;\r
+ size_t len;\r
+\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &len, MBEDTLS_ASN1_INTEGER ) ) != 0 )\r
+ return( ret );\r
+\r
+ ret = mbedtls_mpi_read_binary( X, *p, len );\r
+\r
+ *p += len;\r
+\r
+ return( ret );\r
+}\r
+#endif /* MBEDTLS_BIGNUM_C */\r
+\r
+int mbedtls_asn1_get_bitstring( unsigned char **p, const unsigned char *end,\r
+ mbedtls_asn1_bitstring *bs)\r
+{\r
+ int ret;\r
+\r
+ /* Certificate type is a single byte bitstring */\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &bs->len, MBEDTLS_ASN1_BIT_STRING ) ) != 0 )\r
+ return( ret );\r
+\r
+ /* Check length, subtract one for actual bit string length */\r
+ if( bs->len < 1 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+ bs->len -= 1;\r
+\r
+ /* Get number of unused bits, ensure unused bits <= 7 */\r
+ bs->unused_bits = **p;\r
+ if( bs->unused_bits > 7 )\r
+ return( MBEDTLS_ERR_ASN1_INVALID_LENGTH );\r
+ (*p)++;\r
+\r
+ /* Get actual bitstring */\r
+ bs->p = *p;\r
+ *p += bs->len;\r
+\r
+ if( *p != end )\r
+ return( MBEDTLS_ERR_ASN1_LENGTH_MISMATCH );\r
+\r
+ return( 0 );\r
+}\r
+\r
+/*\r
+ * Get a bit string without unused bits\r
+ */\r
+int mbedtls_asn1_get_bitstring_null( unsigned char **p, const unsigned char *end,\r
+ size_t *len )\r
+{\r
+ int ret;\r
+\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, len, MBEDTLS_ASN1_BIT_STRING ) ) != 0 )\r
+ return( ret );\r
+\r
+ if( (*len)-- < 2 || *(*p)++ != 0 )\r
+ return( MBEDTLS_ERR_ASN1_INVALID_DATA );\r
+\r
+ return( 0 );\r
+}\r
+\r
+\r
+\r
+/*\r
+ * Parses and splits an ASN.1 "SEQUENCE OF <tag>"\r
+ */\r
+int mbedtls_asn1_get_sequence_of( unsigned char **p,\r
+ const unsigned char *end,\r
+ mbedtls_asn1_sequence *cur,\r
+ int tag)\r
+{\r
+ int ret;\r
+ size_t len;\r
+ mbedtls_asn1_buf *buf;\r
+\r
+ /* Get main sequence tag */\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &len,\r
+ MBEDTLS_ASN1_CONSTRUCTED | MBEDTLS_ASN1_SEQUENCE ) ) != 0 )\r
+ return( ret );\r
+\r
+ if( *p + len != end )\r
+ return( MBEDTLS_ERR_ASN1_LENGTH_MISMATCH );\r
+\r
+ while( *p < end )\r
+ {\r
+ buf = &(cur->buf);\r
+ buf->tag = **p;\r
+\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &buf->len, tag ) ) != 0 )\r
+ return( ret );\r
+\r
+ buf->p = *p;\r
+ *p += buf->len;\r
+\r
+ /* Allocate and assign next pointer */\r
+ if( *p < end )\r
+ {\r
+ cur->next = (mbedtls_asn1_sequence*)mbedtls_calloc( 1,\r
+ sizeof( mbedtls_asn1_sequence ) );\r
+\r
+ if( cur->next == NULL )\r
+ return( MBEDTLS_ERR_ASN1_ALLOC_FAILED );\r
+\r
+ cur = cur->next;\r
+ }\r
+ }\r
+\r
+ /* Set final sequence entry's next pointer to NULL */\r
+ cur->next = NULL;\r
+\r
+ if( *p != end )\r
+ return( MBEDTLS_ERR_ASN1_LENGTH_MISMATCH );\r
+\r
+ return( 0 );\r
+}\r
+\r
+int mbedtls_asn1_get_alg( unsigned char **p,\r
+ const unsigned char *end,\r
+ mbedtls_asn1_buf *alg, mbedtls_asn1_buf *params )\r
+{\r
+ int ret;\r
+ size_t len;\r
+\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &len,\r
+ MBEDTLS_ASN1_CONSTRUCTED | MBEDTLS_ASN1_SEQUENCE ) ) != 0 )\r
+ return( ret );\r
+\r
+ if( ( end - *p ) < 1 )\r
+ return( MBEDTLS_ERR_ASN1_OUT_OF_DATA );\r
+\r
+ alg->tag = **p;\r
+ end = *p + len;\r
+\r
+ if( ( ret = mbedtls_asn1_get_tag( p, end, &alg->len, MBEDTLS_ASN1_OID ) ) != 0 )\r
+ return( ret );\r
+\r
+ alg->p = *p;\r
+ *p += alg->len;\r
+\r
+ if( *p == end )\r
+ {\r
+ mbedtls_platform_zeroize( params, sizeof(mbedtls_asn1_buf) );\r
+ return( 0 );\r
+ }\r
+\r
+ params->tag = **p;\r
+ (*p)++;\r
+\r
+ if( ( ret = mbedtls_asn1_get_len( p, end, ¶ms->len ) ) != 0 )\r
+ return( ret );\r
+\r
+ params->p = *p;\r
+ *p += params->len;\r
+\r
+ if( *p != end )\r
+ return( MBEDTLS_ERR_ASN1_LENGTH_MISMATCH );\r
+\r
+ return( 0 );\r
+}\r
+\r
+int mbedtls_asn1_get_alg_null( unsigned char **p,\r
+ const unsigned char *end,\r
+ mbedtls_asn1_buf *alg )\r
+{\r
+ int ret;\r
+ mbedtls_asn1_buf params;\r
+\r
+ memset( ¶ms, 0, sizeof(mbedtls_asn1_buf) );\r
+\r
+ if( ( ret = mbedtls_asn1_get_alg( p, end, alg, ¶ms ) ) != 0 )\r
+ return( ret );\r
+\r
+ if( ( params.tag != MBEDTLS_ASN1_NULL && params.tag != 0 ) || params.len != 0 )\r
+ return( MBEDTLS_ERR_ASN1_INVALID_DATA );\r
+\r
+ return( 0 );\r
+}\r
+\r
+void mbedtls_asn1_free_named_data( mbedtls_asn1_named_data *cur )\r
+{\r
+ if( cur == NULL )\r
+ return;\r
+\r
+ mbedtls_free( cur->oid.p );\r
+ mbedtls_free( cur->val.p );\r
+\r
+ mbedtls_platform_zeroize( cur, sizeof( mbedtls_asn1_named_data ) );\r
+}\r
+\r
+void mbedtls_asn1_free_named_data_list( mbedtls_asn1_named_data **head )\r
+{\r
+ mbedtls_asn1_named_data *cur;\r
+\r
+ while( ( cur = *head ) != NULL )\r
+ {\r
+ *head = cur->next;\r
+ mbedtls_asn1_free_named_data( cur );\r
+ mbedtls_free( cur );\r
+ }\r
+}\r
+\r
+mbedtls_asn1_named_data *mbedtls_asn1_find_named_data( mbedtls_asn1_named_data *list,\r
+ const char *oid, size_t len )\r
+{\r
+ while( list != NULL )\r
+ {\r
+ if( list->oid.len == len &&\r
+ memcmp( list->oid.p, oid, len ) == 0 )\r
+ {\r
+ break;\r
+ }\r
+\r
+ list = list->next;\r
+ }\r
+\r
+ return( list );\r
+}\r
+\r
+#endif /* MBEDTLS_ASN1_PARSE_C */\r