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) fctiwz(u32 *frD, void *frB)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	FP_DECL_D(B);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	FP_DECL_EX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 	u32 fpscr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	unsigned int r;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	fpscr = __FPU_FPSCR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	__FPU_FPSCR &= ~(3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	__FPU_FPSCR |= FP_RND_ZERO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	FP_UNPACK_DP(B, frB);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	FP_TO_INT_D(r, B, 32, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	frD[1] = r;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	__FPU_FPSCR = fpscr;
^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("%s: D %p, B %p: ", __func__, frD, frB);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	dump_double(frD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	printk("\n");
^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) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) }