149 lines
4.5 KiB
C
149 lines
4.5 KiB
C
/*
|
|
* RX emulation
|
|
*
|
|
* Copyright (c) 2019 Yoshinori Sato
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2 or later, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope 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, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "qemu/bitops.h"
|
|
#include "cpu.h"
|
|
#include "exec/log.h"
|
|
#include "exec/cpu_ldst.h"
|
|
#include "sysemu/sysemu.h"
|
|
#include "hw/irq.h"
|
|
|
|
void rx_cpu_unpack_psw(CPURXState *env, uint32_t psw, int rte)
|
|
{
|
|
if (env->psw_pm == 0) {
|
|
env->psw_ipl = FIELD_EX32(psw, PSW, IPL);
|
|
if (rte) {
|
|
/* PSW.PM can write RTE and RTFI */
|
|
env->psw_pm = FIELD_EX32(psw, PSW, PM);
|
|
}
|
|
env->psw_u = FIELD_EX32(psw, PSW, U);
|
|
env->psw_i = FIELD_EX32(psw, PSW, I);
|
|
}
|
|
env->psw_o = FIELD_EX32(psw, PSW, O) << 31;
|
|
env->psw_s = FIELD_EX32(psw, PSW, S) << 31;
|
|
env->psw_z = 1 - FIELD_EX32(psw, PSW, Z);
|
|
env->psw_c = FIELD_EX32(psw, PSW, C);
|
|
}
|
|
|
|
#define INT_FLAGS (CPU_INTERRUPT_HARD | CPU_INTERRUPT_FIR)
|
|
void rx_cpu_do_interrupt(CPUState *cs)
|
|
{
|
|
RXCPU *cpu = RXCPU(cs);
|
|
CPURXState *env = &cpu->env;
|
|
int do_irq = cs->interrupt_request & INT_FLAGS;
|
|
uint32_t save_psw;
|
|
|
|
env->in_sleep = 0;
|
|
|
|
if (env->psw_u) {
|
|
env->usp = env->regs[0];
|
|
} else {
|
|
env->isp = env->regs[0];
|
|
}
|
|
save_psw = rx_cpu_pack_psw(env);
|
|
env->psw_pm = env->psw_i = env->psw_u = 0;
|
|
|
|
if (do_irq) {
|
|
if (do_irq & CPU_INTERRUPT_FIR) {
|
|
env->bpc = env->pc;
|
|
env->bpsw = save_psw;
|
|
env->pc = env->fintv;
|
|
env->psw_ipl = 15;
|
|
cs->interrupt_request &= ~CPU_INTERRUPT_FIR;
|
|
qemu_set_irq(env->ack, env->ack_irq);
|
|
qemu_log_mask(CPU_LOG_INT, "fast interrupt raised\n");
|
|
} else if (do_irq & CPU_INTERRUPT_HARD) {
|
|
env->isp -= 4;
|
|
cpu_stl_data(env, env->isp, save_psw);
|
|
env->isp -= 4;
|
|
cpu_stl_data(env, env->isp, env->pc);
|
|
env->pc = cpu_ldl_data(env, env->intb + env->ack_irq * 4);
|
|
env->psw_ipl = env->ack_ipl;
|
|
cs->interrupt_request &= ~CPU_INTERRUPT_HARD;
|
|
qemu_set_irq(env->ack, env->ack_irq);
|
|
qemu_log_mask(CPU_LOG_INT,
|
|
"interrupt 0x%02x raised\n", env->ack_irq);
|
|
}
|
|
} else {
|
|
uint32_t vec = cs->exception_index;
|
|
const char *expname = "unknown exception";
|
|
|
|
env->isp -= 4;
|
|
cpu_stl_data(env, env->isp, save_psw);
|
|
env->isp -= 4;
|
|
cpu_stl_data(env, env->isp, env->pc);
|
|
|
|
if (vec < 0x100) {
|
|
env->pc = cpu_ldl_data(env, 0xffffffc0 + vec * 4);
|
|
} else {
|
|
env->pc = cpu_ldl_data(env, env->intb + (vec & 0xff) * 4);
|
|
}
|
|
switch (vec) {
|
|
case 20:
|
|
expname = "privilege violation";
|
|
break;
|
|
case 21:
|
|
expname = "access exception";
|
|
break;
|
|
case 23:
|
|
expname = "illegal instruction";
|
|
break;
|
|
case 25:
|
|
expname = "fpu exception";
|
|
break;
|
|
case 30:
|
|
expname = "non-maskable interrupt";
|
|
break;
|
|
case 0x100 ... 0x1ff:
|
|
expname = "unconditional trap";
|
|
}
|
|
qemu_log_mask(CPU_LOG_INT, "exception 0x%02x [%s] raised\n",
|
|
(vec & 0xff), expname);
|
|
}
|
|
env->regs[0] = env->isp;
|
|
}
|
|
|
|
bool rx_cpu_exec_interrupt(CPUState *cs, int interrupt_request)
|
|
{
|
|
RXCPU *cpu = RXCPU(cs);
|
|
CPURXState *env = &cpu->env;
|
|
int accept = 0;
|
|
/* hardware interrupt (Normal) */
|
|
if ((interrupt_request & CPU_INTERRUPT_HARD) &&
|
|
env->psw_i && (env->psw_ipl < env->req_ipl)) {
|
|
env->ack_irq = env->req_irq;
|
|
env->ack_ipl = env->req_ipl;
|
|
accept = 1;
|
|
}
|
|
/* hardware interrupt (FIR) */
|
|
if ((interrupt_request & CPU_INTERRUPT_FIR) &&
|
|
env->psw_i && (env->psw_ipl < 15)) {
|
|
accept = 1;
|
|
}
|
|
if (accept) {
|
|
rx_cpu_do_interrupt(cs);
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
hwaddr rx_cpu_get_phys_page_debug(CPUState *cs, vaddr addr)
|
|
{
|
|
return addr;
|
|
}
|