2023-10-05 18:37:58 +00:00
|
|
|
|
//
|
2023-10-12 17:54:51 +00:00
|
|
|
|
//
|
2023-10-05 18:37:58 +00:00
|
|
|
|
// PerformImplementation.hpp
|
|
|
|
|
// Clock Signal
|
|
|
|
|
//
|
|
|
|
|
// Created by Thomas Harte on 05/10/2023.
|
|
|
|
|
// Copyright © 2023 Thomas Harte. All rights reserved.
|
|
|
|
|
//
|
|
|
|
|
|
|
|
|
|
#ifndef PerformImplementation_h
|
|
|
|
|
#define PerformImplementation_h
|
|
|
|
|
|
2023-10-05 19:49:07 +00:00
|
|
|
|
#include "../../../Numeric/Carry.hpp"
|
2023-10-06 02:27:52 +00:00
|
|
|
|
#include "../../../Numeric/RegisterSizes.hpp"
|
2023-10-06 17:22:35 +00:00
|
|
|
|
#include "../Interrupts.hpp"
|
2023-11-06 02:42:22 +00:00
|
|
|
|
#include "../AccessType.hpp"
|
|
|
|
|
#include "Resolver.hpp"
|
2023-10-05 19:49:07 +00:00
|
|
|
|
|
2023-10-11 02:35:25 +00:00
|
|
|
|
#include <utility>
|
|
|
|
|
|
2023-10-05 18:37:58 +00:00
|
|
|
|
namespace InstructionSet::x86 {
|
|
|
|
|
|
|
|
|
|
namespace Primitive {
|
|
|
|
|
|
2023-11-02 03:39:52 +00:00
|
|
|
|
// The below takes a reference in order properly to handle PUSH SP,
|
|
|
|
|
// which should place the value of SP after the push onto the stack.
|
2023-11-02 21:00:22 +00:00
|
|
|
|
template <typename IntT, bool preauthorised, typename ContextT>
|
2023-11-02 03:39:52 +00:00
|
|
|
|
void push(IntT &value, ContextT &context) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.registers.sp_ -= sizeof(IntT);
|
2023-11-03 19:36:30 +00:00
|
|
|
|
if constexpr (preauthorised) {
|
|
|
|
|
context.memory.template preauthorised_write<IntT>(Source::SS, context.registers.sp_, value);
|
|
|
|
|
} else {
|
|
|
|
|
context.memory.template access<IntT, AccessType::Write>(
|
|
|
|
|
Source::SS,
|
|
|
|
|
context.registers.sp_) = value;
|
|
|
|
|
}
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.template write_back<IntT>();
|
2023-10-16 19:40:24 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-02 21:00:22 +00:00
|
|
|
|
template <typename IntT, bool preauthorised, typename ContextT>
|
2023-11-01 21:03:23 +00:00
|
|
|
|
IntT pop(ContextT &context) {
|
2023-11-02 21:00:22 +00:00
|
|
|
|
const auto value = context.memory.template access<IntT, preauthorised ? AccessType::PreauthorisedRead : AccessType::Read>(
|
2023-11-02 03:39:52 +00:00
|
|
|
|
Source::SS,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.registers.sp_);
|
|
|
|
|
context.registers.sp_ += sizeof(IntT);
|
2023-10-16 19:40:24 +00:00
|
|
|
|
return value;
|
|
|
|
|
}
|
|
|
|
|
|
2023-10-06 15:10:54 +00:00
|
|
|
|
//
|
|
|
|
|
// Comments below on intended functioning of each operation come from the 1997 edition of the
|
|
|
|
|
// Intel Architecture Software Developer’s Manual; that year all such definitions still fitted within a
|
|
|
|
|
// single volume, Volume 2.
|
|
|
|
|
//
|
|
|
|
|
// Order Number 243191; e.g. https://www.ardent-tool.com/CPU/docs/Intel/IA/243191-002.pdf
|
|
|
|
|
//
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
|
|
|
|
void aaa(CPU::RegisterPair16 &ax, ContextT &context) { // P. 313
|
2023-10-05 18:37:58 +00:00
|
|
|
|
/*
|
|
|
|
|
IF ((AL AND 0FH) > 9) OR (AF = 1)
|
|
|
|
|
THEN
|
|
|
|
|
AL ← (AL + 6);
|
|
|
|
|
AH ← AH + 1;
|
|
|
|
|
AF ← 1;
|
|
|
|
|
CF ← 1;
|
|
|
|
|
ELSE
|
|
|
|
|
AF ← 0;
|
|
|
|
|
CF ← 0;
|
|
|
|
|
FI;
|
|
|
|
|
AL ← AL AND 0FH;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The AF and CF flags are set to 1 if the adjustment results in a decimal carry;
|
|
|
|
|
otherwise they are cleared to 0. The OF, SF, ZF, and PF flags are undefined.
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if((ax.halves.low & 0x0f) > 9 || context.flags.template flag<Flag::AuxiliaryCarry>()) {
|
2023-10-05 18:37:58 +00:00
|
|
|
|
ax.halves.low += 6;
|
|
|
|
|
++ax.halves.high;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::AuxiliaryCarry>(1);
|
2023-10-05 18:37:58 +00:00
|
|
|
|
} else {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::AuxiliaryCarry>(0);
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
2023-10-06 02:27:52 +00:00
|
|
|
|
ax.halves.low &= 0x0f;
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
|
|
|
|
void aad(CPU::RegisterPair16 &ax, uint8_t imm, ContextT &context) {
|
2023-10-05 18:37:58 +00:00
|
|
|
|
/*
|
|
|
|
|
tempAL ← AL;
|
|
|
|
|
tempAH ← AH;
|
|
|
|
|
AL ← (tempAL + (tempAH * imm8)) AND FFH; (* imm8 is set to 0AH for the AAD mnemonic *)
|
|
|
|
|
AH ← 0
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The SF, ZF, and PF flags are set according to the result;
|
|
|
|
|
the OF, AF, and CF flags are undefined.
|
|
|
|
|
*/
|
|
|
|
|
ax.halves.low = ax.halves.low + (ax.halves.high * imm);
|
|
|
|
|
ax.halves.high = 0;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<uint8_t, Flag::Zero, Flag::Sign, Flag::ParityOdd>(ax.halves.low);
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
|
|
|
|
void aam(CPU::RegisterPair16 &ax, uint8_t imm, ContextT &context) {
|
2023-10-05 18:52:24 +00:00
|
|
|
|
/*
|
|
|
|
|
tempAL ← AL;
|
|
|
|
|
AH ← tempAL / imm8; (* imm8 is set to 0AH for the AAD mnemonic *)
|
|
|
|
|
AL ← tempAL MOD imm8;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The SF, ZF, and PF flags are set according to the result.
|
|
|
|
|
The OF, AF, and CF flags are undefined.
|
|
|
|
|
*/
|
2023-10-06 15:43:18 +00:00
|
|
|
|
/*
|
|
|
|
|
If ... an immediate value of 0 is used, it will cause a #DE (divide error) exception.
|
|
|
|
|
*/
|
2023-10-06 17:22:35 +00:00
|
|
|
|
if(!imm) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
interrupt(Interrupt::DivideError, context);
|
2023-10-06 17:22:35 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-10-05 18:52:24 +00:00
|
|
|
|
ax.halves.high = ax.halves.low / imm;
|
|
|
|
|
ax.halves.low = ax.halves.low % imm;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<uint8_t, Flag::Zero, Flag::Sign, Flag::ParityOdd>(ax.halves.low);
|
2023-10-05 18:52:24 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
|
|
|
|
void aas(CPU::RegisterPair16 &ax, ContextT &context) {
|
2023-10-05 18:52:24 +00:00
|
|
|
|
/*
|
|
|
|
|
IF ((AL AND 0FH) > 9) OR (AF = 1)
|
|
|
|
|
THEN
|
|
|
|
|
AL ← AL – 6;
|
|
|
|
|
AH ← AH – 1;
|
|
|
|
|
AF ← 1;
|
|
|
|
|
CF ← 1;
|
|
|
|
|
ELSE
|
|
|
|
|
CF ← 0;
|
|
|
|
|
AF ← 0;
|
|
|
|
|
FI;
|
|
|
|
|
AL ← AL AND 0FH;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The AF and CF flags are set to 1 if there is a decimal borrow;
|
|
|
|
|
otherwise, they are cleared to 0. The OF, SF, ZF, and PF flags are undefined.
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if((ax.halves.low & 0x0f) > 9 || context.flags.template flag<Flag::AuxiliaryCarry>()) {
|
2023-10-05 18:52:24 +00:00
|
|
|
|
ax.halves.low -= 6;
|
|
|
|
|
--ax.halves.high;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::AuxiliaryCarry>(1);
|
2023-10-05 18:52:24 +00:00
|
|
|
|
} else {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::AuxiliaryCarry>(0);
|
2023-10-05 18:52:24 +00:00
|
|
|
|
}
|
|
|
|
|
ax.halves.low &= 0x0f;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
|
|
|
|
void daa(uint8_t &al, ContextT &context) {
|
2023-10-09 18:27:02 +00:00
|
|
|
|
/*
|
2023-10-09 18:42:32 +00:00
|
|
|
|
(as modified by https://www.felixcloutier.com/x86/daa ...)
|
|
|
|
|
|
|
|
|
|
old_AL ← AL;
|
|
|
|
|
old_CF ← CF;
|
|
|
|
|
CF ← 0;
|
|
|
|
|
|
2023-10-09 18:27:02 +00:00
|
|
|
|
IF (((AL AND 0FH) > 9) or AF = 1)
|
|
|
|
|
THEN
|
|
|
|
|
AL ← AL + 6;
|
2023-10-09 18:42:32 +00:00
|
|
|
|
CF ← old_CF OR CarryFromLastAddition; (* CF OR carry from AL ← AL + 6 *)
|
2023-10-09 18:27:02 +00:00
|
|
|
|
AF ← 1;
|
|
|
|
|
ELSE
|
|
|
|
|
AF ← 0;
|
|
|
|
|
FI;
|
2023-10-09 18:42:32 +00:00
|
|
|
|
IF ((old_AL > 99H) or old_CF = 1)
|
2023-10-09 18:27:02 +00:00
|
|
|
|
THEN
|
|
|
|
|
AL ← AL + 60H;
|
|
|
|
|
CF ← 1;
|
|
|
|
|
ELSE
|
|
|
|
|
CF ← 0;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF and AF flags are set if the adjustment of the value results in a
|
|
|
|
|
decimal carry in either digit of the result (see the “Operation” section above).
|
|
|
|
|
The SF, ZF, and PF flags are set according to the result. The OF flag is undefined.
|
|
|
|
|
*/
|
2023-10-09 18:42:32 +00:00
|
|
|
|
const uint8_t old_al = al;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
const auto old_carry = context.flags.template flag<Flag::Carry>();
|
|
|
|
|
context.flags.template set_from<Flag::Carry>(0);
|
2023-10-09 18:42:32 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if((al & 0x0f) > 0x09 || context.flags.template flag<Flag::AuxiliaryCarry>()) {
|
|
|
|
|
context.flags.template set_from<Flag::Carry>(old_carry | (al > 0xf9));
|
2023-10-09 18:27:02 +00:00
|
|
|
|
al += 0x06;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(1);
|
2023-10-09 18:27:02 +00:00
|
|
|
|
} else {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(0);
|
2023-10-09 18:27:02 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-09 18:42:32 +00:00
|
|
|
|
if(old_al > 0x99 || old_carry) {
|
2023-10-09 18:27:02 +00:00
|
|
|
|
al += 0x60;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(1);
|
2023-10-09 18:27:02 +00:00
|
|
|
|
} else {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(0);
|
2023-10-09 18:27:02 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<uint8_t, Flag::Zero, Flag::Sign, Flag::ParityOdd>(al);
|
2023-10-09 18:27:02 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
|
|
|
|
void das(uint8_t &al, ContextT &context) {
|
2023-10-09 18:47:39 +00:00
|
|
|
|
/*
|
|
|
|
|
(as modified by https://www.felixcloutier.com/x86/daa ...)
|
|
|
|
|
|
|
|
|
|
old_AL ← AL;
|
|
|
|
|
old_CF ← CF;
|
|
|
|
|
CF ← 0;
|
|
|
|
|
|
|
|
|
|
IF (((AL AND 0FH) > 9) or AF = 1)
|
|
|
|
|
THEN
|
|
|
|
|
AL ← AL - 6;
|
|
|
|
|
CF ← old_CF OR CarryFromLastAddition; (* CF OR borrow from AL ← AL - 6 *)
|
|
|
|
|
AF ← 1;
|
|
|
|
|
ELSE
|
|
|
|
|
AF ← 0;
|
|
|
|
|
FI;
|
|
|
|
|
IF ((old_AL > 99H) or old_CF = 1)
|
|
|
|
|
THEN
|
|
|
|
|
AL ← AL - 60H;
|
|
|
|
|
CF ← 1;
|
|
|
|
|
ELSE
|
|
|
|
|
CF ← 0;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF and AF flags are set if the adjustment of the value results in a
|
|
|
|
|
decimal carry in either digit of the result (see the “Operation” section above).
|
|
|
|
|
The SF, ZF, and PF flags are set according to the result. The OF flag is undefined.
|
|
|
|
|
*/
|
|
|
|
|
const uint8_t old_al = al;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
const auto old_carry = context.flags.template flag<Flag::Carry>();
|
|
|
|
|
context.flags.template set_from<Flag::Carry>(0);
|
2023-10-09 18:47:39 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if((al & 0x0f) > 0x09 || context.flags.template flag<Flag::AuxiliaryCarry>()) {
|
|
|
|
|
context.flags.template set_from<Flag::Carry>(old_carry | (al < 0x06));
|
2023-10-09 18:47:39 +00:00
|
|
|
|
al -= 0x06;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(1);
|
2023-10-09 18:47:39 +00:00
|
|
|
|
} else {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(0);
|
2023-10-09 18:47:39 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if(old_al > 0x99 || old_carry) {
|
|
|
|
|
al -= 0x60;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(1);
|
2023-10-09 18:47:39 +00:00
|
|
|
|
} else {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(0);
|
2023-10-09 18:47:39 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<uint8_t, Flag::Zero, Flag::Sign, Flag::ParityOdd>(al);
|
2023-10-09 18:47:39 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <bool with_carry, typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void add(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-05 19:49:07 +00:00
|
|
|
|
/*
|
2023-10-11 02:43:06 +00:00
|
|
|
|
DEST ← DEST + SRC [+ CF];
|
2023-10-05 19:49:07 +00:00
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The OF, SF, ZF, AF, CF, and PF flags are set according to the result.
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
const IntT result = destination + source + (with_carry ? context.flags.template carry_bit<IntT>() : 0);
|
2023-10-05 19:49:07 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(
|
2023-10-11 16:35:17 +00:00
|
|
|
|
Numeric::carried_out<true, Numeric::bit_size<IntT>() - 1>(destination, source, result));
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(
|
2023-10-11 16:35:17 +00:00
|
|
|
|
Numeric::carried_in<4>(destination, source, result));
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow>(
|
2023-10-11 16:35:17 +00:00
|
|
|
|
Numeric::overflow<true, IntT>(destination, source, result));
|
2023-10-05 19:49:07 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(result);
|
2023-10-11 15:15:59 +00:00
|
|
|
|
|
2023-10-05 19:49:07 +00:00
|
|
|
|
destination = result;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-06 21:04:31 +00:00
|
|
|
|
template <bool with_borrow, AccessType destination_type, typename IntT, typename ContextT>
|
|
|
|
|
void sub(
|
2023-11-07 14:14:42 +00:00
|
|
|
|
access_t<IntT, destination_type> destination,
|
2023-11-06 21:04:31 +00:00
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-09 20:21:04 +00:00
|
|
|
|
/*
|
2023-10-11 02:43:06 +00:00
|
|
|
|
DEST ← DEST - (SRC [+ CF]);
|
2023-10-09 20:21:04 +00:00
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The OF, SF, ZF, AF, CF, and PF flags are set according to the result.
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
const IntT result = destination - source - (with_borrow ? context.flags.template carry_bit<IntT>() : 0);
|
2023-10-09 20:21:04 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(
|
2023-10-11 16:35:17 +00:00
|
|
|
|
Numeric::carried_out<false, Numeric::bit_size<IntT>() - 1>(destination, source, result));
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(
|
2023-10-11 16:35:17 +00:00
|
|
|
|
Numeric::carried_in<4>(destination, source, result));
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow>(
|
2023-10-11 16:35:17 +00:00
|
|
|
|
Numeric::overflow<false, IntT>(destination, source, result));
|
2023-10-09 20:21:04 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(result);
|
2023-10-11 15:15:59 +00:00
|
|
|
|
|
2023-11-06 21:04:31 +00:00
|
|
|
|
if constexpr (destination_type == AccessType::Write) {
|
2023-10-11 02:15:33 +00:00
|
|
|
|
destination = result;
|
|
|
|
|
}
|
2023-10-09 20:21:04 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void test(
|
|
|
|
|
read_t<IntT> destination,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-11 02:28:10 +00:00
|
|
|
|
/*
|
|
|
|
|
TEMP ← SRC1 AND SRC2;
|
|
|
|
|
SF ← MSB(TEMP);
|
|
|
|
|
IF TEMP = 0
|
|
|
|
|
THEN ZF ← 0;
|
|
|
|
|
ELSE ZF ← 1;
|
|
|
|
|
FI:
|
|
|
|
|
PF ← BitwiseXNOR(TEMP[0:7]);
|
|
|
|
|
CF ← 0;
|
|
|
|
|
OF ← 0;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The OF and CF flags are cleared to 0.
|
|
|
|
|
The SF, ZF, and PF flags are set according to the result (see the “Operation” section above).
|
|
|
|
|
The state of the AF flag is undefined.
|
|
|
|
|
*/
|
|
|
|
|
const IntT result = destination & source;
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::Overflow>(0);
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(result);
|
2023-10-11 02:28:10 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-11 02:34:42 +00:00
|
|
|
|
template <typename IntT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void xchg(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
modify_t<IntT> source
|
|
|
|
|
) {
|
2023-10-11 02:34:42 +00:00
|
|
|
|
/*
|
|
|
|
|
TEMP ← DEST
|
|
|
|
|
DEST ← SRC
|
|
|
|
|
SRC ← TEMP
|
|
|
|
|
*/
|
|
|
|
|
std::swap(destination, source);
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void mul(
|
|
|
|
|
modify_t<IntT> destination_high,
|
|
|
|
|
modify_t<IntT> destination_low,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 01:50:17 +00:00
|
|
|
|
/*
|
|
|
|
|
IF byte operation
|
|
|
|
|
THEN
|
|
|
|
|
AX ← AL * SRC
|
|
|
|
|
ELSE (* word or doubleword operation *)
|
|
|
|
|
IF OperandSize = 16 THEN
|
|
|
|
|
DX:AX ← AX * SRC
|
|
|
|
|
ELSE (* OperandSize = 32 *)
|
|
|
|
|
EDX:EAX ← EAX * SRC
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The OF and CF flags are cleared to 0 if the upper half of the result is 0;
|
|
|
|
|
otherwise, they are set to 1. The SF, ZF, AF, and PF flags are undefined.
|
|
|
|
|
*/
|
|
|
|
|
destination_high = (destination_low * source) >> (8 * sizeof(IntT));
|
|
|
|
|
destination_low *= source;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow, Flag::Carry>(destination_high);
|
2023-10-10 01:50:17 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void imul(
|
|
|
|
|
modify_t<IntT> destination_high,
|
|
|
|
|
modify_t<IntT> destination_low,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 02:12:15 +00:00
|
|
|
|
/*
|
|
|
|
|
(as modified by https://www.felixcloutier.com/x86/daa ...)
|
|
|
|
|
|
|
|
|
|
IF (OperandSize = 8)
|
|
|
|
|
THEN
|
|
|
|
|
AX ← AL ∗ SRC (* signed multiplication *)
|
|
|
|
|
IF (AX = SignExtend(AL))
|
|
|
|
|
THEN CF = 0; OF = 0;
|
|
|
|
|
ELSE CF = 1; OF = 1;
|
|
|
|
|
FI;
|
|
|
|
|
ELSE IF OperandSize = 16
|
|
|
|
|
THEN
|
|
|
|
|
DX:AX ← AX ∗ SRC (* signed multiplication *)
|
|
|
|
|
IF (DX:AX = SignExtend(AX))
|
|
|
|
|
THEN CF = 0; OF = 0;
|
|
|
|
|
ELSE CF = 1; OF = 1;
|
|
|
|
|
FI;
|
|
|
|
|
ELSE (* OperandSize = 32 *)
|
|
|
|
|
EDX:EAX ← EAX ∗ SRC (* signed multiplication *)
|
|
|
|
|
IF (EDX:EAX = SignExtend(EAX))
|
|
|
|
|
THEN CF = 0; OF = 0;
|
|
|
|
|
ELSE CF = 1; OF = 1;
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
using sIntT = typename std::make_signed<IntT>::type;
|
|
|
|
|
destination_high = (sIntT(destination_low) * sIntT(source)) >> (8 * sizeof(IntT));
|
|
|
|
|
destination_low = IntT(sIntT(destination_low) * sIntT(source));
|
|
|
|
|
|
2023-10-11 15:06:20 +00:00
|
|
|
|
const auto sign_extension = (destination_low & Numeric::top_bit<IntT>()) ? IntT(~0) : 0;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow, Flag::Carry>(destination_high != sign_extension);
|
2023-10-10 02:12:15 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void div(
|
|
|
|
|
modify_t<IntT> destination_high,
|
|
|
|
|
modify_t<IntT> destination_low,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 19:57:33 +00:00
|
|
|
|
/*
|
|
|
|
|
IF SRC = 0
|
|
|
|
|
THEN #DE; (* divide error *)
|
|
|
|
|
FI;
|
|
|
|
|
IF OperandSize = 8 (* word/byte operation *)
|
|
|
|
|
THEN
|
|
|
|
|
temp ← AX / SRC;
|
|
|
|
|
IF temp > FFH
|
|
|
|
|
THEN #DE; (* divide error *) ;
|
|
|
|
|
ELSE
|
|
|
|
|
AL ← temp;
|
|
|
|
|
AH ← AX MOD SRC;
|
|
|
|
|
FI;
|
|
|
|
|
ELSE
|
|
|
|
|
IF OperandSize = 16 (* doubleword/word operation *)
|
|
|
|
|
THEN
|
|
|
|
|
temp ← DX:AX / SRC;
|
|
|
|
|
IF temp > FFFFH
|
|
|
|
|
THEN #DE; (* divide error *) ;
|
|
|
|
|
ELSE
|
|
|
|
|
AX ← temp;
|
|
|
|
|
DX ← DX:AX MOD SRC;
|
|
|
|
|
FI;
|
|
|
|
|
ELSE (* quadword/doubleword operation *)
|
|
|
|
|
temp ← EDX:EAX / SRC;
|
|
|
|
|
IF temp > FFFFFFFFH
|
|
|
|
|
THEN #DE; (* divide error *) ;
|
|
|
|
|
ELSE
|
|
|
|
|
EAX ← temp;
|
|
|
|
|
EDX ← EDX:EAX MOD SRC;
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF, OF, SF, ZF, AF, and PF flags are undefined.
|
|
|
|
|
*/
|
2023-10-10 14:34:18 +00:00
|
|
|
|
if(!source) {
|
2023-11-02 03:39:52 +00:00
|
|
|
|
interrupt(Interrupt::DivideError, context);
|
2023-10-10 14:34:18 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// TEMPORARY HACK. Will not work with DWords.
|
|
|
|
|
const uint32_t dividend = (destination_high << (8 * sizeof(IntT))) + destination_low;
|
|
|
|
|
const auto result = dividend / source;
|
|
|
|
|
if(IntT(result) != result) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
interrupt(Interrupt::DivideError, context);
|
2023-10-10 14:34:18 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
destination_low = IntT(result);
|
|
|
|
|
destination_high = dividend % source;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void idiv(
|
|
|
|
|
modify_t<IntT> destination_high,
|
|
|
|
|
modify_t<IntT> destination_low,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 19:57:33 +00:00
|
|
|
|
/*
|
|
|
|
|
IF SRC = 0
|
|
|
|
|
THEN #DE; (* divide error *)
|
|
|
|
|
FI;
|
|
|
|
|
IF OperandSize = 8 (* word/byte operation *)
|
|
|
|
|
THEN
|
|
|
|
|
temp ← AX / SRC; (* signed division *)
|
|
|
|
|
IF (temp > 7FH) OR (temp < 80H) (* if a positive result is greater than 7FH or a negative result is less than 80H *)
|
|
|
|
|
THEN #DE; (* divide error *) ;
|
|
|
|
|
ELSE
|
|
|
|
|
AL ← temp;
|
|
|
|
|
AH ← AX MOD SRC;
|
|
|
|
|
FI;
|
|
|
|
|
ELSE
|
|
|
|
|
IF OperandSize = 16 (* doubleword/word operation *)
|
|
|
|
|
THEN
|
|
|
|
|
temp ← DX:AX / SRC; (* signed division *)
|
|
|
|
|
IF (temp > 7FFFH) OR (temp < 8000H) (* if a positive result is greater than 7FFFH or a negative result is less than 8000H *)
|
|
|
|
|
THEN #DE; (* divide error *) ;
|
|
|
|
|
ELSE
|
|
|
|
|
AX ← temp;
|
|
|
|
|
DX ← DX:AX MOD SRC;
|
|
|
|
|
FI;
|
|
|
|
|
ELSE (* quadword/doubleword operation *)
|
|
|
|
|
temp ← EDX:EAX / SRC; (* signed division *)
|
|
|
|
|
IF (temp > 7FFFFFFFH) OR (temp < 80000000H) (* if a positive result is greater than 7FFFFFFFH or a negative result is less than 80000000H *)
|
|
|
|
|
THEN #DE; (* divide error *) ;
|
|
|
|
|
ELSE
|
|
|
|
|
EAX ← temp;
|
|
|
|
|
EDX ← EDX:EAX MOD SRC;
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF, OF, SF, ZF, AF, and PF flags are undefined.
|
|
|
|
|
*/
|
2023-10-10 14:34:18 +00:00
|
|
|
|
if(!source) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
interrupt(Interrupt::DivideError, context);
|
2023-10-10 14:34:18 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// TEMPORARY HACK. Will not work with DWords.
|
|
|
|
|
using sIntT = typename std::make_signed<IntT>::type;
|
|
|
|
|
const int32_t dividend = (sIntT(destination_high) << (8 * sizeof(IntT))) + destination_low;
|
|
|
|
|
const auto result = dividend / sIntT(source);
|
|
|
|
|
if(sIntT(result) != result) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
interrupt(Interrupt::DivideError, context);
|
2023-10-10 14:34:18 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
destination_low = IntT(result);
|
|
|
|
|
destination_high = dividend % sIntT(source);
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void inc(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 19:57:33 +00:00
|
|
|
|
/*
|
|
|
|
|
DEST ← DEST + 1;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF flag is not affected.
|
|
|
|
|
The OF, SF, ZF, AF, and PF flags are set according to the result.
|
|
|
|
|
*/
|
|
|
|
|
++destination;
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow>(destination == Numeric::top_bit<IntT>());
|
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(((destination - 1) ^ destination) & 0x10);
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(destination);
|
2023-10-10 19:57:33 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void jump(
|
|
|
|
|
bool condition,
|
|
|
|
|
IntT displacement,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 20:27:06 +00:00
|
|
|
|
/*
|
|
|
|
|
IF condition
|
|
|
|
|
THEN
|
|
|
|
|
EIP ← EIP + SignExtend(DEST);
|
|
|
|
|
IF OperandSize = 16
|
|
|
|
|
THEN
|
|
|
|
|
EIP ← EIP AND 0000FFFFH;
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
// TODO: proper behaviour in 32-bit.
|
|
|
|
|
if(condition) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(context.registers.ip() + displacement);
|
2023-10-10 20:27:06 +00:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename OffsetT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void loop(
|
|
|
|
|
modify_t<IntT> counter,
|
|
|
|
|
OffsetT displacement,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-18 18:04:21 +00:00
|
|
|
|
--counter;
|
|
|
|
|
if(counter) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(context.registers.ip() + displacement);
|
2023-10-18 18:04:21 +00:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename OffsetT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void loope(
|
|
|
|
|
modify_t<IntT> counter,
|
|
|
|
|
OffsetT displacement,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-18 18:04:21 +00:00
|
|
|
|
--counter;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if(counter && context.flags.template flag<Flag::Zero>()) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(context.registers.ip() + displacement);
|
2023-10-18 18:04:21 +00:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename OffsetT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void loopne(
|
|
|
|
|
modify_t<IntT> counter,
|
|
|
|
|
OffsetT displacement,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-18 18:04:21 +00:00
|
|
|
|
--counter;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if(counter && !context.flags.template flag<Flag::Zero>()) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(context.registers.ip() + displacement);
|
2023-10-18 18:04:21 +00:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void dec(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 19:57:33 +00:00
|
|
|
|
/*
|
|
|
|
|
DEST ← DEST - 1;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF flag is not affected.
|
|
|
|
|
The OF, SF, ZF, AF, and PF flags are set according to the result.
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow>(destination == Numeric::top_bit<IntT>());
|
2023-10-10 19:57:33 +00:00
|
|
|
|
|
|
|
|
|
--destination;
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(destination);
|
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(((destination + 1) ^ destination) & 0x10);
|
2023-10-10 19:57:33 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void and_(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-09 02:18:40 +00:00
|
|
|
|
/*
|
|
|
|
|
DEST ← DEST AND SRC;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The OF and CF flags are cleared; the SF, ZF, and PF flags are set according to the result.
|
|
|
|
|
The state of the AF flag is undefined.
|
|
|
|
|
*/
|
|
|
|
|
destination &= source;
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow, Flag::Carry>(0);
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(destination);
|
2023-10-09 02:18:40 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void or_(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 21:12:06 +00:00
|
|
|
|
/*
|
|
|
|
|
DEST ← DEST OR SRC;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The OF and CF flags are cleared; the SF, ZF, and PF flags are set according to the result.
|
|
|
|
|
The state of the AF flag is undefined.
|
|
|
|
|
*/
|
|
|
|
|
destination |= source;
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow, Flag::Carry>(0);
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(destination);
|
2023-10-10 21:12:06 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void xor_(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
read_t<IntT> source,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-10 21:12:06 +00:00
|
|
|
|
/*
|
|
|
|
|
DEST ← DEST XOR SRC;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The OF and CF flags are cleared; the SF, ZF, and PF flags are set according to the result.
|
|
|
|
|
The state of the AF flag is undefined.
|
|
|
|
|
*/
|
|
|
|
|
destination ^= source;
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow, Flag::Carry>(0);
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(destination);
|
2023-10-10 21:12:06 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void neg(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-11 02:09:10 +00:00
|
|
|
|
/*
|
|
|
|
|
IF DEST = 0
|
|
|
|
|
THEN CF ← 0
|
|
|
|
|
ELSE CF ← 1;
|
|
|
|
|
FI;
|
|
|
|
|
DEST ← –(DEST)
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF flag cleared to 0 if the source operand is 0; otherwise it is set to 1.
|
|
|
|
|
The OF, SF, ZF, AF, and PF flags are set according to the result.
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(Numeric::carried_in<4>(IntT(0), destination, IntT(-destination)));
|
2023-10-11 02:09:10 +00:00
|
|
|
|
|
|
|
|
|
destination = -destination;
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(destination);
|
|
|
|
|
context.flags.template set_from<Flag::Overflow>(destination == Numeric::top_bit<IntT>());
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Zero, Flag::Sign, Flag::ParityOdd>(destination);
|
2023-10-11 02:09:10 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
template <typename IntT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void not_(
|
|
|
|
|
modify_t<IntT> destination
|
|
|
|
|
) {
|
2023-10-11 02:09:10 +00:00
|
|
|
|
/*
|
|
|
|
|
DEST ← NOT DEST;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
Flags affected: none.
|
|
|
|
|
*/
|
2023-11-07 14:58:42 +00:00
|
|
|
|
destination = ~destination;
|
2023-10-11 02:09:10 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void call_relative(
|
|
|
|
|
IntT offset,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
push<uint16_t, false>(context.registers.ip(), context);
|
|
|
|
|
context.flow_controller.jump(context.registers.ip() + offset);
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void call_absolute(
|
|
|
|
|
read_t<IntT> target,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
push<uint16_t, false>(context.registers.ip(), context);
|
|
|
|
|
context.flow_controller.jump(target);
|
2023-10-09 15:46:59 +00:00
|
|
|
|
}
|
2023-10-08 17:34:28 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void jump_absolute(
|
|
|
|
|
read_t<IntT> target,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(target);
|
2023-10-18 17:15:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename InstructionT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void call_far(
|
|
|
|
|
InstructionT &instruction,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-09 15:46:59 +00:00
|
|
|
|
// TODO: eliminate 16-bit assumption below.
|
2023-11-01 18:49:30 +00:00
|
|
|
|
const Source source_segment = instruction.data_segment();
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.preauthorise_stack_write(sizeof(uint16_t) * 2);
|
2023-11-01 18:49:30 +00:00
|
|
|
|
|
|
|
|
|
uint16_t source_address;
|
2023-10-12 18:24:28 +00:00
|
|
|
|
const auto pointer = instruction.destination();
|
2023-10-25 18:43:58 +00:00
|
|
|
|
switch(pointer.source()) {
|
2023-10-09 15:46:59 +00:00
|
|
|
|
default:
|
2023-11-01 18:49:30 +00:00
|
|
|
|
case Source::Immediate:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
push<uint16_t, true>(context.registers.cs(), context);
|
|
|
|
|
push<uint16_t, true>(context.registers.ip(), context);
|
|
|
|
|
context.flow_controller.jump(instruction.segment(), instruction.offset());
|
2023-11-01 18:49:30 +00:00
|
|
|
|
return;
|
2023-10-08 17:34:28 +00:00
|
|
|
|
|
2023-10-09 15:46:59 +00:00
|
|
|
|
case Source::Indirect:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
source_address = address<Source::Indirect, uint16_t, AccessType::Read>(instruction, pointer, context);
|
2023-10-09 15:46:59 +00:00
|
|
|
|
break;
|
|
|
|
|
case Source::IndirectNoBase:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
source_address = address<Source::IndirectNoBase, uint16_t, AccessType::Read>(instruction, pointer, context);
|
2023-10-09 15:46:59 +00:00
|
|
|
|
break;
|
2023-10-08 17:34:28 +00:00
|
|
|
|
case Source::DirectAddress:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
source_address = address<Source::DirectAddress, uint16_t, AccessType::Read>(instruction, pointer, context);
|
2023-10-08 17:34:28 +00:00
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.preauthorise_read(source_segment, source_address, sizeof(uint16_t) * 2);
|
|
|
|
|
const uint16_t offset = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(source_segment, source_address);
|
2023-10-09 15:46:59 +00:00
|
|
|
|
source_address += 2;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
const uint16_t segment = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(source_segment, source_address);
|
2023-11-02 03:39:52 +00:00
|
|
|
|
|
|
|
|
|
// At least on an 8086, the stack writes occur after the target address read.
|
|
|
|
|
push<uint16_t, true>(context.registers.cs(), context);
|
|
|
|
|
push<uint16_t, true>(context.registers.ip(), context);
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(segment, offset);
|
2023-10-09 15:46:59 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename InstructionT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void jump_far(
|
|
|
|
|
InstructionT &instruction,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-18 17:15:00 +00:00
|
|
|
|
// TODO: eliminate 16-bit assumption below.
|
|
|
|
|
uint16_t source_address = 0;
|
|
|
|
|
const auto pointer = instruction.destination();
|
2023-10-25 18:43:58 +00:00
|
|
|
|
switch(pointer.source()) {
|
2023-10-18 17:15:00 +00:00
|
|
|
|
default:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Source::Immediate: context.flow_controller.jump(instruction.segment(), instruction.offset()); return;
|
2023-10-18 17:15:00 +00:00
|
|
|
|
|
|
|
|
|
case Source::Indirect:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
source_address = address<Source::Indirect, uint16_t, AccessType::Read>(instruction, pointer, context);
|
2023-10-18 17:15:00 +00:00
|
|
|
|
break;
|
|
|
|
|
case Source::IndirectNoBase:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
source_address = address<Source::IndirectNoBase, uint16_t, AccessType::Read>(instruction, pointer, context);
|
2023-10-18 17:15:00 +00:00
|
|
|
|
break;
|
|
|
|
|
case Source::DirectAddress:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
source_address = address<Source::DirectAddress, uint16_t, AccessType::Read>(instruction, pointer, context);
|
2023-10-18 17:15:00 +00:00
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
2023-10-27 16:54:42 +00:00
|
|
|
|
const Source source_segment = instruction.data_segment();
|
2023-11-02 03:39:52 +00:00
|
|
|
|
context.memory.preauthorise_read(source_segment, source_address, sizeof(uint16_t) * 2);
|
2023-10-18 17:15:00 +00:00
|
|
|
|
|
2023-11-02 19:37:59 +00:00
|
|
|
|
const uint16_t offset = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(source_segment, source_address);
|
2023-10-18 17:15:00 +00:00
|
|
|
|
source_address += 2;
|
2023-11-02 19:37:59 +00:00
|
|
|
|
const uint16_t segment = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(source_segment, source_address);
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(segment, offset);
|
2023-10-18 17:15:00 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void iret(
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-16 19:40:24 +00:00
|
|
|
|
// TODO: all modes other than 16-bit real mode.
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.preauthorise_stack_read(sizeof(uint16_t) * 3);
|
|
|
|
|
const auto ip = pop<uint16_t, true>(context);
|
|
|
|
|
const auto cs = pop<uint16_t, true>(context);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.set(pop<uint16_t, true>(context));
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.jump(cs, ip);
|
2023-10-16 19:40:24 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename InstructionT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void ret_near(
|
|
|
|
|
InstructionT instruction,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
const auto ip = pop<uint16_t, false>(context);
|
|
|
|
|
context.registers.sp() += instruction.operand();
|
|
|
|
|
context.flow_controller.jump(ip);
|
2023-10-16 19:40:24 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename InstructionT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void ret_far(
|
|
|
|
|
InstructionT instruction,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.preauthorise_stack_read(sizeof(uint16_t) * 2);
|
|
|
|
|
const auto ip = pop<uint16_t, true>(context);
|
|
|
|
|
const auto cs = pop<uint16_t, true>(context);
|
|
|
|
|
context.registers.sp() += instruction.operand();
|
|
|
|
|
context.flow_controller.jump(cs, ip);
|
2023-10-16 19:40:24 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <Source selector, typename InstructionT, typename ContextT>
|
2023-10-12 18:24:28 +00:00
|
|
|
|
void ld(
|
2023-11-07 14:58:42 +00:00
|
|
|
|
const InstructionT &instruction,
|
|
|
|
|
write_t<uint16_t> destination,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
ContextT &context
|
2023-10-12 18:24:28 +00:00
|
|
|
|
) {
|
|
|
|
|
const auto pointer = instruction.source();
|
2023-11-01 21:03:23 +00:00
|
|
|
|
auto source_address = address<uint16_t, AccessType::Read>(instruction, pointer, context);
|
2023-10-27 16:54:42 +00:00
|
|
|
|
const Source source_segment = instruction.data_segment();
|
2023-10-12 18:24:28 +00:00
|
|
|
|
|
2023-11-02 19:37:59 +00:00
|
|
|
|
context.memory.preauthorise_read(source_segment, source_address, 4);
|
|
|
|
|
destination = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(source_segment, source_address);
|
2023-10-12 18:24:28 +00:00
|
|
|
|
source_address += 2;
|
|
|
|
|
switch(selector) {
|
2023-11-02 19:37:59 +00:00
|
|
|
|
case Source::DS: context.registers.ds() = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(source_segment, source_address); break;
|
|
|
|
|
case Source::ES: context.registers.es() = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(source_segment, source_address); break;
|
2023-10-12 18:24:28 +00:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename InstructionT, typename ContextT>
|
2023-10-12 18:31:25 +00:00
|
|
|
|
void lea(
|
2023-10-13 01:12:03 +00:00
|
|
|
|
const InstructionT &instruction,
|
2023-11-07 14:58:42 +00:00
|
|
|
|
write_t<IntT> destination,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
ContextT &context
|
2023-10-12 18:31:25 +00:00
|
|
|
|
) {
|
|
|
|
|
// TODO: address size.
|
2023-11-01 21:03:23 +00:00
|
|
|
|
destination = IntT(address<uint16_t, AccessType::Read>(instruction, instruction.source(), context));
|
2023-10-12 18:31:25 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename AddressT, typename InstructionT, typename ContextT>
|
2023-10-13 01:12:03 +00:00
|
|
|
|
void xlat(
|
|
|
|
|
const InstructionT &instruction,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
ContextT &context
|
2023-10-13 01:12:03 +00:00
|
|
|
|
) {
|
|
|
|
|
AddressT address;
|
|
|
|
|
if constexpr (std::is_same_v<AddressT, uint16_t>) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
address = context.registers.bx() + context.registers.al();
|
2023-10-13 01:12:03 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.registers.al() = context.memory.template access<uint8_t, AccessType::Read>(instruction.data_segment(), address);
|
2023-10-13 01:12:03 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-12 19:34:46 +00:00
|
|
|
|
template <typename IntT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void mov(
|
|
|
|
|
write_t<IntT> destination,
|
|
|
|
|
read_t<IntT> source
|
|
|
|
|
) {
|
2023-10-12 19:34:46 +00:00
|
|
|
|
destination = source;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void into(
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if(context.flags.template flag<Flag::Overflow>()) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
interrupt(Interrupt::OnOverflow, context);
|
2023-10-11 20:01:09 +00:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void sahf(
|
|
|
|
|
uint8_t &ah,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-12 17:54:51 +00:00
|
|
|
|
/*
|
|
|
|
|
EFLAGS(SF:ZF:0:AF:0:PF:1:CF) ← AH;
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<uint8_t, Flag::Sign>(ah);
|
|
|
|
|
context.flags.template set_from<Flag::Zero>(!(ah & 0x40));
|
|
|
|
|
context.flags.template set_from<Flag::AuxiliaryCarry>(ah & 0x10);
|
|
|
|
|
context.flags.template set_from<Flag::ParityOdd>(!(ah & 0x04));
|
|
|
|
|
context.flags.template set_from<Flag::Carry>(ah & 0x01);
|
2023-10-12 17:54:51 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void lahf(
|
|
|
|
|
uint8_t &ah,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-12 17:54:51 +00:00
|
|
|
|
/*
|
|
|
|
|
AH ← EFLAGS(SF:ZF:0:AF:0:PF:1:CF);
|
|
|
|
|
*/
|
|
|
|
|
ah =
|
2023-11-02 20:55:38 +00:00
|
|
|
|
(context.flags.template flag<Flag::Sign>() ? 0x80 : 0x00) |
|
|
|
|
|
(context.flags.template flag<Flag::Zero>() ? 0x40 : 0x00) |
|
|
|
|
|
(context.flags.template flag<Flag::AuxiliaryCarry>() ? 0x10 : 0x00) |
|
|
|
|
|
(context.flags.template flag<Flag::ParityOdd>() ? 0x00 : 0x04) |
|
2023-10-12 17:54:51 +00:00
|
|
|
|
0x02 |
|
2023-11-02 20:55:38 +00:00
|
|
|
|
(context.flags.template flag<Flag::Carry>() ? 0x01 : 0x00);
|
2023-10-12 17:54:51 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-09 19:00:04 +00:00
|
|
|
|
template <typename IntT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void cbw(
|
|
|
|
|
IntT &ax
|
|
|
|
|
) {
|
2023-10-09 19:00:04 +00:00
|
|
|
|
constexpr IntT test_bit = 1 << (sizeof(IntT) * 4 - 1);
|
|
|
|
|
constexpr IntT low_half = (1 << (sizeof(IntT) * 4)) - 1;
|
|
|
|
|
|
|
|
|
|
if(ax & test_bit) {
|
|
|
|
|
ax |= ~low_half;
|
|
|
|
|
} else {
|
|
|
|
|
ax &= low_half;
|
|
|
|
|
}
|
2023-10-09 15:59:38 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-09 18:54:14 +00:00
|
|
|
|
template <typename IntT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void cwd(
|
|
|
|
|
IntT &dx,
|
|
|
|
|
IntT ax
|
|
|
|
|
) {
|
2023-10-11 15:06:20 +00:00
|
|
|
|
dx = ax & Numeric::top_bit<IntT>() ? IntT(~0) : IntT(0);
|
2023-10-09 18:54:14 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-11 16:35:17 +00:00
|
|
|
|
// TODO: changes to the interrupt flag do quite a lot more in protected mode.
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-02 20:55:38 +00:00
|
|
|
|
void clc(ContextT &context) { context.flags.template set_from<Flag::Carry>(0); }
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-02 20:55:38 +00:00
|
|
|
|
void cld(ContextT &context) { context.flags.template set_from<Flag::Direction>(0); }
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-02 20:55:38 +00:00
|
|
|
|
void cli(ContextT &context) { context.flags.template set_from<Flag::Interrupt>(0); }
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-02 20:55:38 +00:00
|
|
|
|
void stc(ContextT &context) { context.flags.template set_from<Flag::Carry>(1); }
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-02 20:55:38 +00:00
|
|
|
|
void std(ContextT &context) { context.flags.template set_from<Flag::Direction>(1); }
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-02 20:55:38 +00:00
|
|
|
|
void sti(ContextT &context) { context.flags.template set_from<Flag::Interrupt>(1); }
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
|
|
|
|
void cmc(ContextT &context) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(!context.flags.template flag<Flag::Carry>());
|
2023-11-01 21:03:23 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
template <typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void salc(
|
|
|
|
|
uint8_t &al,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
al = context.flags.template flag<Flag::Carry>() ? 0xff : 0x00;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void setmo(
|
|
|
|
|
write_t<IntT> destination,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-12 19:52:05 +00:00
|
|
|
|
destination = ~0;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::AuxiliaryCarry, Flag::Overflow>(0);
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Sign, Flag::Zero, Flag::ParityOdd>(destination);
|
2023-10-12 19:52:05 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void rcl(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
uint8_t count,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-13 18:44:22 +00:00
|
|
|
|
/*
|
|
|
|
|
(* RCL and RCR instructions *)
|
|
|
|
|
SIZE ← OperandSize
|
|
|
|
|
CASE (determine count) OF
|
|
|
|
|
SIZE = 8: tempCOUNT ← (COUNT AND 1FH) MOD 9;
|
|
|
|
|
SIZE = 16: tempCOUNT ← (COUNT AND 1FH) MOD 17;
|
|
|
|
|
SIZE = 32: tempCOUNT ← COUNT AND 1FH;
|
|
|
|
|
ESAC;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
(* RCL instruction operation *)
|
|
|
|
|
WHILE (tempCOUNT ≠ 0)
|
|
|
|
|
DO
|
|
|
|
|
tempCF ← MSB(DEST);
|
|
|
|
|
DEST ← (DEST * 2) + CF;
|
|
|
|
|
CF ← tempCF;
|
|
|
|
|
tempCOUNT ← tempCOUNT – 1;
|
|
|
|
|
OD;
|
|
|
|
|
ELIHW;
|
|
|
|
|
IF COUNT = 1
|
|
|
|
|
THEN OF ← MSB(DEST) XOR CF;
|
|
|
|
|
ELSE OF is undefined;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF flag contains the value of the bit shifted into it.
|
|
|
|
|
The OF flag is affected only for single- bit rotates (see “Description” above);
|
|
|
|
|
it is undefined for multi-bit rotates. The SF, ZF, AF, and PF flags are not affected.
|
|
|
|
|
*/
|
2023-10-14 01:44:48 +00:00
|
|
|
|
const auto temp_count = count % (Numeric::bit_size<IntT>() + 1);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
auto carry = context.flags.template carry_bit<IntT>();
|
2023-10-14 01:32:35 +00:00
|
|
|
|
switch(temp_count) {
|
|
|
|
|
case 0: break;
|
|
|
|
|
case Numeric::bit_size<IntT>(): {
|
|
|
|
|
const IntT temp_carry = destination & 1;
|
|
|
|
|
destination = (destination >> 1) | (carry << (Numeric::bit_size<IntT>() - 1));
|
|
|
|
|
carry = temp_carry;
|
|
|
|
|
} break;
|
|
|
|
|
default: {
|
|
|
|
|
const IntT temp_carry = destination & (Numeric::top_bit<IntT>() >> (temp_count - 1));
|
|
|
|
|
destination =
|
|
|
|
|
(destination << temp_count) |
|
|
|
|
|
(destination >> (Numeric::bit_size<IntT>() + 1 - temp_count)) |
|
|
|
|
|
(carry << (temp_count - 1));
|
|
|
|
|
carry = temp_carry ? 1 : 0;
|
|
|
|
|
} break;
|
2023-10-13 18:44:22 +00:00
|
|
|
|
}
|
2023-10-14 01:32:35 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(carry);
|
|
|
|
|
context.flags.template set_from<Flag::Overflow>(
|
2023-10-13 18:44:22 +00:00
|
|
|
|
((destination >> (Numeric::bit_size<IntT>() - 1)) & 1) ^ carry
|
|
|
|
|
);
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void rcr(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
uint8_t count,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-14 01:44:48 +00:00
|
|
|
|
/*
|
|
|
|
|
(* RCR instruction operation *)
|
|
|
|
|
IF COUNT = 1
|
|
|
|
|
THEN OF ← MSB(DEST) XOR CF;
|
|
|
|
|
ELSE OF is undefined;
|
|
|
|
|
FI;
|
|
|
|
|
WHILE (tempCOUNT ≠ 0)
|
|
|
|
|
DO
|
|
|
|
|
tempCF ← LSB(SRC);
|
|
|
|
|
DEST ← (DEST / 2) + (CF * 2SIZE);
|
|
|
|
|
CF ← tempCF;
|
|
|
|
|
tempCOUNT ← tempCOUNT – 1;
|
|
|
|
|
OD;
|
|
|
|
|
*/
|
2023-11-02 20:55:38 +00:00
|
|
|
|
auto carry = context.flags.template carry_bit<IntT>();
|
|
|
|
|
context.flags.template set_from<Flag::Overflow>(
|
2023-10-14 01:44:48 +00:00
|
|
|
|
((destination >> (Numeric::bit_size<IntT>() - 1)) & 1) ^ carry
|
|
|
|
|
);
|
|
|
|
|
|
|
|
|
|
const auto temp_count = count % (Numeric::bit_size<IntT>() + 1);
|
|
|
|
|
switch(temp_count) {
|
|
|
|
|
case 0: break;
|
|
|
|
|
case Numeric::bit_size<IntT>(): {
|
|
|
|
|
const IntT temp_carry = destination & Numeric::top_bit<IntT>();
|
|
|
|
|
destination = (destination << 1) | carry;
|
|
|
|
|
carry = temp_carry;
|
|
|
|
|
} break;
|
|
|
|
|
default: {
|
|
|
|
|
const IntT temp_carry = destination & (1 << (temp_count - 1));
|
|
|
|
|
destination =
|
|
|
|
|
(destination >> temp_count) |
|
|
|
|
|
(destination << (Numeric::bit_size<IntT>() + 1 - temp_count)) |
|
|
|
|
|
(carry << (Numeric::bit_size<IntT>() - temp_count));
|
|
|
|
|
carry = temp_carry;
|
|
|
|
|
} break;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(carry);
|
2023-10-14 01:44:48 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void rol(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
uint8_t count,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-14 02:03:54 +00:00
|
|
|
|
/*
|
|
|
|
|
(* ROL and ROR instructions *)
|
|
|
|
|
SIZE ← OperandSize
|
|
|
|
|
CASE (determine count) OF
|
|
|
|
|
SIZE = 8: tempCOUNT ← COUNT MOD 8;
|
|
|
|
|
SIZE = 16: tempCOUNT ← COUNT MOD 16;
|
|
|
|
|
SIZE = 32: tempCOUNT ← COUNT MOD 32;
|
|
|
|
|
ESAC;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
(* ROL instruction operation *)
|
|
|
|
|
WHILE (tempCOUNT ≠ 0)
|
|
|
|
|
DO
|
|
|
|
|
tempCF ← MSB(DEST);
|
|
|
|
|
DEST ← (DEST * 2) + tempCF;
|
|
|
|
|
tempCOUNT ← tempCOUNT – 1;
|
|
|
|
|
OD;
|
|
|
|
|
ELIHW;
|
|
|
|
|
IF COUNT = 1
|
|
|
|
|
THEN OF ← MSB(DEST) XOR CF;
|
|
|
|
|
ELSE OF is undefined;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF flag contains the value of the bit shifted into it.
|
|
|
|
|
The OF flag is affected only for single- bit rotates (see “Description” above);
|
|
|
|
|
it is undefined for multi-bit rotates. The SF, ZF, AF, and PF flags are not affected.
|
|
|
|
|
*/
|
|
|
|
|
const auto temp_count = count & (Numeric::bit_size<IntT>() - 1);
|
|
|
|
|
if(!count) {
|
|
|
|
|
// TODO: is this 8086-specific? i.e. do the other x86s also exit without affecting flags when temp_count = 0?
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
if(temp_count) {
|
|
|
|
|
destination =
|
|
|
|
|
(destination << temp_count) |
|
|
|
|
|
(destination >> (Numeric::bit_size<IntT>() - temp_count));
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(destination & 1);
|
|
|
|
|
context.flags.template set_from<Flag::Overflow>(
|
2023-10-14 02:03:54 +00:00
|
|
|
|
((destination >> (Numeric::bit_size<IntT>() - 1)) ^ destination) & 1
|
|
|
|
|
);
|
|
|
|
|
}
|
2023-10-14 01:44:48 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void ror(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
uint8_t count,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-14 02:03:54 +00:00
|
|
|
|
/*
|
|
|
|
|
(* ROL and ROR instructions *)
|
|
|
|
|
SIZE ← OperandSize
|
|
|
|
|
CASE (determine count) OF
|
|
|
|
|
SIZE = 8: tempCOUNT ← COUNT MOD 8;
|
|
|
|
|
SIZE = 16: tempCOUNT ← COUNT MOD 16;
|
|
|
|
|
SIZE = 32: tempCOUNT ← COUNT MOD 32;
|
|
|
|
|
ESAC;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
(* ROR instruction operation *)
|
|
|
|
|
WHILE (tempCOUNT ≠ 0)
|
|
|
|
|
DO
|
|
|
|
|
tempCF ← LSB(DEST);
|
|
|
|
|
DEST ← (DEST / 2) + (tempCF * 2^SIZE);
|
|
|
|
|
tempCOUNT ← tempCOUNT – 1;
|
|
|
|
|
OD;
|
|
|
|
|
ELIHW;
|
|
|
|
|
IF COUNT = 1
|
|
|
|
|
THEN OF ← MSB(DEST) XOR MSB - 1 (DEST);
|
|
|
|
|
ELSE OF is undefined;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF flag contains the value of the bit shifted into it.
|
|
|
|
|
The OF flag is affected only for single- bit rotates (see “Description” above);
|
|
|
|
|
it is undefined for multi-bit rotates. The SF, ZF, AF, and PF flags are not affected.
|
|
|
|
|
*/
|
|
|
|
|
const auto temp_count = count & (Numeric::bit_size<IntT>() - 1);
|
|
|
|
|
if(!count) {
|
|
|
|
|
// TODO: is this 8086-specific? i.e. do the other x86s also exit without affecting flags when temp_count = 0?
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
if(temp_count) {
|
|
|
|
|
destination =
|
|
|
|
|
(destination >> temp_count) |
|
|
|
|
|
(destination << (Numeric::bit_size<IntT>() - temp_count));
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(destination & Numeric::top_bit<IntT>());
|
|
|
|
|
context.flags.template set_from<Flag::Overflow>(
|
2023-10-14 02:03:54 +00:00
|
|
|
|
(destination ^ (destination << 1)) & Numeric::top_bit<IntT>()
|
|
|
|
|
);
|
|
|
|
|
}
|
2023-10-15 01:42:33 +00:00
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
tempCOUNT ← (COUNT AND 1FH);
|
|
|
|
|
tempDEST ← DEST;
|
|
|
|
|
WHILE (tempCOUNT ≠ 0)
|
|
|
|
|
DO
|
|
|
|
|
IF instruction is SAL or SHL
|
|
|
|
|
THEN
|
|
|
|
|
CF ← MSB(DEST);
|
|
|
|
|
ELSE (* instruction is SAR or SHR *)
|
|
|
|
|
CF ← LSB(DEST);
|
|
|
|
|
FI;
|
|
|
|
|
IF instruction is SAL or SHL
|
|
|
|
|
THEN
|
|
|
|
|
DEST ← DEST ∗ 2;
|
|
|
|
|
ELSE
|
|
|
|
|
IF instruction is SAR
|
|
|
|
|
THEN
|
|
|
|
|
DEST ← DEST / 2 (*Signed divide, rounding toward negative infinity*);
|
|
|
|
|
ELSE (* instruction is SHR *)
|
|
|
|
|
DEST ← DEST / 2 ; (* Unsigned divide *);
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
tempCOUNT ← tempCOUNT – 1;
|
|
|
|
|
OD;
|
|
|
|
|
(* Determine overflow for the various instructions *)
|
|
|
|
|
IF COUNT = 1
|
|
|
|
|
THEN
|
|
|
|
|
IF instruction is SAL or SHL
|
|
|
|
|
THEN
|
|
|
|
|
OF ← MSB(DEST) XOR CF;
|
|
|
|
|
ELSE
|
|
|
|
|
IF instruction is SAR
|
|
|
|
|
THEN
|
|
|
|
|
OF ← 0;
|
|
|
|
|
ELSE (* instruction is SHR *)
|
|
|
|
|
OF ← MSB(tempDEST);
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
ELSE
|
|
|
|
|
IF COUNT = 0
|
|
|
|
|
THEN
|
|
|
|
|
All flags remain unchanged;
|
|
|
|
|
ELSE (* COUNT neither 1 or 0 *)
|
|
|
|
|
OF ← undefined;
|
|
|
|
|
FI;
|
|
|
|
|
FI;
|
|
|
|
|
*/
|
|
|
|
|
/*
|
|
|
|
|
The CF flag contains the value of the last bit shifted out of the destination operand;
|
|
|
|
|
it is undefined for SHL and SHR instructions where the count is greater than or equal to
|
|
|
|
|
the size (in bits) of the destination operand. The OF flag is affected only for 1-bit shifts
|
|
|
|
|
(see “Description” above); otherwise, it is undefined.
|
|
|
|
|
|
|
|
|
|
The SF, ZF, and PF flags are set according to the result. If the count is 0, the flags are not affected.
|
|
|
|
|
For a non-zero count, the AF flag is undefined.
|
|
|
|
|
*/
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void sal(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
uint8_t count,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-15 01:42:33 +00:00
|
|
|
|
switch(count) {
|
|
|
|
|
case 0: return;
|
|
|
|
|
case Numeric::bit_size<IntT>():
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::Overflow>(destination & 1);
|
2023-10-15 01:42:33 +00:00
|
|
|
|
destination = 0;
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
if(count > Numeric::bit_size<IntT>()) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry, Flag::Overflow>(0);
|
2023-10-15 01:42:33 +00:00
|
|
|
|
destination = 0;
|
|
|
|
|
} else {
|
|
|
|
|
const auto mask = (Numeric::top_bit<IntT>() >> (count - 1));
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(
|
2023-10-15 01:42:33 +00:00
|
|
|
|
destination & mask
|
|
|
|
|
);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow>(
|
2023-10-15 01:42:33 +00:00
|
|
|
|
(destination ^ (destination << 1)) & mask
|
|
|
|
|
);
|
|
|
|
|
destination <<= count;
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
}
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<IntT, Flag::Sign, Flag::Zero, Flag::ParityOdd>(destination);
|
2023-10-15 01:42:33 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void sar(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
uint8_t count,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-15 01:42:33 +00:00
|
|
|
|
if(!count) {
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
const IntT sign = Numeric::top_bit<IntT>() & destination;
|
|
|
|
|
if(count >= Numeric::bit_size<IntT>()) {
|
|
|
|
|
destination = sign ? IntT(~0) : IntT(0);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(sign);
|
2023-10-15 01:42:33 +00:00
|
|
|
|
} else {
|
|
|
|
|
const IntT mask = 1 << (count - 1);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(destination & mask);
|
2023-10-15 01:42:33 +00:00
|
|
|
|
destination = (destination >> count) | (sign ? ~(IntT(~0) >> count) : 0);
|
|
|
|
|
}
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow>(0);
|
|
|
|
|
context.flags.template set_from<IntT, Flag::Sign, Flag::Zero, Flag::ParityOdd>(destination);
|
2023-10-15 01:42:33 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void shr(
|
|
|
|
|
modify_t<IntT> destination,
|
|
|
|
|
uint8_t count,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-16 16:34:11 +00:00
|
|
|
|
if(!count) {
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Overflow>(Numeric::top_bit<IntT>() & destination);
|
2023-10-16 16:34:11 +00:00
|
|
|
|
if(count == Numeric::bit_size<IntT>()) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(Numeric::top_bit<IntT>() & destination);
|
2023-10-16 16:34:11 +00:00
|
|
|
|
destination = 0;
|
|
|
|
|
} else if(count > Numeric::bit_size<IntT>()) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(0);
|
2023-10-16 16:34:11 +00:00
|
|
|
|
destination = 0;
|
|
|
|
|
} else {
|
|
|
|
|
const IntT mask = 1 << (count - 1);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Carry>(destination & mask);
|
2023-10-16 16:34:11 +00:00
|
|
|
|
destination >>= count;
|
|
|
|
|
}
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<IntT, Flag::Sign, Flag::Zero, Flag::ParityOdd>(destination);
|
2023-10-16 16:34:11 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void popf(
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.set(pop<uint16_t, false>(context));
|
2023-10-18 19:59:39 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void pushf(
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-11-02 20:55:38 +00:00
|
|
|
|
uint16_t value = context.flags.get();
|
2023-11-01 21:03:23 +00:00
|
|
|
|
push<uint16_t, false>(value, context);
|
2023-10-18 19:59:39 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-27 03:08:07 +00:00
|
|
|
|
template <typename AddressT, Repetition repetition>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
bool repetition_over(
|
|
|
|
|
const AddressT &eCX
|
|
|
|
|
) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
return repetition != Repetition::None && !eCX;
|
2023-10-20 21:08:11 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename AddressT, Repetition repetition, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void repeat(
|
|
|
|
|
AddressT &eCX,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-21 01:36:50 +00:00
|
|
|
|
if(
|
2023-10-27 03:08:07 +00:00
|
|
|
|
repetition == Repetition::None || // No repetition => stop.
|
|
|
|
|
!(--eCX) // [e]cx is zero after being decremented => stop.
|
2023-10-21 01:36:50 +00:00
|
|
|
|
) {
|
|
|
|
|
return;
|
|
|
|
|
}
|
2023-10-27 20:27:24 +00:00
|
|
|
|
if constexpr (repetition != Repetition::Rep) {
|
|
|
|
|
// If this is RepE or RepNE, also test the zero flag.
|
2023-11-02 20:55:38 +00:00
|
|
|
|
if((repetition == Repetition::RepNE) == context.flags.template flag<Flag::Zero>()) {
|
2023-10-27 20:27:24 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
}
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.flow_controller.repeat_last();
|
2023-10-21 01:36:50 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename AddressT, Repetition repetition, typename InstructionT, typename ContextT>
|
2023-11-07 14:58:42 +00:00
|
|
|
|
void cmps(
|
|
|
|
|
const InstructionT &instruction,
|
|
|
|
|
AddressT &eCX,
|
|
|
|
|
AddressT &eSI,
|
|
|
|
|
AddressT &eDI,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
if(repetition_over<AddressT, repetition>(eCX)) {
|
2023-10-19 18:07:59 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
IntT lhs = context.memory.template access<IntT, AccessType::Read>(instruction.data_segment(), eSI);
|
|
|
|
|
const IntT rhs = context.memory.template access<IntT, AccessType::Read>(Source::ES, eDI);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
eSI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
|
|
|
|
eDI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
2023-10-20 20:52:47 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
Primitive::sub<false, AccessType::Read, IntT>(lhs, rhs, context);
|
2023-10-19 18:07:59 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
repeat<AddressT, repetition>(eCX, context);
|
2023-10-19 18:07:59 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename AddressT, Repetition repetition, typename ContextT>
|
|
|
|
|
void scas(AddressT &eCX, AddressT &eDI, IntT &eAX, ContextT &context) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
if(repetition_over<AddressT, repetition>(eCX)) {
|
2023-10-21 01:54:30 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
const IntT rhs = context.memory.template access<IntT, AccessType::Read>(Source::ES, eDI);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
eDI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
2023-10-21 01:54:30 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
Primitive::sub<false, AccessType::Read, IntT>(eAX, rhs, context);
|
2023-10-21 01:54:30 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
repeat<AddressT, repetition>(eCX, context);
|
2023-10-21 01:54:30 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename AddressT, Repetition repetition, typename InstructionT, typename ContextT>
|
|
|
|
|
void lods(const InstructionT &instruction, AddressT &eCX, AddressT &eSI, IntT &eAX, ContextT &context) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
if(repetition_over<AddressT, repetition>(eCX)) {
|
2023-10-20 21:13:56 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
eAX = context.memory.template access<IntT, AccessType::Read>(instruction.data_segment(), eSI);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
eSI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
2023-10-20 21:13:56 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
repeat<AddressT, repetition>(eCX, context);
|
2023-10-20 21:13:56 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename AddressT, Repetition repetition, typename InstructionT, typename ContextT>
|
|
|
|
|
void movs(const InstructionT &instruction, AddressT &eCX, AddressT &eSI, AddressT &eDI, ContextT &context) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
if(repetition_over<AddressT, repetition>(eCX)) {
|
2023-10-21 01:46:47 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.template access<IntT, AccessType::Write>(Source::ES, eDI) =
|
|
|
|
|
context.memory.template access<IntT, AccessType::Read>(instruction.data_segment(), eSI);
|
2023-10-21 01:46:47 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
eSI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
|
|
|
|
eDI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
2023-10-21 01:46:47 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
repeat<AddressT, repetition>(eCX, context);
|
2023-10-21 01:46:47 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename AddressT, Repetition repetition, typename ContextT>
|
|
|
|
|
void stos(AddressT &eCX, AddressT &eDI, IntT &eAX, ContextT &context) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
if(repetition_over<AddressT, repetition>(eCX)) {
|
2023-10-21 01:46:47 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.template access<IntT, AccessType::Write>(Source::ES, eDI) = eAX;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
eDI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
2023-10-21 01:46:47 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
repeat<AddressT, repetition>(eCX, context);
|
2023-10-21 01:46:47 +00:00
|
|
|
|
}
|
2023-10-20 21:13:56 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename AddressT, Repetition repetition, typename InstructionT, typename ContextT>
|
|
|
|
|
void outs(const InstructionT &instruction, AddressT &eCX, uint16_t port, AddressT &eSI, ContextT &context) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
if(repetition_over<AddressT, repetition>(eCX)) {
|
2023-10-22 02:52:50 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.io.template out<IntT>(
|
|
|
|
|
port,
|
|
|
|
|
context.memory.template access<IntT, AccessType::Read>(instruction.data_segment(), eSI)
|
|
|
|
|
);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
eSI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
2023-10-22 02:52:50 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
repeat<AddressT, repetition>(eCX, context);
|
2023-10-22 02:52:50 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename AddressT, Repetition repetition, typename ContextT>
|
|
|
|
|
void ins(AddressT &eCX, uint16_t port, AddressT &eDI, ContextT &context) {
|
2023-10-27 03:08:07 +00:00
|
|
|
|
if(repetition_over<AddressT, repetition>(eCX)) {
|
2023-10-22 02:52:50 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context.memory.template access<IntT, AccessType::Write>(Source::ES, eDI) = context.io.template in<IntT>(port);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
eDI += context.flags.template direction<AddressT>() * sizeof(IntT);
|
2023-10-22 02:52:50 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
repeat<AddressT, repetition>(eCX, context);
|
2023-10-22 02:52:50 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
|
|
|
|
void out(uint16_t port, IntT value, ContextT &context) {
|
|
|
|
|
context.io.template out<IntT>(port, value);
|
2023-10-22 02:37:25 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <typename IntT, typename ContextT>
|
|
|
|
|
void in(uint16_t port, IntT &value, ContextT &context) {
|
|
|
|
|
value = context.io.template in<IntT>(port);
|
2023-10-22 02:37:25 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-09 15:46:59 +00:00
|
|
|
|
}
|
2023-10-08 17:34:28 +00:00
|
|
|
|
|
2023-10-05 18:37:58 +00:00
|
|
|
|
template <
|
|
|
|
|
DataSize data_size,
|
2023-10-25 20:00:01 +00:00
|
|
|
|
AddressSize address_size,
|
2023-10-05 20:49:02 +00:00
|
|
|
|
typename InstructionT,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
typename ContextT
|
2023-10-05 18:37:58 +00:00
|
|
|
|
> void perform(
|
2023-10-05 20:49:02 +00:00
|
|
|
|
const InstructionT &instruction,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
ContextT &context
|
2023-10-05 18:37:58 +00:00
|
|
|
|
) {
|
2023-10-05 20:49:02 +00:00
|
|
|
|
using IntT = typename DataSizeType<data_size>::type;
|
2023-10-25 20:00:01 +00:00
|
|
|
|
using AddressT = typename AddressSizeType<address_size>::type;
|
2023-10-05 20:49:02 +00:00
|
|
|
|
|
2023-10-31 19:06:19 +00:00
|
|
|
|
// Establish source() and destination() shorthands to fetch data if necessary.
|
|
|
|
|
//
|
|
|
|
|
// C++17, which this project targets at the time of writing, does not provide templatised lambdas.
|
|
|
|
|
// So the following division is in part a necessity.
|
|
|
|
|
//
|
|
|
|
|
// (though GCC offers C++20 syntax as an extension, and Clang seems to follow along, so maybe I'm overthinking)
|
2023-10-09 01:41:36 +00:00
|
|
|
|
IntT immediate;
|
2023-11-06 21:04:31 +00:00
|
|
|
|
const auto source_r = [&]() -> IntT {
|
|
|
|
|
return resolve<IntT, AccessType::Read>(
|
2023-10-09 01:41:36 +00:00
|
|
|
|
instruction,
|
2023-10-25 18:43:58 +00:00
|
|
|
|
instruction.source().source(),
|
2023-10-09 01:41:36 +00:00
|
|
|
|
instruction.source(),
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context,
|
2023-10-09 01:41:36 +00:00
|
|
|
|
nullptr,
|
|
|
|
|
&immediate);
|
|
|
|
|
};
|
2023-10-31 19:06:19 +00:00
|
|
|
|
const auto source_rmw = [&]() -> IntT& {
|
2023-11-06 21:04:31 +00:00
|
|
|
|
return resolve<IntT, AccessType::ReadModifyWrite>(
|
2023-10-31 19:06:19 +00:00
|
|
|
|
instruction,
|
|
|
|
|
instruction.source().source(),
|
|
|
|
|
instruction.source(),
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context,
|
2023-10-31 19:06:19 +00:00
|
|
|
|
nullptr,
|
|
|
|
|
&immediate);
|
|
|
|
|
};
|
2023-11-06 21:04:31 +00:00
|
|
|
|
const auto destination_r = [&]() -> IntT {
|
|
|
|
|
return resolve<IntT, AccessType::Read>(
|
2023-10-29 20:19:10 +00:00
|
|
|
|
instruction,
|
|
|
|
|
instruction.destination().source(),
|
|
|
|
|
instruction.destination(),
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context,
|
2023-10-29 20:19:10 +00:00
|
|
|
|
nullptr,
|
|
|
|
|
&immediate);
|
|
|
|
|
};
|
|
|
|
|
const auto destination_w = [&]() -> IntT& {
|
2023-11-06 21:04:31 +00:00
|
|
|
|
return resolve<IntT, AccessType::Write>(
|
2023-10-29 20:19:10 +00:00
|
|
|
|
instruction,
|
|
|
|
|
instruction.destination().source(),
|
|
|
|
|
instruction.destination(),
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context,
|
2023-10-29 20:19:10 +00:00
|
|
|
|
nullptr,
|
|
|
|
|
&immediate);
|
|
|
|
|
};
|
|
|
|
|
const auto destination_rmw = [&]() -> IntT& {
|
2023-11-06 21:04:31 +00:00
|
|
|
|
return resolve<IntT, AccessType::ReadModifyWrite>(
|
2023-10-09 01:41:36 +00:00
|
|
|
|
instruction,
|
2023-10-25 18:43:58 +00:00
|
|
|
|
instruction.destination().source(),
|
2023-10-09 01:41:36 +00:00
|
|
|
|
instruction.destination(),
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context,
|
2023-10-09 01:41:36 +00:00
|
|
|
|
nullptr,
|
|
|
|
|
&immediate);
|
|
|
|
|
};
|
2023-10-05 20:49:02 +00:00
|
|
|
|
|
2023-10-11 19:08:04 +00:00
|
|
|
|
// Performs a displacement jump only if @c condition is true.
|
2023-10-11 18:36:42 +00:00
|
|
|
|
const auto jcc = [&](bool condition) {
|
|
|
|
|
Primitive::jump(
|
|
|
|
|
condition,
|
|
|
|
|
instruction.displacement(),
|
2023-11-01 21:03:23 +00:00
|
|
|
|
context);
|
2023-10-11 18:36:42 +00:00
|
|
|
|
};
|
|
|
|
|
|
2023-10-13 18:44:22 +00:00
|
|
|
|
const auto shift_count = [&]() -> uint8_t {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
static constexpr uint8_t mask = (ContextT::model != Model::i8086) ? 0x1f : 0xff;
|
2023-10-25 18:43:58 +00:00
|
|
|
|
switch(instruction.source().source()) {
|
2023-10-13 18:44:22 +00:00
|
|
|
|
case Source::None: return 1;
|
2023-10-13 19:34:06 +00:00
|
|
|
|
case Source::Immediate: return uint8_t(instruction.operand()) & mask;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
default: return context.registers.cl() & mask;
|
2023-10-13 18:44:22 +00:00
|
|
|
|
}
|
|
|
|
|
};
|
|
|
|
|
|
2023-10-11 19:08:04 +00:00
|
|
|
|
// Some instructions use a pair of registers as an extended accumulator — DX:AX or EDX:EAX.
|
|
|
|
|
// The two following return the high and low parts of that pair; they also work in Byte mode to return AH:AL,
|
|
|
|
|
// i.e. AX split into high and low parts.
|
|
|
|
|
const auto pair_high = [&]() -> IntT& {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (data_size == DataSize::Byte) return context.registers.ah();
|
|
|
|
|
else if constexpr (data_size == DataSize::Word) return context.registers.dx();
|
|
|
|
|
else if constexpr (data_size == DataSize::DWord) return context.registers.edx();
|
2023-10-11 18:36:42 +00:00
|
|
|
|
};
|
2023-10-11 19:08:04 +00:00
|
|
|
|
const auto pair_low = [&]() -> IntT& {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (data_size == DataSize::Byte) return context.registers.al();
|
|
|
|
|
else if constexpr (data_size == DataSize::Word) return context.registers.ax();
|
|
|
|
|
else if constexpr (data_size == DataSize::DWord) return context.registers.eax();
|
2023-10-11 18:36:42 +00:00
|
|
|
|
};
|
|
|
|
|
|
2023-10-20 21:00:32 +00:00
|
|
|
|
// For the string operations, evaluate to either SI and DI or ESI and EDI, depending on the address size.
|
2023-10-20 20:52:47 +00:00
|
|
|
|
const auto eSI = [&]() -> AddressT& {
|
|
|
|
|
if constexpr (std::is_same_v<AddressT, uint16_t>) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
return context.registers.si();
|
2023-10-20 20:52:47 +00:00
|
|
|
|
} else {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
return context.registers.esi();
|
2023-10-20 20:52:47 +00:00
|
|
|
|
}
|
|
|
|
|
};
|
|
|
|
|
const auto eDI = [&]() -> AddressT& {
|
|
|
|
|
if constexpr (std::is_same_v<AddressT, uint16_t>) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
return context.registers.di();
|
2023-10-20 20:52:47 +00:00
|
|
|
|
} else {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
return context.registers.edi();
|
2023-10-20 20:52:47 +00:00
|
|
|
|
}
|
|
|
|
|
};
|
|
|
|
|
|
2023-10-20 21:00:32 +00:00
|
|
|
|
// For counts, provide either eCX or CX depending on address size.
|
|
|
|
|
const auto eCX = [&]() -> AddressT& {
|
|
|
|
|
if constexpr (std::is_same_v<AddressT, uint16_t>) {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
return context.registers.cx();
|
2023-10-20 21:00:32 +00:00
|
|
|
|
} else {
|
2023-11-01 21:03:23 +00:00
|
|
|
|
return context.registers.ecx();
|
2023-10-20 21:00:32 +00:00
|
|
|
|
}
|
|
|
|
|
};
|
|
|
|
|
|
2023-10-22 02:52:50 +00:00
|
|
|
|
// Gets the port for an IN or OUT; these are always 16-bit.
|
|
|
|
|
const auto port = [&](Source source) -> uint16_t {
|
|
|
|
|
switch(source) {
|
2023-10-27 18:04:23 +00:00
|
|
|
|
case Source::DirectAddress: return instruction.offset();
|
2023-11-01 21:03:23 +00:00
|
|
|
|
default: return context.registers.dx();
|
2023-10-22 02:52:50 +00:00
|
|
|
|
}
|
|
|
|
|
};
|
|
|
|
|
|
2023-10-05 20:49:02 +00:00
|
|
|
|
// Guide to the below:
|
|
|
|
|
//
|
|
|
|
|
// * use hard-coded register names where appropriate;
|
|
|
|
|
// * return directly if there is definitely no possible write back to RAM;
|
|
|
|
|
// * otherwise use the source() and destination() lambdas, and break in order to allow a writeback if necessary.
|
2023-10-27 03:19:31 +00:00
|
|
|
|
switch(instruction.operation()) {
|
2023-10-09 15:46:59 +00:00
|
|
|
|
default:
|
|
|
|
|
assert(false);
|
2023-10-06 02:27:52 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Operation::AAA: Primitive::aaa(context.registers.axp(), context); return;
|
|
|
|
|
case Operation::AAD: Primitive::aad(context.registers.axp(), instruction.operand(), context); return;
|
|
|
|
|
case Operation::AAM: Primitive::aam(context.registers.axp(), instruction.operand(), context); return;
|
|
|
|
|
case Operation::AAS: Primitive::aas(context.registers.axp(), context); return;
|
|
|
|
|
case Operation::DAA: Primitive::daa(context.registers.al(), context); return;
|
|
|
|
|
case Operation::DAS: Primitive::das(context.registers.al(), context); return;
|
2023-10-05 20:49:02 +00:00
|
|
|
|
|
2023-10-11 19:08:04 +00:00
|
|
|
|
case Operation::CBW: Primitive::cbw(pair_low()); return;
|
|
|
|
|
case Operation::CWD: Primitive::cwd(pair_high(), pair_low()); return;
|
2023-10-09 18:54:14 +00:00
|
|
|
|
|
2023-10-09 19:03:01 +00:00
|
|
|
|
case Operation::ESC:
|
|
|
|
|
case Operation::NOP: return;
|
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Operation::HLT: context.flow_controller.halt(); return;
|
|
|
|
|
case Operation::WAIT: context.flow_controller.wait(); return;
|
2023-10-09 20:21:04 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::ADC: Primitive::add<true, IntT>(destination_rmw(), source_r(), context); break;
|
|
|
|
|
case Operation::ADD: Primitive::add<false, IntT>(destination_rmw(), source_r(), context); break;
|
|
|
|
|
case Operation::SBB:
|
|
|
|
|
Primitive::sub<true, AccessType::ReadModifyWrite, IntT>(destination_rmw(), source_r(), context);
|
|
|
|
|
break;
|
|
|
|
|
case Operation::SUB:
|
|
|
|
|
Primitive::sub<false, AccessType::ReadModifyWrite, IntT>(destination_rmw(), source_r(), context);
|
|
|
|
|
break;
|
|
|
|
|
case Operation::CMP:
|
|
|
|
|
Primitive::sub<false, AccessType::Read, IntT>(destination_r(), source_r(), context);
|
|
|
|
|
return;
|
|
|
|
|
case Operation::TEST: Primitive::test<IntT>(destination_r(), source_r(), context); return;
|
2023-10-11 02:15:33 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::MUL: Primitive::mul<IntT>(pair_high(), pair_low(), source_r(), context); return;
|
|
|
|
|
case Operation::IMUL_1: Primitive::imul<IntT>(pair_high(), pair_low(), source_r(), context); return;
|
|
|
|
|
case Operation::DIV: Primitive::div<IntT>(pair_high(), pair_low(), source_r(), context); return;
|
|
|
|
|
case Operation::IDIV: Primitive::idiv<IntT>(pair_high(), pair_low(), source_r(), context); return;
|
2023-10-09 20:21:04 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::INC: Primitive::inc<IntT>(destination_rmw(), context); break;
|
|
|
|
|
case Operation::DEC: Primitive::dec<IntT>(destination_rmw(), context); break;
|
2023-10-10 19:57:33 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::AND: Primitive::and_<IntT>(destination_rmw(), source_r(), context); break;
|
|
|
|
|
case Operation::OR: Primitive::or_<IntT>(destination_rmw(), source_r(), context); break;
|
|
|
|
|
case Operation::XOR: Primitive::xor_<IntT>(destination_rmw(), source_r(), context); break;
|
|
|
|
|
case Operation::NEG: Primitive::neg<IntT>(source_rmw(), context); break; // TODO: should be a destination.
|
|
|
|
|
case Operation::NOT: Primitive::not_<IntT>(source_rmw()); break; // TODO: should be a destination.
|
2023-10-09 15:46:59 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::CALLrel: Primitive::call_relative<AddressT>(instruction.displacement(), context); return;
|
|
|
|
|
case Operation::CALLabs: Primitive::call_absolute<IntT>(destination_r(), context); return;
|
|
|
|
|
case Operation::CALLfar: Primitive::call_far(instruction, context); return;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::JMPrel: jcc(true); return;
|
|
|
|
|
case Operation::JMPabs: Primitive::jump_absolute<IntT>(destination_r(), context); return;
|
|
|
|
|
case Operation::JMPfar: Primitive::jump_far(instruction, context); return;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::JCXZ: jcc(!eCX()); return;
|
|
|
|
|
case Operation::LOOP: Primitive::loop<AddressT>(eCX(), instruction.offset(), context); return;
|
|
|
|
|
case Operation::LOOPE: Primitive::loope<AddressT>(eCX(), instruction.offset(), context); return;
|
|
|
|
|
case Operation::LOOPNE: Primitive::loopne<AddressT>(eCX(), instruction.offset(), context); return;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
|
|
|
|
case Operation::IRET: Primitive::iret(context); return;
|
|
|
|
|
case Operation::RETnear: Primitive::ret_near(instruction, context); return;
|
|
|
|
|
case Operation::RETfar: Primitive::ret_far(instruction, context); return;
|
|
|
|
|
|
|
|
|
|
case Operation::INT: interrupt(instruction.operand(), context); return;
|
|
|
|
|
case Operation::INTO: Primitive::into(context); return;
|
|
|
|
|
|
|
|
|
|
case Operation::SAHF: Primitive::sahf(context.registers.ah(), context); return;
|
|
|
|
|
case Operation::LAHF: Primitive::lahf(context.registers.ah(), context); return;
|
|
|
|
|
|
|
|
|
|
case Operation::LDS: if constexpr (data_size == DataSize::Word) Primitive::ld<Source::DS>(instruction, destination_w(), context); return;
|
|
|
|
|
case Operation::LES: if constexpr (data_size == DataSize::Word) Primitive::ld<Source::ES>(instruction, destination_w(), context); return;
|
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::LEA: Primitive::lea<IntT>(instruction, destination_w(), context); return;
|
|
|
|
|
case Operation::MOV: Primitive::mov<IntT>(destination_w(), source_r()); break;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
case Operation::JO: jcc(context.flags.template condition<Condition::Overflow>()); return;
|
|
|
|
|
case Operation::JNO: jcc(!context.flags.template condition<Condition::Overflow>()); return;
|
|
|
|
|
case Operation::JB: jcc(context.flags.template condition<Condition::Below>()); return;
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::JNB: jcc(!context.flags.template condition<Condition::Below>()); return;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
case Operation::JZ: jcc(context.flags.template condition<Condition::Zero>()); return;
|
|
|
|
|
case Operation::JNZ: jcc(!context.flags.template condition<Condition::Zero>()); return;
|
|
|
|
|
case Operation::JBE: jcc(context.flags.template condition<Condition::BelowOrEqual>()); return;
|
|
|
|
|
case Operation::JNBE: jcc(!context.flags.template condition<Condition::BelowOrEqual>()); return;
|
|
|
|
|
case Operation::JS: jcc(context.flags.template condition<Condition::Sign>()); return;
|
|
|
|
|
case Operation::JNS: jcc(!context.flags.template condition<Condition::Sign>()); return;
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::JP: jcc(!context.flags.template condition<Condition::ParityOdd>()); return;
|
2023-11-02 20:55:38 +00:00
|
|
|
|
case Operation::JNP: jcc(context.flags.template condition<Condition::ParityOdd>()); return;
|
|
|
|
|
case Operation::JL: jcc(context.flags.template condition<Condition::Less>()); return;
|
|
|
|
|
case Operation::JNL: jcc(!context.flags.template condition<Condition::Less>()); return;
|
|
|
|
|
case Operation::JLE: jcc(context.flags.template condition<Condition::LessOrEqual>()); return;
|
|
|
|
|
case Operation::JNLE: jcc(!context.flags.template condition<Condition::LessOrEqual>()); return;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::RCL: Primitive::rcl<IntT>(destination_rmw(), shift_count(), context); break;
|
|
|
|
|
case Operation::RCR: Primitive::rcr<IntT>(destination_rmw(), shift_count(), context); break;
|
|
|
|
|
case Operation::ROL: Primitive::rol<IntT>(destination_rmw(), shift_count(), context); break;
|
|
|
|
|
case Operation::ROR: Primitive::ror<IntT>(destination_rmw(), shift_count(), context); break;
|
|
|
|
|
case Operation::SAL: Primitive::sal<IntT>(destination_rmw(), shift_count(), context); break;
|
|
|
|
|
case Operation::SAR: Primitive::sar<IntT>(destination_rmw(), shift_count(), context); break;
|
|
|
|
|
case Operation::SHR: Primitive::shr<IntT>(destination_rmw(), shift_count(), context); break;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
|
|
|
|
case Operation::CLC: Primitive::clc(context); return;
|
|
|
|
|
case Operation::CLD: Primitive::cld(context); return;
|
|
|
|
|
case Operation::CLI: Primitive::cli(context); return;
|
|
|
|
|
case Operation::STC: Primitive::stc(context); return;
|
|
|
|
|
case Operation::STD: Primitive::std(context); return;
|
|
|
|
|
case Operation::STI: Primitive::sti(context); return;
|
|
|
|
|
case Operation::CMC: Primitive::cmc(context); return;
|
2023-10-11 02:34:42 +00:00
|
|
|
|
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::XCHG: Primitive::xchg<IntT>(destination_rmw(), source_rmw()); break;
|
2023-10-12 19:52:05 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Operation::SALC: Primitive::salc(context.registers.al(), context); return;
|
2023-10-12 19:52:05 +00:00
|
|
|
|
case Operation::SETMO:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (ContextT::model == Model::i8086) {
|
2023-11-07 14:58:42 +00:00
|
|
|
|
Primitive::setmo<IntT>(destination_w(), context);
|
2023-10-29 20:19:10 +00:00
|
|
|
|
break;
|
2023-10-12 19:52:05 +00:00
|
|
|
|
} else {
|
|
|
|
|
// TODO.
|
|
|
|
|
}
|
|
|
|
|
return;
|
|
|
|
|
case Operation::SETMOC:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (ContextT::model == Model::i8086) {
|
2023-11-01 02:04:26 +00:00
|
|
|
|
// Test CL out here to avoid taking a reference to memory if
|
|
|
|
|
// no write is going to occur.
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if(context.registers.cl()) {
|
2023-11-07 14:58:42 +00:00
|
|
|
|
Primitive::setmo<IntT>(destination_w(), context);
|
2023-11-01 02:04:26 +00:00
|
|
|
|
}
|
2023-10-29 20:19:10 +00:00
|
|
|
|
break;
|
2023-10-12 19:52:05 +00:00
|
|
|
|
} else {
|
|
|
|
|
// TODO.
|
|
|
|
|
}
|
|
|
|
|
return;
|
2023-10-13 01:12:03 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Operation::OUT: Primitive::out(port(instruction.destination().source()), pair_low(), context); return;
|
|
|
|
|
case Operation::IN: Primitive::in(port(instruction.source().source()), pair_low(), context); return;
|
2023-10-22 02:37:25 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Operation::XLAT: Primitive::xlat<AddressT>(instruction, context); return;
|
2023-10-18 19:59:39 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Operation::POP: destination_w() = Primitive::pop<IntT, false>(context); break;
|
2023-11-07 14:58:42 +00:00
|
|
|
|
case Operation::PUSH:
|
|
|
|
|
Primitive::push<IntT, false>(source_rmw(), context); // PUSH SP modifies SP before pushing it;
|
|
|
|
|
// hence PUSH is sometimes read-modify-write.
|
|
|
|
|
break;
|
2023-11-01 21:03:23 +00:00
|
|
|
|
case Operation::POPF: Primitive::popf(context); break;
|
|
|
|
|
case Operation::PUSHF: Primitive::pushf(context); break;
|
2023-10-19 18:07:59 +00:00
|
|
|
|
|
|
|
|
|
case Operation::CMPS:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::cmps<IntT, AddressT, Repetition::None>(instruction, eCX(), eSI(), eDI(), context);
|
2023-10-19 18:07:59 +00:00
|
|
|
|
break;
|
2023-10-27 03:08:07 +00:00
|
|
|
|
case Operation::CMPS_REPE:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::cmps<IntT, AddressT, Repetition::RepE>(instruction, eCX(), eSI(), eDI(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
case Operation::CMPS_REPNE:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::cmps<IntT, AddressT, Repetition::RepNE>(instruction, eCX(), eSI(), eDI(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case Operation::SCAS:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::scas<IntT, AddressT, Repetition::None>(eCX(), eDI(), pair_low(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
case Operation::SCAS_REPE:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::scas<IntT, AddressT, Repetition::RepE>(eCX(), eDI(), pair_low(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
case Operation::SCAS_REPNE:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::scas<IntT, AddressT, Repetition::RepNE>(eCX(), eDI(), pair_low(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
|
2023-10-20 21:13:56 +00:00
|
|
|
|
case Operation::LODS:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::lods<IntT, AddressT, Repetition::None>(instruction, eCX(), eSI(), pair_low(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
case Operation::LODS_REP:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::lods<IntT, AddressT, Repetition::Rep>(instruction, eCX(), eSI(), pair_low(), context);
|
2023-10-20 21:13:56 +00:00
|
|
|
|
break;
|
2023-10-27 03:08:07 +00:00
|
|
|
|
|
2023-10-21 01:46:47 +00:00
|
|
|
|
case Operation::MOVS:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::movs<IntT, AddressT, Repetition::None>(instruction, eCX(), eSI(), eDI(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
case Operation::MOVS_REP:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::movs<IntT, AddressT, Repetition::Rep>(instruction, eCX(), eSI(), eDI(), context);
|
2023-10-21 01:46:47 +00:00
|
|
|
|
break;
|
2023-10-27 03:08:07 +00:00
|
|
|
|
|
2023-10-21 01:46:47 +00:00
|
|
|
|
case Operation::STOS:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::stos<IntT, AddressT, Repetition::None>(eCX(), eDI(), pair_low(), context);
|
2023-10-21 01:46:47 +00:00
|
|
|
|
break;
|
2023-10-27 03:08:07 +00:00
|
|
|
|
case Operation::STOS_REP:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::stos<IntT, AddressT, Repetition::Rep>(eCX(), eDI(), pair_low(), context);
|
2023-10-21 01:54:30 +00:00
|
|
|
|
break;
|
2023-10-27 03:08:07 +00:00
|
|
|
|
|
2023-10-22 02:52:50 +00:00
|
|
|
|
case Operation::OUTS:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::outs<IntT, AddressT, Repetition::None>(instruction, eCX(), context.registers.dx(), eSI(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
case Operation::OUTS_REP:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::outs<IntT, AddressT, Repetition::Rep>(instruction, eCX(), context.registers.dx(), eSI(), context);
|
2023-10-22 02:52:50 +00:00
|
|
|
|
break;
|
2023-10-27 03:08:07 +00:00
|
|
|
|
|
2023-10-22 02:52:50 +00:00
|
|
|
|
case Operation::INS:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::ins<IntT, AddressT, Repetition::None>(eCX(), context.registers.dx(), eDI(), context);
|
2023-10-27 03:08:07 +00:00
|
|
|
|
break;
|
|
|
|
|
case Operation::INS_REP:
|
2023-11-01 21:03:23 +00:00
|
|
|
|
Primitive::ins<IntT, AddressT, Repetition::Rep>(eCX(), context.registers.dx(), eDI(), context);
|
2023-10-22 02:52:50 +00:00
|
|
|
|
break;
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-05 20:49:02 +00:00
|
|
|
|
// Write to memory if required to complete this operation.
|
2023-11-01 21:03:23 +00:00
|
|
|
|
//
|
|
|
|
|
// TODO: can I eliminate this with some RAII magic?
|
|
|
|
|
context.memory.template write_back<IntT>();
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
|
|
|
|
|
2023-10-05 20:49:02 +00:00
|
|
|
|
template <
|
2023-10-05 18:37:58 +00:00
|
|
|
|
typename InstructionT,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
typename ContextT
|
2023-10-05 18:37:58 +00:00
|
|
|
|
> void perform(
|
|
|
|
|
const InstructionT &instruction,
|
2023-11-01 21:03:23 +00:00
|
|
|
|
ContextT &context
|
2023-10-05 18:37:58 +00:00
|
|
|
|
) {
|
2023-10-25 20:00:01 +00:00
|
|
|
|
auto size = [](DataSize operation_size, AddressSize address_size) constexpr -> int {
|
|
|
|
|
return int(operation_size) + (int(address_size) << 2);
|
|
|
|
|
};
|
|
|
|
|
|
2023-10-25 20:15:08 +00:00
|
|
|
|
// Dispatch to a function specialised on data and address size.
|
2023-10-25 20:00:01 +00:00
|
|
|
|
switch(size(instruction.operation_size(), instruction.address_size())) {
|
|
|
|
|
// 16-bit combinations.
|
|
|
|
|
case size(DataSize::Byte, AddressSize::b16):
|
2023-11-01 21:03:23 +00:00
|
|
|
|
perform<DataSize::Byte, AddressSize::b16>(instruction, context);
|
2023-10-25 20:00:01 +00:00
|
|
|
|
return;
|
|
|
|
|
case size(DataSize::Word, AddressSize::b16):
|
2023-11-01 21:03:23 +00:00
|
|
|
|
perform<DataSize::Word, AddressSize::b16>(instruction, context);
|
2023-10-25 20:00:01 +00:00
|
|
|
|
return;
|
|
|
|
|
|
|
|
|
|
// 32-bit combinations.
|
2023-10-25 20:15:08 +00:00
|
|
|
|
//
|
|
|
|
|
// The if constexprs below ensure that `perform` isn't compiled for incompatible data or address size and
|
|
|
|
|
// model combinations. So if a caller nominates a 16-bit model it can supply registers and memory objects
|
|
|
|
|
// that don't implement 32-bit registers or accesses.
|
2023-10-25 20:00:01 +00:00
|
|
|
|
case size(DataSize::Byte, AddressSize::b32):
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (is_32bit(ContextT::model)) {
|
|
|
|
|
perform<DataSize::Byte, AddressSize::b32>(instruction, context);
|
2023-10-25 20:00:01 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
2023-10-05 20:49:02 +00:00
|
|
|
|
break;
|
2023-10-25 20:00:01 +00:00
|
|
|
|
case size(DataSize::Word, AddressSize::b32):
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (is_32bit(ContextT::model)) {
|
|
|
|
|
perform<DataSize::Word, AddressSize::b32>(instruction, context);
|
2023-10-25 20:00:01 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
2023-10-05 20:49:02 +00:00
|
|
|
|
break;
|
2023-10-25 20:00:01 +00:00
|
|
|
|
case size(DataSize::DWord, AddressSize::b16):
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (is_32bit(ContextT::model)) {
|
|
|
|
|
perform<DataSize::DWord, AddressSize::b16>(instruction, context);
|
2023-10-25 20:00:01 +00:00
|
|
|
|
return;
|
2023-10-10 01:50:17 +00:00
|
|
|
|
}
|
2023-10-05 20:49:02 +00:00
|
|
|
|
break;
|
2023-10-25 20:00:01 +00:00
|
|
|
|
case size(DataSize::DWord, AddressSize::b32):
|
2023-11-01 21:03:23 +00:00
|
|
|
|
if constexpr (is_32bit(ContextT::model)) {
|
|
|
|
|
perform<DataSize::DWord, AddressSize::b32>(instruction, context);
|
2023-10-25 20:00:01 +00:00
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default: break;
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
2023-10-25 20:00:01 +00:00
|
|
|
|
|
2023-10-25 20:15:08 +00:00
|
|
|
|
// This is reachable only if the data and address size combination in use isn't available
|
|
|
|
|
// on the processor model nominated.
|
2023-10-25 20:00:01 +00:00
|
|
|
|
assert(false);
|
2023-10-05 20:49:02 +00:00
|
|
|
|
}
|
2023-10-05 18:37:58 +00:00
|
|
|
|
|
2023-11-01 21:03:23 +00:00
|
|
|
|
template <
|
|
|
|
|
typename ContextT
|
|
|
|
|
> void interrupt(
|
|
|
|
|
int index,
|
|
|
|
|
ContextT &context
|
|
|
|
|
) {
|
|
|
|
|
const uint32_t address = static_cast<uint32_t>(index) << 2;
|
|
|
|
|
context.memory.preauthorise_read(address, sizeof(uint16_t) * 2);
|
|
|
|
|
context.memory.preauthorise_stack_write(sizeof(uint16_t) * 3);
|
|
|
|
|
|
2023-11-02 19:37:59 +00:00
|
|
|
|
const uint16_t ip = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(address);
|
|
|
|
|
const uint16_t cs = context.memory.template access<uint16_t, AccessType::PreauthorisedRead>(address + 2);
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
2023-11-02 20:55:38 +00:00
|
|
|
|
auto flags = context.flags.get();
|
2023-11-02 03:39:52 +00:00
|
|
|
|
Primitive::push<uint16_t, true>(flags, context);
|
2023-11-02 20:55:38 +00:00
|
|
|
|
context.flags.template set_from<Flag::Interrupt, Flag::Trap>(0);
|
2023-11-01 21:03:23 +00:00
|
|
|
|
|
|
|
|
|
// Push CS and IP.
|
|
|
|
|
Primitive::push<uint16_t, true>(context.registers.cs(), context);
|
|
|
|
|
Primitive::push<uint16_t, true>(context.registers.ip(), context);
|
|
|
|
|
|
|
|
|
|
// Set new destination.
|
|
|
|
|
context.flow_controller.jump(cs, ip);
|
|
|
|
|
}
|
|
|
|
|
|
2023-10-05 18:37:58 +00:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#endif /* PerformImplementation_h */
|