target/riscv: debug: Implement debug related TCGCPUOps
Implement .debug_excp_handler, .debug_check_{breakpoint, watchpoint} TCGCPUOps and hook them into riscv_tcg_ops. Signed-off-by: Bin Meng <bin.meng@windriver.com> Reviewed-by: Alistair Francis <alistair.francis@wdc.com> Message-Id: <20220421003324.1134983-2-bmeng.cn@gmail.com> Signed-off-by: Alistair Francis <alistair.francis@wdc.com>
This commit is contained in:
parent
8124f819d0
commit
b5f6379d13
@ -880,6 +880,9 @@ static const struct TCGCPUOps riscv_tcg_ops = {
|
||||
.do_interrupt = riscv_cpu_do_interrupt,
|
||||
.do_transaction_failed = riscv_cpu_do_transaction_failed,
|
||||
.do_unaligned_access = riscv_cpu_do_unaligned_access,
|
||||
.debug_excp_handler = riscv_cpu_debug_excp_handler,
|
||||
.debug_check_breakpoint = riscv_cpu_debug_check_breakpoint,
|
||||
.debug_check_watchpoint = riscv_cpu_debug_check_watchpoint,
|
||||
#endif /* !CONFIG_USER_ONLY */
|
||||
};
|
||||
|
||||
|
@ -337,3 +337,78 @@ void tdata_csr_write(CPURISCVState *env, int tdata_index, target_ulong val)
|
||||
|
||||
return write_func(env, env->trigger_cur, tdata_index, val);
|
||||
}
|
||||
|
||||
void riscv_cpu_debug_excp_handler(CPUState *cs)
|
||||
{
|
||||
RISCVCPU *cpu = RISCV_CPU(cs);
|
||||
CPURISCVState *env = &cpu->env;
|
||||
|
||||
if (cs->watchpoint_hit) {
|
||||
if (cs->watchpoint_hit->flags & BP_CPU) {
|
||||
cs->watchpoint_hit = NULL;
|
||||
riscv_raise_exception(env, RISCV_EXCP_BREAKPOINT, 0);
|
||||
}
|
||||
} else {
|
||||
if (cpu_breakpoint_test(cs, env->pc, BP_CPU)) {
|
||||
riscv_raise_exception(env, RISCV_EXCP_BREAKPOINT, 0);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
bool riscv_cpu_debug_check_breakpoint(CPUState *cs)
|
||||
{
|
||||
RISCVCPU *cpu = RISCV_CPU(cs);
|
||||
CPURISCVState *env = &cpu->env;
|
||||
CPUBreakpoint *bp;
|
||||
target_ulong ctrl;
|
||||
target_ulong pc;
|
||||
int i;
|
||||
|
||||
QTAILQ_FOREACH(bp, &cs->breakpoints, entry) {
|
||||
for (i = 0; i < TRIGGER_TYPE2_NUM; i++) {
|
||||
ctrl = env->type2_trig[i].mcontrol;
|
||||
pc = env->type2_trig[i].maddress;
|
||||
|
||||
if ((ctrl & TYPE2_EXEC) && (bp->pc == pc)) {
|
||||
/* check U/S/M bit against current privilege level */
|
||||
if ((ctrl >> 3) & BIT(env->priv)) {
|
||||
return true;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool riscv_cpu_debug_check_watchpoint(CPUState *cs, CPUWatchpoint *wp)
|
||||
{
|
||||
RISCVCPU *cpu = RISCV_CPU(cs);
|
||||
CPURISCVState *env = &cpu->env;
|
||||
target_ulong ctrl;
|
||||
target_ulong addr;
|
||||
int flags;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < TRIGGER_TYPE2_NUM; i++) {
|
||||
ctrl = env->type2_trig[i].mcontrol;
|
||||
addr = env->type2_trig[i].maddress;
|
||||
flags = 0;
|
||||
|
||||
if (ctrl & TYPE2_LOAD) {
|
||||
flags |= BP_MEM_READ;
|
||||
}
|
||||
if (ctrl & TYPE2_STORE) {
|
||||
flags |= BP_MEM_WRITE;
|
||||
}
|
||||
|
||||
if ((wp->flags & flags) && (wp->vaddr == addr)) {
|
||||
/* check U/S/M bit against current privilege level */
|
||||
if ((ctrl >> 3) & BIT(env->priv)) {
|
||||
return true;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
@ -105,4 +105,8 @@ void tselect_csr_write(CPURISCVState *env, target_ulong val);
|
||||
target_ulong tdata_csr_read(CPURISCVState *env, int tdata_index);
|
||||
void tdata_csr_write(CPURISCVState *env, int tdata_index, target_ulong val);
|
||||
|
||||
void riscv_cpu_debug_excp_handler(CPUState *cs);
|
||||
bool riscv_cpu_debug_check_breakpoint(CPUState *cs);
|
||||
bool riscv_cpu_debug_check_watchpoint(CPUState *cs, CPUWatchpoint *wp);
|
||||
|
||||
#endif /* RISCV_DEBUG_H */
|
||||
|
Loading…
Reference in New Issue
Block a user