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/xtea.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 * An 32-bit implementation of the XTEA algorithm
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_XTEA_C)
be_bryan 0:b74591d5ab33 29
be_bryan 0:b74591d5ab33 30 #include "mbedtls/xtea.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_SELF_TEST)
be_bryan 0:b74591d5ab33 35 #if defined(MBEDTLS_PLATFORM_C)
be_bryan 0:b74591d5ab33 36 #include "mbedtls/platform.h"
be_bryan 0:b74591d5ab33 37 #else
be_bryan 0:b74591d5ab33 38 #include <stdio.h>
be_bryan 0:b74591d5ab33 39 #define mbedtls_printf printf
be_bryan 0:b74591d5ab33 40 #endif /* MBEDTLS_PLATFORM_C */
be_bryan 0:b74591d5ab33 41 #endif /* MBEDTLS_SELF_TEST */
be_bryan 0:b74591d5ab33 42
be_bryan 0:b74591d5ab33 43 #if !defined(MBEDTLS_XTEA_ALT)
be_bryan 0:b74591d5ab33 44
be_bryan 0:b74591d5ab33 45 /* Implementation that should never be optimized out by the compiler */
be_bryan 0:b74591d5ab33 46 static void mbedtls_zeroize( void *v, size_t n ) {
be_bryan 0:b74591d5ab33 47 volatile unsigned char *p = v; while( n-- ) *p++ = 0;
be_bryan 0:b74591d5ab33 48 }
be_bryan 0:b74591d5ab33 49
be_bryan 0:b74591d5ab33 50 /*
be_bryan 0:b74591d5ab33 51 * 32-bit integer manipulation macros (big endian)
be_bryan 0:b74591d5ab33 52 */
be_bryan 0:b74591d5ab33 53 #ifndef GET_UINT32_BE
be_bryan 0:b74591d5ab33 54 #define GET_UINT32_BE(n,b,i) \
be_bryan 0:b74591d5ab33 55 { \
be_bryan 0:b74591d5ab33 56 (n) = ( (uint32_t) (b)[(i) ] << 24 ) \
be_bryan 0:b74591d5ab33 57 | ( (uint32_t) (b)[(i) + 1] << 16 ) \
be_bryan 0:b74591d5ab33 58 | ( (uint32_t) (b)[(i) + 2] << 8 ) \
be_bryan 0:b74591d5ab33 59 | ( (uint32_t) (b)[(i) + 3] ); \
be_bryan 0:b74591d5ab33 60 }
be_bryan 0:b74591d5ab33 61 #endif
be_bryan 0:b74591d5ab33 62
be_bryan 0:b74591d5ab33 63 #ifndef PUT_UINT32_BE
be_bryan 0:b74591d5ab33 64 #define PUT_UINT32_BE(n,b,i) \
be_bryan 0:b74591d5ab33 65 { \
be_bryan 0:b74591d5ab33 66 (b)[(i) ] = (unsigned char) ( (n) >> 24 ); \
be_bryan 0:b74591d5ab33 67 (b)[(i) + 1] = (unsigned char) ( (n) >> 16 ); \
be_bryan 0:b74591d5ab33 68 (b)[(i) + 2] = (unsigned char) ( (n) >> 8 ); \
be_bryan 0:b74591d5ab33 69 (b)[(i) + 3] = (unsigned char) ( (n) ); \
be_bryan 0:b74591d5ab33 70 }
be_bryan 0:b74591d5ab33 71 #endif
be_bryan 0:b74591d5ab33 72
be_bryan 0:b74591d5ab33 73 void mbedtls_xtea_init( mbedtls_xtea_context *ctx )
be_bryan 0:b74591d5ab33 74 {
be_bryan 0:b74591d5ab33 75 memset( ctx, 0, sizeof( mbedtls_xtea_context ) );
be_bryan 0:b74591d5ab33 76 }
be_bryan 0:b74591d5ab33 77
be_bryan 0:b74591d5ab33 78 void mbedtls_xtea_free( mbedtls_xtea_context *ctx )
be_bryan 0:b74591d5ab33 79 {
be_bryan 0:b74591d5ab33 80 if( ctx == NULL )
be_bryan 0:b74591d5ab33 81 return;
be_bryan 0:b74591d5ab33 82
be_bryan 0:b74591d5ab33 83 mbedtls_zeroize( ctx, sizeof( mbedtls_xtea_context ) );
be_bryan 0:b74591d5ab33 84 }
be_bryan 0:b74591d5ab33 85
be_bryan 0:b74591d5ab33 86 /*
be_bryan 0:b74591d5ab33 87 * XTEA key schedule
be_bryan 0:b74591d5ab33 88 */
be_bryan 0:b74591d5ab33 89 void mbedtls_xtea_setup( mbedtls_xtea_context *ctx, const unsigned char key[16] )
be_bryan 0:b74591d5ab33 90 {
be_bryan 0:b74591d5ab33 91 int i;
be_bryan 0:b74591d5ab33 92
be_bryan 0:b74591d5ab33 93 memset( ctx, 0, sizeof(mbedtls_xtea_context) );
be_bryan 0:b74591d5ab33 94
be_bryan 0:b74591d5ab33 95 for( i = 0; i < 4; i++ )
be_bryan 0:b74591d5ab33 96 {
be_bryan 0:b74591d5ab33 97 GET_UINT32_BE( ctx->k[i], key, i << 2 );
be_bryan 0:b74591d5ab33 98 }
be_bryan 0:b74591d5ab33 99 }
be_bryan 0:b74591d5ab33 100
be_bryan 0:b74591d5ab33 101 /*
be_bryan 0:b74591d5ab33 102 * XTEA encrypt function
be_bryan 0:b74591d5ab33 103 */
be_bryan 0:b74591d5ab33 104 int mbedtls_xtea_crypt_ecb( mbedtls_xtea_context *ctx, int mode,
be_bryan 0:b74591d5ab33 105 const unsigned char input[8], unsigned char output[8])
be_bryan 0:b74591d5ab33 106 {
be_bryan 0:b74591d5ab33 107 uint32_t *k, v0, v1, i;
be_bryan 0:b74591d5ab33 108
be_bryan 0:b74591d5ab33 109 k = ctx->k;
be_bryan 0:b74591d5ab33 110
be_bryan 0:b74591d5ab33 111 GET_UINT32_BE( v0, input, 0 );
be_bryan 0:b74591d5ab33 112 GET_UINT32_BE( v1, input, 4 );
be_bryan 0:b74591d5ab33 113
be_bryan 0:b74591d5ab33 114 if( mode == MBEDTLS_XTEA_ENCRYPT )
be_bryan 0:b74591d5ab33 115 {
be_bryan 0:b74591d5ab33 116 uint32_t sum = 0, delta = 0x9E3779B9;
be_bryan 0:b74591d5ab33 117
be_bryan 0:b74591d5ab33 118 for( i = 0; i < 32; i++ )
be_bryan 0:b74591d5ab33 119 {
be_bryan 0:b74591d5ab33 120 v0 += (((v1 << 4) ^ (v1 >> 5)) + v1) ^ (sum + k[sum & 3]);
be_bryan 0:b74591d5ab33 121 sum += delta;
be_bryan 0:b74591d5ab33 122 v1 += (((v0 << 4) ^ (v0 >> 5)) + v0) ^ (sum + k[(sum>>11) & 3]);
be_bryan 0:b74591d5ab33 123 }
be_bryan 0:b74591d5ab33 124 }
be_bryan 0:b74591d5ab33 125 else /* MBEDTLS_XTEA_DECRYPT */
be_bryan 0:b74591d5ab33 126 {
be_bryan 0:b74591d5ab33 127 uint32_t delta = 0x9E3779B9, sum = delta * 32;
be_bryan 0:b74591d5ab33 128
be_bryan 0:b74591d5ab33 129 for( i = 0; i < 32; i++ )
be_bryan 0:b74591d5ab33 130 {
be_bryan 0:b74591d5ab33 131 v1 -= (((v0 << 4) ^ (v0 >> 5)) + v0) ^ (sum + k[(sum>>11) & 3]);
be_bryan 0:b74591d5ab33 132 sum -= delta;
be_bryan 0:b74591d5ab33 133 v0 -= (((v1 << 4) ^ (v1 >> 5)) + v1) ^ (sum + k[sum & 3]);
be_bryan 0:b74591d5ab33 134 }
be_bryan 0:b74591d5ab33 135 }
be_bryan 0:b74591d5ab33 136
be_bryan 0:b74591d5ab33 137 PUT_UINT32_BE( v0, output, 0 );
be_bryan 0:b74591d5ab33 138 PUT_UINT32_BE( v1, output, 4 );
be_bryan 0:b74591d5ab33 139
be_bryan 0:b74591d5ab33 140 return( 0 );
be_bryan 0:b74591d5ab33 141 }
be_bryan 0:b74591d5ab33 142
be_bryan 0:b74591d5ab33 143 #if defined(MBEDTLS_CIPHER_MODE_CBC)
be_bryan 0:b74591d5ab33 144 /*
be_bryan 0:b74591d5ab33 145 * XTEA-CBC buffer encryption/decryption
be_bryan 0:b74591d5ab33 146 */
be_bryan 0:b74591d5ab33 147 int mbedtls_xtea_crypt_cbc( mbedtls_xtea_context *ctx, int mode, size_t length,
be_bryan 0:b74591d5ab33 148 unsigned char iv[8], const unsigned char *input,
be_bryan 0:b74591d5ab33 149 unsigned char *output)
be_bryan 0:b74591d5ab33 150 {
be_bryan 0:b74591d5ab33 151 int i;
be_bryan 0:b74591d5ab33 152 unsigned char temp[8];
be_bryan 0:b74591d5ab33 153
be_bryan 0:b74591d5ab33 154 if( length % 8 )
be_bryan 0:b74591d5ab33 155 return( MBEDTLS_ERR_XTEA_INVALID_INPUT_LENGTH );
be_bryan 0:b74591d5ab33 156
be_bryan 0:b74591d5ab33 157 if( mode == MBEDTLS_XTEA_DECRYPT )
be_bryan 0:b74591d5ab33 158 {
be_bryan 0:b74591d5ab33 159 while( length > 0 )
be_bryan 0:b74591d5ab33 160 {
be_bryan 0:b74591d5ab33 161 memcpy( temp, input, 8 );
be_bryan 0:b74591d5ab33 162 mbedtls_xtea_crypt_ecb( ctx, mode, input, output );
be_bryan 0:b74591d5ab33 163
be_bryan 0:b74591d5ab33 164 for( i = 0; i < 8; i++ )
be_bryan 0:b74591d5ab33 165 output[i] = (unsigned char)( output[i] ^ iv[i] );
be_bryan 0:b74591d5ab33 166
be_bryan 0:b74591d5ab33 167 memcpy( iv, temp, 8 );
be_bryan 0:b74591d5ab33 168
be_bryan 0:b74591d5ab33 169 input += 8;
be_bryan 0:b74591d5ab33 170 output += 8;
be_bryan 0:b74591d5ab33 171 length -= 8;
be_bryan 0:b74591d5ab33 172 }
be_bryan 0:b74591d5ab33 173 }
be_bryan 0:b74591d5ab33 174 else
be_bryan 0:b74591d5ab33 175 {
be_bryan 0:b74591d5ab33 176 while( length > 0 )
be_bryan 0:b74591d5ab33 177 {
be_bryan 0:b74591d5ab33 178 for( i = 0; i < 8; i++ )
be_bryan 0:b74591d5ab33 179 output[i] = (unsigned char)( input[i] ^ iv[i] );
be_bryan 0:b74591d5ab33 180
be_bryan 0:b74591d5ab33 181 mbedtls_xtea_crypt_ecb( ctx, mode, output, output );
be_bryan 0:b74591d5ab33 182 memcpy( iv, output, 8 );
be_bryan 0:b74591d5ab33 183
be_bryan 0:b74591d5ab33 184 input += 8;
be_bryan 0:b74591d5ab33 185 output += 8;
be_bryan 0:b74591d5ab33 186 length -= 8;
be_bryan 0:b74591d5ab33 187 }
be_bryan 0:b74591d5ab33 188 }
be_bryan 0:b74591d5ab33 189
be_bryan 0:b74591d5ab33 190 return( 0 );
be_bryan 0:b74591d5ab33 191 }
be_bryan 0:b74591d5ab33 192 #endif /* MBEDTLS_CIPHER_MODE_CBC */
be_bryan 0:b74591d5ab33 193 #endif /* !MBEDTLS_XTEA_ALT */
be_bryan 0:b74591d5ab33 194
be_bryan 0:b74591d5ab33 195 #if defined(MBEDTLS_SELF_TEST)
be_bryan 0:b74591d5ab33 196
be_bryan 0:b74591d5ab33 197 /*
be_bryan 0:b74591d5ab33 198 * XTEA tests vectors (non-official)
be_bryan 0:b74591d5ab33 199 */
be_bryan 0:b74591d5ab33 200
be_bryan 0:b74591d5ab33 201 static const unsigned char xtea_test_key[6][16] =
be_bryan 0:b74591d5ab33 202 {
be_bryan 0:b74591d5ab33 203 { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b,
be_bryan 0:b74591d5ab33 204 0x0c, 0x0d, 0x0e, 0x0f },
be_bryan 0:b74591d5ab33 205 { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b,
be_bryan 0:b74591d5ab33 206 0x0c, 0x0d, 0x0e, 0x0f },
be_bryan 0:b74591d5ab33 207 { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b,
be_bryan 0:b74591d5ab33 208 0x0c, 0x0d, 0x0e, 0x0f },
be_bryan 0:b74591d5ab33 209 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
be_bryan 0:b74591d5ab33 210 0x00, 0x00, 0x00, 0x00 },
be_bryan 0:b74591d5ab33 211 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
be_bryan 0:b74591d5ab33 212 0x00, 0x00, 0x00, 0x00 },
be_bryan 0:b74591d5ab33 213 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
be_bryan 0:b74591d5ab33 214 0x00, 0x00, 0x00, 0x00 }
be_bryan 0:b74591d5ab33 215 };
be_bryan 0:b74591d5ab33 216
be_bryan 0:b74591d5ab33 217 static const unsigned char xtea_test_pt[6][8] =
be_bryan 0:b74591d5ab33 218 {
be_bryan 0:b74591d5ab33 219 { 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48 },
be_bryan 0:b74591d5ab33 220 { 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41 },
be_bryan 0:b74591d5ab33 221 { 0x5a, 0x5b, 0x6e, 0x27, 0x89, 0x48, 0xd7, 0x7f },
be_bryan 0:b74591d5ab33 222 { 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48 },
be_bryan 0:b74591d5ab33 223 { 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41 },
be_bryan 0:b74591d5ab33 224 { 0x70, 0xe1, 0x22, 0x5d, 0x6e, 0x4e, 0x76, 0x55 }
be_bryan 0:b74591d5ab33 225 };
be_bryan 0:b74591d5ab33 226
be_bryan 0:b74591d5ab33 227 static const unsigned char xtea_test_ct[6][8] =
be_bryan 0:b74591d5ab33 228 {
be_bryan 0:b74591d5ab33 229 { 0x49, 0x7d, 0xf3, 0xd0, 0x72, 0x61, 0x2c, 0xb5 },
be_bryan 0:b74591d5ab33 230 { 0xe7, 0x8f, 0x2d, 0x13, 0x74, 0x43, 0x41, 0xd8 },
be_bryan 0:b74591d5ab33 231 { 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41 },
be_bryan 0:b74591d5ab33 232 { 0xa0, 0x39, 0x05, 0x89, 0xf8, 0xb8, 0xef, 0xa5 },
be_bryan 0:b74591d5ab33 233 { 0xed, 0x23, 0x37, 0x5a, 0x82, 0x1a, 0x8c, 0x2d },
be_bryan 0:b74591d5ab33 234 { 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41, 0x41 }
be_bryan 0:b74591d5ab33 235 };
be_bryan 0:b74591d5ab33 236
be_bryan 0:b74591d5ab33 237 /*
be_bryan 0:b74591d5ab33 238 * Checkup routine
be_bryan 0:b74591d5ab33 239 */
be_bryan 0:b74591d5ab33 240 int mbedtls_xtea_self_test( int verbose )
be_bryan 0:b74591d5ab33 241 {
be_bryan 0:b74591d5ab33 242 int i, ret = 0;
be_bryan 0:b74591d5ab33 243 unsigned char buf[8];
be_bryan 0:b74591d5ab33 244 mbedtls_xtea_context ctx;
be_bryan 0:b74591d5ab33 245
be_bryan 0:b74591d5ab33 246 mbedtls_xtea_init( &ctx );
be_bryan 0:b74591d5ab33 247 for( i = 0; i < 6; i++ )
be_bryan 0:b74591d5ab33 248 {
be_bryan 0:b74591d5ab33 249 if( verbose != 0 )
be_bryan 0:b74591d5ab33 250 mbedtls_printf( " XTEA test #%d: ", i + 1 );
be_bryan 0:b74591d5ab33 251
be_bryan 0:b74591d5ab33 252 memcpy( buf, xtea_test_pt[i], 8 );
be_bryan 0:b74591d5ab33 253
be_bryan 0:b74591d5ab33 254 mbedtls_xtea_setup( &ctx, xtea_test_key[i] );
be_bryan 0:b74591d5ab33 255 mbedtls_xtea_crypt_ecb( &ctx, MBEDTLS_XTEA_ENCRYPT, buf, buf );
be_bryan 0:b74591d5ab33 256
be_bryan 0:b74591d5ab33 257 if( memcmp( buf, xtea_test_ct[i], 8 ) != 0 )
be_bryan 0:b74591d5ab33 258 {
be_bryan 0:b74591d5ab33 259 if( verbose != 0 )
be_bryan 0:b74591d5ab33 260 mbedtls_printf( "failed\n" );
be_bryan 0:b74591d5ab33 261
be_bryan 0:b74591d5ab33 262 ret = 1;
be_bryan 0:b74591d5ab33 263 goto exit;
be_bryan 0:b74591d5ab33 264 }
be_bryan 0:b74591d5ab33 265
be_bryan 0:b74591d5ab33 266 if( verbose != 0 )
be_bryan 0:b74591d5ab33 267 mbedtls_printf( "passed\n" );
be_bryan 0:b74591d5ab33 268 }
be_bryan 0:b74591d5ab33 269
be_bryan 0:b74591d5ab33 270 if( verbose != 0 )
be_bryan 0:b74591d5ab33 271 mbedtls_printf( "\n" );
be_bryan 0:b74591d5ab33 272
be_bryan 0:b74591d5ab33 273 exit:
be_bryan 0:b74591d5ab33 274 mbedtls_xtea_free( &ctx );
be_bryan 0:b74591d5ab33 275
be_bryan 0:b74591d5ab33 276 return( ret );
be_bryan 0:b74591d5ab33 277 }
be_bryan 0:b74591d5ab33 278
be_bryan 0:b74591d5ab33 279 #endif /* MBEDTLS_SELF_TEST */
be_bryan 0:b74591d5ab33 280
be_bryan 0:b74591d5ab33 281 #endif /* MBEDTLS_XTEA_C */