mbed os with nrf51 internal bandgap enabled to read battery level

Dependents:   BLE_file_test BLE_Blink ExternalEncoder

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 * Portable interface to the CPU cycle counter
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 #if !defined(MBEDTLS_CONFIG_FILE)
elessair 0:f269e3021894 23 #include "mbedtls/config.h"
elessair 0:f269e3021894 24 #else
elessair 0:f269e3021894 25 #include MBEDTLS_CONFIG_FILE
elessair 0:f269e3021894 26 #endif
elessair 0:f269e3021894 27
elessair 0:f269e3021894 28 #if defined(MBEDTLS_SELF_TEST) && defined(MBEDTLS_PLATFORM_C)
elessair 0:f269e3021894 29 #include "mbedtls/platform.h"
elessair 0:f269e3021894 30 #else
elessair 0:f269e3021894 31 #include <stdio.h>
elessair 0:f269e3021894 32 #define mbedtls_printf printf
elessair 0:f269e3021894 33 #endif
elessair 0:f269e3021894 34
elessair 0:f269e3021894 35 #if defined(MBEDTLS_TIMING_C)
elessair 0:f269e3021894 36
elessair 0:f269e3021894 37 #include "mbedtls/timing.h"
elessair 0:f269e3021894 38
elessair 0:f269e3021894 39 #if !defined(MBEDTLS_TIMING_ALT)
elessair 0:f269e3021894 40
elessair 0:f269e3021894 41 #if !defined(unix) && !defined(__unix__) && !defined(__unix) && \
elessair 0:f269e3021894 42 !defined(__APPLE__) && !defined(_WIN32)
elessair 0:f269e3021894 43 #error "This module only works on Unix and Windows, see MBEDTLS_TIMING_C in config.h"
elessair 0:f269e3021894 44 #endif
elessair 0:f269e3021894 45
elessair 0:f269e3021894 46 #ifndef asm
elessair 0:f269e3021894 47 #define asm __asm
elessair 0:f269e3021894 48 #endif
elessair 0:f269e3021894 49
elessair 0:f269e3021894 50 #if defined(_WIN32) && !defined(EFIX64) && !defined(EFI32)
elessair 0:f269e3021894 51
elessair 0:f269e3021894 52 #include <windows.h>
elessair 0:f269e3021894 53 #include <winbase.h>
elessair 0:f269e3021894 54
elessair 0:f269e3021894 55 struct _hr_time
elessair 0:f269e3021894 56 {
elessair 0:f269e3021894 57 LARGE_INTEGER start;
elessair 0:f269e3021894 58 };
elessair 0:f269e3021894 59
elessair 0:f269e3021894 60 #else
elessair 0:f269e3021894 61
elessair 0:f269e3021894 62 #include <unistd.h>
elessair 0:f269e3021894 63 #include <sys/types.h>
elessair 0:f269e3021894 64 #include <sys/time.h>
elessair 0:f269e3021894 65 #include <signal.h>
elessair 0:f269e3021894 66 #include <time.h>
elessair 0:f269e3021894 67
elessair 0:f269e3021894 68 struct _hr_time
elessair 0:f269e3021894 69 {
elessair 0:f269e3021894 70 struct timeval start;
elessair 0:f269e3021894 71 };
elessair 0:f269e3021894 72
elessair 0:f269e3021894 73 #endif /* _WIN32 && !EFIX64 && !EFI32 */
elessair 0:f269e3021894 74
elessair 0:f269e3021894 75 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 76 ( defined(_MSC_VER) && defined(_M_IX86) ) || defined(__WATCOMC__)
elessair 0:f269e3021894 77
elessair 0:f269e3021894 78 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 79
elessair 0:f269e3021894 80 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 81 {
elessair 0:f269e3021894 82 unsigned long tsc;
elessair 0:f269e3021894 83 __asm rdtsc
elessair 0:f269e3021894 84 __asm mov [tsc], eax
elessair 0:f269e3021894 85 return( tsc );
elessair 0:f269e3021894 86 }
elessair 0:f269e3021894 87 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 88 ( _MSC_VER && _M_IX86 ) || __WATCOMC__ */
elessair 0:f269e3021894 89
elessair 0:f269e3021894 90 /* some versions of mingw-64 have 32-bit longs even on x84_64 */
elessair 0:f269e3021894 91 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 92 defined(__GNUC__) && ( defined(__i386__) || ( \
elessair 0:f269e3021894 93 ( defined(__amd64__) || defined( __x86_64__) ) && __SIZEOF_LONG__ == 4 ) )
elessair 0:f269e3021894 94
elessair 0:f269e3021894 95 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 96
elessair 0:f269e3021894 97 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 98 {
elessair 0:f269e3021894 99 unsigned long lo, hi;
elessair 0:f269e3021894 100 asm volatile( "rdtsc" : "=a" (lo), "=d" (hi) );
elessair 0:f269e3021894 101 return( lo );
elessair 0:f269e3021894 102 }
elessair 0:f269e3021894 103 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 104 __GNUC__ && __i386__ */
elessair 0:f269e3021894 105
elessair 0:f269e3021894 106 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 107 defined(__GNUC__) && ( defined(__amd64__) || defined(__x86_64__) )
elessair 0:f269e3021894 108
elessair 0:f269e3021894 109 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 110
elessair 0:f269e3021894 111 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 112 {
elessair 0:f269e3021894 113 unsigned long lo, hi;
elessair 0:f269e3021894 114 asm volatile( "rdtsc" : "=a" (lo), "=d" (hi) );
elessair 0:f269e3021894 115 return( lo | ( hi << 32 ) );
elessair 0:f269e3021894 116 }
elessair 0:f269e3021894 117 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 118 __GNUC__ && ( __amd64__ || __x86_64__ ) */
elessair 0:f269e3021894 119
elessair 0:f269e3021894 120 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 121 defined(__GNUC__) && ( defined(__powerpc__) || defined(__ppc__) )
elessair 0:f269e3021894 122
elessair 0:f269e3021894 123 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 124
elessair 0:f269e3021894 125 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 126 {
elessair 0:f269e3021894 127 unsigned long tbl, tbu0, tbu1;
elessair 0:f269e3021894 128
elessair 0:f269e3021894 129 do
elessair 0:f269e3021894 130 {
elessair 0:f269e3021894 131 asm volatile( "mftbu %0" : "=r" (tbu0) );
elessair 0:f269e3021894 132 asm volatile( "mftb %0" : "=r" (tbl ) );
elessair 0:f269e3021894 133 asm volatile( "mftbu %0" : "=r" (tbu1) );
elessair 0:f269e3021894 134 }
elessair 0:f269e3021894 135 while( tbu0 != tbu1 );
elessair 0:f269e3021894 136
elessair 0:f269e3021894 137 return( tbl );
elessair 0:f269e3021894 138 }
elessair 0:f269e3021894 139 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 140 __GNUC__ && ( __powerpc__ || __ppc__ ) */
elessair 0:f269e3021894 141
elessair 0:f269e3021894 142 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 143 defined(__GNUC__) && defined(__sparc64__)
elessair 0:f269e3021894 144
elessair 0:f269e3021894 145 #if defined(__OpenBSD__)
elessair 0:f269e3021894 146 #warning OpenBSD does not allow access to tick register using software version instead
elessair 0:f269e3021894 147 #else
elessair 0:f269e3021894 148 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 149
elessair 0:f269e3021894 150 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 151 {
elessair 0:f269e3021894 152 unsigned long tick;
elessair 0:f269e3021894 153 asm volatile( "rdpr %%tick, %0;" : "=&r" (tick) );
elessair 0:f269e3021894 154 return( tick );
elessair 0:f269e3021894 155 }
elessair 0:f269e3021894 156 #endif /* __OpenBSD__ */
elessair 0:f269e3021894 157 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 158 __GNUC__ && __sparc64__ */
elessair 0:f269e3021894 159
elessair 0:f269e3021894 160 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 161 defined(__GNUC__) && defined(__sparc__) && !defined(__sparc64__)
elessair 0:f269e3021894 162
elessair 0:f269e3021894 163 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 164
elessair 0:f269e3021894 165 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 166 {
elessair 0:f269e3021894 167 unsigned long tick;
elessair 0:f269e3021894 168 asm volatile( ".byte 0x83, 0x41, 0x00, 0x00" );
elessair 0:f269e3021894 169 asm volatile( "mov %%g1, %0" : "=r" (tick) );
elessair 0:f269e3021894 170 return( tick );
elessair 0:f269e3021894 171 }
elessair 0:f269e3021894 172 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 173 __GNUC__ && __sparc__ && !__sparc64__ */
elessair 0:f269e3021894 174
elessair 0:f269e3021894 175 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 176 defined(__GNUC__) && defined(__alpha__)
elessair 0:f269e3021894 177
elessair 0:f269e3021894 178 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 179
elessair 0:f269e3021894 180 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 181 {
elessair 0:f269e3021894 182 unsigned long cc;
elessair 0:f269e3021894 183 asm volatile( "rpcc %0" : "=r" (cc) );
elessair 0:f269e3021894 184 return( cc & 0xFFFFFFFF );
elessair 0:f269e3021894 185 }
elessair 0:f269e3021894 186 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 187 __GNUC__ && __alpha__ */
elessair 0:f269e3021894 188
elessair 0:f269e3021894 189 #if !defined(HAVE_HARDCLOCK) && defined(MBEDTLS_HAVE_ASM) && \
elessair 0:f269e3021894 190 defined(__GNUC__) && defined(__ia64__)
elessair 0:f269e3021894 191
elessair 0:f269e3021894 192 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 193
elessair 0:f269e3021894 194 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 195 {
elessair 0:f269e3021894 196 unsigned long itc;
elessair 0:f269e3021894 197 asm volatile( "mov %0 = ar.itc" : "=r" (itc) );
elessair 0:f269e3021894 198 return( itc );
elessair 0:f269e3021894 199 }
elessair 0:f269e3021894 200 #endif /* !HAVE_HARDCLOCK && MBEDTLS_HAVE_ASM &&
elessair 0:f269e3021894 201 __GNUC__ && __ia64__ */
elessair 0:f269e3021894 202
elessair 0:f269e3021894 203 #if !defined(HAVE_HARDCLOCK) && defined(_MSC_VER) && \
elessair 0:f269e3021894 204 !defined(EFIX64) && !defined(EFI32)
elessair 0:f269e3021894 205
elessair 0:f269e3021894 206 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 207
elessair 0:f269e3021894 208 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 209 {
elessair 0:f269e3021894 210 LARGE_INTEGER offset;
elessair 0:f269e3021894 211
elessair 0:f269e3021894 212 QueryPerformanceCounter( &offset );
elessair 0:f269e3021894 213
elessair 0:f269e3021894 214 return( (unsigned long)( offset.QuadPart ) );
elessair 0:f269e3021894 215 }
elessair 0:f269e3021894 216 #endif /* !HAVE_HARDCLOCK && _MSC_VER && !EFIX64 && !EFI32 */
elessair 0:f269e3021894 217
elessair 0:f269e3021894 218 #if !defined(HAVE_HARDCLOCK)
elessair 0:f269e3021894 219
elessair 0:f269e3021894 220 #define HAVE_HARDCLOCK
elessair 0:f269e3021894 221
elessair 0:f269e3021894 222 static int hardclock_init = 0;
elessair 0:f269e3021894 223 static struct timeval tv_init;
elessair 0:f269e3021894 224
elessair 0:f269e3021894 225 unsigned long mbedtls_timing_hardclock( void )
elessair 0:f269e3021894 226 {
elessair 0:f269e3021894 227 struct timeval tv_cur;
elessair 0:f269e3021894 228
elessair 0:f269e3021894 229 if( hardclock_init == 0 )
elessair 0:f269e3021894 230 {
elessair 0:f269e3021894 231 gettimeofday( &tv_init, NULL );
elessair 0:f269e3021894 232 hardclock_init = 1;
elessair 0:f269e3021894 233 }
elessair 0:f269e3021894 234
elessair 0:f269e3021894 235 gettimeofday( &tv_cur, NULL );
elessair 0:f269e3021894 236 return( ( tv_cur.tv_sec - tv_init.tv_sec ) * 1000000
elessair 0:f269e3021894 237 + ( tv_cur.tv_usec - tv_init.tv_usec ) );
elessair 0:f269e3021894 238 }
elessair 0:f269e3021894 239 #endif /* !HAVE_HARDCLOCK */
elessair 0:f269e3021894 240
elessair 0:f269e3021894 241 volatile int mbedtls_timing_alarmed = 0;
elessair 0:f269e3021894 242
elessair 0:f269e3021894 243 #if defined(_WIN32) && !defined(EFIX64) && !defined(EFI32)
elessair 0:f269e3021894 244
elessair 0:f269e3021894 245 unsigned long mbedtls_timing_get_timer( struct mbedtls_timing_hr_time *val, int reset )
elessair 0:f269e3021894 246 {
elessair 0:f269e3021894 247 unsigned long delta;
elessair 0:f269e3021894 248 LARGE_INTEGER offset, hfreq;
elessair 0:f269e3021894 249 struct _hr_time *t = (struct _hr_time *) val;
elessair 0:f269e3021894 250
elessair 0:f269e3021894 251 QueryPerformanceCounter( &offset );
elessair 0:f269e3021894 252 QueryPerformanceFrequency( &hfreq );
elessair 0:f269e3021894 253
elessair 0:f269e3021894 254 delta = (unsigned long)( ( 1000 *
elessair 0:f269e3021894 255 ( offset.QuadPart - t->start.QuadPart ) ) /
elessair 0:f269e3021894 256 hfreq.QuadPart );
elessair 0:f269e3021894 257
elessair 0:f269e3021894 258 if( reset )
elessair 0:f269e3021894 259 QueryPerformanceCounter( &t->start );
elessair 0:f269e3021894 260
elessair 0:f269e3021894 261 return( delta );
elessair 0:f269e3021894 262 }
elessair 0:f269e3021894 263
elessair 0:f269e3021894 264 /* It's OK to use a global because alarm() is supposed to be global anyway */
elessair 0:f269e3021894 265 static DWORD alarmMs;
elessair 0:f269e3021894 266
elessair 0:f269e3021894 267 static DWORD WINAPI TimerProc( LPVOID TimerContext )
elessair 0:f269e3021894 268 {
elessair 0:f269e3021894 269 ((void) TimerContext);
elessair 0:f269e3021894 270 Sleep( alarmMs );
elessair 0:f269e3021894 271 mbedtls_timing_alarmed = 1;
elessair 0:f269e3021894 272 return( TRUE );
elessair 0:f269e3021894 273 }
elessair 0:f269e3021894 274
elessair 0:f269e3021894 275 void mbedtls_set_alarm( int seconds )
elessair 0:f269e3021894 276 {
elessair 0:f269e3021894 277 DWORD ThreadId;
elessair 0:f269e3021894 278
elessair 0:f269e3021894 279 mbedtls_timing_alarmed = 0;
elessair 0:f269e3021894 280 alarmMs = seconds * 1000;
elessair 0:f269e3021894 281 CloseHandle( CreateThread( NULL, 0, TimerProc, NULL, 0, &ThreadId ) );
elessair 0:f269e3021894 282 }
elessair 0:f269e3021894 283
elessair 0:f269e3021894 284 #else /* _WIN32 && !EFIX64 && !EFI32 */
elessair 0:f269e3021894 285
elessair 0:f269e3021894 286 unsigned long mbedtls_timing_get_timer( struct mbedtls_timing_hr_time *val, int reset )
elessair 0:f269e3021894 287 {
elessair 0:f269e3021894 288 unsigned long delta;
elessair 0:f269e3021894 289 struct timeval offset;
elessair 0:f269e3021894 290 struct _hr_time *t = (struct _hr_time *) val;
elessair 0:f269e3021894 291
elessair 0:f269e3021894 292 gettimeofday( &offset, NULL );
elessair 0:f269e3021894 293
elessair 0:f269e3021894 294 if( reset )
elessair 0:f269e3021894 295 {
elessair 0:f269e3021894 296 t->start.tv_sec = offset.tv_sec;
elessair 0:f269e3021894 297 t->start.tv_usec = offset.tv_usec;
elessair 0:f269e3021894 298 return( 0 );
elessair 0:f269e3021894 299 }
elessair 0:f269e3021894 300
elessair 0:f269e3021894 301 delta = ( offset.tv_sec - t->start.tv_sec ) * 1000
elessair 0:f269e3021894 302 + ( offset.tv_usec - t->start.tv_usec ) / 1000;
elessair 0:f269e3021894 303
elessair 0:f269e3021894 304 return( delta );
elessair 0:f269e3021894 305 }
elessair 0:f269e3021894 306
elessair 0:f269e3021894 307 static void sighandler( int signum )
elessair 0:f269e3021894 308 {
elessair 0:f269e3021894 309 mbedtls_timing_alarmed = 1;
elessair 0:f269e3021894 310 signal( signum, sighandler );
elessair 0:f269e3021894 311 }
elessair 0:f269e3021894 312
elessair 0:f269e3021894 313 void mbedtls_set_alarm( int seconds )
elessair 0:f269e3021894 314 {
elessair 0:f269e3021894 315 mbedtls_timing_alarmed = 0;
elessair 0:f269e3021894 316 signal( SIGALRM, sighandler );
elessair 0:f269e3021894 317 alarm( seconds );
elessair 0:f269e3021894 318 }
elessair 0:f269e3021894 319
elessair 0:f269e3021894 320 #endif /* _WIN32 && !EFIX64 && !EFI32 */
elessair 0:f269e3021894 321
elessair 0:f269e3021894 322 /*
elessair 0:f269e3021894 323 * Set delays to watch
elessair 0:f269e3021894 324 */
elessair 0:f269e3021894 325 void mbedtls_timing_set_delay( void *data, uint32_t int_ms, uint32_t fin_ms )
elessair 0:f269e3021894 326 {
elessair 0:f269e3021894 327 mbedtls_timing_delay_context *ctx = (mbedtls_timing_delay_context *) data;
elessair 0:f269e3021894 328
elessair 0:f269e3021894 329 ctx->int_ms = int_ms;
elessair 0:f269e3021894 330 ctx->fin_ms = fin_ms;
elessair 0:f269e3021894 331
elessair 0:f269e3021894 332 if( fin_ms != 0 )
elessair 0:f269e3021894 333 (void) mbedtls_timing_get_timer( &ctx->timer, 1 );
elessair 0:f269e3021894 334 }
elessair 0:f269e3021894 335
elessair 0:f269e3021894 336 /*
elessair 0:f269e3021894 337 * Get number of delays expired
elessair 0:f269e3021894 338 */
elessair 0:f269e3021894 339 int mbedtls_timing_get_delay( void *data )
elessair 0:f269e3021894 340 {
elessair 0:f269e3021894 341 mbedtls_timing_delay_context *ctx = (mbedtls_timing_delay_context *) data;
elessair 0:f269e3021894 342 unsigned long elapsed_ms;
elessair 0:f269e3021894 343
elessair 0:f269e3021894 344 if( ctx->fin_ms == 0 )
elessair 0:f269e3021894 345 return( -1 );
elessair 0:f269e3021894 346
elessair 0:f269e3021894 347 elapsed_ms = mbedtls_timing_get_timer( &ctx->timer, 0 );
elessair 0:f269e3021894 348
elessair 0:f269e3021894 349 if( elapsed_ms >= ctx->fin_ms )
elessair 0:f269e3021894 350 return( 2 );
elessair 0:f269e3021894 351
elessair 0:f269e3021894 352 if( elapsed_ms >= ctx->int_ms )
elessair 0:f269e3021894 353 return( 1 );
elessair 0:f269e3021894 354
elessair 0:f269e3021894 355 return( 0 );
elessair 0:f269e3021894 356 }
elessair 0:f269e3021894 357
elessair 0:f269e3021894 358 #endif /* !MBEDTLS_TIMING_ALT */
elessair 0:f269e3021894 359
elessair 0:f269e3021894 360 #if defined(MBEDTLS_SELF_TEST)
elessair 0:f269e3021894 361
elessair 0:f269e3021894 362 /*
elessair 0:f269e3021894 363 * Busy-waits for the given number of milliseconds.
elessair 0:f269e3021894 364 * Used for testing mbedtls_timing_hardclock.
elessair 0:f269e3021894 365 */
elessair 0:f269e3021894 366 static void busy_msleep( unsigned long msec )
elessair 0:f269e3021894 367 {
elessair 0:f269e3021894 368 struct mbedtls_timing_hr_time hires;
elessair 0:f269e3021894 369 unsigned long i = 0; /* for busy-waiting */
elessair 0:f269e3021894 370 volatile unsigned long j; /* to prevent optimisation */
elessair 0:f269e3021894 371
elessair 0:f269e3021894 372 (void) mbedtls_timing_get_timer( &hires, 1 );
elessair 0:f269e3021894 373
elessair 0:f269e3021894 374 while( mbedtls_timing_get_timer( &hires, 0 ) < msec )
elessair 0:f269e3021894 375 i++;
elessair 0:f269e3021894 376
elessair 0:f269e3021894 377 j = i;
elessair 0:f269e3021894 378 (void) j;
elessair 0:f269e3021894 379 }
elessair 0:f269e3021894 380
elessair 0:f269e3021894 381 #define FAIL do \
elessair 0:f269e3021894 382 { \
elessair 0:f269e3021894 383 if( verbose != 0 ) \
elessair 0:f269e3021894 384 mbedtls_printf( "failed\n" ); \
elessair 0:f269e3021894 385 \
elessair 0:f269e3021894 386 return( 1 ); \
elessair 0:f269e3021894 387 } while( 0 )
elessair 0:f269e3021894 388
elessair 0:f269e3021894 389 /*
elessair 0:f269e3021894 390 * Checkup routine
elessair 0:f269e3021894 391 *
elessair 0:f269e3021894 392 * Warning: this is work in progress, some tests may not be reliable enough
elessair 0:f269e3021894 393 * yet! False positives may happen.
elessair 0:f269e3021894 394 */
elessair 0:f269e3021894 395 int mbedtls_timing_self_test( int verbose )
elessair 0:f269e3021894 396 {
elessair 0:f269e3021894 397 unsigned long cycles, ratio;
elessair 0:f269e3021894 398 unsigned long millisecs, secs;
elessair 0:f269e3021894 399 int hardfail;
elessair 0:f269e3021894 400 struct mbedtls_timing_hr_time hires;
elessair 0:f269e3021894 401 uint32_t a, b;
elessair 0:f269e3021894 402 mbedtls_timing_delay_context ctx;
elessair 0:f269e3021894 403
elessair 0:f269e3021894 404 if( verbose != 0 )
elessair 0:f269e3021894 405 mbedtls_printf( " TIMING tests note: will take some time!\n" );
elessair 0:f269e3021894 406
elessair 0:f269e3021894 407
elessair 0:f269e3021894 408 if( verbose != 0 )
elessair 0:f269e3021894 409 mbedtls_printf( " TIMING test #1 (set_alarm / get_timer): " );
elessair 0:f269e3021894 410
elessair 0:f269e3021894 411 for( secs = 1; secs <= 3; secs++ )
elessair 0:f269e3021894 412 {
elessair 0:f269e3021894 413 (void) mbedtls_timing_get_timer( &hires, 1 );
elessair 0:f269e3021894 414
elessair 0:f269e3021894 415 mbedtls_set_alarm( (int) secs );
elessair 0:f269e3021894 416 while( !mbedtls_timing_alarmed )
elessair 0:f269e3021894 417 ;
elessair 0:f269e3021894 418
elessair 0:f269e3021894 419 millisecs = mbedtls_timing_get_timer( &hires, 0 );
elessair 0:f269e3021894 420
elessair 0:f269e3021894 421 /* For some reason on Windows it looks like alarm has an extra delay
elessair 0:f269e3021894 422 * (maybe related to creating a new thread). Allow some room here. */
elessair 0:f269e3021894 423 if( millisecs < 800 * secs || millisecs > 1200 * secs + 300 )
elessair 0:f269e3021894 424 {
elessair 0:f269e3021894 425 if( verbose != 0 )
elessair 0:f269e3021894 426 mbedtls_printf( "failed\n" );
elessair 0:f269e3021894 427
elessair 0:f269e3021894 428 return( 1 );
elessair 0:f269e3021894 429 }
elessair 0:f269e3021894 430 }
elessair 0:f269e3021894 431
elessair 0:f269e3021894 432 if( verbose != 0 )
elessair 0:f269e3021894 433 mbedtls_printf( "passed\n" );
elessair 0:f269e3021894 434
elessair 0:f269e3021894 435 if( verbose != 0 )
elessair 0:f269e3021894 436 mbedtls_printf( " TIMING test #2 (set/get_delay ): " );
elessair 0:f269e3021894 437
elessair 0:f269e3021894 438 for( a = 200; a <= 400; a += 200 )
elessair 0:f269e3021894 439 {
elessair 0:f269e3021894 440 for( b = 200; b <= 400; b += 200 )
elessair 0:f269e3021894 441 {
elessair 0:f269e3021894 442 mbedtls_timing_set_delay( &ctx, a, a + b );
elessair 0:f269e3021894 443
elessair 0:f269e3021894 444 busy_msleep( a - a / 8 );
elessair 0:f269e3021894 445 if( mbedtls_timing_get_delay( &ctx ) != 0 )
elessair 0:f269e3021894 446 FAIL;
elessair 0:f269e3021894 447
elessair 0:f269e3021894 448 busy_msleep( a / 4 );
elessair 0:f269e3021894 449 if( mbedtls_timing_get_delay( &ctx ) != 1 )
elessair 0:f269e3021894 450 FAIL;
elessair 0:f269e3021894 451
elessair 0:f269e3021894 452 busy_msleep( b - a / 8 - b / 8 );
elessair 0:f269e3021894 453 if( mbedtls_timing_get_delay( &ctx ) != 1 )
elessair 0:f269e3021894 454 FAIL;
elessair 0:f269e3021894 455
elessair 0:f269e3021894 456 busy_msleep( b / 4 );
elessair 0:f269e3021894 457 if( mbedtls_timing_get_delay( &ctx ) != 2 )
elessair 0:f269e3021894 458 FAIL;
elessair 0:f269e3021894 459 }
elessair 0:f269e3021894 460 }
elessair 0:f269e3021894 461
elessair 0:f269e3021894 462 mbedtls_timing_set_delay( &ctx, 0, 0 );
elessair 0:f269e3021894 463 busy_msleep( 200 );
elessair 0:f269e3021894 464 if( mbedtls_timing_get_delay( &ctx ) != -1 )
elessair 0:f269e3021894 465 FAIL;
elessair 0:f269e3021894 466
elessair 0:f269e3021894 467 if( verbose != 0 )
elessair 0:f269e3021894 468 mbedtls_printf( "passed\n" );
elessair 0:f269e3021894 469
elessair 0:f269e3021894 470 if( verbose != 0 )
elessair 0:f269e3021894 471 mbedtls_printf( " TIMING test #3 (hardclock / get_timer): " );
elessair 0:f269e3021894 472
elessair 0:f269e3021894 473 /*
elessair 0:f269e3021894 474 * Allow one failure for possible counter wrapping.
elessair 0:f269e3021894 475 * On a 4Ghz 32-bit machine the cycle counter wraps about once per second;
elessair 0:f269e3021894 476 * since the whole test is about 10ms, it shouldn't happen twice in a row.
elessair 0:f269e3021894 477 */
elessair 0:f269e3021894 478 hardfail = 0;
elessair 0:f269e3021894 479
elessair 0:f269e3021894 480 hard_test:
elessair 0:f269e3021894 481 if( hardfail > 1 )
elessair 0:f269e3021894 482 {
elessair 0:f269e3021894 483 if( verbose != 0 )
elessair 0:f269e3021894 484 mbedtls_printf( "failed (ignored)\n" );
elessair 0:f269e3021894 485
elessair 0:f269e3021894 486 goto hard_test_done;
elessair 0:f269e3021894 487 }
elessair 0:f269e3021894 488
elessair 0:f269e3021894 489 /* Get a reference ratio cycles/ms */
elessair 0:f269e3021894 490 millisecs = 1;
elessair 0:f269e3021894 491 cycles = mbedtls_timing_hardclock();
elessair 0:f269e3021894 492 busy_msleep( millisecs );
elessair 0:f269e3021894 493 cycles = mbedtls_timing_hardclock() - cycles;
elessair 0:f269e3021894 494 ratio = cycles / millisecs;
elessair 0:f269e3021894 495
elessair 0:f269e3021894 496 /* Check that the ratio is mostly constant */
elessair 0:f269e3021894 497 for( millisecs = 2; millisecs <= 4; millisecs++ )
elessair 0:f269e3021894 498 {
elessair 0:f269e3021894 499 cycles = mbedtls_timing_hardclock();
elessair 0:f269e3021894 500 busy_msleep( millisecs );
elessair 0:f269e3021894 501 cycles = mbedtls_timing_hardclock() - cycles;
elessair 0:f269e3021894 502
elessair 0:f269e3021894 503 /* Allow variation up to 20% */
elessair 0:f269e3021894 504 if( cycles / millisecs < ratio - ratio / 5 ||
elessair 0:f269e3021894 505 cycles / millisecs > ratio + ratio / 5 )
elessair 0:f269e3021894 506 {
elessair 0:f269e3021894 507 hardfail++;
elessair 0:f269e3021894 508 goto hard_test;
elessair 0:f269e3021894 509 }
elessair 0:f269e3021894 510 }
elessair 0:f269e3021894 511
elessair 0:f269e3021894 512 if( verbose != 0 )
elessair 0:f269e3021894 513 mbedtls_printf( "passed\n" );
elessair 0:f269e3021894 514
elessair 0:f269e3021894 515 hard_test_done:
elessair 0:f269e3021894 516
elessair 0:f269e3021894 517 if( verbose != 0 )
elessair 0:f269e3021894 518 mbedtls_printf( "\n" );
elessair 0:f269e3021894 519
elessair 0:f269e3021894 520 return( 0 );
elessair 0:f269e3021894 521 }
elessair 0:f269e3021894 522
elessair 0:f269e3021894 523 #endif /* MBEDTLS_SELF_TEST */
elessair 0:f269e3021894 524
elessair 0:f269e3021894 525 #endif /* MBEDTLS_TIMING_C */