timing.c 10.2 KB
Newer Older
1 2 3
/*
 *  Portable interface to the CPU cycle counter
 *
4
 *  Copyright (C) 2006-2014, Brainspark B.V.
Paul Bakker's avatar
Paul Bakker committed
5 6
 *
 *  This file is part of PolarSSL (http://www.polarssl.org)
7
 *  Lead Maintainer: Paul Bakker <polarssl_maintainer at polarssl.org>
Paul Bakker's avatar
Paul Bakker committed
8
 *
9
 *  All rights reserved.
Paul Bakker's avatar
Paul Bakker committed
10
 *
11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */

26
#include "polarssl/config.h"
27

28 29 30 31 32 33 34
#if defined(POLARSSL_SELF_TEST) && defined(POLARSSL_PLATFORM_C)
#include "polarssl/platform.h"
#else
#include <stdio.h>
#define polarssl_printf     printf
#endif

35
#if defined(POLARSSL_TIMING_C) && !defined(POLARSSL_TIMING_ALT)
36

37
#include "polarssl/timing.h"
38

39
#if defined(_WIN32) && !defined(EFIX64) && !defined(EFI32)
40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63

#include <windows.h>
#include <winbase.h>

struct _hr_time
{
    LARGE_INTEGER start;
};

#else

#include <unistd.h>
#include <sys/types.h>
#include <sys/time.h>
#include <signal.h>
#include <time.h>

struct _hr_time
{
    struct timeval start;
};

#endif

64
#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&  \
Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
65
    (defined(_MSC_VER) && defined(_M_IX86)) || defined(__WATCOMC__)
66

67 68
#define POLARSSL_HAVE_HARDCLOCK

69 70 71 72 73 74 75
unsigned long hardclock( void )
{
    unsigned long tsc;
    __asm   rdtsc
    __asm   mov  [tsc], eax
    return( tsc );
}
76
#endif
77

78 79 80 81
#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&  \
    defined(__GNUC__) && defined(__i386__)

#define POLARSSL_HAVE_HARDCLOCK
82 83 84

unsigned long hardclock( void )
{
85
    unsigned long lo, hi;
86
    asm volatile( "rdtsc" : "=a" (lo), "=d" (hi) );
87
    return( lo );
88
}
89
#endif
90

91 92 93 94
#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&  \
    defined(__GNUC__) && (defined(__amd64__) || defined(__x86_64__))

#define POLARSSL_HAVE_HARDCLOCK
95 96 97 98

unsigned long hardclock( void )
{
    unsigned long lo, hi;
99
    asm volatile( "rdtsc" : "=a" (lo), "=d" (hi) );
100 101
    return( lo | (hi << 32) );
}
102
#endif
103

104 105 106 107
#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&  \
    defined(__GNUC__) && (defined(__powerpc__) || defined(__ppc__))

#define POLARSSL_HAVE_HARDCLOCK
108 109 110 111 112 113 114

unsigned long hardclock( void )
{
    unsigned long tbl, tbu0, tbu1;

    do
    {
115 116 117
        asm volatile( "mftbu %0" : "=r" (tbu0) );
        asm volatile( "mftb  %0" : "=r" (tbl ) );
        asm volatile( "mftbu %0" : "=r" (tbu1) );
118 119 120 121 122
    }
    while( tbu0 != tbu1 );

    return( tbl );
}
123 124 125 126
#endif

#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&  \
    defined(__GNUC__) && defined(__sparc64__)
127

128 129
#if defined(__OpenBSD__)
#warning OpenBSD does not allow access to tick register using software version instead
130
#else
131 132 133 134 135
#define POLARSSL_HAVE_HARDCLOCK

unsigned long hardclock( void )
{
    unsigned long tick;
136
    asm volatile( "rdpr %%tick, %0;" : "=&r" (tick) );
137 138 139 140 141 142 143 144 145
    return( tick );
}
#endif
#endif

#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&  \
    defined(__GNUC__) && defined(__sparc__) && !defined(__sparc64__)

#define POLARSSL_HAVE_HARDCLOCK
146 147 148 149

unsigned long hardclock( void )
{
    unsigned long tick;
150 151
    asm volatile( ".byte 0x83, 0x41, 0x00, 0x00" );
    asm volatile( "mov   %%g1, %0" : "=r" (tick) );
152 153
    return( tick );
}
154
#endif
155

