arch/ppc-all/include/aros/ppc/fenv.h

   1 /*-
   2  * Copyright (c) 2004-2005 David Schultz <das@FreeBSD.ORG>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   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.
  13  *
  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
  24  * SUCH DAMAGE.
  25  *
  26  * $FreeBSD: src/lib/msun/powerpc/fenv.h,v 1.3 2005/03/16 19:03:45 das Exp $
  27  */
  28
  29 #ifndef _FENV_H_
  30 #define _FENV_H_
  31
  32 #ifdef __AROS__
  33 #include <aros/system.h>
  34 #endif
  35 #include <aros/types/int_t.h>
  36
  37 typedef uint32_t        fenv_t;
  38 typedef uint32_t        fexcept_t;
  39
  40 /* Exception flags */
  41 #define FE_INEXACT      0x02000000
  42 #define FE_DIVBYZERO    0x04000000
  43 #define FE_UNDERFLOW    0x08000000
  44 #define FE_OVERFLOW     0x10000000
  45 #define FE_INVALID      0x20000000      /* all types of invalid FP ops */
  46
  47 /*
  48  * The PowerPC architecture has extra invalid flags that indicate the
  49  * specific type of invalid operation occurred.  These flags may be
  50  * tested, set, and cleared---but not masked---separately.  All of
  51  * these bits are cleared when FE_INVALID is cleared, but only
  52  * FE_VXSOFT is set when FE_INVALID is explicitly set in software.
  53  */
  54 #define FE_VXCVI        0x00000100      /* invalid integer convert */
  55 #define FE_VXSQRT       0x00000200      /* square root of a negative */
  56 #define FE_VXSOFT       0x00000400      /* software-requested exception */
  57 #define FE_VXVC         0x00080000      /* ordered comparison involving NaN */
  58 #define FE_VXIMZ        0x00100000      /* inf * 0 */
  59 #define FE_VXZDZ        0x00200000      /* 0 / 0 */
  60 #define FE_VXIDI        0x00400000      /* inf / inf */
  61 #define FE_VXISI        0x00800000      /* inf - inf */
  62 #define FE_VXSNAN       0x01000000      /* operation on a signalling NaN */
  63 #define FE_ALL_INVALID  (FE_VXCVI | FE_VXSQRT | FE_VXSOFT | FE_VXVC | \
  64                          FE_VXIMZ | FE_VXZDZ | FE_VXIDI | FE_VXISI | \
  65                          FE_VXSNAN | FE_INVALID)
  66 #define FE_ALL_EXCEPT   (FE_DIVBYZERO | FE_INEXACT | \
  67                          FE_ALL_INVALID | FE_OVERFLOW | FE_UNDERFLOW)
  68
  69 /* Rounding modes */
  70 #define FE_TONEAREST    0x0000
  71 #define FE_TOWARDZERO   0x0001
  72 #define FE_UPWARD       0x0002
  73 #define FE_DOWNWARD     0x0003
  74 #define _ROUND_MASK     (FE_TONEAREST | FE_DOWNWARD | \
  75                          FE_UPWARD | FE_TOWARDZERO)
  76
  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 #define _FPUSW_SHIFT    22
  85 #define _ENABLE_MASK    ((FE_DIVBYZERO | FE_INEXACT | FE_INVALID | \
  86                          FE_OVERFLOW | FE_UNDERFLOW) >> _FPUSW_SHIFT)
  87
  88 #define __mffs(__env)   __asm __volatile("mffs %0" : "=f" (*(__env)))
  89 #define __mtfsf(__env)  __asm __volatile("mtfsf 255,%0" : : "f" (__env))
  90
  91 union __fpscr {
  92         double __d;
  93         struct {
  94                 uint32_t __junk;
  95                 fenv_t __reg;
  96         } __bits;
  97 };
  98
  99 static __inline int
 100 feclearexcept(int __excepts)
 101 {
 102         union __fpscr __r;
 103
 104         if (__excepts & FE_INVALID)
 105                 __excepts |= FE_ALL_INVALID;
 106         __mffs(&__r.__d);
 107         __r.__bits.__reg &= ~__excepts;
 108         __mtfsf(__r.__d);
 109         return (0);
 110 }
 111
 112 static __inline int
 113 fegetexceptflag(fexcept_t *__flagp, int __excepts)
 114 {
 115         union __fpscr __r;
 116
 117         __mffs(&__r.__d);
 118         *__flagp = __r.__bits.__reg & __excepts;
 119         return (0);
 120 }
 121
 122 static __inline int
 123 fesetexceptflag(const fexcept_t *__flagp, int __excepts)
 124 {
 125         union __fpscr __r;
 126
 127         if (__excepts & FE_INVALID)
 128                 __excepts |= FE_ALL_EXCEPT;
 129         __mffs(&__r.__d);
 130         __r.__bits.__reg &= ~__excepts;
 131         __r.__bits.__reg |= *__flagp & __excepts;
 132         __mtfsf(__r.__d);
 133         return (0);
 134 }
 135
 136 static __inline int
 137 feraiseexcept(int __excepts)
 138 {
 139         union __fpscr __r;
 140
 141         if (__excepts & FE_INVALID)
 142                 __excepts |= FE_VXSOFT;
 143         __mffs(&__r.__d);
 144         __r.__bits.__reg |= __excepts;
 145         __mtfsf(__r.__d);
 146         return (0);
 147 }
 148
 149 static __inline int
 150 fetestexcept(int __excepts)
 151 {
 152         union __fpscr __r;
 153
 154         __mffs(&__r.__d);
 155         return (__r.__bits.__reg & __excepts);
 156 }
 157
 158 static __inline int
 159 fegetround(void)
 160 {
 161         union __fpscr __r;
 162
 163         __mffs(&__r.__d);
 164         return (__r.__bits.__reg & _ROUND_MASK);
 165 }
 166
 167 static __inline int
 168 fesetround(int __round)
 169 {
 170         union __fpscr __r;
 171
 172         if (__round & ~_ROUND_MASK)
 173                 return (-1);
 174         __mffs(&__r.__d);
 175         __r.__bits.__reg &= ~_ROUND_MASK;
 176         __r.__bits.__reg |= __round;
 177         __mtfsf(__r.__d);
 178         return (0);
 179 }
 180
 181 static __inline int
 182 fegetenv(fenv_t *__envp)
 183 {
 184         union __fpscr __r;
 185
 186         __mffs(&__r.__d);
 187         *__envp = __r.__bits.__reg;
 188         return (0);
 189 }
 190
 191 static __inline int
 192 feholdexcept(fenv_t *__envp)
 193 {
 194         union __fpscr __r;
 195
 196         __mffs(&__r.__d);
 197         *__envp = __r.__d;
 198         __r.__bits.__reg &= ~(FE_ALL_EXCEPT | _ENABLE_MASK);
 199         __mtfsf(__r.__d);
 200         return (0);
 201 }
 202
 203 static __inline int
 204 fesetenv(const fenv_t *__envp)
 205 {
 206         union __fpscr __r;
 207
 208         __r.__bits.__reg = *__envp;
 209         __mtfsf(__r.__d);
 210         return (0);
 211 }
 212
 213 static __inline int
 214 feupdateenv(const fenv_t *__envp)
 215 {
 216         union __fpscr __r;
 217
 218         __mffs(&__r.__d);
 219         __r.__bits.__reg &= FE_ALL_EXCEPT;
 220         __r.__bits.__reg |= *__envp;
 221         __mtfsf(__r.__d);
 222         return (0);
 223 }
 224
 225 #if __BSD_VISIBLE
 226
 227 static __inline int
 228 feenableexcept(int __mask)
 229 {
 230         union __fpscr __r;
 231         fenv_t __oldmask;
 232
 233         __mffs(&__r.__d);
 234         __oldmask = __r.__bits.__reg;
 235         __r.__bits.__reg |= (__mask & FE_ALL_EXCEPT) >> _FPUSW_SHIFT;
 236         __mtfsf(__r.__d);
 237         return ((__oldmask & _ENABLE_MASK) << _FPUSW_SHIFT);
 238 }
 239
 240 static __inline int
 241 fedisableexcept(int __mask)
 242 {
 243         union __fpscr __r;
 244         fenv_t __oldmask;
 245
 246         __mffs(&__r.__d);
 247         __oldmask = __r.__bits.__reg;
 248         __r.__bits.__reg &= ~((__mask & FE_ALL_EXCEPT) >> _FPUSW_SHIFT);
 249         __mtfsf(__r.__d);
 250         return ((__oldmask & _ENABLE_MASK) << _FPUSW_SHIFT);
 251 }
 252
 253 static __inline int
 254 fegetexcept(void)
 255 {
 256         union __fpscr __r;
 257
 258         __mffs(&__r.__d);
 259         return ((__r.__bits.__reg & _ENABLE_MASK) << _FPUSW_SHIFT);
 260 }
 261
 262 #endif /* __BSD_VISIBLE */
 263
 264 __END_DECLS
 265
 266 #endif  /* !_FENV_H_ */