RTI/RTT shall not change the PSW in user/supervisor mode

This commit is contained in:
folkert van heusden 2022-06-18 18:05:31 +02:00
parent 51670ef199
commit 31edf022cc
2 changed files with 20 additions and 12 deletions

28
cpu.cpp
View file

@ -246,18 +246,16 @@ int cpu::getPSW_spl() const
return (psw >> 5) & 7; return (psw >> 5) & 7;
} }
void cpu::setPSW(const uint16_t v, const bool limited) void cpu::setPSW(uint16_t v, const bool limited)
{ {
if (limited) { if (limited) {
psw |= v & 0174000; // current & previous mode can only be increased, 11 can only be set v &= 0174037;
psw &= 0174000; // retain upper 5 bit v |= psw & 0174340;
psw |= v & ~0174000;
} }
else {
psw = v; psw = v;
} }
}
bool cpu::check_queued_interrupts() bool cpu::check_queued_interrupts()
{ {
@ -1548,10 +1546,15 @@ bool cpu::misc_operations(const uint16_t instr)
case 0b0000000000000001: // WAIT case 0b0000000000000001: // WAIT
return true; return true;
case 0b0000000000000010: // RTI case 0b0000000000000010: { // RTI
setPC(popStack()); setPC(popStack());
setPSW(popStack(), !!((getPSW() >> 12) & 3));
uint16_t replacement_psw = popStack();
setPSW(replacement_psw, true);
return true; return true;
}
case 0b0000000000000011: // BPT case 0b0000000000000011: // BPT
trap(014); trap(014);
@ -1561,10 +1564,15 @@ bool cpu::misc_operations(const uint16_t instr)
trap(020); trap(020);
return true; return true;
case 0b0000000000000110: // RTT case 0b0000000000000110: { // RTT
setPC(popStack()); setPC(popStack());
setPSW(popStack(), !!((getPSW() >> 12) & 3));
uint16_t replacement_psw = popStack();
setPSW(replacement_psw, true);
return true; return true;
}
case 0b0000000000000111: // MFPT case 0b0000000000000111: // MFPT
if (emulateMFPT) if (emulateMFPT)

2
cpu.h
View file

@ -118,7 +118,7 @@ public:
void setBitPSW(const int bit, const bool v); void setBitPSW(const int bit, const bool v);
uint16_t getPSW() const { return psw; } uint16_t getPSW() const { return psw; }
void setPSW(const uint16_t v, const bool limited); void setPSW(uint16_t v, const bool limited);
uint16_t getStackLimitRegister() { return stackLimitRegister; } uint16_t getStackLimitRegister() { return stackLimitRegister; }
void setStackLimitRegister(const uint16_t v) { stackLimitRegister = v; } void setStackLimitRegister(const uint16_t v) { stackLimitRegister = v; }