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) fsel(u32 *frD, void *frA, u32 *frB, u32 *frC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	FP_DECL_D(A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	FP_DECL_EX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	printk("%s: %p %p %p %p\n", __func__, frD, frA, frB, frC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	FP_UNPACK_DP(A, frA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	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 24) 	printk("B: %08x %08x\n", frB[0], frB[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	printk("C: %08x %08x\n", frC[0], frC[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	if (A_c == FP_CLS_NAN || (A_c != FP_CLS_ZERO && A_s)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 		frD[0] = frB[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 		frD[1] = frB[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 		frD[0] = frC[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		frD[1] = frC[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	printk("D: %08x.%08x\n", frD[0], frD[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) }