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#include <math-emu/single.h> 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_ciint 1262306a36Sopenharmony_cilfs(void *frD, void *ea) 1362306a36Sopenharmony_ci{ 1462306a36Sopenharmony_ci FP_DECL_D(R); 1562306a36Sopenharmony_ci FP_DECL_S(A); 1662306a36Sopenharmony_ci FP_DECL_EX; 1762306a36Sopenharmony_ci float f; 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci#ifdef DEBUG 2062306a36Sopenharmony_ci printk("%s: D %p, ea %p\n", __func__, frD, ea); 2162306a36Sopenharmony_ci#endif 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci if (copy_from_user(&f, ea, sizeof(float))) 2462306a36Sopenharmony_ci return -EFAULT; 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci FP_UNPACK_S(A, f); 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ci#ifdef DEBUG 2962306a36Sopenharmony_ci printk("A: %ld %lu %ld (%ld) [%08lx]\n", A_s, A_f, A_e, A_c, 3062306a36Sopenharmony_ci *(unsigned long *)&f); 3162306a36Sopenharmony_ci#endif 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_ci FP_CONV(D, S, 2, 1, R, A); 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci#ifdef DEBUG 3662306a36Sopenharmony_ci printk("R: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c); 3762306a36Sopenharmony_ci#endif 3862306a36Sopenharmony_ci 3962306a36Sopenharmony_ci if (R_c == FP_CLS_NAN) { 4062306a36Sopenharmony_ci R_e = _FP_EXPMAX_D; 4162306a36Sopenharmony_ci _FP_PACK_RAW_2_P(D, frD, R); 4262306a36Sopenharmony_ci } else { 4362306a36Sopenharmony_ci __FP_PACK_D(frD, R); 4462306a36Sopenharmony_ci } 4562306a36Sopenharmony_ci 4662306a36Sopenharmony_ci return 0; 4762306a36Sopenharmony_ci} 48