1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3 *
4 * Copyright (c) 2004-2005 David Schultz <[email protected]>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 *
28 * $FreeBSD$
29 */
30
31 #ifndef _FENV_H_
32 #define _FENV_H_
33
34 #include <sys/_types.h>
35
36 #ifndef __fenv_static
37 #define __fenv_static static
38 #endif
39
40 typedef __uint32_t fenv_t;
41 typedef __uint32_t fexcept_t;
42
43 /* Exception flags */
44 #define FE_INVALID 0x0001
45 #define FE_DIVBYZERO 0x0002
46 #define FE_OVERFLOW 0x0004
47 #define FE_UNDERFLOW 0x0008
48 #define FE_INEXACT 0x0010
49 #ifdef __ARM_PCS_VFP
50 #define FE_DENORMAL 0x0080
51 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
52 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW | FE_DENORMAL)
53 #else
54 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
55 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW)
56 #endif
57
58 /* Rounding modes */
59 #define VFP_FE_TONEAREST 0x00000000
60 #define VFP_FE_UPWARD 0x00400000
61 #define VFP_FE_DOWNWARD 0x00800000
62 #define VFP_FE_TOWARDZERO 0x00c00000
63
64 #ifdef __ARM_PCS_VFP
65 #define FE_TONEAREST VFP_FE_TONEAREST
66 #define FE_UPWARD VFP_FE_UPWARD
67 #define FE_DOWNWARD VFP_FE_DOWNWARD
68 #define FE_TOWARDZERO VFP_FE_TOWARDZERO
69 #else
70 #define FE_TONEAREST 0x0000
71 #define FE_TOWARDZERO 0x0001
72 #define FE_UPWARD 0x0002
73 #define FE_DOWNWARD 0x0003
74 #endif
75 #define _ROUND_MASK (FE_TONEAREST | FE_DOWNWARD | \
76 FE_UPWARD | FE_TOWARDZERO)
77 __BEGIN_DECLS
78
79 /* Default floating-point environment */
80 extern const fenv_t __fe_dfl_env;
81 #define FE_DFL_ENV (&__fe_dfl_env)
82
83 /* We need to be able to map status flag positions to mask flag positions */
84 #ifndef __ARM_PCS_VFP
85 #define _FPUSW_SHIFT 16
86 #define _ENABLE_MASK (FE_ALL_EXCEPT << _FPUSW_SHIFT)
87 #endif
88
89 #ifndef __ARM_PCS_VFP
90
91 int feclearexcept(int __excepts);
92 int fegetexceptflag(fexcept_t *__flagp, int __excepts);
93 int fesetexceptflag(const fexcept_t *__flagp, int __excepts);
94 int feraiseexcept(int __excepts);
95 int fetestexcept(int __excepts);
96 int fegetround(void);
97 int fesetround(int __round);
98 int fegetenv(fenv_t *__envp);
99 int feholdexcept(fenv_t *__envp);
100 int fesetenv(const fenv_t *__envp);
101 int feupdateenv(const fenv_t *__envp);
102 #if __BSD_VISIBLE
103 int feenableexcept(int __mask);
104 int fedisableexcept(int __mask);
105 int fegetexcept(void);
106 #endif
107
108 #else /* __ARM_PCS_VFP */
109
110 #define vmrs_fpscr(__r) __asm __volatile("vmrs %0, fpscr" : "=&r"(__r))
111 #define vmsr_fpscr(__r) __asm __volatile("vmsr fpscr, %0" : : "r"(__r))
112
113 #define _FPU_MASK_SHIFT 8
114
115 __fenv_static inline int
feclearexcept(int __excepts)116 feclearexcept(int __excepts)
117 {
118 fexcept_t __fpsr;
119
120 vmrs_fpscr(__fpsr);
121 __fpsr &= ~__excepts;
122 vmsr_fpscr(__fpsr);
123 return (0);
124 }
125
126 __fenv_static inline int
fegetexceptflag(fexcept_t * __flagp,int __excepts)127 fegetexceptflag(fexcept_t *__flagp, int __excepts)
128 {
129 fexcept_t __fpsr;
130
131 vmrs_fpscr(__fpsr);
132 *__flagp = __fpsr & __excepts;
133 return (0);
134 }
135
136 __fenv_static inline int
fesetexceptflag(const fexcept_t * __flagp,int __excepts)137 fesetexceptflag(const fexcept_t *__flagp, int __excepts)
138 {
139 fexcept_t __fpsr;
140
141 vmrs_fpscr(__fpsr);
142 __fpsr &= ~__excepts;
143 __fpsr |= *__flagp & __excepts;
144 vmsr_fpscr(__fpsr);
145 return (0);
146 }
147
148 __fenv_static inline int
feraiseexcept(int __excepts)149 feraiseexcept(int __excepts)
150 {
151 fexcept_t __ex = __excepts;
152
153 fesetexceptflag(&__ex, __excepts); /* XXX */
154 return (0);
155 }
156
157 __fenv_static inline int
fetestexcept(int __excepts)158 fetestexcept(int __excepts)
159 {
160 fexcept_t __fpsr;
161
162 vmrs_fpscr(__fpsr);
163 return (__fpsr & __excepts);
164 }
165
166 __fenv_static inline int
fegetround(void)167 fegetround(void)
168 {
169 fenv_t __fpsr;
170
171 vmrs_fpscr(__fpsr);
172 return (__fpsr & _ROUND_MASK);
173 }
174
175 __fenv_static inline int
fesetround(int __round)176 fesetround(int __round)
177 {
178 fenv_t __fpsr;
179
180 vmrs_fpscr(__fpsr);
181 __fpsr &= ~(_ROUND_MASK);
182 __fpsr |= __round;
183 vmsr_fpscr(__fpsr);
184 return (0);
185 }
186
187 __fenv_static inline int
fegetenv(fenv_t * __envp)188 fegetenv(fenv_t *__envp)
189 {
190
191 vmrs_fpscr(*__envp);
192 return (0);
193 }
194
195 __fenv_static inline int
feholdexcept(fenv_t * __envp)196 feholdexcept(fenv_t *__envp)
197 {
198 fenv_t __env;
199
200 vmrs_fpscr(__env);
201 *__envp = __env;
202 __env &= ~(FE_ALL_EXCEPT);
203 vmsr_fpscr(__env);
204 return (0);
205 }
206
207 __fenv_static inline int
fesetenv(const fenv_t * __envp)208 fesetenv(const fenv_t *__envp)
209 {
210
211 vmsr_fpscr(*__envp);
212 return (0);
213 }
214
215 __fenv_static inline int
feupdateenv(const fenv_t * __envp)216 feupdateenv(const fenv_t *__envp)
217 {
218 fexcept_t __fpsr;
219
220 vmrs_fpscr(__fpsr);
221 vmsr_fpscr(*__envp);
222 feraiseexcept(__fpsr & FE_ALL_EXCEPT);
223 return (0);
224 }
225
226 #if __BSD_VISIBLE
227
228 /* We currently provide no external definitions of the functions below. */
229
230 __fenv_static inline int
feenableexcept(int __mask)231 feenableexcept(int __mask)
232 {
233 fenv_t __old_fpsr, __new_fpsr;
234
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);
240 }
241
242 __fenv_static inline int
fedisableexcept(int __mask)243 fedisableexcept(int __mask)
244 {
245 fenv_t __old_fpsr, __new_fpsr;
246
247 vmrs_fpscr(__old_fpsr);
248 __new_fpsr = __old_fpsr &
249 ~((__mask & FE_ALL_EXCEPT) << _FPU_MASK_SHIFT);
250 vmsr_fpscr(__new_fpsr);
251 return ((__old_fpsr >> _FPU_MASK_SHIFT) & FE_ALL_EXCEPT);
252 }
253
254 __fenv_static inline int
fegetexcept(void)255 fegetexcept(void)
256 {
257 fenv_t __fpsr;
258
259 vmrs_fpscr(__fpsr);
260 return (__fpsr & FE_ALL_EXCEPT);
261 }
262
263 #endif /* __BSD_VISIBLE */
264
265 #endif /* __ARM_PCS_VFP */
266
267 __END_DECLS
268
269 #endif /* !_FENV_H_ */
270