Kev Mann / mbed-dev-OS5_10_4

RTC auf true

features/mbedtls/src/padlock.c@2:7aab896b1a3b, 2019-03-13 (annotated)

Committer:
kevman
Date:
Wed Mar 13 11:03:24 2019 +0000
Revision:
2:7aab896b1a3b
Parent:
0:38ceb79fef03 
2019-03-13

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kevman 0:38ceb79fef03 1 /*
kevman 0:38ceb79fef03 2 * VIA PadLock support functions
kevman 0:38ceb79fef03 3 *
kevman 0:38ceb79fef03 4 * Copyright (C) 2006-2015, ARM Limited, All Rights Reserved
kevman 0:38ceb79fef03 5 * SPDX-License-Identifier: Apache-2.0
kevman 0:38ceb79fef03 6 *
kevman 0:38ceb79fef03 7 * Licensed under the Apache License, Version 2.0 (the "License"); you may
kevman 0:38ceb79fef03 8 * not use this file except in compliance with the License.
kevman 0:38ceb79fef03 9 * You may obtain a copy of the License at
kevman 0:38ceb79fef03 10 *
kevman 0:38ceb79fef03 11 * http://www.apache.org/licenses/LICENSE-2.0
kevman 0:38ceb79fef03 12 *
kevman 0:38ceb79fef03 13 * Unless required by applicable law or agreed to in writing, software
kevman 0:38ceb79fef03 14 * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
kevman 0:38ceb79fef03 15 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kevman 0:38ceb79fef03 16 * See the License for the specific language governing permissions and
kevman 0:38ceb79fef03 17 * limitations under the License.
kevman 0:38ceb79fef03 18 *
kevman 0:38ceb79fef03 19 * This file is part of mbed TLS (https://tls.mbed.org)
kevman 0:38ceb79fef03 20 */
kevman 0:38ceb79fef03 21 /*
kevman 0:38ceb79fef03 22 * This implementation is based on the VIA PadLock Programming Guide:
kevman 0:38ceb79fef03 23 *
kevman 0:38ceb79fef03 24 * http://www.via.com.tw/en/downloads/whitepapers/initiatives/padlock/
kevman 0:38ceb79fef03 25 * programming_guide.pdf
kevman 0:38ceb79fef03 26 */
kevman 0:38ceb79fef03 27
kevman 0:38ceb79fef03 28 #if !defined(MBEDTLS_CONFIG_FILE)
kevman 0:38ceb79fef03 29 #include "mbedtls/config.h"
kevman 0:38ceb79fef03 30 #else
kevman 0:38ceb79fef03 31 #include MBEDTLS_CONFIG_FILE
kevman 0:38ceb79fef03 32 #endif
kevman 0:38ceb79fef03 33
kevman 0:38ceb79fef03 34 #if defined(MBEDTLS_PADLOCK_C)
kevman 0:38ceb79fef03 35
kevman 0:38ceb79fef03 36 #include "mbedtls/padlock.h"
kevman 0:38ceb79fef03 37
kevman 0:38ceb79fef03 38 #include <string.h>
kevman 0:38ceb79fef03 39
kevman 0:38ceb79fef03 40 #ifndef asm
kevman 0:38ceb79fef03 41 #define asm __asm
kevman 0:38ceb79fef03 42 #endif
kevman 0:38ceb79fef03 43
kevman 0:38ceb79fef03 44 #if defined(MBEDTLS_HAVE_X86)
kevman 0:38ceb79fef03 45
kevman 0:38ceb79fef03 46 /*
kevman 0:38ceb79fef03 47 * PadLock detection routine
kevman 0:38ceb79fef03 48 */
kevman 0:38ceb79fef03 49 int mbedtls_padlock_has_support( int feature )
kevman 0:38ceb79fef03 50 {
kevman 0:38ceb79fef03 51 static int flags = -1;
kevman 0:38ceb79fef03 52 int ebx = 0, edx = 0;
kevman 0:38ceb79fef03 53
kevman 0:38ceb79fef03 54 if( flags == -1 )
kevman 0:38ceb79fef03 55 {
kevman 0:38ceb79fef03 56 asm( "movl %%ebx, %0 \n\t"
kevman 0:38ceb79fef03 57 "movl $0xC0000000, %%eax \n\t"
kevman 0:38ceb79fef03 58 "cpuid \n\t"
kevman 0:38ceb79fef03 59 "cmpl $0xC0000001, %%eax \n\t"
kevman 0:38ceb79fef03 60 "movl $0, %%edx \n\t"
kevman 0:38ceb79fef03 61 "jb unsupported \n\t"
kevman 0:38ceb79fef03 62 "movl $0xC0000001, %%eax \n\t"
kevman 0:38ceb79fef03 63 "cpuid \n\t"
kevman 0:38ceb79fef03 64 "unsupported: \n\t"
kevman 0:38ceb79fef03 65 "movl %%edx, %1 \n\t"
kevman 0:38ceb79fef03 66 "movl %2, %%ebx \n\t"
kevman 0:38ceb79fef03 67 : "=m" (ebx), "=m" (edx)
kevman 0:38ceb79fef03 68 : "m" (ebx)
kevman 0:38ceb79fef03 69 : "eax", "ecx", "edx" );
kevman 0:38ceb79fef03 70
kevman 0:38ceb79fef03 71 flags = edx;
kevman 0:38ceb79fef03 72 }
kevman 0:38ceb79fef03 73
kevman 0:38ceb79fef03 74 return( flags & feature );
kevman 0:38ceb79fef03 75 }
kevman 0:38ceb79fef03 76
kevman 0:38ceb79fef03 77 /*
kevman 0:38ceb79fef03 78 * PadLock AES-ECB block en(de)cryption
kevman 0:38ceb79fef03 79 */
kevman 0:38ceb79fef03 80 int mbedtls_padlock_xcryptecb( mbedtls_aes_context *ctx,
kevman 0:38ceb79fef03 81 int mode,
kevman 0:38ceb79fef03 82 const unsigned char input[16],
kevman 0:38ceb79fef03 83 unsigned char output[16] )
kevman 0:38ceb79fef03 84 {
kevman 0:38ceb79fef03 85 int ebx = 0;
kevman 0:38ceb79fef03 86 uint32_t *rk;
kevman 0:38ceb79fef03 87 uint32_t *blk;
kevman 0:38ceb79fef03 88 uint32_t *ctrl;
kevman 0:38ceb79fef03 89 unsigned char buf[256];
kevman 0:38ceb79fef03 90
kevman 0:38ceb79fef03 91 rk = ctx->rk;
kevman 0:38ceb79fef03 92 blk = MBEDTLS_PADLOCK_ALIGN16( buf );
kevman 0:38ceb79fef03 93 memcpy( blk, input, 16 );
kevman 0:38ceb79fef03 94
kevman 0:38ceb79fef03 95 ctrl = blk + 4;
kevman 0:38ceb79fef03 96 *ctrl = 0x80 | ctx->nr | ( ( ctx->nr + ( mode^1 ) - 10 ) << 9 );
kevman 0:38ceb79fef03 97
kevman 0:38ceb79fef03 98 asm( "pushfl \n\t"
kevman 0:38ceb79fef03 99 "popfl \n\t"
kevman 0:38ceb79fef03 100 "movl %%ebx, %0 \n\t"
kevman 0:38ceb79fef03 101 "movl $1, %%ecx \n\t"
kevman 0:38ceb79fef03 102 "movl %2, %%edx \n\t"
kevman 0:38ceb79fef03 103 "movl %3, %%ebx \n\t"
kevman 0:38ceb79fef03 104 "movl %4, %%esi \n\t"
kevman 0:38ceb79fef03 105 "movl %4, %%edi \n\t"
kevman 0:38ceb79fef03 106 ".byte 0xf3,0x0f,0xa7,0xc8 \n\t"
kevman 0:38ceb79fef03 107 "movl %1, %%ebx \n\t"
kevman 0:38ceb79fef03 108 : "=m" (ebx)
kevman 0:38ceb79fef03 109 : "m" (ebx), "m" (ctrl), "m" (rk), "m" (blk)
kevman 0:38ceb79fef03 110 : "memory", "ecx", "edx", "esi", "edi" );
kevman 0:38ceb79fef03 111
kevman 0:38ceb79fef03 112 memcpy( output, blk, 16 );
kevman 0:38ceb79fef03 113
kevman 0:38ceb79fef03 114 return( 0 );
kevman 0:38ceb79fef03 115 }
kevman 0:38ceb79fef03 116
kevman 0:38ceb79fef03 117 /*
kevman 0:38ceb79fef03 118 * PadLock AES-CBC buffer en(de)cryption
kevman 0:38ceb79fef03 119 */
kevman 0:38ceb79fef03 120 int mbedtls_padlock_xcryptcbc( mbedtls_aes_context *ctx,
kevman 0:38ceb79fef03 121 int mode,
kevman 0:38ceb79fef03 122 size_t length,
kevman 0:38ceb79fef03 123 unsigned char iv[16],
kevman 0:38ceb79fef03 124 const unsigned char *input,
kevman 0:38ceb79fef03 125 unsigned char *output )
kevman 0:38ceb79fef03 126 {
kevman 0:38ceb79fef03 127 int ebx = 0;
kevman 0:38ceb79fef03 128 size_t count;
kevman 0:38ceb79fef03 129 uint32_t *rk;
kevman 0:38ceb79fef03 130 uint32_t *iw;
kevman 0:38ceb79fef03 131 uint32_t *ctrl;
kevman 0:38ceb79fef03 132 unsigned char buf[256];
kevman 0:38ceb79fef03 133
kevman 0:38ceb79fef03 134 if( ( (long) input & 15 ) != 0 ||
kevman 0:38ceb79fef03 135 ( (long) output & 15 ) != 0 )
kevman 0:38ceb79fef03 136 return( MBEDTLS_ERR_PADLOCK_DATA_MISALIGNED );
kevman 0:38ceb79fef03 137
kevman 0:38ceb79fef03 138 rk = ctx->rk;
kevman 0:38ceb79fef03 139 iw = MBEDTLS_PADLOCK_ALIGN16( buf );
kevman 0:38ceb79fef03 140 memcpy( iw, iv, 16 );
kevman 0:38ceb79fef03 141
kevman 0:38ceb79fef03 142 ctrl = iw + 4;
kevman 0:38ceb79fef03 143 *ctrl = 0x80 | ctx->nr | ( ( ctx->nr + ( mode ^ 1 ) - 10 ) << 9 );
kevman 0:38ceb79fef03 144
kevman 0:38ceb79fef03 145 count = ( length + 15 ) >> 4;
kevman 0:38ceb79fef03 146
kevman 0:38ceb79fef03 147 asm( "pushfl \n\t"
kevman 0:38ceb79fef03 148 "popfl \n\t"
kevman 0:38ceb79fef03 149 "movl %%ebx, %0 \n\t"
kevman 0:38ceb79fef03 150 "movl %2, %%ecx \n\t"
kevman 0:38ceb79fef03 151 "movl %3, %%edx \n\t"
kevman 0:38ceb79fef03 152 "movl %4, %%ebx \n\t"
kevman 0:38ceb79fef03 153 "movl %5, %%esi \n\t"
kevman 0:38ceb79fef03 154 "movl %6, %%edi \n\t"
kevman 0:38ceb79fef03 155 "movl %7, %%eax \n\t"
kevman 0:38ceb79fef03 156 ".byte 0xf3,0x0f,0xa7,0xd0 \n\t"
kevman 0:38ceb79fef03 157 "movl %1, %%ebx \n\t"
kevman 0:38ceb79fef03 158 : "=m" (ebx)
kevman 0:38ceb79fef03 159 : "m" (ebx), "m" (count), "m" (ctrl),
kevman 0:38ceb79fef03 160 "m" (rk), "m" (input), "m" (output), "m" (iw)
kevman 0:38ceb79fef03 161 : "memory", "eax", "ecx", "edx", "esi", "edi" );
kevman 0:38ceb79fef03 162
kevman 0:38ceb79fef03 163 memcpy( iv, iw, 16 );
kevman 0:38ceb79fef03 164
kevman 0:38ceb79fef03 165 return( 0 );
kevman 0:38ceb79fef03 166 }
kevman 0:38ceb79fef03 167
kevman 0:38ceb79fef03 168 #endif /* MBEDTLS_HAVE_X86 */
kevman 0:38ceb79fef03 169
kevman 0:38ceb79fef03 170 #endif /* MBEDTLS_PADLOCK_C */