Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | #include <linux/types.h> |
| 2 | #include <linux/errno.h> |
| 3 | #include <asm/uaccess.h> |
| 4 | |
Kumar Gala | d2b194e | 2008-06-04 02:59:29 -0500 | [diff] [blame] | 5 | #include <asm/sfp-machine.h> |
| 6 | #include <math-emu/soft-fp.h> |
| 7 | #include <math-emu/double.h> |
| 8 | #include <math-emu/single.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 9 | |
| 10 | int |
| 11 | stfs(void *frS, void *ea) |
| 12 | { |
| 13 | FP_DECL_D(A); |
| 14 | FP_DECL_S(R); |
Kumar Gala | d2b194e | 2008-06-04 02:59:29 -0500 | [diff] [blame] | 15 | FP_DECL_EX; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | float f; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | |
| 18 | #ifdef DEBUG |
Harvey Harrison | e48b1b4 | 2008-03-29 08:21:07 +1100 | [diff] [blame] | 19 | printk("%s: S %p, ea %p\n", __func__, frS, ea); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | #endif |
| 21 | |
Kumar Gala | d2b194e | 2008-06-04 02:59:29 -0500 | [diff] [blame] | 22 | FP_UNPACK_DP(A, frS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | |
| 24 | #ifdef DEBUG |
| 25 | printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); |
| 26 | #endif |
| 27 | |
| 28 | FP_CONV(S, D, 1, 2, R, A); |
| 29 | |
| 30 | #ifdef DEBUG |
| 31 | printk("R: %ld %lu %ld (%ld)\n", R_s, R_f, R_e, R_c); |
| 32 | #endif |
| 33 | |
Kumar Gala | d2b194e | 2008-06-04 02:59:29 -0500 | [diff] [blame] | 34 | _FP_PACK_CANONICAL(S, 1, R); |
| 35 | if (!FP_CUR_EXCEPTIONS || !__FPU_TRAP_P(FP_CUR_EXCEPTIONS)) { |
| 36 | _FP_PACK_RAW_1_P(S, &f, R); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | if (copy_to_user(ea, &f, sizeof(float))) |
| 38 | return -EFAULT; |
| 39 | } |
| 40 | |
Kumar Gala | d2b194e | 2008-06-04 02:59:29 -0500 | [diff] [blame] | 41 | return FP_CUR_EXCEPTIONS; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | } |