xref: /netbsd-src/lib/libc/arch/hppa/gen/fpsetmask.c (revision 5b9a421677efb9106380328eb6c45d66c997589f)
1*5b9a4216Sskrll /*	$NetBSD: fpsetmask.c,v 1.6 2012/03/23 09:34:09 skrll Exp $	*/
295a63d48Schs 
395a63d48Schs /*	$OpenBSD: fpsetmask.c,v 1.4 2004/01/05 06:06:16 otto Exp $	*/
495a63d48Schs 
595a63d48Schs /*
695a63d48Schs  * Written by Miodrag Vallat.  Public domain
795a63d48Schs  */
895a63d48Schs 
988c3eadbSlukem #include <sys/cdefs.h>
1088c3eadbSlukem #if defined(LIBC_SCCS) && !defined(lint)
11*5b9a4216Sskrll __RCSID("$NetBSD: fpsetmask.c,v 1.6 2012/03/23 09:34:09 skrll Exp $");
1288c3eadbSlukem #endif /* LIBC_SCCS and not lint */
1388c3eadbSlukem 
1495a63d48Schs #include <sys/types.h>
1595a63d48Schs #include <ieeefp.h>
1695a63d48Schs 
1795a63d48Schs fp_except
fpsetmask(fp_except mask)1895a63d48Schs fpsetmask(fp_except mask)
1995a63d48Schs {
2095a63d48Schs 	uint64_t fpsr;
2195a63d48Schs 	fp_except old;
2295a63d48Schs 
2314c5fc5dSskrll 	__asm volatile("fstd %%fr0,0(%1)" : "=m"(fpsr) : "r"(&fpsr) : "memory");
24*5b9a4216Sskrll 	old = (fp_except)(fpsr >> 32) & 0x1f;
2595a63d48Schs 	fpsr = (fpsr & 0xffffffe000000000LL) | ((uint64_t)(mask & 0x1f) << 32);
2614c5fc5dSskrll 	__asm volatile("fldd 0(%0),%%fr0" : : "r"(&fpsr) : "memory");
2795a63d48Schs 	return (old);
2895a63d48Schs }
29