mirror of
https://github.com/TomHarte/CLK.git
synced 2024-08-17 07:29:04 +00:00
2226 lines
66 KiB
C++
2226 lines
66 KiB
C++
//
|
|
// 68000Mk2Implementation.hpp
|
|
// Clock Signal
|
|
//
|
|
// Created by Thomas Harte on 16/05/2022.
|
|
// Copyright © 2022 Thomas Harte. All rights reserved.
|
|
//
|
|
|
|
#ifndef _8000Mk2Implementation_h
|
|
#define _8000Mk2Implementation_h
|
|
|
|
#include <cassert>
|
|
#include <cstdio>
|
|
|
|
#include "../../../InstructionSets/M68k/ExceptionVectors.hpp"
|
|
|
|
namespace CPU {
|
|
namespace MC68000Mk2 {
|
|
|
|
/// States for the state machine which are named by
|
|
/// me for their purpose rather than automatically by file position.
|
|
/// These are negative to avoid ambiguity with the other group.
|
|
enum ExecutionState: int {
|
|
Reset = std::numeric_limits<int>::min(),
|
|
Decode,
|
|
WaitForDTACK,
|
|
|
|
/// Perform the proper sequence to fetch a byte or word operand.
|
|
FetchOperand_bw,
|
|
/// Perform the proper sequence to fetch a long-word operand.
|
|
FetchOperand_l,
|
|
|
|
StoreOperand,
|
|
StoreOperand_bw,
|
|
StoreOperand_l,
|
|
|
|
StandardException,
|
|
BusOrAddressErrorException,
|
|
|
|
// Specific addressing mode fetches.
|
|
//
|
|
// Additional context here is that I'm very much on the fence but
|
|
// for now am telling myself:
|
|
//
|
|
// (1) the overwhelming majority of instructions that need an
|
|
// effective address calculation use it for an operand read
|
|
// immediately afterwards, so keeping those things bound
|
|
// avoids a large number of conditional branches; and
|
|
// (2) making a decision between byte/word and long-word once at
|
|
// the outset also saves a conditional for any two-operand
|
|
// instructions (which is also the majority); but
|
|
// (3) some instructions do just need the address calculation —
|
|
// LEA and PEA are obvious examples, but are not the
|
|
// exhaustive list — so a third route just to do the
|
|
// calculation is necessary.
|
|
//
|
|
// My internal dialogue then argues that each of these is actually
|
|
// a small amount of code, so the need manually to duplicate (per
|
|
// the control-flow constraints of using a switch as a coroutine)
|
|
// isn't too ugly. Possibly even less ugly than pulling things out
|
|
// with a macro, especially for debugging.
|
|
//
|
|
// Further consideration may be necessary. Especially once this is
|
|
// up on its feet and profiling becomes an option.
|
|
|
|
FetchAddressRegisterIndirect_bw,
|
|
FetchAddressRegisterIndirectWithPostincrement_bw,
|
|
FetchAddressRegisterIndirectWithPredecrement_bw,
|
|
FetchAddressRegisterIndirectWithDisplacement_bw,
|
|
FetchAddressRegisterIndirectWithIndex8bitDisplacement_bw,
|
|
FetchProgramCounterIndirectWithDisplacement_bw,
|
|
FetchProgramCounterIndirectWithIndex8bitDisplacement_bw,
|
|
FetchAbsoluteShort_bw,
|
|
FetchAbsoluteLong_bw,
|
|
FetchImmediateData_bw,
|
|
|
|
FetchAddressRegisterIndirect_l,
|
|
FetchAddressRegisterIndirectWithPostincrement_l,
|
|
FetchAddressRegisterIndirectWithPredecrement_l,
|
|
FetchAddressRegisterIndirectWithDisplacement_l,
|
|
FetchAddressRegisterIndirectWithIndex8bitDisplacement_l,
|
|
FetchProgramCounterIndirectWithDisplacement_l,
|
|
FetchProgramCounterIndirectWithIndex8bitDisplacement_l,
|
|
FetchAbsoluteShort_l,
|
|
FetchAbsoluteLong_l,
|
|
FetchImmediateData_l,
|
|
|
|
CalcEffectiveAddress,
|
|
CalcAddressRegisterIndirect,
|
|
CalcAddressRegisterIndirectWithPostincrement,
|
|
CalcAddressRegisterIndirectWithPredecrement,
|
|
CalcAddressRegisterIndirectWithDisplacement,
|
|
CalcAddressRegisterIndirectWithIndex8bitDisplacement,
|
|
CalcProgramCounterIndirectWithDisplacement,
|
|
CalcProgramCounterIndirectWithIndex8bitDisplacement,
|
|
CalcAbsoluteShort,
|
|
CalcAbsoluteLong,
|
|
|
|
// Various forms of perform; each of these will
|
|
// perform the current instruction, then do the
|
|
// indicated bus cycle.
|
|
|
|
Perform_np,
|
|
Perform_np_n,
|
|
Perform_np_nn,
|
|
|
|
// MOVE has unique bus usage, so has specialised states.
|
|
|
|
MOVEw,
|
|
MOVEwRegisterDirect,
|
|
MOVEwAddressRegisterIndirectWithPostincrement,
|
|
|
|
TwoOp_Predec_bw,
|
|
TwoOp_Predec_l,
|
|
|
|
CHK,
|
|
CHK_no_trap,
|
|
CHK_was_over,
|
|
CHK_was_under,
|
|
|
|
Scc_Dn,
|
|
Scc_Dn_did_not_set,
|
|
Scc_Dn_did_set,
|
|
|
|
DBcc,
|
|
DBcc_branch_taken,
|
|
DBcc_condition_true,
|
|
DBcc_counter_overflow,
|
|
|
|
Bcc_b,
|
|
Bcc_w,
|
|
Bcc_branch_taken,
|
|
Bcc_b_branch_not_taken,
|
|
Bcc_w_branch_not_taken,
|
|
|
|
BSR,
|
|
|
|
JSRJMPAddressRegisterIndirect,
|
|
JSRJMPAddressRegisterIndirectWithDisplacement,
|
|
JSRJMPAddressRegisterIndirectWithIndex8bitDisplacement,
|
|
JSRJMPProgramCounterIndirectWithDisplacement,
|
|
JSRJMPProgramCounterIndirectWithIndex8bitDisplacement,
|
|
JSRJMPAbsoluteShort,
|
|
JSRJMPAbsoluteLong,
|
|
|
|
JSR, JMP,
|
|
|
|
BCHG_BSET_Dn,
|
|
BCLR_Dn,
|
|
|
|
MOVEPtoM_w,
|
|
MOVEPtoM_l,
|
|
MOVEPtoR_w,
|
|
MOVEPtoR_l,
|
|
|
|
LogicalToSR,
|
|
|
|
MOVEMtoR, MOVEMtoR_l_read, MOVEMtoR_w_read, MOVEMtoR_finish,
|
|
MOVEMtoM,
|
|
MOVEMtoM_l_write, MOVEMtoM_w_write,
|
|
MOVEMtoM_l_write_predec, MOVEMtoM_w_write_predec,
|
|
MOVEMtoM_finish,
|
|
|
|
DIVU_DIVS,
|
|
MULU_MULS,
|
|
LEA,
|
|
PEA,
|
|
TAS,
|
|
MOVEtoCCRSR,
|
|
RTR,
|
|
RTE,
|
|
RTS,
|
|
};
|
|
|
|
// MARK: - The state machine.
|
|
|
|
template <class BusHandler, bool dtack_is_implicit, bool permit_overrun, bool signal_will_perform>
|
|
void Processor<BusHandler, dtack_is_implicit, permit_overrun, signal_will_perform>::run_for(HalfCycles duration) {
|
|
// Accumulate the newly paid-in cycles. If this instance remains in deficit, exit.
|
|
time_remaining_ += duration;
|
|
if(time_remaining_ <= HalfCycles(0)) return;
|
|
|
|
// Check whether all remaining time has been expended; if so then exit, having set this line up as
|
|
// the next resumption point.
|
|
#define ConsiderExit() if(time_remaining_ <= HalfCycles(0)) { state_ = __COUNTER__+1; return; } [[fallthrough]]; case __COUNTER__:
|
|
|
|
// Subtracts `n` half-cycles from `time_remaining_`; if permit_overrun is false, also ConsiderExit()
|
|
#define Spend(n) time_remaining_ -= (n); if constexpr (!permit_overrun) ConsiderExit()
|
|
|
|
// Performs ConsiderExit() only if permit_overrun is true.
|
|
#define CheckOverrun() if constexpr (permit_overrun) ConsiderExit()
|
|
|
|
// Moves directly to state x, which must be a compile-time constant.
|
|
#define MoveToStateSpecific(x) goto x;
|
|
|
|
// Moves to state x by dynamic dispatch; x can be a regular variable.
|
|
#define MoveToStateDynamic(x) { state_ = x; continue; }
|
|
|
|
// Sets the start position for state x.
|
|
#define BeginState(x) case ExecutionState::x: [[maybe_unused]] x
|
|
|
|
//
|
|
// So basic structure is, in general:
|
|
//
|
|
// BeginState(Action):
|
|
// do_something();
|
|
// Spend(20);
|
|
// do_something_else();
|
|
// Spend(10);
|
|
// do_a_third_thing();
|
|
// Spend(30);
|
|
// MoveToState(next_action);
|
|
//
|
|
// Additional notes:
|
|
//
|
|
// Action and all equivalents should be negative values, since the
|
|
// switch-for-computed-goto-for-a-coroutine structure uses __COUNTER__* for
|
|
// its invented entry- and exit-points, meaning that negative numbers are
|
|
// the easiest group that is safely definitely never going to collide.
|
|
//
|
|
// (* an extension supported by at least GCC, Clang and MSVC)
|
|
|
|
|
|
// Spare containers:
|
|
HalfCycles delay; // To receive any additional time added on by calls to perform_bus_operation.
|
|
|
|
// Helper macros for common bus transactions:
|
|
|
|
// Performs the bus operation and then applies a `Spend` of its length
|
|
// plus any additional length returned by the bus handler.
|
|
#define PerformBusOperation(x) \
|
|
delay = bus_handler_.perform_bus_operation(x, is_supervisor_); \
|
|
Spend(x.length + delay)
|
|
|
|
// Performs no bus activity for the specified number of microcycles.
|
|
#define IdleBus(n) \
|
|
idle.length = HalfCycles(n * 4); \
|
|
PerformBusOperation(idle)
|
|
|
|
// Spin until DTACK, VPA or BERR is asserted (unless DTACK is implicit),
|
|
// holding the bus cycle provided.
|
|
#define WaitForDTACK(x) \
|
|
if constexpr (!dtack_is_implicit && !dtack_ && !vpa_ && !berr_) { \
|
|
awaiting_dtack = x; \
|
|
awaiting_dtack.length = HalfCycles(2); \
|
|
post_dtack_state_ = __COUNTER__+1; \
|
|
state_ = ExecutionState::WaitForDTACK; \
|
|
break; \
|
|
} \
|
|
[[fallthrough]]; case __COUNTER__:
|
|
|
|
// Performs the bus operation provided, which will be one with a
|
|
// SelectWord or SelectByte operation, stretching it to match the E
|
|
// bus if VPA is currently asserted.
|
|
//
|
|
// TODO: If BERR is asserted, stop here and perform a bus error exception.
|
|
//
|
|
// TODO: If VPA is asserted, stretch this cycle.
|
|
#define CompleteAccess(x) \
|
|
PerformBusOperation(x)
|
|
|
|
// Performs the memory access implied by the announce, perform pair,
|
|
// honouring DTACK, BERR and VPA as necessary.
|
|
#define AccessPair(val, announce, perform) \
|
|
perform.value = &val; \
|
|
if constexpr (!dtack_is_implicit) { \
|
|
announce.length = HalfCycles(4); \
|
|
} \
|
|
PerformBusOperation(announce); \
|
|
WaitForDTACK(announce); \
|
|
CompleteAccess(perform);
|
|
|
|
// Sets up the next data access size and read flags.
|
|
#define SetupDataAccess(read_flag, select_flag) \
|
|
access_announce.operation = Microcycle::NewAddress | Microcycle::IsData | (read_flag); \
|
|
access.operation = access_announce.operation | (select_flag);
|
|
|
|
// Sets the address source for the next data access.
|
|
#define SetDataAddress(addr) \
|
|
access.address = access_announce.address = &addr;
|
|
|
|
// Performs the access established by SetupDataAccess into val.
|
|
#define Access(val) \
|
|
AccessPair(val, access_announce, access)
|
|
|
|
// Reads the program (i.e. non-data) word from addr into val.
|
|
#define ReadProgramWord(val) \
|
|
AccessPair(val, read_program_announce, read_program); \
|
|
program_counter_.l += 2;
|
|
|
|
// Reads one futher word from the program counter and inserts it into
|
|
// the prefetch queue.
|
|
#define Prefetch() \
|
|
prefetch_.high = prefetch_.low; \
|
|
ReadProgramWord(prefetch_.low)
|
|
|
|
using Mode = InstructionSet::M68k::AddressingMode;
|
|
|
|
// Otherwise continue for all time, until back in debt.
|
|
// Formatting is slightly obtuse here to make this look more like a coroutine.
|
|
while(true) { switch(state_) {
|
|
|
|
// Spin in place, one cycle at a time, until one of DTACK,
|
|
// BERR or VPA is asserted.
|
|
BeginState(WaitForDTACK):
|
|
PerformBusOperation(awaiting_dtack);
|
|
|
|
if(dtack_ || berr_ || vpa_) {
|
|
MoveToStateDynamic(post_dtack_state_);
|
|
}
|
|
MoveToStateSpecific(WaitForDTACK);
|
|
|
|
// Perform the RESET exception, which seeds the stack pointer and program
|
|
// counter, populates the prefetch queue, and then moves to instruction dispatch.
|
|
BeginState(Reset):
|
|
IdleBus(7); // (n-)*5 nn
|
|
|
|
// Establish general reset state.
|
|
status_.is_supervisor = true;
|
|
status_.interrupt_level = 7;
|
|
status_.trace_flag = 0;
|
|
did_update_status();
|
|
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord);
|
|
SetDataAddress(temporary_address_.l);
|
|
|
|
temporary_address_.l = 0;
|
|
Access(registers_[15].high); // nF
|
|
|
|
temporary_address_.l += 2;
|
|
Access(registers_[15].low); // nf
|
|
|
|
temporary_address_.l += 2;
|
|
Access(program_counter_.high); // nV
|
|
|
|
temporary_address_.l += 2;
|
|
Access(program_counter_.low); // nv
|
|
|
|
Prefetch(); // np
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
// Perform a 'standard' exception, i.e. a Group 1 or 2.
|
|
BeginState(StandardException):
|
|
captured_status_.w = status_.status();
|
|
|
|
// Switch to supervisor mode.
|
|
status_.is_supervisor = true;
|
|
status_.trace_flag = 0;
|
|
did_update_status();
|
|
|
|
SetupDataAccess(0, Microcycle::SelectWord);
|
|
SetDataAddress(registers_[15].l);
|
|
|
|
// Push status and current program counter.
|
|
// Write order is wacky here, but I think it's correct.
|
|
registers_[15].l -= 6;
|
|
Access(captured_status_); // ns
|
|
|
|
registers_[15].l += 4;
|
|
Access(instruction_address_.low); // ns
|
|
|
|
registers_[15].l -= 2;
|
|
Access(instruction_address_.high); // nS
|
|
|
|
registers_[15].l -= 2;
|
|
|
|
// Grab new program counter.
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord);
|
|
SetDataAddress(temporary_address_.l);
|
|
|
|
temporary_address_.l = exception_vector_ << 2;
|
|
Access(program_counter_.high); // nV
|
|
|
|
temporary_address_.l += 2;
|
|
Access(program_counter_.low); // nv
|
|
|
|
// Populate the prefetch queue.
|
|
Prefetch(); // np
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
// Inspect the prefetch queue in order to decode the next instruction,
|
|
// and segue into the fetching of operands.
|
|
BeginState(Decode):
|
|
CheckOverrun();
|
|
|
|
opcode_ = prefetch_.high.w;
|
|
instruction_ = decoder_.decode(opcode_);
|
|
instruction_address_.l = program_counter_.l - 4;
|
|
|
|
// Signal the bus handler if requested.
|
|
if constexpr (signal_will_perform) {
|
|
bus_handler_.will_perform(instruction_address_.l, opcode_);
|
|
}
|
|
|
|
// Check for a privilege violation.
|
|
if(instruction_.requires_supervisor() && !status_.is_supervisor) {
|
|
exception_vector_ = InstructionSet::M68k::Exception::PrivilegeViolation;
|
|
MoveToStateSpecific(StandardException);
|
|
}
|
|
|
|
// Check for an unrecognised opcode.
|
|
if(instruction_.operation == InstructionSet::M68k::Operation::Undefined) {
|
|
switch(opcode_ & 0xf000) {
|
|
default:
|
|
exception_vector_ = InstructionSet::M68k::Exception::IllegalInstruction;
|
|
continue;
|
|
case 0xa000:
|
|
exception_vector_ = InstructionSet::M68k::Exception::Line1010;
|
|
continue;
|
|
case 0xf000:
|
|
exception_vector_ = InstructionSet::M68k::Exception::Line1111;
|
|
continue;
|
|
}
|
|
MoveToStateSpecific(StandardException);
|
|
}
|
|
|
|
// Ensure the first parameter is next fetched.
|
|
next_operand_ = 0;
|
|
|
|
// Obtain operand flags and pick a perform pattern.
|
|
#define CASE(x) \
|
|
case InstructionSet::M68k::Operation::x: \
|
|
operand_flags_ = InstructionSet::M68k::operand_flags<InstructionSet::M68k::Model::M68000, InstructionSet::M68k::Operation::x>();
|
|
|
|
#define StdCASE(x, y) \
|
|
CASE(x) \
|
|
y; \
|
|
\
|
|
if constexpr (InstructionSet::M68k::operand_size<InstructionSet::M68k::Operation::x>() == InstructionSet::M68k::DataSize::LongWord) { \
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord); \
|
|
MoveToStateSpecific(FetchOperand_l); \
|
|
} else { \
|
|
if constexpr (InstructionSet::M68k::operand_size<InstructionSet::M68k::Operation::x>() == InstructionSet::M68k::DataSize::Byte) { \
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectByte); \
|
|
} else { \
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord); \
|
|
} \
|
|
MoveToStateSpecific(FetchOperand_bw); \
|
|
}
|
|
|
|
#define Duplicate(x, y) \
|
|
case InstructionSet::M68k::Operation::x: \
|
|
static_assert( \
|
|
InstructionSet::M68k::operand_flags<InstructionSet::M68k::Model::M68000, InstructionSet::M68k::Operation::x>() == \
|
|
InstructionSet::M68k::operand_flags<InstructionSet::M68k::Model::M68000, InstructionSet::M68k::Operation::y>() && \
|
|
InstructionSet::M68k::operand_size<InstructionSet::M68k::Operation::x>() == \
|
|
InstructionSet::M68k::operand_size<InstructionSet::M68k::Operation::y>() \
|
|
); \
|
|
[[fallthrough]];
|
|
|
|
switch(instruction_.operation) {
|
|
StdCASE(NBCD, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np_n;
|
|
} else {
|
|
perform_state_ = Perform_np;
|
|
}
|
|
})
|
|
|
|
Duplicate(CLRb, NEGXb) Duplicate(NEGb, NEGXb) Duplicate(NOTb, NEGXb)
|
|
StdCASE(NEGXb, perform_state_ = Perform_np);
|
|
|
|
Duplicate(CLRw, NEGXw) Duplicate(NEGw, NEGXw) Duplicate(NOTw, NEGXw)
|
|
StdCASE(NEGXw, perform_state_ = Perform_np);
|
|
|
|
Duplicate(CLRl, NEGXl) Duplicate(NEGl, NEGXl) Duplicate(NOTl, NEGXl)
|
|
StdCASE(NEGXl,
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np_n;
|
|
} else {
|
|
perform_state_ = Perform_np;
|
|
}
|
|
);
|
|
|
|
StdCASE(SWAP, perform_state_ = Perform_np);
|
|
StdCASE(EXG, perform_state_ = Perform_np_n);
|
|
|
|
StdCASE(EXTbtow, perform_state_ = Perform_np);
|
|
StdCASE(EXTwtol, perform_state_ = Perform_np);
|
|
|
|
StdCASE(MOVEw, perform_state_ = MOVEw);
|
|
|
|
StdCASE(CMPb, perform_state_ = Perform_np);
|
|
StdCASE(CMPw, perform_state_ = Perform_np);
|
|
StdCASE(CMPl, perform_state_ = Perform_np_n);
|
|
|
|
StdCASE(CMPAw, perform_state_ = Perform_np_n);
|
|
StdCASE(CMPAl, perform_state_ = Perform_np_n);
|
|
|
|
Duplicate(ANDb, ORb) StdCASE(ORb, perform_state_ = Perform_np);
|
|
Duplicate(ANDw, ORw) StdCASE(ORw, perform_state_ = Perform_np);
|
|
Duplicate(ANDl, ORl) StdCASE(ORl, {
|
|
if(instruction_.mode(1) == Mode::DataRegisterDirect) {
|
|
switch(instruction_.mode(0)) {
|
|
default:
|
|
perform_state_ = Perform_np_n;
|
|
break;
|
|
case Mode::DataRegisterDirect:
|
|
case Mode::ImmediateData:
|
|
perform_state_ = Perform_np_nn;
|
|
break;
|
|
}
|
|
} else {
|
|
perform_state_ = Perform_np;
|
|
}
|
|
});
|
|
|
|
StdCASE(EORb, perform_state_ = Perform_np);
|
|
StdCASE(EORw, perform_state_ = Perform_np);
|
|
StdCASE(EORl, {
|
|
if(instruction_.mode(1) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np_nn;
|
|
} else {
|
|
perform_state_ = Perform_np;
|
|
}
|
|
})
|
|
|
|
Duplicate(SBCD, ABCD)
|
|
CASE(ABCD)
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np_n;
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectByte);
|
|
MoveToStateSpecific(FetchOperand_bw);
|
|
} else {
|
|
select_flag_ = Microcycle::SelectByte;
|
|
MoveToStateSpecific(TwoOp_Predec_bw);
|
|
}
|
|
|
|
StdCASE(CHK, perform_state_ = CHK);
|
|
|
|
Duplicate(SUBb, ADDb) StdCASE(ADDb, perform_state_ = Perform_np)
|
|
Duplicate(SUBw, ADDw) StdCASE(ADDw, perform_state_ = Perform_np)
|
|
Duplicate(SUBl, ADDl) StdCASE(ADDl, {
|
|
if(instruction_.mode(1) != Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np;
|
|
} else {
|
|
switch(instruction_.mode(0)) {
|
|
default:
|
|
perform_state_ = Perform_np_n;
|
|
break;
|
|
case Mode::DataRegisterDirect:
|
|
case Mode::AddressRegisterDirect:
|
|
case Mode::ImmediateData:
|
|
perform_state_ = Perform_np_nn;
|
|
break;
|
|
}
|
|
}
|
|
})
|
|
|
|
Duplicate(SUBAw, ADDAw) StdCASE(ADDAw, perform_state_ = Perform_np_nn)
|
|
Duplicate(SUBAl, ADDAl) StdCASE(ADDAl, {
|
|
if(instruction_.mode(1) == Mode::AddressRegisterDirect) {
|
|
perform_state_ = Perform_np_nn;
|
|
} else {
|
|
switch(instruction_.mode(0)) {
|
|
default:
|
|
perform_state_ = Perform_np_n;
|
|
break;
|
|
case Mode::DataRegisterDirect:
|
|
case Mode::AddressRegisterDirect:
|
|
case Mode::ImmediateData:
|
|
perform_state_ = Perform_np_nn;
|
|
break;
|
|
}
|
|
}
|
|
})
|
|
|
|
Duplicate(SUBXb, ADDXb) StdCASE(ADDXb, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np;
|
|
} else {
|
|
select_flag_ = Microcycle::SelectByte;
|
|
MoveToStateSpecific(TwoOp_Predec_bw);
|
|
}
|
|
})
|
|
Duplicate(SUBXw, ADDXw) StdCASE(ADDXw, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np;
|
|
} else {
|
|
select_flag_ = Microcycle::SelectWord;
|
|
MoveToStateSpecific(TwoOp_Predec_bw);
|
|
}
|
|
})
|
|
Duplicate(SUBXl, ADDXl) StdCASE(ADDXl, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Perform_np_nn;
|
|
} else {
|
|
MoveToStateSpecific(TwoOp_Predec_l);
|
|
}
|
|
})
|
|
|
|
StdCASE(Scc, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
perform_state_ = Scc_Dn;
|
|
} else {
|
|
perform_state_ = Perform_np;
|
|
}
|
|
});
|
|
|
|
StdCASE(DBcc, MoveToStateSpecific(DBcc));
|
|
|
|
StdCASE(Bccb, MoveToStateSpecific(Bcc_b));
|
|
StdCASE(Bccw, MoveToStateSpecific(Bcc_w));
|
|
|
|
StdCASE(BSRb, perform_state_ = BSR);
|
|
StdCASE(BSRw, perform_state_ = BSR);
|
|
|
|
Duplicate(JMP, JSR)
|
|
StdCASE(JSR, {
|
|
post_ea_state_ =
|
|
(instruction_.operation == InstructionSet::M68k::Operation::JSR) ?
|
|
JSR : JMP;
|
|
|
|
switch(instruction_.mode(0)) {
|
|
case Mode::AddressRegisterIndirect:
|
|
MoveToStateSpecific(JSRJMPAddressRegisterIndirect);
|
|
case Mode::AddressRegisterIndirectWithDisplacement:
|
|
MoveToStateSpecific(JSRJMPAddressRegisterIndirectWithDisplacement);
|
|
case Mode::AddressRegisterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(JSRJMPAddressRegisterIndirectWithIndex8bitDisplacement);
|
|
case Mode::ProgramCounterIndirectWithDisplacement:
|
|
MoveToStateSpecific(JSRJMPProgramCounterIndirectWithDisplacement);
|
|
case Mode::ProgramCounterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(JSRJMPProgramCounterIndirectWithIndex8bitDisplacement);
|
|
case Mode::AbsoluteShort:
|
|
MoveToStateSpecific(JSRJMPAbsoluteShort);
|
|
case Mode::AbsoluteLong:
|
|
MoveToStateSpecific(JSRJMPAbsoluteLong);
|
|
|
|
default: assert(false);
|
|
}
|
|
});
|
|
|
|
StdCASE(BTST, {
|
|
switch(instruction_.mode(1)) {
|
|
default:
|
|
perform_state_ = Perform_np;
|
|
break;
|
|
case Mode::DataRegisterDirect:
|
|
case Mode::ImmediateData:
|
|
perform_state_ = Perform_np_n;
|
|
break;
|
|
}
|
|
});
|
|
|
|
Duplicate(BCHG, BSET)
|
|
StdCASE(BSET, {
|
|
switch(instruction_.mode(1)) {
|
|
default:
|
|
perform_state_ = Perform_np;
|
|
break;
|
|
case Mode::DataRegisterDirect:
|
|
case Mode::ImmediateData:
|
|
perform_state_ = BCHG_BSET_Dn;
|
|
break;
|
|
}
|
|
});
|
|
|
|
StdCASE(BCLR, {
|
|
switch(instruction_.mode(1)) {
|
|
default:
|
|
perform_state_ = Perform_np;
|
|
break;
|
|
case Mode::DataRegisterDirect:
|
|
case Mode::ImmediateData:
|
|
perform_state_ = BCLR_Dn;
|
|
break;
|
|
}
|
|
});
|
|
|
|
StdCASE(MOVEPl, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
MoveToStateSpecific(MOVEPtoM_l);
|
|
} else {
|
|
MoveToStateSpecific(MOVEPtoR_l);
|
|
}
|
|
});
|
|
|
|
StdCASE(MOVEPw, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
MoveToStateSpecific(MOVEPtoM_w);
|
|
} else {
|
|
MoveToStateSpecific(MOVEPtoR_w);
|
|
}
|
|
});
|
|
|
|
Duplicate(ORItoCCR, EORItoCCR); Duplicate(ANDItoCCR, EORItoCCR);
|
|
StdCASE(EORItoCCR, perform_state_ = LogicalToSR);
|
|
|
|
Duplicate(ORItoSR, EORItoSR); Duplicate(ANDItoSR, EORItoSR);
|
|
StdCASE(EORItoSR, perform_state_ = LogicalToSR);
|
|
|
|
StdCASE(MOVEMtoRl, perform_state_ = MOVEMtoR);
|
|
StdCASE(MOVEMtoRw, perform_state_ = MOVEMtoR);
|
|
StdCASE(MOVEMtoMl, perform_state_ = MOVEMtoM);
|
|
StdCASE(MOVEMtoMw, perform_state_ = MOVEMtoM);
|
|
|
|
StdCASE(TSTb, perform_state_ = Perform_np);
|
|
StdCASE(TSTw, perform_state_ = Perform_np);
|
|
StdCASE(TSTl, perform_state_ = Perform_np);
|
|
|
|
StdCASE(DIVU, perform_state_ = DIVU_DIVS);
|
|
StdCASE(DIVS, perform_state_ = DIVU_DIVS);
|
|
StdCASE(MULU, perform_state_ = MULU_MULS);
|
|
StdCASE(MULS, perform_state_ = MULU_MULS);
|
|
|
|
StdCASE(LEA, {
|
|
post_ea_state_ = LEA;
|
|
next_operand_ = 0;
|
|
MoveToStateSpecific(CalcEffectiveAddress);
|
|
});
|
|
StdCASE(PEA, {
|
|
post_ea_state_ = PEA;
|
|
next_operand_ = 0;
|
|
MoveToStateSpecific(CalcEffectiveAddress);
|
|
});
|
|
|
|
StdCASE(TAS, {
|
|
// TAS uses a special atomic bus cycle for memory accesses,
|
|
// but is also available as DataRegisterDirect, with no
|
|
// memory access whatsoever. So segue elsewhere here only
|
|
// for the other cases.
|
|
if(instruction_.mode(0) != Mode::DataRegisterDirect) {
|
|
post_ea_state_ = TAS;
|
|
next_operand_ = 0;
|
|
MoveToStateSpecific(CalcEffectiveAddress);
|
|
}
|
|
|
|
perform_state_ = Perform_np;
|
|
});
|
|
|
|
Duplicate(MOVEtoCCR, MOVEtoSR);
|
|
StdCASE(MOVEtoSR, perform_state_ = MOVEtoCCRSR);
|
|
|
|
StdCASE(MOVEfromSR, {
|
|
if(instruction_.mode(0) == Mode::DataRegisterDirect) {
|
|
post_ea_state_ = Perform_np_n;
|
|
} else {
|
|
post_ea_state_ = Perform_np;
|
|
}
|
|
MoveToStateSpecific(CalcEffectiveAddress);
|
|
});
|
|
|
|
StdCASE(RTR, MoveToStateSpecific(RTR));
|
|
StdCASE(RTE, MoveToStateSpecific(RTE));
|
|
StdCASE(RTS, MoveToStateSpecific(RTS));
|
|
|
|
default:
|
|
assert(false);
|
|
}
|
|
|
|
#undef Duplicate
|
|
#undef StdCASE
|
|
#undef CASE
|
|
|
|
// MARK: - Fetch, dispatch.
|
|
|
|
#define MoveToNextOperand(x) \
|
|
++next_operand_; \
|
|
if(next_operand_ == 2) { \
|
|
MoveToStateDynamic(perform_state_); \
|
|
} \
|
|
MoveToStateSpecific(x)
|
|
|
|
// Check the operand flags to determine whether the byte or word
|
|
// operand at index next_operand_ needs to be fetched, and if so
|
|
// then calculate the EA and do so.
|
|
BeginState(FetchOperand_bw):
|
|
// Check that this operand is meant to be fetched; if not then either:
|
|
//
|
|
// (i) this operand isn't used; or
|
|
// (ii) its address calculation will end up conflated with performance,
|
|
// so there's no generic bus-accurate approach.
|
|
if(!(operand_flags_ & (1 << next_operand_))) {
|
|
MoveToStateDynamic(perform_state_);
|
|
}
|
|
|
|
// Figure out how to fetch it.
|
|
switch(instruction_.mode(next_operand_)) {
|
|
case Mode::AddressRegisterDirect:
|
|
case Mode::DataRegisterDirect:
|
|
operand_[next_operand_] = registers_[instruction_.lreg(next_operand_)];
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
case Mode::Quick:
|
|
operand_[next_operand_].l = InstructionSet::M68k::quick(opcode_, instruction_.operation);
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
case Mode::AddressRegisterIndirect:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirect_bw);
|
|
case Mode::AddressRegisterIndirectWithPostincrement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithPostincrement_bw);
|
|
case Mode::AddressRegisterIndirectWithPredecrement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithPredecrement_bw);
|
|
case Mode::AddressRegisterIndirectWithDisplacement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithDisplacement_bw);
|
|
case Mode::AddressRegisterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithIndex8bitDisplacement_bw);
|
|
case Mode::ProgramCounterIndirectWithDisplacement:
|
|
MoveToStateSpecific(FetchProgramCounterIndirectWithDisplacement_bw);
|
|
case Mode::ProgramCounterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(FetchProgramCounterIndirectWithIndex8bitDisplacement_bw);
|
|
case Mode::AbsoluteShort:
|
|
MoveToStateSpecific(FetchAbsoluteShort_bw);
|
|
case Mode::AbsoluteLong:
|
|
MoveToStateSpecific(FetchAbsoluteLong_bw);
|
|
case Mode::ImmediateData:
|
|
MoveToStateSpecific(FetchImmediateData_bw);
|
|
|
|
// Should be impossible to reach.
|
|
default:
|
|
assert(false);
|
|
}
|
|
break;
|
|
|
|
// As above, but for .l.
|
|
BeginState(FetchOperand_l):
|
|
if(!(operand_flags_ & (1 << next_operand_))) {
|
|
MoveToStateDynamic(perform_state_);
|
|
}
|
|
|
|
switch(instruction_.mode(next_operand_)) {
|
|
case Mode::AddressRegisterDirect:
|
|
case Mode::DataRegisterDirect:
|
|
operand_[next_operand_] = registers_[instruction_.lreg(next_operand_)];
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
case Mode::Quick:
|
|
operand_[next_operand_].l = InstructionSet::M68k::quick(opcode_, instruction_.operation);
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
case Mode::AddressRegisterIndirect:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirect_l);
|
|
case Mode::AddressRegisterIndirectWithPostincrement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithPostincrement_l);
|
|
case Mode::AddressRegisterIndirectWithPredecrement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithPredecrement_l);
|
|
case Mode::AddressRegisterIndirectWithDisplacement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithDisplacement_l);
|
|
case Mode::AddressRegisterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(FetchAddressRegisterIndirectWithIndex8bitDisplacement_l);
|
|
case Mode::ProgramCounterIndirectWithDisplacement:
|
|
MoveToStateSpecific(FetchProgramCounterIndirectWithDisplacement_l);
|
|
case Mode::ProgramCounterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(FetchProgramCounterIndirectWithIndex8bitDisplacement_l);
|
|
case Mode::AbsoluteShort:
|
|
MoveToStateSpecific(FetchAbsoluteShort_l);
|
|
case Mode::AbsoluteLong:
|
|
MoveToStateSpecific(FetchAbsoluteLong_l);
|
|
case Mode::ImmediateData:
|
|
MoveToStateSpecific(FetchImmediateData_l);
|
|
|
|
// Should be impossible to reach.
|
|
default:
|
|
assert(false);
|
|
}
|
|
break;
|
|
|
|
BeginState(CalcEffectiveAddress):
|
|
switch(instruction_.mode(next_operand_)) {
|
|
default:
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
case Mode::AddressRegisterIndirect:
|
|
MoveToStateSpecific(CalcAddressRegisterIndirect);
|
|
case Mode::AddressRegisterIndirectWithPostincrement:
|
|
MoveToStateSpecific(CalcAddressRegisterIndirectWithPostincrement);
|
|
case Mode::AddressRegisterIndirectWithPredecrement:
|
|
MoveToStateSpecific(CalcAddressRegisterIndirectWithPredecrement);
|
|
case Mode::AddressRegisterIndirectWithDisplacement:
|
|
MoveToStateSpecific(CalcAddressRegisterIndirectWithDisplacement);
|
|
case Mode::AddressRegisterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(CalcAddressRegisterIndirectWithIndex8bitDisplacement);
|
|
case Mode::ProgramCounterIndirectWithDisplacement:
|
|
MoveToStateSpecific(CalcProgramCounterIndirectWithDisplacement);
|
|
case Mode::ProgramCounterIndirectWithIndex8bitDisplacement:
|
|
MoveToStateSpecific(CalcProgramCounterIndirectWithIndex8bitDisplacement);
|
|
case Mode::AbsoluteShort:
|
|
MoveToStateSpecific(CalcAbsoluteShort);
|
|
case Mode::AbsoluteLong:
|
|
MoveToStateSpecific(CalcAbsoluteLong);
|
|
}
|
|
|
|
// MARK: - Fetch, addressing modes.
|
|
|
|
//
|
|
// AddressRegisterIndirect
|
|
//
|
|
BeginState(FetchAddressRegisterIndirect_bw):
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchAddressRegisterIndirect_l):
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Access(operand_[next_operand_].high); // nR
|
|
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcAddressRegisterIndirect):
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
BeginState(JSRJMPAddressRegisterIndirect):
|
|
effective_address_[0].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
temporary_address_.l = instruction_address_.l + 2;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// AddressRegisterIndirectWithPostincrement
|
|
//
|
|
BeginState(FetchAddressRegisterIndirectWithPostincrement_bw):
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
registers_[8 + instruction_.reg(next_operand_)].l +=
|
|
address_increments[int(instruction_.operand_size())][instruction_.reg(next_operand_)];
|
|
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchAddressRegisterIndirectWithPostincrement_l):
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
registers_[8 + instruction_.reg(next_operand_)].l += 4;
|
|
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcAddressRegisterIndirectWithPostincrement):
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
registers_[8 + instruction_.reg(next_operand_)].l +=
|
|
address_increments[int(instruction_.operand_size())][instruction_.reg(next_operand_)];
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// AddressRegisterIndirectWithPredecrement
|
|
//
|
|
BeginState(FetchAddressRegisterIndirectWithPredecrement_bw):
|
|
registers_[8 + instruction_.reg(next_operand_)].l -=
|
|
address_increments[int(instruction_.operand_size())][instruction_.reg(next_operand_)];
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
IdleBus(1); // n
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchAddressRegisterIndirectWithPredecrement_l):
|
|
registers_[8 + instruction_.reg(next_operand_)].l -= 4;
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
IdleBus(1); // n
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcAddressRegisterIndirectWithPredecrement):
|
|
registers_[8 + instruction_.reg(next_operand_)].l -= address_increments[int(instruction_.operand_size())][instruction_.reg(next_operand_)];
|
|
effective_address_[next_operand_].l = registers_[8 + instruction_.reg(next_operand_)].l;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// AddressRegisterIndirectWithDisplacement
|
|
//
|
|
BeginState(FetchAddressRegisterIndirectWithDisplacement_bw):
|
|
effective_address_[next_operand_].l =
|
|
registers_[8 + instruction_.reg(next_operand_)].l +
|
|
int16_t(prefetch_.w);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchAddressRegisterIndirectWithDisplacement_l):
|
|
effective_address_[next_operand_].l =
|
|
registers_[8 + instruction_.reg(next_operand_)].l +
|
|
int16_t(prefetch_.w);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcAddressRegisterIndirectWithDisplacement):
|
|
effective_address_[next_operand_].l =
|
|
registers_[8 + instruction_.reg(next_operand_)].l +
|
|
int16_t(prefetch_.w);
|
|
Prefetch(); // np
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
BeginState(JSRJMPAddressRegisterIndirectWithDisplacement):
|
|
effective_address_[0].l =
|
|
registers_[8 + instruction_.reg(next_operand_)].l +
|
|
int16_t(prefetch_.w);
|
|
IdleBus(1); // n
|
|
temporary_address_.l = instruction_address_.l + 4;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// ProgramCounterIndirectWithDisplacement
|
|
//
|
|
BeginState(FetchProgramCounterIndirectWithDisplacement_bw):
|
|
effective_address_[next_operand_].l =
|
|
program_counter_.l - 2 +
|
|
int16_t(prefetch_.w);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchProgramCounterIndirectWithDisplacement_l):
|
|
effective_address_[next_operand_].l =
|
|
program_counter_.l - 2 +
|
|
int16_t(prefetch_.w);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcProgramCounterIndirectWithDisplacement):
|
|
effective_address_[next_operand_].l =
|
|
program_counter_.l - 2 +
|
|
int16_t(prefetch_.w);
|
|
Prefetch(); // np
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
BeginState(JSRJMPProgramCounterIndirectWithDisplacement):
|
|
effective_address_[0].l =
|
|
program_counter_.l - 2 +
|
|
int16_t(prefetch_.w);
|
|
IdleBus(1); // n
|
|
temporary_address_.l = instruction_address_.l + 4;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// AddressRegisterIndirectWithIndex8bitDisplacement
|
|
//
|
|
#define d8Xn(base) \
|
|
base + \
|
|
((prefetch_.w & 0x800) ? \
|
|
registers_[prefetch_.w >> 12].l : \
|
|
int16_t(registers_[prefetch_.w >> 12].w)) + \
|
|
int8_t(prefetch_.b);
|
|
|
|
BeginState(FetchAddressRegisterIndirectWithIndex8bitDisplacement_bw):
|
|
effective_address_[next_operand_].l = d8Xn(registers_[8 + instruction_.reg(next_operand_)].l);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchAddressRegisterIndirectWithIndex8bitDisplacement_l):
|
|
effective_address_[next_operand_].l = d8Xn(registers_[8 + instruction_.reg(next_operand_)].l);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcAddressRegisterIndirectWithIndex8bitDisplacement):
|
|
effective_address_[next_operand_].l = d8Xn(registers_[8 + instruction_.reg(next_operand_)].l);
|
|
Prefetch(); // np
|
|
IdleBus(1); // n
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
BeginState(JSRJMPAddressRegisterIndirectWithIndex8bitDisplacement):
|
|
effective_address_[0].l = d8Xn(registers_[8 + instruction_.reg(next_operand_)].l);
|
|
IdleBus(3); // n nn
|
|
temporary_address_.l = instruction_address_.l + 4;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// ProgramCounterIndirectWithIndex8bitDisplacement
|
|
//
|
|
BeginState(FetchProgramCounterIndirectWithIndex8bitDisplacement_bw):
|
|
effective_address_[next_operand_].l = d8Xn(program_counter_.l - 2);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchProgramCounterIndirectWithIndex8bitDisplacement_l):
|
|
effective_address_[next_operand_].l = d8Xn(program_counter_.l - 2);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcProgramCounterIndirectWithIndex8bitDisplacement):
|
|
effective_address_[next_operand_].l = d8Xn(program_counter_.l - 2);
|
|
Prefetch(); // np
|
|
IdleBus(1); // n
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
BeginState(JSRJMPProgramCounterIndirectWithIndex8bitDisplacement):
|
|
effective_address_[0].l = d8Xn(program_counter_.l - 2);
|
|
IdleBus(3); // n nn
|
|
temporary_address_.l = instruction_address_.l + 4;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
#undef d8Xn
|
|
|
|
//
|
|
// AbsoluteShort
|
|
//
|
|
BeginState(FetchAbsoluteShort_bw):
|
|
effective_address_[next_operand_].l = int16_t(prefetch_.w);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchAbsoluteShort_l):
|
|
effective_address_[next_operand_].l = int16_t(prefetch_.w);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcAbsoluteShort):
|
|
effective_address_[next_operand_].l = int16_t(prefetch_.w);
|
|
Prefetch(); // np
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
BeginState(JSRJMPAbsoluteShort):
|
|
effective_address_[0].l = int16_t(prefetch_.w);
|
|
IdleBus(1); // n
|
|
temporary_address_.l = instruction_address_.l + 4;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// AbsoluteLong
|
|
//
|
|
BeginState(FetchAbsoluteLong_bw):
|
|
Prefetch(); // np
|
|
|
|
effective_address_[next_operand_].l = prefetch_.l;
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchAbsoluteLong_l):
|
|
Prefetch(); // np
|
|
|
|
effective_address_[next_operand_].l = prefetch_.l;
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
|
|
Prefetch(); // np
|
|
Access(operand_[next_operand_].high); // nR
|
|
effective_address_[next_operand_].l += 2;
|
|
Access(operand_[next_operand_].low); // nr
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
BeginState(CalcAbsoluteLong):
|
|
Prefetch(); // np
|
|
effective_address_[next_operand_].l = prefetch_.l;
|
|
Prefetch(); // np
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
BeginState(JSRJMPAbsoluteLong):
|
|
Prefetch(); // np
|
|
effective_address_[0].l = prefetch_.l;
|
|
temporary_address_.l = instruction_address_.l + 6;
|
|
MoveToStateDynamic(post_ea_state_);
|
|
|
|
//
|
|
// ImmediateData
|
|
//
|
|
BeginState(FetchImmediateData_bw):
|
|
operand_[next_operand_].w = prefetch_.w;
|
|
Prefetch(); // np
|
|
MoveToNextOperand(FetchOperand_bw);
|
|
|
|
BeginState(FetchImmediateData_l):
|
|
Prefetch(); // np
|
|
operand_[next_operand_].l = prefetch_.l;
|
|
Prefetch(); // np
|
|
MoveToNextOperand(FetchOperand_l);
|
|
|
|
#undef MoveToNextOperand
|
|
|
|
// MARK: - Store.
|
|
|
|
#define MoveToNextOperand(x) \
|
|
++next_operand_; \
|
|
if(next_operand_ == 2) { \
|
|
MoveToStateSpecific(Decode); \
|
|
} \
|
|
MoveToStateSpecific(x)
|
|
|
|
// Store operand is a lot simpler: only one operand is ever stored, and its address
|
|
// is already known. So this can either skip straight back to ::Decode if the target
|
|
// is a register, otherwise a single write operation can occur.
|
|
BeginState(StoreOperand):
|
|
switch(instruction_.operand_size()) {
|
|
case InstructionSet::M68k::DataSize::LongWord:
|
|
SetupDataAccess(0, Microcycle::SelectWord);
|
|
MoveToStateSpecific(StoreOperand_l);
|
|
|
|
case InstructionSet::M68k::DataSize::Word:
|
|
SetupDataAccess(0, Microcycle::SelectWord);
|
|
MoveToStateSpecific(StoreOperand_bw);
|
|
|
|
case InstructionSet::M68k::DataSize::Byte:
|
|
SetupDataAccess(0, Microcycle::SelectByte);
|
|
MoveToStateSpecific(StoreOperand_bw);
|
|
}
|
|
|
|
BeginState(StoreOperand_bw):
|
|
if(!(operand_flags_ & 0x4 << next_operand_)) {
|
|
MoveToNextOperand(StoreOperand_bw);
|
|
}
|
|
|
|
// Assumption enshrined here: there are no write-only Dn
|
|
// byte operations. i.e. anything that should technically
|
|
// write back only a byte will have read from the register
|
|
// before the operation, making it safe to write back the
|
|
// entire word.
|
|
//
|
|
// However there are write-only Dn word operations, and
|
|
// the sign-extended top half needs to be kept for An.
|
|
switch(instruction_.mode(next_operand_)) {
|
|
case Mode::DataRegisterDirect:
|
|
registers_[instruction_.lreg(next_operand_)].w = operand_[next_operand_].w;
|
|
MoveToNextOperand(StoreOperand_bw);
|
|
case Mode::AddressRegisterDirect:
|
|
registers_[instruction_.lreg(next_operand_)] = operand_[next_operand_];
|
|
MoveToNextOperand(StoreOperand_bw);
|
|
default: break;
|
|
}
|
|
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
Access(operand_[next_operand_].low); // nw
|
|
MoveToNextOperand(StoreOperand_bw);
|
|
|
|
BeginState(StoreOperand_l):
|
|
if(!(operand_flags_ & 0x4 << next_operand_)) {
|
|
MoveToNextOperand(StoreOperand_l);
|
|
}
|
|
|
|
if(instruction_.mode(next_operand_) <= Mode::AddressRegisterDirect) {
|
|
registers_[instruction_.lreg(next_operand_)] = operand_[next_operand_];
|
|
MoveToNextOperand(StoreOperand_l);
|
|
}
|
|
|
|
SetupDataAccess(0, Microcycle::SelectWord);
|
|
SetDataAddress(effective_address_[next_operand_].l);
|
|
Access(operand_[next_operand_].low); // nw
|
|
|
|
effective_address_[next_operand_].l -= 2;
|
|
Access(operand_[next_operand_].high); // nW
|
|
MoveToNextOperand(StoreOperand_l);
|
|
|
|
#define PerformDynamic() \
|
|
InstructionSet::M68k::perform<InstructionSet::M68k::Model::M68000>( \
|
|
instruction_, operand_[0], operand_[1], status_, *static_cast<ProcessorBase *>(this));
|
|
|
|
#define PerformSpecific(x) \
|
|
InstructionSet::M68k::perform< \
|
|
InstructionSet::M68k::Model::M68000, \
|
|
ProcessorBase, \
|
|
InstructionSet::M68k::Operation::x \
|
|
>( \
|
|
instruction_, operand_[0], operand_[1], status_, *static_cast<ProcessorBase *>(this));
|
|
|
|
//
|
|
// Various generic forms of perform.
|
|
//
|
|
#define MoveToWritePhase() \
|
|
next_operand_ = 0; \
|
|
if(operand_flags_ & 0x0c) MoveToStateSpecific(StoreOperand) else MoveToStateSpecific(Decode)
|
|
|
|
BeginState(Perform_np):
|
|
PerformDynamic();
|
|
Prefetch(); // np
|
|
MoveToWritePhase();
|
|
|
|
BeginState(Perform_np_n):
|
|
PerformDynamic();
|
|
Prefetch(); // np
|
|
IdleBus(1); // n
|
|
MoveToWritePhase();
|
|
|
|
BeginState(Perform_np_nn):
|
|
PerformDynamic();
|
|
Prefetch(); // np
|
|
IdleBus(2); // nn
|
|
MoveToWritePhase();
|
|
|
|
#undef MoveToWritePhase
|
|
|
|
|
|
//
|
|
// Specific forms of perform...
|
|
//
|
|
|
|
BeginState(MOVEw):
|
|
switch(instruction_.mode(1)) {
|
|
case Mode::DataRegisterDirect:
|
|
case Mode::AddressRegisterDirect:
|
|
MoveToStateSpecific(MOVEwRegisterDirect);
|
|
|
|
case Mode::AddressRegisterIndirectWithPostincrement:
|
|
MoveToStateSpecific(MOVEwAddressRegisterIndirectWithPostincrement);
|
|
|
|
default: assert(false);
|
|
}
|
|
|
|
BeginState(MOVEwRegisterDirect):
|
|
registers_[instruction_.lreg(1)].w = operand_[1].w;
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(MOVEwAddressRegisterIndirectWithPostincrement):
|
|
// TODO: nw
|
|
assert(false);
|
|
Prefetch() // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// [ABCD/SBCD/SUBX/ADDX] (An)-, (An)-
|
|
//
|
|
BeginState(TwoOp_Predec_bw):
|
|
IdleBus(1); // n
|
|
|
|
SetupDataAccess(Microcycle::Read, select_flag_);
|
|
|
|
SetDataAddress(registers_[8 + instruction_.reg(0)].l);
|
|
registers_[8 + instruction_.reg(0)].l -= address_increments[int(instruction_.operand_size())][instruction_.reg(0)];
|
|
Access(operand_[0].low); // nr
|
|
|
|
SetDataAddress(registers_[8 + instruction_.reg(1)].l);
|
|
registers_[8 + instruction_.reg(1)].l -= address_increments[int(instruction_.operand_size())][instruction_.reg(1)];
|
|
Access(operand_[1].low); // nr
|
|
|
|
Prefetch(); // np
|
|
|
|
PerformDynamic();
|
|
|
|
SetupDataAccess(0, select_flag_);
|
|
Access(operand_[1].low); // nw
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(TwoOp_Predec_l):
|
|
IdleBus(1); // n
|
|
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord);
|
|
|
|
SetDataAddress(registers_[8 + instruction_.reg(0)].l);
|
|
registers_[8 + instruction_.reg(0)].l -= 2;
|
|
Access(operand_[0].low); // nr
|
|
|
|
registers_[8 + instruction_.reg(0)].l -= 2;
|
|
Access(operand_[0].high); // nR
|
|
|
|
SetDataAddress(registers_[8 + instruction_.reg(1)].l);
|
|
registers_[8 + instruction_.reg(1)].l -= 2;
|
|
Access(operand_[1].low); // nr
|
|
|
|
registers_[8 + instruction_.reg(1)].l -= 2;
|
|
Access(operand_[1].high); // nR
|
|
|
|
PerformDynamic();
|
|
|
|
SetupDataAccess(0, Microcycle::SelectWord);
|
|
|
|
registers_[8 + instruction_.reg(1)].l += 2;
|
|
Access(operand_[1].low); // nw
|
|
|
|
Prefetch(); // np
|
|
|
|
registers_[8 + instruction_.reg(1)].l -= 2;
|
|
Access(operand_[1].high); // nW
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// CHK
|
|
//
|
|
BeginState(CHK):
|
|
Prefetch(); // np
|
|
PerformSpecific(CHK);
|
|
|
|
// Proper next state will have been set by the flow controller
|
|
// call-in; just allow dispatch to whatever it was.
|
|
break;
|
|
|
|
BeginState(CHK_no_trap):
|
|
IdleBus(3); // nn n
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(CHK_was_over):
|
|
IdleBus(2); // nn
|
|
instruction_address_.l = program_counter_.l - 4;
|
|
exception_vector_ = InstructionSet::M68k::Exception::CHK;
|
|
MoveToStateSpecific(StandardException);
|
|
|
|
BeginState(CHK_was_under):
|
|
IdleBus(3); // n nn
|
|
instruction_address_.l = program_counter_.l - 4;
|
|
exception_vector_ = InstructionSet::M68k::Exception::CHK;
|
|
MoveToStateSpecific(StandardException);
|
|
|
|
//
|
|
// Scc
|
|
//
|
|
BeginState(Scc_Dn):
|
|
Prefetch(); // np
|
|
PerformSpecific(Scc);
|
|
|
|
// Next state will be set by did_scc.
|
|
break;
|
|
|
|
BeginState(Scc_Dn_did_set):
|
|
IdleBus(1); // n
|
|
[[fallthrough]];
|
|
BeginState(Scc_Dn_did_not_set):
|
|
next_operand_ = 0;
|
|
MoveToStateSpecific(StoreOperand);
|
|
|
|
//
|
|
// DBcc
|
|
//
|
|
BeginState(DBcc):
|
|
operand_[0] = registers_[instruction_.reg(0)];
|
|
operand_[1].w = uint32_t(int16_t(prefetch_.w));
|
|
PerformSpecific(DBcc);
|
|
registers_[instruction_.reg(0)].w = operand_[0].w;
|
|
|
|
// Next state was set by complete_dbcc.
|
|
break;
|
|
|
|
BeginState(DBcc_branch_taken):
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(DBcc_condition_true):
|
|
IdleBus(2); // n n
|
|
Prefetch(); // np
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(DBcc_counter_overflow):
|
|
IdleBus(1); // n
|
|
|
|
// Yacht lists an extra np here; I'm assuming it's a read from where
|
|
// the PC would have gone, had the branch been taken. So do that,
|
|
// but then reset the PC to where it would have been.
|
|
Prefetch(); // np
|
|
|
|
program_counter_.l = instruction_address_.l + 4;
|
|
Prefetch(); // np
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// Bcc [.b and .w]
|
|
//
|
|
BeginState(Bcc_b):
|
|
operand_[0].b = uint8_t(opcode_);
|
|
PerformSpecific(Bccb);
|
|
|
|
// Next state was set by complete_bcc.
|
|
break;
|
|
|
|
BeginState(Bcc_w):
|
|
operand_[0].w = prefetch_.w;
|
|
PerformSpecific(Bccw);
|
|
|
|
// Next state was set by complete_bcc.
|
|
break;
|
|
|
|
BeginState(Bcc_branch_taken):
|
|
IdleBus(1); // n
|
|
Prefetch(); // np
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(Bcc_b_branch_not_taken):
|
|
IdleBus(2); // nn
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(Bcc_w_branch_not_taken):
|
|
IdleBus(2); // nn
|
|
Prefetch(); // np
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
|
|
#define Push(x) \
|
|
SetupDataAccess(0, Microcycle::SelectWord); \
|
|
SetDataAddress(registers_[15].l); \
|
|
registers_[15].l -= 4; \
|
|
Access(x.high); \
|
|
registers_[15].l += 2; \
|
|
Access(x.low); \
|
|
registers_[15].l -= 2;
|
|
|
|
//
|
|
// BSR
|
|
//
|
|
BeginState(BSR):
|
|
IdleBus(1); // n
|
|
|
|
// Calculate the address of the next instruction.
|
|
if(instruction_.operand_size() == InstructionSet::M68k::DataSize::Word) {
|
|
temporary_address_.l = instruction_address_.l + 4;
|
|
} else {
|
|
temporary_address_.l = instruction_address_.l + 2;
|
|
}
|
|
|
|
// Push it to the stack.
|
|
Push(temporary_address_);
|
|
|
|
// Get the new PC.
|
|
PerformDynamic();
|
|
|
|
Prefetch(); // np
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// JSR [push only; address calculation elsewhere], JMP
|
|
//
|
|
BeginState(JSR):
|
|
// Update the program counter and prefetch once.
|
|
program_counter_.l = effective_address_[0].l;
|
|
Prefetch(); // np
|
|
|
|
// Push the old PC onto the stack in upper, lower order.
|
|
Push(temporary_address_);
|
|
|
|
// Prefetch once more.
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(JMP):
|
|
// Update the program counter and prefetch once.
|
|
program_counter_.l = effective_address_[0].l;
|
|
Prefetch(); // np
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// BSET, BCHG, BCLR
|
|
//
|
|
BeginState(BCHG_BSET_Dn):
|
|
PerformDynamic();
|
|
|
|
Prefetch();
|
|
IdleBus(1 + dynamic_instruction_length_);
|
|
registers_[instruction_.reg(1)] = operand_[1];
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(BCLR_Dn):
|
|
PerformSpecific(BCLR);
|
|
|
|
Prefetch();
|
|
IdleBus(2 + dynamic_instruction_length_);
|
|
registers_[instruction_.reg(1)] = operand_[1];
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// MOVEP
|
|
//
|
|
BeginState(MOVEPtoM_l):
|
|
temporary_address_.l = registers_[8 + instruction_.reg(1)].l + uint32_t(int16_t(prefetch_.w));
|
|
SetDataAddress(temporary_address_.l);
|
|
SetupDataAccess(0, Microcycle::SelectByte);
|
|
|
|
Prefetch(); // np
|
|
|
|
temporary_value_.b = uint8_t(registers_[instruction_.reg(0)].l >> 24);
|
|
Access(temporary_value_.low); // nW
|
|
|
|
temporary_address_.l += 2;
|
|
temporary_value_.b = uint8_t(registers_[instruction_.reg(0)].l >> 16);
|
|
Access(temporary_value_.low); // nW
|
|
|
|
temporary_address_.l += 2;
|
|
temporary_value_.b = uint8_t(registers_[instruction_.reg(0)].l >> 8);
|
|
Access(temporary_value_.low); // nw
|
|
|
|
temporary_address_.l += 2;
|
|
temporary_value_.b = uint8_t(registers_[instruction_.reg(0)].l);
|
|
Access(temporary_value_.low); // nw
|
|
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(MOVEPtoM_w):
|
|
temporary_address_.l = registers_[8 + instruction_.reg(1)].l + uint32_t(int16_t(prefetch_.w));
|
|
SetDataAddress(temporary_address_.l);
|
|
SetupDataAccess(0, Microcycle::SelectByte);
|
|
|
|
Prefetch(); // np
|
|
|
|
temporary_value_.b = uint8_t(registers_[instruction_.reg(0)].l >> 8);
|
|
Access(temporary_value_.low); // nW
|
|
|
|
temporary_address_.l += 2;
|
|
temporary_value_.b = uint8_t(registers_[instruction_.reg(0)].l);
|
|
Access(temporary_value_.low); // nw
|
|
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(MOVEPtoR_l):
|
|
temporary_address_.l = registers_[8 + instruction_.reg(0)].l + uint32_t(int16_t(prefetch_.w));
|
|
SetDataAddress(temporary_address_.l);
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectByte);
|
|
|
|
Prefetch(); // np
|
|
|
|
Access(temporary_value_.low); // nR
|
|
registers_[instruction_.reg(1)].l = temporary_value_.b << 24;
|
|
|
|
temporary_address_.l += 2;
|
|
Access(temporary_value_.low); // nR
|
|
registers_[instruction_.reg(1)].w |= temporary_value_.b << 16;
|
|
|
|
temporary_address_.l += 2;
|
|
Access(temporary_value_.low); // nr
|
|
registers_[instruction_.reg(1)].w |= temporary_value_.b << 8;
|
|
|
|
temporary_address_.l += 2;
|
|
Access(temporary_value_.low); // nr
|
|
registers_[instruction_.reg(1)].w |= temporary_value_.b;
|
|
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(MOVEPtoR_w):
|
|
temporary_address_.l = registers_[8 + instruction_.reg(0)].l + uint32_t(int16_t(prefetch_.w));
|
|
SetDataAddress(temporary_address_.l);
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectByte);
|
|
|
|
Prefetch(); // np
|
|
|
|
Access(temporary_value_.low); // nR
|
|
registers_[instruction_.reg(1)].w = temporary_value_.b << 8;
|
|
|
|
temporary_address_.l += 2;
|
|
Access(temporary_value_.low); // nr
|
|
registers_[instruction_.reg(1)].w |= temporary_value_.b;
|
|
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// [EORI/ORI/ANDI] #, [CCR/SR]
|
|
//
|
|
BeginState(LogicalToSR):
|
|
// Perform the operation.
|
|
PerformDynamic();
|
|
|
|
// Recede the program counter and prefetch twice.
|
|
program_counter_.l -= 2;
|
|
Prefetch();
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// MOVEM M --> R
|
|
//
|
|
BeginState(MOVEMtoR):
|
|
post_ea_state_ =
|
|
(instruction_.operation == InstructionSet::M68k::Operation::MOVEMtoRl) ?
|
|
MOVEMtoR_l_read : MOVEMtoR_w_read;
|
|
next_operand_ = 1;
|
|
register_index_ = 0;
|
|
|
|
SetDataAddress(effective_address_[1].l);
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord);
|
|
MoveToStateSpecific(CalcEffectiveAddress);
|
|
|
|
BeginState(MOVEMtoR_w_read):
|
|
// If there's nothing left to read, move on.
|
|
if(!operand_[0].w) {
|
|
MoveToStateSpecific(MOVEMtoR_finish);
|
|
}
|
|
|
|
// Find the next register to read, read it and sign extend it.
|
|
while(!(operand_[0].w & 1)) {
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
}
|
|
Access(registers_[register_index_].low);
|
|
registers_[register_index_].l = uint32_t(int16_t(registers_[register_index_].w));
|
|
effective_address_[1].l += 2;
|
|
|
|
// Drop the bottom bit.
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
MoveToStateSpecific(MOVEMtoR_w_read);
|
|
|
|
BeginState(MOVEMtoR_l_read):
|
|
// If there's nothing left to read, move on.
|
|
if(!operand_[0].w) {
|
|
MoveToStateSpecific(MOVEMtoR_finish);
|
|
}
|
|
|
|
// Find the next register to read, read it.
|
|
while(!(operand_[0].w & 1)) {
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
}
|
|
Access(registers_[register_index_].high);
|
|
effective_address_[1].l += 2;
|
|
Access(registers_[register_index_].low);
|
|
effective_address_[1].l += 2;
|
|
|
|
// Drop the bottom bit.
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
MoveToStateSpecific(MOVEMtoR_l_read);
|
|
|
|
BeginState(MOVEMtoR_finish):
|
|
// Perform one more read, spuriously.
|
|
Access(temporary_value_.low); // nr
|
|
|
|
// Write the address back to the register if
|
|
// this was postincrement mode.
|
|
if(instruction_.mode(1) == Mode::AddressRegisterIndirectWithPostincrement) {
|
|
registers_[8 + instruction_.reg(1)].l = effective_address_[1].l;
|
|
}
|
|
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// MOVEM R --> M
|
|
//
|
|
BeginState(MOVEMtoM):
|
|
next_operand_ = 1;
|
|
SetDataAddress(effective_address_[1].l);
|
|
SetupDataAccess(0, Microcycle::SelectWord);
|
|
|
|
// Predecrement writes registers the other way around, but still reads the
|
|
// mask from LSB.
|
|
if(instruction_.mode(1) == Mode::AddressRegisterIndirectWithPredecrement) {
|
|
register_index_ = 15;
|
|
effective_address_[1].l = registers_[8 + instruction_.reg(1)].l;
|
|
|
|
// Don't go through the usual calculate EA path because: (i) the test above
|
|
// has already told us the addressing mode, and it's trivial; and (ii) the
|
|
// predecrement isn't actually wanted.
|
|
if(instruction_.operation == InstructionSet::M68k::Operation::MOVEMtoMl) {
|
|
MoveToStateSpecific(MOVEMtoM_l_write_predec);
|
|
} else {
|
|
MoveToStateSpecific(MOVEMtoM_w_write_predec);
|
|
}
|
|
}
|
|
|
|
register_index_ = 0;
|
|
post_ea_state_ =
|
|
(instruction_.operation == InstructionSet::M68k::Operation::MOVEMtoMl) ?
|
|
MOVEMtoM_l_write : MOVEMtoM_w_write;
|
|
MoveToStateSpecific(CalcEffectiveAddress);
|
|
|
|
BeginState(MOVEMtoM_w_write):
|
|
// If there's nothing left to read, move on.
|
|
if(!operand_[0].w) {
|
|
MoveToStateSpecific(MOVEMtoM_finish);
|
|
}
|
|
|
|
// Find the next register to write, write it.
|
|
while(!(operand_[0].w & 1)) {
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
}
|
|
Access(registers_[register_index_].low);
|
|
effective_address_[1].l += 2;
|
|
|
|
// Drop the bottom bit.
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
MoveToStateSpecific(MOVEMtoM_w_write);
|
|
|
|
BeginState(MOVEMtoM_l_write):
|
|
// If there's nothing left to read, move on.
|
|
if(!operand_[0].w) {
|
|
MoveToStateSpecific(MOVEMtoM_finish);
|
|
}
|
|
|
|
// Find the next register to write, write it.
|
|
while(!(operand_[0].w & 1)) {
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
}
|
|
|
|
Access(registers_[register_index_].high);
|
|
effective_address_[1].l += 2;
|
|
Access(registers_[register_index_].low);
|
|
effective_address_[1].l += 2;
|
|
|
|
// Drop the bottom bit.
|
|
operand_[0].w >>= 1;
|
|
++register_index_;
|
|
MoveToStateSpecific(MOVEMtoM_l_write);
|
|
|
|
BeginState(MOVEMtoM_w_write_predec):
|
|
// If there's nothing left to read, move on.
|
|
if(!operand_[0].w) {
|
|
MoveToStateSpecific(MOVEMtoM_finish);
|
|
}
|
|
|
|
// Find the next register to write, write it.
|
|
while(!(operand_[0].w & 1)) {
|
|
operand_[0].w >>= 1;
|
|
--register_index_;
|
|
}
|
|
effective_address_[1].l -= 2;
|
|
Access(registers_[register_index_].low);
|
|
|
|
// Drop the bottom bit.
|
|
operand_[0].w >>= 1;
|
|
--register_index_;
|
|
MoveToStateSpecific(MOVEMtoM_w_write_predec);
|
|
|
|
BeginState(MOVEMtoM_l_write_predec):
|
|
// If there's nothing left to read, move on.
|
|
if(!operand_[0].w) {
|
|
MoveToStateSpecific(MOVEMtoM_finish);
|
|
}
|
|
|
|
// Find the next register to write, write it.
|
|
while(!(operand_[0].w & 1)) {
|
|
operand_[0].w >>= 1;
|
|
--register_index_;
|
|
}
|
|
|
|
effective_address_[1].l -= 2;
|
|
Access(registers_[register_index_].low);
|
|
effective_address_[1].l -= 2;
|
|
Access(registers_[register_index_].high);
|
|
|
|
// Drop the bottom bit.
|
|
operand_[0].w >>= 1;
|
|
--register_index_;
|
|
MoveToStateSpecific(MOVEMtoM_l_write_predec);
|
|
|
|
BeginState(MOVEMtoM_finish):
|
|
// Write the address back to the register if
|
|
// this was predecrement mode.
|
|
if(instruction_.mode(1) == Mode::AddressRegisterIndirectWithPredecrement) {
|
|
registers_[8 + instruction_.reg(1)].l = effective_address_[1].l;
|
|
}
|
|
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// DIVU and DIVUS
|
|
//
|
|
BeginState(DIVU_DIVS):
|
|
// Set a no-interrupt-occurred sentinel.
|
|
exception_vector_ = -1;
|
|
|
|
// Perform the instruction.
|
|
PerformDynamic();
|
|
|
|
// Delay the correct amount of time.
|
|
IdleBus(dynamic_instruction_length_);
|
|
|
|
// Either dispatch an exception or don't.
|
|
if(exception_vector_ >= 0) {
|
|
MoveToStateSpecific(StandardException);
|
|
}
|
|
|
|
// DIVU and DIVS are always to a register, so just write back here
|
|
// to save on dispatch costs.
|
|
registers_[instruction_.reg(1)] = operand_[1];
|
|
|
|
Prefetch(); // np
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// MULU and MULS
|
|
//
|
|
BeginState(MULU_MULS):
|
|
Prefetch(); // np
|
|
|
|
// Perform the instruction.
|
|
PerformDynamic();
|
|
|
|
// Delay the correct amount of time.
|
|
IdleBus(dynamic_instruction_length_);
|
|
|
|
// MULU and MULS are always to a register, so just write back here
|
|
// to save on dispatch costs.
|
|
registers_[instruction_.reg(1)] = operand_[1];
|
|
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// LEA
|
|
//
|
|
BeginState(LEA):
|
|
registers_[8 + instruction_.reg(1)].l = effective_address_[0].l;
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// PEA
|
|
//
|
|
BeginState(PEA):
|
|
Push(effective_address_[0]);
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// TAS
|
|
//
|
|
BeginState(TAS):
|
|
// Populate all addresses.
|
|
tas_cycles[0].address = tas_cycles[1].address =
|
|
tas_cycles[2].address =
|
|
tas_cycles[3].address = tas_cycles[4].address = &effective_address_[0].l;
|
|
|
|
// Populate values to the relevant subset.
|
|
tas_cycles[0].value = tas_cycles[1].value =
|
|
tas_cycles[3].value = tas_cycles[4].value = &operand_[0].low;
|
|
|
|
// First two parts: the read.
|
|
PerformBusOperation(tas_cycles[0]);
|
|
PerformBusOperation(tas_cycles[1]);
|
|
|
|
// Third part: processing time.
|
|
PerformBusOperation(tas_cycles[2]);
|
|
|
|
// Do the actual TAS operation.
|
|
status_.overflow_flag = status_.carry_flag = 0;
|
|
status_.zero_result = operand_[0].b;
|
|
status_.negative_flag = operand_[0].b & 0x80;
|
|
|
|
// Final parts: write back.
|
|
operand_[0].b |= 0x80;
|
|
PerformBusOperation(tas_cycles[3]);
|
|
PerformBusOperation(tas_cycles[4]);
|
|
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// MOVE to [CCR/SR]
|
|
//
|
|
BeginState(MOVEtoCCRSR):
|
|
PerformDynamic();
|
|
|
|
// Rewind the program counter and prefetch twice.
|
|
IdleBus(2);
|
|
program_counter_.l -= 2;
|
|
Prefetch();
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// RTR, RTS, RTE
|
|
//
|
|
BeginState(RTS):
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord);
|
|
SetDataAddress(registers_[15].l);
|
|
|
|
Access(program_counter_.high);
|
|
registers_[15].l += 2;
|
|
Access(program_counter_.low);
|
|
registers_[15].l += 2;
|
|
|
|
Prefetch();
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(RTE):
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord);
|
|
SetDataAddress(registers_[15].l);
|
|
|
|
Access(program_counter_.high);
|
|
registers_[15].l += 2;
|
|
Access(program_counter_.low);
|
|
registers_[15].l += 2;
|
|
|
|
Access(temporary_value_.low);
|
|
registers_[15].l += 2;
|
|
status_.set_status(temporary_value_.w);
|
|
|
|
Prefetch();
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
BeginState(RTR):
|
|
SetupDataAccess(Microcycle::Read, Microcycle::SelectWord);
|
|
SetDataAddress(registers_[15].l);
|
|
|
|
registers_[15].l += 2;
|
|
Access(program_counter_.high);
|
|
registers_[15].l += 2;
|
|
Access(program_counter_.low);
|
|
|
|
registers_[15].l -= 4;
|
|
Access(temporary_value_.low);
|
|
registers_[15].l += 6;
|
|
status_.set_ccr(temporary_value_.w);
|
|
|
|
Prefetch();
|
|
Prefetch();
|
|
MoveToStateSpecific(Decode);
|
|
|
|
//
|
|
// Various states TODO.
|
|
//
|
|
#define TODOState(x) \
|
|
BeginState(x): [[fallthrough]];
|
|
|
|
TODOState(BusOrAddressErrorException);
|
|
|
|
#undef TODOState
|
|
|
|
default:
|
|
printf("Unhandled state: %d; opcode is %04x\n", state_, opcode_);
|
|
assert(false);
|
|
}}
|
|
|
|
#undef Push
|
|
#undef PerformDynamic
|
|
#undef PerformSpecific
|
|
#undef Prefetch
|
|
#undef ReadProgramWord
|
|
#undef ReadDataWord
|
|
#undef AccessPair
|
|
#undef CompleteAccess
|
|
#undef WaitForDTACK
|
|
#undef IdleBus
|
|
#undef PerformBusOperation
|
|
#undef MoveToStateSpecific
|
|
#undef MoveToStateDynamic
|
|
#undef CheckOverrun
|
|
#undef Spend
|
|
#undef ConsiderExit
|
|
|
|
}
|
|
|
|
// MARK: - Flow Controller.
|
|
|
|
void ProcessorBase::did_update_status() {
|
|
// Shuffle the stack pointers.
|
|
stack_pointers_[is_supervisor_] = registers_[15];
|
|
registers_[15] = stack_pointers_[int(status_.is_supervisor)];
|
|
is_supervisor_ = int(status_.is_supervisor);
|
|
}
|
|
|
|
void ProcessorBase::did_chk(bool was_under, bool was_over) {
|
|
if(was_over) {
|
|
state_ = CHK_was_over;
|
|
} else if(was_under) {
|
|
state_ = CHK_was_under;
|
|
} else {
|
|
state_ = CHK_no_trap;
|
|
}
|
|
}
|
|
|
|
void ProcessorBase::did_scc(bool did_set_ff) {
|
|
state_ = did_set_ff ? Scc_Dn_did_set : Scc_Dn_did_not_set;
|
|
}
|
|
|
|
void ProcessorBase::complete_dbcc(bool matched_condition, bool overflowed, int16_t offset) {
|
|
// The actual DBcc rule is: branch if !matched_condition and !overflowed; but I think
|
|
// that a spurious read from the intended destination PC occurs if overflowed, so update
|
|
// the PC for any case of !matched_condition and rely on the DBcc_counter_overflow to
|
|
// set it back.
|
|
if(!matched_condition) {
|
|
state_ = overflowed ? DBcc_counter_overflow : DBcc_branch_taken;
|
|
program_counter_.l = instruction_address_.l + uint32_t(offset) + 2;
|
|
return;
|
|
}
|
|
state_ = DBcc_condition_true;
|
|
}
|
|
|
|
template <typename IntT> void ProcessorBase::complete_bcc(bool take_branch, IntT offset) {
|
|
if(take_branch) {
|
|
program_counter_.l = instruction_address_.l + uint32_t(offset) + 2;
|
|
state_ = Bcc_branch_taken;
|
|
return;
|
|
}
|
|
|
|
state_ =
|
|
(instruction_.operation == InstructionSet::M68k::Operation::Bccb) ?
|
|
Bcc_b_branch_not_taken : Bcc_w_branch_not_taken;
|
|
}
|
|
|
|
void ProcessorBase::bsr(uint32_t offset) {
|
|
program_counter_.l = instruction_address_.l + offset + 2;
|
|
}
|
|
|
|
void ProcessorBase::did_bit_op(int bit_position) {
|
|
dynamic_instruction_length_ = int(bit_position > 15);
|
|
}
|
|
|
|
template <bool did_overflow> void ProcessorBase::did_divu(uint32_t, uint32_t) {
|
|
// TODO: calculate cost.
|
|
}
|
|
|
|
template <bool did_overflow> void ProcessorBase::did_divs(int32_t, int32_t) {
|
|
// TODO: calculate cost.
|
|
}
|
|
|
|
template <typename IntT> void ProcessorBase::did_mulu(IntT) {
|
|
// TODO: calculate cost.
|
|
}
|
|
|
|
template <typename IntT> void ProcessorBase::did_muls(IntT) {
|
|
// TODO: calculate cost.
|
|
}
|
|
|
|
template <bool use_current_instruction_pc> void ProcessorBase::raise_exception(int vector) {
|
|
// No overt action is taken here; instructions that might throw an exception are required
|
|
// to check-in after the fact.
|
|
//
|
|
// As implemented above, that means:
|
|
//
|
|
// * DIVU;
|
|
// * DIVS.
|
|
exception_vector_ = vector;
|
|
}
|
|
|
|
inline void ProcessorBase::tas(Preinstruction instruction, uint32_t) {
|
|
// This will be reached only if addressing mode is Dn.
|
|
const uint8_t value = registers_[instruction.reg(0)].b;
|
|
registers_[instruction.reg(0)].b |= 0x80;
|
|
|
|
status_.overflow_flag = status_.carry_flag = 0;
|
|
status_.zero_result = value;
|
|
status_.negative_flag = value & 0x80;
|
|
}
|
|
|
|
// MARK: - External state.
|
|
|
|
template <class BusHandler, bool dtack_is_implicit, bool permit_overrun, bool signal_will_perform>
|
|
CPU::MC68000Mk2::State Processor<BusHandler, dtack_is_implicit, permit_overrun, signal_will_perform>::get_state() {
|
|
CPU::MC68000Mk2::State state;
|
|
|
|
// This isn't true, but will ensure that both stack_pointers_ have their proper values.
|
|
did_update_status();
|
|
|
|
for(int c = 0; c < 7; c++) {
|
|
state.registers.data[c] = registers_[c].l;
|
|
state.registers.address[c] = registers_[c + 8].l;
|
|
}
|
|
state.registers.data[7] = registers_[7].l;
|
|
|
|
state.registers.program_counter = program_counter_.l;
|
|
state.registers.status = status_.status();
|
|
state.registers.user_stack_pointer = stack_pointers_[0].l;
|
|
state.registers.supervisor_stack_pointer = stack_pointers_[1].l;
|
|
|
|
return state;
|
|
}
|
|
|
|
template <class BusHandler, bool dtack_is_implicit, bool permit_overrun, bool signal_will_perform>
|
|
void Processor<BusHandler, dtack_is_implicit, permit_overrun, signal_will_perform>::set_state(const CPU::MC68000Mk2::State &state) {
|
|
// Copy registers and the program counter.
|
|
for(int c = 0; c < 7; c++) {
|
|
registers_[c].l = state.registers.data[c];
|
|
registers_[c + 8].l = state.registers.address[c];
|
|
}
|
|
registers_[7].l = state.registers.data[7];
|
|
program_counter_.l = state.registers.program_counter;
|
|
|
|
// Set status first in order to get the proper is-supervisor flag in place.
|
|
status_.set_status(state.registers.status);
|
|
|
|
// Update stack pointers, being careful to copy the right one.
|
|
stack_pointers_[0].l = state.registers.user_stack_pointer;
|
|
stack_pointers_[1].l = state.registers.supervisor_stack_pointer;
|
|
registers_[15] = stack_pointers_[is_supervisor_];
|
|
|
|
// Ensure the local is-supervisor flag is updated.
|
|
did_update_status();
|
|
}
|
|
|
|
|
|
}
|
|
}
|
|
|
|
#endif /* _8000Mk2Implementation_h */
|