156 157 158 159
#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&      \
    defined(__GNUC__) && defined(__alpha__)

#define POLARSSL_HAVE_HARDCLOCK
160 161 162 163

unsigned long hardclock( void )
{
    unsigned long cc;
164
    asm volatile( "rpcc %0" : "=r" (cc) );
165 166
    return( cc & 0xFFFFFFFF );
}
167
#endif
168

169 170 171 172
#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(POLARSSL_HAVE_ASM) &&      \
    defined(__GNUC__) && defined(__ia64__)

#define POLARSSL_HAVE_HARDCLOCK
173 174 175 176

unsigned long hardclock( void )
{
    unsigned long itc;
177
    asm volatile( "mov %0 = ar.itc" : "=r" (itc) );
178 179
    return( itc );
}
180
#endif
181

182 183
#if !defined(POLARSSL_HAVE_HARDCLOCK) && defined(_MSC_VER) && \
    !defined(EFIX64) && !defined(EFI32)
184 185

#define POLARSSL_HAVE_HARDCLOCK
186 187 188 189

unsigned long hardclock( void )
{
    LARGE_INTEGER offset;
190

Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
191
    QueryPerformanceCounter( &offset );
192

Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
193
    return (unsigned long)( offset.QuadPart );
194
}
195
#endif
196

197 198 199
#if !defined(POLARSSL_HAVE_HARDCLOCK)

#define POLARSSL_HAVE_HARDCLOCK
200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217

static int hardclock_init = 0;
static struct timeval tv_init;

unsigned long hardclock( void )
{
    struct timeval tv_cur;

    if( hardclock_init == 0 )
    {
        gettimeofday( &tv_init, NULL );
        hardclock_init = 1;
    }

    gettimeofday( &tv_cur, NULL );
    return( ( tv_cur.tv_sec  - tv_init.tv_sec  ) * 1000000
          + ( tv_cur.tv_usec - tv_init.tv_usec ) );
}
218
#endif
219

220
volatile int alarmed = 0;
221

222
#if defined(_WIN32) && !defined(EFIX64) && !defined(EFI32)
223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243

unsigned long get_timer( struct hr_time *val, int reset )
{
    unsigned long delta;
    LARGE_INTEGER offset, hfreq;
    struct _hr_time *t = (struct _hr_time *) val;

    QueryPerformanceCounter(  &offset );
    QueryPerformanceFrequency( &hfreq );

    delta = (unsigned long)( ( 1000 *
        ( offset.QuadPart - t->start.QuadPart ) ) /
           hfreq.QuadPart );

    if( reset )
        QueryPerformanceCounter( &t->start );

    return( delta );
}

DWORD WINAPI TimerProc( LPVOID uElapse )
Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
244
{
245
    Sleep( (DWORD) uElapse );
Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
246
    alarmed = 1;
247 248 249 250
    return( TRUE );
}

void set_alarm( int seconds )
Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
251
{
252 253
    DWORD ThreadId;

Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
254
    alarmed = 0;
255 256 257 258 259 260 261 262 263
    CloseHandle( CreateThread( NULL, 0, TimerProc,
        (LPVOID) ( seconds * 1000 ), 0, &ThreadId ) );
}

void m_sleep( int milliseconds )
{
    Sleep( milliseconds );
}

264
#else /* _WIN32 && !EFIX64 && !EFI32 */
265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285

unsigned long get_timer( struct hr_time *val, int reset )
{
    unsigned long delta;
    struct timeval offset;
    struct _hr_time *t = (struct _hr_time *) val;

    gettimeofday( &offset, NULL );

    delta = ( offset.tv_sec  - t->start.tv_sec  ) * 1000
          + ( offset.tv_usec - t->start.tv_usec ) / 1000;

    if( reset )
    {
        t->start.tv_sec  = offset.tv_sec;
        t->start.tv_usec = offset.tv_usec;
    }

    return( delta );
}

Paul Bakker's avatar
Paul Bakker committed
286 287 288 289 290 291
#if defined(INTEGRITY)
void m_sleep( int milliseconds )
{
    usleep( milliseconds * 1000 );
}

292
#else /* INTEGRITY */
Paul Bakker's avatar
Paul Bakker committed
293

294
static void sighandler( int signum )
Manuel Pégourié-Gonnard's avatar
Manuel Pégourié-Gonnard committed
295
{
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311
    alarmed = 1;
    signal( signum, sighandler );
}

