1 /* 2 * CDDL HEADER START 3 * 4 * The contents of this file are subject to the terms of the 5 * Common Development and Distribution License (the "License"). 6 * You may not use this file except in compliance with the License. 7 * 8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 9 * or http://www.opensolaris.org/os/licensing. 10 * See the License for the specific language governing permissions 11 * and limitations under the License. 12 * 13 * When distributing Covered Code, include this CDDL HEADER in each 14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 15 * If applicable, add the following below this CDDL HEADER, with the 16 * fields enclosed by brackets "[]" replaced with your own identifying 17 * information: Portions Copyright [yyyy] [name of copyright owner] 18 * 19 * CDDL HEADER END 20 */ 21 22 /* 23 * Copyright 2006 Sun Microsystems, Inc. All rights reserved. 24 * Use is subject to license terms. 25 */ 26 27 /* 28 * Copyright 2011, Richard Lowe. 29 */ 30 31 /* Functions in this file are duplicated in locallibm.il. Keep them in sync */ 32 33 #ifndef _LIBM_INLINES_H 34 #define _LIBM_INLINES_H 35 36 #ifdef __GNUC__ 37 38 #include <sys/types.h> 39 #include <sys/ieeefp.h> 40 41 #ifdef __cplusplus 42 extern "C" { 43 #endif 44 45 extern __GNU_INLINE double 46 __inline_sqrt(double d) 47 { 48 double ret; 49 50 __asm__ __volatile__("fsqrtd %1,%0\n\t" : "=e" (ret) : "e" (d)); 51 return (ret); 52 } 53 54 extern __GNU_INLINE float 55 __inline_sqrtf(float f) 56 { 57 float ret; 58 59 __asm__ __volatile__("fsqrts %1,%0\n\t" : "=f" (ret) : "f" (f)); 60 return (ret); 61 } 62 63 extern __GNU_INLINE enum fp_class_type 64 fp_classf(float f) 65 { 66 enum fp_class_type ret; 67 uint32_t tmp; 68 69 /* XXX: Separate input and output */ 70 __asm__ __volatile__( 71 "sethi %%hi(0x80000000),%1\n\t" 72 "andncc %2,%1,%0\n\t" 73 "bne 1f\n\t" 74 "nop\n\t" 75 "mov 0,%0\n\t" 76 "ba 2f\n\t" /* x is 0 */ 77 "nop\n\t" 78 "1:\n\t" 79 "sethi %%hi(0x7f800000),%1\n\t" 80 "andcc %0,%1,%%g0\n\t" 81 "bne 1f\n\t" 82 "nop\n\t" 83 "mov 1,%0\n\t" 84 "ba 2f\n\t" /* x is subnormal */ 85 "nop\n\t" 86 "1:\n\t" 87 "cmp %0,%1\n\t" 88 "bge 1f\n\t" 89 "nop\n\t" 90 "mov 2,%0\n\t" 91 "ba 2f\n\t" /* x is normal */ 92 "nop\n\t" 93 "1:\n\t" 94 "bg 1f\n\t" 95 "nop\n\t" 96 "mov 3,%0\n\t" 97 "ba 2f\n\t" /* x is __infinity */ 98 "nop\n\t" 99 "1:\n\t" 100 "sethi %%hi(0x00400000),%1\n\t" 101 "andcc %0,%1,%%g0\n\t" 102 "mov 4,%0\n\t" /* x is quiet NaN */ 103 "bne 2f\n\t" 104 "nop\n\t" 105 "mov 5,%0\n\t" /* x is signaling NaN */ 106 "2:\n\t" 107 : "=r" (ret), "=&r" (tmp) 108 : "r" (f) 109 : "cc"); 110 return (ret); 111 } 112 113 #define _HI_WORD(x) ((uint32_t *)&x)[0] 114 #define _LO_WORD(x) ((uint32_t *)&x)[1] 115 116 extern __GNU_INLINE enum fp_class_type 117 fp_class(double d) 118 { 119 enum fp_class_type ret; 120 uint32_t tmp; 121 122 __asm__ __volatile__( 123 "sethi %%hi(0x80000000),%1\n\t" /* %1 gets 80000000 */ 124 "andn %2,%1,%0\n\t" /* %2-%0 gets abs(x) */ 125 "orcc %0,%3,%%g0\n\t" /* set cc as x is zero/nonzero */ 126 "bne 1f\n\t" /* branch if x is nonzero */ 127 "nop\n\t" 128 "mov 0,%0\n\t" 129 "ba 2f\n\t" /* x is 0 */ 130 "nop\n\t" 131 "1:\n\t" 132 "sethi %%hi(0x7ff00000),%1\n\t" /* %1 gets 7ff00000 */ 133 "andcc %0,%1,%%g0\n\t" /* cc set by __exp field of x */ 134 "bne 1f\n\t" /* branch if normal or max __exp */ 135 "nop\n\t" 136 "mov 1,%0\n\t" 137 "ba 2f\n\t" /* x is subnormal */ 138 "nop\n\t" 139 "1:\n\t" 140 "cmp %0,%1\n\t" 141 "bge 1f\n\t" /* branch if x is max __exp */ 142 "nop\n\t" 143 "mov 2,%0\n\t" 144 "ba 2f\n\t" /* x is normal */ 145 "nop\n\t" 146 "1:\n\t" 147 "andn %0,%1,%0\n\t" /* o0 gets msw __significand field */ 148 "orcc %0,%3,%%g0\n\t" /* set cc by OR __significand */ 149 "bne 1f\n\t" /* Branch if __nan */ 150 "nop\n\t" 151 "mov 3,%0\n\t" 152 "ba 2f\n\t" /* x is __infinity */ 153 "nop\n\t" 154 "1:\n\t" 155 "sethi %%hi(0x00080000),%1\n\t" 156 "andcc %0,%1,%%g0\n\t" /* set cc by quiet/sig bit */ 157 "be 1f\n\t" /* Branch if signaling */ 158 "nop\n\t" 159 "mov 4,%0\n\t" /* x is quiet NaN */ 160 "ba 2f\n\t" 161 "nop\n\t" 162 "1:\n\t" 163 "mov 5,%0\n\t" /* x is signaling NaN */ 164 "2:\n\t" 165 : "=&r" (ret), "=&r" (tmp) 166 : "r" (_HI_WORD(d)), "r" (_LO_WORD(d)) 167 : "cc"); 168 169 return (ret); 170 } 171 172 extern __GNU_INLINE int 173 __swapEX(int i) 174 { 175 int ret; 176 uint32_t fsr; 177 uint32_t tmp1, tmp2; 178 179 __asm__ __volatile__( 180 "and %4,0x1f,%2\n\t" /* tmp1 = %2 = %o1 */ 181 "sll %2,5,%2\n\t" /* shift input to aexc bit location */ 182 ".volatile\n\t" 183 "st %%fsr,%1\n\t" 184 "ld %1,%0\n\t" /* %0 = fsr */ 185 "andn %0,0x3e0,%3\n\t" /* tmp2 = %3 = %o2 */ 186 "or %2,%3,%2\n\t" /* %2 = new fsr */ 187 "st %2,%1\n\t" 188 "ld %1,%%fsr\n\t" 189 "srl %0,5,%0\n\t" 190 "and %0,0x1f,%0\n\t" /* %0 = ret = %o0 */ 191 ".nonvolatile\n\t" 192 : "=r" (ret), "=m" (fsr), "=r" (tmp1), "=r" (tmp2) 193 : "r" (i) 194 : "cc"); 195 196 return (ret); 197 } 198 199 /* 200 * On the SPARC, __swapRP is a no-op; always return 0 for backward 201 * compatibility 202 */ 203 /* ARGSUSED */ 204 extern __GNU_INLINE enum fp_precision_type 205 __swapRP(enum fp_precision_type i) 206 { 207 return (0); 208 } 209 210 extern __GNU_INLINE enum fp_direction_type 211 __swapRD(enum fp_direction_type d) 212 { 213 enum fp_direction_type ret; 214 uint32_t fsr; 215 uint32_t tmp1, tmp2, tmp3; 216 217 __asm__ __volatile__( 218 "and %5,0x3,%0\n\t" 219 "sll %0,30,%2\n\t" /* shift input to RD bit location */ 220 ".volatile\n\t" 221 "st %%fsr,%1\n\t" 222 "ld %1,%0\n\t" /* %0 = fsr */ 223 "set 0xc0000000,%4\n\t" /* mask of rounding direction bits */ 224 "andn %0,%4,%3\n\t" 225 "or %2,%3,%2\n\t" /* %2 = new fsr */ 226 "st %2,%1\n\t" 227 "ld %1,%%fsr\n\t" 228 "srl %0,30,%0\n\t" 229 "and %0,0x3,%0\n\t" 230 ".nonvolatile\n\t" 231 : "=r" (ret), "=m" (fsr), "=r" (tmp1), "=r" (tmp2), "=r" (tmp3) 232 : "r" (d) 233 : "cc"); 234 235 return (ret); 236 } 237 238 extern __GNU_INLINE int 239 __swapTE(int i) 240 { 241 int ret; 242 uint32_t fsr, tmp1, tmp2; 243 244 __asm__ __volatile__( 245 "and %4,0x1f,%0\n\t" 246 "sll %0,23,%2\n\t" /* shift input to TEM bit location */ 247 ".volatile\n\t" 248 "st %%fsr,%1\n\t" 249 "ld %1,%0\n\t" /* %0 = fsr */ 250 "set 0x0f800000,%3\n\t" /* mask of TEM (Trap Enable Mode bits) */ 251 "andn %0,%3,%3\n\t" 252 "or %2,%3,%2\n\t" /* %2 = new fsr */ 253 "st %2,%1\n\t" 254 "ld %1,%%fsr\n\t" 255 "srl %0,23,%0\n\t" 256 "and %0,0x1f,%0\n\t" 257 ".nonvolatile\n\t" 258 : "=r" (ret), "=m" (fsr), "=r" (tmp1), "=r" (tmp2) 259 : "r" (i) 260 : "cc"); 261 262 return (ret); 263 } 264 265 extern __GNU_INLINE double 266 sqrt(double d) 267 { 268 return (__inline_sqrt(d)); 269 } 270 271 extern __GNU_INLINE float 272 sqrtf(float f) 273 { 274 return (__inline_sqrtf(f)); 275 } 276 277 extern __GNU_INLINE double 278 fabs(double d) 279 { 280 double ret; 281 282 __asm__ __volatile__("fabsd %1,%0\n\t" : "=e" (ret) : "e" (d)); 283 return (ret); 284 } 285 286 extern __GNU_INLINE float 287 fabsf(float f) 288 { 289 float ret; 290 291 __asm__ __volatile__("fabss %1,%0\n\t" : "=f" (ret) : "f" (f)); 292 return (ret); 293 } 294 295 #ifdef __cplusplus 296 } 297 #endif 298 299 #endif /* __GNUC */ 300 301 #endif /* _LIBM_INLINES_H */ 302