213 lines
4.4 KiB
C
213 lines
4.4 KiB
C
/*
|
|
* This file is part of SIS.
|
|
*
|
|
* SIS, SPARC instruction simulator. Copyright (C) 1995 Jiri Gaisler, European
|
|
* Space Agency
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it under
|
|
* the terms of the GNU General Public License as published by the Free
|
|
* Software Foundation; either version 2 of the License, or (at your option)
|
|
* any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program; if not, write to the Free Software Foundation, Inc., 675
|
|
* Mass Ave, Cambridge, MA 02139, USA.
|
|
*
|
|
*
|
|
* This file implements the interface between the host and the simulated
|
|
* FPU. IEEE trap handling is done as follows:
|
|
* 1. In the host, all IEEE traps are masked
|
|
* 2. After each simulated FPU instruction, check if any exception occured
|
|
* by reading the exception bits from the host FPU status register
|
|
* (get_accex()).
|
|
* 3. Propagate any exceptions to the simulated FSR.
|
|
* 4. Clear host exception bits
|
|
*
|
|
*
|
|
* This can also be done using ieee_flags() library routine on sun.
|
|
*/
|
|
|
|
#include "sis.h"
|
|
|
|
/* Forward declarations */
|
|
|
|
extern uint32 _get_sw PARAMS ((void));
|
|
extern uint32 _get_cw PARAMS ((void));
|
|
static void __setfpucw PARAMS ((unsigned short fpu_control));
|
|
|
|
/* This host dependent routine should return the accrued exceptions */
|
|
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
|
|
|
|
}
|
|
|
|
/* How to clear the accrued exceptions */
|
|
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
|
|
}
|
|
|
|
/* How to map SPARC FSR onto the host */
|
|
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
|
|
}
|
|
|
|
|
|
/* Host dependent support functions */
|
|
|
|
#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
|
|
/* #if defined _WIN32 || defined __GO32__ */
|
|
/* This is so floating exception handling works on NT
|
|
These definitions are from the linux fpu_control.h, which
|
|
doesn't exist on NT.
|
|
|
|
default to:
|
|
- extended precision
|
|
- rounding to nearest
|
|
- exceptions on overflow, zero divide and NaN
|
|
*/
|
|
#define _FPU_DEFAULT 0x1372
|
|
#define _FPU_RESERVED 0xF0C0 /* Reserved bits in cw */
|
|
|
|
static void
|
|
__setfpucw(unsigned short fpu_control)
|
|
{
|
|
volatile unsigned short cw;
|
|
|
|
/* If user supplied _fpu_control, use it ! */
|
|
if (!fpu_control)
|
|
{
|
|
/* use defaults */
|
|
fpu_control = _FPU_DEFAULT;
|
|
}
|
|
/* Get Control Word */
|
|
__asm__ volatile ("fnstcw %0" : "=m" (cw) : );
|
|
|
|
/* mask in */
|
|
cw &= _FPU_RESERVED;
|
|
cw = cw | (fpu_control & ~_FPU_RESERVED);
|
|
|
|
/* set cw */
|
|
__asm__ volatile ("fldcw %0" :: "m" (cw));
|
|
}
|
|
/* #endif */
|
|
#endif
|