00001 
00002 
00003 
00004 
00005 
00006 
00007 
00008 
00009 
00010 
00011 
00012 
00013 
00014 
00015 
00016 
00017 
00018 
00019 
00020 
00021 
00022 
00023 
00024 
00025 
00026 
00027 
00028 #include <string.h>
00029 #include <time.h>
00030 
00031 #include "xyssl/config.h"
00032 
00033 #if defined(XYSSL_HAVEGE_C)
00034 
00035 #include "xyssl/havege.h"
00036 #include "xyssl/timing.h"
00037 
00038 
00039 
00040 
00041 
00042 
00043 
00044 
00045 
00046 
00047 
00048 
00049 
00050 
00051 
00052 #define SWAP(X,Y) { int *T = X; X = Y; Y = T; }
00053 
00054 #define TST1_ENTER if( PTEST & 1 ) { PTEST ^= 3; PTEST >>= 1;
00055 #define TST2_ENTER if( PTEST & 1 ) { PTEST ^= 3; PTEST >>= 1;
00056 
00057 #define TST1_LEAVE U1++; }
00058 #define TST2_LEAVE U2++; }
00059 
00060 #define ONE_ITERATION                                   \
00061                                                         \
00062     PTEST = PT1 >> 20;                                  \
00063                                                         \
00064     TST1_ENTER  TST1_ENTER  TST1_ENTER  TST1_ENTER      \
00065     TST1_ENTER  TST1_ENTER  TST1_ENTER  TST1_ENTER      \
00066     TST1_ENTER  TST1_ENTER  TST1_ENTER  TST1_ENTER      \
00067                                                         \
00068     TST1_LEAVE  TST1_LEAVE  TST1_LEAVE  TST1_LEAVE      \
00069     TST1_LEAVE  TST1_LEAVE  TST1_LEAVE  TST1_LEAVE      \
00070     TST1_LEAVE  TST1_LEAVE  TST1_LEAVE  TST1_LEAVE      \
00071                                                         \
00072     PTX = (PT1 >> 18) & 7;                              \
00073     PT1 &= 0x1FFF;                                      \
00074     PT2 &= 0x1FFF;                                      \
00075     CLK = (int) hardclock();                            \
00076                                                         \
00077     i = 0;                                              \
00078     A = &WALK[PT1    ]; RES[i++] ^= *A;                 \
00079     B = &WALK[PT2    ]; RES[i++] ^= *B;                 \
00080     C = &WALK[PT1 ^ 1]; RES[i++] ^= *C;                 \
00081     D = &WALK[PT2 ^ 4]; RES[i++] ^= *D;                 \
00082                                                         \
00083     IN = (*A >> (1)) ^ (*A << (31)) ^ CLK;              \
00084     *A = (*B >> (2)) ^ (*B << (30)) ^ CLK;              \
00085     *B = IN ^ U1;                                       \
00086     *C = (*C >> (3)) ^ (*C << (29)) ^ CLK;              \
00087     *D = (*D >> (4)) ^ (*D << (28)) ^ CLK;              \
00088                                                         \
00089     A = &WALK[PT1 ^ 2]; RES[i++] ^= *A;                 \
00090     B = &WALK[PT2 ^ 2]; RES[i++] ^= *B;                 \
00091     C = &WALK[PT1 ^ 3]; RES[i++] ^= *C;                 \
00092     D = &WALK[PT2 ^ 6]; RES[i++] ^= *D;                 \
00093                                                         \
00094     if( PTEST & 1 ) SWAP( A, C );                       \
00095                                                         \
00096     IN = (*A >> (5)) ^ (*A << (27)) ^ CLK;              \
00097     *A = (*B >> (6)) ^ (*B << (26)) ^ CLK;              \
00098     *B = IN; CLK = (int) hardclock();                   \
00099     *C = (*C >> (7)) ^ (*C << (25)) ^ CLK;              \
00100     *D = (*D >> (8)) ^ (*D << (24)) ^ CLK;              \
00101                                                         \
00102     A = &WALK[PT1 ^ 4];                                 \
00103     B = &WALK[PT2 ^ 1];                                 \
00104                                                         \
00105     PTEST = PT2 >> 1;                                   \
00106                                                         \
00107     PT2 = (RES[(i - 8) ^ PTY] ^ WALK[PT2 ^ PTY ^ 7]);   \
00108     PT2 = ((PT2 & 0x1FFF) & (~8)) ^ ((PT1 ^ 8) & 0x8);  \
00109     PTY = (PT2 >> 10) & 7;                              \
00110                                                         \
00111     TST2_ENTER  TST2_ENTER  TST2_ENTER  TST2_ENTER      \
00112     TST2_ENTER  TST2_ENTER  TST2_ENTER  TST2_ENTER      \
00113     TST2_ENTER  TST2_ENTER  TST2_ENTER  TST2_ENTER      \
00114                                                         \
00115     TST2_LEAVE  TST2_LEAVE  TST2_LEAVE  TST2_LEAVE      \
00116     TST2_LEAVE  TST2_LEAVE  TST2_LEAVE  TST2_LEAVE      \
00117     TST2_LEAVE  TST2_LEAVE  TST2_LEAVE  TST2_LEAVE      \
00118                                                         \
00119     C = &WALK[PT1 ^ 5];                                 \
00120     D = &WALK[PT2 ^ 5];                                 \
00121                                                         \
00122     RES[i++] ^= *A;                                     \
00123     RES[i++] ^= *B;                                     \
00124     RES[i++] ^= *C;                                     \
00125     RES[i++] ^= *D;                                     \
00126                                                         \
00127     IN = (*A >> ( 9)) ^ (*A << (23)) ^ CLK;             \
00128     *A = (*B >> (10)) ^ (*B << (22)) ^ CLK;             \
00129     *B = IN ^ U2;                                       \
00130     *C = (*C >> (11)) ^ (*C << (21)) ^ CLK;             \
00131     *D = (*D >> (12)) ^ (*D << (20)) ^ CLK;             \
00132                                                         \
00133     A = &WALK[PT1 ^ 6]; RES[i++] ^= *A;                 \
00134     B = &WALK[PT2 ^ 3]; RES[i++] ^= *B;                 \
00135     C = &WALK[PT1 ^ 7]; RES[i++] ^= *C;                 \
00136     D = &WALK[PT2 ^ 7]; RES[i++] ^= *D;                 \
00137                                                         \
00138     IN = (*A >> (13)) ^ (*A << (19)) ^ CLK;             \
00139     *A = (*B >> (14)) ^ (*B << (18)) ^ CLK;             \
00140     *B = IN;                                            \
00141     *C = (*C >> (15)) ^ (*C << (17)) ^ CLK;             \
00142     *D = (*D >> (16)) ^ (*D << (16)) ^ CLK;             \
00143                                                         \
00144     PT1 = ( RES[(i - 8) ^ PTX] ^                        \
00145             WALK[PT1 ^ PTX ^ 7] ) & (~1);               \
00146     PT1 ^= (PT2 ^ 0x10) & 0x10;                         \
00147                                                         \
00148     for( n++, i = 0; i < 16; i++ )                      \
00149         hs->pool[n % COLLECT_SIZE] ^= RES[i];
00150 
00151 
00152 
00153 
00154 static void havege_fill( havege_state *hs )
00155 {
00156     int i, n = 0;
00157     int  U1,  U2, *A, *B, *C, *D;
00158     int PT1, PT2, *WALK, RES[16];
00159     int PTX, PTY, CLK, PTEST, IN;
00160 
00161     WALK = hs->WALK;
00162     PT1  = hs->PT1;
00163     PT2  = hs->PT2;
00164 
00165     PTX  = U1 = 0;
00166     PTY  = U2 = 0;
00167 
00168     memset( RES, 0, sizeof( RES ) );
00169 
00170     while( n < COLLECT_SIZE * 4 )
00171     {
00172         ONE_ITERATION
00173         ONE_ITERATION
00174         ONE_ITERATION
00175         ONE_ITERATION
00176     }
00177 
00178     hs->PT1 = PT1;
00179     hs->PT2 = PT2;
00180 
00181     hs->offset[0] = 0;
00182     hs->offset[1] = COLLECT_SIZE / 2;
00183 }
00184 
00185 
00186 
00187 
00188 void havege_init( havege_state *hs )
00189 {
00190     memset( hs, 0, sizeof( havege_state ) );
00191 
00192     havege_fill( hs );
00193 }
00194 
00195 
00196 
00197 
00198 int havege_rand( void *p_rng )
00199 {
00200     int ret;
00201     havege_state *hs = (havege_state *) p_rng;
00202 
00203     if( hs->offset[1] >= COLLECT_SIZE )
00204         havege_fill( hs );
00205 
00206     ret  = hs->pool[hs->offset[0]++];
00207     ret ^= hs->pool[hs->offset[1]++];
00208 
00209     return( ret );
00210 }
00211 
00212 #if defined(XYSSL_RAND_TEST)
00213 
00214 #include <stdio.h>
00215 
00216 int main( int argc, char *argv[] )
00217 {
00218     FILE *f;
00219     time_t t;
00220     int i, j, k;
00221     havege_state hs;
00222     unsigned char buf[1024];
00223 
00224     if( argc < 2 )
00225     {
00226         fprintf( stderr, "usage: %s <output filename>\n", argv[0] );
00227         return( 1 );
00228     }
00229 
00230     if( ( f = fopen( argv[1], "wb+" ) ) == NULL )
00231     {
00232         printf( "failed to open '%s' for writing.\n", argv[0] );
00233         return( 1 );
00234     }
00235 
00236     havege_init( &hs );
00237 
00238     t = time( NULL );
00239 
00240     for( i = 0, k = 32768; i < k; i++ )
00241     {
00242         for( j = 0; j < sizeof( buf ); j++ )
00243             buf[j] = havege_rand( &hs );
00244 
00245         fwrite( buf, sizeof( buf ), 1, f );
00246 
00247         printf( "Generating 32Mb of data in file '%s'... %04.1f" \
00248                 "%% done\r", argv[1], (100 * (float) (i + 1)) / k );
00249         fflush( stdout );
00250     }
00251 
00252     if( t == time( NULL ) )
00253         t--;
00254 
00255     fclose( f );
00256     return( 0 );
00257 }
00258 
00259 #endif
00260 
00261 #endif