mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

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 * NIST SP800-38C compliant CCM implementation
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 /*
be_bryan 0:b74591d5ab33 23 * Definition of CCM:
be_bryan 0:b74591d5ab33 24 * http://csrc.nist.gov/publications/nistpubs/800-38C/SP800-38C_updated-July20_2007.pdf
be_bryan 0:b74591d5ab33 25 * RFC 3610 "Counter with CBC-MAC (CCM)"
be_bryan 0:b74591d5ab33 26 *
be_bryan 0:b74591d5ab33 27 * Related:
be_bryan 0:b74591d5ab33 28 * RFC 5116 "An Interface and Algorithms for Authenticated Encryption"
be_bryan 0:b74591d5ab33 29 */
be_bryan 0:b74591d5ab33 30
be_bryan 0:b74591d5ab33 31 #if !defined(MBEDTLS_CONFIG_FILE)
be_bryan 0:b74591d5ab33 32 #include "mbedtls/config.h"
be_bryan 0:b74591d5ab33 33 #else
be_bryan 0:b74591d5ab33 34 #include MBEDTLS_CONFIG_FILE
be_bryan 0:b74591d5ab33 35 #endif
be_bryan 0:b74591d5ab33 36
be_bryan 0:b74591d5ab33 37 #if defined(MBEDTLS_CCM_C)
be_bryan 0:b74591d5ab33 38
be_bryan 0:b74591d5ab33 39 #include "mbedtls/ccm.h"
be_bryan 0:b74591d5ab33 40
be_bryan 0:b74591d5ab33 41 #include <string.h>
be_bryan 0:b74591d5ab33 42
be_bryan 0:b74591d5ab33 43 #if defined(MBEDTLS_SELF_TEST) && defined(MBEDTLS_AES_C)
be_bryan 0:b74591d5ab33 44 #if defined(MBEDTLS_PLATFORM_C)
be_bryan 0:b74591d5ab33 45 #include "mbedtls/platform.h"
be_bryan 0:b74591d5ab33 46 #else
be_bryan 0:b74591d5ab33 47 #include <stdio.h>
be_bryan 0:b74591d5ab33 48 #define mbedtls_printf printf
be_bryan 0:b74591d5ab33 49 #endif /* MBEDTLS_PLATFORM_C */
be_bryan 0:b74591d5ab33 50 #endif /* MBEDTLS_SELF_TEST && MBEDTLS_AES_C */
be_bryan 0:b74591d5ab33 51
be_bryan 0:b74591d5ab33 52 /* Implementation that should never be optimized out by the compiler */
be_bryan 0:b74591d5ab33 53 static void mbedtls_zeroize( void *v, size_t n ) {
be_bryan 0:b74591d5ab33 54 volatile unsigned char *p = (unsigned char*)v; while( n-- ) *p++ = 0;
be_bryan 0:b74591d5ab33 55 }
be_bryan 0:b74591d5ab33 56
be_bryan 0:b74591d5ab33 57 #define CCM_ENCRYPT 0
be_bryan 0:b74591d5ab33 58 #define CCM_DECRYPT 1
be_bryan 0:b74591d5ab33 59
be_bryan 0:b74591d5ab33 60 /*
be_bryan 0:b74591d5ab33 61 * Initialize context
be_bryan 0:b74591d5ab33 62 */
be_bryan 0:b74591d5ab33 63 void mbedtls_ccm_init( mbedtls_ccm_context *ctx )
be_bryan 0:b74591d5ab33 64 {
be_bryan 0:b74591d5ab33 65 memset( ctx, 0, sizeof( mbedtls_ccm_context ) );
be_bryan 0:b74591d5ab33 66 }
be_bryan 0:b74591d5ab33 67
be_bryan 0:b74591d5ab33 68 int mbedtls_ccm_setkey( mbedtls_ccm_context *ctx,
be_bryan 0:b74591d5ab33 69 mbedtls_cipher_id_t cipher,
be_bryan 0:b74591d5ab33 70 const unsigned char *key,
be_bryan 0:b74591d5ab33 71 unsigned int keybits )
be_bryan 0:b74591d5ab33 72 {
be_bryan 0:b74591d5ab33 73 int ret;
be_bryan 0:b74591d5ab33 74 const mbedtls_cipher_info_t *cipher_info;
be_bryan 0:b74591d5ab33 75
be_bryan 0:b74591d5ab33 76 cipher_info = mbedtls_cipher_info_from_values( cipher, keybits, MBEDTLS_MODE_ECB );
be_bryan 0:b74591d5ab33 77 if( cipher_info == NULL )
be_bryan 0:b74591d5ab33 78 return( MBEDTLS_ERR_CCM_BAD_INPUT );
be_bryan 0:b74591d5ab33 79
be_bryan 0:b74591d5ab33 80 if( cipher_info->block_size != 16 )
be_bryan 0:b74591d5ab33 81 return( MBEDTLS_ERR_CCM_BAD_INPUT );
be_bryan 0:b74591d5ab33 82
be_bryan 0:b74591d5ab33 83 mbedtls_cipher_free( &ctx->cipher_ctx );
be_bryan 0:b74591d5ab33 84
be_bryan 0:b74591d5ab33 85 if( ( ret = mbedtls_cipher_setup( &ctx->cipher_ctx, cipher_info ) ) != 0 )
be_bryan 0:b74591d5ab33 86 return( ret );
be_bryan 0:b74591d5ab33 87
be_bryan 0:b74591d5ab33 88 if( ( ret = mbedtls_cipher_setkey( &ctx->cipher_ctx, key, keybits,
be_bryan 0:b74591d5ab33 89 MBEDTLS_ENCRYPT ) ) != 0 )
be_bryan 0:b74591d5ab33 90 {
be_bryan 0:b74591d5ab33 91 return( ret );
be_bryan 0:b74591d5ab33 92 }
be_bryan 0:b74591d5ab33 93
be_bryan 0:b74591d5ab33 94 return( 0 );
be_bryan 0:b74591d5ab33 95 }
be_bryan 0:b74591d5ab33 96
be_bryan 0:b74591d5ab33 97 /*
be_bryan 0:b74591d5ab33 98 * Free context
be_bryan 0:b74591d5ab33 99 */
be_bryan 0:b74591d5ab33 100 void mbedtls_ccm_free( mbedtls_ccm_context *ctx )
be_bryan 0:b74591d5ab33 101 {
be_bryan 0:b74591d5ab33 102 mbedtls_cipher_free( &ctx->cipher_ctx );
be_bryan 0:b74591d5ab33 103 mbedtls_zeroize( ctx, sizeof( mbedtls_ccm_context ) );
be_bryan 0:b74591d5ab33 104 }
be_bryan 0:b74591d5ab33 105
be_bryan 0:b74591d5ab33 106 /*
be_bryan 0:b74591d5ab33 107 * Macros for common operations.
be_bryan 0:b74591d5ab33 108 * Results in smaller compiled code than static inline functions.
be_bryan 0:b74591d5ab33 109 */
be_bryan 0:b74591d5ab33 110
be_bryan 0:b74591d5ab33 111 /*
be_bryan 0:b74591d5ab33 112 * Update the CBC-MAC state in y using a block in b
be_bryan 0:b74591d5ab33 113 * (Always using b as the source helps the compiler optimise a bit better.)
be_bryan 0:b74591d5ab33 114 */
be_bryan 0:b74591d5ab33 115 #define UPDATE_CBC_MAC \
be_bryan 0:b74591d5ab33 116 for( i = 0; i < 16; i++ ) \
be_bryan 0:b74591d5ab33 117 y[i] ^= b[i]; \
be_bryan 0:b74591d5ab33 118 \
be_bryan 0:b74591d5ab33 119 if( ( ret = mbedtls_cipher_update( &ctx->cipher_ctx, y, 16, y, &olen ) ) != 0 ) \
be_bryan 0:b74591d5ab33 120 return( ret );
be_bryan 0:b74591d5ab33 121
be_bryan 0:b74591d5ab33 122 /*
be_bryan 0:b74591d5ab33 123 * Encrypt or decrypt a partial block with CTR
be_bryan 0:b74591d5ab33 124 * Warning: using b for temporary storage! src and dst must not be b!
be_bryan 0:b74591d5ab33 125 * This avoids allocating one more 16 bytes buffer while allowing src == dst.
be_bryan 0:b74591d5ab33 126 */
be_bryan 0:b74591d5ab33 127 #define CTR_CRYPT( dst, src, len ) \
be_bryan 0:b74591d5ab33 128 if( ( ret = mbedtls_cipher_update( &ctx->cipher_ctx, ctr, 16, b, &olen ) ) != 0 ) \
be_bryan 0:b74591d5ab33 129 return( ret ); \
be_bryan 0:b74591d5ab33 130 \
be_bryan 0:b74591d5ab33 131 for( i = 0; i < len; i++ ) \
be_bryan 0:b74591d5ab33 132 dst[i] = src[i] ^ b[i];
be_bryan 0:b74591d5ab33 133
be_bryan 0:b74591d5ab33 134 /*
be_bryan 0:b74591d5ab33 135 * Authenticated encryption or decryption
be_bryan 0:b74591d5ab33 136 */
be_bryan 0:b74591d5ab33 137 static int ccm_auth_crypt( mbedtls_ccm_context *ctx, int mode, size_t length,
be_bryan 0:b74591d5ab33 138 const unsigned char *iv, size_t iv_len,
be_bryan 0:b74591d5ab33 139 const unsigned char *add, size_t add_len,
be_bryan 0:b74591d5ab33 140 const unsigned char *input, unsigned char *output,
be_bryan 0:b74591d5ab33 141 unsigned char *tag, size_t tag_len )
be_bryan 0:b74591d5ab33 142 {
be_bryan 0:b74591d5ab33 143 int ret;
be_bryan 0:b74591d5ab33 144 unsigned char i;
be_bryan 0:b74591d5ab33 145 unsigned char q;
be_bryan 0:b74591d5ab33 146 size_t len_left, olen;
be_bryan 0:b74591d5ab33 147 unsigned char b[16];
be_bryan 0:b74591d5ab33 148 unsigned char y[16];
be_bryan 0:b74591d5ab33 149 unsigned char ctr[16];
be_bryan 0:b74591d5ab33 150 const unsigned char *src;
be_bryan 0:b74591d5ab33 151 unsigned char *dst;
be_bryan 0:b74591d5ab33 152
be_bryan 0:b74591d5ab33 153 /*
be_bryan 0:b74591d5ab33 154 * Check length requirements: SP800-38C A.1
be_bryan 0:b74591d5ab33 155 * Additional requirement: a < 2^16 - 2^8 to simplify the code.
be_bryan 0:b74591d5ab33 156 * 'length' checked later (when writing it to the first block)
be_bryan 0:b74591d5ab33 157 */
be_bryan 0:b74591d5ab33 158 if( tag_len < 4 || tag_len > 16 || tag_len % 2 != 0 )
be_bryan 0:b74591d5ab33 159 return( MBEDTLS_ERR_CCM_BAD_INPUT );
be_bryan 0:b74591d5ab33 160
be_bryan 0:b74591d5ab33 161 /* Also implies q is within bounds */
be_bryan 0:b74591d5ab33 162 if( iv_len < 7 || iv_len > 13 )
be_bryan 0:b74591d5ab33 163 return( MBEDTLS_ERR_CCM_BAD_INPUT );
be_bryan 0:b74591d5ab33 164
be_bryan 0:b74591d5ab33 165 if( add_len > 0xFF00 )
be_bryan 0:b74591d5ab33 166 return( MBEDTLS_ERR_CCM_BAD_INPUT );
be_bryan 0:b74591d5ab33 167
be_bryan 0:b74591d5ab33 168 q = 16 - 1 - (unsigned char) iv_len;
be_bryan 0:b74591d5ab33 169
be_bryan 0:b74591d5ab33 170 /*
be_bryan 0:b74591d5ab33 171 * First block B_0:
be_bryan 0:b74591d5ab33 172 * 0 .. 0 flags
be_bryan 0:b74591d5ab33 173 * 1 .. iv_len nonce (aka iv)
be_bryan 0:b74591d5ab33 174 * iv_len+1 .. 15 length
be_bryan 0:b74591d5ab33 175 *
be_bryan 0:b74591d5ab33 176 * With flags as (bits):
be_bryan 0:b74591d5ab33 177 * 7 0
be_bryan 0:b74591d5ab33 178 * 6 add present?
be_bryan 0:b74591d5ab33 179 * 5 .. 3 (t - 2) / 2
be_bryan 0:b74591d5ab33 180 * 2 .. 0 q - 1
be_bryan 0:b74591d5ab33 181 */
be_bryan 0:b74591d5ab33 182 b[0] = 0;
be_bryan 0:b74591d5ab33 183 b[0] |= ( add_len > 0 ) << 6;
be_bryan 0:b74591d5ab33 184 b[0] |= ( ( tag_len - 2 ) / 2 ) << 3;
be_bryan 0:b74591d5ab33 185 b[0] |= q - 1;
be_bryan 0:b74591d5ab33 186
be_bryan 0:b74591d5ab33 187 memcpy( b + 1, iv, iv_len );
be_bryan 0:b74591d5ab33 188
be_bryan 0:b74591d5ab33 189 for( i = 0, len_left = length; i < q; i++, len_left >>= 8 )
be_bryan 0:b74591d5ab33 190 b[15-i] = (unsigned char)( len_left & 0xFF );
be_bryan 0:b74591d5ab33 191
be_bryan 0:b74591d5ab33 192 if( len_left > 0 )
be_bryan 0:b74591d5ab33 193 return( MBEDTLS_ERR_CCM_BAD_INPUT );
be_bryan 0:b74591d5ab33 194
be_bryan 0:b74591d5ab33 195
be_bryan 0:b74591d5ab33 196 /* Start CBC-MAC with first block */
be_bryan 0:b74591d5ab33 197 memset( y, 0, 16 );
be_bryan 0:b74591d5ab33 198 UPDATE_CBC_MAC;
be_bryan 0:b74591d5ab33 199
be_bryan 0:b74591d5ab33 200 /*
be_bryan 0:b74591d5ab33 201 * If there is additional data, update CBC-MAC with
be_bryan 0:b74591d5ab33 202 * add_len, add, 0 (padding to a block boundary)
be_bryan 0:b74591d5ab33 203 */
be_bryan 0:b74591d5ab33 204 if( add_len > 0 )
be_bryan 0:b74591d5ab33 205 {
be_bryan 0:b74591d5ab33 206 size_t use_len;
be_bryan 0:b74591d5ab33 207 len_left = add_len;
be_bryan 0:b74591d5ab33 208 src = add;
be_bryan 0:b74591d5ab33 209
be_bryan 0:b74591d5ab33 210 memset( b, 0, 16 );
be_bryan 0:b74591d5ab33 211 b[0] = (unsigned char)( ( add_len >> 8 ) & 0xFF );
be_bryan 0:b74591d5ab33 212 b[1] = (unsigned char)( ( add_len ) & 0xFF );
be_bryan 0:b74591d5ab33 213
be_bryan 0:b74591d5ab33 214 use_len = len_left < 16 - 2 ? len_left : 16 - 2;
be_bryan 0:b74591d5ab33 215 memcpy( b + 2, src, use_len );
be_bryan 0:b74591d5ab33 216 len_left -= use_len;
be_bryan 0:b74591d5ab33 217 src += use_len;
be_bryan 0:b74591d5ab33 218
be_bryan 0:b74591d5ab33 219 UPDATE_CBC_MAC;
be_bryan 0:b74591d5ab33 220
be_bryan 0:b74591d5ab33 221 while( len_left > 0 )
be_bryan 0:b74591d5ab33 222 {
be_bryan 0:b74591d5ab33 223 use_len = len_left > 16 ? 16 : len_left;
be_bryan 0:b74591d5ab33 224
be_bryan 0:b74591d5ab33 225 memset( b, 0, 16 );
be_bryan 0:b74591d5ab33 226 memcpy( b, src, use_len );
be_bryan 0:b74591d5ab33 227 UPDATE_CBC_MAC;
be_bryan 0:b74591d5ab33 228
be_bryan 0:b74591d5ab33 229 len_left -= use_len;
be_bryan 0:b74591d5ab33 230 src += use_len;
be_bryan 0:b74591d5ab33 231 }
be_bryan 0:b74591d5ab33 232 }
be_bryan 0:b74591d5ab33 233
be_bryan 0:b74591d5ab33 234 /*
be_bryan 0:b74591d5ab33 235 * Prepare counter block for encryption:
be_bryan 0:b74591d5ab33 236 * 0 .. 0 flags
be_bryan 0:b74591d5ab33 237 * 1 .. iv_len nonce (aka iv)
be_bryan 0:b74591d5ab33 238 * iv_len+1 .. 15 counter (initially 1)
be_bryan 0:b74591d5ab33 239 *
be_bryan 0:b74591d5ab33 240 * With flags as (bits):
be_bryan 0:b74591d5ab33 241 * 7 .. 3 0
be_bryan 0:b74591d5ab33 242 * 2 .. 0 q - 1
be_bryan 0:b74591d5ab33 243 */
be_bryan 0:b74591d5ab33 244 ctr[0] = q - 1;
be_bryan 0:b74591d5ab33 245 memcpy( ctr + 1, iv, iv_len );
be_bryan 0:b74591d5ab33 246 memset( ctr + 1 + iv_len, 0, q );
be_bryan 0:b74591d5ab33 247 ctr[15] = 1;
be_bryan 0:b74591d5ab33 248
be_bryan 0:b74591d5ab33 249 /*
be_bryan 0:b74591d5ab33 250 * Authenticate and {en,de}crypt the message.
be_bryan 0:b74591d5ab33 251 *
be_bryan 0:b74591d5ab33 252 * The only difference between encryption and decryption is
be_bryan 0:b74591d5ab33 253 * the respective order of authentication and {en,de}cryption.
be_bryan 0:b74591d5ab33 254 */
be_bryan 0:b74591d5ab33 255 len_left = length;
be_bryan 0:b74591d5ab33 256 src = input;
be_bryan 0:b74591d5ab33 257 dst = output;
be_bryan 0:b74591d5ab33 258
be_bryan 0:b74591d5ab33 259 while( len_left > 0 )
be_bryan 0:b74591d5ab33 260 {
be_bryan 0:b74591d5ab33 261 size_t use_len = len_left > 16 ? 16 : len_left;
be_bryan 0:b74591d5ab33 262
be_bryan 0:b74591d5ab33 263 if( mode == CCM_ENCRYPT )
be_bryan 0:b74591d5ab33 264 {
be_bryan 0:b74591d5ab33 265 memset( b, 0, 16 );
be_bryan 0:b74591d5ab33 266 memcpy( b, src, use_len );
be_bryan 0:b74591d5ab33 267 UPDATE_CBC_MAC;
be_bryan 0:b74591d5ab33 268 }
be_bryan 0:b74591d5ab33 269
be_bryan 0:b74591d5ab33 270 CTR_CRYPT( dst, src, use_len );
be_bryan 0:b74591d5ab33 271
be_bryan 0:b74591d5ab33 272 if( mode == CCM_DECRYPT )
be_bryan 0:b74591d5ab33 273 {
be_bryan 0:b74591d5ab33 274 memset( b, 0, 16 );
be_bryan 0:b74591d5ab33 275 memcpy( b, dst, use_len );
be_bryan 0:b74591d5ab33 276 UPDATE_CBC_MAC;
be_bryan 0:b74591d5ab33 277 }
be_bryan 0:b74591d5ab33 278
be_bryan 0:b74591d5ab33 279 dst += use_len;
be_bryan 0:b74591d5ab33 280 src += use_len;
be_bryan 0:b74591d5ab33 281 len_left -= use_len;
be_bryan 0:b74591d5ab33 282
be_bryan 0:b74591d5ab33 283 /*
be_bryan 0:b74591d5ab33 284 * Increment counter.
be_bryan 0:b74591d5ab33 285 * No need to check for overflow thanks to the length check above.
be_bryan 0:b74591d5ab33 286 */
be_bryan 0:b74591d5ab33 287 for( i = 0; i < q; i++ )
be_bryan 0:b74591d5ab33 288 if( ++ctr[15-i] != 0 )
be_bryan 0:b74591d5ab33 289 break;
be_bryan 0:b74591d5ab33 290 }
be_bryan 0:b74591d5ab33 291
be_bryan 0:b74591d5ab33 292 /*
be_bryan 0:b74591d5ab33 293 * Authentication: reset counter and crypt/mask internal tag
be_bryan 0:b74591d5ab33 294 */
be_bryan 0:b74591d5ab33 295 for( i = 0; i < q; i++ )
be_bryan 0:b74591d5ab33 296 ctr[15-i] = 0;
be_bryan 0:b74591d5ab33 297
be_bryan 0:b74591d5ab33 298 CTR_CRYPT( y, y, 16 );
be_bryan 0:b74591d5ab33 299 memcpy( tag, y, tag_len );
be_bryan 0:b74591d5ab33 300
be_bryan 0:b74591d5ab33 301 return( 0 );
be_bryan 0:b74591d5ab33 302 }
be_bryan 0:b74591d5ab33 303
be_bryan 0:b74591d5ab33 304 /*
be_bryan 0:b74591d5ab33 305 * Authenticated encryption
be_bryan 0:b74591d5ab33 306 */
be_bryan 0:b74591d5ab33 307 int mbedtls_ccm_encrypt_and_tag( mbedtls_ccm_context *ctx, size_t length,
be_bryan 0:b74591d5ab33 308 const unsigned char *iv, size_t iv_len,
be_bryan 0:b74591d5ab33 309 const unsigned char *add, size_t add_len,
be_bryan 0:b74591d5ab33 310 const unsigned char *input, unsigned char *output,
be_bryan 0:b74591d5ab33 311 unsigned char *tag, size_t tag_len )
be_bryan 0:b74591d5ab33 312 {
be_bryan 0:b74591d5ab33 313 return( ccm_auth_crypt( ctx, CCM_ENCRYPT, length, iv, iv_len,
be_bryan 0:b74591d5ab33 314 add, add_len, input, output, tag, tag_len ) );
be_bryan 0:b74591d5ab33 315 }
be_bryan 0:b74591d5ab33 316
be_bryan 0:b74591d5ab33 317 /*
be_bryan 0:b74591d5ab33 318 * Authenticated decryption
be_bryan 0:b74591d5ab33 319 */
be_bryan 0:b74591d5ab33 320 int mbedtls_ccm_auth_decrypt( mbedtls_ccm_context *ctx, size_t length,
be_bryan 0:b74591d5ab33 321 const unsigned char *iv, size_t iv_len,
be_bryan 0:b74591d5ab33 322 const unsigned char *add, size_t add_len,
be_bryan 0:b74591d5ab33 323 const unsigned char *input, unsigned char *output,
be_bryan 0:b74591d5ab33 324 const unsigned char *tag, size_t tag_len )
be_bryan 0:b74591d5ab33 325 {
be_bryan 0:b74591d5ab33 326 int ret;
be_bryan 0:b74591d5ab33 327 unsigned char check_tag[16];
be_bryan 0:b74591d5ab33 328 unsigned char i;
be_bryan 0:b74591d5ab33 329 int diff;
be_bryan 0:b74591d5ab33 330
be_bryan 0:b74591d5ab33 331 if( ( ret = ccm_auth_crypt( ctx, CCM_DECRYPT, length,
be_bryan 0:b74591d5ab33 332 iv, iv_len, add, add_len,
be_bryan 0:b74591d5ab33 333 input, output, check_tag, tag_len ) ) != 0 )
be_bryan 0:b74591d5ab33 334 {
be_bryan 0:b74591d5ab33 335 return( ret );
be_bryan 0:b74591d5ab33 336 }
be_bryan 0:b74591d5ab33 337
be_bryan 0:b74591d5ab33 338 /* Check tag in "constant-time" */
be_bryan 0:b74591d5ab33 339 for( diff = 0, i = 0; i < tag_len; i++ )
be_bryan 0:b74591d5ab33 340 diff |= tag[i] ^ check_tag[i];
be_bryan 0:b74591d5ab33 341
be_bryan 0:b74591d5ab33 342 if( diff != 0 )
be_bryan 0:b74591d5ab33 343 {
be_bryan 0:b74591d5ab33 344 mbedtls_zeroize( output, length );
be_bryan 0:b74591d5ab33 345 return( MBEDTLS_ERR_CCM_AUTH_FAILED );
be_bryan 0:b74591d5ab33 346 }
be_bryan 0:b74591d5ab33 347
be_bryan 0:b74591d5ab33 348 return( 0 );
be_bryan 0:b74591d5ab33 349 }
be_bryan 0:b74591d5ab33 350
be_bryan 0:b74591d5ab33 351
be_bryan 0:b74591d5ab33 352 #if defined(MBEDTLS_SELF_TEST) && defined(MBEDTLS_AES_C)
be_bryan 0:b74591d5ab33 353 /*
be_bryan 0:b74591d5ab33 354 * Examples 1 to 3 from SP800-38C Appendix C
be_bryan 0:b74591d5ab33 355 */
be_bryan 0:b74591d5ab33 356
be_bryan 0:b74591d5ab33 357 #define NB_TESTS 3
be_bryan 0:b74591d5ab33 358
be_bryan 0:b74591d5ab33 359 /*
be_bryan 0:b74591d5ab33 360 * The data is the same for all tests, only the used length changes
be_bryan 0:b74591d5ab33 361 */
be_bryan 0:b74591d5ab33 362 static const unsigned char key[] = {
be_bryan 0:b74591d5ab33 363 0x40, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47,
be_bryan 0:b74591d5ab33 364 0x48, 0x49, 0x4a, 0x4b, 0x4c, 0x4d, 0x4e, 0x4f
be_bryan 0:b74591d5ab33 365 };
be_bryan 0:b74591d5ab33 366
be_bryan 0:b74591d5ab33 367 static const unsigned char iv[] = {
be_bryan 0:b74591d5ab33 368 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17,
be_bryan 0:b74591d5ab33 369 0x18, 0x19, 0x1a, 0x1b
be_bryan 0:b74591d5ab33 370 };
be_bryan 0:b74591d5ab33 371
be_bryan 0:b74591d5ab33 372 static const unsigned char ad[] = {
be_bryan 0:b74591d5ab33 373 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
be_bryan 0:b74591d5ab33 374 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f,
be_bryan 0:b74591d5ab33 375 0x10, 0x11, 0x12, 0x13
be_bryan 0:b74591d5ab33 376 };
be_bryan 0:b74591d5ab33 377
be_bryan 0:b74591d5ab33 378 static const unsigned char msg[] = {
be_bryan 0:b74591d5ab33 379 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27,
be_bryan 0:b74591d5ab33 380 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f,
be_bryan 0:b74591d5ab33 381 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37,
be_bryan 0:b74591d5ab33 382 };
be_bryan 0:b74591d5ab33 383
be_bryan 0:b74591d5ab33 384 static const size_t iv_len [NB_TESTS] = { 7, 8, 12 };
be_bryan 0:b74591d5ab33 385 static const size_t add_len[NB_TESTS] = { 8, 16, 20 };
be_bryan 0:b74591d5ab33 386 static const size_t msg_len[NB_TESTS] = { 4, 16, 24 };
be_bryan 0:b74591d5ab33 387 static const size_t tag_len[NB_TESTS] = { 4, 6, 8 };
be_bryan 0:b74591d5ab33 388
be_bryan 0:b74591d5ab33 389 static const unsigned char res[NB_TESTS][32] = {
be_bryan 0:b74591d5ab33 390 { 0x71, 0x62, 0x01, 0x5b, 0x4d, 0xac, 0x25, 0x5d },
be_bryan 0:b74591d5ab33 391 { 0xd2, 0xa1, 0xf0, 0xe0, 0x51, 0xea, 0x5f, 0x62,
be_bryan 0:b74591d5ab33 392 0x08, 0x1a, 0x77, 0x92, 0x07, 0x3d, 0x59, 0x3d,
be_bryan 0:b74591d5ab33 393 0x1f, 0xc6, 0x4f, 0xbf, 0xac, 0xcd },
be_bryan 0:b74591d5ab33 394 { 0xe3, 0xb2, 0x01, 0xa9, 0xf5, 0xb7, 0x1a, 0x7a,
be_bryan 0:b74591d5ab33 395 0x9b, 0x1c, 0xea, 0xec, 0xcd, 0x97, 0xe7, 0x0b,
be_bryan 0:b74591d5ab33 396 0x61, 0x76, 0xaa, 0xd9, 0xa4, 0x42, 0x8a, 0xa5,
be_bryan 0:b74591d5ab33 397 0x48, 0x43, 0x92, 0xfb, 0xc1, 0xb0, 0x99, 0x51 }
be_bryan 0:b74591d5ab33 398 };
be_bryan 0:b74591d5ab33 399
be_bryan 0:b74591d5ab33 400 int mbedtls_ccm_self_test( int verbose )
be_bryan 0:b74591d5ab33 401 {
be_bryan 0:b74591d5ab33 402 mbedtls_ccm_context ctx;
be_bryan 0:b74591d5ab33 403 unsigned char out[32];
be_bryan 0:b74591d5ab33 404 size_t i;
be_bryan 0:b74591d5ab33 405 int ret;
be_bryan 0:b74591d5ab33 406
be_bryan 0:b74591d5ab33 407 mbedtls_ccm_init( &ctx );
be_bryan 0:b74591d5ab33 408
be_bryan 0:b74591d5ab33 409 if( mbedtls_ccm_setkey( &ctx, MBEDTLS_CIPHER_ID_AES, key, 8 * sizeof key ) != 0 )
be_bryan 0:b74591d5ab33 410 {
be_bryan 0:b74591d5ab33 411 if( verbose != 0 )
be_bryan 0:b74591d5ab33 412 mbedtls_printf( " CCM: setup failed" );
be_bryan 0:b74591d5ab33 413
be_bryan 0:b74591d5ab33 414 return( 1 );
be_bryan 0:b74591d5ab33 415 }
be_bryan 0:b74591d5ab33 416
be_bryan 0:b74591d5ab33 417 for( i = 0; i < NB_TESTS; i++ )
be_bryan 0:b74591d5ab33 418 {
be_bryan 0:b74591d5ab33 419 if( verbose != 0 )
be_bryan 0:b74591d5ab33 420 mbedtls_printf( " CCM-AES #%u: ", (unsigned int) i + 1 );
be_bryan 0:b74591d5ab33 421
be_bryan 0:b74591d5ab33 422 ret = mbedtls_ccm_encrypt_and_tag( &ctx, msg_len[i],
be_bryan 0:b74591d5ab33 423 iv, iv_len[i], ad, add_len[i],
be_bryan 0:b74591d5ab33 424 msg, out,
be_bryan 0:b74591d5ab33 425 out + msg_len[i], tag_len[i] );
be_bryan 0:b74591d5ab33 426
be_bryan 0:b74591d5ab33 427 if( ret != 0 ||
be_bryan 0:b74591d5ab33 428 memcmp( out, res[i], msg_len[i] + tag_len[i] ) != 0 )
be_bryan 0:b74591d5ab33 429 {
be_bryan 0:b74591d5ab33 430 if( verbose != 0 )
be_bryan 0:b74591d5ab33 431 mbedtls_printf( "failed\n" );
be_bryan 0:b74591d5ab33 432
be_bryan 0:b74591d5ab33 433 return( 1 );
be_bryan 0:b74591d5ab33 434 }
be_bryan 0:b74591d5ab33 435
be_bryan 0:b74591d5ab33 436 ret = mbedtls_ccm_auth_decrypt( &ctx, msg_len[i],
be_bryan 0:b74591d5ab33 437 iv, iv_len[i], ad, add_len[i],
be_bryan 0:b74591d5ab33 438 res[i], out,
be_bryan 0:b74591d5ab33 439 res[i] + msg_len[i], tag_len[i] );
be_bryan 0:b74591d5ab33 440
be_bryan 0:b74591d5ab33 441 if( ret != 0 ||
be_bryan 0:b74591d5ab33 442 memcmp( out, msg, msg_len[i] ) != 0 )
be_bryan 0:b74591d5ab33 443 {
be_bryan 0:b74591d5ab33 444 if( verbose != 0 )
be_bryan 0:b74591d5ab33 445 mbedtls_printf( "failed\n" );
be_bryan 0:b74591d5ab33 446
be_bryan 0:b74591d5ab33 447 return( 1 );
be_bryan 0:b74591d5ab33 448 }
be_bryan 0:b74591d5ab33 449
be_bryan 0:b74591d5ab33 450 if( verbose != 0 )
be_bryan 0:b74591d5ab33 451 mbedtls_printf( "passed\n" );
be_bryan 0:b74591d5ab33 452 }
be_bryan 0:b74591d5ab33 453
be_bryan 0:b74591d5ab33 454 mbedtls_ccm_free( &ctx );
be_bryan 0:b74591d5ab33 455
be_bryan 0:b74591d5ab33 456 if( verbose != 0 )
be_bryan 0:b74591d5ab33 457 mbedtls_printf( "\n" );
be_bryan 0:b74591d5ab33 458
be_bryan 0:b74591d5ab33 459 return( 0 );
be_bryan 0:b74591d5ab33 460 }
be_bryan 0:b74591d5ab33 461
be_bryan 0:b74591d5ab33 462 #endif /* MBEDTLS_SELF_TEST && MBEDTLS_AES_C */
be_bryan 0:b74591d5ab33 463
be_bryan 0:b74591d5ab33 464 #endif /* MBEDTLS_CCM_C */