Subversion Repositories openfpu64

#include <stdio.h>
#include "system.h"
#include <unistd.h>
#include "alt_types.h"
#include <stdlib.h>
#include <stdio.h>
#include "system.h"
#include <unistd.h>
#include "alt_types.h"
#include "io.h"
#include "fpu.h"
#include "sys/alt_timestamp.h"
#include "altera_avalon_performance_counter.h"
#include <time.h>
#include <sys/alt_irq.h>
 
/*******************************************************
 * To use this library/driver, add the fpu.[ch] files to your application
 * and add these linker flags. 
 * Click right on your application, choose properties, C/C++ Build
 * -> Linker -> General and type 
 * "-Wl,--wrap,__adddf3,--wrap,__subdf3,--wrap,__muldf3"
 * For each implemented function, add another --wrap,__functioname
 * *****************************************************/
 
#define MODE_ADD 0
#define MODE_SUB 4
#define MODE_MUL 8
#define MODE_DIV 12
/* See fpu_package.vhd for definition*/
 
double __wrap___adddf3(double a, double b)
{
    volatile alt_u32 * fpu_regs = (alt_u32 *) (OPENFPU64_0_BASE+0x80000000);
    volatile int dpcontext = alt_irq_disable_all();
    volatile double c;
 
    register alt_u32 * temp_a = (alt_u32 *) &a;
    register alt_u32 * temp_b = (alt_u32 *) &b;
    alt_u32 result2[2];
 
    /*
       printf("a0 %08lx!\n", temp_a[0]);
       printf("a1 %08lx!\n", temp_a[1]);
       printf("b0 %08lx!\n", temp_a[0]);
       printf("b1 %08lx!\n", temp_b[1]);
    /**/
    //PERF_BEGIN(PERFORMANCE_COUNTER_BASE,3);
 
    fpu_regs[0+MODE_ADD] = temp_a[1];
    fpu_regs[1] = temp_a[0];
    fpu_regs[2] = temp_b[1];
    fpu_regs[3] = temp_b[0];
 
    result2[1]=fpu_regs[0];
    result2[0]=fpu_regs[1];
    /*
       printf("result 0 %08lx!\n", result2[0]);
       printf("result 1 %08lx!\n", result2[1]);
    /**/
    c=*((double *) (result2));
    //PERF_END(PERFORMANCE_COUNTER_BASE,3);
    alt_irq_enable_all(dpcontext);
    return c;
} 
 
 
double __wrap___subdf3(double a, double b)
{
    volatile alt_u32 * fpu_regs = (alt_u32 *) (OPENFPU64_0_BASE+0x80000000);
    volatile int dpcontext = alt_irq_disable_all();
    volatile double c;
 
    register alt_u32 * temp_a = (alt_u32 *) &a;
    register alt_u32 * temp_b = (alt_u32 *) &b;
    alt_u32 result2[2];
 
    fpu_regs[0+MODE_SUB] = temp_a[1];
    fpu_regs[1] = temp_a[0];
    fpu_regs[2] = temp_b[1];
    fpu_regs[3] = temp_b[0];
 
    result2[1]=fpu_regs[0];
    result2[0]=fpu_regs[1];
 
    c=*((double *) (result2));
 
    alt_irq_enable_all(dpcontext);
    return c;
} 
 
 
double __wrap___muldf3 (double a , double b)
{
    //printf("mul called\n");
    volatile alt_u32 * fpu_regs = (alt_u32 *) (OPENFPU64_0_BASE+0x80000000);
    int dpcontext = alt_irq_disable_all();
    double c;
 
    register alt_u32 * temp_a = (alt_u32 *) &a;
    register alt_u32 * temp_b = (alt_u32 *) &b;
    alt_u32 result2[2];
 
 
    printf("a0 %08lx!\n", temp_a[0]);
    printf("a1 %08lx!\n", temp_a[1]);
    printf("b0 %08lx!\n", temp_a[0]);
    printf("b1 %08lx!\n", temp_b[1]);
    /**/
    //PERF_BEGIN(PERFORMANCE_COUNTER_BASE,3);
 
    fpu_regs[0+MODE_MUL] = temp_a[1];
    fpu_regs[1] = temp_a[0];
    fpu_regs[2] = temp_b[1];
    fpu_regs[3] = temp_b[0];
 
    result2[1]=fpu_regs[0];
    result2[0]=fpu_regs[1];
 
    printf("result 0 %08lx!\n", result2[0]);
    printf("result 1 %08lx!\n", result2[1]);
    /**/
    c=*((double *) (result2));
    //PERF_END(PERFORMANCE_COUNTER_BASE,3);
 
    alt_irq_enable_all(dpcontext);
    return c;
} 
 
 
 
 
double __wrap___divdf3 (double a , double b){
    printf("div called\n");
    return a;
};