2084 lines
60 KiB
C#
2084 lines
60 KiB
C#
#undef DPCM_SYNCCLOCK
|
|
|
|
using System;
|
|
|
|
namespace VirtualNes.Core
|
|
{
|
|
public class CPU
|
|
{
|
|
private static int nmicount;
|
|
|
|
// 6502 status flags
|
|
public const byte C_FLAG = 0x01; // 1: Carry
|
|
public const byte Z_FLAG = 0x02; // 1: Zero
|
|
public const byte I_FLAG = 0x04; // 1: Irq disabled
|
|
public const byte D_FLAG = 0x08; // 1: Decimal mode flag (NES unused)
|
|
public const byte B_FLAG = 0x10; // 1: Break
|
|
public const byte R_FLAG = 0x20; // 1: Reserved (Always 1)
|
|
public const byte V_FLAG = 0x40; // 1: Overflow
|
|
public const byte N_FLAG = 0x80; // 1: Negative
|
|
|
|
// Interrupt
|
|
public const byte NMI_FLAG = 0x01;
|
|
public const byte IRQ_FLAG = 0x02;
|
|
|
|
public const byte IRQ_FRAMEIRQ = 0x04;
|
|
public const byte IRQ_DPCM = 0x08;
|
|
public const byte IRQ_MAPPER = 0x10;
|
|
public const byte IRQ_MAPPER2 = 0x20;
|
|
public const byte IRQ_TRIGGER = 0x40; // one shot(媽IRQ())
|
|
public const byte IRQ_TRIGGER2 = 0x80; // one shot(媽IRQ_NotPending())
|
|
|
|
public static readonly byte IRQ_MASK = unchecked((byte)(~(NMI_FLAG | IRQ_FLAG)));
|
|
|
|
// Vector
|
|
public const ushort NMI_VECTOR = 0xFFFA;
|
|
public const ushort RES_VECTOR = 0xFFFC;
|
|
public const ushort IRQ_VECTOR = 0xFFFE;
|
|
|
|
private NES nes;
|
|
private bool m_bClockProcess;
|
|
private int TOTAL_cycles;
|
|
private int DMA_cycles;
|
|
private Mapper mapper;
|
|
private APU apu;
|
|
internal R6502 R = new R6502();
|
|
private byte[] ZN_Table = new byte[256];
|
|
private ArrayRef<byte> STACK;
|
|
|
|
public CPU(NES parent)
|
|
{
|
|
nes = parent;
|
|
m_bClockProcess = false;
|
|
|
|
}
|
|
|
|
public void Dispose() { }
|
|
|
|
ushort EA = 0;
|
|
ushort ET = 0;
|
|
ushort WT = 0;
|
|
byte DT = 0;
|
|
int exec_cycles = 0;
|
|
|
|
internal long EXEC(int request_cycles)
|
|
{
|
|
byte opcode = 0;
|
|
int OLD_cycles = TOTAL_cycles;
|
|
byte nmi_request = 0, irq_request = 0;
|
|
bool bClockProcess = m_bClockProcess;
|
|
|
|
exec_cycles = 0;
|
|
EA = 0;
|
|
ET = 0;
|
|
WT = 0;
|
|
DT = 0;
|
|
|
|
while (request_cycles > 0)
|
|
{
|
|
exec_cycles = 0;
|
|
if (DMA_cycles > 0)
|
|
{
|
|
if (request_cycles <= DMA_cycles)
|
|
{
|
|
DMA_cycles -= request_cycles;
|
|
TOTAL_cycles += request_cycles;
|
|
|
|
mapper.Clock(request_cycles);
|
|
#if DPCM_SYNCCLOCK
|
|
apu.SyncDPCM(request_cycles);
|
|
#endif
|
|
if (m_bClockProcess)
|
|
{
|
|
nes.Clock(request_cycles);
|
|
}
|
|
|
|
goto _execute_exit;
|
|
}
|
|
else
|
|
{
|
|
exec_cycles += DMA_cycles;
|
|
DMA_cycles = 0;
|
|
}
|
|
}
|
|
|
|
nmi_request = irq_request = 0;
|
|
opcode = OP6502(R.PC++);
|
|
|
|
if (R.INT_pending != 0)
|
|
{
|
|
if ((R.INT_pending & NMI_FLAG) != 0)
|
|
{
|
|
nmi_request = 0xFF;
|
|
byte temp = unchecked((byte)(~NMI_FLAG));
|
|
R.INT_pending &= temp;
|
|
}
|
|
else if ((R.INT_pending & IRQ_MASK) != 0)
|
|
{
|
|
byte temp = unchecked((byte)(~IRQ_TRIGGER2));
|
|
R.INT_pending &= temp;
|
|
if (
|
|
((R.P & I_FLAG) == 0)
|
|
&&
|
|
(opcode != 0x40)
|
|
)
|
|
{
|
|
irq_request = 0xFF;
|
|
temp = unchecked((byte)(~IRQ_TRIGGER));
|
|
R.INT_pending &= temp;
|
|
}
|
|
}
|
|
}
|
|
|
|
switch (opcode)
|
|
{
|
|
case 0x69: // ADC #$??
|
|
MR_IM(); ADC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x65: // ADC $??
|
|
MR_ZP(); ADC();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x75: // ADC $??,X
|
|
MR_ZX(); ADC();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x6D: // ADC $????
|
|
MR_AB(); ADC();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x7D: // ADC $????,X
|
|
MR_AX(); ADC(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x79: // ADC $????,Y
|
|
MR_AY(); ADC(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x61: // ADC ($??,X)
|
|
MR_IX(); ADC();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x71: // ADC ($??),Y
|
|
MR_IY(); ADC(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0xE9: // SBC #$??
|
|
MR_IM(); SBC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xE5: // SBC $??
|
|
MR_ZP(); SBC();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xF5: // SBC $??,X
|
|
MR_ZX(); SBC();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xED: // SBC $????
|
|
MR_AB(); SBC();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xFD: // SBC $????,X
|
|
MR_AX(); SBC(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xF9: // SBC $????,Y
|
|
MR_AY(); SBC(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xE1: // SBC ($??,X)
|
|
MR_IX(); SBC();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xF1: // SBC ($??),Y
|
|
MR_IY(); SBC(); CHECK_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0xC6: // DEC $??
|
|
MR_ZP(); DEC(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xD6: // DEC $??,X
|
|
MR_ZX(); DEC(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xCE: // DEC $????
|
|
MR_AB(); DEC(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xDE: // DEC $????,X
|
|
MR_AX(); DEC(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
|
|
case 0xCA: // DEX
|
|
DEX();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x88: // DEY
|
|
DEY();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0xE6: // INC $??
|
|
MR_ZP(); INC(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xF6: // INC $??,X
|
|
MR_ZX(); INC(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xEE: // INC $????
|
|
MR_AB(); INC(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xFE: // INC $????,X
|
|
MR_AX(); INC(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
|
|
case 0xE8: // INX
|
|
INX();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xC8: // INY
|
|
INY();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x29: // AND #$??
|
|
MR_IM(); AND();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x25: // AND $??
|
|
MR_ZP(); AND();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x35: // AND $??,X
|
|
MR_ZX(); AND();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x2D: // AND $????
|
|
MR_AB(); AND();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x3D: // AND $????,X
|
|
MR_AX(); AND(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x39: // AND $????,Y
|
|
MR_AY(); AND(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x21: // AND ($??,X)
|
|
MR_IX(); AND();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x31: // AND ($??),Y
|
|
MR_IY(); AND(); CHECK_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0x0A: // ASL A
|
|
ASL_A();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x06: // ASL $??
|
|
MR_ZP(); ASL(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x16: // ASL $??,X
|
|
MR_ZX(); ASL(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x0E: // ASL $????
|
|
MR_AB(); ASL(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x1E: // ASL $????,X
|
|
MR_AX(); ASL(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
|
|
case 0x24: // BIT $??
|
|
MR_ZP(); BIT();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x2C: // BIT $????
|
|
MR_AB(); BIT();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0x49: // EOR #$??
|
|
MR_IM(); EOR();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x45: // EOR $??
|
|
MR_ZP(); EOR();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x55: // EOR $??,X
|
|
MR_ZX(); EOR();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x4D: // EOR $????
|
|
MR_AB(); EOR();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x5D: // EOR $????,X
|
|
MR_AX(); EOR(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x59: // EOR $????,Y
|
|
MR_AY(); EOR(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x41: // EOR ($??,X)
|
|
MR_IX(); EOR();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x51: // EOR ($??),Y
|
|
MR_IY(); EOR(); CHECK_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0x4A: // LSR A
|
|
LSR_A();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x46: // LSR $??
|
|
MR_ZP(); LSR(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x56: // LSR $??,X
|
|
MR_ZX(); LSR(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x4E: // LSR $????
|
|
MR_AB(); LSR(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x5E: // LSR $????,X
|
|
MR_AX(); LSR(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
|
|
case 0x09: // ORA #$??
|
|
MR_IM(); ORA();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x05: // ORA $??
|
|
MR_ZP(); ORA();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x15: // ORA $??,X
|
|
MR_ZX(); ORA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x0D: // ORA $????
|
|
MR_AB(); ORA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x1D: // ORA $????,X
|
|
MR_AX(); ORA(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x19: // ORA $????,Y
|
|
MR_AY(); ORA(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x01: // ORA ($??,X)
|
|
MR_IX(); ORA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x11: // ORA ($??),Y
|
|
MR_IY(); ORA(); CHECK_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0x2A: // ROL A
|
|
ROL_A();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x26: // ROL $??
|
|
MR_ZP(); ROL(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x36: // ROL $??,X
|
|
MR_ZX(); ROL(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x2E: // ROL $????
|
|
MR_AB(); ROL(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x3E: // ROL $????,X
|
|
MR_AX(); ROL(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
|
|
case 0x6A: // ROR A
|
|
ROR_A();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x66: // ROR $??
|
|
MR_ZP(); ROR(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x76: // ROR $??,X
|
|
MR_ZX(); ROR(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x6E: // ROR $????
|
|
MR_AB(); ROR(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x7E: // ROR $????,X
|
|
MR_AX(); ROR(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
|
|
case 0xA9: // LDA #$??
|
|
MR_IM(); LDA();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xA5: // LDA $??
|
|
MR_ZP(); LDA();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xB5: // LDA $??,X
|
|
MR_ZX(); LDA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xAD: // LDA $????
|
|
MR_AB(); LDA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xBD: // LDA $????,X
|
|
MR_AX(); LDA(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xB9: // LDA $????,Y
|
|
MR_AY(); LDA(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xA1: // LDA ($??,X)
|
|
MR_IX(); LDA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xB1: // LDA ($??),Y
|
|
MR_IY(); LDA(); CHECK_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0xA2: // LDX #$??
|
|
MR_IM(); LDX();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xA6: // LDX $??
|
|
MR_ZP(); LDX();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xB6: // LDX $??,Y
|
|
MR_ZY(); LDX();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xAE: // LDX $????
|
|
MR_AB(); LDX();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xBE: // LDX $????,Y
|
|
MR_AY(); LDX(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0xA0: // LDY #$??
|
|
MR_IM(); LDY();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xA4: // LDY $??
|
|
MR_ZP(); LDY();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xB4: // LDY $??,X
|
|
MR_ZX(); LDY();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xAC: // LDY $????
|
|
MR_AB(); LDY();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xBC: // LDY $????,X
|
|
MR_AX(); LDY(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0x85: // STA $??
|
|
EA_ZP(); STA(); MW_ZP();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x95: // STA $??,X
|
|
EA_ZX(); STA(); MW_ZP();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x8D: // STA $????
|
|
EA_AB(); STA(); MW_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x9D: // STA $????,X
|
|
EA_AX(); STA(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x99: // STA $????,Y
|
|
EA_AY(); STA(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x81: // STA ($??,X)
|
|
EA_IX(); STA(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x91: // STA ($??),Y
|
|
EA_IY(); STA(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
|
|
case 0x86: // STX $??
|
|
EA_ZP(); STX(); MW_ZP();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x96: // STX $??,Y
|
|
EA_ZY(); STX(); MW_ZP();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x8E: // STX $????
|
|
EA_AB(); STX(); MW_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0x84: // STY $??
|
|
EA_ZP(); STY(); MW_ZP();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x94: // STY $??,X
|
|
EA_ZX(); STY(); MW_ZP();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x8C: // STY $????
|
|
EA_AB(); STY(); MW_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0xAA: // TAX
|
|
TAX();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x8A: // TXA
|
|
TXA();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xA8: // TAY
|
|
TAY();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x98: // TYA
|
|
TYA();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xBA: // TSX
|
|
TSX();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x9A: // TXS
|
|
TXS();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0xC9: // CMP #$??
|
|
MR_IM(); CMP_();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xC5: // CMP $??
|
|
MR_ZP(); CMP_();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xD5: // CMP $??,X
|
|
MR_ZX(); CMP_();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xCD: // CMP $????
|
|
MR_AB(); CMP_();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xDD: // CMP $????,X
|
|
MR_AX(); CMP_(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xD9: // CMP $????,Y
|
|
MR_AY(); CMP_(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xC1: // CMP ($??,X)
|
|
MR_IX(); CMP_();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xD1: // CMP ($??),Y
|
|
MR_IY(); CMP_(); CHECK_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0xE0: // CPX #$??
|
|
MR_IM(); CPX();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xE4: // CPX $??
|
|
MR_ZP(); CPX();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xEC: // CPX $????
|
|
MR_AB(); CPX();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0xC0: // CPY #$??
|
|
MR_IM(); CPY();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xC4: // CPY $??
|
|
MR_ZP(); CPY();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xCC: // CPY $????
|
|
MR_AB(); CPY();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0x90: // BCC
|
|
MR_IM(); BCC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xB0: // BCS
|
|
MR_IM(); BCS();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xF0: // BEQ
|
|
MR_IM(); BEQ();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x30: // BMI
|
|
MR_IM(); BMI();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xD0: // BNE
|
|
MR_IM(); BNE();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x10: // BPL
|
|
MR_IM(); BPL();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x50: // BVC
|
|
MR_IM(); BVC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x70: // BVS
|
|
MR_IM(); BVS();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x4C: // JMP $????
|
|
JMP();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x6C: // JMP ($????)
|
|
JMP_ID();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0x20: // JSR
|
|
JSR();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
|
|
case 0x40: // RTI
|
|
RTI();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x60: // RTS
|
|
RTS();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
|
|
// フラグ制御系
|
|
case 0x18: // CLC
|
|
CLC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xD8: // CLD
|
|
CLD();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x58: // CLI
|
|
CLI();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xB8: // CLV
|
|
CLV();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x38: // SEC
|
|
SEC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0xF8: // SED
|
|
SED();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x78: // SEI
|
|
SEI();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
// スタック系
|
|
case 0x48: // PHA
|
|
PUSH(R.A);
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x08: // PHP
|
|
PUSH((byte)(R.P | B_FLAG));
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x68: // PLA (N-----Z-)
|
|
R.A = POP();
|
|
SET_ZN_FLAG(R.A);
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x28: // PLP
|
|
R.P = (byte)(POP() | R_FLAG);
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
// その他
|
|
case 0x00: // BRK
|
|
BRK();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
|
|
case 0xEA: // NOP
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
// 未公開命令群
|
|
case 0x0B: // ANC #$??
|
|
case 0x2B: // ANC #$??
|
|
MR_IM(); ANC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x8B: // ANE #$??
|
|
MR_IM(); ANE();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x6B: // ARR #$??
|
|
MR_IM(); ARR();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x4B: // ASR #$??
|
|
MR_IM(); ASR();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0xC7: // DCP $??
|
|
MR_ZP(); DCP(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xD7: // DCP $??,X
|
|
MR_ZX(); DCP(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xCF: // DCP $????
|
|
MR_AB(); DCP(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xDF: // DCP $????,X
|
|
MR_AX(); DCP(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0xDB: // DCP $????,Y
|
|
MR_AY(); DCP(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0xC3: // DCP ($??,X)
|
|
MR_IX(); DCP(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
case 0xD3: // DCP ($??),Y
|
|
MR_IY(); DCP(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
|
|
case 0xE7: // ISB $??
|
|
MR_ZP(); ISB(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xF7: // ISB $??,X
|
|
MR_ZX(); ISB(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xEF: // ISB $????
|
|
MR_AB(); ISB(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xFF: // ISB $????,X
|
|
MR_AX(); ISB(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xFB: // ISB $????,Y
|
|
MR_AY(); ISB(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xE3: // ISB ($??,X)
|
|
MR_IX(); ISB(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0xF3: // ISB ($??),Y
|
|
MR_IY(); ISB(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0xBB: // LAS $????,Y
|
|
MR_AY(); LAS(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
|
|
case 0xA7: // LAX $??
|
|
MR_ZP(); LAX();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0xB7: // LAX $??,Y
|
|
MR_ZY(); LAX();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xAF: // LAX $????
|
|
MR_AB(); LAX();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xBF: // LAX $????,Y
|
|
MR_AY(); LAX(); CHECK_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0xA3: // LAX ($??,X)
|
|
MR_IX(); LAX();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0xB3: // LAX ($??),Y
|
|
MR_IY(); LAX(); CHECK_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0xAB: // LXA #$??
|
|
MR_IM(); LXA();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x27: // RLA $??
|
|
MR_ZP(); RLA(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x37: // RLA $??,X
|
|
MR_ZX(); RLA(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x2F: // RLA $????
|
|
MR_AB(); RLA(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x3F: // RLA $????,X
|
|
MR_AX(); RLA(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x3B: // RLA $????,Y
|
|
MR_AY(); RLA(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x23: // RLA ($??,X)
|
|
MR_IX(); RLA(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
case 0x33: // RLA ($??),Y
|
|
MR_IY(); RLA(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
|
|
case 0x67: // RRA $??
|
|
MR_ZP(); RRA(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x77: // RRA $??,X
|
|
MR_ZX(); RRA(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x6F: // RRA $????
|
|
MR_AB(); RRA(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x7F: // RRA $????,X
|
|
MR_AX(); RRA(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x7B: // RRA $????,Y
|
|
MR_AY(); RRA(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x63: // RRA ($??,X)
|
|
MR_IX(); RRA(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
case 0x73: // RRA ($??),Y
|
|
MR_IY(); RRA(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
|
|
case 0x87: // SAX $??
|
|
MR_ZP(); SAX(); MW_ZP();
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x97: // SAX $??,Y
|
|
MR_ZY(); SAX(); MW_ZP();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x8F: // SAX $????
|
|
MR_AB(); SAX(); MW_EA();
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x83: // SAX ($??,X)
|
|
MR_IX(); SAX(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
|
|
case 0xCB: // SBX #$??
|
|
MR_IM(); SBX();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x9F: // SHA $????,Y
|
|
MR_AY(); SHA(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x93: // SHA ($??),Y
|
|
MR_IY(); SHA(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
|
|
case 0x9B: // SHS $????,Y
|
|
MR_AY(); SHS(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0x9E: // SHX $????,Y
|
|
MR_AY(); SHX(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0x9C: // SHY $????,X
|
|
MR_AX(); SHY(); MW_EA();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
|
|
case 0x07: // SLO $??
|
|
MR_ZP(); SLO(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x17: // SLO $??,X
|
|
MR_ZX(); SLO(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x0F: // SLO $????
|
|
MR_AB(); SLO(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x1F: // SLO $????,X
|
|
MR_AX(); SLO(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x1B: // SLO $????,Y
|
|
MR_AY(); SLO(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x03: // SLO ($??,X)
|
|
MR_IX(); SLO(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
case 0x13: // SLO ($??),Y
|
|
MR_IY(); SLO(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
|
|
case 0x47: // SRE $??
|
|
MR_ZP(); SRE(); MW_ZP();
|
|
ADD_CYCLE(5);
|
|
break;
|
|
case 0x57: // SRE $??,X
|
|
MR_ZX(); SRE(); MW_ZP();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x4F: // SRE $????
|
|
MR_AB(); SRE(); MW_EA();
|
|
ADD_CYCLE(6);
|
|
break;
|
|
case 0x5F: // SRE $????,X
|
|
MR_AX(); SRE(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x5B: // SRE $????,Y
|
|
MR_AY(); SRE(); MW_EA();
|
|
ADD_CYCLE(7);
|
|
break;
|
|
case 0x43: // SRE ($??,X)
|
|
MR_IX(); SRE(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
case 0x53: // SRE ($??),Y
|
|
MR_IY(); SRE(); MW_EA();
|
|
ADD_CYCLE(8);
|
|
break;
|
|
|
|
case 0xEB: // SBC #$?? (Unofficial)
|
|
MR_IM(); SBC();
|
|
ADD_CYCLE(2);
|
|
break;
|
|
|
|
case 0x1A: // NOP (Unofficial)
|
|
case 0x3A: // NOP (Unofficial)
|
|
case 0x5A: // NOP (Unofficial)
|
|
case 0x7A: // NOP (Unofficial)
|
|
case 0xDA: // NOP (Unofficial)
|
|
case 0xFA: // NOP (Unofficial)
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x80: // DOP (CYCLES 2)
|
|
case 0x82: // DOP (CYCLES 2)
|
|
case 0x89: // DOP (CYCLES 2)
|
|
case 0xC2: // DOP (CYCLES 2)
|
|
case 0xE2: // DOP (CYCLES 2)
|
|
R.PC++;
|
|
ADD_CYCLE(2);
|
|
break;
|
|
case 0x04: // DOP (CYCLES 3)
|
|
case 0x44: // DOP (CYCLES 3)
|
|
case 0x64: // DOP (CYCLES 3)
|
|
R.PC++;
|
|
ADD_CYCLE(3);
|
|
break;
|
|
case 0x14: // DOP (CYCLES 4)
|
|
case 0x34: // DOP (CYCLES 4)
|
|
case 0x54: // DOP (CYCLES 4)
|
|
case 0x74: // DOP (CYCLES 4)
|
|
case 0xD4: // DOP (CYCLES 4)
|
|
case 0xF4: // DOP (CYCLES 4)
|
|
R.PC++;
|
|
ADD_CYCLE(4);
|
|
break;
|
|
case 0x0C: // TOP
|
|
case 0x1C: // TOP
|
|
case 0x3C: // TOP
|
|
case 0x5C: // TOP
|
|
case 0x7C: // TOP
|
|
case 0xDC: // TOP
|
|
case 0xFC: // TOP
|
|
R.PC += 2;
|
|
ADD_CYCLE(4);
|
|
break;
|
|
|
|
case 0x02: /* JAM */
|
|
case 0x12: /* JAM */
|
|
case 0x22: /* JAM */
|
|
case 0x32: /* JAM */
|
|
case 0x42: /* JAM */
|
|
case 0x52: /* JAM */
|
|
case 0x62: /* JAM */
|
|
case 0x72: /* JAM */
|
|
case 0x92: /* JAM */
|
|
case 0xB2: /* JAM */
|
|
case 0xD2: /* JAM */
|
|
case 0xF2: /* JAM */
|
|
default:
|
|
if (!Supporter.S.Config.emulator.bIllegalOp)
|
|
{
|
|
throw new Exception("IllegalOp");
|
|
}
|
|
else
|
|
{
|
|
R.PC--;
|
|
ADD_CYCLE(4);
|
|
}
|
|
break;
|
|
// default:
|
|
// __assume(0);
|
|
}
|
|
|
|
if (nmi_request != 0)
|
|
{
|
|
_NMI();
|
|
}
|
|
else
|
|
if (irq_request != 0)
|
|
{
|
|
_IRQ();
|
|
}
|
|
|
|
request_cycles -= exec_cycles;
|
|
TOTAL_cycles += exec_cycles;
|
|
|
|
mapper.Clock(exec_cycles);
|
|
#if DPCM_SYNCCLOCK
|
|
apu->SyncDPCM( exec_cycles );
|
|
#endif
|
|
if (bClockProcess)
|
|
{
|
|
nes.Clock(exec_cycles);
|
|
}
|
|
}
|
|
_execute_exit:
|
|
#if !DPCM_SYNCCLOCK
|
|
apu.SyncDPCM(TOTAL_cycles - OLD_cycles);
|
|
#endif
|
|
return TOTAL_cycles - OLD_cycles;
|
|
}
|
|
private void _IRQ()
|
|
{
|
|
PUSH((byte)(R.PC >> 8));
|
|
PUSH((byte)(R.PC & 0xFF));
|
|
CLR_FLAG(B_FLAG);
|
|
PUSH(R.P);
|
|
SET_FLAG(I_FLAG);
|
|
R.PC = RD6502W(IRQ_VECTOR);
|
|
exec_cycles += 7;
|
|
}
|
|
|
|
|
|
private ushort RD6502W(ushort addr)
|
|
{
|
|
if (addr < 0x2000)
|
|
{
|
|
// RAM (Mirror $0800, $1000, $1800)
|
|
return BitConverter.ToUInt16(MMU.RAM, addr & 0x07FF);
|
|
}
|
|
else if (addr < 0x8000)
|
|
{
|
|
// Others
|
|
return (ushort)(nes.Read(addr) + nes.Read((ushort)(addr + 1)) * 0x100);
|
|
}
|
|
|
|
var temp = MMU.CPU_MEM_BANK[addr >> 13];
|
|
shortTemp[0] = temp[addr & 0x1FFF];
|
|
shortTemp[1] = temp[(addr & 0x1FFF) + 1];
|
|
return BitConverter.ToUInt16(shortTemp, 0);
|
|
}
|
|
|
|
private void SET_FLAG(byte V)
|
|
{
|
|
R.P |= (V);
|
|
}
|
|
|
|
private void CLR_FLAG(byte V)
|
|
{
|
|
var temp = (byte)(~V);
|
|
R.P &= temp;
|
|
}
|
|
|
|
private void _NMI()
|
|
{
|
|
PUSH((byte)(R.PC >> 8));
|
|
PUSH((byte)(R.PC & 0xFF));
|
|
CLR_FLAG(B_FLAG);
|
|
PUSH(R.P);
|
|
SET_FLAG(I_FLAG);
|
|
R.PC = RD6502W(NMI_VECTOR);
|
|
exec_cycles += 7;
|
|
}
|
|
|
|
private void SRE()
|
|
{
|
|
TST_FLAG((DT & 0x01) != 0, C_FLAG);
|
|
DT >>= 1;
|
|
R.A ^= DT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void SLO()
|
|
{
|
|
TST_FLAG((DT & 0x80) != 0, C_FLAG);
|
|
DT <<= 1;
|
|
R.A |= DT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void SHY()
|
|
{
|
|
DT = (byte)(R.Y & ((EA >> 8) + 1));
|
|
}
|
|
|
|
private void SHX()
|
|
{
|
|
DT = (byte)(R.X & ((EA >> 8) + 1));
|
|
}
|
|
|
|
private void SHS()
|
|
{
|
|
R.S = (byte)(R.A & R.X);
|
|
DT = (byte)(R.S & ((EA >> 8) + 1));
|
|
}
|
|
|
|
private void SHA()
|
|
{
|
|
DT = (byte)(R.A & R.X & ((EA >> 8) + 1));
|
|
}
|
|
|
|
private void SBX()
|
|
{
|
|
WT = (ushort)((R.A & R.X) - DT);
|
|
TST_FLAG(WT < 0x100, C_FLAG);
|
|
R.X = (byte)(WT & 0xFF);
|
|
SET_ZN_FLAG(R.X);
|
|
}
|
|
|
|
private void SAX()
|
|
{
|
|
DT = (byte)(R.A & R.X);
|
|
}
|
|
|
|
private void RRA()
|
|
{
|
|
if ((R.P & C_FLAG) != 0)
|
|
{
|
|
TST_FLAG((DT & 0x01) != 0, C_FLAG);
|
|
DT = (byte)((DT >> 1) | 0x80);
|
|
}
|
|
else
|
|
{
|
|
TST_FLAG((DT & 0x01) != 0, C_FLAG);
|
|
DT >>= 1;
|
|
}
|
|
ADC();
|
|
}
|
|
|
|
private void RLA()
|
|
{
|
|
if ((R.P & C_FLAG) != 0)
|
|
{
|
|
TST_FLAG((DT & 0x80) != 0, C_FLAG);
|
|
DT = (byte)((DT << 1) | 1);
|
|
}
|
|
else
|
|
{
|
|
TST_FLAG((DT & 0x80) != 0, C_FLAG);
|
|
DT <<= 1;
|
|
}
|
|
R.A &= DT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void LXA()
|
|
{
|
|
R.A = R.X = (byte)((R.A | 0xEE) & DT);
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void LAX()
|
|
{
|
|
R.A = DT;
|
|
R.X = R.A;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void LAS()
|
|
{
|
|
R.A = R.X = R.S = (byte)(R.S & DT);
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void ISB()
|
|
{
|
|
DT++;
|
|
SBC();
|
|
}
|
|
|
|
private void DCP()
|
|
{
|
|
DT--;
|
|
CMP_();
|
|
}
|
|
|
|
private void ASR()
|
|
{
|
|
DT &= R.A;
|
|
TST_FLAG((DT & 0x01) != 0, C_FLAG);
|
|
R.A = (byte)(DT >> 1);
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void ARR()
|
|
{
|
|
DT &= R.A;
|
|
R.A = (byte)((DT >> 1) | ((R.P & C_FLAG) << 7));
|
|
SET_ZN_FLAG(R.A);
|
|
TST_FLAG((R.A & 0x40) != 0, C_FLAG);
|
|
TST_FLAG(((R.A >> 6) ^ (R.A >> 5)) != 0, V_FLAG);
|
|
}
|
|
|
|
private void ANE()
|
|
{
|
|
R.A = (byte)((R.A | 0xEE) & R.X & DT);
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void ANC()
|
|
{
|
|
R.A &= DT;
|
|
SET_ZN_FLAG(R.A);
|
|
TST_FLAG((R.P & N_FLAG) != 0, C_FLAG);
|
|
}
|
|
|
|
private void BRK()
|
|
{
|
|
R.PC++;
|
|
PUSH((byte)(R.PC >> 8));
|
|
PUSH((byte)(R.PC & 0xFF));
|
|
SET_FLAG(B_FLAG);
|
|
PUSH(R.P);
|
|
SET_FLAG(I_FLAG);
|
|
R.PC = RD6502W(IRQ_VECTOR);
|
|
}
|
|
|
|
private byte POP()
|
|
{
|
|
return STACK[(++R.S) & 0xFF];
|
|
}
|
|
|
|
private void PUSH(byte V)
|
|
{
|
|
STACK[(R.S--) & 0xFF] = V;
|
|
}
|
|
|
|
private void SEI()
|
|
{
|
|
R.P |= I_FLAG;
|
|
}
|
|
|
|
private void SED()
|
|
{
|
|
R.P |= D_FLAG;
|
|
}
|
|
|
|
private void SEC()
|
|
{
|
|
R.P |= C_FLAG;
|
|
}
|
|
|
|
private void CLV()
|
|
{
|
|
var temp = unchecked((byte)(~V_FLAG));
|
|
R.P &= temp;
|
|
}
|
|
|
|
private void CLI()
|
|
{
|
|
var temp = unchecked((byte)(~I_FLAG));
|
|
R.P &= temp;
|
|
}
|
|
|
|
private void CLD()
|
|
{
|
|
var temp = unchecked((byte)(~D_FLAG));
|
|
R.P &= temp;
|
|
}
|
|
|
|
private void CLC()
|
|
{
|
|
var temp = unchecked((byte)(~C_FLAG));
|
|
R.P &= temp;
|
|
}
|
|
|
|
private void RTS()
|
|
{
|
|
R.PC = POP();
|
|
R.PC |= (ushort)(POP() * 0x0100);
|
|
R.PC++;
|
|
}
|
|
|
|
private void RTI()
|
|
{
|
|
R.P = (byte)(POP() | R_FLAG);
|
|
R.PC = POP();
|
|
R.PC |= (ushort)(POP() * 0x0100);
|
|
}
|
|
|
|
private void JSR()
|
|
{
|
|
EA = OP6502W(R.PC);
|
|
R.PC++;
|
|
PUSH((byte)(R.PC >> 8));
|
|
PUSH((byte)(R.PC & 0xFF));
|
|
R.PC = EA;
|
|
}
|
|
|
|
private void JMP_ID()
|
|
{
|
|
WT = OP6502W(R.PC);
|
|
EA = RD6502(WT);
|
|
WT = (ushort)((WT & 0xFF00) | ((WT + 1) & 0x00FF));
|
|
R.PC = (ushort)(EA + RD6502(WT) * 0x100);
|
|
}
|
|
|
|
private void JMP()
|
|
{
|
|
R.PC = OP6502W(R.PC);
|
|
}
|
|
|
|
private void BVS()
|
|
{
|
|
if ((R.P & V_FLAG) != 0)
|
|
REL_JUMP();
|
|
}
|
|
|
|
private void REL_JUMP()
|
|
{
|
|
ET = R.PC;
|
|
EA = (ushort)(R.PC + (sbyte)DT);
|
|
R.PC = EA;
|
|
ADD_CYCLE(1);
|
|
CHECK_EA();
|
|
}
|
|
|
|
private void BVC()
|
|
{
|
|
if ((R.P & V_FLAG) == 0) REL_JUMP();
|
|
}
|
|
|
|
private void BPL()
|
|
{
|
|
if ((R.P & N_FLAG) == 0) REL_JUMP();
|
|
}
|
|
|
|
private void BNE()
|
|
{
|
|
if ((R.P & Z_FLAG) == 0) REL_JUMP();
|
|
}
|
|
|
|
private void BMI()
|
|
{
|
|
if ((R.P & N_FLAG) != 0) REL_JUMP();
|
|
}
|
|
|
|
private void BEQ()
|
|
{
|
|
if ((R.P & Z_FLAG) != 0) REL_JUMP();
|
|
}
|
|
|
|
private void BCS()
|
|
{
|
|
if ((R.P & C_FLAG) != 0) REL_JUMP();
|
|
}
|
|
|
|
private void BCC()
|
|
{
|
|
if ((R.P & C_FLAG) == 0) REL_JUMP();
|
|
}
|
|
|
|
private void CPY()
|
|
{
|
|
WT = (ushort)(R.Y - DT);
|
|
TST_FLAG((WT & 0x8000) == 0, C_FLAG);
|
|
SET_ZN_FLAG((byte)WT);
|
|
}
|
|
|
|
private void CPX()
|
|
{
|
|
WT = (ushort)(R.X - DT);
|
|
TST_FLAG((WT & 0x8000) == 0, C_FLAG);
|
|
SET_ZN_FLAG((byte)WT);
|
|
}
|
|
|
|
private void CMP_()
|
|
{
|
|
WT = (ushort)(R.A - DT);
|
|
TST_FLAG((WT & 0x8000) == 0, C_FLAG);
|
|
SET_ZN_FLAG((byte)WT);
|
|
}
|
|
|
|
private void TXS()
|
|
{
|
|
R.S = R.X;
|
|
}
|
|
|
|
private void TSX()
|
|
{
|
|
R.X = R.S; SET_ZN_FLAG(R.X);
|
|
}
|
|
|
|
private void TYA()
|
|
{
|
|
R.A = R.Y; SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void TAY()
|
|
{
|
|
R.Y = R.A; SET_ZN_FLAG(R.Y);
|
|
}
|
|
|
|
private void TXA()
|
|
{
|
|
R.A = R.X; SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void TAX()
|
|
{
|
|
R.X = R.A; SET_ZN_FLAG(R.X);
|
|
}
|
|
|
|
private void STY()
|
|
{
|
|
DT = R.Y;
|
|
}
|
|
|
|
private void EA_ZY()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
EA = (byte)(DT + R.Y);
|
|
}
|
|
|
|
private void STX()
|
|
{
|
|
DT = R.X;
|
|
}
|
|
|
|
private void EA_IY()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
ET = ZPRDW(DT);
|
|
EA = (ushort)(ET + R.Y);
|
|
}
|
|
|
|
private void EA_IX()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
EA = ZPRDW(DT + R.X);
|
|
}
|
|
|
|
private void EA_AY()
|
|
{
|
|
ET = OP6502W(R.PC);
|
|
R.PC += 2;
|
|
EA = (ushort)(ET + R.Y);
|
|
}
|
|
|
|
private void EA_AX()
|
|
{
|
|
ET = OP6502W(R.PC);
|
|
R.PC += 2;
|
|
EA = (ushort)(ET + R.X);
|
|
}
|
|
|
|
private void EA_AB()
|
|
{
|
|
EA = OP6502W(R.PC);
|
|
R.PC += 2;
|
|
}
|
|
|
|
private void EA_ZX()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
EA = (byte)(DT + R.X);
|
|
}
|
|
|
|
private void STA()
|
|
{
|
|
DT = R.A;
|
|
}
|
|
|
|
private void EA_ZP()
|
|
{
|
|
EA = OP6502(R.PC++);
|
|
}
|
|
|
|
private void LDY()
|
|
{
|
|
R.Y = DT; SET_ZN_FLAG(R.Y);
|
|
}
|
|
|
|
private void MR_ZY()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
EA = (byte)(DT + R.Y);
|
|
DT = ZPRD(EA);
|
|
}
|
|
|
|
private void LDX()
|
|
{
|
|
R.X = DT; SET_ZN_FLAG(R.X);
|
|
}
|
|
|
|
private void LDA()
|
|
{
|
|
R.A = DT; SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void ROR()
|
|
{
|
|
if ((R.P & C_FLAG) != 0)
|
|
{
|
|
TST_FLAG((DT & 0x01) != 0, C_FLAG);
|
|
DT = (byte)((DT >> 1) | 0x80);
|
|
}
|
|
else
|
|
{
|
|
TST_FLAG((DT & 0x01) != 0, C_FLAG);
|
|
DT >>= 1;
|
|
}
|
|
SET_ZN_FLAG(DT);
|
|
}
|
|
|
|
private void ROR_A()
|
|
{
|
|
if ((R.P & C_FLAG) != 0)
|
|
{
|
|
TST_FLAG((R.A & 0x01) != 0, C_FLAG);
|
|
R.A = (byte)((R.A >> 1) | 0x80);
|
|
}
|
|
else
|
|
{
|
|
TST_FLAG((R.A & 0x01) != 0, C_FLAG);
|
|
R.A >>= 1;
|
|
}
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void ROL()
|
|
{
|
|
if ((R.P & C_FLAG) != 0)
|
|
{
|
|
TST_FLAG((DT & 0x80) != 0, C_FLAG);
|
|
DT = (byte)((DT << 1) | 0x01);
|
|
}
|
|
else
|
|
{
|
|
TST_FLAG((DT & 0x80) != 0, C_FLAG);
|
|
DT <<= 1;
|
|
}
|
|
SET_ZN_FLAG(DT);
|
|
}
|
|
|
|
private void ROL_A()
|
|
{
|
|
if ((R.P & C_FLAG) != 0)
|
|
{
|
|
TST_FLAG((R.A & 0x80) != 0, C_FLAG);
|
|
R.A = (byte)((R.A << 1) | 0x01);
|
|
}
|
|
else
|
|
{
|
|
TST_FLAG((R.A & 0x80) != 0, C_FLAG);
|
|
R.A <<= 1;
|
|
}
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void ORA()
|
|
{
|
|
R.A |= DT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void LSR_A()
|
|
{
|
|
TST_FLAG((R.A & 0x01) != 0, C_FLAG);
|
|
R.A >>= 1;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void LSR()
|
|
{
|
|
TST_FLAG((DT & 0x01) != 0, C_FLAG);
|
|
DT >>= 1;
|
|
SET_ZN_FLAG(DT);
|
|
}
|
|
|
|
private void EOR()
|
|
{
|
|
R.A ^= DT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
internal void SetClockProcess(bool bEnable)
|
|
{
|
|
m_bClockProcess = bEnable;
|
|
}
|
|
|
|
internal byte OP6502(ushort addr)
|
|
{
|
|
return MMU.CPU_MEM_BANK[addr >> 13][addr & 0x1FFF];
|
|
}
|
|
|
|
private byte[] shortTemp = new byte[2];
|
|
internal ushort OP6502W(ushort addr)
|
|
{
|
|
var bytePage = MMU.CPU_MEM_BANK[addr >> 13];
|
|
var spanByte = bytePage;
|
|
shortTemp[0] = spanByte[addr & 0x1FFF];
|
|
shortTemp[1] = spanByte[(addr & 0x1FFF) + 1];
|
|
return BitConverter.ToUInt16(shortTemp, 0);
|
|
}
|
|
|
|
internal byte RD6502(ushort addr)
|
|
{
|
|
if (addr < 0x2000)
|
|
{
|
|
// RAM (Mirror $0800, $1000, $1800)
|
|
return MMU.RAM[addr & 0x07FF];
|
|
}
|
|
else if (addr < 0x8000)
|
|
{
|
|
// Others
|
|
return nes.Read(addr);
|
|
}
|
|
else
|
|
{
|
|
// Dummy access
|
|
mapper.Read(addr, MMU.CPU_MEM_BANK[addr >> 13][addr & 0x1FFF]);
|
|
}
|
|
|
|
// Quick bank read
|
|
return MMU.CPU_MEM_BANK[addr >> 13][addr & 0x1FFF];
|
|
}
|
|
|
|
private void AND()
|
|
{
|
|
R.A &= DT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void MR_IM()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
}
|
|
|
|
private void BIT()
|
|
{
|
|
TST_FLAG((DT & R.A) == 0, Z_FLAG);
|
|
TST_FLAG((DT & 0x80) != 0, N_FLAG);
|
|
TST_FLAG((DT & 0x40) != 0, V_FLAG);
|
|
}
|
|
|
|
private void MR_ZP()
|
|
{
|
|
EA = OP6502(R.PC++);
|
|
DT = ZPRD(EA);
|
|
}
|
|
|
|
private byte ZPRD(ushort A)
|
|
{
|
|
return MMU.RAM[A];
|
|
}
|
|
|
|
private ushort ZPRDW(int A)
|
|
{
|
|
ushort ram1 = MMU.RAM[A];
|
|
ushort ram2 = MMU.RAM[A + 1];
|
|
ram2 <<= 8;
|
|
return (ushort)(ram1 + ram2);
|
|
}
|
|
|
|
private void ADC()
|
|
{
|
|
WT = (ushort)(R.A + DT + (R.P & C_FLAG));
|
|
TST_FLAG(WT > 0xFF, C_FLAG);
|
|
var temp = ((~(R.A ^ DT)) & (R.A ^ WT) & 0x80);
|
|
TST_FLAG(temp != 0, V_FLAG);
|
|
R.A = (byte)WT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void TST_FLAG(bool F, byte V)
|
|
{
|
|
byte temp = (byte)~V;
|
|
R.P &= temp;
|
|
|
|
if (F) R.P |= V;
|
|
}
|
|
|
|
private void SET_ZN_FLAG(byte A)
|
|
{
|
|
byte temp = unchecked((byte)(~(Z_FLAG | N_FLAG)));
|
|
R.P &= temp;
|
|
R.P |= ZN_Table[A];
|
|
}
|
|
|
|
private void ADD_CYCLE(int V)
|
|
{
|
|
exec_cycles += V;
|
|
}
|
|
|
|
private void MR_ZX()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
EA = (ushort)(DT + R.X);
|
|
DT = ZPRD(EA);
|
|
}
|
|
|
|
private void MR_AB()
|
|
{
|
|
EA = OP6502W(R.PC);
|
|
R.PC += 2;
|
|
DT = RD6502(EA);
|
|
}
|
|
|
|
private void MR_AX()
|
|
{
|
|
ET = OP6502W(R.PC);
|
|
R.PC += 2;
|
|
EA = (ushort)(ET + R.X);
|
|
DT = RD6502(EA);
|
|
}
|
|
|
|
private void CHECK_EA()
|
|
{
|
|
if ((ET & 0xFF00) != (EA & 0xFF00)) ADD_CYCLE(1);
|
|
}
|
|
|
|
private void MR_AY()
|
|
{
|
|
ET = OP6502W(R.PC);
|
|
R.PC += 2;
|
|
EA = (ushort)(ET + R.Y);
|
|
DT = RD6502(EA);
|
|
}
|
|
|
|
private void MR_IX()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
EA = ZPRDW(DT + R.X);
|
|
DT = RD6502(EA);
|
|
}
|
|
|
|
private void MR_IY()
|
|
{
|
|
DT = OP6502(R.PC++);
|
|
ET = ZPRDW(DT);
|
|
EA = (ushort)(ET + R.Y);
|
|
DT = RD6502(EA);
|
|
}
|
|
private void ASL_A()
|
|
{
|
|
TST_FLAG((R.A & 0x80) != 0, C_FLAG);
|
|
R.A <<= 1;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void ASL()
|
|
{
|
|
TST_FLAG((DT & 0x80) != 0, C_FLAG);
|
|
DT <<= 1;
|
|
SET_ZN_FLAG(DT);
|
|
}
|
|
|
|
private void SBC()
|
|
{
|
|
WT = (ushort)(R.A - DT - (~R.P & C_FLAG));
|
|
bool f = ((R.A ^ DT) & (R.A ^ WT) & (0x80)) != 0;
|
|
TST_FLAG(f, V_FLAG);
|
|
TST_FLAG(WT < 0x100, C_FLAG);
|
|
R.A = (byte)WT;
|
|
SET_ZN_FLAG(R.A);
|
|
}
|
|
|
|
private void DEC()
|
|
{
|
|
DT--;
|
|
SET_ZN_FLAG(DT);
|
|
}
|
|
|
|
private void DEX()
|
|
{
|
|
R.X--;
|
|
SET_ZN_FLAG(R.X);
|
|
}
|
|
|
|
private void DEY()
|
|
{
|
|
R.Y--;
|
|
SET_ZN_FLAG(R.Y);
|
|
}
|
|
|
|
private void INC()
|
|
{
|
|
DT++;
|
|
SET_ZN_FLAG(DT);
|
|
}
|
|
|
|
private void INX()
|
|
{
|
|
R.X++;
|
|
SET_ZN_FLAG(R.X);
|
|
}
|
|
|
|
private void INY()
|
|
{
|
|
R.Y++;
|
|
SET_ZN_FLAG(R.Y);
|
|
}
|
|
|
|
private void MW_ZP()
|
|
{
|
|
ZPWR(EA, DT);
|
|
}
|
|
|
|
private void ZPWR(ushort a, byte v)
|
|
{
|
|
MMU.RAM[a] = v;
|
|
}
|
|
|
|
private void MW_EA()
|
|
{
|
|
WR6502(EA, DT);
|
|
}
|
|
|
|
internal void ClrIRQ(byte mask)
|
|
{
|
|
byte temp = (byte)~mask;
|
|
R.INT_pending &= temp;
|
|
}
|
|
|
|
internal void WR6502(ushort addr, byte data)
|
|
{
|
|
if (addr < 0x2000)
|
|
{
|
|
// RAM (Mirror $0800, $1000, $1800)
|
|
MMU.RAM[addr & 0x07FF] = data;
|
|
}
|
|
else
|
|
{
|
|
// Others
|
|
nes.Write(addr, data);
|
|
}
|
|
}
|
|
|
|
internal void NMI()
|
|
{
|
|
R.INT_pending |= NMI_FLAG;
|
|
nmicount = 0;
|
|
}
|
|
|
|
internal void SetIRQ(byte mask)
|
|
{
|
|
R.INT_pending |= mask;
|
|
}
|
|
|
|
internal int GetTotalCycles()
|
|
{
|
|
return TOTAL_cycles;
|
|
}
|
|
|
|
internal void DMA(int cycles)
|
|
{
|
|
DMA_cycles += cycles;
|
|
}
|
|
|
|
internal void Reset()
|
|
{
|
|
apu = nes.apu;
|
|
mapper = nes.mapper;
|
|
|
|
R.A = 0x00;
|
|
R.X = 0x00;
|
|
R.Y = 0x00;
|
|
R.S = 0xFF;
|
|
R.P = Z_FLAG | R_FLAG;
|
|
R.PC = RD6502W(RES_VECTOR);
|
|
|
|
R.INT_pending = 0;
|
|
|
|
TOTAL_cycles = 0;
|
|
DMA_cycles = 0;
|
|
|
|
// STACK quick access
|
|
STACK = new ArrayRef<byte>(MMU.RAM, 0x0100, MMU.RAM.Length - 0x100);
|
|
|
|
// Zero/Negative FLAG
|
|
ZN_Table[0] = Z_FLAG;
|
|
for (int i = 1; i < 256; i++)
|
|
ZN_Table[i] = (byte)((i & 0x80) != 0 ? N_FLAG : 0);
|
|
}
|
|
|
|
internal void GetContext(ref R6502 r)
|
|
{
|
|
r = R;
|
|
}
|
|
|
|
internal void SetContext(R6502 r)
|
|
{
|
|
R = r;
|
|
}
|
|
|
|
internal int GetDmaCycles()
|
|
{
|
|
return DMA_cycles;
|
|
}
|
|
|
|
internal void SetDmaCycles(int cycles)
|
|
{
|
|
DMA_cycles = cycles;
|
|
}
|
|
}
|
|
|
|
public enum StatusFlag6502 : int
|
|
{
|
|
C_FLAG = 0x01,
|
|
Z_FLAG = 0x02,
|
|
I_FLAG = 0x04,
|
|
D_FLAG = 0x08,
|
|
B_FLAG = 0x10,
|
|
R_FLAG = 0x20,
|
|
V_FLAG = 0x40,
|
|
N_FLAG = 0x80
|
|
}
|
|
|
|
public enum Interrupt : int
|
|
{
|
|
NMI_FLAG = 0x01,
|
|
IRQ_FLAG = 0x02,
|
|
IRQ_FRAMEIRQ = 0x04,
|
|
IRQ_DPCM = 0x08,
|
|
IRQ_MAPPER = 0x10,
|
|
IRQ_MAPPER2 = 0x20,
|
|
IRQ_TRIGGER = 0x40,
|
|
IRQ_TRIGGER2 = 0x80,
|
|
IRQ_MASK = (~(NMI_FLAG | IRQ_FLAG)),
|
|
}
|
|
|
|
public enum Vector : int
|
|
{
|
|
NMI_VECTOR = 0xFFFA,
|
|
RES_VECTOR = 0xFFFC,
|
|
IRQ_VECTOR = 0xFFFE
|
|
}
|
|
|
|
public class R6502
|
|
{
|
|
public ushort PC;
|
|
public byte A;
|
|
public byte P;
|
|
public byte X;
|
|
public byte Y;
|
|
public byte S;
|
|
|
|
public byte INT_pending;
|
|
}
|
|
} |