Orange Pi5 kernel

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