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
47 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
48 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW)
51 #define FE_TONEAREST 0x0000
52 #define FE_TOWARDZERO 0x0001
53 #define FE_UPWARD 0x0002
54 #define FE_DOWNWARD 0x0003
55 #define _ROUND_MASK (FE_TONEAREST | FE_DOWNWARD | \
56 FE_UPWARD | FE_TOWARDZERO)
59 /* Default floating-point environment */
60 extern const fenv_t __fe_dfl_env;
61 #define FE_DFL_ENV (&__fe_dfl_env)
63 /* We need to be able to map status flag positions to mask flag positions */
64 #define _FPUSW_SHIFT 16
65 #define _ENABLE_MASK (FE_ALL_EXCEPT << _FPUSW_SHIFT)
68 #define __rfs(__fpsr) __asm __volatile("rfs %0" : "=r" (*(__fpsr)))
69 #define __wfs(__fpsr) __asm __volatile("wfs %0" : : "r" (__fpsr))
75 __fenv_static inline int
76 feclearexcept(int __excepts)
86 __fenv_static inline int
87 fegetexceptflag(fexcept_t *__flagp, int __excepts)
92 *__flagp = __fpsr & __excepts;
96 __fenv_static inline int
97 fesetexceptflag(const fexcept_t *__flagp, int __excepts)
102 __fpsr &= ~__excepts;
103 __fpsr |= *__flagp & __excepts;
108 __fenv_static inline int
109 feraiseexcept(int __excepts)
111 fexcept_t __ex = __excepts;
113 fesetexceptflag(&__ex, __excepts); /* XXX */
117 __fenv_static inline int
118 fetestexcept(int __excepts)
123 return (__fpsr & __excepts);
126 __fenv_static inline int
131 * Apparently, the rounding mode is specified as part of the
132 * instruction format on ARM, so the dynamic rounding mode is
133 * indeterminate. Some FPUs may differ.
138 __fenv_static inline int
139 fesetround(int __round)
145 __fenv_static inline int
146 fegetenv(fenv_t *__envp)
153 __fenv_static inline int
154 feholdexcept(fenv_t *__envp)
160 __env &= ~(FE_ALL_EXCEPT | _ENABLE_MASK);
165 __fenv_static inline int
166 fesetenv(const fenv_t *__envp)
173 __fenv_static inline int
174 feupdateenv(const fenv_t *__envp)
180 feraiseexcept(__fpsr & FE_ALL_EXCEPT);
186 /* We currently provide no external definitions of the functions below. */
189 feenableexcept(int __mask)
191 fenv_t __old_fpsr, __new_fpsr;
194 __new_fpsr = __old_fpsr | (__mask & FE_ALL_EXCEPT) << _FPUSW_SHIFT;
196 return ((__old_fpsr >> _FPUSW_SHIFT) & FE_ALL_EXCEPT);
200 fedisableexcept(int __mask)
202 fenv_t __old_fpsr, __new_fpsr;
205 __new_fpsr = __old_fpsr & ~((__mask & FE_ALL_EXCEPT) << _FPUSW_SHIFT);
207 return ((__old_fpsr >> _FPUSW_SHIFT) & FE_ALL_EXCEPT);
216 return ((__fpsr & _ENABLE_MASK) >> _FPUSW_SHIFT);
219 #endif /* __BSD_VISIBLE */
223 #endif /* !_FENV_H_ */