38256529f3
Directly use env->virt_enabled instead. Suggested-by: LIU Zhiwei <zhiwei_liu@linux.alibaba.com> Signed-off-by: Weiwei Li <liweiwei@iscas.ac.cn> Signed-off-by: Junqiang Wang <wangjunqiang@iscas.ac.cn> Reviewed-by: Richard Henderson <richard.henderson@linaro.org> Reviewed-by: LIU Zhiwei <zhiwei_liu@linux.alibaba.com> Reviewed-by: Alistair Francis <alistair.francis@wdc.com> Reviewed-by: Daniel Henrique Barboza <dbarboza@ventanamicro.com> Message-Id: <20230405085813.40643-2-liweiwei@iscas.ac.cn> Signed-off-by: Alistair Francis <alistair.francis@wdc.com>
934 lines
27 KiB
C
934 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 priviledge 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 priviledge 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 priviledge mode, the number of
|
|
* executed instructions since last priviledge 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 priviledge 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)) {
|
|
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)) {
|
|
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 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_init(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;
|
|
env->itrigger_timer[i] = timer_new_ns(QEMU_CLOCK_VIRTUAL,
|
|
riscv_itrigger_timer_cb, env);
|
|
}
|
|
}
|