rjw | 1f88458 | 2022-01-06 17:20:42 +0800 | [diff] [blame^] | 1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | #include <linux/types.h> |
| 3 | #include <linux/errno.h> |
| 4 | #include <linux/uaccess.h> |
| 5 | |
| 6 | #include <asm/sfp-machine.h> |
| 7 | #include <math-emu/soft-fp.h> |
| 8 | #include <math-emu/double.h> |
| 9 | #include <math-emu/single.h> |
| 10 | |
| 11 | int |
| 12 | stfs(void *frS, void *ea) |
| 13 | { |
| 14 | FP_DECL_D(A); |
| 15 | FP_DECL_S(R); |
| 16 | FP_DECL_EX; |
| 17 | float f; |
| 18 | |
| 19 | #ifdef DEBUG |
| 20 | printk("%s: S %p, ea %p\n", __func__, frS, ea); |
| 21 | #endif |
| 22 | |
| 23 | FP_UNPACK_DP(A, frS); |
| 24 | |
| 25 | #ifdef DEBUG |
| 26 | printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); |
| 27 | #endif |
| 28 | |
| 29 | FP_CONV(S, D, 1, 2, R, A); |
| 30 | |
| 31 | #ifdef DEBUG |
| 32 | printk("R: %ld %lu %ld (%ld)\n", R_s, R_f, R_e, R_c); |
| 33 | #endif |
| 34 | |
| 35 | _FP_PACK_CANONICAL(S, 1, R); |
| 36 | if (!FP_CUR_EXCEPTIONS || !__FPU_TRAP_P(FP_CUR_EXCEPTIONS)) { |
| 37 | _FP_PACK_RAW_1_P(S, &f, R); |
| 38 | if (copy_to_user(ea, &f, sizeof(float))) |
| 39 | return -EFAULT; |
| 40 | } |
| 41 | |
| 42 | return FP_CUR_EXCEPTIONS; |
| 43 | } |