Bochs/bochs/cpu/fpu/fpu.cc

644 lines
22 KiB
C++
Raw Normal View History

/////////////////////////////////////////////////////////////////////////
// $Id$
2005-03-21 00:19:38 +03:00
/////////////////////////////////////////////////////////////////////////
//
2013-09-05 22:40:14 +04:00
// Copyright (c) 2003-2013 Stanislav Shwartsman
2007-03-24 00:27:13 +03:00
// Written by Stanislav Shwartsman [sshwarts at sourceforge net]
//
// This library is free software; you can redistribute it and/or
// modify it under the terms of the GNU Lesser General Public
// License as published by the Free Software Foundation; either
// version 2 of the License, or (at your option) any later version.
//
// This library 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
// Lesser General Public License for more details.
//
// You should have received a copy of the GNU Lesser General Public
// License along with this library; if not, write to the Free Software
// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
//
2004-06-18 19:14:50 +04:00
/////////////////////////////////////////////////////////////////////////
#define NEED_CPU_REG_SHORTCUTS 1
#include "bochs.h"
#include "cpu/cpu.h"
#define LOG_THIS BX_CPU_THIS_PTR
#include "iodev/iodev.h"
2004-06-18 19:14:50 +04:00
#define CHECK_PENDING_EXCEPTIONS 1
#if BX_SUPPORT_FPU
2009-04-27 18:00:55 +04:00
void BX_CPU_C::prepareFPU(bxInstruction_c *i, bx_bool check_pending_exceptions)
{
if (BX_CPU_THIS_PTR cr0.get_EM() || BX_CPU_THIS_PTR cr0.get_TS())
exception(BX_NM_EXCEPTION, 0);
2004-06-18 19:14:50 +04:00
if (check_pending_exceptions)
BX_CPU_THIS_PTR FPU_check_pending_exceptions();
2009-04-27 18:00:55 +04:00
}
2004-06-18 19:14:50 +04:00
2009-04-27 18:00:55 +04:00
void BX_CPU_C::FPU_update_last_instruction(bxInstruction_c *i)
{
BX_CPU_THIS_PTR the_i387.foo = i->foo();
2009-04-27 18:00:55 +04:00
BX_CPU_THIS_PTR the_i387.fcs = BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].selector.value;
BX_CPU_THIS_PTR the_i387.fip = BX_CPU_THIS_PTR prev_rip;
2009-04-27 18:00:55 +04:00
if (! i->modC0()) {
BX_CPU_THIS_PTR the_i387.fds = BX_CPU_THIS_PTR sregs[i->seg()].selector.value;
BX_CPU_THIS_PTR the_i387.fdp = RMAddr(i);
}
}
void BX_CPU_C::FPU_check_pending_exceptions(void)
{
2004-06-18 19:14:50 +04:00
if(BX_CPU_THIS_PTR the_i387.get_partial_status() & FPU_SW_Summary)
{
2006-09-08 15:26:04 +04:00
// NE=1 selects the native or internal mode, which generates #MF,
// which is an extension introduced with 80486.
// NE=0 selects the original (backward compatible) FPU error
// handling, which generates an IRQ 13 via the PIC chip.
#if BX_CPU_LEVEL >= 4
if (BX_CPU_THIS_PTR cr0.get_NE() != 0) {
exception(BX_MF_EXCEPTION, 0);
2006-09-08 15:26:04 +04:00
}
else
#endif
2006-09-08 15:26:04 +04:00
{
// MSDOS compatibility external interrupt (IRQ13)
2010-11-11 18:48:56 +03:00
BX_INFO(("math_abort: MSDOS compatibility FPU exception"));
2006-09-08 15:26:04 +04:00
DEV_pic_raise_irq(13);
}
}
}
2013-08-23 00:21:36 +04:00
Bit16u BX_CPU_C::x87_get_FCS(void)
{
if (bx_cpuid_support_fcs_fds_deprecation())
return 0;
else
return BX_CPU_THIS_PTR the_i387.fcs;
}
Bit16u BX_CPU_C::x87_get_FDS(void)
{
if (bx_cpuid_support_fcs_fds_deprecation())
return 0;
else
return BX_CPU_THIS_PTR the_i387.fds;
}
bx_address BX_CPU_C::fpu_save_environment(bxInstruction_c *i)
{
unsigned offset;
/* read all registers in stack order and update x87 tag word */
for(int n=0;n<8;n++) {
// update tag only if it is not empty
if (! IS_TAG_EMPTY(n)) {
int tag = FPU_tagof(BX_READ_FPU_REG(n));
BX_CPU_THIS_PTR the_i387.FPU_settagi(tag, n);
}
}
bx_address eaddr = BX_CPU_CALL_METHODR(i->ResolveModrm, (i));
2010-10-19 02:19:45 +04:00
bx_address asize_mask = i->asize_mask();
2004-06-18 19:14:50 +04:00
if (protected_mode()) /* Protected Mode */
{
if (i->os32L() || i->os64L())
{
Bit32u tmp;
tmp = 0xffff0000 | BX_CPU_THIS_PTR the_i387.get_control_word();
write_virtual_dword(i->seg(), eaddr, tmp);
2004-06-18 19:14:50 +04:00
tmp = 0xffff0000 | BX_CPU_THIS_PTR the_i387.get_status_word();
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x04) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = 0xffff0000 | BX_CPU_THIS_PTR the_i387.get_tag_word();
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x08) & asize_mask, tmp);
2008-04-26 16:14:58 +04:00
tmp = (Bit32u)(BX_CPU_THIS_PTR the_i387.fip);
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x0c) & asize_mask, tmp);
2013-08-23 00:21:36 +04:00
tmp = x87_get_FCS() | ((Bit32u)(BX_CPU_THIS_PTR the_i387.foo)) << 16;
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x10) & asize_mask, tmp);
2008-04-26 16:14:58 +04:00
tmp = (Bit32u)(BX_CPU_THIS_PTR the_i387.fdp);
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x14) & asize_mask, tmp);
2013-08-23 00:21:36 +04:00
tmp = 0xffff0000 | x87_get_FDS();
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x18) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
offset = 0x1c;
2004-06-18 19:14:50 +04:00
}
else /* Protected Mode - 16 bit */
{
Bit16u tmp;
tmp = BX_CPU_THIS_PTR the_i387.get_control_word();
write_virtual_word(i->seg(), eaddr, tmp);
2004-06-18 19:14:50 +04:00
tmp = BX_CPU_THIS_PTR the_i387.get_status_word();
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x02) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = BX_CPU_THIS_PTR the_i387.get_tag_word();
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x04) & asize_mask, tmp);
2007-12-26 21:39:15 +03:00
tmp = (Bit16u)(BX_CPU_THIS_PTR the_i387.fip) & 0xffff;
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x06) & asize_mask, tmp);
2013-08-23 00:21:36 +04:00
tmp = x87_get_FCS();
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x08) & asize_mask, tmp);
2007-12-26 21:39:15 +03:00
tmp = (Bit16u)(BX_CPU_THIS_PTR the_i387.fdp) & 0xffff;
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x0a) & asize_mask, tmp);
2013-08-23 00:21:36 +04:00
tmp = x87_get_FDS();
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x0c) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
offset = 0x0e;
2004-06-18 19:14:50 +04:00
}
}
else /* Real or V86 Mode */
{
2013-08-23 00:21:36 +04:00
Bit32u fp_ip = ((Bit32u) x87_get_FCS() << 4) +
(Bit32u)(BX_CPU_THIS_PTR the_i387.fip);
2013-08-23 00:21:36 +04:00
Bit32u fp_dp = ((Bit32u) x87_get_FDS() << 4) +
(Bit32u)(BX_CPU_THIS_PTR the_i387.fdp);
2004-06-18 19:14:50 +04:00
if (i->os32L())
2004-06-18 19:14:50 +04:00
{
Bit32u tmp;
2004-06-18 19:14:50 +04:00
tmp = 0xffff0000 | BX_CPU_THIS_PTR the_i387.get_control_word();
write_virtual_dword(i->seg(), eaddr, tmp);
2004-06-18 19:14:50 +04:00
tmp = 0xffff0000 | BX_CPU_THIS_PTR the_i387.get_status_word();
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x04) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = 0xffff0000 | BX_CPU_THIS_PTR the_i387.get_tag_word();
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x08) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = 0xffff0000 | (fp_ip & 0xffff);
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x0c) & asize_mask, tmp);
2008-04-26 16:14:58 +04:00
tmp = ((fp_ip & 0xffff0000) >> 4) | BX_CPU_THIS_PTR the_i387.foo;
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x10) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = 0xffff0000 | (fp_dp & 0xffff);
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x14) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = (fp_dp & 0xffff0000) >> 4;
2010-10-19 02:19:45 +04:00
write_virtual_dword(i->seg(), (eaddr + 0x18) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
offset = 0x1c;
2004-06-18 19:14:50 +04:00
}
else /* Real or V86 Mode - 16 bit */
{
Bit16u tmp;
tmp = BX_CPU_THIS_PTR the_i387.get_control_word();
write_virtual_word(i->seg(), eaddr, tmp);
2004-06-18 19:14:50 +04:00
tmp = BX_CPU_THIS_PTR the_i387.get_status_word();
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x02) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = BX_CPU_THIS_PTR the_i387.get_tag_word();
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x04) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = fp_ip & 0xffff;
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x06) & asize_mask, tmp);
2008-04-26 16:14:58 +04:00
tmp = (Bit16u)((fp_ip & 0xf0000) >> 4) | BX_CPU_THIS_PTR the_i387.foo;
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x08) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = fp_dp & 0xffff;
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x0a) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
tmp = (Bit16u)((fp_dp & 0xf0000) >> 4);
2010-10-19 02:19:45 +04:00
write_virtual_word(i->seg(), (eaddr + 0x0c) & asize_mask, tmp);
2004-06-18 19:14:50 +04:00
offset = 0x0e;
}
}
2010-10-19 02:19:45 +04:00
return (eaddr + offset) & asize_mask;
2004-06-18 19:14:50 +04:00
}
bx_address BX_CPU_C::fpu_load_environment(bxInstruction_c *i)
2004-06-18 19:14:50 +04:00
{
unsigned offset;
2004-06-18 19:14:50 +04:00
2008-09-17 00:40:56 +04:00
bx_address eaddr = BX_CPU_CALL_METHODR(i->ResolveModrm, (i));
2010-10-19 02:19:45 +04:00
bx_address asize_mask = i->asize_mask();
2004-06-18 19:14:50 +04:00
if (protected_mode()) /* Protected Mode */
{
if (i->os32L() || i->os64L())
{
Bit32u tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x18) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.fds = tmp & 0xffff;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x14) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.fdp = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x10) & asize_mask);
2004-06-18 19:14:50 +04:00
BX_CPU_THIS_PTR the_i387.fcs = tmp & 0xffff;
BX_CPU_THIS_PTR the_i387.foo = (tmp >> 16) & 0x07ff;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x0c) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.fip = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x08) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.twd = tmp & 0xffff;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x04) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.swd = tmp & 0xffff;
2010-10-17 20:24:33 +04:00
BX_CPU_THIS_PTR the_i387.tos = (tmp >> 11) & 0x7;
2009-11-17 23:43:41 +03:00
tmp = read_virtual_dword(i->seg(), eaddr);
BX_CPU_THIS_PTR the_i387.cwd = tmp & 0xffff;
2004-06-18 19:14:50 +04:00
offset = 0x1c;
}
else /* Protected Mode - 16 bit */
{
Bit16u tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x0c) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.fds = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x0a) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.fdp = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x08) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.fcs = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x06) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.fip = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x04) & asize_mask);
2009-11-17 23:43:41 +03:00
BX_CPU_THIS_PTR the_i387.twd = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x02) & asize_mask);
2004-06-18 19:14:50 +04:00
BX_CPU_THIS_PTR the_i387.swd = tmp;
2010-10-17 20:24:33 +04:00
BX_CPU_THIS_PTR the_i387.tos = (tmp >> 11) & 0x7;
2009-11-17 23:43:41 +03:00
tmp = read_virtual_word(i->seg(), eaddr);
BX_CPU_THIS_PTR the_i387.cwd = tmp;
2004-06-18 19:14:50 +04:00
/* opcode is defined to be zero */
BX_CPU_THIS_PTR the_i387.foo = 0;
offset = 0x0e;
}
}
else /* Real or V86 Mode */
{
Bit32u fp_ip, fp_dp;
2004-06-18 19:14:50 +04:00
if (i->os32L())
2004-06-18 19:14:50 +04:00
{
Bit32u tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x18) & asize_mask);
fp_dp = (tmp & 0x0ffff000) << 4;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x14) & asize_mask);
fp_dp |= tmp & 0xffff;
2004-06-18 19:14:50 +04:00
BX_CPU_THIS_PTR the_i387.fdp = fp_dp;
BX_CPU_THIS_PTR the_i387.fds = 0;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x10) & asize_mask);
BX_CPU_THIS_PTR the_i387.foo = tmp & 0x07ff;
fp_ip = (tmp & 0x0ffff000) << 4;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x0c) & asize_mask);
fp_ip |= tmp & 0xffff;
BX_CPU_THIS_PTR the_i387.fip = fp_ip;
BX_CPU_THIS_PTR the_i387.fcs = 0;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x08) & asize_mask);
BX_CPU_THIS_PTR the_i387.twd = tmp & 0xffff;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_dword(i->seg(), (eaddr + 0x04) & asize_mask);
BX_CPU_THIS_PTR the_i387.swd = tmp & 0xffff;
2010-10-17 20:24:33 +04:00
BX_CPU_THIS_PTR the_i387.tos = (tmp >> 11) & 0x7;
tmp = read_virtual_dword(i->seg(), eaddr);
BX_CPU_THIS_PTR the_i387.cwd = tmp & 0xffff;
2004-06-18 19:14:50 +04:00
offset = 0x1c;
}
else /* Real or V86 Mode - 16 bit */
{
Bit16u tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x0c) & asize_mask);
fp_dp = (tmp & 0xf000) << 4;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x0a) & asize_mask);
BX_CPU_THIS_PTR the_i387.fdp = fp_dp | tmp;
BX_CPU_THIS_PTR the_i387.fds = 0;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x08) & asize_mask);
2004-06-18 19:14:50 +04:00
BX_CPU_THIS_PTR the_i387.foo = tmp & 0x07ff;
fp_ip = (tmp & 0xf000) << 4;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x06) & asize_mask);
BX_CPU_THIS_PTR the_i387.fip = fp_ip | tmp;
2004-06-18 19:14:50 +04:00
BX_CPU_THIS_PTR the_i387.fcs = 0;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x04) & asize_mask);
BX_CPU_THIS_PTR the_i387.twd = tmp;
2010-10-19 02:19:45 +04:00
tmp = read_virtual_word(i->seg(), (eaddr + 0x02) & asize_mask);
BX_CPU_THIS_PTR the_i387.swd = tmp;
2010-10-17 20:24:33 +04:00
BX_CPU_THIS_PTR the_i387.tos = (tmp >> 11) & 0x7;
tmp = read_virtual_word(i->seg(), eaddr);
BX_CPU_THIS_PTR the_i387.cwd = tmp;
2004-06-18 19:14:50 +04:00
offset = 0x0e;
}
}
/* always set bit 6 as '1 */
BX_CPU_THIS_PTR the_i387.cwd =
(BX_CPU_THIS_PTR the_i387.cwd & ~FPU_CW_Reserved_Bits) | 0x0040;
2004-06-18 19:14:50 +04:00
/* check for unmasked exceptions */
if (FPU_PARTIAL_STATUS & ~FPU_CONTROL_WORD & FPU_CW_Exceptions_Mask)
{
/* set the B and ES bits in the status-word */
FPU_PARTIAL_STATUS |= FPU_SW_Summary | FPU_SW_Backward;
}
else {
2004-06-18 19:14:50 +04:00
/* clear the B and ES bits in the status-word */
FPU_PARTIAL_STATUS &= ~(FPU_SW_Summary | FPU_SW_Backward);
}
2010-10-19 02:19:45 +04:00
return (eaddr + offset) & asize_mask;
}
2004-06-18 19:14:50 +04:00
/* D9 /5 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FLDCW(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, CHECK_PENDING_EXCEPTIONS);
bx_address eaddr = BX_CPU_CALL_METHODR(i->ResolveModrm, (i));
Bit16u cwd = read_virtual_word(i->seg(), eaddr);
FPU_CONTROL_WORD = (cwd & ~FPU_CW_Reserved_Bits) | 0x0040; // bit 6 is reserved as '1
2004-06-18 19:14:50 +04:00
/* check for unmasked exceptions */
if (FPU_PARTIAL_STATUS & ~FPU_CONTROL_WORD & FPU_CW_Exceptions_Mask)
{
/* set the B and ES bits in the status-word */
FPU_PARTIAL_STATUS |= FPU_SW_Summary | FPU_SW_Backward;
}
else
{
/* clear the B and ES bits in the status-word */
FPU_PARTIAL_STATUS &= ~(FPU_SW_Summary | FPU_SW_Backward);
}
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* D9 /7 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNSTCW(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
2004-06-18 19:14:50 +04:00
Bit16u cwd = BX_CPU_THIS_PTR the_i387.get_control_word();
bx_address eaddr = BX_CPU_CALL_METHODR(i->ResolveModrm, (i));
write_virtual_word(i->seg(), eaddr, cwd);
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* DD /7 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNSTSW(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
2004-06-18 19:14:50 +04:00
Bit16u swd = BX_CPU_THIS_PTR the_i387.get_status_word();
bx_address eaddr = BX_CPU_CALL_METHODR(i->ResolveModrm, (i));
write_virtual_word(i->seg(), eaddr, swd);
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* DF E0 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNSTSW_AX(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
2004-06-18 19:14:50 +04:00
AX = BX_CPU_THIS_PTR the_i387.get_status_word();
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* DD /4 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FRSTOR(bxInstruction_c *i)
{
prepareFPU(i, CHECK_PENDING_EXCEPTIONS);
bx_address offset = fpu_load_environment(i);
2008-04-28 00:43:38 +04:00
floatx80 tmp;
2008-04-28 00:43:38 +04:00
/* read all registers in stack order */
2004-06-18 19:14:50 +04:00
for(int n=0;n<8;n++)
{
2010-10-19 02:19:45 +04:00
tmp.fraction = read_virtual_qword(i->seg(), (offset + n*10) & i->asize_mask());
tmp.exp = read_virtual_word (i->seg(), (offset + n*10 + 8) & i->asize_mask());
2008-04-28 00:43:38 +04:00
// update tag only if it is not empty
BX_WRITE_FPU_REGISTER_AND_TAG(tmp,
IS_TAG_EMPTY(n) ? FPU_Tag_Empty : FPU_tagof(tmp), n);
2004-06-18 19:14:50 +04:00
}
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* DD /6 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNSAVE(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
bx_address offset = fpu_save_environment(i);
2004-06-18 19:14:50 +04:00
/* save all registers in stack order. */
for(int n=0;n<8;n++)
{
floatx80 stn = BX_READ_FPU_REG(n);
2010-10-19 02:19:45 +04:00
write_virtual_qword(i->seg(), (offset + n*10) & i->asize_mask(), stn.fraction);
write_virtual_word (i->seg(), (offset + n*10 + 8) & i->asize_mask(), stn.exp);
2004-06-18 19:14:50 +04:00
}
2004-06-18 19:14:50 +04:00
BX_CPU_THIS_PTR the_i387.init();
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* 9B E2 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNCLEX(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
2004-06-18 19:14:50 +04:00
FPU_PARTIAL_STATUS &= ~(FPU_SW_Backward|FPU_SW_Summary|FPU_SW_Stack_Fault|FPU_SW_Precision|
2009-03-11 00:43:11 +03:00
FPU_SW_Underflow|FPU_SW_Overflow|FPU_SW_Zero_Div|FPU_SW_Denormal_Op|
FPU_SW_Invalid);
2004-06-18 19:14:50 +04:00
// do not update last fpu instruction pointer
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* DB E3 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNINIT(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
2004-06-18 19:14:50 +04:00
BX_CPU_THIS_PTR the_i387.init();
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* D9 /4 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FLDENV(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, CHECK_PENDING_EXCEPTIONS);
fpu_load_environment(i);
/* read all registers in stack order and update x87 tag word */
for(int n=0;n<8;n++) {
// update tag only if it is not empty
if (! IS_TAG_EMPTY(n)) {
int tag = FPU_tagof(BX_READ_FPU_REG(n));
BX_CPU_THIS_PTR the_i387.FPU_settagi(tag, n);
}
}
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* D9 /6 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNSTENV(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
2004-06-18 19:14:50 +04:00
fpu_save_environment(i);
/* mask all floating point exceptions */
FPU_CONTROL_WORD |= FPU_CW_Exceptions_Mask;
/* clear the B and ES bits in the status word */
FPU_PARTIAL_STATUS &= ~(FPU_SW_Backward|FPU_SW_Summary);
BX_NEXT_INSTR(i);
}
2004-06-18 19:14:50 +04:00
/* D9 D0 */
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FNOP(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, CHECK_PENDING_EXCEPTIONS);
FPU_update_last_instruction(i);
2004-06-18 19:14:50 +04:00
// Perform no FPU operation. This instruction takes up space in the
// instruction stream but does not affect the FPU or machine
// context, except the EIP register.
BX_NEXT_INSTR(i);
}
BX_INSF_TYPE BX_CPP_AttrRegparmN(1) BX_CPU_C::FPLEGACY(bxInstruction_c *i)
{
2009-08-22 19:53:06 +04:00
prepareFPU(i, !CHECK_PENDING_EXCEPTIONS);
2004-06-18 19:14:50 +04:00
// FPU performs no specific operation and no internal x87 states
// are affected
BX_NEXT_INSTR(i);
}
#endif
#if BX_SUPPORT_FPU
2009-04-12 20:13:49 +04:00
#include "softfloatx80.h"
2004-06-18 19:14:50 +04:00
#include <math.h>
void BX_CPU_C::print_state_FPU(void)
{
2004-06-18 19:14:50 +04:00
static double scale_factor = pow(2.0, -63.0);
2009-01-31 00:05:01 +03:00
static const char* cw_round_control[] = {
"NEAREST", "DOWN", "UP", "CHOP"
};
2009-01-31 00:05:01 +03:00
static const char* cw_precision_control[] = {
"32", "RES", "64", "80"
};
2009-04-12 20:13:49 +04:00
static const char* fp_class[] = {
2009-04-12 23:13:13 +04:00
"ZERO", "xNAN", "-INF", "+INF", "DENORMAL", "NORMAL"
2009-04-12 20:13:49 +04:00
};
2004-06-18 19:14:50 +04:00
Bit32u reg;
reg = BX_CPU_THIS_PTR the_i387.get_status_word();
fprintf(stderr, "status word: 0x%04x: ", reg);
fprintf(stderr, "%s %s TOS%d %s %s %s %s %s %s %s %s %s %s %s\n",
(reg & FPU_SW_Backward) ? "B" : "b",
(reg & FPU_SW_C3) ? "C3" : "c3", (FPU_TOS&7),
(reg & FPU_SW_C2) ? "C2" : "c2",
(reg & FPU_SW_C1) ? "C1" : "c1",
(reg & FPU_SW_C0) ? "C0" : "c0",
(reg & FPU_SW_Summary) ? "ES" : "es",
(reg & FPU_SW_Stack_Fault) ? "SF" : "sf",
(reg & FPU_SW_Precision) ? "PE" : "pe",
(reg & FPU_SW_Underflow) ? "UE" : "ue",
(reg & FPU_SW_Overflow) ? "OE" : "oe",
(reg & FPU_SW_Zero_Div) ? "ZE" : "ze",
(reg & FPU_SW_Denormal_Op) ? "DE" : "de",
(reg & FPU_SW_Invalid) ? "IE" : "ie");
2008-05-20 00:00:42 +04:00
reg = BX_CPU_THIS_PTR the_i387.get_control_word();
fprintf(stderr, "control word: 0x%04x: ", reg);
fprintf(stderr, "%s RC_%s PC_%s %s %s %s %s %s %s\n",
(reg & FPU_CW_Inf) ? "INF" : "inf",
(cw_round_control[(reg & FPU_CW_RC) >> 10]),
(cw_precision_control[(reg & FPU_CW_PC) >> 8]),
(reg & FPU_CW_Precision) ? "PM" : "pm",
(reg & FPU_CW_Underflow) ? "UM" : "um",
(reg & FPU_CW_Overflow) ? "OM" : "om",
(reg & FPU_CW_Zero_Div) ? "ZM" : "zm",
(reg & FPU_CW_Denormal) ? "DM" : "dm",
(reg & FPU_CW_Invalid) ? "IM" : "im");
reg = BX_CPU_THIS_PTR the_i387.get_tag_word();
2004-06-18 19:14:50 +04:00
fprintf(stderr, "tag word: 0x%04x\n", reg);
reg = BX_CPU_THIS_PTR the_i387.foo;
fprintf(stderr, "operand: 0x%04x\n", reg);
fprintf(stderr, "fip: 0x" FMT_ADDRX "\n",
BX_CPU_THIS_PTR the_i387.fip);
2004-06-18 19:14:50 +04:00
reg = BX_CPU_THIS_PTR the_i387.fcs;
fprintf(stderr, "fcs: 0x%04x\n", reg);
fprintf(stderr, "fdp: 0x" FMT_ADDRX "\n",
BX_CPU_THIS_PTR the_i387.fdp);
2004-06-18 19:14:50 +04:00
reg = BX_CPU_THIS_PTR the_i387.fds;
fprintf(stderr, "fds: 0x%04x\n", reg);
2004-06-18 19:14:50 +04:00
// print stack too
int tos = FPU_TOS & 7;
2004-06-18 19:14:50 +04:00
for (int i=0; i<8; i++) {
const floatx80 &fp = BX_FPU_REG(i);
unsigned tag = BX_CPU_THIS_PTR the_i387.FPU_gettagi((i-tos)&7);
if (tag != FPU_Tag_Empty) tag = FPU_tagof(fp);
2004-06-18 19:14:50 +04:00
double f = pow(2.0, ((0x7fff & fp.exp) - 0x3fff));
if (fp.exp & 0x8000) f = -f;
#ifdef _MSC_VER
f *= (double)(signed __int64)(fp.fraction>>1) * scale_factor * 2;
#else
2004-06-18 19:14:50 +04:00
f *= fp.fraction*scale_factor;
#endif
2009-04-12 20:13:49 +04:00
float_class_t f_class = floatx80_class(fp);
fprintf(stderr, "%sFP%d ST%d(%c): raw 0x%04x:%08lx%08lx (%.10f) (%s)\n",
2008-05-20 00:00:42 +04:00
i==tos?"=>":" ", i, (i-tos)&7,
"v0se"[tag],
2008-05-01 00:41:15 +04:00
fp.exp & 0xffff, GET32H(fp.fraction), GET32L(fp.fraction),
2009-04-12 20:13:49 +04:00
f, (f_class == float_NaN) ? (floatx80_is_signaling_nan(fp) ? "SNAN" : "QNAN") : fp_class[f_class]);
2004-06-18 19:14:50 +04:00
}
}
2009-04-12 20:13:49 +04:00
#include "softfloat-specialize.h"
/* -----------------------------------------------------------
* Slimmed down version used to compile against a CPU simulator
* rather than a kernel (ported by Kevin Lawton)
* ------------------------------------------------------------ */
int FPU_tagof(const floatx80 &reg)
{
Bit32s exp = floatx80_exp(reg);
if (exp == 0)
{
if (! floatx80_fraction(reg))
return FPU_Tag_Zero;
/* The number is a de-normal or pseudodenormal. */
return FPU_Tag_Special;
}
if (exp == 0x7fff)
{
/* Is an Infinity, a NaN, or an unsupported data type. */
return FPU_Tag_Special;
}
if (!(reg.fraction & BX_CONST64(0x8000000000000000)))
{
/* Unsupported data type. */
/* Valid numbers have the ms bit set to 1. */
return FPU_Tag_Special;
}
return FPU_Tag_Valid;
}
#endif