Austin Blackstone / Mbed 2 deprecated client-lwip-lightswitch-demo-expanded

mbed client lightswitch demo

Dependencies:   mbed Socket lwip-eth lwip-sys lwip

Fork of mbed-client-classic-example-lwip by Austin Blackstone

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