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 __uint64_t fenv_t;
39 typedef __uint64_t fexcept_t;
42 #define FE_INVALID 0x00000001
43 #define FE_DIVBYZERO 0x00000002
44 #define FE_OVERFLOW 0x00000004
45 #define FE_UNDERFLOW 0x00000008
46 #define FE_INEXACT 0x00000010
47 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
48 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW)
53 * We can't just use the hardware bit values here, because that would
54 * make FE_UPWARD and FE_DOWNWARD negative, which is not allowed.
56 #define FE_TONEAREST 0x0
58 #define FE_DOWNWARD 0x2
59 #define FE_TOWARDZERO 0x3
60 #define _ROUND_MASK (FE_TONEAREST | FE_DOWNWARD | \
61 FE_UPWARD | FE_TOWARDZERO)
62 #define _ROUND_SHIFT 22
66 /* Default floating-point environment */
67 extern const fenv_t __fe_dfl_env;
68 #define FE_DFL_ENV (&__fe_dfl_env)
70 /* We need to be able to map status flag positions to mask flag positions */
71 #define _FPUSW_SHIFT 8
72 #define _ENABLE_MASK (FE_ALL_EXCEPT << _FPUSW_SHIFT)
74 #define __mrs_fpcr(__r) __asm __volatile("mrs %0, fpcr" : "=r" (__r))
75 #define __msr_fpcr(__r) __asm __volatile("msr fpcr, %0" : : "r" (__r))
77 #define __mrs_fpsr(__r) __asm __volatile("mrs %0, fpsr" : "=r" (__r))
78 #define __msr_fpsr(__r) __asm __volatile("msr fpsr, %0" : : "r" (__r))
80 __fenv_static __inline int
81 feclearexcept(int __excepts)
91 __fenv_static inline int
92 fegetexceptflag(fexcept_t *__flagp, int __excepts)
97 *__flagp = __r & __excepts;
101 __fenv_static inline int
102 fesetexceptflag(const fexcept_t *__flagp, int __excepts)
108 __r |= *__flagp & __excepts;
113 __fenv_static inline int
114 feraiseexcept(int __excepts)
124 __fenv_static inline int
125 fetestexcept(int __excepts)
130 return (__r & __excepts);
133 __fenv_static inline int
139 return ((__r >> _ROUND_SHIFT) & _ROUND_MASK);
142 __fenv_static inline int
143 fesetround(int __round)
147 if (__round & ~_ROUND_MASK)
150 __r &= ~(_ROUND_MASK << _ROUND_SHIFT);
151 __r |= __round << _ROUND_SHIFT;
156 __fenv_static inline int
157 fegetenv(fenv_t *__envp)
162 *__envp = __r & _ENABLE_MASK;
165 *__envp |= __r & (FE_ALL_EXCEPT | (_ROUND_MASK << _ROUND_SHIFT));
170 __fenv_static inline int
171 feholdexcept(fenv_t *__envp)
176 *__envp = __r & _ENABLE_MASK;
177 __r &= ~(_ENABLE_MASK);
181 *__envp |= __r & (FE_ALL_EXCEPT | (_ROUND_MASK << _ROUND_SHIFT));
182 __r &= ~(_ENABLE_MASK);
187 __fenv_static inline int
188 fesetenv(const fenv_t *__envp)
191 __msr_fpcr((*__envp) & _ENABLE_MASK);
192 __msr_fpsr((*__envp) & (FE_ALL_EXCEPT | (_ROUND_MASK << _ROUND_SHIFT)));
196 __fenv_static inline int
197 feupdateenv(const fenv_t *__envp)
203 feraiseexcept(__r & FE_ALL_EXCEPT);
209 /* We currently provide no external definitions of the functions below. */
212 feenableexcept(int __mask)
214 fenv_t __old_r, __new_r;
217 __new_r = __old_r | ((__mask & FE_ALL_EXCEPT) << _FPUSW_SHIFT);
219 return ((__old_r >> _FPUSW_SHIFT) & FE_ALL_EXCEPT);
223 fedisableexcept(int __mask)
225 fenv_t __old_r, __new_r;
228 __new_r = __old_r & ~((__mask & FE_ALL_EXCEPT) << _FPUSW_SHIFT);
230 return ((__old_r >> _FPUSW_SHIFT) & FE_ALL_EXCEPT);
239 return ((__r & _ENABLE_MASK) >> _FPUSW_SHIFT);
242 #endif /* __BSD_VISIBLE */
246 #endif /* !_FENV_H_ */