EL4121 Embedded System / mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

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