1*e415d488SLionel Sambuc /* $NetBSD: fpsetmask.c,v 1.6 2012/03/21 00:38:34 christos Exp $ */ 22fe8fb19SBen Gras 32fe8fb19SBen Gras /* 42fe8fb19SBen Gras * Written by J.T. Conklin, Apr 10, 1995 52fe8fb19SBen Gras * Public domain. 62fe8fb19SBen Gras */ 72fe8fb19SBen Gras 82fe8fb19SBen Gras #include <sys/cdefs.h> 92fe8fb19SBen Gras #if defined(LIBC_SCCS) && !defined(lint) 10*e415d488SLionel Sambuc __RCSID("$NetBSD: fpsetmask.c,v 1.6 2012/03/21 00:38:34 christos Exp $"); 112fe8fb19SBen Gras #endif /* LIBC_SCCS and not lint */ 122fe8fb19SBen Gras 132fe8fb19SBen Gras #include "namespace.h" 142fe8fb19SBen Gras 152fe8fb19SBen Gras #include <ieeefp.h> 162fe8fb19SBen Gras 172fe8fb19SBen Gras #ifdef __weak_alias __weak_alias(fpsetmask,_fpsetmask)182fe8fb19SBen Gras__weak_alias(fpsetmask,_fpsetmask) 192fe8fb19SBen Gras #endif 202fe8fb19SBen Gras 212fe8fb19SBen Gras fp_except 22*e415d488SLionel Sambuc fpsetmask(fp_except mask) 232fe8fb19SBen Gras { 242fe8fb19SBen Gras fp_except old; 252fe8fb19SBen Gras fp_except new; 262fe8fb19SBen Gras 272fe8fb19SBen Gras __asm("st %%fsr,%0" : "=m" (*&old)); 282fe8fb19SBen Gras 292fe8fb19SBen Gras new = old; 302fe8fb19SBen Gras new &= ~(0x1f << 23); 312fe8fb19SBen Gras new |= ((mask & 0x1f) << 23); 322fe8fb19SBen Gras 332fe8fb19SBen Gras __asm("ld %0,%%fsr" : : "m" (*&new)); 342fe8fb19SBen Gras 352fe8fb19SBen Gras return (old >> 23) & 0x1f; 362fe8fb19SBen Gras } 37