///////////////////////////////////////////////////////////////////////// // $Id: fpu_arith.cc,v 1.19 2009-04-27 14:00:55 sshwarts Exp $ ///////////////////////////////////////////////////////////////////////// // // Copyright (c) 2003 Stanislav Shwartsman // 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 // ///////////////////////////////////////////////////////////////////////// #define NEED_CPU_REG_SHORTCUTS 1 #include "bochs.h" #include "cpu/cpu.h" #define LOG_THIS BX_CPU_THIS_PTR #if BX_SUPPORT_FPU float_status_t FPU_pre_exception_handling(Bit16u control_word) { float_status_t status; int precision = control_word & FPU_CW_PC; switch(precision) { case FPU_PR_32_BITS: status.float_rounding_precision = 32; break; case FPU_PR_64_BITS: status.float_rounding_precision = 64; break; case FPU_PR_80_BITS: status.float_rounding_precision = 80; break; default: /* With the precision control bits set to 01 "(reserved)", a real CPU behaves as if the precision control bits were set to 11 "80 bits" */ status.float_rounding_precision = 80; } status.float_exception_flags = 0; // clear exceptions before execution status.float_nan_handling_mode = float_first_operand_nan; status.float_rounding_mode = (control_word & FPU_CW_RC) >> 10; status.flush_underflow_to_zero = 0; return status; } #include "softfloatx80.h" floatx80 FPU_handle_NaN(floatx80 a, int aIsNaN, float32 b32, int bIsNaN, float_status_t &status) { int aIsSignalingNaN = floatx80_is_signaling_nan(a); int bIsSignalingNaN = float32_is_signaling_nan(b32); // propogate QNaN to SNaN a = propagateFloatx80NaN(a, status); // float32 is NaN so conversion will propagate SNaN to QNaN and raise // appropriate exception flags floatx80 b = float32_to_floatx80(b32, status); if (aIsSignalingNaN | bIsSignalingNaN) float_raise(status, float_flag_invalid); if (aIsSignalingNaN) { if (bIsSignalingNaN) goto returnLargerSignificand; return bIsNaN ? b : a; } else if (aIsNaN) { if (bIsSignalingNaN | ! bIsNaN) return a; returnLargerSignificand: if (a.fraction < b.fraction) return b; if (b.fraction < a.fraction) return a; return (a.exp < b.exp) ? a : b; } else { return b; } } int FPU_handle_NaN(floatx80 a, float32 b, floatx80 &r, float_status_t &status) { if (floatx80_is_unsupported(a)) { float_raise(status, float_flag_invalid); r = floatx80_default_nan; return 1; } int aIsNaN = floatx80_is_nan(a), bIsNaN = float32_is_nan(b); if (aIsNaN | bIsNaN) { r = FPU_handle_NaN(a, aIsNaN, b, bIsNaN, status); return 1; } return 0; } floatx80 FPU_handle_NaN(floatx80 a, int aIsNaN, float64 b64, int bIsNaN, float_status_t &status) { int aIsSignalingNaN = floatx80_is_signaling_nan(a); int bIsSignalingNaN = float64_is_signaling_nan(b64); // propogate QNaN to SNaN a = propagateFloatx80NaN(a, status); // float64 is NaN so conversion will propagate SNaN to QNaN and raise // appropriate exception flags floatx80 b = float64_to_floatx80(b64, status); if (aIsSignalingNaN | bIsSignalingNaN) float_raise(status, float_flag_invalid); if (aIsSignalingNaN) { if (bIsSignalingNaN) goto returnLargerSignificand; return bIsNaN ? b : a; } else if (aIsNaN) { if (bIsSignalingNaN | ! bIsNaN) return a; returnLargerSignificand: if (a.fraction < b.fraction) return b; if (b.fraction < a.fraction) return a; return (a.exp < b.exp) ? a : b; } else { return b; } } int FPU_handle_NaN(floatx80 a, float64 b, floatx80 &r, float_status_t &status) { if (floatx80_is_unsupported(a)) { float_raise(status, float_flag_invalid); r = floatx80_default_nan; return 1; } int aIsNaN = floatx80_is_nan(a), bIsNaN = float64_is_nan(b); if (aIsNaN | bIsNaN) { r = FPU_handle_NaN(a, aIsNaN, b, bIsNaN, status); return 1; } return 0; } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FADD_ST0_STj(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = BX_READ_FPU_REG(i->rm()); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_add(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FADD_ST0_STj: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FADD_STi_ST0(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); int pop_stack = i->b1() & 2; clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(i->rm(), pop_stack); return; } floatx80 a = BX_READ_FPU_REG(i->rm()); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_add(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) { BX_WRITE_FPU_REG(result, i->rm()); if (pop_stack) BX_CPU_THIS_PTR the_i387.FPU_pop(); } #else BX_INFO(("FADD(P)_STi_ST0: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FADD_SINGLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float32 load_reg = read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_add(a, float32_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FADD_SINGLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FADD_DOUBLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float64 load_reg = read_virtual_qword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_add(a, float64_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FADD_DOUBLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIADD_WORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit16s load_reg = (Bit16s) read_virtual_word(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80((Bit32s)(load_reg)); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_add(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIADD_WORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIADD_DWORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit32s load_reg = (Bit32s) read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80(load_reg); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_add(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIADD_DWORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FMUL_ST0_STj(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = BX_READ_FPU_REG(i->rm()); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_mul(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FMUL_ST0_STj: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FMUL_STi_ST0(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); int pop_stack = i->b1() & 2; clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(i->rm(), pop_stack); return; } floatx80 a = BX_READ_FPU_REG(i->rm()); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_mul(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) { BX_WRITE_FPU_REG(result, i->rm()); if (pop_stack) BX_CPU_THIS_PTR the_i387.FPU_pop(); } #else BX_INFO(("FMUL(P)_STi_ST0: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FMUL_SINGLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float32 load_reg = read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_mul(a, float32_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FMUL_SINGLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FMUL_DOUBLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float64 load_reg = read_virtual_qword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_mul(a, float64_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FMUL_DOUBLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIMUL_WORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit16s load_reg = (Bit16s) read_virtual_word(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80((Bit32s)(load_reg)); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_mul(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIMUL_WORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIMUL_DWORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit32s load_reg = (Bit32s) read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80(load_reg); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_mul(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIMUL_DWORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUB_ST0_STj(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = BX_READ_FPU_REG(i->rm()); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FSUB_ST0_STj: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUBR_ST0_STj(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(i->rm()); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FSUBR_ST0_STj: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUB_STi_ST0(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); int pop_stack = i->b1() & 2; clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(i->rm(), pop_stack); return; } floatx80 a = BX_READ_FPU_REG(i->rm()); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) { BX_WRITE_FPU_REG(result, i->rm()); if (pop_stack) BX_CPU_THIS_PTR the_i387.FPU_pop(); } #else BX_INFO(("FSUB(P)_STi_ST0: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUBR_STi_ST0(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); int pop_stack = i->b1() & 2; clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(i->rm(), pop_stack); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = BX_READ_FPU_REG(i->rm()); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) { BX_WRITE_FPU_REG(result, i->rm()); if (pop_stack) BX_CPU_THIS_PTR the_i387.FPU_pop(); } #else BX_INFO(("FSUBR(P)_STi_ST0: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUB_SINGLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float32 load_reg = read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_sub(a, float32_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FSUB_SINGLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUBR_SINGLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float32 load_reg = read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 b = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(b, load_reg, result, status)) result = floatx80_sub(float32_to_floatx80(load_reg, status), b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FSUBR_SINGLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUB_DOUBLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float64 load_reg = read_virtual_qword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_sub(a, float64_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FSUB_DOUBLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSUBR_DOUBLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float64 load_reg = read_virtual_qword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 b = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(b, load_reg, result, status)) result = floatx80_sub(float64_to_floatx80(load_reg, status), b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FSUBR_DOUBLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FISUB_WORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit16s load_reg = (Bit16s) read_virtual_word(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80((Bit32s)(load_reg)); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FISUB_WORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FISUBR_WORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit16s load_reg = (Bit16s) read_virtual_word(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = int32_to_floatx80((Bit32s)(load_reg)); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FISUBR_WORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FISUB_DWORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit32s load_reg = (Bit32s) read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80(load_reg); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(BX_READ_FPU_REG(0), int32_to_floatx80(load_reg), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FISUB_DWORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FISUBR_DWORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit32s load_reg = (Bit32s) read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = int32_to_floatx80(load_reg); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sub(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FISUBR_DWORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIV_ST0_STj(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = BX_READ_FPU_REG(i->rm()); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FDIV_ST0_STj: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIVR_ST0_STj(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(i->rm()); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FDIVR_ST0_STj: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIV_STi_ST0(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); int pop_stack = i->b1() & 2; clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(i->rm(), pop_stack); return; } floatx80 a = BX_READ_FPU_REG(i->rm()); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) { BX_WRITE_FPU_REG(result, i->rm()); if (pop_stack) BX_CPU_THIS_PTR the_i387.FPU_pop(); } #else BX_INFO(("FDIV(P)_STi_ST0: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIVR_STi_ST0(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); int pop_stack = i->b1() & 2; clear_C1(); if (IS_TAG_EMPTY(0) || IS_TAG_EMPTY(i->rm())) { BX_CPU_THIS_PTR FPU_stack_underflow(i->rm(), pop_stack); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = BX_READ_FPU_REG(i->rm()); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) { BX_WRITE_FPU_REG(result, i->rm()); if (pop_stack) BX_CPU_THIS_PTR the_i387.FPU_pop(); } #else BX_INFO(("FDIVR(P)_STi_ST0: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIV_SINGLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float32 load_reg = read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_div(a, float32_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FDIV_SINGLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIVR_SINGLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float32 load_reg = read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 b = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(b, load_reg, result, status)) result = floatx80_div(float32_to_floatx80(load_reg, status), b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FDIVR_SINGLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIV_DOUBLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float64 load_reg = read_virtual_qword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 a = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(a, load_reg, result, status)) result = floatx80_div(a, float64_to_floatx80(load_reg, status), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FDIV_DOUBLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FDIVR_DOUBLE_REAL(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); float64 load_reg = read_virtual_qword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 b = BX_READ_FPU_REG(0), result; if (! FPU_handle_NaN(b, load_reg, result, status)) result = floatx80_div(float64_to_floatx80(load_reg, status), b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FDIVR_DOUBLE_REAL: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIDIV_WORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit16s load_reg = (Bit16s) read_virtual_word(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80((Bit32s)(load_reg)); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIDIV_WORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIDIVR_WORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit16s load_reg = (Bit16s) read_virtual_word(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = int32_to_floatx80((Bit32s)(load_reg)); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIDIVR_WORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIDIV_DWORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit32s load_reg = (Bit32s) read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = BX_READ_FPU_REG(0); floatx80 b = int32_to_floatx80(load_reg); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIDIV_DWORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FIDIVR_DWORD_INTEGER(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); RMAddr(i) = BX_CPU_CALL_METHODR(i->ResolveModrm, (i)); Bit32s load_reg = (Bit32s) read_virtual_dword(i->seg(), RMAddr(i)); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } floatx80 a = int32_to_floatx80(load_reg); floatx80 b = BX_READ_FPU_REG(0); float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_div(a, b, status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FIDIVR_DWORD_INTEGER: required FPU, configure --enable-fpu")); #endif } void BX_CPP_AttrRegparmN(1) BX_CPU_C::FSQRT(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_sqrt(BX_READ_FPU_REG(0), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FSQRT: required FPU, configure --enable-fpu")); #endif } /* D9 FC */ void BX_CPP_AttrRegparmN(1) BX_CPU_C::FRNDINT(bxInstruction_c *i) { #if BX_SUPPORT_FPU BX_CPU_THIS_PTR prepareFPU(i); BX_CPU_THIS_PTR FPU_update_last_instruction(i); clear_C1(); if (IS_TAG_EMPTY(0)) { BX_CPU_THIS_PTR FPU_stack_underflow(0); return; } float_status_t status = FPU_pre_exception_handling(BX_CPU_THIS_PTR the_i387.get_control_word()); floatx80 result = floatx80_round_to_int(BX_READ_FPU_REG(0), status); if (! BX_CPU_THIS_PTR FPU_exception(status.float_exception_flags)) BX_WRITE_FPU_REG(result, 0); #else BX_INFO(("FRNDINT: required FPU, configure --enable-fpu")); #endif } #endif