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_ */