2 * Copyright (c) 2004-2005 David Schultz <das@FreeBSD.ORG>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 #include <sys/_types.h>
35 #define __fenv_static static
38 typedef __uint32_t fenv_t;
39 typedef __uint32_t fexcept_t;
42 #define FE_INVALID 0x0001
43 #define FE_DIVBYZERO 0x0002
44 #define FE_OVERFLOW 0x0004
45 #define FE_UNDERFLOW 0x0008
46 #define FE_INEXACT 0x0010
48 #define FE_DENORMAL 0x0080
49 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
50 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW | FE_DENORMAL)
52 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
53 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW)
58 #define FE_TONEAREST 0x00000000
59 #define FE_UPWARD 0x00400000
60 #define FE_DOWNWARD 0x00800000
61 #define FE_TOWARDZERO 0x00c00000
63 #define FE_TONEAREST 0x0000
64 #define FE_TOWARDZERO 0x0001
65 #define FE_UPWARD 0x0002
66 #define FE_DOWNWARD 0x0003
68 #define _ROUND_MASK (FE_TONEAREST | FE_DOWNWARD | \
69 FE_UPWARD | FE_TOWARDZERO)
72 /* Default floating-point environment */
73 extern const fenv_t __fe_dfl_env;
74 #define FE_DFL_ENV (&__fe_dfl_env)
76 /* We need to be able to map status flag positions to mask flag positions */
78 #define _FPUSW_SHIFT 16
79 #define _ENABLE_MASK (FE_ALL_EXCEPT << _FPUSW_SHIFT)
84 int feclearexcept(int __excepts);
85 int fegetexceptflag(fexcept_t *__flagp, int __excepts);
86 int fesetexceptflag(const fexcept_t *__flagp, int __excepts);
87 int feraiseexcept(int __excepts);
88 int fetestexcept(int __excepts);
90 int fesetround(int __round);
91 int fegetenv(fenv_t *__envp);
92 int feholdexcept(fenv_t *__envp);
93 int fesetenv(const fenv_t *__envp);
94 int feupdateenv(const fenv_t *__envp);
96 #else /* __ARM_PCS_VFP */
98 #define vmrs_fpscr(__r) __asm __volatile("vmrs %0, fpscr" : "=&r"(__r))
99 #define vmsr_fpscr(__r) __asm __volatile("vmsr fpscr, %0" : : "r"(__r))
101 #define _FPU_MASK_SHIFT 8
103 __fenv_static inline int
104 feclearexcept(int __excepts)
109 __fpsr &= ~__excepts;
114 __fenv_static inline int
115 fegetexceptflag(fexcept_t *__flagp, int __excepts)
120 *__flagp = __fpsr & __excepts;
124 __fenv_static inline int
125 fesetexceptflag(const fexcept_t *__flagp, int __excepts)
130 __fpsr &= ~__excepts;
131 __fpsr |= *__flagp & __excepts;
136 __fenv_static inline int
137 feraiseexcept(int __excepts)
139 fexcept_t __ex = __excepts;
141 fesetexceptflag(&__ex, __excepts); /* XXX */
145 __fenv_static inline int
146 fetestexcept(int __excepts)
151 return (__fpsr & __excepts);
154 __fenv_static inline int
160 return (__fpsr & _ROUND_MASK);
163 __fenv_static inline int
164 fesetround(int __round)
169 __fpsr &= ~(_ROUND_MASK);
175 __fenv_static inline int
176 fegetenv(fenv_t *__envp)
183 __fenv_static inline int
184 feholdexcept(fenv_t *__envp)
190 __env &= ~(FE_ALL_EXCEPT);
195 __fenv_static inline int
196 fesetenv(const fenv_t *__envp)
203 __fenv_static inline int
204 feupdateenv(const fenv_t *__envp)
210 feraiseexcept(__fpsr & FE_ALL_EXCEPT);
216 /* We currently provide no external definitions of the functions below. */
218 __fenv_static inline int
219 feenableexcept(int __mask)
221 fenv_t __old_fpsr, __new_fpsr;
223 vmrs_fpscr(__old_fpsr);
224 __new_fpsr = __old_fpsr |
225 ((__mask & FE_ALL_EXCEPT) << _FPU_MASK_SHIFT);
226 vmsr_fpscr(__new_fpsr);
227 return ((__old_fpsr >> _FPU_MASK_SHIFT) & FE_ALL_EXCEPT);
230 __fenv_static inline int
231 fedisableexcept(int __mask)
233 fenv_t __old_fpsr, __new_fpsr;
235 vmrs_fpscr(__old_fpsr);
236 __new_fpsr = __old_fpsr &
237 ~((__mask & FE_ALL_EXCEPT) << _FPU_MASK_SHIFT);
238 vmsr_fpscr(__new_fpsr);
239 return ((__old_fpsr >> _FPU_MASK_SHIFT) & FE_ALL_EXCEPT);
242 __fenv_static inline int
248 return (__fpsr & FE_ALL_EXCEPT);
251 #endif /* __BSD_VISIBLE */
253 #endif /* __ARM_PCS_VFP */
257 #endif /* !_FENV_H_ */