0099f60534
We're not setting (s/m)tval when triggering breakpoints of type 2 (mcontrol) and 6 (mcontrol6). According to the debug spec section 5.7.12, "Match Control Type 6": "The Privileged Spec says that breakpoint exceptions that occur on instruction fetches, loads, or stores update the tval CSR with either zero or the faulting virtual address. The faulting virtual address for an mcontrol6 trigger with action = 0 is the address being accessed and which caused that trigger to fire." A similar text is also found in the Debug spec section 5.7.11 w.r.t. mcontrol. Note that what we're doing ATM is not violating the spec, but it's simple enough to set mtval/stval and it makes life easier for any software that relies on this info. Given that we always use action = 0, save the faulting address for the mcontrol and mcontrol6 trigger breakpoints into env->badaddr, which is used as as scratch area for traps with address information. 'tval' is then set during riscv_cpu_do_interrupt(). Signed-off-by: Daniel Henrique Barboza <dbarboza@ventanamicro.com> Reviewed-by: Alistair Francis <alistair.francis@wdc.com> Reviewed-by: LIU Zhiwei <zhiwei_liu@linux.alibaba.com> Message-ID: <20240416230437.1869024-2-dbarboza@ventanamicro.com> Signed-off-by: Alistair Francis <alistair.francis@wdc.com>
949 lines
27 KiB
C
949 lines
27 KiB
C
/*
|
|
* QEMU RISC-V Native Debug Support
|
|
*
|
|
* Copyright (c) 2022 Wind River Systems, Inc.
|
|
*
|
|
* Author:
|
|
* Bin Meng <bin.meng@windriver.com>
|
|
*
|
|
* This provides the native debug support via the Trigger Module, as defined
|
|
* in the RISC-V Debug Specification:
|
|
* https://github.com/riscv/riscv-debug-spec/raw/master/riscv-debug-stable.pdf
|
|
*
|
|
* 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/log.h"
|
|
#include "qapi/error.h"
|
|
#include "cpu.h"
|
|
#include "trace.h"
|
|
#include "exec/exec-all.h"
|
|
#include "exec/helper-proto.h"
|
|
#include "sysemu/cpu-timers.h"
|
|
|
|
/*
|
|
* The following M-mode trigger CSRs are implemented:
|
|
*
|
|
* - tselect
|
|
* - tdata1
|
|
* - tdata2
|
|
* - tdata3
|
|
* - tinfo
|
|
*
|
|
* The following triggers are initialized by default:
|
|
*
|
|
* Index | Type | tdata mapping | Description
|
|
* ------+------+------------------------+------------
|
|
* 0 | 2 | tdata1, tdata2 | Address / Data Match
|
|
* 1 | 2 | tdata1, tdata2 | Address / Data Match
|
|
*/
|
|
|
|
/* tdata availability of a trigger */
|
|
typedef bool tdata_avail[TDATA_NUM];
|
|
|
|
static tdata_avail tdata_mapping[TRIGGER_TYPE_NUM] = {
|
|
[TRIGGER_TYPE_NO_EXIST] = { false, false, false },
|
|
[TRIGGER_TYPE_AD_MATCH] = { true, true, true },
|
|
[TRIGGER_TYPE_INST_CNT] = { true, false, true },
|
|
[TRIGGER_TYPE_INT] = { true, true, true },
|
|
[TRIGGER_TYPE_EXCP] = { true, true, true },
|
|
[TRIGGER_TYPE_AD_MATCH6] = { true, true, true },
|
|
[TRIGGER_TYPE_EXT_SRC] = { true, false, false },
|
|
[TRIGGER_TYPE_UNAVAIL] = { true, true, true }
|
|
};
|
|
|
|
/* only breakpoint size 1/2/4/8 supported */
|
|
static int access_size[SIZE_NUM] = {
|
|
[SIZE_ANY] = 0,
|
|
[SIZE_1B] = 1,
|
|
[SIZE_2B] = 2,
|
|
[SIZE_4B] = 4,
|
|
[SIZE_6B] = -1,
|
|
[SIZE_8B] = 8,
|
|
[6 ... 15] = -1,
|
|
};
|
|
|
|
static inline target_ulong extract_trigger_type(CPURISCVState *env,
|
|
target_ulong tdata1)
|
|
{
|
|
switch (riscv_cpu_mxl(env)) {
|
|
case MXL_RV32:
|
|
return extract32(tdata1, 28, 4);
|
|
case MXL_RV64:
|
|
case MXL_RV128:
|
|
return extract64(tdata1, 60, 4);
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
}
|
|
|
|
static inline target_ulong get_trigger_type(CPURISCVState *env,
|
|
target_ulong trigger_index)
|
|
{
|
|
return extract_trigger_type(env, env->tdata1[trigger_index]);
|
|
}
|
|
|
|
static trigger_action_t get_trigger_action(CPURISCVState *env,
|
|
target_ulong trigger_index)
|
|
{
|
|
target_ulong tdata1 = env->tdata1[trigger_index];
|
|
int trigger_type = get_trigger_type(env, trigger_index);
|
|
trigger_action_t action = DBG_ACTION_NONE;
|
|
|
|
switch (trigger_type) {
|
|
case TRIGGER_TYPE_AD_MATCH:
|
|
action = (tdata1 & TYPE2_ACTION) >> 12;
|
|
break;
|
|
case TRIGGER_TYPE_AD_MATCH6:
|
|
action = (tdata1 & TYPE6_ACTION) >> 12;
|
|
break;
|
|
case TRIGGER_TYPE_INST_CNT:
|
|
case TRIGGER_TYPE_INT:
|
|
case TRIGGER_TYPE_EXCP:
|
|
case TRIGGER_TYPE_EXT_SRC:
|
|
qemu_log_mask(LOG_UNIMP, "trigger type: %d is not supported\n",
|
|
trigger_type);
|
|
break;
|
|
case TRIGGER_TYPE_NO_EXIST:
|
|
case TRIGGER_TYPE_UNAVAIL:
|
|
qemu_log_mask(LOG_GUEST_ERROR, "trigger type: %d does not exit\n",
|
|
trigger_type);
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
return action;
|
|
}
|
|
|
|
static inline target_ulong build_tdata1(CPURISCVState *env,
|
|
trigger_type_t type,
|
|
bool dmode, target_ulong data)
|
|
{
|
|
target_ulong tdata1;
|
|
|
|
switch (riscv_cpu_mxl(env)) {
|
|
case MXL_RV32:
|
|
tdata1 = RV32_TYPE(type) |
|
|
(dmode ? RV32_DMODE : 0) |
|
|
(data & RV32_DATA_MASK);
|
|
break;
|
|
case MXL_RV64:
|
|
case MXL_RV128:
|
|
tdata1 = RV64_TYPE(type) |
|
|
(dmode ? RV64_DMODE : 0) |
|
|
(data & RV64_DATA_MASK);
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
return tdata1;
|
|
}
|
|
|
|
bool tdata_available(CPURISCVState *env, int tdata_index)
|
|
{
|
|
int trigger_type = get_trigger_type(env, env->trigger_cur);
|
|
|
|
if (unlikely(tdata_index >= TDATA_NUM)) {
|
|
return false;
|
|
}
|
|
|
|
return tdata_mapping[trigger_type][tdata_index];
|
|
}
|
|
|
|
target_ulong tselect_csr_read(CPURISCVState *env)
|
|
{
|
|
return env->trigger_cur;
|
|
}
|
|
|
|
void tselect_csr_write(CPURISCVState *env, target_ulong val)
|
|
{
|
|
if (val < RV_MAX_TRIGGERS) {
|
|
env->trigger_cur = val;
|
|
}
|
|
}
|
|
|
|
static target_ulong tdata1_validate(CPURISCVState *env, target_ulong val,
|
|
trigger_type_t t)
|
|
{
|
|
uint32_t type, dmode;
|
|
target_ulong tdata1;
|
|
|
|
switch (riscv_cpu_mxl(env)) {
|
|
case MXL_RV32:
|
|
type = extract32(val, 28, 4);
|
|
dmode = extract32(val, 27, 1);
|
|
tdata1 = RV32_TYPE(t);
|
|
break;
|
|
case MXL_RV64:
|
|
case MXL_RV128:
|
|
type = extract64(val, 60, 4);
|
|
dmode = extract64(val, 59, 1);
|
|
tdata1 = RV64_TYPE(t);
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
if (type != t) {
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
"ignoring type write to tdata1 register\n");
|
|
}
|
|
|
|
if (dmode != 0) {
|
|
qemu_log_mask(LOG_UNIMP, "debug mode is not supported\n");
|
|
}
|
|
|
|
return tdata1;
|
|
}
|
|
|
|
static inline void warn_always_zero_bit(target_ulong val, target_ulong mask,
|
|
const char *msg)
|
|
{
|
|
if (val & mask) {
|
|
qemu_log_mask(LOG_UNIMP, "%s bit is always zero\n", msg);
|
|
}
|
|
}
|
|
|
|
static void do_trigger_action(CPURISCVState *env, target_ulong trigger_index)
|
|
{
|
|
trigger_action_t action = get_trigger_action(env, trigger_index);
|
|
|
|
switch (action) {
|
|
case DBG_ACTION_NONE:
|
|
break;
|
|
case DBG_ACTION_BP:
|
|
riscv_raise_exception(env, RISCV_EXCP_BREAKPOINT, 0);
|
|
break;
|
|
case DBG_ACTION_DBG_MODE:
|
|
case DBG_ACTION_TRACE0:
|
|
case DBG_ACTION_TRACE1:
|
|
case DBG_ACTION_TRACE2:
|
|
case DBG_ACTION_TRACE3:
|
|
case DBG_ACTION_EXT_DBG0:
|
|
case DBG_ACTION_EXT_DBG1:
|
|
qemu_log_mask(LOG_UNIMP, "action: %d is not supported\n", action);
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
}
|
|
|
|
/* type 2 trigger */
|
|
|
|
static uint32_t type2_breakpoint_size(CPURISCVState *env, target_ulong ctrl)
|
|
{
|
|
uint32_t sizelo, sizehi = 0;
|
|
|
|
if (riscv_cpu_mxl(env) == MXL_RV64) {
|
|
sizehi = extract32(ctrl, 21, 2);
|
|
}
|
|
sizelo = extract32(ctrl, 16, 2);
|
|
return (sizehi << 2) | sizelo;
|
|
}
|
|
|
|
static inline bool type2_breakpoint_enabled(target_ulong ctrl)
|
|
{
|
|
bool mode = !!(ctrl & (TYPE2_U | TYPE2_S | TYPE2_M));
|
|
bool rwx = !!(ctrl & (TYPE2_LOAD | TYPE2_STORE | TYPE2_EXEC));
|
|
|
|
return mode && rwx;
|
|
}
|
|
|
|
static target_ulong type2_mcontrol_validate(CPURISCVState *env,
|
|
target_ulong ctrl)
|
|
{
|
|
target_ulong val;
|
|
uint32_t size;
|
|
|
|
/* validate the generic part first */
|
|
val = tdata1_validate(env, ctrl, TRIGGER_TYPE_AD_MATCH);
|
|
|
|
/* validate unimplemented (always zero) bits */
|
|
warn_always_zero_bit(ctrl, TYPE2_MATCH, "match");
|
|
warn_always_zero_bit(ctrl, TYPE2_CHAIN, "chain");
|
|
warn_always_zero_bit(ctrl, TYPE2_ACTION, "action");
|
|
warn_always_zero_bit(ctrl, TYPE2_TIMING, "timing");
|
|
warn_always_zero_bit(ctrl, TYPE2_SELECT, "select");
|
|
warn_always_zero_bit(ctrl, TYPE2_HIT, "hit");
|
|
|
|
/* validate size encoding */
|
|
size = type2_breakpoint_size(env, ctrl);
|
|
if (access_size[size] == -1) {
|
|
qemu_log_mask(LOG_UNIMP, "access size %d is not supported, using "
|
|
"SIZE_ANY\n", size);
|
|
} else {
|
|
val |= (ctrl & TYPE2_SIZELO);
|
|
if (riscv_cpu_mxl(env) == MXL_RV64) {
|
|
val |= (ctrl & TYPE2_SIZEHI);
|
|
}
|
|
}
|
|
|
|
/* keep the mode and attribute bits */
|
|
val |= (ctrl & (TYPE2_U | TYPE2_S | TYPE2_M |
|
|
TYPE2_LOAD | TYPE2_STORE | TYPE2_EXEC));
|
|
|
|
return val;
|
|
}
|
|
|
|
static void type2_breakpoint_insert(CPURISCVState *env, target_ulong index)
|
|
{
|
|
target_ulong ctrl = env->tdata1[index];
|
|
target_ulong addr = env->tdata2[index];
|
|
bool enabled = type2_breakpoint_enabled(ctrl);
|
|
CPUState *cs = env_cpu(env);
|
|
int flags = BP_CPU | BP_STOP_BEFORE_ACCESS;
|
|
uint32_t size;
|
|
|
|
if (!enabled) {
|
|
return;
|
|
}
|
|
|
|
if (ctrl & TYPE2_EXEC) {
|
|
cpu_breakpoint_insert(cs, addr, flags, &env->cpu_breakpoint[index]);
|
|
}
|
|
|
|
if (ctrl & TYPE2_LOAD) {
|
|
flags |= BP_MEM_READ;
|
|
}
|
|
if (ctrl & TYPE2_STORE) {
|
|
flags |= BP_MEM_WRITE;
|
|
}
|
|
|
|
if (flags & BP_MEM_ACCESS) {
|
|
size = type2_breakpoint_size(env, ctrl);
|
|
if (size != 0) {
|
|
cpu_watchpoint_insert(cs, addr, size, flags,
|
|
&env->cpu_watchpoint[index]);
|
|
} else {
|
|
cpu_watchpoint_insert(cs, addr, 8, flags,
|
|
&env->cpu_watchpoint[index]);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void type2_breakpoint_remove(CPURISCVState *env, target_ulong index)
|
|
{
|
|
CPUState *cs = env_cpu(env);
|
|
|
|
if (env->cpu_breakpoint[index]) {
|
|
cpu_breakpoint_remove_by_ref(cs, env->cpu_breakpoint[index]);
|
|
env->cpu_breakpoint[index] = NULL;
|
|
}
|
|
|
|
if (env->cpu_watchpoint[index]) {
|
|
cpu_watchpoint_remove_by_ref(cs, env->cpu_watchpoint[index]);
|
|
env->cpu_watchpoint[index] = NULL;
|
|
}
|
|
}
|
|
|
|
static void type2_reg_write(CPURISCVState *env, target_ulong index,
|
|
int tdata_index, target_ulong val)
|
|
{
|
|
target_ulong new_val;
|
|
|
|
switch (tdata_index) {
|
|
case TDATA1:
|
|
new_val = type2_mcontrol_validate(env, val);
|
|
if (new_val != env->tdata1[index]) {
|
|
env->tdata1[index] = new_val;
|
|
type2_breakpoint_remove(env, index);
|
|
type2_breakpoint_insert(env, index);
|
|
}
|
|
break;
|
|
case TDATA2:
|
|
if (val != env->tdata2[index]) {
|
|
env->tdata2[index] = val;
|
|
type2_breakpoint_remove(env, index);
|
|
type2_breakpoint_insert(env, index);
|
|
}
|
|
break;
|
|
case TDATA3:
|
|
qemu_log_mask(LOG_UNIMP,
|
|
"tdata3 is not supported for type 2 trigger\n");
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
/* type 6 trigger */
|
|
|
|
static inline bool type6_breakpoint_enabled(target_ulong ctrl)
|
|
{
|
|
bool mode = !!(ctrl & (TYPE6_VU | TYPE6_VS | TYPE6_U | TYPE6_S | TYPE6_M));
|
|
bool rwx = !!(ctrl & (TYPE6_LOAD | TYPE6_STORE | TYPE6_EXEC));
|
|
|
|
return mode && rwx;
|
|
}
|
|
|
|
static target_ulong type6_mcontrol6_validate(CPURISCVState *env,
|
|
target_ulong ctrl)
|
|
{
|
|
target_ulong val;
|
|
uint32_t size;
|
|
|
|
/* validate the generic part first */
|
|
val = tdata1_validate(env, ctrl, TRIGGER_TYPE_AD_MATCH6);
|
|
|
|
/* validate unimplemented (always zero) bits */
|
|
warn_always_zero_bit(ctrl, TYPE6_MATCH, "match");
|
|
warn_always_zero_bit(ctrl, TYPE6_CHAIN, "chain");
|
|
warn_always_zero_bit(ctrl, TYPE6_ACTION, "action");
|
|
warn_always_zero_bit(ctrl, TYPE6_TIMING, "timing");
|
|
warn_always_zero_bit(ctrl, TYPE6_SELECT, "select");
|
|
warn_always_zero_bit(ctrl, TYPE6_HIT, "hit");
|
|
|
|
/* validate size encoding */
|
|
size = extract32(ctrl, 16, 4);
|
|
if (access_size[size] == -1) {
|
|
qemu_log_mask(LOG_UNIMP, "access size %d is not supported, using "
|
|
"SIZE_ANY\n", size);
|
|
} else {
|
|
val |= (ctrl & TYPE6_SIZE);
|
|
}
|
|
|
|
/* keep the mode and attribute bits */
|
|
val |= (ctrl & (TYPE6_VU | TYPE6_VS | TYPE6_U | TYPE6_S | TYPE6_M |
|
|
TYPE6_LOAD | TYPE6_STORE | TYPE6_EXEC));
|
|
|
|
return val;
|
|
}
|
|
|
|
static void type6_breakpoint_insert(CPURISCVState *env, target_ulong index)
|
|
{
|
|
target_ulong ctrl = env->tdata1[index];
|
|
target_ulong addr = env->tdata2[index];
|
|
bool enabled = type6_breakpoint_enabled(ctrl);
|
|
CPUState *cs = env_cpu(env);
|
|
int flags = BP_CPU | BP_STOP_BEFORE_ACCESS;
|
|
uint32_t size;
|
|
|
|
if (!enabled) {
|
|
return;
|
|
}
|
|
|
|
if (ctrl & TYPE6_EXEC) {
|
|
cpu_breakpoint_insert(cs, addr, flags, &env->cpu_breakpoint[index]);
|
|
}
|
|
|
|
if (ctrl & TYPE6_LOAD) {
|
|
flags |= BP_MEM_READ;
|
|
}
|
|
|
|
if (ctrl & TYPE6_STORE) {
|
|
flags |= BP_MEM_WRITE;
|
|
}
|
|
|
|
if (flags & BP_MEM_ACCESS) {
|
|
size = extract32(ctrl, 16, 4);
|
|
if (size != 0) {
|
|
cpu_watchpoint_insert(cs, addr, size, flags,
|
|
&env->cpu_watchpoint[index]);
|
|
} else {
|
|
cpu_watchpoint_insert(cs, addr, 8, flags,
|
|
&env->cpu_watchpoint[index]);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void type6_breakpoint_remove(CPURISCVState *env, target_ulong index)
|
|
{
|
|
type2_breakpoint_remove(env, index);
|
|
}
|
|
|
|
static void type6_reg_write(CPURISCVState *env, target_ulong index,
|
|
int tdata_index, target_ulong val)
|
|
{
|
|
target_ulong new_val;
|
|
|
|
switch (tdata_index) {
|
|
case TDATA1:
|
|
new_val = type6_mcontrol6_validate(env, val);
|
|
if (new_val != env->tdata1[index]) {
|
|
env->tdata1[index] = new_val;
|
|
type6_breakpoint_remove(env, index);
|
|
type6_breakpoint_insert(env, index);
|
|
}
|
|
break;
|
|
case TDATA2:
|
|
if (val != env->tdata2[index]) {
|
|
env->tdata2[index] = val;
|
|
type6_breakpoint_remove(env, index);
|
|
type6_breakpoint_insert(env, index);
|
|
}
|
|
break;
|
|
case TDATA3:
|
|
qemu_log_mask(LOG_UNIMP,
|
|
"tdata3 is not supported for type 6 trigger\n");
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
/* icount trigger type */
|
|
static inline int
|
|
itrigger_get_count(CPURISCVState *env, int index)
|
|
{
|
|
return get_field(env->tdata1[index], ITRIGGER_COUNT);
|
|
}
|
|
|
|
static inline void
|
|
itrigger_set_count(CPURISCVState *env, int index, int value)
|
|
{
|
|
env->tdata1[index] = set_field(env->tdata1[index],
|
|
ITRIGGER_COUNT, value);
|
|
}
|
|
|
|
static bool check_itrigger_priv(CPURISCVState *env, int index)
|
|
{
|
|
target_ulong tdata1 = env->tdata1[index];
|
|
if (env->virt_enabled) {
|
|
/* check VU/VS bit against current privilege level */
|
|
return (get_field(tdata1, ITRIGGER_VS) == env->priv) ||
|
|
(get_field(tdata1, ITRIGGER_VU) == env->priv);
|
|
} else {
|
|
/* check U/S/M bit against current privilege level */
|
|
return (get_field(tdata1, ITRIGGER_M) == env->priv) ||
|
|
(get_field(tdata1, ITRIGGER_S) == env->priv) ||
|
|
(get_field(tdata1, ITRIGGER_U) == env->priv);
|
|
}
|
|
}
|
|
|
|
bool riscv_itrigger_enabled(CPURISCVState *env)
|
|
{
|
|
int count;
|
|
for (int i = 0; i < RV_MAX_TRIGGERS; i++) {
|
|
if (get_trigger_type(env, i) != TRIGGER_TYPE_INST_CNT) {
|
|
continue;
|
|
}
|
|
if (check_itrigger_priv(env, i)) {
|
|
continue;
|
|
}
|
|
count = itrigger_get_count(env, i);
|
|
if (!count) {
|
|
continue;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
void helper_itrigger_match(CPURISCVState *env)
|
|
{
|
|
int count;
|
|
for (int i = 0; i < RV_MAX_TRIGGERS; i++) {
|
|
if (get_trigger_type(env, i) != TRIGGER_TYPE_INST_CNT) {
|
|
continue;
|
|
}
|
|
if (check_itrigger_priv(env, i)) {
|
|
continue;
|
|
}
|
|
count = itrigger_get_count(env, i);
|
|
if (!count) {
|
|
continue;
|
|
}
|
|
itrigger_set_count(env, i, count--);
|
|
if (!count) {
|
|
env->itrigger_enabled = riscv_itrigger_enabled(env);
|
|
do_trigger_action(env, i);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void riscv_itrigger_update_count(CPURISCVState *env)
|
|
{
|
|
int count, executed;
|
|
/*
|
|
* Record last icount, so that we can evaluate the executed instructions
|
|
* since last privilege mode change or timer expire.
|
|
*/
|
|
int64_t last_icount = env->last_icount, current_icount;
|
|
current_icount = env->last_icount = icount_get_raw();
|
|
|
|
for (int i = 0; i < RV_MAX_TRIGGERS; i++) {
|
|
if (get_trigger_type(env, i) != TRIGGER_TYPE_INST_CNT) {
|
|
continue;
|
|
}
|
|
count = itrigger_get_count(env, i);
|
|
if (!count) {
|
|
continue;
|
|
}
|
|
/*
|
|
* Only when privilege is changed or itrigger timer expires,
|
|
* the count field in itrigger tdata1 register is updated.
|
|
* And the count field in itrigger only contains remaining value.
|
|
*/
|
|
if (check_itrigger_priv(env, i)) {
|
|
/*
|
|
* If itrigger enabled in this privilege mode, the number of
|
|
* executed instructions since last privilege change
|
|
* should be reduced from current itrigger count.
|
|
*/
|
|
executed = current_icount - last_icount;
|
|
itrigger_set_count(env, i, count - executed);
|
|
if (count == executed) {
|
|
do_trigger_action(env, i);
|
|
}
|
|
} else {
|
|
/*
|
|
* If itrigger is not enabled in this privilege mode,
|
|
* the number of executed instructions will be discard and
|
|
* the count field in itrigger will not change.
|
|
*/
|
|
timer_mod(env->itrigger_timer[i],
|
|
current_icount + count);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void riscv_itrigger_timer_cb(void *opaque)
|
|
{
|
|
riscv_itrigger_update_count((CPURISCVState *)opaque);
|
|
}
|
|
|
|
void riscv_itrigger_update_priv(CPURISCVState *env)
|
|
{
|
|
riscv_itrigger_update_count(env);
|
|
}
|
|
|
|
static target_ulong itrigger_validate(CPURISCVState *env,
|
|
target_ulong ctrl)
|
|
{
|
|
target_ulong val;
|
|
|
|
/* validate the generic part first */
|
|
val = tdata1_validate(env, ctrl, TRIGGER_TYPE_INST_CNT);
|
|
|
|
/* validate unimplemented (always zero) bits */
|
|
warn_always_zero_bit(ctrl, ITRIGGER_ACTION, "action");
|
|
warn_always_zero_bit(ctrl, ITRIGGER_HIT, "hit");
|
|
warn_always_zero_bit(ctrl, ITRIGGER_PENDING, "pending");
|
|
|
|
/* keep the mode and attribute bits */
|
|
val |= ctrl & (ITRIGGER_VU | ITRIGGER_VS | ITRIGGER_U | ITRIGGER_S |
|
|
ITRIGGER_M | ITRIGGER_COUNT);
|
|
|
|
return val;
|
|
}
|
|
|
|
static void itrigger_reg_write(CPURISCVState *env, target_ulong index,
|
|
int tdata_index, target_ulong val)
|
|
{
|
|
target_ulong new_val;
|
|
|
|
switch (tdata_index) {
|
|
case TDATA1:
|
|
/* set timer for icount */
|
|
new_val = itrigger_validate(env, val);
|
|
if (new_val != env->tdata1[index]) {
|
|
env->tdata1[index] = new_val;
|
|
if (icount_enabled()) {
|
|
env->last_icount = icount_get_raw();
|
|
/* set the count to timer */
|
|
timer_mod(env->itrigger_timer[index],
|
|
env->last_icount + itrigger_get_count(env, index));
|
|
} else {
|
|
env->itrigger_enabled = riscv_itrigger_enabled(env);
|
|
}
|
|
}
|
|
break;
|
|
case TDATA2:
|
|
qemu_log_mask(LOG_UNIMP,
|
|
"tdata2 is not supported for icount trigger\n");
|
|
break;
|
|
case TDATA3:
|
|
qemu_log_mask(LOG_UNIMP,
|
|
"tdata3 is not supported for icount trigger\n");
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
static int itrigger_get_adjust_count(CPURISCVState *env)
|
|
{
|
|
int count = itrigger_get_count(env, env->trigger_cur), executed;
|
|
if ((count != 0) && check_itrigger_priv(env, env->trigger_cur)) {
|
|
executed = icount_get_raw() - env->last_icount;
|
|
count += executed;
|
|
}
|
|
return count;
|
|
}
|
|
|
|
target_ulong tdata_csr_read(CPURISCVState *env, int tdata_index)
|
|
{
|
|
int trigger_type;
|
|
switch (tdata_index) {
|
|
case TDATA1:
|
|
trigger_type = extract_trigger_type(env,
|
|
env->tdata1[env->trigger_cur]);
|
|
if ((trigger_type == TRIGGER_TYPE_INST_CNT) && icount_enabled()) {
|
|
return deposit64(env->tdata1[env->trigger_cur], 10, 14,
|
|
itrigger_get_adjust_count(env));
|
|
}
|
|
return env->tdata1[env->trigger_cur];
|
|
case TDATA2:
|
|
return env->tdata2[env->trigger_cur];
|
|
case TDATA3:
|
|
return env->tdata3[env->trigger_cur];
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
}
|
|
|
|
void tdata_csr_write(CPURISCVState *env, int tdata_index, target_ulong val)
|
|
{
|
|
int trigger_type;
|
|
|
|
if (tdata_index == TDATA1) {
|
|
trigger_type = extract_trigger_type(env, val);
|
|
} else {
|
|
trigger_type = get_trigger_type(env, env->trigger_cur);
|
|
}
|
|
|
|
switch (trigger_type) {
|
|
case TRIGGER_TYPE_AD_MATCH:
|
|
type2_reg_write(env, env->trigger_cur, tdata_index, val);
|
|
break;
|
|
case TRIGGER_TYPE_AD_MATCH6:
|
|
type6_reg_write(env, env->trigger_cur, tdata_index, val);
|
|
break;
|
|
case TRIGGER_TYPE_INST_CNT:
|
|
itrigger_reg_write(env, env->trigger_cur, tdata_index, val);
|
|
break;
|
|
case TRIGGER_TYPE_INT:
|
|
case TRIGGER_TYPE_EXCP:
|
|
case TRIGGER_TYPE_EXT_SRC:
|
|
qemu_log_mask(LOG_UNIMP, "trigger type: %d is not supported\n",
|
|
trigger_type);
|
|
break;
|
|
case TRIGGER_TYPE_NO_EXIST:
|
|
case TRIGGER_TYPE_UNAVAIL:
|
|
qemu_log_mask(LOG_GUEST_ERROR, "trigger type: %d does not exit\n",
|
|
trigger_type);
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
}
|
|
|
|
target_ulong tinfo_csr_read(CPURISCVState *env)
|
|
{
|
|
/* assume all triggers support the same types of triggers */
|
|
return BIT(TRIGGER_TYPE_AD_MATCH) |
|
|
BIT(TRIGGER_TYPE_AD_MATCH6);
|
|
}
|
|
|
|
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) {
|
|
do_trigger_action(env, DBG_ACTION_BP);
|
|
}
|
|
} else {
|
|
if (cpu_breakpoint_test(cs, env->pc, BP_CPU)) {
|
|
do_trigger_action(env, DBG_ACTION_BP);
|
|
}
|
|
}
|
|
}
|
|
|
|
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 trigger_type;
|
|
int i;
|
|
|
|
QTAILQ_FOREACH(bp, &cs->breakpoints, entry) {
|
|
for (i = 0; i < RV_MAX_TRIGGERS; i++) {
|
|
trigger_type = get_trigger_type(env, i);
|
|
|
|
switch (trigger_type) {
|
|
case TRIGGER_TYPE_AD_MATCH:
|
|
/* type 2 trigger cannot be fired in VU/VS mode */
|
|
if (env->virt_enabled) {
|
|
return false;
|
|
}
|
|
|
|
ctrl = env->tdata1[i];
|
|
pc = env->tdata2[i];
|
|
|
|
if ((ctrl & TYPE2_EXEC) && (bp->pc == pc)) {
|
|
/* check U/S/M bit against current privilege level */
|
|
if ((ctrl >> 3) & BIT(env->priv)) {
|
|
env->badaddr = pc;
|
|
return true;
|
|
}
|
|
}
|
|
break;
|
|
case TRIGGER_TYPE_AD_MATCH6:
|
|
ctrl = env->tdata1[i];
|
|
pc = env->tdata2[i];
|
|
|
|
if ((ctrl & TYPE6_EXEC) && (bp->pc == pc)) {
|
|
if (env->virt_enabled) {
|
|
/* check VU/VS bit against current privilege level */
|
|
if ((ctrl >> 23) & BIT(env->priv)) {
|
|
env->badaddr = pc;
|
|
return true;
|
|
}
|
|
} else {
|
|
/* check U/S/M bit against current privilege level */
|
|
if ((ctrl >> 3) & BIT(env->priv)) {
|
|
env->badaddr = pc;
|
|
return true;
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
default:
|
|
/* other trigger types are not supported or irrelevant */
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
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 trigger_type;
|
|
int flags;
|
|
int i;
|
|
|
|
for (i = 0; i < RV_MAX_TRIGGERS; i++) {
|
|
trigger_type = get_trigger_type(env, i);
|
|
|
|
switch (trigger_type) {
|
|
case TRIGGER_TYPE_AD_MATCH:
|
|
/* type 2 trigger cannot be fired in VU/VS mode */
|
|
if (env->virt_enabled) {
|
|
return false;
|
|
}
|
|
|
|
ctrl = env->tdata1[i];
|
|
addr = env->tdata2[i];
|
|
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;
|
|
}
|
|
}
|
|
break;
|
|
case TRIGGER_TYPE_AD_MATCH6:
|
|
ctrl = env->tdata1[i];
|
|
addr = env->tdata2[i];
|
|
flags = 0;
|
|
|
|
if (ctrl & TYPE6_LOAD) {
|
|
flags |= BP_MEM_READ;
|
|
}
|
|
if (ctrl & TYPE6_STORE) {
|
|
flags |= BP_MEM_WRITE;
|
|
}
|
|
|
|
if ((wp->flags & flags) && (wp->vaddr == addr)) {
|
|
if (env->virt_enabled) {
|
|
/* check VU/VS bit against current privilege level */
|
|
if ((ctrl >> 23) & BIT(env->priv)) {
|
|
return true;
|
|
}
|
|
} else {
|
|
/* check U/S/M bit against current privilege level */
|
|
if ((ctrl >> 3) & BIT(env->priv)) {
|
|
return true;
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
default:
|
|
/* other trigger types are not supported */
|
|
break;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
void riscv_trigger_realize(CPURISCVState *env)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < RV_MAX_TRIGGERS; i++) {
|
|
env->itrigger_timer[i] = timer_new_ns(QEMU_CLOCK_VIRTUAL,
|
|
riscv_itrigger_timer_cb, env);
|
|
}
|
|
}
|
|
|
|
void riscv_trigger_reset_hold(CPURISCVState *env)
|
|
{
|
|
target_ulong tdata1 = build_tdata1(env, TRIGGER_TYPE_AD_MATCH, 0, 0);
|
|
int i;
|
|
|
|
/* init to type 2 triggers */
|
|
for (i = 0; i < RV_MAX_TRIGGERS; i++) {
|
|
/*
|
|
* type = TRIGGER_TYPE_AD_MATCH
|
|
* dmode = 0 (both debug and M-mode can write tdata)
|
|
* maskmax = 0 (unimplemented, always 0)
|
|
* sizehi = 0 (match against any size, RV64 only)
|
|
* hit = 0 (unimplemented, always 0)
|
|
* select = 0 (always 0, perform match on address)
|
|
* timing = 0 (always 0, trigger before instruction)
|
|
* sizelo = 0 (match against any size)
|
|
* action = 0 (always 0, raise a breakpoint exception)
|
|
* chain = 0 (unimplemented, always 0)
|
|
* match = 0 (always 0, when any compare value equals tdata2)
|
|
*/
|
|
env->tdata1[i] = tdata1;
|
|
env->tdata2[i] = 0;
|
|
env->tdata3[i] = 0;
|
|
env->cpu_breakpoint[i] = NULL;
|
|
env->cpu_watchpoint[i] = NULL;
|
|
timer_del(env->itrigger_timer[i]);
|
|
}
|
|
|
|
env->mcontext = 0;
|
|
}
|