18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci#include <linux/types.h> 38c2ecf20Sopenharmony_ci#include <linux/errno.h> 48c2ecf20Sopenharmony_ci#include <linux/uaccess.h> 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <asm/sfp-machine.h> 78c2ecf20Sopenharmony_ci#include <math-emu/soft-fp.h> 88c2ecf20Sopenharmony_ci#include <math-emu/double.h> 98c2ecf20Sopenharmony_ci#include <math-emu/single.h> 108c2ecf20Sopenharmony_ci 118c2ecf20Sopenharmony_ciint 128c2ecf20Sopenharmony_cilfs(void *frD, void *ea) 138c2ecf20Sopenharmony_ci{ 148c2ecf20Sopenharmony_ci FP_DECL_D(R); 158c2ecf20Sopenharmony_ci FP_DECL_S(A); 168c2ecf20Sopenharmony_ci FP_DECL_EX; 178c2ecf20Sopenharmony_ci float f; 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_ci#ifdef DEBUG 208c2ecf20Sopenharmony_ci printk("%s: D %p, ea %p\n", __func__, frD, ea); 218c2ecf20Sopenharmony_ci#endif 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_ci if (copy_from_user(&f, ea, sizeof(float))) 248c2ecf20Sopenharmony_ci return -EFAULT; 258c2ecf20Sopenharmony_ci 268c2ecf20Sopenharmony_ci FP_UNPACK_S(A, f); 278c2ecf20Sopenharmony_ci 288c2ecf20Sopenharmony_ci#ifdef DEBUG 298c2ecf20Sopenharmony_ci printk("A: %ld %lu %ld (%ld) [%08lx]\n", A_s, A_f, A_e, A_c, 308c2ecf20Sopenharmony_ci *(unsigned long *)&f); 318c2ecf20Sopenharmony_ci#endif 328c2ecf20Sopenharmony_ci 338c2ecf20Sopenharmony_ci FP_CONV(D, S, 2, 1, R, A); 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci#ifdef DEBUG 368c2ecf20Sopenharmony_ci printk("R: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c); 378c2ecf20Sopenharmony_ci#endif 388c2ecf20Sopenharmony_ci 398c2ecf20Sopenharmony_ci if (R_c == FP_CLS_NAN) { 408c2ecf20Sopenharmony_ci R_e = _FP_EXPMAX_D; 418c2ecf20Sopenharmony_ci _FP_PACK_RAW_2_P(D, frD, R); 428c2ecf20Sopenharmony_ci } else { 438c2ecf20Sopenharmony_ci __FP_PACK_D(frD, R); 448c2ecf20Sopenharmony_ci } 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci return 0; 478c2ecf20Sopenharmony_ci} 48