1/*	$NetBSD: fenv.h,v 1.6 2020/07/26 08:08:41 simonb Exp $	*/
2
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 * $FreeBSD: head/lib/msun/mips/fenv.h 226218 2011-10-10 15:43:09Z das $
29 */
30
31#ifndef	_MIPS_FENV_H_
32#define	_MIPS_FENV_H_
33
34#include <sys/stdint.h>
35
36/* Exception flags */
37#define	FE_INEXACT	0x0004
38#define	FE_UNDERFLOW	0x0008
39#define	FE_OVERFLOW	0x0010
40#define	FE_DIVBYZERO	0x0020
41#define	FE_INVALID	0x0040
42#define	FE_ALL_EXCEPT	(FE_DIVBYZERO | FE_INEXACT | \
43			 FE_INVALID | FE_OVERFLOW | FE_UNDERFLOW)
44
45/* Rounding modes */
46#define	FE_TONEAREST	0x0000
47#define	FE_TOWARDZERO	0x0001
48#define	FE_UPWARD	0x0002
49#define	FE_DOWNWARD	0x0003
50#define	_ROUND_MASK	(FE_TONEAREST | FE_DOWNWARD | \
51			 FE_UPWARD | FE_TOWARDZERO)
52
53#ifndef __mips_soft_float
54
55#ifndef	__fenv_static
56#define	__fenv_static	static
57#endif
58
59typedef	uint32_t 	fpu_control_t __attribute__((__mode__(__SI__)));
60typedef	fpu_control_t	fenv_t;
61typedef	fpu_control_t	fexcept_t;
62
63__BEGIN_DECLS
64
65/* Default floating-point environment */
66extern const fenv_t	__fe_dfl_env;
67#define	FE_DFL_ENV	(&__fe_dfl_env)
68
69/* We need to be able to map status flag positions to mask flag positions */
70#define	_ENABLE_MASK	(FE_ALL_EXCEPT << _ENABLE_SHIFT)
71#define	_ENABLE_SHIFT    5
72
73static inline fpu_control_t
74__rfs(void)
75{
76	fpu_control_t __fpsr;
77
78	__asm __volatile("cfc1 %0,$31" : "=r" (__fpsr));
79	return __fpsr;
80}
81
82static inline void
83__wfs(fpu_control_t __fpsr)
84{
85
86	__asm __volatile("ctc1 %0,$31" : : "r" (__fpsr));
87}
88
89#if __GNUC_PREREQ__(8, 0)
90#pragma GCC diagnostic push
91#pragma GCC diagnostic ignored "-Wshadow"
92#endif
93
94__fenv_static inline int
95feclearexcept(int __excepts)
96{
97	fexcept_t __fpsr;
98
99	__excepts &= FE_ALL_EXCEPT;
100	__fpsr = __rfs();
101	__fpsr &= ~(__excepts | (__excepts << _ENABLE_SHIFT));
102	__wfs(__fpsr);
103	return 0;
104}
105
106__fenv_static inline int
107fegetexceptflag(fexcept_t *__flagp, int __excepts)
108{
109	fexcept_t __fpsr;
110
111	__fpsr = __rfs();
112	*__flagp = __fpsr & __excepts;
113	return (0);
114}
115
116__fenv_static inline int
117fesetexceptflag(const fexcept_t *__flagp, int __excepts)
118{
119	fexcept_t __fpsr;
120
121	__fpsr = __rfs();
122	__fpsr &= ~__excepts;
123	__fpsr |= *__flagp & __excepts;
124	__wfs(__fpsr);
125	return (0);
126}
127
128__fenv_static inline int
129feraiseexcept(int __excepts)
130{
131	fexcept_t __ex = __excepts;
132
133	fesetexceptflag(&__ex, __excepts);	/* XXX */
134	return (0);
135}
136
137__fenv_static inline int
138fetestexcept(int __excepts)
139{
140	fexcept_t __fpsr;
141
142	__fpsr = __rfs();
143	return (__fpsr & __excepts);
144}
145
146__fenv_static inline int
147fegetround(void)
148{
149	fexcept_t __fpsr;
150
151	__fpsr = __rfs();
152	return __fpsr & _ROUND_MASK;
153}
154
155__fenv_static inline int
156fesetround(int __round)
157{
158	fexcept_t __fpsr;
159
160	if (__round & ~_ROUND_MASK)
161		return 1;
162	__fpsr = __rfs();
163	__fpsr &= ~_ROUND_MASK;
164	__fpsr |= __round;
165	__wfs(__fpsr);
166
167	return 0;
168}
169
170__fenv_static inline int
171fegetenv(fenv_t *__envp)
172{
173
174	*__envp = __rfs();
175	return (0);
176}
177
178__fenv_static inline int
179feholdexcept(fenv_t *__envp)
180{
181	fenv_t __env;
182
183	__env = __rfs();
184	*__envp = __env;
185	__env &= ~(FE_ALL_EXCEPT | _ENABLE_MASK);
186	__wfs(__env);
187	return (0);
188}
189
190__fenv_static inline int
191fesetenv(const fenv_t *__envp)
192{
193
194	__wfs(*__envp);
195	return (0);
196}
197
198__fenv_static inline int
199feupdateenv(const fenv_t *__envp)
200{
201	fexcept_t __fpsr;
202
203	__fpsr = __rfs();
204	__wfs(*__envp);
205	feraiseexcept(__fpsr & FE_ALL_EXCEPT);
206	return (0);
207}
208
209#if __GNUC_PREREQ__(8, 0)
210#pragma GCC diagnostic pop
211#endif
212
213#if defined(_NETBSD_SOURCE) || defined(_GNU_SOURCE)
214
215__fenv_static inline int
216feenableexcept(int __excepts)
217{
218	fenv_t __old_fpsr, __new_fpsr;
219
220	__new_fpsr = __rfs();
221	__old_fpsr = (__new_fpsr & _ENABLE_MASK) >> _ENABLE_SHIFT;
222	__excepts &= FE_ALL_EXCEPT;
223	__new_fpsr |= __excepts << _ENABLE_SHIFT;
224	__wfs(__new_fpsr);
225	return __old_fpsr;
226}
227
228__fenv_static inline int
229fedisableexcept(int __excepts)
230{
231	fenv_t __old_fpsr, __new_fpsr;
232
233	__new_fpsr = __rfs();
234	__old_fpsr = (__new_fpsr & _ENABLE_MASK) >> _ENABLE_SHIFT;
235	__excepts &= FE_ALL_EXCEPT;
236	__new_fpsr &= ~(__excepts << _ENABLE_SHIFT);
237	__wfs(__new_fpsr);
238	return __old_fpsr;
239}
240
241__fenv_static inline int
242fegetexcept(void)
243{
244	fenv_t __fpsr;
245
246	__fpsr = __rfs();
247	return ((__fpsr & _ENABLE_MASK) >> _ENABLE_SHIFT);
248}
249
250#endif /* _NETBSD_SOURCE || _GNU_SOURCE */
251
252__END_DECLS
253
254#endif /* __mips_soft_float */
255
256#endif	/* !_FENV_H_ */
257