blob: 62bd25264fb5548bd27b697b6f4ebc64b1900125 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001#include <linux/types.h>
2#include <linux/errno.h>
Linus Torvalds7c0f6ba2016-12-24 11:46:01 -08003#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
Kumar Galad2b194e2008-06-04 02:59:29 -05005#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 Torvalds1da177e2005-04-16 15:20:36 -07009
10int
11stfs(void *frS, void *ea)
12{
13 FP_DECL_D(A);
14 FP_DECL_S(R);
Kumar Galad2b194e2008-06-04 02:59:29 -050015 FP_DECL_EX;
Linus Torvalds1da177e2005-04-16 15:20:36 -070016 float f;
Linus Torvalds1da177e2005-04-16 15:20:36 -070017
18#ifdef DEBUG
Harvey Harrisone48b1b42008-03-29 08:21:07 +110019 printk("%s: S %p, ea %p\n", __func__, frS, ea);
Linus Torvalds1da177e2005-04-16 15:20:36 -070020#endif
21
Kumar Galad2b194e2008-06-04 02:59:29 -050022 FP_UNPACK_DP(A, frS);
Linus Torvalds1da177e2005-04-16 15:20:36 -070023
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 Galad2b194e2008-06-04 02:59:29 -050034 _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 Torvalds1da177e2005-04-16 15:20:36 -070037 if (copy_to_user(ea, &f, sizeof(float)))
38 return -EFAULT;
39 }
40
Kumar Galad2b194e2008-06-04 02:59:29 -050041 return FP_CUR_EXCEPTIONS;
Linus Torvalds1da177e2005-04-16 15:20:36 -070042}