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(to: ea, from: &f, n: sizeof(float))) |
39 | return -EFAULT; |
40 | } |
41 | |
42 | return FP_CUR_EXCEPTIONS; |
43 | } |
44 | |