ShuriZma
/
BizHawk
mirror of https://github.com/TASEmulators/BizHawk.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
BizHawk/waterbox/ss/sh7095.inc

6737 lines
116 KiB
C++
Raw Blame History

/******************************************************************************/
/* Mednafen Sega Saturn Emulation Module */
/******************************************************************************/
/* sh7095.inc - Hitachi SH7095 Emulation
** Copyright (C) 2015-2017 Mednafen Team
**
** This program is free software; you can redistribute it and/or
** modify it under the terms of the GNU General Public License
** as published by the Free Software Foundation; either version 2
** of the License, or (at your option) any later version.
**
** This program is distributed in the hope that it will be useful,
** but WITHOUT ANY WARRANTY; without even the implied warranty of
** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
** GNU General Public License for more details.
**
** You should have received a copy of the GNU General Public License
** along with this program; if not, write to the Free Software Foundation, Inc.,
** 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
*/
/*
Emulation implementation notes/deficiencies:
Overall timing is extremely approximate.
DMA timing is very rough. DMA burst mode probably isn't handled totally correctly, especially in
relation to the other CPU and the SCU(is DMA burst mode even legal on the Saturn?).
Misaligned memory accesses(that cause address errors) aren't emulated correctly(for
future reference, there's a difference between how cache versus external bus is accessed
for misaligned addresses, and perhaps a difference between 32-bit and 16-bit spaces as
defined by the BSC too; and then there's misaligned OPM register access semantics...).
Address errors occur one instruction too soon.
SLEEP instruction, standby mode, and DMA burst stalls are handled by thoroughly (ab)using the
IF/ID pipeline emulation and opcode dispatch mechanism.
Individual module clocking disabling functionality of SBYCR isn't handled.
Interrupts are typically delayed by one instruction, but when the interrupt is handled,
the current interrupt state is used instead of the previous interrupt state.
This can result in the exception-handling pseudo-op code being called when there's
no "current" exception to process, which is a quasi-error condition; there's code to log
this condition and recover from it. An SH-2 code sequence that can cause this condition
if there's currently a pending/unacked interrupt:
<interrupt-enabling instruction>
<interrupt-acknowledging instruction>
This cooouuuld turn out to be a problem, and if it does, it can be fixed by having two interrupt-pending variables,
with one being copied to the other in DoIDIF().
Instruction fetches don't go through the cache emulation, for performance reasons(getting the instruction fetches timed right
versus the instruction data read/write would be critical, to avoid causing inaccurate cache miss patterns which could cause code
to run slower than on the real thing, which is arguably worse than having it run faster).
SCI, UBC, and BSC are mostly unemulated.
*/
// Address error exception order, sleep versus exceptions.
/*
TODO: PC-relative addressing, uses instruction or data fetches?
*/
/*
TODO: Make sure RecalcPendingIntPEX() is called in all places it needs to be called(which is arguably too many...).
*/
/*
TODO: Penalize slave CPU external bus access if we ever figure out a solution to the timestamp vs mem_timestamp problem that doesn't murder
performance.
*/
// Shouldn't enable instruction cache emulation until we resolve timestamp vs mem_timestamp issues
// in regards to bus contention and time sharing, or else emulated dual-CPU programs will run slower
// than they should and probably glitch out(and also until 5GHz desktop CPUs are the norm ;)).
//#define SH7095_EMULATE_ICACHE
#ifdef MSB_FIRST
#define NE32ASU8_IDX_ADJ(T, idx) (idx)
#else
#define NE32ASU8_IDX_ADJ(T, idx) ( ((idx) & ~(sizeof(T) - 1)) ^ (4 - (sizeof(T))) )
#endif
SH7095::SH7095(const char* const name_arg, const unsigned event_id_dma_arg, uint8 (*exivecfn_arg)(void)) : event_id_dma(event_id_dma_arg), cpu_name(name_arg), ExIVecFetch(exivecfn_arg)
{
Init();
}
template<unsigned which, typename T, unsigned region, bool CacheEnabled, bool TwoWayMode, bool IsInstr>
static NO_INLINE MDFN_FASTCALL T C_MemReadRT(uint32 A);
template<unsigned which, typename T, unsigned region, bool CacheEnabled>
static NO_INLINE MDFN_FASTCALL void C_MemWriteRT(uint32 A, T V);
void SH7095::Init(void)
{
#define MAHL_P(w, region) { \
MRFP8[region] = C_MemReadRT<w, uint8, region, false, false, false>; \
MRFP16[region] = C_MemReadRT<w, uint16, region, false, false, false>; \
MRFP32[region] = C_MemReadRT<w, uint32, region, false, false, false>; \
MRFPI[region] = C_MemReadRT<w, uint32, region, false, false, true>; \
MWFP8[region] = C_MemWriteRT<w, uint8, region, false>; \
MWFP16[region] = C_MemWriteRT<w, uint16, region, false>; \
MWFP32[region] = C_MemWriteRT<w, uint32, region, false>; \
}
#define MAHL(region) \
if(this == &CPU[0]) \
{ MAHL_P(0, region) } \
else \
{ MAHL_P(1, region) }
MAHL(1)
MAHL(2)
MAHL(3)
MAHL(4)
MAHL(5)
MAHL(6)
MAHL(7)
#undef MAHL
#undef MAHL_P
//
//
//
//
// Initialize variables that won't be initialized elsewhere since they reflect the overall emulator timing state, or are cache variables
// for signal inputs.
//
timestamp = 0;
write_finish_timestamp = 0;
divide_finish_timestamp = 0;
FRT.lastts = 0;
dma_lastts = 0;
FRT.FTI = false;
FRT.FTCI = false;
IRL = 0;
NMILevel = false;
BCR1 &= 0x7FFF; //MD5Level = false;
ExtHalt = false;
TruePowerOn();
}
SH7095::~SH7095()
{
}
void SH7095::AdjustTS(int32 delta, bool force_set)
{
if(force_set)
{
timestamp = delta;
MA_until = delta;
MM_until = delta;
#if 0
for(unsigned i = 0; i < 16; i++)
WB_until[i] = delta;
#endif
write_finish_timestamp = delta;
divide_finish_timestamp = delta;
FRT.lastts = delta;
dma_lastts = delta;
}
else
{
if(!(timestamp & 0x40000000))
timestamp += delta;
if(!(MA_until & 0x40000000))
MA_until += delta;
if(!(MM_until & 0x40000000))
MM_until += delta;
#if 0
for(unsigned i = 0; i < 16; i++)
{
if(!(WB_until[i] & 0x40000000))
WB_until[i] += delta;
}
#endif
if(!(write_finish_timestamp & 0x40000000))
write_finish_timestamp += delta;
if(!(divide_finish_timestamp & 0x40000000))
divide_finish_timestamp += delta;
FRT.lastts += delta;
dma_lastts += delta;
}
FRT_WDT_ClockDivider &= 0x00FFFFFF;
FRT_WDT_Recalc_NET();
}
//
// Initialize everything for determinism, especially state left "undefined" by reset/power exception handling.
//
void SH7095::TruePowerOn(void)
{
for(unsigned i = 0; i < 16; i++)
R[i] = 0;
#if 0
for(unsigned i = 0; i < 16; i++)
WB_until[i] = 0;
#endif
PC = 0;
SR = 0;
GBR = 0;
VBR = 0;
MACH = 0;
MACL = 0;
PR = 0;
EPending = 0;
Pipe_ID = 0;
Pipe_IF = 0;
PC_IF = PC_ID = 0;
memset(Cache, 0, sizeof(Cache));
CCR = 0;
MA_until = 0;
MM_until = 0;
//
//
//
IPRA = 0;
IPRB = 0;
VCRWDT = 0;
VCRA = 0;
VCRB = 0;
VCRC = 0;
VCRD = 0;
ICR = 0;
//
//
//
FRT.FRC = 0;
FRT.OCR[0] = FRT.OCR[1] = 0;
FRT.FICR = 0;
FRT.TIER = 0;
FRT.FTCSR = 0;
FRT.FTCSRM = 0;
FRT.TCR = 0;
FRT.TOCR = 0;
FRT.RW_Temp = 0;
FRT_WDT_ClockDivider = 0;
WDT.WTCSR = 0;
WDT.WTCSRM = 0;
WDT.WTCNT = 0;
WDT.RSTCSR = 0;
WDT.RSTCSRM = 0;
FRT_WDT_Recalc_NET();
//
//
//
DMA_ClockCounter = 0;
DMA_SGCounter = 0;
DMA_RoundRobinRockinBoppin = 0;
memset(DMACH, 0, sizeof(DMACH));
DMAOR = 0;
DMAORM = 0;
//
//
//
DVSR = 0;
DVDNT = 0;
DVDNTH = 0;
DVDNTL = 0;
DVDNTH_Shadow = 0;
DVDNTL_Shadow = 0;
VCRDIV = 0;
DVCR = 0;
//
//
//
}
// de=1, dme=1, te=0, nmif=0, ae=0
INLINE bool SH7095::DMA_RunCond(unsigned ch)
{
return ((DMAOR & 0x07) == 0x01) && ((DMACH[ch].CHCR & 0x03) == 0x01);
}
bool SH7095::DMA_InBurst(void)
{
if((DMAOR & 0x08) && DMA_RunCond(0) && DMA_RunCond(1))
return ((DMACH[0].CHCR | DMACH[1].CHCR) & 0x10);
if(DMA_RunCond(0))
return (DMACH[0].CHCR & 0x10);
else if(DMA_RunCond(1))
return (DMACH[1].CHCR & 0x10);
return false;
}
void SH7095::DMA_CheckEnterBurstHack(void)
{
if(DMA_InBurst())
SetPEX(PEX_PSEUDO_DMABURST);
}
// RecalcPendingIntPEX() will be called higher up, at the end of DMA_Update()
//
// Call SH7095_Bus* directly instead of through ExtBusRead, at least until we can work
// out all this disparate timestamp nonsense properly(maybe around the time we add proper bus controller emulation? ;)).
//
INLINE void SH7095::DMA_DoTransfer(unsigned ch)
{
static const int8 ainc[3][4] =
{
{ 0, 1, -1, -1 },
{ 0, 2, -2, -2 },
{ 0, 4, -4, -4 },
};
const unsigned ts = (DMACH[ch].CHCR >> 10) & 3;
const unsigned sm = (DMACH[ch].CHCR >> 12) & 3;
const unsigned dm = (DMACH[ch].CHCR >> 14) & 3;
uint32 sar = DMACH[ch].SAR;
uint32 dar = DMACH[ch].DAR;
uint32 tcr = DMACH[ch].TCR;
switch(ts)
{
case 0x00: // 8-bit
{
uint8 buffer;
buffer = SH7095_BusRead<uint8>(sar & 0x07FFFFFF, false, &DMA_ClockCounter);
SH7095_BusWrite<uint8>(dar & 0x07FFFFFF, buffer, false, &DMA_ClockCounter);
sar += ainc[0][sm];
dar += ainc[0][dm];
tcr = (tcr - 1) & 0xFFFFFF;
}
break;
case 0x01: // 16-bit
{
uint16 buffer;
buffer = SH7095_BusRead<uint16>(sar & 0x07FFFFFE, false, &DMA_ClockCounter);
SH7095_BusWrite<uint16>(dar & 0x07FFFFFE, buffer, false, &DMA_ClockCounter);
if(MDFN_UNLIKELY((sar | dar) & 0x1))
{
DMAOR |= 4;
DMAORM |= 4;
SetPEX(PEX_DMAADDR);
}
sar += ainc[1][sm];
dar += ainc[1][dm];
tcr = (tcr - 1) & 0xFFFFFF;
}
break;
case 0x02: // 32-bit
{
uint32 buffer;
buffer = SH7095_BusRead<uint32>(sar & 0x07FFFFFC, false, &DMA_ClockCounter);
SH7095_BusWrite<uint32>(dar & 0x07FFFFFC, buffer, false, &DMA_ClockCounter);
if(MDFN_UNLIKELY((sar | dar) & 0x3))
{
DMAOR |= 4;
DMAORM |= 4;
SetPEX(PEX_DMAADDR);
}
sar += ainc[2][sm];
dar += ainc[2][dm];
tcr = (tcr - 1) & 0xFFFFFF;
}
break;
case 0x03: // 4 * 32-bit, a mess...
{
uint32 buffer[4];
if(MDFN_UNLIKELY((sar | dar) & 0x3))
{
DMAOR |= 4;
DMAORM |= 4;
SetPEX(PEX_DMAADDR);
}
for(unsigned i = 0; i < 4; i++)
{
buffer[i] = SH7095_BusRead<uint32>((sar + (i << 2)) & 0x07FFFFFC, (bool)i, &DMA_ClockCounter);
}
sar += 0x10;
for(unsigned i = 0; i < 4; i++)
{
SH7095_BusWrite<uint32>(dar & 0x07FFFFFC, buffer[i], false, &DMA_ClockCounter);
dar += ainc[2][dm];
tcr = (tcr - 1) & 0xFFFFFF;
if(MDFN_UNLIKELY(!tcr))
break;
}
}
break;
}
if(!tcr)
{
SS_DBGTI(SS_DBG_SH2, "[%s] DMA %d finished.", cpu_name, ch);
DMACH[ch].CHCR |= 2;
DMACH[ch].CHCRM |= 2;
}
DMACH[ch].SAR = sar;
DMACH[ch].DAR = dar;
DMACH[ch].TCR = tcr;
}
sscpu_timestamp_t SH7095::DMA_Update(sscpu_timestamp_t et)
{
if(MDFN_UNLIKELY(et < dma_lastts))
{
// et < dma_lastts may happen...look into it.
if(et < dma_lastts)
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] DMA_Update called with et(%u) < dma_lastts(%u).\n", cpu_name, et, dma_lastts);
}
else if(MDFN_UNLIKELY(ExtHalt))
{
dma_lastts = et;
return dma_lastts + 128;
}
else
{
uint32 clocks = et - dma_lastts;
dma_lastts = et;
//
//
//
bool rr = DMA_RoundRobinRockinBoppin;
DMA_ClockCounter += clocks;
DMA_SGCounter += clocks;
if(DMAOR & 0x08) // Round robin
{
while(DMA_RunCond(0) || DMA_RunCond(1))
{
if(DMA_RunCond(rr))
{
if(DMA_ClockCounter <= 0)
goto TimeOver;
DMA_DoTransfer(rr);
}
rr = !rr;
}
}
else // ch 0 > ch1
{
while(DMA_RunCond(0))
{
if(DMA_ClockCounter <= 0)
goto TimeOver;
DMA_DoTransfer(0);
}
while(DMA_RunCond(1))
{
if(DMA_ClockCounter <= 0)
goto TimeOver;
DMA_DoTransfer(1);
}
}
//
//
//
TimeOver:;
DMA_RoundRobinRockinBoppin = rr;
DMA_ClockCounter = std::min<int32>(DMA_ClockCounter, 128);
DMA_SGCounter = std::min<int32>(DMA_SGCounter, 0);
DMA_CheckEnterBurstHack();
RecalcPendingIntPEX(); // TODO: conditionalize(or make RecalcPendingIntPEX() less expensive).
}
return dma_lastts + ((DMA_SGCounter < 0) ? 32 : 128);
}
// DMA_StartSG() must be paired with a DMA_Update(SH7095_mem_timestamp) somewhere before.
void SH7095::DMA_StartSG(void)
{
DMA_SGCounter = DMA_ClockCounter - 128;
SS_SetEventNT(&events[event_id_dma], SH7095_mem_timestamp + 32); // fixed + 32, don't evaluate DMA_SGCounter here.
DMA_CheckEnterBurstHack();
}
//
//
//
void NO_INLINE SH7095::FRT_Reset(void)
{
FRT.FRC = 0x00;
FRT.OCR[0] = FRT.OCR[1] = 0x00;
FRT.FICR = 0x00;
FRT.TIER = 0x00;
FRT.FTCSR = 0x00;
FRT.FTCSRM = 0x00;
FRT.TCR = 0x00;
FRT.TOCR = 0x00;
FRT.RW_Temp = 0x00; // Reset or not?
FRT_WDT_Recalc_NET();
RecalcPendingIntPEX();
}
INLINE void SH7095::FRT_CheckOCR(void)
{
if(FRT.FRC == FRT.OCR[0]) // OCRA
{
if(FRT.FTCSR & 0x0001)
FRT.FRC = 0;
if(!(FRT.FTCSR & 0x08))
{
FRT.FTCSR |= 0x08;
FRT.FTCSRM |= 0x08;
RecalcPendingIntPEX();
}
}
if(FRT.FRC == FRT.OCR[1]) // OCRB
{
if(!(FRT.FTCSR & 0x04))
{
FRT.FTCSR |= 0x04;
FRT.FTCSRM |= 0x04;
RecalcPendingIntPEX();
}
}
}
INLINE void SH7095::FRT_ClockFRC(void)
{
FRT.FRC++;
if(!FRT.FRC)
{
if(!(FRT.FTCSR & 0x02))
{
FRT.FTCSR |= 0x02; // OVF
FRT.FTCSRM |= 0x02;
RecalcPendingIntPEX();
}
}
//
//
//
FRT_CheckOCR();
}
static const uint8 wdt_cstab[8] = { 1, /**/ 6, 7, 8, 9, 10, /**/ 12, 13 };
//
// Call after:
// WDT.WTCSR, WDT.WTCNT, FRT.TCR, FRT.OCR[0], FRT.OCR[1] changes due to register write or similar.
// timestamp >= FRT_WDT_NextTS (after call to FRT_WDT_Update())
//
void SH7095::FRT_WDT_Recalc_NET(void)
{
int32 rt = 1000;
if((FRT.TCR & 0x3) != 0x3) // when == 3, count on rising edge of external clock(not handled here).
{
const uint32 frt_clockshift = 3 + ((FRT.TCR & 0x3) << 1); // /8, /32, /128, count at falling edge
int32 next_frc = 0x10000;
if(FRT.OCR[0] > FRT.FRC)
next_frc = FRT.OCR[0];
if(FRT.OCR[1] > FRT.FRC)
next_frc = FRT.OCR[1];
rt = ((next_frc - FRT.FRC) << frt_clockshift) - (FRT_WDT_ClockDivider & ((1 << frt_clockshift) - 1));
}
if(WDT.WTCSR & 0x28) // TME(0x20) and internal use standby NMI recover bit(0x08)
{
const unsigned wdt_clockshift = wdt_cstab[WDT.WTCSR & 0x7];
int32 wdt_rt;
wdt_rt = ((0x100 - WDT.WTCNT) << wdt_clockshift) - (FRT_WDT_ClockDivider & ((1 << wdt_clockshift) - 1));
rt = std::min<int32>(rt, wdt_rt);
}
assert(rt > 0);
FRT_WDT_NextTS = timestamp + rt;
}
void SH7095::FRT_WDT_Update(void)
{
assert(timestamp >= FRT.lastts);
uint32 clocks = timestamp - FRT.lastts;
//if(clocks >= 1000)
// printf("%u, %d %d\n", clocks, timestamp, FRT.lastts);
//assert(clocks < 1000);
FRT.lastts = timestamp;
//
//
//
const uint32 PreAddCD = FRT_WDT_ClockDivider;
FRT_WDT_ClockDivider += clocks;
if((FRT.TCR & 0x3) != 0x3) // when == 3, count on rising edge of external clock(not handled here).
{
const uint32 frt_clockshift = 3 + ((FRT.TCR & 0x3) << 1); // /8, /32, /128, count at falling edge
uint32 divided_clocks = (FRT_WDT_ClockDivider >> frt_clockshift) - (PreAddCD >> frt_clockshift);
while(divided_clocks-- > 0)
{
FRT_ClockFRC();
}
}
// WDT:
if(WDT.WTCSR & 0x28) // TME(0x20) and internal use standby NMI recover bit(0x08)
{
const unsigned wdt_clockshift = wdt_cstab[WDT.WTCSR & 0x7];
uint32 divided_clocks = (FRT_WDT_ClockDivider >> wdt_clockshift) - (PreAddCD >> wdt_clockshift);
uint32 tmp_counter = WDT.WTCNT;
tmp_counter += divided_clocks;
WDT.WTCNT = tmp_counter;
//
//
if(MDFN_UNLIKELY(tmp_counter >= 0x100))
{
if(MDFN_UNLIKELY(WDT.WTCSR & 0x08))
{
Standby = false;
WDT.WTCNT = 0x00;
WDT.WTCSR &= ~0x08;
}
else if(MDFN_UNLIKELY(WDT.WTCSR & 0x40)) // Watchdog timer mode
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] WDT overflow in WDT mode!\n", cpu_name);
WDT.RSTCSR |= 0x80;
WDT.WTCNT = 0;
WDT.WTCSR = 0;
if(WDT.RSTCSR & 0x40) // RSTE
Reset(!(WDT.RSTCSR & 0x20), true);
}
else
{
if(!(WDT.WTCSR & 0x80))
{
WDT.WTCSR |= 0x80;
WDT.WTCSRM |= 0x80;
RecalcPendingIntPEX();
}
}
}
}
}
void SH7095::SetFTI(bool state)
{
FRT_WDT_Update();
//
//
bool prev = FRT.FTI;
FRT.FTI = state;
if((prev ^ state) & (prev ^ (FRT.TCR >> 7)))
{
SS_DBGTI(SS_DBG_SH2, "[%s] FTI input capture triggered.", cpu_name);
if((FRT.FTCSR & 0x80) || (FRT.FTCSRM & 0x80))
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] FTI Input capture interrupt while software not ready? FTCSR=0x%02x, FTCSRM=0x%02x\n", cpu_name, FRT.FTCSR, FRT.FTCSRM);
}
FRT.FICR = FRT.FRC;
if(!(FRT.FTCSR & 0x80))
{
FRT.FTCSR |= 0x80;
FRT.FTCSRM |= 0x80;
}
RecalcPendingIntPEX();
}
}
void SH7095::SetFTCI(bool state)
{
bool prev = FRT.FTCI;
FRT.FTCI = state;
if((FRT.TCR & 0x3) == 0x3)
{
if(!prev && state)
FRT_ClockFRC();
}
}
void NO_INLINE SH7095::WDT_Reset(bool from_internal_wdt)
{
WDT.WTCSR = 0x00;
WDT.WTCSRM = 0x00;
WDT.WTCNT = 0x00;
if(!from_internal_wdt)
{
WDT.RSTCSR = 0x00;
WDT.RSTCSRM = 0x00;
}
FRT_WDT_Recalc_NET();
RecalcPendingIntPEX();
}
void NO_INLINE SH7095::WDT_StandbyReset(void)
{
WDT.WTCSR &= 0x1F;
WDT.WTCSRM &= 0x1F;
WDT.RSTCSR = 0x00;
WDT.RSTCSRM = 0x00;
FRT_WDT_Recalc_NET();
RecalcPendingIntPEX();
}
//
//
//
//
//
static INLINE uint64 DIVU64_Partial(uint64 dividend, uint32 divisor)
{
bool M, Q;
Q = dividend >> 63;
M = divisor >> 31;
for(unsigned x = 0; x < 3; x++)
{
if(!(Q ^ M))
dividend -= (uint64)divisor << 32;
else
dividend += (uint64)divisor << 32;
Q = dividend >> 63;
dividend <<= 1;
dividend |= Q ^ 1 ^ M;
}
return dividend;
}
INLINE void SH7095::DIVU_S32_S32(void)
{
if(!DVSR)
{
divide_finish_timestamp = MA_until + 2 + 6;
DVCR |= 1;
RecalcPendingIntPEX();
DVDNTH = (int32)DVDNT >> 29;
if(!(DVCR & 2))
DVDNT = DVDNTL = 0x7FFFFFFF + ((int32)DVDNT < 0);
else
DVDNT = DVDNTL = (DVDNT << 3) | (((int32)~DVDNT >> 31) & 7);
}
else
{
divide_finish_timestamp = MA_until + 1 + 39;
if(DVSR == 0xFFFFFFFF && DVDNTL == 0x80000000)
{
DVDNT = DVDNTL = 0x80000000;
DVDNTH = 0;
}
else
{
DVDNTH = (int32)DVDNTL % (int32)DVSR;
DVDNT = DVDNTL = (int32)DVDNTL / (int32)DVSR;
}
}
DVDNTH_Shadow = DVDNTH;
DVDNTL_Shadow = DVDNTL;
}
INLINE void SH7095::DIVU_S64_S32(void)
{
const int32 divisor = DVSR;
const int64 dividend = ((int64)DVDNTH << 32) | DVDNTL;
int64 quotient;
if(!divisor)
goto Overflow;
if((uint64)dividend == (1ULL << 63) && (uint32)divisor == ~(uint32)0)
goto Overflow;
quotient = dividend / divisor;
//printf("Divisor=%08x, Dividend=%016llx, Quotient=%016llx\n", divisor, dividend, quotient);
if(quotient == 2147483648LL && divisor < 0 && (dividend % divisor) == 0) // Ugh, maybe we should just implement it properly the long way...
goto SkipOVCheck;
if(quotient < -2147483647LL || quotient > 2147483647LL)
{
Overflow:
divide_finish_timestamp = timestamp + 6;
DVCR |= 1;
RecalcPendingIntPEX();
//
uint64 tmp = DIVU64_Partial(dividend, divisor);
DVDNTH = tmp >> 32;
if(DVCR & 2)
DVDNT = DVDNTL = tmp;
else
DVDNT = DVDNTL = 0x7FFFFFFF + ((int32)((dividend >> 32) ^ divisor) < 0);
}
else
{
SkipOVCheck:
divide_finish_timestamp = timestamp + 39;
DVDNTH = dividend % divisor;
DVDNT = DVDNTL = quotient;
}
DVDNTH_Shadow = DVDNTH;
DVDNTL_Shadow = DVDNTL;
}
//
// Misaligned/wrong-sized accesses aren't handled correctly, it's a mess, but probably doesn't matter.
//
template<typename T>
NO_INLINE void SH7095::OnChipRegWrite(uint32 A, uint32 V)
{
//SS_DBG(SS_DBG_SH2_REGW, "[%s] %zu-byte write to on-chip register area; address=0x%08x value=0x%08x\n", cpu_name, sizeof(T), A, V);
if(A & 0x100)
{
if(sizeof(T) == 2)
A &= 0xFE;
else
A &= 0xFC;
if(sizeof(T) == 1)
{
SetPEX(PEX_CPUADDR);
V |= (uint8)V << 8;
}
switch(A)
{
default:
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Unhandled %zu-byte write to on-chip high register area; address=0x%08x value=0x%08x\n", cpu_name, sizeof(T), A, V);
break;
//
// Division Unit registers
//
case 0x20:
case 0x00:
DVSR = V;
break;
case 0x24:
case 0x04:
DVDNT = V;
DVDNTL = V;
DVDNTH = (int32)V >> 31;
DIVU_S32_S32();
break;
case 0x28:
case 0x08:
DVCR = V & 0x3;
break;
case 0x2C:
case 0x0C:
VCRDIV = V;
break;
case 0x30:
case 0x10:
DVDNTH = V;
break;
case 0x34:
case 0x14:
DVDNTL = V;
DIVU_S64_S32();
break;
// ?
case 0x38:
case 0x18:
DVDNTH_Shadow = V;
break;
case 0x3C:
case 0x1C:
DVDNTL_Shadow = V;
break;
//
//
//
//
// DMA registers
//
case 0x80:
case 0x90:
DMACH[(A >> 4) & 1].SAR = V;
break;
case 0x84:
case 0x94:
DMACH[(A >> 4) & 1].DAR = V;
break;
case 0x88:
case 0x98:
DMACH[(A >> 4) & 1].TCR = V & 0xFFFFFF;
break;
case 0x8C:
case 0x9C:
DMA_Update(SH7095_mem_timestamp);
{
const unsigned ch = (A >> 4) & 1;
DMACH[ch].CHCR = (V & ~2) | (DMACH[ch].CHCR & (V | DMACH[ch].CHCRM) & 2);
SS_DBGTI(SS_DBG_SH2, "[%s] DMA %d CHCR Write: CHCR=0x%04x SAR=0x%08x DAR=0x%08x TCR=0x%04x", cpu_name, ch, DMACH[ch].CHCR, DMACH[ch].SAR, DMACH[ch].DAR, DMACH[ch].TCR);
if((DMACH[ch].CHCR & 0x1) && (DMACH[ch].CHCR & 0x3E8) != 0x200)
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Unhandled CHCR on DMA channel %u: 0x%08x\n", cpu_name, ch, DMACH[ch].CHCR);
}
}
DMA_StartSG();
RecalcPendingIntPEX();
break;
case 0xA0:
case 0xA8:
DMACH[(A >> 3) & 1].VCR = V;
break;
case 0xB0:
DMA_Update(SH7095_mem_timestamp);
DMAOR = (V & 0x9) | (DMAOR & (V | DMAORM) & 0x6);
DMA_StartSG();
break;
//
// BSC registers
//
case 0xE0: // BCR1
case 0xE2:
BCR1 = (BCR1 &~ BCR1M) | (V & BCR1M); // Not sure if this is right, TODO: test somehow.
BCR1M = 0;
break;
}
}
else
{
unsigned mask = 0xFFFF;
unsigned shift = 0;
if(sizeof(T) != 2)
{
shift = ((A & 1) ^ 1) << 3;
mask = 0xFF << shift;
if(sizeof(T) == 4)
shift ^= 8;
}
if(sizeof(T) == 4)
SetPEX(PEX_CPUADDR);
switch(A & 0xFF)
{
default:
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Unhandled %zu-byte write to on-chip low register area; address=0x%08x value=0x%08x\n", cpu_name, sizeof(T), A, V);
break;
//
// Free-running timer registers.
//
//
// TIER
case 0x10:
FRT_WDT_Update();
//
FRT.TIER = V;
RecalcPendingIntPEX();
break;
// FTCSR
case 0x11:
FRT_WDT_Update();
//
FRT.FTCSR = (FRT.FTCSR & (FRT.FTCSRM | V) & 0x8E) | (V & 0x01);
RecalcPendingIntPEX();
FRT_CheckOCR();
break;
// FRCH
case 0x12:
FRT.RW_Temp = V;
break;
// FRCL
case 0x13:
FRT_WDT_Update();
//
FRT.FRC = (FRT.RW_Temp << 8) | (V & 0xFF);
FRT_CheckOCR();
FRT_WDT_Recalc_NET();
break;
// OCRA/B H
case 0x14:
FRT.RW_Temp = V;
break;
// OCRA/B L
case 0x15:
FRT_WDT_Update();
//
FRT.OCR[(FRT.TOCR >> 4) & 1] = (FRT.RW_Temp << 8) | V;
FRT_CheckOCR();
FRT_WDT_Recalc_NET();
break;
// TCR
case 0x16:
{
FRT_WDT_Update();
//
//const uint8 old_TCR = FRT.TCR;
FRT.TCR = V;
#if 0
//
// Maybe not worth emulating?:
//
if((old_TCR ^ FRT.TCR) & 3)
{
bool old_cs;
bool clock;
if((old_TCR & 0x3) == 3)
old_cs = FRT.FTCI;
else
old_cs = (FRT_WDT_.ClockDivider >> (3 - 1 + ((old_TCR & 0x3) << 1))) & 1;
if((V & 0x3) == 3)
clock = (!old_cs && FRT.FTCI);
else
{
bool new_cs = (FRT_WDT_ClockDivider >> (3 - 1 + ((FRT.TCR & 0x3) << 1))) & 1;
clock = (old_cs && !new_cs);
}
if(clock)
FRT_ClockFRC();
}
#endif
//
//
//
FRT_WDT_Recalc_NET();
}
break;
// TOCR
case 0x17:
FRT.TOCR = V & 0x1F;
break;
//
//
//
case 0x71:
case 0x72:
DMACH[(A & 1) ^ 1].DRCR = V & 0x3;
break;
//
// WDT registers
//
case 0x80:
case 0x88:
FRT_WDT_Update();
if(sizeof(T) == 2)
{
if((V & 0xFF00) == 0x5A00)
{
if(WDT.WTCSR & 0x20)
WDT.WTCNT = V;
}
else if((V & 0xFF00) == 0xA500)
{
WDT.WTCSR = (WDT.WTCSR & (WDT.WTCSRM | V) & 0x80) | (V & 0x67);
if(WDT.WTCSR & 0x20)
SBYCR &= 0x7F;
else
{
WDT.WTCSR &= ~0x80; // Seemingly undocumented...
WDT.WTCNT = 0;
}
}
}
WDT.RSTCSRM = 0;
FRT_WDT_Recalc_NET();
RecalcPendingIntPEX();
break;
case 0x82:
case 0x8A:
FRT_WDT_Update();
if(sizeof(T) == 2)
{
if(V == 0xA500)
{
// Clear OVF bit
WDT.RSTCSR &= ~WDT.RSTCSRM;
}
else if((V & 0xFF00) == 0x5A00)
{
// Write RSTE and RSTS bits
WDT.RSTCSR = (WDT.RSTCSR & 0x80) | (V & 0x60);
}
}
WDT.RSTCSRM = 0;
break;
case 0x81:
case 0x83:
case 0x84:
case 0x85:
case 0x86:
case 0x87:
case 0x89:
case 0x8B:
case 0x8C:
case 0x8D:
case 0x8E:
case 0x8F:
WDT.RSTCSRM = 0;
break;
//
//
//
case 0x91:
SBYCR = V;
if(WDT.WTCSR & 0x20)
SBYCR &= 0x7F;
if(SBYCR != 0)
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] SBYCR set to non-zero value: 0x%02x\n", cpu_name, V);
}
break;
case 0x92: case 0x93: case 0x94: case 0x95:
case 0x96: case 0x97: case 0x98: case 0x99:
case 0x9A: case 0x9B: case 0x9C: case 0x9D:
case 0x9E:
SetCCR(V);
break;
//
//
//
case 0x60:
case 0x61:
IPRB = (IPRB &~ mask) | ((V << shift) & mask & 0xFF00);
RecalcPendingIntPEX();
break;
case 0x62:
case 0x63:
VCRA = (VCRA &~ mask) | ((V << shift) & mask & 0x7F7F);
break;
case 0x64:
case 0x65:
VCRB = (VCRB &~ mask) | ((V << shift) & mask & 0x7F7F);
break;
case 0x66:
case 0x67:
VCRC = (VCRC &~ mask) | ((V << shift) & mask & 0x7F7F);
break;
case 0x68:
case 0x69:
VCRD = (VCRD &~ mask) | ((V << shift) & mask & 0x7F00);
break;
case 0xE0:
case 0xE1:
ICR = (ICR &~ mask) | ((V << shift) & mask & 0x0101);
if(ICR & 0x0100)
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] NMIE=1\n", cpu_name);
}
RecalcPendingIntPEX();
break;
case 0xE2:
case 0xE3:
IPRA = (IPRA &~ mask) | ((V << shift) & mask & 0xFFF0);
RecalcPendingIntPEX();
break;
case 0xE4:
case 0xE5:
VCRWDT = (VCRWDT &~ mask) | ((V << shift) & mask & 0x7F7F);
break;
}
}
}
template<typename T>
INLINE T SH7095::OnChipRegRead(uint32 A)
{
if(A & 0x100)
{
uint32 ret = 0;
MA_until++;
if(sizeof(T) == 2)
A &= 0xFE;
else
A &= 0xFC;
if(sizeof(T) == 1)
SetPEX(PEX_CPUADDR);
switch(A)
{
default:
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Unhandled %zu-byte read from on-chip high register area; address=0x%08x\n", cpu_name, sizeof(T), A);
break;
//
// Division Unit registers
//
case 0x20:
case 0x22:
case 0x00:
case 0x02:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = DVSR;
break;
case 0x24:
case 0x26:
case 0x04:
case 0x06:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = DVDNT;
break;
case 0x28:
case 0x2A:
case 0x08:
case 0x0A:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = DVCR;
break;
case 0x2C:
case 0x2E:
case 0x0C:
case 0x0E:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = VCRDIV;
break;
case 0x30:
case 0x32:
case 0x10:
case 0x12:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = DVDNTH;
break;
case 0x34:
case 0x36:
case 0x14:
case 0x16:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = DVDNTL;
break;
// ?
case 0x38:
case 0x3A:
case 0x18:
case 0x1A:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = DVDNTH_Shadow;
break;
case 0x3C:
case 0x3E:
case 0x1C:
case 0x1E:
MA_until = std::max<sscpu_timestamp_t>(MA_until, divide_finish_timestamp);
ret = DVDNTL_Shadow;
break;
//
//
//
//
// DMA registers
//
case 0x80:
case 0x90:
ret = DMACH[(A >> 4) & 1].SAR;
break;
case 0x84:
case 0x94:
ret = DMACH[(A >> 4) & 1].DAR;
break;
case 0x88:
case 0x98:
ret = DMACH[(A >> 4) & 1].TCR;
break;
case 0x8C:
case 0x9C:
{
const unsigned ch = (A >> 4) & 1;
ret = DMACH[ch].CHCR;
DMACH[ch].CHCRM = 0;
}
break;
case 0xA0:
case 0xA8:
ret = DMACH[(A >> 3) & 1].VCR;
break;
case 0xB0:
ret = DMAOR;
DMAORM = 0;
break;
//
// BSC registers
//
case 0xE0: // BCR1
case 0xE2:
ret = BCR1;
break;
}
if(sizeof(T) == 1)
ret >>= ((A & 1) ^ 1) << 3;
return ret;
}
else
{
const unsigned Am = (uint8)A;
const unsigned shift = ((sizeof(T) != 2) ? (((A & 1) ^ 1) << 3) : 0);
uint16 ret = 0;
if(Am < 0x20)
MA_until = (MA_until + 11) &~ 1; // FIXME: not quite right. //3;
else if((Am >= 0x60 && Am < 0xA0) || Am >= 0xE0)
MA_until += 3;
else
MA_until += 1;
if(sizeof(T) == 4)
SetPEX(PEX_CPUADDR);
else switch(Am)
{
default:
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Unhandled %zu-byte read from on-chip low register area; address=0x%08x\n", cpu_name, sizeof(T), A);
break;
//
// FRT registers. Some weirdness with 16-bit reads duplicating the lower 8 bits in the upper 8-bits, but the upper 8-bits are masked
// with the last data written to the FRT area or something...not emulated here.
//
case 0x10:
ret = FRT.TIER | 1;
break;
case 0x11:
FRT_WDT_Update();
//
ret = FRT.FTCSR;
FRT.FTCSRM = 0x00;
break;
case 0x12:
FRT_WDT_Update();
//
FRT.RW_Temp = FRT.FRC;
ret = FRT.FRC >> 8;
break;
case 0x13:
ret = FRT.RW_Temp;
break;
case 0x14:
ret = FRT.OCR[(FRT.TOCR >> 4) & 1] >> 8;
break;
case 0x15:
ret = FRT.OCR[(FRT.TOCR >> 4) & 1] & 0xFF;
break;
case 0x16:
ret = FRT.TCR;
break;
case 0x17:
ret = FRT.TOCR | 0xE0;
break;
case 0x18:
FRT.RW_Temp = FRT.FICR;
ret = FRT.FICR >> 8;
break;
case 0x19:
ret = FRT.RW_Temp;
break;
//
//
//
case 0x71:
case 0x72:
ret = DMACH[(A & 1) ^ 1].DRCR;
break;
//
// WDT registers
//
case 0x80:
case 0x88:
FRT_WDT_Update();
ret = WDT.WTCSR | 0x18;
WDT.WTCSRM = 0x00;
break;
case 0x81:
case 0x89:
FRT_WDT_Update();
ret = WDT.WTCNT;
break;
case 0x82:
case 0x85:
case 0x86:
case 0x87:
case 0x8A:
case 0x8D:
case 0x8E:
case 0x8F:
ret = 0xFF;
break;
case 0x83:
case 0x8B:
FRT_WDT_Update();
ret = WDT.RSTCSR | 0x1F;
WDT.RSTCSRM = (WDT.RSTCSR & 0x80);
break;
// FIXME: WDT open bus of a sort.
// case 0x84:
// case 0x8C:
//
//
//
case 0x91:
ret = SBYCR;
break;
case 0x92: case 0x93: case 0x94: case 0x95:
case 0x96: case 0x97: case 0x98: case 0x99:
case 0x9A: case 0x9B: case 0x9C: case 0x9D:
case 0x9E:
ret = CCR | (CCR << 8);
break;
//
//
//
case 0x60:
case 0x61:
ret = IPRB >> shift;
break;
case 0x62:
case 0x63:
ret = VCRA >> shift;
break;
case 0x64:
case 0x65:
ret = VCRB >> shift;
break;
case 0x66:
case 0x67:
ret = VCRC >> shift;
break;
case 0x68:
case 0x69:
ret = VCRD >> shift;
break;
case 0x6A: case 0x6B: case 0x6C: case 0x6D: case 0x6E: case 0x6F:
ret = 0xFFFF >> shift;
break;
case 0xE0:
case 0xE1:
ret = (ICR | (NMILevel << 15)) >> shift;
break;
case 0xE2:
case 0xE3:
ret = IPRA >> shift;
break;
case 0xE4:
case 0xE5:
ret = VCRWDT >> shift;
break;
case 0xE6: case 0xE7:
case 0xE8: case 0xE9: case 0xEA: case 0xEB: case 0xEC: case 0xED: case 0xEE: case 0xEF:
case 0xF0: case 0xF1: case 0xF2: case 0xF3: case 0xF4: case 0xF5: case 0xF6: case 0xF7:
case 0xF8: case 0xF9: case 0xFA: case 0xFB: case 0xFC: case 0xFD: case 0xFE: case 0xFF:
ret = 0xFFFF >> shift;
break;
}
return ret;
}
}
template<typename T, bool BurstHax>
INLINE T SH7095::ExtBusRead(uint32 A)
{
T ret;
A &= (1U << 27) - 1;
if(timestamp > SH7095_mem_timestamp)
SH7095_mem_timestamp = timestamp;
ret = SH7095_BusRead<T>(A, BurstHax, NULL);
return ret;
}
template<typename T>
INLINE void SH7095::ExtBusWrite(uint32 A, T V)
{
A &= (1U << 27) - 1;
if(timestamp > SH7095_mem_timestamp)
SH7095_mem_timestamp = timestamp;
SH7095_BusWrite<T>(A, V, false, NULL);
write_finish_timestamp = SH7095_mem_timestamp;
}
//
//
//
static const struct
{
uint8 AND;
uint8 OR;
} LRU_Update_Tab[4] =
{
{ (1 << 2) | (1 << 1) | (1 << 0), /**/ (0 << 5) | (0 << 4) | (0 << 3) }, // Way 0
{ (1 << 4) | (1 << 3) | (1 << 0), /**/ (1 << 5) | (0 << 2) | (0 << 1) }, // Way 1
{ (1 << 5) | (1 << 3) | (1 << 1), /**/ (1 << 4) | (1 << 2) | (0 << 0) }, // Way 2
{ (1 << 5) | (1 << 4) | (1 << 2), /**/ (1 << 3) | (1 << 1) | (1 << 0) }, // Way 3
};
static const int8 LRU_Replace_Tab[0x40] =
{
/* 0x00 */ 0x03, 0x02, -1, 0x02, 0x03, -1, 0x01, 0x01, -1, 0x02, -1, 0x02, -1, -1, 0x01, 0x01,
/* 0x10 */ 0x03, -1, -1, -1, 0x03, -1, 0x01, 0x01, -1, -1, -1, -1, -1, -1, 0x01, 0x01,
/* 0x20 */ 0x03, 0x02, -1, 0x02, 0x03, -1, -1, -1, -1, 0x02, -1, 0x02, -1, -1, -1, -1,
/* 0x30 */ 0x03, -1, -1, -1, 0x03, -1, -1, -1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
};
static INLINE uint32 cmov_eq_thing(const uint32 reg_compval, const uint32 mem_compval, uint32 var, const uint32 repl_var)
{
#ifdef ARCH_X86
asm( "cmpl %1, %2\n\t"
"cmove %3,%0\n\t"
: "+r"(var)
: "r"(reg_compval), "g"(mem_compval), "r"(repl_var)
: "cc");
#else
#ifdef __GNUC__
#warning "Conditional move inline assembly not being used."
#endif
var = ((reg_compval == mem_compval) ? repl_var : var);
#endif
return var;
}
INLINE void SH7095::AssocPurge(const uint32 A)
{
const uint32 ATM = A & (0x7FFFF << 10);
auto* cent = &Cache[(A >> 4) & 0x3F];
// Ignore two-way-mode bit in CCR here.
if(ATM == cent->Tag[0]) cent->Tag[0] |= 1U << 31; // Set invalid bit to 1.
if(ATM == cent->Tag[1]) cent->Tag[1] |= 1U << 31;
if(ATM == cent->Tag[2]) cent->Tag[2] |= 1U << 31;
if(ATM == cent->Tag[3]) cent->Tag[3] |= 1U << 31;
}
template<typename T, unsigned region, bool CacheEnabled, bool TwoWayMode, bool IsInstr>
INLINE T SH7095::MemReadRT(uint32 A)
{
static_assert(region < 0x8, "Wrong region argument.");
const uint32 unmasked_A = A;
if(!IsInstr)
{
if(MDFN_UNLIKELY(A & (sizeof(T) - 1)))
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Misaligned %zu-byte read from 0x%08x\n", cpu_name, sizeof(T), A);
A &= ~(sizeof(T) - 1);
SetPEX(PEX_CPUADDR);
}
}
if(!IsInstr)
MA_until = std::max<sscpu_timestamp_t>(MA_until, timestamp + 1);
else
timestamp = std::max<sscpu_timestamp_t>(MA_until, timestamp);
//
// WARNING: Template arguments CacheEnabled and TwoWayMode are only valid for region==0. In addition, TwoWayMode is only valid for CacheEnabled==true.
//
switch(region) // A >> 29
{
case 0:
if(CacheEnabled)
{
const uint32 ATM = A & (0x7FFFF << 10);
auto* cent = &Cache[(A >> 4) & 0x3F];
int way_match = -1;
way_match = cmov_eq_thing(ATM, cent->Tag[0], way_match, 0);
way_match = cmov_eq_thing(ATM, cent->Tag[1], way_match, 1);
way_match = cmov_eq_thing(ATM, cent->Tag[2], way_match, 2);
way_match = cmov_eq_thing(ATM, cent->Tag[3], way_match, 3);
if(MDFN_UNLIKELY(way_match < 0)) // Cache miss!
{
if(IsInstr)
{
if(MDFN_UNLIKELY(CCR & CCR_ID))
goto EBRCase;
}
else
{
if(MDFN_UNLIKELY(CCR & CCR_OD))
goto EBRCase;
}
if(TwoWayMode)
way_match = 3 ^ (cent->LRU & 0x1);
else
way_match = LRU_Replace_Tab[cent->LRU];
if(MDFN_UNLIKELY(way_match < 0))
goto EBRCase;
//
// Load cache line.
//
//printf("Cache load line: %08x\n", A);
cent->Tag[way_match] = ATM;
{
unsigned di = (A + 4 + 0) & 0xC; MDFN_ennsb<uint32, true>(&cent->Data[way_match][di], ExtBusRead<uint32, false>((A &~ 0xF) + di));
}
for(unsigned i = 4; i < 16; i += 4)
{
unsigned di = (A + 4 + i) & 0xC; MDFN_ennsb<uint32, true>(&cent->Data[way_match][di], ExtBusRead<uint32, true>((A &~ 0xF) + di));
}
if(!IsInstr)
MA_until = std::max<sscpu_timestamp_t>(MA_until, SH7095_mem_timestamp + 1);
else
timestamp = SH7095_mem_timestamp;
}
cent->LRU = (cent->LRU & LRU_Update_Tab[way_match].AND) | LRU_Update_Tab[way_match].OR;
return MDFN_densb<T, true>(&cent->Data[way_match][NE32ASU8_IDX_ADJ(T, A & 0x0F)]);
}
// Fall-through, no break here
case 1:
EBRCase:
{
T ret = ExtBusRead<T, false>(A);
if(!IsInstr)
MA_until = std::max<sscpu_timestamp_t>(MA_until, SH7095_mem_timestamp + 1);
else
timestamp = SH7095_mem_timestamp;
return ret;
}
case 2:
case 5:
//
// Associative purge(apparently returns open bus of some sort)
//
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] %zu-byte read from associative purge area; address=0x%08x\n", cpu_name, sizeof(T), A);
AssocPurge(A);
return ~0;
case 3:
//
// Direct cache address/tag access
//
// Note: bits 0, 1, 3, 29, 30, 31 are some sort of open-bus(unemulated).
//
// SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] %zu-byte read from cache address array area; address=0x%08x\n", cpu_name, sizeof(T), A);
{
const unsigned way = (CCR >> 6) & 0x3;
const unsigned ena = (A >> 4) & 0x3F;
return (Cache[ena].Tag[way] & (0x7FFFF << 10)) | (((int32)~Cache[ena].Tag[way] >> 31) & 0x4) | (Cache[ena].LRU << 4);
}
case 4:
case 6:
//
// Direct cache data access
//
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] %zu-byte read from cache data array area; address=0x%08x\n", cpu_name, sizeof(T), A);
{
const unsigned way = (A >> 10) & 0x3;
const unsigned ena = (A >> 4) & 0x3F;
return MDFN_densb<T, true>(&Cache[ena].Data[way][NE32ASU8_IDX_ADJ(T, A & 0x0F)]);
}
case 7:
return OnChipRegRead<T>(unmasked_A);
}
}
template<typename T>
INLINE T SH7095::MemRead(uint32 A)
{
if(sizeof(T) == 1)
return MRFP8[A >> 29](A);
else if(sizeof(T) == 2)
return MRFP16[A >> 29](A);
else
return MRFP32[A >> 29](A);
}
template<typename T>
INLINE void SH7095::Write_UpdateCache(uint32 A, T V)
{
const uint32 ATM = A & (0x7FFFF << 10);
auto* cent = &Cache[(A >> 4) & 0x3F];
int way_match = -1;
way_match = cmov_eq_thing(ATM, cent->Tag[0], way_match, 0);
way_match = cmov_eq_thing(ATM, cent->Tag[1], way_match, 1);
way_match = cmov_eq_thing(ATM, cent->Tag[2], way_match, 2);
way_match = cmov_eq_thing(ATM, cent->Tag[3], way_match, 3);
if(MDFN_LIKELY(way_match >= 0)) // Cache hit!
{
cent->LRU = (cent->LRU & LRU_Update_Tab[way_match].AND) | LRU_Update_Tab[way_match].OR;
MDFN_ennsb<T, true>(&cent->Data[way_match][NE32ASU8_IDX_ADJ(T, A & 0x0F)], V); // Ignore CCR OD bit here.
}
}
template<typename T, unsigned region, bool CacheEnabled>
INLINE void SH7095::MemWriteRT(uint32 A, T V)
{
static_assert(region < 0x8, "Wrong region argument.");
const uint32 unmasked_A = A;
if(MDFN_UNLIKELY(A & (sizeof(T) - 1)))
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Misaligned %zu-byte write of 0x%08x to 0x%08x\n", cpu_name, sizeof(T), V, A);
A &= ~(sizeof(T) - 1);
SetPEX(PEX_CPUADDR);
}
MA_until = std::max<sscpu_timestamp_t>(MA_until, timestamp + 1);
//
// WARNING: Template argument CacheEnabled is only valid for region==0.
//
switch(region) // A >> 29
{
case 0:
if(CacheEnabled)
Write_UpdateCache<T>(A, V);
// Fall-through, no break
case 1:
MA_until = std::max<sscpu_timestamp_t>(MA_until, write_finish_timestamp + 1);
ExtBusWrite<T>(A, V);
return;
case 2:
case 5:
//
// Associative purge.
//
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] %zu-byte write to associative purge area; address=0x%08x value=0x%x\n", cpu_name, sizeof(T), A, V);
AssocPurge(A);
return;
case 3:
//
// Direct cache address/tag access
//
// TODO: Check non-32 bit access
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] %zu-byte write to cache address array area; address=0x%08x value=0x%x\n", cpu_name, sizeof(T), A, V);
timestamp++;
MA_until = std::max<sscpu_timestamp_t>(MA_until, timestamp + 1);
{
const unsigned way = (CCR >> 6) & 0x3;
const unsigned ena = (A >> 4) & 0x3F;
Cache[ena].Tag[way] = (A & (0x7FFFF << 10)) | ((!(A & 0x4)) << 31);
Cache[ena].LRU = (V >> 4) & 0x3F;
}
return;
case 4:
case 6:
//
// Direct cache data access
//
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] %zu-byte write to cache data array area; address=0x%08x value=0x%x\n", cpu_name, sizeof(T), A, V);
{
const unsigned way = (A >> 10) & 0x3;
const unsigned ena = (A >> 4) & 0x3F;
MDFN_ennsb<T, true>(&Cache[ena].Data[way][NE32ASU8_IDX_ADJ(T, A & 0x0F)], V);
}
return;
case 7:
OnChipRegWrite<T>(unmasked_A, V);
return;
}
}
template<typename T>
INLINE void SH7095::MemWrite(uint32 A, T V)
{
if(sizeof(T) == 1)
MWFP8[A >> 29](A, V);
else if(sizeof(T) == 2)
MWFP16[A >> 29](A, V);
else
MWFP32[A >> 29](A, V);
}
template<unsigned which, typename T, unsigned region, bool CacheEnabled, bool TwoWayMode, bool IsInstr>
static NO_INLINE MDFN_FASTCALL T C_MemReadRT(uint32 A)
{
return CPU[which].MemReadRT<T, region, CacheEnabled, TwoWayMode, IsInstr>(A);
}
template<unsigned which, typename T, unsigned region, bool CacheEnabled>
static NO_INLINE MDFN_FASTCALL void C_MemWriteRT(uint32 A, T V)
{
CPU[which].MemWriteRT<T, region, CacheEnabled>(A, V);
}
INLINE void SH7095::SetCCR(uint8 V)
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Write to CCR: 0x%02x\n", cpu_name, V);
if(V & CCR_CP)
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Cache purge.\n", cpu_name);
for(unsigned entry = 0; entry < 64; entry++)
{
Cache[entry].LRU = 0;
for(unsigned way = 0; way < 4; way++)
Cache[entry].Tag[way] |= 1U << 31; // Set invalid bit to 1.
}
V &= ~CCR_CP;
}
CCR = V;
#define MAHL(bs,w) \
if(CCR & CCR_CE) \
{ \
if(CCR & CCR_TW) \
{ \
MRFP##bs[0] = C_MemReadRT <w, uint##bs, 0x0, true, true, false>; \
MRFPI[0] = C_MemReadRT <w, uint32, 0x0, true, true, true>; \
} \
else \
{ \
MRFP##bs[0] = C_MemReadRT <w, uint##bs, 0x0, true, false, false>; \
MRFPI[0] = C_MemReadRT <w, uint32, 0x0, true, false, true>; \
} \
MWFP##bs[0] = C_MemWriteRT<w, uint##bs, 0x0, true>; \
} \
else \
{ \
MRFP##bs[0] = C_MemReadRT <w, uint##bs, 0x0, false, false, false>; \
MRFPI[0] = C_MemReadRT <w, uint32, 0x0, false, false, true>; \
MWFP##bs[0] = C_MemWriteRT<w, uint##bs, 0x0, false>; \
}
if(this == &CPU[0])
{
MAHL( 8, 0)
MAHL(16, 0)
MAHL(32, 0)
}
else
{
MAHL( 8, 1)
MAHL(16, 1)
MAHL(32, 1)
}
#undef MAHL
}
/*
*/
void NO_INLINE SH7095::Reset(bool power_on_reset, bool from_internal_wdt)
{
VBR = 0;
SR |= 0xF << 4;
SetCCR(0);
//
if(power_on_reset)
{
BCR1 = (BCR1 & 0x8000) | 0x03F0;
BCR1M = 0x1FF7;
}
//
for(unsigned ch = 0; ch < 2; ch++)
{
DMACH[ch].CHCR = 0x00;
DMACH[ch].CHCRM = 0x00;
DMACH[ch].DRCR = 0x00;
}
DMAOR = 0x00;
RecalcPendingIntPEX();
//
INTC_Reset();
//
DVCR = 0;
RecalcPendingIntPEX();
//
FRT_Reset();
WDT_Reset(from_internal_wdt);
//
SBYCR = 0;
Standby = false;
//
//
//
EPending = 0;
SetPEX(power_on_reset ? PEX_POWERON : PEX_RESET);
Pipe_ID = EPending;
}
void NO_INLINE SH7095::INTC_Reset(void)
{
IPRA = 0;
IPRB = 0;
VCRA = 0;
VCRB = 0;
VCRC = 0;
VCRD = 0;
VCRWDT = 0;
ICR = 0;
RecalcPendingIntPEX();
}
void SH7095::SetNMI(bool level)
{
//printf("NMI: %d, %d %d\n", NMILevel, level, (bool)(ICR & 0x100));
if(NMILevel != level && level == (bool)(ICR & 0x100))
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] NMI - Standby=%u\n", cpu_name, Standby);
SetPEX(PEX_NMI);
if(Standby)
{
WDT.WTCSR |= 0x08;
FRT_WDT_Recalc_NET();
}
else
DMAOR |= 0x02; // TODO: NMIF; set always, or only when DMA was active?
}
NMILevel = level;
}
void SH7095::SetMD5(bool level)
{
BCR1 = (BCR1 & 0x7FFF) | (level << 15);
}
void SH7095::SetIRL(unsigned level)
{
assert(level < 16);
IRL = level;
RecalcPendingIntPEX();
}
void SH7095::ForceInternalEventUpdates(void)
{
FRT_WDT_Update();
FRT_WDT_Recalc_NET();
}
//
// Default priority(for same ipr value), highest to lowest:
// NMI
// User break
// IRL15
// [...]
// IRL1
// DIVU
// DMAC0
// DMAC1
// WDT
// REF
// SCI-ERI
// SCI-RXI
// SCI-TXI
// SCI-TEI
// FRT-ICI
// FRT-OCI
// FRT-OVI
//
//
uint8 INLINE SH7095::GetPendingInt(uint8* vecnum_out)
{
unsigned ipr;
unsigned vecnum;
unsigned tmp_ipr;
ipr = IRL;
vecnum = (IRL >> 1) + VECNUM_INT_BASE;
if(vecnum_out && (ICR & 0x1) && IRL > 0) // External vec fetch has side effects, make sure to only do it if vecnum_out is non-NULL and ICR & 0x1, and if this is the interrupt being serviced.
vecnum = ~0U;
//
//
//
if((DVCR & 0x3) == 0x3 && (tmp_ipr = ((IPRA >> 12) & 0xF)) > ipr)
{
ipr = tmp_ipr;
vecnum = (VCRDIV & 0x7F);
}
for(unsigned ch = 0; ch < 2; ch++)
{
if((DMACH[ch].CHCR & 0x6) == 0x6 && (tmp_ipr = ((IPRA >> 8) & 0xF)) > ipr)
{
ipr = tmp_ipr;
vecnum = (DMACH[ch].VCR & 0x7F);
}
}
if((WDT.WTCSR & 0x80) && (tmp_ipr = ((IPRA >> 4) & 0xF)) > ipr)
{
ipr = tmp_ipr;
vecnum = (VCRWDT >> 8) & 0x7F;
}
#if 0
if(OPMIPending)
{
static const uint32 sci_any_mask = (1U << OPMI_SCI_TEI) | (1U << OPMI_SCI_TXI) | (1U << OPMI_SCI_RXI) | (1U << OPMI_SCI_ERI);
static const uint32 dmac_any_mask = (1U << OPMI_DMAC1) | (1U << OPMI_DMAC0);
uint32 new_ipr;
if((OPMIPending & sci_any_mask) && (new_ipr = ((IPRB >> 12) & 0xF)) > ipr)
{
}
}
#endif
//
//
//
const uint32 frt_ip_tmp = (FRT.FTCSR & FRT.TIER & 0x8E);
if(frt_ip_tmp && (tmp_ipr = ((IPRB >> 8) & 0xF)) > ipr)
{
ipr = tmp_ipr;
if(frt_ip_tmp & 0x80) // ICI
vecnum = (VCRC >> 8) & 0x7F;
else if(frt_ip_tmp & 0x0C) // OCIA+OCIB
vecnum = (VCRC >> 0) & 0x7F;
else // OVI
vecnum = (VCRD >> 8) & 0x7F;
}
if(vecnum_out)
{
if(vecnum == ~0U)
vecnum = ExIVecFetch();
*vecnum_out = vecnum;
}
return ipr;
}
//
// Call after changes to:
// IRL
// SR
//
// IPRA
// IPRB
//
// DMACH[*].CHCR
//
// DVCR
//
// FRT.FTCSR
// FRT.TIER
//
void NO_INLINE SH7095::RecalcPendingIntPEX(void)
{
if(GetPendingInt(NULL) > ((SR >> 4) & 0xF))
SetPEX(PEX_INT);
else
ClearPEX(PEX_INT);
}
static const uint8 InstrDecodeTab[65536] =
{
#include "sh7095_idecodetab.inc"
};
template<bool DebugMode>
INLINE void SH7095::FetchIF(bool ForceIBufferFill)
{
if(DebugMode)
PC_IF = PC;
#ifdef SH7095_EMULATE_ICACHE
if(ForceIBufferFill)
{
IBuffer = MRFPI[PC >> 29](PC &~ 2);
Pipe_IF = (uint16)(IBuffer >> (((PC & 2) ^ 2) << 3));
}
else
{
Pipe_IF = (uint16)IBuffer;
if(!(PC & 0x2))
{
IBuffer = MRFPI[PC >> 29](PC);
Pipe_IF = IBuffer >> 16;
}
}
#else
if(timestamp < (MA_until - (ForceIBufferFill ? 0 : ((int32)(PC & 0x2) << 28))))
timestamp = MA_until;
if(MDFN_UNLIKELY((int32)PC < 0)) // Mr. Boooones
{
Pipe_IF = MRFP16[PC >> 29](PC);
timestamp++;
return;
}
Pipe_IF = *(uint16*)(SH7095_FastMap[PC >> SH7095_EXT_MAP_GRAN_BITS] + PC);
#endif
timestamp++;
}
//
// TODO: Stop reading from memory when an exception is pending?
//
template<bool DebugMode, bool DelaySlot, bool IntPreventNext, bool SkipFetchIF>
INLINE void SH7095::DoIDIF_Real(void)
{
if(DelaySlot)
{
//
// Redecode the opcode from the 16-bit instruction to makes sure exceptions won't be taken in the delay slot(due
// to op field being forced to 0xFF in the previous call to DoIDIF()), and forces usage of the second half of the opcode
// table so we can generate illegal slot instruction exceptions as appropriate.
//
// Oh, and this effectively discards the previously-fetched instruction in Pipe_IF. Poor, poor instruction.
//
Pipe_ID = (uint16)Pipe_ID;
Pipe_ID |= (InstrDecodeTab[Pipe_ID] | 0x80) << 24;
}
else
{
uint32 op = InstrDecodeTab[Pipe_IF];
uint32 epo = EPending;
if(IntPreventNext)
{
epo &= ~(1U << (PEX_INT + EPENDING_PEXBITS_SHIFT));
if(!(epo & (0xFF << EPENDING_PEXBITS_SHIFT)))
epo = 0;
}
if(DebugMode)
PC_ID = PC_IF;
Pipe_ID = Pipe_IF | (op << 24) | epo;
}
if(!SkipFetchIF)
FetchIF<DebugMode>(false);
}
template<unsigned which, bool DebugMode, bool DelaySlot, bool IntPreventNext, bool SkipFetchIF>
static NO_INLINE void DoIDIF(void)
{
CPU[which].DoIDIF_Real<DebugMode, DelaySlot, IntPreventNext, SkipFetchIF>();
}
template<unsigned which, int DebugMode, bool delayed>
INLINE void SH7095::Branch(uint32 target)
{
if(DebugMode > 0)
DBG_AddBranchTrace(which, target, -1);
PC = target;
//
// Not totally correct, but simplifies things...probably :p
//
if(delayed)
{
if(MDFN_UNLIKELY(PC & 1))
{
DoIDIF<which, (bool)DebugMode, true, true, true>();
SetPEX(PEX_CPUADDR); // Pending for the instruction after the delay slot instruction.
}
else
{
#ifdef SH7095_EMULATE_ICACHE
if(PC & 0x2)
IBuffer = MRFPI[PC >> 29](PC &~ 2);
#endif
DoIDIF<which, (bool)DebugMode, true, false, false>();
}
}
else
{
if(MDFN_UNLIKELY(PC & 1))
{
SetPEX(PEX_CPUADDR);
DoIDIF<which, (bool)DebugMode, false, false, true>();
}
else
{
#ifdef SH7095_EMULATE_ICACHE
if(PC & 0x2)
IBuffer = MRFPI[PC >> 29](PC &~ 2);
#endif
DoIDIF<which, (bool)DebugMode, false, false, false>();
PC += 2;
DoIDIF<which, (bool)DebugMode, false, false, false>();
}
}
}
// Remember to use BEGIN_OP_DLYIDIF instead of BEGIN_OP
template<unsigned which, int DebugMode>
INLINE void SH7095::UCDelayBranch(uint32 target)
{
if(DebugMode > 0)
DBG_AddBranchTrace(which, target, -1);
PC = target;
if(DebugMode)
PC_ID = PC_IF;
Pipe_ID = Pipe_IF | ((InstrDecodeTab[Pipe_IF] | 0x80) << 24);
timestamp++;
if(MDFN_UNLIKELY(PC & 1))
{
DoIDIF<which, (bool)DebugMode, true, true, true>();
SetPEX(PEX_CPUADDR); // Pending for the instruction after the delay slot instruction.
}
else
{
FetchIF<DebugMode>(true);
}
}
template<unsigned which, int DebugMode>
INLINE void SH7095::UCRelDelayBranch(uint32 disp)
{
UCDelayBranch<which, DebugMode>(PC + disp);
}
template<unsigned which, int DebugMode, bool delayed>
INLINE void SH7095::CondRelBranch(bool cond, uint32 disp)
{
if(cond)
Branch<which, DebugMode, delayed>(PC + disp);
}
template<bool DebugMode>
uint32 NO_INLINE SH7095::Exception(const unsigned exnum, const unsigned vecnum)
{
uint32 new_PC;
timestamp += 2;
if(exnum == EXCEPTION_RESET || exnum == EXCEPTION_POWERON)
{
new_PC = MemRead<uint32>((vecnum + 0) << 2);
R[15] = MemRead<uint32>((vecnum + 1) << 2);
}
else
{
// Save SR to stack
// Save PC to stack
// Read exception vector table
R[15] -= 4;
MemWrite<uint32>(R[15], SR);
timestamp++;
R[15] -= 4;
MemWrite<uint32>(R[15], PC);
timestamp++;
timestamp++;
new_PC = MemRead<uint32>(VBR + (vecnum << 2));
timestamp++;
}
if(DebugMode)
DBG_AddBranchTrace(this - CPU, new_PC, exnum, vecnum);
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Exception %u, vecnum=%u, saved PC=0x%08x --- New PC=0x%08x\n", cpu_name, exnum, vecnum, PC, new_PC);
return new_PC;
}
/*
PC == 0
instr = [?]
ID = [?]
IF = [0]
PC == 2
instr = [?]
ID = [0]
IF = [2]
PC == 4
instr = [0]
ID = [2]
IF = [4]
*/
template<unsigned which, bool DebugMode>
INLINE void SH7095::Step(void)
{
//
// Ideally, we would place SPEPRecover: after the FRT event check, but doing
// so causes gcc(multiple versions) to produce inconceivably awful code under certain conditions
// (such as disabling all the SS_DBG stuff at compile-time) because it thinks it's an important loop
// or something?(even with all our branch hinting!)
//
SPEPRecover:;
if(MDFN_UNLIKELY(timestamp >= FRT_WDT_NextTS))
{
FRT_WDT_Update();
FRT_WDT_Recalc_NET();
}
const uint32 instr = (uint16)Pipe_ID;
const unsigned instr_nyb1 = (instr >> 4) & 0xF;
const unsigned instr_nyb2 = (instr >> 8) & 0xF;
// asm volatile("":: "a"(instr_nyb1), "d"(instr_nyb2));
switch(Pipe_ID >> 24)
{
#include "sh7095_opdefs.inc"
#define PART_OP_NORMIDIF DoIDIF<which, DebugMode, false, false, false>();
#define BEGIN_OP(x) OP_##x { PART_OP_NORMIDIF
#define BEGIN_OP_DLYIDIF(x) OP_##x {
// "Interrupt-disabled" instruction(blocks interrupt from being taken for next instruction).
// Use with BEGIN_OP_DLYIDIF()
#define PART_OP_INTDIS DoIDIF<which, DebugMode, false, true, false>();
#define END_OP } break;
#if 0
#define WB_EX_CHECK(r) { if(timestamp < WB_until[(r)]) timestamp = WB_until[(r)]; }
#define WB_WRITE(r, v) { R[(r)] = (v); WB_until[(r)] = MA_until + 1; }
#else
#define WB_EX_CHECK(r) { }
#define WB_WRITE(r, v) { R[(r)] = (v); }
#endif
//
//
//
//
// MOV #imm,Rn
//
BEGIN_OP(MOV_IMM_REG)
const unsigned n = instr_nyb2;
const uint32 imm = (int8)instr;
WB_EX_CHECK(n)
R[n] = imm;
END_OP
//
// MOV.W @(disp,PC),Rn
//
BEGIN_OP(MOV_W_PCREL_REG)
const unsigned n = instr_nyb2;
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = PC + (d << 1);
WB_WRITE(n, (int16)MemRead<uint16>(ea));
END_OP
//
// MOV.L @(disp,PC),Rn
//
BEGIN_OP(MOV_L_PCREL_REG)
const unsigned n = instr_nyb2;
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = (PC &~ 0x3) + (d << 2);
WB_WRITE(n, MemRead<uint32>(ea));
END_OP
//
// MOV Rm,Rn
//
BEGIN_OP(MOV_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = R[m];
END_OP
//
// MOV.B Rm,@Rn
//
BEGIN_OP(MOV_B_REG_REGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 val = R[m];
const uint32 ea = R[n];
MemWrite<uint8>(ea, val);
END_OP
//
// MOV.W Rm,@Rn
//
BEGIN_OP(MOV_W_REG_REGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 val = R[m];
const uint32 ea = R[n];
MemWrite<uint16>(ea, val);
END_OP
//
// MOV.L Rm,@Rn
//
BEGIN_OP(MOV_L_REG_REGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 val = R[m];
const uint32 ea = R[n];
MemWrite<uint32>(ea, val);
END_OP
//
// MOV.B @Rm,Rn
//
BEGIN_OP(MOV_B_REGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
WB_WRITE(n, (int8)MemRead<uint8>(ea));
END_OP
//
// MOV.W @Rm,Rn
//
BEGIN_OP(MOV_W_REGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
WB_WRITE(n, (int16)MemRead<uint16>(ea));
END_OP
//
// MOV.L @Rm,Rn
//
BEGIN_OP(MOV_L_REGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
WB_WRITE(n, MemRead<uint32>(ea));
END_OP
//
// MOV.B Rm,@-Rn
//
BEGIN_OP(MOV_B_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 val = R[m];
uint32 ea;
R[n] -= 1;
ea = R[n];
MemWrite<uint8>(ea, val);
END_OP
//
// MOV.W Rm,@-Rn
//
BEGIN_OP(MOV_W_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 val = R[m];
uint32 ea;
R[n] -= 2;
ea = R[n];
MemWrite<uint16>(ea, val);
END_OP
//
// MOV.L Rm,@-Rn
//
BEGIN_OP(MOV_L_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 val = R[m];
uint32 ea;
R[n] -= 4;
ea = R[n];
MemWrite<uint32>(ea, val);
END_OP
//
// MOV.B @Rm+,Rn
//
BEGIN_OP(MOV_B_REGINDIRPI_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
uint32 ea;
ea = R[m];
R[m] += 1;
WB_WRITE(n, (int8)MemRead<uint8>(ea));
END_OP
//
// MOV.W @Rm+,Rn
//
BEGIN_OP(MOV_W_REGINDIRPI_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
uint32 ea;
ea = R[m];
R[m] += 2;
WB_WRITE(n, (int16)MemRead<uint16>(ea));
END_OP
//
// MOV.L @Rm+,Rn
//
BEGIN_OP(MOV_L_REGINDIRPI_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
uint32 ea;
ea = R[m];
R[m] += 4;
WB_WRITE(n, MemRead<uint32>(ea));
END_OP
//
// MOV.B R0,@(disp,Rn)
//
BEGIN_OP(MOV_B_REG0_REGINDIRDISP)
const unsigned n = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[n] + (d << 0);
MemWrite<uint8>(ea, R[0]);
END_OP
//
// MOV.W R0,@(disp,Rn)
//
BEGIN_OP(MOV_W_REG0_REGINDIRDISP)
const unsigned n = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[n] + (d << 1);
MemWrite<uint16>(ea, R[0]);
END_OP
//
// MOV.L Rm,@(disp,Rn)
//
BEGIN_OP(MOV_L_REG_REGINDIRDISP)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[n] + (d << 2);
MemWrite<uint32>(ea, R[m]);
END_OP
//
// MOV.B @(disp,Rm),R0
//
BEGIN_OP(MOV_B_REGINDIRDISP_REG0)
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[m] + (d << 0);
WB_WRITE(0, (int8)MemRead<uint8>(ea));
END_OP
//
// MOV.W @(disp,Rm),R0
//
BEGIN_OP(MOV_W_REGINDIRDISP_REG0)
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[m] + (d << 1);
WB_WRITE(0, (int16)MemRead<uint16>(ea));
END_OP
//
// MOV.L @(disp,Rm),Rn
//
BEGIN_OP(MOV_L_REGINDIRDISP_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[m] + (d << 2);
WB_WRITE(n, MemRead<uint32>(ea));
END_OP
//
// MOV.B Rm,@(R0,Rn)
//
BEGIN_OP(MOV_B_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[n];
MemWrite<uint8>(ea, R[m]);
END_OP
//
// MOV.W Rm,@(R0,Rn)
//
BEGIN_OP(MOV_W_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[n];
MemWrite<uint16>(ea, R[m]);
END_OP
//
// MOV.L Rm,@(R0,Rn)
//
BEGIN_OP(MOV_L_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[n];
MemWrite<uint32>(ea, R[m]);
END_OP
//
// MOV.B @(R0,Rm),Rn
//
BEGIN_OP(MOV_B_IDXREGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[m];
WB_WRITE(n, (int8)MemRead<uint8>(ea));
END_OP
//
// MOV.W @(R0,Rm),Rn
//
BEGIN_OP(MOV_W_IDXREGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[m];
WB_WRITE(n, (int16)MemRead<uint16>(ea));
END_OP
//
// MOV.L @(R0,Rm),Rn
//
BEGIN_OP(MOV_L_IDXREGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[m];
WB_WRITE(n, MemRead<uint32>(ea));
END_OP
//
// MOV.B R0,@(disp,GBR)
//
BEGIN_OP(MOV_B_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 0);
MemWrite<uint8>(ea, R[0]);
END_OP
//
// MOV.W R0,@(disp,GBR)
//
BEGIN_OP(MOV_W_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 1);
MemWrite<uint16>(ea, R[0]);
END_OP
//
// MOV.L R0,@(disp,GBR)
//
BEGIN_OP(MOV_L_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 2);
MemWrite<uint32>(ea, R[0]);
END_OP
//
// MOV.B @(disp,GBR),R0
//
BEGIN_OP(MOV_B_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 0);
WB_WRITE(0, (int8)MemRead<uint8>(ea));
END_OP
//
// MOV.W @(disp,GBR),R0
//
BEGIN_OP(MOV_W_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 1);
WB_WRITE(0, (int16)MemRead<uint16>(ea));
END_OP
//
// MOV.L @(disp,GBR),R0
//
BEGIN_OP(MOV_L_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 2);
WB_WRITE(0, MemRead<uint32>(ea));
END_OP
//
// MOVA @(disp,PC),R0
//
BEGIN_OP(MOVA_PCREL_REG0)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = (PC &~ 0x3) + (d << 2);
WB_EX_CHECK(0)
R[0] = ea;
END_OP
//
// MOVT Rn
//
BEGIN_OP(MOVT_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n] = GetT();
END_OP
//
// SWAP.B Rm,Rn
//
BEGIN_OP(SWAP_B_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = (R[m] & 0xFFFF0000) | ((R[m] << 8) & 0xFF00) | ((R[m] >> 8) & 0x00FF);
END_OP
//
// SWAP.W Rm,Rn
//
BEGIN_OP(SWAP_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = (R[m] << 16) | (R[m] >> 16);
END_OP
//
// XTRCT Rm,Rn
//
BEGIN_OP(XTRCT_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = (R[n] >> 16) | (R[m] << 16);
END_OP
//
// ADD Rm,Rn
//
BEGIN_OP(ADD_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = R[n] + R[m];
END_OP
//
// ADD #imm,Rn
//
BEGIN_OP(ADD_IMM_REG)
const unsigned n = instr_nyb2;
const uint32 imm = (int8)instr;
WB_EX_CHECK(n)
R[n] = R[n] + imm;
END_OP
//
// ADDC Rm,Rn
//
BEGIN_OP(ADDC_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint64 result = (uint64)R[n] + R[m] + GetT();
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = result;
SetT((result >> 32) & 1);
END_OP
//
// ADDV Rm,Rn
//
BEGIN_OP(ADDV_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 result = R[n] + R[m];
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT(((~(R[n] ^ R[m])) & (R[n] ^ result)) >> 31);
R[n] = result;
END_OP
//
// CMP/EQ #imm,R0
//
BEGIN_OP(CMP_EQ_IMM_REG0)
const uint32 imm = (int8)instr;
WB_EX_CHECK(0)
SetT(imm == R[0]);
END_OP
//
// CMP/EQ Rm,Rn
//
BEGIN_OP(CMP_EQ_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT(R[n] == R[m]);
END_OP
//
// CMP/HS Rm,Rn
//
BEGIN_OP(CMP_HS_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT(R[n] >= R[m]);
END_OP
//
// CMP/GE Rm,Rn
//
BEGIN_OP(CMP_GE_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT((int32)R[n] >= (int32)R[m]);
END_OP
//
// CMP/HI Rm,Rn
//
BEGIN_OP(CMP_HI_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT(R[n] > R[m]);
END_OP
//
// CMP/GT Rm,Rn
//
BEGIN_OP(CMP_GT_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT((int32)R[n] > (int32)R[m]);
END_OP
//
// CMP/PZ Rn
//
BEGIN_OP(CMP_PZ_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
SetT((int32)R[n] >= 0);
END_OP
//
// CMP/PL Rn
//
BEGIN_OP(CMP_PL_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
SetT((int32)R[n] > 0);
END_OP
//
// CMP/STR Rm,Rn
//
BEGIN_OP(CMP_STR_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 tmp = R[n] ^ R[m];
unsigned new_T = 0;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
if(!(tmp & 0x000000FF)) new_T = 1;
if(!(tmp & 0x0000FF00)) new_T = 1;
if(!(tmp & 0x00FF0000)) new_T = 1;
if(!(tmp & 0xFF000000)) new_T = 1;
SetT(new_T);
END_OP
//
// DIV1 Rm,Rn
//
BEGIN_OP(DIV1_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
uint32 tmp;
bool new_Q;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
new_Q = R[n] >> 31;
R[n] <<= 1;
R[n] |= GetT();
tmp = R[n];
new_Q ^= GetM();
if(!(GetQ() ^ GetM()))
{
R[n] -= R[m];
new_Q ^= (R[n] > tmp);
}
else
{
R[n] += R[m];
new_Q ^= (R[n] < tmp);
}
SetQ(new_Q);
SetT(new_Q == GetM());
END_OP
//
// DIV0S Rm,Rn
//
BEGIN_OP(DIV0S_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const unsigned new_Q = R[n] >> 31;
const unsigned new_M = R[m] >> 31;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetQ(new_Q);
SetM(new_M);
SetT(new_Q != new_M);
END_OP
//
// DIV0U
//
BEGIN_OP(DIV0U)
SetQ(false);
SetM(false);
SetT(false);
END_OP
//
// DT
//
BEGIN_OP(DT)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n]--;
SetT(!R[n]);
END_OP
//
// EXTS.B Rm,Rn
//
BEGIN_OP(EXTS_B_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = (int8)R[m];
END_OP
//
// EXTS.W Rm,Rn
//
BEGIN_OP(EXTS_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = (int16)R[m];
END_OP
//
// EXTU.B Rm,Rn
//
BEGIN_OP(EXTU_B_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = (uint8)R[m];
END_OP
//
// EXTU.W Rm,Rn
//
BEGIN_OP(EXTU_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = (uint16)R[m];
END_OP
//
// MAC.L @Rm+,@Rn+
//
// Pipeline: page 188(not implemented right here)
BEGIN_OP(MAC_L)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
uint64 a, b, sum;
int32 m0, m1;
// Order confirmed.
m0 = (int32)MemRead<uint32>(R[m]);
R[m] += 4;
m1 = (int32)MemRead<uint32>(R[n]);
R[n] += 4;
a = GetMAC64();
b = (int64)m0 * m1;
sum = a + b;
if(GetS() && sum > 0x00007FFFFFFFFFFFULL && sum < 0xFFFF800000000000ULL)
{
if((int64)b < 0)
sum = 0xFFFF800000000000ULL;
else
sum = 0x00007FFFFFFFFFFFULL;
}
SetMAC64(sum);
timestamp++;
END_OP
//
// MAC.W @Rm+,@Rn+
//
// Pipeline: page 180(not implemented right here)
BEGIN_OP(MAC_W)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
int16 m0, m1;
// Order confirmed.
m0 = (int16)MemRead<uint16>(R[m]);
R[m] += 2;
m1 = (int16)MemRead<uint16>(R[n]);
R[n] += 2;
if(GetS())
{
int32 b = (int32)m0 * m1;
uint64 sum = (int64)(int32)MACL + b;
if(sum > 0x000000007FFFFFFFULL && sum < 0xFFFFFFFF80000000ULL)
{
MACH |= 1;
if(b < 0)
sum = 0x80000000ULL;
else
sum = 0x7FFFFFFFULL;
}
MACL = sum;
}
else
SetMAC64(GetMAC64() + (int64)m0 * m1);
timestamp++;
END_OP
//
// DMULS.L Rm,Rn
//
// Pipeline: page 215 (not implemented here totally correctly)
BEGIN_OP_DLYIDIF(DMULS_L_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint64 result = (int64)(int32)R[n] * (int32)R[m];
timestamp++;
MA_until = std::max<sscpu_timestamp_t>(std::max<sscpu_timestamp_t>(MA_until, MM_until), timestamp + 1);
MM_until = MA_until + 4;
PART_OP_NORMIDIF
MACL = result >> 0;
MACH = result >> 32;
END_OP
//
// DMULU.L Rm,Rn
//
// Pipeline: page 215 (not implemented here totally correctly)
BEGIN_OP_DLYIDIF(DMULU_L_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint64 result = (uint64)R[n] * R[m];
timestamp++;
MA_until = std::max<sscpu_timestamp_t>(std::max<sscpu_timestamp_t>(MA_until, MM_until), timestamp + 1);
MM_until = MA_until + 4;
PART_OP_NORMIDIF
MACL = result >> 0;
MACH = result >> 32;
END_OP
//
// MUL.L Rm,Rn
//
// Pipeline: page 215 (not implemented here totally correctly)
BEGIN_OP_DLYIDIF(MUL_L_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
timestamp++;
MA_until = std::max<sscpu_timestamp_t>(std::max<sscpu_timestamp_t>(MA_until, MM_until), timestamp + 1);
MM_until = MA_until + 4;
PART_OP_NORMIDIF
MACL = R[n] * R[m];
END_OP
//
// MULS.W Rm,Rn
//
// Pipeline: page 207
BEGIN_OP(MULS_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
MA_until = std::max<sscpu_timestamp_t>(std::max<sscpu_timestamp_t>(MA_until, MM_until), timestamp + 1);
MM_until = MA_until + 2;
MACL = (int16)R[n] * (int16)R[m];
END_OP
//
// MULU.W Rm,Rn
//
// Pipeline: page 207
BEGIN_OP(MULU_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
MA_until = std::max<sscpu_timestamp_t>(std::max<sscpu_timestamp_t>(MA_until, MM_until), timestamp + 1);
MM_until = MA_until + 2;
MACL = (uint32)(uint16)R[n] * (uint32)(uint16)R[m];
END_OP
//
// NEG Rm,Rn
//
BEGIN_OP(NEG_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = -R[m];
END_OP
//
// NEGC Rm,Rn
//
BEGIN_OP(NEGC_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint64 result = (uint64)0 - R[m] - GetT();
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = result;
SetT((result >> 32) & 1);
END_OP
//
// SUB Rm,Rn
//
BEGIN_OP(SUB_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = R[n] - R[m];
END_OP
//
// SUBC Rm,Rn
//
BEGIN_OP(SUBC_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint64 result = (uint64)R[n] - R[m] - GetT();
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = result;
SetT((result >> 32) & 1);
END_OP
//
// SUBV Rm,Rn
//
BEGIN_OP(SUBV_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const uint32 result = R[n] - R[m];
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT((((R[n] ^ R[m])) & (R[n] ^ result)) >> 31);
R[n] = result;
END_OP
//
// AND Rm,Rn
//
BEGIN_OP(AND_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = R[n] & R[m];
END_OP
//
// AND #imm,R0
//
BEGIN_OP(AND_IMM_REG0)
const unsigned imm = (uint8)instr;
WB_EX_CHECK(0)
R[0] = R[0] & imm;
END_OP
//
// AND.B #imm,@(R0,GBR)
//
BEGIN_OP(AND_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
const uint32 ea = R[0] + GBR;
uint32 tmp;
tmp = MemRead<uint8>(ea);
timestamp++;
tmp &= imm;
MemWrite<uint8>(ea, tmp);
timestamp++;
END_OP
//
// NOT Rm,Rn
//
BEGIN_OP(NOT_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = ~R[m];
END_OP
//
// OR Rm,Rn
//
BEGIN_OP(OR_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] |= R[m];
END_OP
//
// OR #imm,R0
//
BEGIN_OP(OR_IMM_REG0)
const unsigned imm = (uint8)instr;
WB_EX_CHECK(0)
R[0] |= imm;
END_OP
//
// OR.B #imm,@(R0,GBR)
//
BEGIN_OP(OR_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
const uint32 ea = R[0] + GBR;
uint32 tmp;
tmp = MemRead<uint8>(ea);
timestamp++;
tmp |= imm;
MemWrite<uint8>(ea, tmp);
timestamp++;
END_OP
//
// TAS.B @Rn
//
BEGIN_OP(TAS_B_REGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[n];
uint8 tmp;
SH7095_BusLock++;
tmp = ExtBusRead<uint8, false>(ea); // FIXME: Address error on invalid address(>= 0x40000000 ?).
timestamp = SH7095_mem_timestamp;
SetT(!tmp);
tmp |= 0x80;
MemWrite<uint8>(ea, tmp);
SH7095_BusLock--;
timestamp += 3;
END_OP
//
// TST Rm,Rn
//
BEGIN_OP(TST_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
SetT(!(R[n] & R[m]));
END_OP
//
// TST #imm,R0
//
BEGIN_OP(TST_IMM_REG0)
const unsigned imm = (uint8)instr;
WB_EX_CHECK(0)
SetT(!(R[0] & imm));
END_OP
//
// TST.B #imm,@(R0,GBR)
//
BEGIN_OP(TST_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
const uint32 ea = R[0] + GBR;
uint32 tmp;
tmp = MemRead<uint8>(ea);
timestamp++;
SetT(!(tmp & imm));
timestamp++;
END_OP
//
// XOR Rm,Rn
//
BEGIN_OP(XOR_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
WB_EX_CHECK(n)
WB_EX_CHECK(m)
R[n] = R[n] ^ R[m];
END_OP
//
// XOR #imm,R0
//
BEGIN_OP(XOR_IMM_REG0)
const unsigned imm = (uint8)instr;
WB_EX_CHECK(0)
R[0] = R[0] ^ imm;
END_OP
//
// XOR.B #imm,@(R0,GBR)
//
BEGIN_OP(XOR_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
const uint32 ea = R[0] + GBR;
uint32 tmp;
tmp = MemRead<uint8>(ea);
timestamp++;
tmp ^= imm;
MemWrite<uint8>(ea, tmp);
timestamp++;
END_OP
//
// ROTL Rn
//
BEGIN_OP(ROTL_REG)
const unsigned n = instr_nyb2;
const unsigned rotbit = R[n] >> 31;
WB_EX_CHECK(n)
R[n] = (R[n] << 1) | rotbit;
SetT(rotbit);
END_OP
//
// ROTR Rn
//
BEGIN_OP(ROTR_REG)
const unsigned n = instr_nyb2;
const unsigned rotbit = R[n] & 1;
WB_EX_CHECK(n)
R[n] = (R[n] >> 1) | (rotbit << 31);
SetT(rotbit);
END_OP
//
// ROTCL Rn
//
BEGIN_OP(ROTCL_REG)
const unsigned n = instr_nyb2;
const unsigned rotbit = R[n] >> 31;
WB_EX_CHECK(n)
R[n] = (R[n] << 1) | GetT();
SetT(rotbit);
END_OP
//
// ROTCR Rn
//
BEGIN_OP(ROTCR_REG)
const unsigned n = instr_nyb2;
const unsigned rotbit = R[n] & 1;
WB_EX_CHECK(n)
R[n] = (R[n] >> 1) | (GetT() << 31);
SetT(rotbit);
END_OP
//
// SHAR Rn
//
BEGIN_OP(SHAR_REG)
const unsigned n = instr_nyb2;
const unsigned shbit = R[n] & 1;
WB_EX_CHECK(n)
R[n] = (int32)R[n] >> 1;
SetT(shbit);
END_OP
//
// SHLL Rn
//
BEGIN_OP(SHLL_REG)
const unsigned n = instr_nyb2;
const unsigned shbit = R[n] >> 31;
WB_EX_CHECK(n)
R[n] <<= 1;
SetT(shbit);
END_OP
//
// SHLR Rn
//
BEGIN_OP(SHLR_REG)
const unsigned n = instr_nyb2;
const unsigned shbit = R[n] & 1;
WB_EX_CHECK(n)
R[n] >>= 1;
SetT(shbit);
END_OP
//
// SHLL2 Rn
//
BEGIN_OP(SHLL2_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n] <<= 2;
END_OP
//
// SHLR2 Rn
//
BEGIN_OP(SHLR2_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n] >>= 2;
END_OP
//
// SHLL8 Rn
//
BEGIN_OP(SHLL8_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n] <<= 8;
END_OP
//
// SHLR8 Rn
//
BEGIN_OP(SHLR8_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n] >>= 8;
END_OP
//
// SHLL16 Rn
//
BEGIN_OP(SHLL16_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n] <<= 16;
END_OP
//
// SHLR16 Rn
//
BEGIN_OP(SHLR16_REG)
const unsigned n = instr_nyb2;
WB_EX_CHECK(n)
R[n] >>= 16;
END_OP
//
// BF
//
BEGIN_OP(BF)
CondRelBranch<which, DebugMode, false>(!GetT(), (uint32)(int8)instr << 1);
END_OP
//
// BF/S
//
BEGIN_OP(BF_S)
CondRelBranch<which, DebugMode, true>(!GetT(), (uint32)(int8)instr << 1);
END_OP
//
// BT
//
BEGIN_OP(BT)
CondRelBranch<which, DebugMode, false>(GetT(), (uint32)(int8)instr << 1);
END_OP
//
// BT/S
//
BEGIN_OP(BT_S)
CondRelBranch<which, DebugMode, true>(GetT(), (uint32)(int8)instr << 1);
END_OP
//
// BRA
//
BEGIN_OP_DLYIDIF(BRA)
UCRelDelayBranch<which, DebugMode>((uint32)sign_x_to_s32(12, instr) << 1);
END_OP
//
// BRAF Rm
//
BEGIN_OP_DLYIDIF(BRAF_REG)
const unsigned m = instr_nyb2;
UCRelDelayBranch<which, DebugMode>(R[m]);
END_OP
//
// BSR
//
BEGIN_OP_DLYIDIF(BSR)
PR = PC;
UCRelDelayBranch<which, DebugMode>((uint32)sign_x_to_s32(12, instr) << 1);
END_OP
//
// BSRF Rm
//
BEGIN_OP_DLYIDIF(BSRF_REG)
const unsigned m = instr_nyb2;
PR = PC;
UCRelDelayBranch<which, DebugMode>(R[m]);
END_OP
//
// JMP @Rm
//
BEGIN_OP_DLYIDIF(JMP_REGINDIR)
const unsigned m = instr_nyb2;
UCDelayBranch<which, DebugMode>(R[m]);
END_OP
//
// JSR @Rm
//
BEGIN_OP_DLYIDIF(JSR_REGINDIR)
const unsigned m = instr_nyb2;
PR = PC;
UCDelayBranch<which, DebugMode>(R[m]);
END_OP
//
// RTS
//
BEGIN_OP_DLYIDIF(RTS)
UCDelayBranch<which, DebugMode>(PR);
END_OP
//
// CLRT
//
BEGIN_OP(CLRT)
SetT(false);
END_OP
//
// CLRMAC
//
BEGIN_OP(CLRMAC)
MACH = 0;
MACL = 0;
END_OP
//
// LDC
//
BEGIN_OP_DLYIDIF(LDC)
const unsigned m = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
CtrlRegs[cri] = R[m];
if(cri == 0)
{
SR &= 0x3F3;
RecalcPendingIntPEX();
}
PART_OP_INTDIS
END_OP
//
// LDC.L
//
// Pipeline: page 233
//
BEGIN_OP_DLYIDIF(LDC_L)
const unsigned m = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
uint32 ea;
ea = R[m];
R[m] += 4;
timestamp++;
CtrlRegs[cri] = MemRead<uint32>(ea);
if(cri == 0)
{
SR &= 0x3F3;
RecalcPendingIntPEX();
}
timestamp++;
PART_OP_INTDIS
END_OP
//
// LDS
//
BEGIN_OP_DLYIDIF(LDS)
const unsigned m = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
SysRegs[sri] = R[m];
PART_OP_INTDIS
END_OP
//
// LDS.L
//
BEGIN_OP_DLYIDIF(LDS_L) // Pipeline same as ordinary load instruction
const unsigned m = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
uint32 ea;
ea = R[m];
R[m] += 4;
PART_OP_INTDIS
SysRegs[sri] = MemRead<uint32>(ea);
//printf(" LDS.L: (0x%08x)->0x%08x\n", ea, SysRegs[sri]);
END_OP
//
// NOP
//
BEGIN_OP(NOP)
END_OP
//
// RTE
//
// Pipeline: page 241
//
BEGIN_OP(RTE)
uint32 new_PC;
new_PC = MemRead<uint32>(R[15]);
R[15] += 4;
SR = MemRead<uint32>(R[15]);
RecalcPendingIntPEX();
R[15] += 4;
timestamp++;
Branch<which, DebugMode, true>(new_PC);
END_OP
//
// SETT
//
BEGIN_OP(SETT)
SetT(true);
END_OP
//
// SLEEP
//
BEGIN_OP_DLYIDIF(SLEEP)
//
// Standby mode time yay?
//
if(MDFN_UNLIKELY(SBYCR & 0x80))
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Entering standby mode.\n", cpu_name);
for(unsigned ch = 0; ch < 2; ch++)
{
DMACH[ch].CHCR = 0x00;
DMACH[ch].CHCRM = 0x00;
}
DMAOR = 0x00;
RecalcPendingIntPEX();
//
//
FRT_Reset();
//
//
WDT_StandbyReset();
//
//
timestamp++;
Pipe_ID = (Pipe_ID & 0x00FFFFFF) | (0x7E << 24);
Standby = true;
return;
}
if(MDFN_LIKELY(!EPending))
{
timestamp += 3;
return;
}
else
{
DoIDIF<which, DebugMode, false, false, false>();
}
END_OP
BEGIN_OP_DLYIDIF(PSEUDO_STANDBY)
if(MDFN_LIKELY(Standby))
{
timestamp += 7;
return;
}
else
{
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Exiting standby mode.\n", cpu_name);
FRT_Reset(); // Reset again(for the counter) because we didn't stop clocking it.
DoIDIF<which, DebugMode, false, false, false>();
}
END_OP
//
// STC
//
BEGIN_OP_DLYIDIF(STC)
const unsigned n = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
R[n] = CtrlRegs[cri];
PART_OP_INTDIS
END_OP
//
// STC.L
//
// pipeline: page 234
BEGIN_OP_DLYIDIF(STC_L)
const unsigned n = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
uint32 ea;
R[n] -= 4;
ea = R[n];
MemWrite<uint32>(ea, CtrlRegs[cri]);
timestamp++;
PART_OP_INTDIS
END_OP
//
// STS
//
BEGIN_OP_DLYIDIF(STS)
const unsigned n = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
R[n] = SysRegs[sri];
PART_OP_INTDIS
END_OP
//
// STS.L
//
BEGIN_OP_DLYIDIF(STS_L) // Pipeline same as ordinary store instruction
const unsigned n = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
uint32 ea;
R[n] -= 4;
ea = R[n];
//printf(" STS.L: 0x%08x->(0x%08x)\n", SysRegs[sri], ea);
MemWrite<uint32>(ea, SysRegs[sri]);
PART_OP_INTDIS
END_OP
//
// TRAPA #imm
//
// Saved PC is the address of the instruction after the TRAPA instruction
//
BEGIN_OP_DLYIDIF(TRAPA)
const unsigned imm = (uint8)instr;
PC -= 2;
Branch<which, -DebugMode, false>(Exception<DebugMode>(EXCEPTION_TRAP, imm));
END_OP
/*
**
**
*/
//
// Illegal Instruction
//
// Saved PC is the address of the illegal instruction.
//
BEGIN_OP_DLYIDIF(ILLEGAL)
PC -= 4;
Branch<which, -DebugMode, false>(Exception<DebugMode>(EXCEPTION_ILLINSTR, VECNUM_ILLINSTR));
END_OP
//
// Illegal Slot Instruction
//
// Saved PC is the effective target address of the jump.
//
BEGIN_OP_DLYIDIF(SLOT_ILLEGAL)
PC -= 2;
Branch<which, -DebugMode, false>(Exception<DebugMode>(EXCEPTION_ILLSLOT, VECNUM_ILLSLOT));
END_OP
//
// Pending exception(address error/interrupt)
//
BEGIN_OP_DLYIDIF(PSEUDO_EPENDING)
uint32 new_PC = 0;
//
// Priority here(listed highest to lowest):
// External halt
// Power
// Reset
// Pseudo DMA burst(hacky abusey thing to stall the CPU, should be above everything but reset/power and ext halt otherwise kaboom!).
// CPU address error
// DMA address error
// NMI
// Interrupt (final else, may be called quasi-spuriously)
//
#define TPP(x) (Pipe_ID & (1U << ((x) + EPENDING_PEXBITS_SHIFT)))
//
// Test against Pipe_ID, reset bits in EPending(if appropriate).
//
if(MDFN_UNLIKELY(TPP(PEX_PSEUDO_EXTHALT)))
{
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Ext halt begin: Pipe_ID=0x%08x PC=0x%08x\n", cpu_name, Pipe_ID, PC);
Pipe_ID = (Pipe_ID & 0x00FFFFFF) | (0xFE << 24);
return;
}
else if(MDFN_UNLIKELY(TPP(PEX_POWERON) || TPP(PEX_RESET)))
{
if(TPP(PEX_POWERON))
{
EPending = 0;
new_PC = Exception<DebugMode>(EXCEPTION_POWERON, VECNUM_POWERON);
}
else
{
EPending = 0;
new_PC = Exception<DebugMode>(EXCEPTION_RESET, VECNUM_RESET);
}
}
else if(MDFN_UNLIKELY(TPP(PEX_PSEUDO_DMABURST)))
{
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Burst begin: Pipe_ID=0x%08x PC=0x%08x\n", cpu_name, Pipe_ID, PC);
Pipe_ID = (Pipe_ID & 0x00FFFFFF) | (0xFE << 24);
return;
}
else if(MDFN_UNLIKELY(TPP(PEX_CPUADDR)))
{
PC -= 4;
ClearPEX(PEX_CPUADDR);
new_PC = Exception<DebugMode>(EXCEPTION_CPUADDR, VECNUM_CPUADDR);
ClearPEX(PEX_CPUADDR); // Infinite recursive address errors are not good(stack wraparound could clobber backup memory).
}
else if(MDFN_UNLIKELY(TPP(PEX_DMAADDR)))
{
PC -= 4;
ClearPEX(PEX_DMAADDR);
new_PC = Exception<DebugMode>(EXCEPTION_DMAADDR, VECNUM_DMAADDR);
}
else if(TPP(PEX_NMI))
{
PC -= 4;
ClearPEX(PEX_NMI);
new_PC = Exception<DebugMode>(EXCEPTION_NMI, VECNUM_NMI);
//
//
//
SR |= 0xF << 4;
RecalcPendingIntPEX();
}
else // Int
{
uint8 ipr;
ipr = GetPendingInt(NULL);
if(MDFN_LIKELY(ipr > ((SR >> 4) & 0xF)))
{
uint8 vecnum;
// Note: GetPendingInt() may call ExIVecFetch(), which may call SetIRL with a new value, so be
// careful to use the "old" value here.
GetPendingInt(&vecnum);
PC -= 4;
new_PC = Exception<DebugMode>(EXCEPTION_INT, vecnum);
//
//
//
SR &= ~(0xF << 4);
SR |= ipr << 4;
RecalcPendingIntPEX();
}
else
{
//
// Can happen like so(note for future testing):
//
// (WDT interval timer IRQ pending here)
//
// WTCSR_R;
// asm volatile(
// "ldc %0,SR\n\t"
// "mov.w %2, @%1\n\t"
// :
// :"r"(0), "r"(0xFFFFFE88), "r"(0xA500 | 0x00)
// : "memory");
//
SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Spurious EPENDING. IPR=0x%02x SR=0x%04x EPending=0x%08x Pipe_ID=0x%08x PC=0x%08x\n", cpu_name, ipr, SR, EPending, Pipe_ID, PC);
Pipe_ID = (uint16)Pipe_ID;
Pipe_ID |= InstrDecodeTab[Pipe_ID] << 24;
goto SPEPRecover;
}
}
//
//
//
Branch<which, -DebugMode, false>(new_PC);
END_OP
BEGIN_OP_DLYIDIF(PSEUDO_DMABURST)
if(MDFN_LIKELY(DMA_InBurst() || ExtHalt))
{
timestamp += 7;
return;
}
else
{
ClearPEX(PEX_PSEUDO_DMABURST);
ClearPEX(PEX_PSEUDO_EXTHALT);
//
// Recover Pipe_ID opcode field; only use Pipe_ID for this, not EPending, otherwise
// we may accidentally allow an interrupt to occur immediately after an interrupt-disabled instruction.
//
Pipe_ID &= 0x00FFFFFF;
Pipe_ID &= ~(1U << (PEX_PSEUDO_DMABURST + EPENDING_PEXBITS_SHIFT));
Pipe_ID &= ~(1U << (PEX_PSEUDO_EXTHALT + EPENDING_PEXBITS_SHIFT));
Pipe_ID |= InstrDecodeTab[(uint16)Pipe_ID] << 24;
if(Pipe_ID & (0xFF << EPENDING_PEXBITS_SHIFT))
Pipe_ID |= EPENDING_OP_OR;
//SS_DBG(SS_DBG_WARNING | SS_DBG_SH2, "[%s] Burst/External halt end: Pipe_ID=0x%08x PC=0x%08x\n", cpu_name, Pipe_ID, PC);
return;
}
END_OP
#undef BEGIN_OP
#undef BEGIN_OP_DLYIDIF
#undef END_OP
}
PC += 2;
}
//
//
//
//
//
//
//
//
INLINE uint32 SH7095::GetRegister(const unsigned id, char* const special, const uint32 special_len)
{
uint32 ret = 0xDEADBEEF;
switch(id)
{
case GSREG_PC_ID:
ret = PC_ID;
break;
case GSREG_PC_IF:
ret = PC_IF;
break;
case GSREG_PID:
ret = Pipe_ID;
break;
case GSREG_PIF:
ret = Pipe_IF;
break;
case GSREG_EP:
ret = EPending;
break;
case GSREG_RPC:
ret = PC;
break;
case GSREG_R0: case GSREG_R1: case GSREG_R2: case GSREG_R3: case GSREG_R4: case GSREG_R5: case GSREG_R6: case GSREG_R7:
case GSREG_R8: case GSREG_R9: case GSREG_R10: case GSREG_R11: case GSREG_R12: case GSREG_R13: case GSREG_R14: case GSREG_R15:
ret = R[id - GSREG_R0];
break;
case GSREG_SR:
ret = SR;
break;
case GSREG_GBR:
ret = GBR;
break;
case GSREG_VBR:
ret = VBR;
break;
case GSREG_MACH:
ret = MACH;
break;
case GSREG_MACL:
ret = MACL;
break;
case GSREG_PR:
ret = PR;
break;
//
//
//
case GSREG_NMIL:
ret = NMILevel;
break;
case GSREG_IRL:
ret = IRL;
break;
case GSREG_IPRA:
ret = IPRA;
break;
case GSREG_IPRB:
ret = IPRB;
break;
case GSREG_VCRWDT:
ret = VCRWDT;
break;
case GSREG_VCRA:
ret = VCRA;
break;
case GSREG_VCRB:
ret = VCRB;
break;
case GSREG_VCRC:
ret = VCRC;
if(special)
{
trio_snprintf(special, special_len, "FIC: 0x%02x, FOC: 0x%02x", (ret >> 8) & 0x7F, ret & 0x7F);
}
break;
case GSREG_VCRD:
ret = VCRD;
break;
case GSREG_ICR:
ret = ICR;
break;
//
//
//
case GSREG_DVSR:
ret = DVSR;
break;
case GSREG_DVDNT:
ret = DVDNT;
break;
case GSREG_DVDNTH:
ret = DVDNTH;
break;
case GSREG_DVDNTL:
ret = DVDNTL;
break;
case GSREG_DVDNTHS:
ret = DVDNTH_Shadow;
break;
case GSREG_DVDNTLS:
ret = DVDNTL_Shadow;
break;
case GSREG_VCRDIV:
ret = VCRDIV;
break;
case GSREG_DVCR:
ret = DVCR;
break;
//
//
//
case GSREG_WTCSR:
ret = WDT.WTCSR;
break;
case GSREG_WTCSRM:
ret = WDT.WTCSRM;
break;
case GSREG_WTCNT:
ret = WDT.WTCNT;
break;
case GSREG_RSTCSR:
ret = WDT.RSTCSR;
break;
case GSREG_RSTCSRM:
ret = WDT.RSTCSRM;
break;
//
//
//
case GSREG_DMAOR:
ret = DMAOR;
break;
case GSREG_DMAORM:
ret = DMAORM;
break;
case GSREG_DMA0_SAR:
case GSREG_DMA1_SAR:
ret = DMACH[id == GSREG_DMA1_SAR].SAR;
break;
case GSREG_DMA0_DAR:
case GSREG_DMA1_DAR:
ret = DMACH[id == GSREG_DMA1_DAR].DAR;
break;
case GSREG_DMA0_TCR:
case GSREG_DMA1_TCR:
ret = DMACH[id == GSREG_DMA1_TCR].TCR;
break;
case GSREG_DMA0_CHCR:
case GSREG_DMA1_CHCR:
ret = DMACH[id == GSREG_DMA1_CHCR].CHCR;
break;
case GSREG_DMA0_CHCRM:
case GSREG_DMA1_CHCRM:
ret = DMACH[id == GSREG_DMA1_CHCRM].CHCRM;
break;
case GSREG_DMA0_VCR:
case GSREG_DMA1_VCR:
ret = DMACH[id == GSREG_DMA1_VCR].VCR;
break;
case GSREG_DMA0_DRCR:
case GSREG_DMA1_DRCR:
ret = DMACH[id == GSREG_DMA1_DRCR].DRCR;
break;
//
//
//
case GSREG_FRC:
ret = FRT.FRC;
break;
case GSREG_OCR0:
ret = FRT.OCR[0];
break;
case GSREG_OCR1:
ret = FRT.OCR[1];
break;
case GSREG_FICR:
ret = FRT.FICR;
break;
case GSREG_TIER:
ret = FRT.TIER;
break;
case GSREG_FTCSR:
ret = FRT.FTCSR;
break;
case GSREG_FTCSRM:
ret = FRT.FTCSRM;
break;
case GSREG_TCR:
ret = FRT.TCR;
break;
case GSREG_TOCR:
ret = FRT.TOCR;
break;
case GSREG_RWT:
ret = FRT.RW_Temp;
break;
}
return ret;
}
void SH7095::SetRegister(const unsigned id, const uint32 value)
{
switch(id)
{
//case GSREG_PC: break;
case GSREG_PID:
Pipe_ID = value;
break;
case GSREG_PIF:
Pipe_IF = value;
break;
//case GSREG_EP:
// EPending = value;
// break;
case GSREG_RPC:
PC = value;
break;
case GSREG_R0: case GSREG_R1: case GSREG_R2: case GSREG_R3: case GSREG_R4: case GSREG_R5: case GSREG_R6: case GSREG_R7:
case GSREG_R8: case GSREG_R9: case GSREG_R10: case GSREG_R11: case GSREG_R12: case GSREG_R13: case GSREG_R14: case GSREG_R15:
R[id - GSREG_R0] = value;
break;
case GSREG_SR:
SR = value & 0x3F3;
RecalcPendingIntPEX();
break;
case GSREG_GBR:
GBR = value;
break;
case GSREG_VBR:
VBR = value;
break;
case GSREG_MACH:
MACH = value;
break;
case GSREG_MACL:
MACL = value;
break;
case GSREG_PR:
PR = value;
break;
//
//
//
case GSREG_FTCSR:
FRT.FTCSR = value & 0x8F;
RecalcPendingIntPEX();
FRT_CheckOCR();
break;
case GSREG_FTCSRM:
FRT.FTCSRM = value & 0x8F;
break;
}
}
//
//
//
//
//
//
//
void MDFN_COLD SH7095::Disassemble(const uint16 instr, const uint32 PC, char* buffer, uint16 (*DisPeek16)(uint32), uint32 (*DisPeek32)(uint32))
{
static const char* CR_Names[3] = { "SR", "GBR", "VBR" };
static const char* SR_Names[3] = { "MACH", "MACL", "PR" };
const unsigned instr_nyb1 = (instr >> 4) & 0xF;
const unsigned instr_nyb2 = (instr >> 8) & 0xF;
switch(InstrDecodeTab[instr])
{
#define BEGIN_DIS_OP(x) OP_##x {
#define END_DIS_OP } break;
default:
trio_sprintf(buffer, ".word 0x%04x", instr);
break;
//
// MOV #imm,Rn
//
BEGIN_DIS_OP(MOV_IMM_REG)
const unsigned n = instr_nyb2;
const int32 imm = (int8)instr;
trio_sprintf(buffer, "MOV #%d,R%u", imm, n);
END_DIS_OP
//
// MOV.W @(disp,PC),Rn
//
BEGIN_DIS_OP(MOV_W_PCREL_REG)
const unsigned n = instr_nyb2;
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = PC + (d << 1);
trio_sprintf(buffer, "MOV.W @(0x%03x,PC),R%u ! 0x%04x", (d << 1), n, DisPeek16(ea));
END_DIS_OP
//
// MOV.L @(disp,PC),Rn
//
BEGIN_DIS_OP(MOV_L_PCREL_REG)
const unsigned n = instr_nyb2;
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = (PC &~ 0x3) + (d << 2);
trio_sprintf(buffer, "MOV.L @(0x%03x,PC),R%u ! 0x%08x", (d << 2), n, DisPeek32(ea));
END_DIS_OP
//
// MOV Rm,Rn
//
BEGIN_DIS_OP(MOV_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV R%u,R%u", m, n);
END_DIS_OP
//
// MOV.B Rm,@Rn
//
BEGIN_DIS_OP(MOV_B_REG_REGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.B R%u,@R%u", m, n);
END_DIS_OP
//
// MOV.W Rm,@Rn
//
BEGIN_DIS_OP(MOV_W_REG_REGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.W R%u,@R%u", m, n);
END_DIS_OP
//
// MOV.L Rm,@Rn
//
BEGIN_DIS_OP(MOV_L_REG_REGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.L R%u,@R%u", m, n);
END_DIS_OP
//
// MOV.B @Rm,Rn
//
BEGIN_DIS_OP(MOV_B_REGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.B @R%u,R%u", m, n);
END_DIS_OP
//
// MOV.W @Rm,Rn
//
BEGIN_DIS_OP(MOV_W_REGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.W @R%u,R%u", m, n);
END_DIS_OP
//
// MOV.L @Rm,Rn
//
BEGIN_DIS_OP(MOV_L_REGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.L @R%u,R%u", m, n);
END_DIS_OP
//
// MOV.B Rm,@-Rn
//
BEGIN_DIS_OP(MOV_B_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.B R%u,@-R%u", m, n);
END_DIS_OP
//
// MOV.W Rm,@-Rn
//
BEGIN_DIS_OP(MOV_W_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.W R%u,@-R%u", m, n);
END_DIS_OP
//
// MOV.L Rm,@-Rn
//
BEGIN_DIS_OP(MOV_L_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.L R%u,@-R%u", m, n);
END_DIS_OP
//
// MOV.B @Rm+,Rn
//
BEGIN_DIS_OP(MOV_B_REGINDIRPI_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.B @R%u+,R%u", m, n);
END_DIS_OP
//
// MOV.W @Rm+,Rn
//
BEGIN_DIS_OP(MOV_W_REGINDIRPI_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.W @R%u+,R%u", m, n);
END_DIS_OP
//
// MOV.L @Rm+,Rn
//
BEGIN_DIS_OP(MOV_L_REGINDIRPI_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.L @R%u+,R%u", m, n);
END_DIS_OP
//
// MOV.B R0,@(disp,Rn)
//
BEGIN_DIS_OP(MOV_B_REG0_REGINDIRDISP)
const unsigned n = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
trio_sprintf(buffer, "MOV.B R0,@(%u,R%u)", (d << 0), n);
END_DIS_OP
//
// MOV.W R0,@(disp,Rn)
//
BEGIN_DIS_OP(MOV_W_REG0_REGINDIRDISP)
const unsigned n = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
trio_sprintf(buffer, "MOV.W R0,@(%u,R%u)", (d << 1), n);
END_DIS_OP
//
// MOV.L Rm,@(disp,Rn)
//
BEGIN_DIS_OP(MOV_L_REG_REGINDIRDISP)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
trio_sprintf(buffer, "MOV.L R%u,@(%u,R%u)", m, (d << 2), n);
END_DIS_OP
//
// MOV.B @(disp,Rm),R0
//
BEGIN_DIS_OP(MOV_B_REGINDIRDISP_REG0)
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
trio_sprintf(buffer, "MOV.B @(%u,R%u),R0", (d << 0), m);
END_DIS_OP
//
// MOV.W @(disp,Rm),R0
//
BEGIN_DIS_OP(MOV_W_REGINDIRDISP_REG0)
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
trio_sprintf(buffer, "MOV.W @(%u,R%u),R0", (d << 1), m);
END_DIS_OP
//
// MOV.L @(disp,Rm),Rn
//
BEGIN_DIS_OP(MOV_L_REGINDIRDISP_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
trio_sprintf(buffer, "MOV.L @(%u,R%u),R%u", (d << 2), m, n);
END_DIS_OP
//
// MOV.B Rm,@(R0,Rn)
//
BEGIN_DIS_OP(MOV_B_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.B R%u,@(R0,R%u)", m, n);
END_DIS_OP
//
// MOV.W Rm,@(R0,Rn)
//
BEGIN_DIS_OP(MOV_W_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.W R%u,@(R0,R%u)", m, n);
END_DIS_OP
//
// MOV.L Rm,@(R0,Rn)
//
BEGIN_DIS_OP(MOV_L_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.L R%u,@(R0,R%u)", m, n);
END_DIS_OP
//
// MOV.B @(R0,Rm),Rn
//
BEGIN_DIS_OP(MOV_B_IDXREGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.B @(R0,R%u),R%u", m, n);
END_DIS_OP
//
// MOV.W @(R0,Rm),Rn
//
BEGIN_DIS_OP(MOV_W_IDXREGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.W @(R0,R%u),R%u", m, n);
END_DIS_OP
//
// MOV.L @(R0,Rm),Rn
//
BEGIN_DIS_OP(MOV_L_IDXREGINDIR_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MOV.L @(R0,R%u),R%u", m, n);
END_DIS_OP
//
// MOV.B R0,@(disp,GBR)
//
BEGIN_DIS_OP(MOV_B_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
trio_sprintf(buffer, "MOV.B R0,@(%u,GBR)", (d << 0));
END_DIS_OP
//
// MOV.W R0,@(disp,GBR)
//
BEGIN_DIS_OP(MOV_W_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
trio_sprintf(buffer, "MOV.W R0,@(%u,GBR)", (d << 1));
END_DIS_OP
//
// MOV.L R0,@(disp,GBR)
//
BEGIN_DIS_OP(MOV_L_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
trio_sprintf(buffer, "MOV.L R0,@(%u,GBR)", (d << 2));
END_DIS_OP
//
// MOV.B @(disp,GBR),R0
//
BEGIN_DIS_OP(MOV_B_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
trio_sprintf(buffer, "MOV.B @(%u,GBR),R0", (d << 0));
END_DIS_OP
//
// MOV.W @(disp,GBR),R0
//
BEGIN_DIS_OP(MOV_W_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
trio_sprintf(buffer, "MOV.W @(%u,GBR),R0", (d << 1));
END_DIS_OP
//
// MOV.L @(disp,GBR),R0
//
BEGIN_DIS_OP(MOV_L_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
trio_sprintf(buffer, "MOV.L @(%u,GBR),R0", (d << 2));
END_DIS_OP
//
// MOVA @(disp,PC),R0
//
BEGIN_DIS_OP(MOVA_PCREL_REG0)
const unsigned d = (instr >> 0) & 0xff;
trio_sprintf(buffer, "MOVA @(%u,PC),R0", (d << 2));
END_DIS_OP
//
// MOVT Rn
//
BEGIN_DIS_OP(MOVT_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "MOVT R%u", n);
END_DIS_OP
//
// SWAP.B Rm,Rn
//
BEGIN_DIS_OP(SWAP_B_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "SWAP.B R%u,R%u", m, n);
END_DIS_OP
//
// SWAP.W Rm,Rn
//
BEGIN_DIS_OP(SWAP_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "SWAP.W R%u,R%u", m, n);
END_DIS_OP
//
// XTRCT Rm,Rn
//
BEGIN_DIS_OP(XTRCT_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "XTRCT R%u,R%u", m, n);
END_DIS_OP
//
// ADD Rm,Rn
//
BEGIN_DIS_OP(ADD_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "ADD R%u,R%u", m, n);
END_DIS_OP
//
// ADD #imm,Rn
//
BEGIN_DIS_OP(ADD_IMM_REG)
const unsigned n = instr_nyb2;
const int32 imm = (int8)instr;
trio_sprintf(buffer, "ADD #%d,R%u", imm, n);
END_DIS_OP
//
// ADDC Rm,Rn
//
BEGIN_DIS_OP(ADDC_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "ADDC R%u,R%u", m, n);
END_DIS_OP
//
// ADDV Rm,Rn
//
BEGIN_DIS_OP(ADDV_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "ADDV R%u,R%u", m, n);
END_DIS_OP
//
// CMP/EQ #imm,R0
//
BEGIN_DIS_OP(CMP_EQ_IMM_REG0)
const int32 imm = (int8)instr;
trio_sprintf(buffer, "CMP/EQ #%d,R0", imm);
END_DIS_OP
//
// CMP/EQ Rm,Rn
//
BEGIN_DIS_OP(CMP_EQ_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "CMP/EQ R%u,R%u", m, n);
END_DIS_OP
//
// CMP/HS Rm,Rn
//
BEGIN_DIS_OP(CMP_HS_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "CMP/HS R%u,R%u", m, n);
END_DIS_OP
//
// CMP/GE Rm,Rn
//
BEGIN_DIS_OP(CMP_GE_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "CMP/GE R%u,R%u", m, n);
END_DIS_OP
//
// CMP/HI Rm,Rn
//
BEGIN_DIS_OP(CMP_HI_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "CMP/HI R%u,R%u", m, n);
END_DIS_OP
//
// CMP/GT Rm,Rn
//
BEGIN_DIS_OP(CMP_GT_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "CMP/GT R%u,R%u", m, n);
END_DIS_OP
//
// CMP/PZ Rn
//
BEGIN_DIS_OP(CMP_PZ_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "CMP/PZ R%u", n);
END_DIS_OP
//
// CMP/PL Rn
//
BEGIN_DIS_OP(CMP_PL_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "CMP/PL R%u", n);
END_DIS_OP
//
// CMP/STR Rm,Rn
//
BEGIN_DIS_OP(CMP_STR_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "CMP/STR R%u,R%u", m, n);
END_DIS_OP
//
// DIV1 Rm,Rn
//
BEGIN_DIS_OP(DIV1_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "DIV1 R%u,R%u", m, n);
END_DIS_OP
//
// DIV0S Rm,Rn
//
BEGIN_DIS_OP(DIV0S_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "DIV0S R%u,R%u", m, n);
END_DIS_OP
//
// DIV0U
//
BEGIN_DIS_OP(DIV0U)
trio_sprintf(buffer, "DIV0U");
END_DIS_OP
//
// DMULS.L Rm,Rn
//
BEGIN_DIS_OP(DMULS_L_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "DMULS.L R%u,R%u", m, n);
END_DIS_OP
//
// DMULU.L Rm,Rn
//
BEGIN_DIS_OP(DMULU_L_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "DMULU.L R%u,R%u", m, n);
END_DIS_OP
//
// DT Rn
//
BEGIN_DIS_OP(DT)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "DT R%u", n);
END_DIS_OP
//
// EXTS.B Rm,Rn
//
BEGIN_DIS_OP(EXTS_B_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "EXTS.B R%u,R%u", m, n);
END_DIS_OP
//
// EXTS.W Rm,Rn
//
BEGIN_DIS_OP(EXTS_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "EXTS.W R%u,R%u", m, n);
END_DIS_OP
//
// EXTU.B Rm,Rn
//
BEGIN_DIS_OP(EXTU_B_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "EXTU.B R%u,R%u", m, n);
END_DIS_OP
//
// EXTU.W Rm,Rn
//
BEGIN_DIS_OP(EXTU_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "EXTU.W R%u,R%u", m, n);
END_DIS_OP
//
// MAC.L @Rm+,@Rn+
//
BEGIN_DIS_OP(MAC_L)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MAC.L @R%u+,@R%u+", m, n);
END_DIS_OP
//
// MAC.W @Rm+,@Rn+
//
BEGIN_DIS_OP(MAC_W)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MAC.W @R%u+,@R%u+", m, n);
END_DIS_OP
//
// MUL.L Rm,Rn
//
BEGIN_DIS_OP(MUL_L_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MUL.L R%u,R%u", m, n);
END_DIS_OP
//
// MULS.W Rm,Rn
//
BEGIN_DIS_OP(MULS_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MULS.W R%u,R%u", m, n);
END_DIS_OP
//
// MULU.W Rm,Rn
//
BEGIN_DIS_OP(MULU_W_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "MULU.W R%u,R%u", m, n);
END_DIS_OP
//
// NEG Rm,Rn
//
BEGIN_DIS_OP(NEG_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "NEG R%u,R%u", m, n);
END_DIS_OP
//
// NEGC Rm,Rn
//
BEGIN_DIS_OP(NEGC_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "NEGC R%u,R%u", m, n);
END_DIS_OP
//
// SUB Rm,Rn
//
BEGIN_DIS_OP(SUB_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "SUB R%u,R%u", m, n);
END_DIS_OP
//
// SUBC Rm,Rn
//
BEGIN_DIS_OP(SUBC_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "SUBC R%u,R%u", m, n);
END_DIS_OP
//
// SUBV Rm,Rn
//
BEGIN_DIS_OP(SUBV_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "SUBV R%u,R%u", m, n);
END_DIS_OP
//
// AND Rm,Rn
//
BEGIN_DIS_OP(AND_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "AND R%u,R%u", m, n);
END_DIS_OP
//
// AND #imm,R0
//
BEGIN_DIS_OP(AND_IMM_REG0)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "AND #%u,R0", imm);
END_DIS_OP
//
// AND.B #imm,@(R0,GBR)
//
BEGIN_DIS_OP(AND_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "AND.B #%u,@(R0,GBR)", imm);
END_DIS_OP
//
// NOT Rm,Rn
//
BEGIN_DIS_OP(NOT_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "NOT R%u,R%u", m, n);
END_DIS_OP
//
// OR Rm,Rn
//
BEGIN_DIS_OP(OR_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "OR R%u,R%u", m, n);
END_DIS_OP
//
// OR #imm,R0
//
BEGIN_DIS_OP(OR_IMM_REG0)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "OR #%u,R0", imm);
END_DIS_OP
//
// OR.B #imm,@(R0,GBR)
//
BEGIN_DIS_OP(OR_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "OR.B #%u,@(R0,GBR)", imm);
END_DIS_OP
//
// TAS.B @Rn
//
BEGIN_DIS_OP(TAS_B_REGINDIR)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "TAS.B @R%u", n);
END_DIS_OP
//
// TST Rm,Rn
//
BEGIN_DIS_OP(TST_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "TST R%u,R%u", m, n);
END_DIS_OP
//
// TST #imm,R0
//
BEGIN_DIS_OP(TST_IMM_REG0)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "TST #%u,R0", imm);
END_DIS_OP
//
// TST.B #imm,@(R0,GBR)
//
BEGIN_DIS_OP(TST_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "TST.B #%u,@(R0,GBR)", imm);
END_DIS_OP
//
// XOR Rm,Rn
//
BEGIN_DIS_OP(XOR_REG_REG)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
trio_sprintf(buffer, "XOR R%u,R%u", m, n);
END_DIS_OP
//
// XOR #imm,R0
//
BEGIN_DIS_OP(XOR_IMM_REG0)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "XOR #%u,R0", imm);
END_DIS_OP
//
// XOR.B #imm,@(R0,GBR)
//
BEGIN_DIS_OP(XOR_B_IMM_IDXGBRINDIR)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "XOR.B #%u,@(R0,GBR)", imm);
END_DIS_OP
//
// ROTL Rn
//
BEGIN_DIS_OP(ROTL_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "ROTL R%u", n);
END_DIS_OP
//
// ROTR Rn
//
BEGIN_DIS_OP(ROTR_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "ROTR R%u", n);
END_DIS_OP
//
// ROTCL Rn
//
BEGIN_DIS_OP(ROTCL_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "ROTCL R%u", n);
END_DIS_OP
//
// ROTCR Rn
//
BEGIN_DIS_OP(ROTCR_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "ROTCR R%u", n);
END_DIS_OP
//
// SHAR Rn
//
BEGIN_DIS_OP(SHAR_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHAR R%u", n);
END_DIS_OP
//
// SHLL Rn
//
BEGIN_DIS_OP(SHLL_REG)
const unsigned n = instr_nyb2;
if(instr & 0x20)
trio_sprintf(buffer, "SHAL R%u", n);
else
trio_sprintf(buffer, "SHLL R%u", n);
END_DIS_OP
//
// SHLR Rn
//
BEGIN_DIS_OP(SHLR_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHLR R%u", n);
END_DIS_OP
//
// SHLL2 Rn
//
BEGIN_DIS_OP(SHLL2_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHLL2 R%u", n);
END_DIS_OP
//
// SHLR2 Rn
//
BEGIN_DIS_OP(SHLR2_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHLR2 R%u", n);
END_DIS_OP
//
// SHLL8 Rn
//
BEGIN_DIS_OP(SHLL8_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHLL8 R%u", n);
END_DIS_OP
//
// SHLR8 Rn
//
BEGIN_DIS_OP(SHLR8_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHLR8 R%u", n);
END_DIS_OP
//
// SHLL16 Rn
//
BEGIN_DIS_OP(SHLL16_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHLL16 R%u", n);
END_DIS_OP
//
// SHLR16 Rn
//
BEGIN_DIS_OP(SHLR16_REG)
const unsigned n = instr_nyb2;
trio_sprintf(buffer, "SHLR16 R%u", n);
END_DIS_OP
//
// BF
//
BEGIN_DIS_OP(BF)
trio_sprintf(buffer, "BF 0x%08x", (uint32)(PC + ((uint32)(int8)instr << 1)));
END_DIS_OP
//
// BF/S
//
BEGIN_DIS_OP(BF_S)
trio_sprintf(buffer, "BF/S 0x%08x", (uint32)(PC + ((uint32)(int8)instr << 1)));
END_DIS_OP
//
// BT
//
BEGIN_DIS_OP(BT)
trio_sprintf(buffer, "BT 0x%08x", (uint32)(PC + ((uint32)(int8)instr << 1)));
END_DIS_OP
//
// BT/S
//
BEGIN_DIS_OP(BT_S)
trio_sprintf(buffer, "BT/S 0x%08x", (uint32)(PC + ((uint32)(int8)instr << 1)));
END_DIS_OP
//
// BRA
//
BEGIN_DIS_OP(BRA)
trio_sprintf(buffer, "BRA 0x%08x", (uint32)(PC + ((uint32)sign_x_to_s32(12, instr) << 1)));
END_DIS_OP
//
// BRAF Rm
//
BEGIN_DIS_OP(BRAF_REG)
const unsigned m = instr_nyb2;
trio_sprintf(buffer, "BRAF R%u", m);
END_DIS_OP
//
// BSR
//
BEGIN_DIS_OP(BSR)
trio_sprintf(buffer, "BSR 0x%08x", (uint32)(PC + ((uint32)sign_x_to_s32(12, instr) << 1)));
END_DIS_OP
//
// BSRF Rm
//
BEGIN_DIS_OP(BSRF_REG)
const unsigned m = instr_nyb2;
trio_sprintf(buffer, "BSRF R%u", m);
END_DIS_OP
//
// JMP @Rm
//
BEGIN_DIS_OP(JMP_REGINDIR)
const unsigned m = instr_nyb2;
trio_sprintf(buffer, "JMP @R%u", m);
END_DIS_OP
//
// JSR @Rm
//
BEGIN_DIS_OP(JSR_REGINDIR)
const unsigned m = instr_nyb2;
trio_sprintf(buffer, "JSR @R%u", m);
END_DIS_OP
//
// RTS
//
BEGIN_DIS_OP(RTS)
trio_sprintf(buffer, "RTS");
END_DIS_OP
//
// CLRT
//
BEGIN_DIS_OP(CLRT)
trio_sprintf(buffer, "CLRT");
END_DIS_OP
//
// CLRMAC
//
BEGIN_DIS_OP(CLRMAC)
trio_sprintf(buffer, "CLRMAC");
END_DIS_OP
//
// LDC
//
BEGIN_DIS_OP(LDC)
const unsigned m = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "LDC R%u, %s", m, CR_Names[cri]);
END_DIS_OP
//
// LDC.L
//
BEGIN_DIS_OP(LDC_L)
const unsigned m = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "LDC.L @R%u+, %s", m, CR_Names[cri]);
END_DIS_OP
//
// LDS
//
BEGIN_DIS_OP(LDS)
const unsigned m = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "LDS R%u, %s", m, SR_Names[sri]);
END_DIS_OP
//
// LDS.L
//
BEGIN_DIS_OP(LDS_L)
const unsigned m = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "LDS.L @R%u+, %s", m, SR_Names[sri]);
END_DIS_OP
//
// NOP
//
BEGIN_DIS_OP(NOP)
trio_sprintf(buffer, "NOP");
END_DIS_OP
//
// RTE
//
BEGIN_DIS_OP(RTE)
trio_sprintf(buffer, "RTE");
END_DIS_OP
//
// SETT
//
BEGIN_DIS_OP(SETT)
trio_sprintf(buffer, "SETT");
END_DIS_OP
//
// SLEEP
//
BEGIN_DIS_OP(SLEEP)
trio_sprintf(buffer, "SLEEP");
END_DIS_OP
//
// STC
//
BEGIN_DIS_OP(STC)
const unsigned n = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "STS %s, R%u", CR_Names[cri], n);
END_DIS_OP
//
// STC.L
//
BEGIN_DIS_OP(STC_L)
const unsigned n = instr_nyb2;
const unsigned cri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "STC.L %s, @-R%u", CR_Names[cri], n);
END_DIS_OP
//
// STS
//
BEGIN_DIS_OP(STS)
const unsigned n = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "STS %s, R%u", SR_Names[sri], n);
END_DIS_OP
//
// STS.L
//
BEGIN_DIS_OP(STS_L)
const unsigned n = instr_nyb2;
const unsigned sri = (instr >> 4) & 0x3;
trio_sprintf(buffer, "STS.L %s, @-R%u", SR_Names[sri], n);
END_DIS_OP
//
// TRAPA #imm
//
BEGIN_DIS_OP(TRAPA)
const unsigned imm = (uint8)instr;
trio_sprintf(buffer, "TRAPA #%u", imm);
END_DIS_OP
#undef BEGIN_DIS_OP
#undef END_DIS_OP
}
}
//
//
//
//
INLINE void SH7095::CheckRWBreakpoints(void (*MRead)(unsigned len, uint32 addr), void (*MWrite)(unsigned len, uint32 addr)) const
{
uint32 lpid = Pipe_ID;
//
//
//
//SPEPRecover:;
const uint32 instr = (uint16)lpid;
const unsigned instr_nyb1 = (instr >> 4) & 0xF;
const unsigned instr_nyb2 = (instr >> 8) & 0xF;
switch(lpid >> 24)
{
#include "sh7095_opdefs.inc"
#define BEGIN_BP_OP(x) OP_##x {
#define END_BP_OP } break;
//
// MOV.W @(disp,PC),Rn
//
BEGIN_BP_OP(MOV_W_PCREL_REG)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = PC + (d << 1);
MRead(2, ea);
END_BP_OP
//
// MOV.L @(disp,PC),Rn
//
BEGIN_BP_OP(MOV_L_PCREL_REG)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = (PC &~ 0x3) + (d << 2);
MRead(4, ea);
END_BP_OP
//
// MOV.B Rm,@Rn
//
BEGIN_BP_OP(MOV_B_REG_REGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[n];
MWrite(1, ea);
END_BP_OP
//
// MOV.W Rm,@Rn
//
BEGIN_BP_OP(MOV_W_REG_REGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[n];
MWrite(2, ea);
END_BP_OP
//
// MOV.L Rm,@Rn
//
BEGIN_BP_OP(MOV_L_REG_REGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[n];
MWrite(4, ea);
END_BP_OP
//
// MOV.B @Rm,Rn
//
BEGIN_BP_OP(MOV_B_REGINDIR_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
MRead(1, ea);
END_BP_OP
//
// MOV.W @Rm,Rn
//
BEGIN_BP_OP(MOV_W_REGINDIR_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
MRead(2, ea);
END_BP_OP
//
// MOV.L @Rm,Rn
//
BEGIN_BP_OP(MOV_L_REGINDIR_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
MRead(4, ea);
END_BP_OP
//
// MOV.B Rm,@-Rn
//
BEGIN_BP_OP(MOV_B_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const uint32 ea = R[n] - 1;
MWrite(1, ea);
END_BP_OP
//
// MOV.W Rm,@-Rn
//
BEGIN_BP_OP(MOV_W_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const uint32 ea = R[n] - 2;
MWrite(2, ea);
END_BP_OP
//
// MOV.L Rm,@-Rn
//
BEGIN_BP_OP(MOV_L_REG_REGINDIRPD)
const unsigned n = instr_nyb2;
const uint32 ea = R[n] - 4;
MWrite(4, ea);
END_BP_OP
//
// MOV.B @Rm+,Rn
//
BEGIN_BP_OP(MOV_B_REGINDIRPI_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
MRead(1, ea);
END_BP_OP
//
// MOV.W @Rm+,Rn
//
BEGIN_BP_OP(MOV_W_REGINDIRPI_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
MRead(2, ea);
END_BP_OP
//
// MOV.L @Rm+,Rn
//
BEGIN_BP_OP(MOV_L_REGINDIRPI_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[m];
MRead(4, ea);
END_BP_OP
//
// MOV.B R0,@(disp,Rn)
//
BEGIN_BP_OP(MOV_B_REG0_REGINDIRDISP)
const unsigned n = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[n] + (d << 0);
MWrite(1, ea);
END_BP_OP
//
// MOV.W R0,@(disp,Rn)
//
BEGIN_BP_OP(MOV_W_REG0_REGINDIRDISP)
const unsigned n = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[n] + (d << 1);
MWrite(2, ea);
END_BP_OP
//
// MOV.L Rm,@(disp,Rn)
//
BEGIN_BP_OP(MOV_L_REG_REGINDIRDISP)
const unsigned n = instr_nyb2;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[n] + (d << 2);
MWrite(4, ea);
END_BP_OP
//
// MOV.B @(disp,Rm),R0
//
BEGIN_BP_OP(MOV_B_REGINDIRDISP_REG0)
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[m] + (d << 0);
MRead(1, ea);
END_BP_OP
//
// MOV.W @(disp,Rm),R0
//
BEGIN_BP_OP(MOV_W_REGINDIRDISP_REG0)
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[m] + (d << 1);
MRead(2, ea);
END_BP_OP
//
// MOV.L @(disp,Rm),Rn
//
BEGIN_BP_OP(MOV_L_REGINDIRDISP_REG)
const unsigned m = instr_nyb1;
const unsigned d = (instr >> 0) & 0xf;
const uint32 ea = R[m] + (d << 2);
MRead(4, ea);
END_BP_OP
//
// MOV.B Rm,@(R0,Rn)
//
BEGIN_BP_OP(MOV_B_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[0] + R[n];
MWrite(1, ea);
END_BP_OP
//
// MOV.W Rm,@(R0,Rn)
//
BEGIN_BP_OP(MOV_W_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[0] + R[n];
MWrite(2, ea);
END_BP_OP
//
// MOV.L Rm,@(R0,Rn)
//
BEGIN_BP_OP(MOV_L_REG_IDXREGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[0] + R[n];
MWrite(4, ea);
END_BP_OP
//
// MOV.B @(R0,Rm),Rn
//
BEGIN_BP_OP(MOV_B_IDXREGINDIR_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[m];
MRead(1, ea);
END_BP_OP
//
// MOV.W @(R0,Rm),Rn
//
BEGIN_BP_OP(MOV_W_IDXREGINDIR_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[m];
MRead(2, ea);
END_BP_OP
//
// MOV.L @(R0,Rm),Rn
//
BEGIN_BP_OP(MOV_L_IDXREGINDIR_REG)
const unsigned m = instr_nyb1;
const uint32 ea = R[0] + R[m];
MRead(4, ea);
END_BP_OP
//
// MOV.B R0,@(disp,GBR)
//
BEGIN_BP_OP(MOV_B_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 0);
MWrite(1, ea);
END_BP_OP
//
// MOV.W R0,@(disp,GBR)
//
BEGIN_BP_OP(MOV_W_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 1);
MWrite(2, ea);
END_BP_OP
//
// MOV.L R0,@(disp,GBR)
//
BEGIN_BP_OP(MOV_L_REG0_GBRINDIRDISP)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 2);
MWrite(4, ea);
END_BP_OP
//
// MOV.B @(disp,GBR),R0
//
BEGIN_BP_OP(MOV_B_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 0);
MRead(1, ea);
END_BP_OP
//
// MOV.W @(disp,GBR),R0
//
BEGIN_BP_OP(MOV_W_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 1);
MRead(2, ea);
END_BP_OP
//
// MOV.L @(disp,GBR),R0
//
BEGIN_BP_OP(MOV_L_GBRINDIRDISP_REG0)
const unsigned d = (instr >> 0) & 0xff;
const uint32 ea = GBR + (d << 2);
MRead(4, ea);
END_BP_OP
//
// MAC.L @Rm+,@Rn+
//
BEGIN_BP_OP(MAC_L)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
MRead(4, R[m]);
MRead(4, R[n] + ((m == n) << 2));
END_BP_OP
//
// MAC.W @Rm+,@Rn+
//
BEGIN_BP_OP(MAC_W)
const unsigned n = instr_nyb2;
const unsigned m = instr_nyb1;
MRead(2, R[m]);
MRead(2, R[n] + ((m == n) << 1));
END_BP_OP
//
// AND.B #imm,@(R0,GBR)
//
BEGIN_BP_OP(AND_B_IMM_IDXGBRINDIR)
const uint32 ea = R[0] + GBR;
MRead(1, ea);
MWrite(1, ea);
END_BP_OP
//
// OR.B #imm,@(R0,GBR)
//
BEGIN_BP_OP(OR_B_IMM_IDXGBRINDIR)
const uint32 ea = R[0] + GBR;
MRead(1, ea);
MWrite(1, ea);
END_BP_OP
//
// TAS.B @Rn
//
BEGIN_BP_OP(TAS_B_REGINDIR)
const unsigned n = instr_nyb2;
const uint32 ea = R[n];
MRead(1, ea);
MWrite(1, ea);
END_BP_OP
//
// TST.B #imm,@(R0,GBR)
//
BEGIN_BP_OP(TST_B_IMM_IDXGBRINDIR)
const uint32 ea = R[0] + GBR;
MRead(1, ea);
END_BP_OP
//
// XOR.B #imm,@(R0,GBR)
//
BEGIN_BP_OP(XOR_B_IMM_IDXGBRINDIR)
const uint32 ea = R[0] + GBR;
MRead(1, ea);
MWrite(1, ea);
END_BP_OP
//
// LDC.L
//
BEGIN_BP_OP(LDC_L)
const unsigned m = instr_nyb2;
const uint32 ea = R[m];
MRead(4, ea);
END_BP_OP
//
// LDS.L
//
BEGIN_BP_OP(LDS_L)
const unsigned m = instr_nyb2;
const uint32 ea = R[m];
MRead(4, ea);
END_BP_OP
//
// RTE
//
BEGIN_BP_OP(RTE)
MRead(4, R[15]);
MRead(4, 4 + R[15]);
END_BP_OP
//
// STC.L
//
BEGIN_BP_OP(STC_L)
const unsigned n = instr_nyb2;
const uint32 ea = R[n] - 4;
MWrite(4, ea);
END_BP_OP
//
// STS.L
//
BEGIN_BP_OP(STS_L) // Pipeline same as ordinary store instruction
const unsigned n = instr_nyb2;
const uint32 ea = R[n] - 4;
MWrite(4, ea);
END_BP_OP
#if 0
//
// TRAPA #imm
//
// Saved PC is the address of the instruction after the TRAPA instruction
//
BEGIN_BP_OP_DLYIDIF(TRAPA)
const unsigned imm = (uint8)instr;
BP_EXCEPT(EXCEPTION_TRAP, imm);
END_BP_OP
//
// Illegal Instruction
//
BEGIN_BP_OP_DLYIDIF(ILLEGAL)
BP_EXCEPT(EXCEPTION_ILLINSTR, VECNUM_ILLINSTR);
END_BP_OP
//
// Illegal Slot Instruction
//
BEGIN_BP_OP_DLYIDIF(SLOT_ILLEGAL)
BP_EXCEPT(EXCEPTION_ILLSLOT, VECNUM_ILLSLOT);
END_BP_OP
//
// Pending exception(address error/interrupt)
//
BEGIN_BP_OP_DLYIDIF(PSEUDO_EPENDING)
#define TPP(x) (Pipe_ID & (1U << ((x) + EPENDING_PEXBITS_SHIFT)))
if(MDFN_UNLIKELY(TPP(PEX_PSEUDO_EXTHALT)))
return;
else if(MDFN_UNLIKELY(TPP(PEX_POWERON) || TPP(PEX_RESET)))
{
if(TPP(PEX_POWERON))
BP_EXCEPT(EXCEPTION_POWERON, VECNUM_POWERON);
else
BP_EXCEPT(EXCEPTION_RESET, VECNUM_RESET);
}
else if(MDFN_UNLIKELY(TPP(PEX_PSEUDO_DMABURST)))
return;
else if(MDFN_UNLIKELY(TPP(PEX_CPUADDR)))
BP_EXCEPT(EXCEPTION_CPUADDR, VECNUM_CPUADDR);
else if(MDFN_UNLIKELY(TPP(PEX_DMAADDR)))
BP_EXCEPT(EXCEPTION_DMAADDR, VECNUM_DMAADDR);
else if(TPP(PEX_NMI))
BP_EXCEPT(EXCEPTION_NMI, VECNUM_NMI);
else // Int
{
uint8 ipr = GetPendingInt(NULL);
if(MDFN_LIKELY(ipr > ((SR >> 4) & 0xF)))
{
uint8 vecnum;
// Note: GetPendingInt() may call ExIVecFetch(), which may call SetIRL with a new value, so be
// careful to use the "old" value here.
GetPendingInt(&vecnum);
BP_EXCEPT(EXCEPTION_INT, vecnum);
}
else
{
lpid = (uint16)lpid;
lpid |= InstrDecodeTab[lpid] << 24;
goto SPEPRecover;
}
}
END_BP_OP
#endif
#undef BEGIN_BP_OP
#undef END_BP_OP
}
}
Reference in New Issue View Git Blame Copy Permalink