void set_alarm( int seconds )
{
    alarmed = 0;
    signal( SIGALRM, sighandler );
    alarm( seconds );
}

void m_sleep( int milliseconds )
{
    struct timeval tv;

    tv.tv_sec  = milliseconds / 1000;
312
    tv.tv_usec = ( milliseconds % 1000 ) * 1000;
313 314 315

    select( 0, NULL, NULL, NULL, &tv );
}
Paul Bakker's avatar
Paul Bakker committed
316
#endif /* INTEGRITY */
317

318
#endif /* _WIN32 && !EFIX64 && !EFI32 */
319

320 321
#if defined(POLARSSL_SELF_TEST)

322 323 324 325 326
/* To test net_usleep against our functions */
#if defined(POLARSSL_NET_C)
#include "polarssl/net.h"
#endif

327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346
/*
 * Checkup routine
 */
int timing_self_test( int verbose )
{
    unsigned long cycles, ratio;
    unsigned long millisecs, secs;
    int hardfail;
    struct hr_time hires;

    if( verbose != 0)
        polarssl_printf( "  TIMING tests warning: will take some time!\n" );

    if( verbose != 0 )
        polarssl_printf( "  TIMING test #1 (m_sleep   / get_timer): " );

    for( secs = 1; secs <= 3; secs++ )
    {
        (void) get_timer( &hires, 1 );

347
        m_sleep( 500 * secs );
348 349 350

        millisecs = get_timer( &hires, 0 );

351
        if( millisecs < 450 * secs || millisecs > 550 * secs )
352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433
        {
            if( verbose != 0 )
                polarssl_printf( "failed\n" );

            return( 1 );
        }
    }

    if( verbose != 0 )
        polarssl_printf( "passed\n" );

    if( verbose != 0 )
        polarssl_printf( "  TIMING test #2 (set_alarm / get_timer): " );

    for( secs = 1; secs <= 3; secs++ )
    {
        (void) get_timer( &hires, 1 );

        set_alarm( secs );
        while( !alarmed )
            ;

        millisecs = get_timer( &hires, 0 );

        if( millisecs < 900 * secs || millisecs > 1100 * secs )
        {
            if( verbose != 0 )
                polarssl_printf( "failed\n" );

            return( 1 );
        }
    }

    if( verbose != 0 )
        polarssl_printf( "passed\n" );

    if( verbose != 0 )
        polarssl_printf( "  TIMING test #3 (hardclock / m_sleep  ): " );

    /*
     * Allow one failure for possible counter wrapping.
     * On a 4Ghz 32-bit machine the cycle counter wraps about once per second;
     * since the whole test is about 10ms, it shouldn't happen twice in a row.
     */
    hardfail = 0;

hard_test:
    if( hardfail > 1 )
    {
        if( verbose != 0 )
            polarssl_printf( "failed\n" );

        return( 1 );
    }

    /* Get a reference ratio cycles/ms */
    cycles = hardclock();
    m_sleep( 1 );
    cycles = hardclock() - cycles;
    ratio = cycles / 1;

    for( millisecs = 2; millisecs <= 4; millisecs++ )
    {
        cycles = hardclock();
        m_sleep( millisecs );
        cycles = hardclock() - cycles;

        /* Allow variation up to 20% */
        if( cycles / millisecs < ratio - ratio / 5 ||
            cycles / millisecs > ratio + ratio / 5 )
        {
            hardfail++;
            goto hard_test;
        }
    }

    if( verbose != 0 )
        polarssl_printf( "passed\n" );

    if( verbose != 0 )
        polarssl_printf( "\n" );

434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458
#if defined(POLARSSL_NET_C)
    if( verbose != 0 )
        polarssl_printf( "  TIMING test #4 (net_usleep/ get_timer): " );

    for( secs = 1; secs <= 3; secs++ )
    {
        (void) get_timer( &hires, 1 );

        net_usleep( 500000 * secs );

        millisecs = get_timer( &hires, 0 );

        if( millisecs < 450 * secs || millisecs > 550 * secs )
        {
            if( verbose != 0 )
                polarssl_printf( "failed\n" );

            return( 1 );
        }
    }

    if( verbose != 0 )
        polarssl_printf( "passed\n" );
#endif

459 460 461 462 463 464
    return( 0 );
}

#endif /* POLARSSL_SELF_TEST */

#endif /* POLARSSL_TIMING_C && !POLARSSL_TIMING_ALT */