takashi kadono / Mbed OS Nucleo446_SSD1331

Dependencies:   ssd1331

Committer:
kadonotakashi
Date:
Wed Oct 10 00:33:53 2018 +0000
Revision:
0:8fdf9a60065b
how to make mbed librry

Who changed what in which revision?

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