erkin yucel / mbed-os

mbed os with nrf51 internal bandgap enabled to read battery level

Dependents:   BLE_file_test BLE_Blink ExternalEncoder

features/mbedtls/src/xtea.c@0:f269e3021894, 2016-10-23 (annotated)

Committer:
elessair
Date:
Sun Oct 23 15:10:02 2016 +0000
Revision:
0:f269e3021894
Initial commit

Who changed what in which revision?

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