fpsetsticky.c revision 1.6
1/*	$NetBSD: fpsetsticky.c,v 1.6 2012/03/17 21:35:06 martin Exp $	*/
2
3/*
4 * Written by J.T. Conklin, Apr 10, 1995
5 * Public domain.
6 */
7
8#include <sys/cdefs.h>
9#if defined(LIBC_SCCS) && !defined(lint)
10__RCSID("$NetBSD: fpsetsticky.c,v 1.6 2012/03/17 21:35:06 martin Exp $");
11#endif /* LIBC_SCCS and not lint */
12
13#include "namespace.h"
14
15#include <sys/types.h>
16#include <ieeefp.h>
17
18#ifdef __weak_alias
19__weak_alias(fpsetsticky,_fpsetsticky)
20#endif
21
22#ifdef EXCEPTIONS_WITH_SOFTFLOAT
23extern fp_except _softfloat_float_exception_flags;
24#endif
25
26fp_except
27fpsetsticky(sticky)
28	fp_except sticky;
29{
30	fp_except old;
31	fp_except new;
32
33	__asm("st %%fsr,%0" : "=m" (*&old));
34
35	new = old;
36	new &= ~(0x1f << 5);
37	new |= ((sticky & 0x1f) << 5);
38
39	__asm("ld %0,%%fsr" : : "m" (*&new));
40
41	old = ((uint32_t)old >> 5) & 0x1f;
42
43#ifdef EXCEPTIONS_WITH_SOFTFLOAT
44	old |= _softfloat_float_exception_flags;
45	_softfloat_float_exception_flags = sticky;
46#endif
47	return old;
48}
49