#include <stdio.h>
#include <math.h>
#include <asm/msr.h>
#include "resample.h"

#define CLK    300.e6
#define LOOPS  20000


typedef double ( *ddf ) ( double );


float a1 [256];
float a2 [256];

void init ( void )
{
    int  i;
    
    for ( i = 0; i < sizeof(a1)/sizeof(*a1); i++ ) {
        a1 [i] = sin(i)+0.2*sin(1.8*i)+log(2+i);
	a2 [i] = cos(0.1*i);
    }
}

void test ( unsigned int no, scalar_t f )
{
    unsigned long long  t1;
    unsigned long long  t2;
    unsigned long long  t3;
    unsigned long long  t4;
    int                 l;
    double              last = 0;
    double              curr = 0;
    
    printf ( "[%3u] %22.14f\t\t", no, (double)f (a1,a2) );
    fflush ( stdout );

    do {
    rdtscll (t1);
    l = LOOPS;
    do
        ;
    while (--l);
    rdtscll (t2);
    rdtscll (t3);
    l = LOOPS;
    do
        f(a1,a2), f(a1,a2), f(a1,a2), f(a1,a2);
    while (--l);
    rdtscll (t4);
    last = curr;
    curr = (t4-t3-t2+t1) / CLK / LOOPS / 4 * 1.e9;
    } while ( fabs(curr-last) > 1.e-4 * (curr+last) );
    printf ("%8.2f ns\n", (curr+last) / 2 );
}

void testn ( scalarn_t f )
{
    unsigned long long  t1;
    unsigned long long  t2;
    unsigned long long  t3;
    unsigned long long  t4;
    int                 l;
    int                 i;
    double              last = 0;
    double              curr = 0;
    
    for ( i = 1; i <= 64; i += i<6 ? 1 : i<8 ? 2 : i ) {
        printf ( "[%3u] %22.14f\t\t", 4u*i, (double)f (a1,a2,i) );
        fflush ( stdout );

    do {
        rdtscll (t1);
        l = LOOPS;
        do
            ;
        while (--l);
        rdtscll (t2);
        rdtscll (t3);
        l = LOOPS;
        do
            f(a1,a2,i), f(a1,a2,i), f(a1,a2,i), f(a1,a2,i);
        while (--l);
        rdtscll (t4);
    last = curr;
    curr = (t4-t3-t2+t1) / CLK / LOOPS / 4 * 1.e9;
    } while ( fabs(curr-last) > 1.e-4 * (curr+last) );
    printf ("%8.2f ns\n", (curr+last) / 2 );
    }
}

void test2 ( const char* name, ddf f )
{
    int     i;
    double  x;
    
    printf ( "\n%%%% %s\n\n", name );
    
    for ( i = -1000; i <= 1000; i++ ) {
        x = 1.e-3 * i;
	printf ( "%5d\t%12.8f\t%12.8f\t%12.8f\n", i, f(x), (f(x+5.e-5) - f(x-5.e-5))*1.e+4, (f(x+1.e-4) + f(x-1.e-4) - 2*f(x))*5.e+7 );
    }
    printf ( "%%%%\n" );
    fflush ( stdout );
}


int main ( int argc, char** argv )
{

#if 0

    test2 ( "Hann", hanning   );
    test2 ( "Hamm", hamming   );
    test2 ( "BM", blackman  );
    test2 ( "BM1",blackman1 );
    test2 ( "BM2",blackman2 );
    test2 ( "BMH N",blackmanharris_nuttall );
    test2 ( "MNH Min",blackmanharris_min4    );

#else

    init ();

    test ( 4, scalar04_float32       );
    test ( 4, scalar04_float32_i387  );
    test ( 4, scalar04_float32_3DNow );
    test ( 4, scalar04_float32_SIMD  );

    test ( 8, scalar08_float32       );
    test ( 8, scalar08_float32_i387  );
    test ( 8, scalar08_float32_3DNow );
    test ( 8, scalar08_float32_SIMD  );

    test ( 12, scalar12_float32       );
    test ( 12, scalar12_float32_i387  );
    test ( 12, scalar12_float32_3DNow );
    test ( 12, scalar12_float32_SIMD  );

    test ( 16, scalar16_float32       );
    test ( 16, scalar16_float32_i387  );
    test ( 16, scalar16_float32_3DNow );
    test ( 16, scalar16_float32_SIMD  );

    test ( 20, scalar20_float32       );
    test ( 20, scalar20_float32_i387  );
    test ( 20, scalar20_float32_3DNow );
    test ( 20, scalar20_float32_SIMD  );

    test ( 24, scalar24_float32       );
    test ( 24, scalar24_float32_i387  );
    test ( 24, scalar24_float32_3DNow );
    test ( 24, scalar24_float32_SIMD  );

    testn( scalar4n_float32       );
    testn( scalar4n_float32_i387  );
    testn( scalar4n_float32_3DNow );
    testn( scalar4n_float32_SIMD  );

#endif    
    
    return 0;
}

/* end of scalartest.c */
