1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2004-2005 David Schultz <das@FreeBSD.ORG>
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
29 #ifndef _FENV_H_
30 #define _FENV_H_
31
32 #include <sys/cdefs.h>
33 #include <sys/_types.h>
34
35 #ifndef __fenv_static
36 #define __fenv_static static
37 #endif
38
39 typedef __uint32_t fenv_t;
40 typedef __uint32_t fexcept_t;
41
42 /* Exception flags */
43 #define FE_INVALID 0x0001
44 #define FE_DIVBYZERO 0x0002
45 #define FE_OVERFLOW 0x0004
46 #define FE_UNDERFLOW 0x0008
47 #define FE_INEXACT 0x0010
48 #ifdef __ARM_PCS_VFP
49 #define FE_DENORMAL 0x0080
50 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
51 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW | FE_DENORMAL)
52 #else
53 #define FE_ALL_EXCEPT (FE_DIVBYZERO | FE_INEXACT | \
54 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW)
55 #endif
56
57 /* Rounding modes */
58 #define VFP_FE_TONEAREST 0x00000000
59 #define VFP_FE_UPWARD 0x00400000
60 #define VFP_FE_DOWNWARD 0x00800000
61 #define VFP_FE_TOWARDZERO 0x00c00000
62
63 #ifdef __ARM_PCS_VFP
64 #define FE_TONEAREST VFP_FE_TONEAREST
65 #define FE_UPWARD VFP_FE_UPWARD
66 #define FE_DOWNWARD VFP_FE_DOWNWARD
67 #define FE_TOWARDZERO VFP_FE_TOWARDZERO
68 #else
69 #define FE_TONEAREST 0x0000
70 #define FE_TOWARDZERO 0x0001
71 #define FE_UPWARD 0x0002
72 #define FE_DOWNWARD 0x0003
73 #endif
74 #define _ROUND_MASK (FE_TONEAREST | FE_DOWNWARD | \
75 FE_UPWARD | FE_TOWARDZERO)
76 __BEGIN_DECLS
77
78 /* Default floating-point environment */
79 extern const fenv_t __fe_dfl_env;
80 #define FE_DFL_ENV (&__fe_dfl_env)
81
82 /* We need to be able to map status flag positions to mask flag positions */
83 #ifndef __ARM_PCS_VFP
84 #define _FPUSW_SHIFT 16
85 #define _ENABLE_MASK (FE_ALL_EXCEPT << _FPUSW_SHIFT)
86 #endif
87
88 #ifndef __ARM_PCS_VFP
89
90 int feclearexcept(int __excepts);
91 int fegetexceptflag(fexcept_t *__flagp, int __excepts);
92 int fesetexceptflag(const fexcept_t *__flagp, int __excepts);
93 int feraiseexcept(int __excepts);
94 int fetestexcept(int __excepts);
95 int fegetround(void);
96 int fesetround(int __round);
97 int fegetenv(fenv_t *__envp);
98 int feholdexcept(fenv_t *__envp);
99 int fesetenv(const fenv_t *__envp);
100 int feupdateenv(const fenv_t *__envp);
101 #if __BSD_VISIBLE
102 int feenableexcept(int __mask);
103 int fedisableexcept(int __mask);
104 int fegetexcept(void);
105 #endif
106
107 #else /* __ARM_PCS_VFP */
108
109 #define vmrs_fpscr(__r) __asm __volatile("vmrs %0, fpscr" : "=&r"(__r))
110 #define vmsr_fpscr(__r) __asm __volatile("vmsr fpscr, %0" : : "r"(__r))
111
112 #define _FPU_MASK_SHIFT 8
113
114 __fenv_static inline int
feclearexcept(int __excepts)115 feclearexcept(int __excepts)
116 {
117 fexcept_t __fpsr;
118
119 vmrs_fpscr(__fpsr);
120 __fpsr &= ~__excepts;
121 vmsr_fpscr(__fpsr);
122 return (0);
123 }
124
125 __fenv_static inline int
fegetexceptflag(fexcept_t * __flagp,int __excepts)126 fegetexceptflag(fexcept_t *__flagp, int __excepts)
127 {
128 fexcept_t __fpsr;
129
130 vmrs_fpscr(__fpsr);
131 *__flagp = __fpsr & __excepts;
132 return (0);
133 }
134
135 __fenv_static inline int
fesetexceptflag(const fexcept_t * __flagp,int __excepts)136 fesetexceptflag(const fexcept_t *__flagp, int __excepts)
137 {
138 fexcept_t __fpsr;
139
140 vmrs_fpscr(__fpsr);
141 __fpsr &= ~__excepts;
142 __fpsr |= *__flagp & __excepts;
143 vmsr_fpscr(__fpsr);
144 return (0);
145 }
146
147 __fenv_static inline int
feraiseexcept(int __excepts)148 feraiseexcept(int __excepts)
149 {
150 fexcept_t __ex = __excepts;
151
152 fesetexceptflag(&__ex, __excepts); /* XXX */
153 return (0);
154 }
155
156 __fenv_static inline int
fetestexcept(int __excepts)157 fetestexcept(int __excepts)
158 {
159 fexcept_t __fpsr;
160
161 vmrs_fpscr(__fpsr);
162 return (__fpsr & __excepts);
163 }
164
165 __fenv_static inline int
fegetround(void)166 fegetround(void)
167 {
168 fenv_t __fpsr;
169
170 vmrs_fpscr(__fpsr);
171 return (__fpsr & _ROUND_MASK);
172 }
173
174 __fenv_static inline int
fesetround(int __round)175 fesetround(int __round)
176 {
177 fenv_t __fpsr;
178
179 vmrs_fpscr(__fpsr);
180 __fpsr &= ~(_ROUND_MASK);
181 __fpsr |= __round;
182 vmsr_fpscr(__fpsr);
183 return (0);
184 }
185
186 __fenv_static inline int
fegetenv(fenv_t * __envp)187 fegetenv(fenv_t *__envp)
188 {
189
190 vmrs_fpscr(*__envp);
191 return (0);
192 }
193
194 __fenv_static inline int
feholdexcept(fenv_t * __envp)195 feholdexcept(fenv_t *__envp)
196 {
197 fenv_t __env;
198
199 vmrs_fpscr(__env);
200 *__envp = __env;
201 __env &= ~(FE_ALL_EXCEPT);
202 vmsr_fpscr(__env);
203 return (0);
204 }
205
206 __fenv_static inline int
fesetenv(const fenv_t * __envp)207 fesetenv(const fenv_t *__envp)
208 {
209
210 vmsr_fpscr(*__envp);
211 return (0);
212 }
213
214 __fenv_static inline int
feupdateenv(const fenv_t * __envp)215 feupdateenv(const fenv_t *__envp)
216 {
217 fexcept_t __fpsr;
218
219 vmrs_fpscr(__fpsr);
220 vmsr_fpscr(*__envp);
221 feraiseexcept(__fpsr & FE_ALL_EXCEPT);
222 return (0);
223 }
224
225 #if __BSD_VISIBLE
226
227 /* We currently provide no external definitions of the functions below. */
228
229 __fenv_static inline int
feenableexcept(int __mask)230 feenableexcept(int __mask)
231 {
232 fenv_t __old_fpsr, __new_fpsr;
233
234 vmrs_fpscr(__old_fpsr);
235 __new_fpsr = __old_fpsr |
236 ((__mask & FE_ALL_EXCEPT) << _FPU_MASK_SHIFT);
237 vmsr_fpscr(__new_fpsr);
238 return ((__old_fpsr >> _FPU_MASK_SHIFT) & FE_ALL_EXCEPT);
239 }
240
241 __fenv_static inline int
fedisableexcept(int __mask)242 fedisableexcept(int __mask)
243 {
244 fenv_t __old_fpsr, __new_fpsr;
245
246 vmrs_fpscr(__old_fpsr);
247 __new_fpsr = __old_fpsr &
248 ~((__mask & FE_ALL_EXCEPT) << _FPU_MASK_SHIFT);
249 vmsr_fpscr(__new_fpsr);
250 return ((__old_fpsr >> _FPU_MASK_SHIFT) & FE_ALL_EXCEPT);
251 }
252
253 __fenv_static inline int
fegetexcept(void)254 fegetexcept(void)
255 {
256 fenv_t __fpsr;
257
258 vmrs_fpscr(__fpsr);
259 return (__fpsr & FE_ALL_EXCEPT);
260 }
261
262 #endif /* __BSD_VISIBLE */
263
264 #endif /* __ARM_PCS_VFP */
265
266 __END_DECLS
267
268 #endif /* !_FENV_H_ */
269