xref: /openbmc/linux/arch/powerpc/math-emu/fmadd.c (revision 5cd27208)
15cd27208SKumar Gala #include <linux/types.h>
25cd27208SKumar Gala #include <linux/errno.h>
35cd27208SKumar Gala #include <asm/uaccess.h>
45cd27208SKumar Gala 
55cd27208SKumar Gala #include "soft-fp.h"
65cd27208SKumar Gala #include "double.h"
75cd27208SKumar Gala 
85cd27208SKumar Gala int
95cd27208SKumar Gala fmadd(void *frD, void *frA, void *frB, void *frC)
105cd27208SKumar Gala {
115cd27208SKumar Gala 	FP_DECL_D(R);
125cd27208SKumar Gala 	FP_DECL_D(A);
135cd27208SKumar Gala 	FP_DECL_D(B);
145cd27208SKumar Gala 	FP_DECL_D(C);
155cd27208SKumar Gala 	FP_DECL_D(T);
165cd27208SKumar Gala 	int ret = 0;
175cd27208SKumar Gala 
185cd27208SKumar Gala #ifdef DEBUG
195cd27208SKumar Gala 	printk("%s: %p %p %p %p\n", __FUNCTION__, frD, frA, frB, frC);
205cd27208SKumar Gala #endif
215cd27208SKumar Gala 
225cd27208SKumar Gala 	__FP_UNPACK_D(A, frA);
235cd27208SKumar Gala 	__FP_UNPACK_D(B, frB);
245cd27208SKumar Gala 	__FP_UNPACK_D(C, frC);
255cd27208SKumar Gala 
265cd27208SKumar Gala #ifdef DEBUG
275cd27208SKumar Gala 	printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c);
285cd27208SKumar Gala 	printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c);
295cd27208SKumar Gala 	printk("C: %ld %lu %lu %ld (%ld)\n", C_s, C_f1, C_f0, C_e, C_c);
305cd27208SKumar Gala #endif
315cd27208SKumar Gala 
325cd27208SKumar Gala 	if ((A_c == FP_CLS_INF && C_c == FP_CLS_ZERO) ||
335cd27208SKumar Gala 	    (A_c == FP_CLS_ZERO && C_c == FP_CLS_INF))
345cd27208SKumar Gala                 ret |= EFLAG_VXIMZ;
355cd27208SKumar Gala 
365cd27208SKumar Gala 	FP_MUL_D(T, A, C);
375cd27208SKumar Gala 
385cd27208SKumar Gala 	if (T_s != B_s && T_c == FP_CLS_INF && B_c == FP_CLS_INF)
395cd27208SKumar Gala 		ret |= EFLAG_VXISI;
405cd27208SKumar Gala 
415cd27208SKumar Gala 	FP_ADD_D(R, T, B);
425cd27208SKumar Gala 
435cd27208SKumar Gala #ifdef DEBUG
445cd27208SKumar Gala 	printk("D: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c);
455cd27208SKumar Gala #endif
465cd27208SKumar Gala 
475cd27208SKumar Gala 	return (ret | __FP_PACK_D(frD, R));
485cd27208SKumar Gala }
49