162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci#include <linux/types.h> 362306a36Sopenharmony_ci#include <linux/errno.h> 462306a36Sopenharmony_ci#include <linux/uaccess.h> 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <asm/sfp-machine.h> 762306a36Sopenharmony_ci#include <math-emu/soft-fp.h> 862306a36Sopenharmony_ci#include <math-emu/double.h> 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ciint 1162306a36Sopenharmony_cifctiwz(u32 *frD, void *frB) 1262306a36Sopenharmony_ci{ 1362306a36Sopenharmony_ci FP_DECL_D(B); 1462306a36Sopenharmony_ci FP_DECL_EX; 1562306a36Sopenharmony_ci u32 fpscr; 1662306a36Sopenharmony_ci unsigned int r; 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci fpscr = __FPU_FPSCR; 1962306a36Sopenharmony_ci __FPU_FPSCR &= ~(3); 2062306a36Sopenharmony_ci __FPU_FPSCR |= FP_RND_ZERO; 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_ci FP_UNPACK_DP(B, frB); 2362306a36Sopenharmony_ci FP_TO_INT_D(r, B, 32, 1); 2462306a36Sopenharmony_ci frD[1] = r; 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci __FPU_FPSCR = fpscr; 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ci#ifdef DEBUG 2962306a36Sopenharmony_ci printk("%s: D %p, B %p: ", __func__, frD, frB); 3062306a36Sopenharmony_ci dump_double(frD); 3162306a36Sopenharmony_ci printk("\n"); 3262306a36Sopenharmony_ci#endif 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci return 0; 3562306a36Sopenharmony_ci} 36