78 lines
1.3 KiB
C++
78 lines
1.3 KiB
C++
|
#include "system.h"
|
||
|
|
//#include <trio/trio.h>
|
||
|
|
|
||
|
|
namespace MDFN_IEN_WSWAN
|
||
|
|
{
|
||
|
|
void Interrupt::Recalc()
|
||
|
|
{
|
||
|
|
IOn_Cache = FALSE;
|
||
|
|
IOn_Which = 0;
|
||
|
|
IVector_Cache = 0;
|
||
|
|
|
||
|
|
for(int i = 0; i < 8; i++)
|
||
|
|
{
|
||
|
|
if(IStatus & IEnable & (1 << i))
|
||
|
|
{
|
||
|
|
IOn_Cache = TRUE;
|
||
|
|
IOn_Which = i;
|
||
|
|
IVector_Cache = (IVectorBase + i) * 4;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void Interrupt::DebugForce(unsigned int level)
|
||
|
|
{
|
||
|
|
sys->cpu.interrupt((IVectorBase + level) * 4, TRUE);
|
||
|
|
}
|
||
|
|
|
||
|
|
void Interrupt::DoInterrupt(int which)
|
||
|
|
{
|
||
|
|
if(IEnable & (1 << which))
|
||
|
|
IStatus |= 1 << which;
|
||
|
|
|
||
|
|
//printf("Interrupt: %d\n", which);
|
||
|
|
Recalc();
|
||
|
|
}
|
||
|
|
|
||
|
|
void Interrupt::Write(uint32 A, uint8 V)
|
||
|
|
{
|
||
|
|
//printf("Write: %04x %02x\n", A, V);
|
||
|
|
switch(A)
|
||
|
|
{
|
||
|
|
case 0xB0: IVectorBase = V; Recalc(); break;
|
||
|
|
case 0xB2: IEnable = V; IStatus &= IEnable; Recalc(); break;
|
||
|
|
case 0xB6: /*printf("IStatus: %02x\n", V);*/ IStatus &= ~V; Recalc(); break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
uint8 Interrupt::Read(uint32 A)
|
||
|
|
{
|
||
|
|
//printf("Read: %04x\n", A);
|
||
|
|
switch(A)
|
||
|
|
{
|
||
|
|
case 0xB0: return(IVectorBase);
|
||
|
|
case 0xB2: return(IEnable);
|
||
|
|
case 0xB6: return(1 << IOn_Which); //return(IStatus);
|
||
|
|
}
|
||
|
|
return(0);
|
||
|
|
}
|
||
|
|
|
||
|
|
void Interrupt::Check()
|
||
|
|
{
|
||
|
|
if(IOn_Cache)
|
||
|
|
{
|
||
|
|
sys->cpu.interrupt(IVector_Cache, FALSE);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void Interrupt::Reset()
|
||
|
|
{
|
||
|
|
IEnable = 0x00;
|
||
|
|
IStatus = 0x00;
|
||
|
|
IVectorBase = 0x00;
|
||
|
|
Recalc();
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|