nkeynes@185: #include <stdio.h>
nkeynes@185: #include <assert.h>
nkeynes@185: #include <math.h>
nkeynes@185: 
nkeynes@185: #define write_string(x) printf(x)
nkeynes@185: #define write_int(x) printf( "%08X", x )
nkeynes@185: 
nkeynes@185: int do_fsca(int angle, float *a, float *b);
nkeynes@185: float do_fsrra( float param );
nkeynes@185: float do_fipr( float *vectora, float *vectorb );
nkeynes@185: float do_fipr2( float *vectora, float *vectorb );
nkeynes@185: void do_ftrv( float *matrix, float *vector );
nkeynes@185: void do_ftrv2( float *matrix, float *vector );
nkeynes@185: 
nkeynes@185: unsigned int get_fpscr();
nkeynes@185: void set_fpscr( unsigned int fpscr );
nkeynes@185: 
nkeynes@185: #define MAX_FLOAT_DIFF 0.00001
nkeynes@185: 
nkeynes@192: static inline float inttof( unsigned int i )
nkeynes@192: {
nkeynes@192:     return *((float *)&i);
nkeynes@192: }
nkeynes@192: 
nkeynes@192: static inline double longtod( unsigned long long l )
nkeynes@192: {
nkeynes@192:     return *((double *)&l);
nkeynes@192: }
nkeynes@192: 
nkeynes@192: static inline unsigned int ftoint( float f )
nkeynes@192: {
nkeynes@192:     return *((unsigned int *)&f);
nkeynes@192: }
nkeynes@192: 
nkeynes@192: static inline unsigned long long dtolong( double d )
nkeynes@192: {
nkeynes@192:     return *((unsigned long long *)&d);
nkeynes@192: }
nkeynes@192: 
nkeynes@192: #define QNANF inttof(0x7FBFFFFF)
nkeynes@192: #define QNAND longtod(0x7FF7FFFFFFFFFFFFLL)
nkeynes@185: 
nkeynes@185: int compare_float( float a, float b )
nkeynes@185: {
nkeynes@192:     if( ftoint(a) == ftoint(b) ) /* Exact bit-pattern match */
nkeynes@185: 	return 1;
nkeynes@185:     float diff = (a>b?(a-b):(b-a));
nkeynes@185:     return diff < MAX_FLOAT_DIFF;
nkeynes@185: }
nkeynes@185: 
nkeynes@192: #define FTOINT(a) (*((unsigned int *)&a))
nkeynes@192: 
nkeynes@192: #define TEST_FEQUALS( a, b ) if( !compare_float(a,b) ) { printf( "Assertion failed at %s.%d: expected %.8f (%08X) but was %.8f (%08X)\n", __FILE__, __LINE__, a, FTOINT(a), b, FTOINT(b) ); return 1; }
nkeynes@185: 
nkeynes@185: int test_fsca( int angle, float expect_a, float expect_b )
nkeynes@185: {
nkeynes@185:     float a = 10.0;
nkeynes@185:     float b = 10.0;
nkeynes@185:     do_fsca(angle, &a, &b );
nkeynes@185:     
nkeynes@185:     TEST_FEQUALS(expect_a, a);
nkeynes@185:     TEST_FEQUALS(expect_b, b);
nkeynes@185: }
nkeynes@185: 
nkeynes@185: int test_fsrra( float f, float expect )
nkeynes@185: {
nkeynes@185:     float f2 = do_fsrra( f );
nkeynes@185:     TEST_FEQUALS( expect, f2 );
nkeynes@185: }
nkeynes@185: 
nkeynes@185: void test_coercion( float f )
nkeynes@185: {
nkeynes@185:     double d = (double)f;
nkeynes@185:     float q = (float)d;
nkeynes@185:     unsigned int i = (unsigned int)d;
nkeynes@185:     signed int j = (signed int)q;
nkeynes@185: 
nkeynes@185:     printf( "Coerce: %08X %08X%08X %08X %08X %08X\n", *((unsigned int *)&f),
nkeynes@185:     	    *((unsigned int *)&d),  *(((unsigned int *)&d)+1),
nkeynes@185:     	    *((unsigned int *)&q), i, j );
nkeynes@185: }
nkeynes@185: 
nkeynes@185: void test_doublearr( int len )
nkeynes@185: {
nkeynes@185:     double arr[len];
nkeynes@185:     unsigned int *iarr = (unsigned int *)&arr;
nkeynes@185:     int i;
nkeynes@185:     arr[0] = 2.5;
nkeynes@185:     for( i=1; i<len; i++ ) {
nkeynes@185: 	arr[i] = (arr[i-1] * arr[i-1] + arr[0]) / 1.25 - 0.19;
nkeynes@185:     }
nkeynes@185: 
nkeynes@185:     printf( "arr: " );
nkeynes@185:     for( i=0; i<len; i++ ) {
nkeynes@185: 	printf( "%08X", *iarr++ );
nkeynes@185: 	printf( "%08X ", *iarr++ );
nkeynes@185:     }
nkeynes@185:     printf( "\n" );
nkeynes@185: }
nkeynes@185: 
nkeynes@185: void test_floatarr( int len )
nkeynes@185: {
nkeynes@185:     float arr[len];
nkeynes@185:     unsigned int *iarr = (unsigned int *)&arr;
nkeynes@185:     int i;
nkeynes@185:     arr[0] = 2.5;
nkeynes@185:     for( i=1; i<len; i++ ) {
nkeynes@185: 	arr[i] = (arr[i-1] * arr[i-1] + arr[0]) / 1.25 - 0.19;
nkeynes@185:     }
nkeynes@185: 
nkeynes@185:     write_string( "arr: " );
nkeynes@185:     for( i=0; i<len; i++ ) {
nkeynes@185: 	write_int( *iarr++ );
nkeynes@185: 	write_string( " " );
nkeynes@185:     }
nkeynes@185:     write_string( "\n" );
nkeynes@185: }
nkeynes@185: 
nkeynes@185: float __attribute__((aligned(8))) matrix[16] = { 1.26, 2.34, 5.67, 3.497, -1.23, 43.43, -45.68, 9.12, 
nkeynes@185: 			 12.1, 34.301, -297.354, 0.05, 0.123, 23.34, 9.99, 33.321 };
nkeynes@185: float __attribute__((aligned(8))) vec1[4] = { 5.65, 9.98, -34.12, 0.043 };
nkeynes@185: float __attribute__((aligned(8))) vec2[4] = { 3.45, -123, 4.54, 98.0909 };
nkeynes@185: float __attribute__((aligned(8))) vec3[4] = { 1.25, 2.25, 3.75, 5.12 };
nkeynes@185: float __attribute__((aligned(8))) vec4[4] = {-0.25, 8.9, -2.3, 9.19 };
nkeynes@185: 
nkeynes@185: void test_fipr( )
nkeynes@185: {
nkeynes@185:     float r = do_fipr( vec3, vec4 );
nkeynes@185:     write_string( "fipr: " );
nkeynes@185:     write_int( *(unsigned int *)&r );
nkeynes@185:     write_string( "\n" );
nkeynes@185:     
nkeynes@185:     r = do_fipr2( vec4, vec3 );
nkeynes@185:     write_string( "fipr: " );
nkeynes@185:     write_int( *(unsigned int *)&r );
nkeynes@185:     write_string( "\n" );
nkeynes@185:     
nkeynes@185: }
nkeynes@185: 
nkeynes@185: void test_ftrv( )
nkeynes@185: {
nkeynes@185:     
nkeynes@185:     do_ftrv( matrix, vec1 );
nkeynes@185:     write_string( "ftrv: " );
nkeynes@185:     write_int( *(unsigned int *)&vec1[0] );
nkeynes@185:     write_int( *(unsigned int *)&vec1[1] );
nkeynes@185:     write_int( *(unsigned int *)&vec1[2] );
nkeynes@185:     write_int( *(unsigned int *)&vec1[3] );
nkeynes@185:     write_string( "\n" );
nkeynes@185:     
nkeynes@185:     do_ftrv2( matrix, vec2 );
nkeynes@185:     
nkeynes@185:     write_string( "ftrv: " );
nkeynes@185:     write_int( *(unsigned int *)&vec2[0] );
nkeynes@185:     write_int( *(unsigned int *)&vec2[1] );
nkeynes@185:     write_int( *(unsigned int *)&vec2[2] );
nkeynes@185:     write_int( *(unsigned int *)&vec2[3] );
nkeynes@185:     write_string( "\n" );
nkeynes@185:     
nkeynes@185: }
nkeynes@185:     
nkeynes@185: 
nkeynes@185: int main()
nkeynes@185: {
nkeynes@192:     fprintf( stderr, "LL: %d\n", sizeof(unsigned long long) );
nkeynes@192:     write_int( get_fpscr() );
nkeynes@192:     write_string( "\n" );
nkeynes@192:     test_fsca( 0x00000000, 0, 1 );
nkeynes@192:     test_fsca( 0x00011234, 0.43205646, 0.90184659 );
nkeynes@192:     test_fsca( 0xFEDCBA98, -0.99121743, -0.13224234 );
nkeynes@192:     test_fsrra( 25.0, 0.2 );
nkeynes@192:     test_fsrra( 0.05, 4.4721361 );
nkeynes@192:     test_fsrra( -12.345, QNANF );
nkeynes@192:     test_coercion( -3.1415926 );
nkeynes@192:     test_coercion( 123456789012346567.890 );
nkeynes@192:     test_coercion( -2147483648.0 );
nkeynes@192:     test_coercion( 5234.1234 );
nkeynes@192:     test_doublearr( 5 );
nkeynes@192:     test_floatarr( 5 );
nkeynes@192:     test_fipr();
nkeynes@192:     test_ftrv();
nkeynes@192:     return 1;
nkeynes@185: }
nkeynes@192: