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/padlock.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 * VIA PadLock support functions
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 * This implementation is based on the VIA PadLock Programming Guide:
elessair 0:f269e3021894 23 *
elessair 0:f269e3021894 24 * http://www.via.com.tw/en/downloads/whitepapers/initiatives/padlock/
elessair 0:f269e3021894 25 * programming_guide.pdf
elessair 0:f269e3021894 26 */
elessair 0:f269e3021894 27
elessair 0:f269e3021894 28 #if !defined(MBEDTLS_CONFIG_FILE)
elessair 0:f269e3021894 29 #include "mbedtls/config.h"
elessair 0:f269e3021894 30 #else
elessair 0:f269e3021894 31 #include MBEDTLS_CONFIG_FILE
elessair 0:f269e3021894 32 #endif
elessair 0:f269e3021894 33
elessair 0:f269e3021894 34 #if defined(MBEDTLS_PADLOCK_C)
elessair 0:f269e3021894 35
elessair 0:f269e3021894 36 #include "mbedtls/padlock.h"
elessair 0:f269e3021894 37
elessair 0:f269e3021894 38 #include <string.h>
elessair 0:f269e3021894 39
elessair 0:f269e3021894 40 #ifndef asm
elessair 0:f269e3021894 41 #define asm __asm
elessair 0:f269e3021894 42 #endif
elessair 0:f269e3021894 43
elessair 0:f269e3021894 44 #if defined(MBEDTLS_HAVE_X86)
elessair 0:f269e3021894 45
elessair 0:f269e3021894 46 /*
elessair 0:f269e3021894 47 * PadLock detection routine
elessair 0:f269e3021894 48 */
elessair 0:f269e3021894 49 int mbedtls_padlock_has_support( int feature )
elessair 0:f269e3021894 50 {
elessair 0:f269e3021894 51 static int flags = -1;
elessair 0:f269e3021894 52 int ebx = 0, edx = 0;
elessair 0:f269e3021894 53
elessair 0:f269e3021894 54 if( flags == -1 )
elessair 0:f269e3021894 55 {
elessair 0:f269e3021894 56 asm( "movl %%ebx, %0 \n\t"
elessair 0:f269e3021894 57 "movl $0xC0000000, %%eax \n\t"
elessair 0:f269e3021894 58 "cpuid \n\t"
elessair 0:f269e3021894 59 "cmpl $0xC0000001, %%eax \n\t"
elessair 0:f269e3021894 60 "movl $0, %%edx \n\t"
elessair 0:f269e3021894 61 "jb unsupported \n\t"
elessair 0:f269e3021894 62 "movl $0xC0000001, %%eax \n\t"
elessair 0:f269e3021894 63 "cpuid \n\t"
elessair 0:f269e3021894 64 "unsupported: \n\t"
elessair 0:f269e3021894 65 "movl %%edx, %1 \n\t"
elessair 0:f269e3021894 66 "movl %2, %%ebx \n\t"
elessair 0:f269e3021894 67 : "=m" (ebx), "=m" (edx)
elessair 0:f269e3021894 68 : "m" (ebx)
elessair 0:f269e3021894 69 : "eax", "ecx", "edx" );
elessair 0:f269e3021894 70
elessair 0:f269e3021894 71 flags = edx;
elessair 0:f269e3021894 72 }
elessair 0:f269e3021894 73
elessair 0:f269e3021894 74 return( flags & feature );
elessair 0:f269e3021894 75 }
elessair 0:f269e3021894 76
elessair 0:f269e3021894 77 /*
elessair 0:f269e3021894 78 * PadLock AES-ECB block en(de)cryption
elessair 0:f269e3021894 79 */
elessair 0:f269e3021894 80 int mbedtls_padlock_xcryptecb( mbedtls_aes_context *ctx,
elessair 0:f269e3021894 81 int mode,
elessair 0:f269e3021894 82 const unsigned char input[16],
elessair 0:f269e3021894 83 unsigned char output[16] )
elessair 0:f269e3021894 84 {
elessair 0:f269e3021894 85 int ebx = 0;
elessair 0:f269e3021894 86 uint32_t *rk;
elessair 0:f269e3021894 87 uint32_t *blk;
elessair 0:f269e3021894 88 uint32_t *ctrl;
elessair 0:f269e3021894 89 unsigned char buf[256];
elessair 0:f269e3021894 90
elessair 0:f269e3021894 91 rk = ctx->rk;
elessair 0:f269e3021894 92 blk = MBEDTLS_PADLOCK_ALIGN16( buf );
elessair 0:f269e3021894 93 memcpy( blk, input, 16 );
elessair 0:f269e3021894 94
elessair 0:f269e3021894 95 ctrl = blk + 4;
elessair 0:f269e3021894 96 *ctrl = 0x80 | ctx->nr | ( ( ctx->nr + ( mode^1 ) - 10 ) << 9 );
elessair 0:f269e3021894 97
elessair 0:f269e3021894 98 asm( "pushfl \n\t"
elessair 0:f269e3021894 99 "popfl \n\t"
elessair 0:f269e3021894 100 "movl %%ebx, %0 \n\t"
elessair 0:f269e3021894 101 "movl $1, %%ecx \n\t"
elessair 0:f269e3021894 102 "movl %2, %%edx \n\t"
elessair 0:f269e3021894 103 "movl %3, %%ebx \n\t"
elessair 0:f269e3021894 104 "movl %4, %%esi \n\t"
elessair 0:f269e3021894 105 "movl %4, %%edi \n\t"
elessair 0:f269e3021894 106 ".byte 0xf3,0x0f,0xa7,0xc8 \n\t"
elessair 0:f269e3021894 107 "movl %1, %%ebx \n\t"
elessair 0:f269e3021894 108 : "=m" (ebx)
elessair 0:f269e3021894 109 : "m" (ebx), "m" (ctrl), "m" (rk), "m" (blk)
elessair 0:f269e3021894 110 : "memory", "ecx", "edx", "esi", "edi" );
elessair 0:f269e3021894 111
elessair 0:f269e3021894 112 memcpy( output, blk, 16 );
elessair 0:f269e3021894 113
elessair 0:f269e3021894 114 return( 0 );
elessair 0:f269e3021894 115 }
elessair 0:f269e3021894 116
elessair 0:f269e3021894 117 /*
elessair 0:f269e3021894 118 * PadLock AES-CBC buffer en(de)cryption
elessair 0:f269e3021894 119 */
elessair 0:f269e3021894 120 int mbedtls_padlock_xcryptcbc( mbedtls_aes_context *ctx,
elessair 0:f269e3021894 121 int mode,
elessair 0:f269e3021894 122 size_t length,
elessair 0:f269e3021894 123 unsigned char iv[16],
elessair 0:f269e3021894 124 const unsigned char *input,
elessair 0:f269e3021894 125 unsigned char *output )
elessair 0:f269e3021894 126 {
elessair 0:f269e3021894 127 int ebx = 0;
elessair 0:f269e3021894 128 size_t count;
elessair 0:f269e3021894 129 uint32_t *rk;
elessair 0:f269e3021894 130 uint32_t *iw;
elessair 0:f269e3021894 131 uint32_t *ctrl;
elessair 0:f269e3021894 132 unsigned char buf[256];
elessair 0:f269e3021894 133
elessair 0:f269e3021894 134 if( ( (long) input & 15 ) != 0 ||
elessair 0:f269e3021894 135 ( (long) output & 15 ) != 0 )
elessair 0:f269e3021894 136 return( MBEDTLS_ERR_PADLOCK_DATA_MISALIGNED );
elessair 0:f269e3021894 137
elessair 0:f269e3021894 138 rk = ctx->rk;
elessair 0:f269e3021894 139 iw = MBEDTLS_PADLOCK_ALIGN16( buf );
elessair 0:f269e3021894 140 memcpy( iw, iv, 16 );
elessair 0:f269e3021894 141
elessair 0:f269e3021894 142 ctrl = iw + 4;
elessair 0:f269e3021894 143 *ctrl = 0x80 | ctx->nr | ( ( ctx->nr + ( mode ^ 1 ) - 10 ) << 9 );
elessair 0:f269e3021894 144
elessair 0:f269e3021894 145 count = ( length + 15 ) >> 4;
elessair 0:f269e3021894 146
elessair 0:f269e3021894 147 asm( "pushfl \n\t"
elessair 0:f269e3021894 148 "popfl \n\t"
elessair 0:f269e3021894 149 "movl %%ebx, %0 \n\t"
elessair 0:f269e3021894 150 "movl %2, %%ecx \n\t"
elessair 0:f269e3021894 151 "movl %3, %%edx \n\t"
elessair 0:f269e3021894 152 "movl %4, %%ebx \n\t"
elessair 0:f269e3021894 153 "movl %5, %%esi \n\t"
elessair 0:f269e3021894 154 "movl %6, %%edi \n\t"
elessair 0:f269e3021894 155 "movl %7, %%eax \n\t"
elessair 0:f269e3021894 156 ".byte 0xf3,0x0f,0xa7,0xd0 \n\t"
elessair 0:f269e3021894 157 "movl %1, %%ebx \n\t"
elessair 0:f269e3021894 158 : "=m" (ebx)
elessair 0:f269e3021894 159 : "m" (ebx), "m" (count), "m" (ctrl),
elessair 0:f269e3021894 160 "m" (rk), "m" (input), "m" (output), "m" (iw)
elessair 0:f269e3021894 161 : "memory", "eax", "ecx", "edx", "esi", "edi" );
elessair 0:f269e3021894 162
elessair 0:f269e3021894 163 memcpy( iv, iw, 16 );
elessair 0:f269e3021894 164
elessair 0:f269e3021894 165 return( 0 );
elessair 0:f269e3021894 166 }
elessair 0:f269e3021894 167
elessair 0:f269e3021894 168 #endif /* MBEDTLS_HAVE_X86 */
elessair 0:f269e3021894 169
elessair 0:f269e3021894 170 #endif /* MBEDTLS_PADLOCK_C */