Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | #include <linux/types.h> |
2 | #include <linux/errno.h> | |
3 | #include <asm/uaccess.h> | |
4 | ||
d2b194ed KG |
5 | #include <asm/sfp-machine.h> |
6 | #include <math-emu/soft-fp.h> | |
7 | #include <math-emu/double.h> | |
1da177e4 LT |
8 | |
9 | int | |
10 | fmadd(void *frD, void *frA, void *frB, void *frC) | |
11 | { | |
12 | FP_DECL_D(R); | |
13 | FP_DECL_D(A); | |
14 | FP_DECL_D(B); | |
15 | FP_DECL_D(C); | |
16 | FP_DECL_D(T); | |
d2b194ed | 17 | FP_DECL_EX; |
1da177e4 LT |
18 | |
19 | #ifdef DEBUG | |
e48b1b45 | 20 | printk("%s: %p %p %p %p\n", __func__, frD, frA, frB, frC); |
1da177e4 LT |
21 | #endif |
22 | ||
d2b194ed KG |
23 | FP_UNPACK_DP(A, frA); |
24 | FP_UNPACK_DP(B, frB); | |
25 | FP_UNPACK_DP(C, frC); | |
1da177e4 LT |
26 | |
27 | #ifdef DEBUG | |
28 | printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); | |
29 | printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); | |
30 | printk("C: %ld %lu %lu %ld (%ld)\n", C_s, C_f1, C_f0, C_e, C_c); | |
31 | #endif | |
32 | ||
33 | if ((A_c == FP_CLS_INF && C_c == FP_CLS_ZERO) || | |
34 | (A_c == FP_CLS_ZERO && C_c == FP_CLS_INF)) | |
033b8a33 | 35 | FP_SET_EXCEPTION(EFLAG_VXIMZ); |
1da177e4 LT |
36 | |
37 | FP_MUL_D(T, A, C); | |
38 | ||
39 | if (T_s != B_s && T_c == FP_CLS_INF && B_c == FP_CLS_INF) | |
033b8a33 | 40 | FP_SET_EXCEPTION(EFLAG_VXISI); |
1da177e4 LT |
41 | |
42 | FP_ADD_D(R, T, B); | |
43 | ||
44 | #ifdef DEBUG | |
45 | printk("D: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c); | |
46 | #endif | |
47 | ||
d2b194ed KG |
48 | __FP_PACK_D(frD, R); |
49 | ||
50 | return FP_CUR_EXCEPTIONS; | |
1da177e4 | 51 | } |