#include "sis.h"
extern uint32 _get_sw PARAMS ((void));
extern uint32 _get_cw PARAMS ((void));
static void __setfpucw PARAMS ((unsigned short fpu_control));
int
get_accex()
{
#ifdef sparc
return ((_get_fsr_raw() >> 5) & 0x1F);
#elif i386
uint32 accx;
accx = _get_sw() & 0x3f;
accx = ((accx & 1) << 4) | ((accx & 2) >> 1) | ((accx & 4) >> 1) |
(accx & 8) | ((accx & 16) >> 2) | ((accx & 32) >> 5);
return(accx);
#else
return(0);
#warning no fpu trap support for this target
#endif
}
void
clear_accex()
{
#ifdef sparc
set_fsr((_get_fsr_raw() & ~0x3e0));
#elif i386
asm("
.text
fnclex
");
#else
#warning no fpu trap support for this target
#endif
}
void
set_fsr(fsr)
uint32 fsr;
{
#ifdef sparc
_set_fsr_raw(fsr & ~0x0f800000);
#elif i386
void __setfpucw(unsigned short fpu_control);
uint32 rawfsr;
fsr >>= 30;
switch (fsr) {
case 0:
case 2: break;
case 1: fsr = 3;
case 3: fsr = 1;
}
rawfsr = _get_cw();
rawfsr |= (fsr << 10) | 0x3ff;
__setfpucw(rawfsr);
#else
#warning no fpu trap support for this target
#endif
}
#ifdef sparc
asm("
.text
.align 4
.global __set_fsr_raw,_set_fsr_raw
__set_fsr_raw:
_set_fsr_raw:
save %sp,-104,%sp
st %i0,[%fp+68]
ld [%fp+68], %fsr
mov 0,%i0
ret
restore
.align 4
.global __get_fsr_raw
.global _get_fsr_raw
__get_fsr_raw:
_get_fsr_raw:
save %sp,-104,%sp
st %fsr,[%fp+68]
ld [%fp+68], %i0
ret
restore
");
#elif i386
asm("
.text
.align 8
.globl _get_sw,__get_sw
__get_sw:
_get_sw:
pushl %ebp
movl %esp,%ebp
movl $0,%eax
fnstsw %ax
movl %ebp,%esp
popl %ebp
ret
.align 8
.globl _get_cw,__get_cw
__get_cw:
_get_cw:
pushl %ebp
movl %esp,%ebp
subw $2,%esp
fnstcw -2(%ebp)
movw -2(%ebp),%eax
movl %ebp,%esp
popl %ebp
ret
");
#else
#warning no fpu trap support for this target
#endif
#if i386
#define _FPU_DEFAULT 0x1372
#define _FPU_RESERVED 0xF0C0
static void
__setfpucw(unsigned short fpu_control)
{
volatile unsigned short cw;
if (!fpu_control)
{
fpu_control = _FPU_DEFAULT;
}
__asm__ volatile ("fnstcw %0" : "=m" (cw) : );
cw &= _FPU_RESERVED;
cw = cw | (fpu_control & ~_FPU_RESERVED);
__asm__ volatile ("fldcw %0" :: "m" (cw));
}
#endif