interesting
/
riscv-openocd
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Merge adf3e85bac into 67082829da

This commit is contained in:
Samuel Obuch 2025-03-07 13:00:08 +03:00 committed by GitHub
parent 67082829da adf3e85bac
commit 17817b8489
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
2 changed files with 24 additions and 44 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

65
src/target/riscv/riscv.c
View File

@ -294,6 +294,10 @@ static enum riscv_halt_reason riscv_halt_reason(struct target *target);
static void riscv_info_init(struct target *target, struct riscv_info *r);
static int riscv_step_rtos_hart(struct target *target);
static const riscv_reg_t mstatus_ie_mask = MSTATUS_MIE | MSTATUS_HIE | MSTATUS_SIE | MSTATUS_UIE;
static int riscv_interrupts_disable(struct target *target, riscv_reg_t *old_mstatus);
static int riscv_interrupts_restore(struct target *target, riscv_reg_t old_mstatus);
static void riscv_sample_buf_maybe_add_timestamp(struct target *target, bool before)
{
RISCV_INFO(r);
@ -3645,9 +3649,8 @@ static int riscv_run_algorithm(struct target *target, int num_mem_params,
}
/* Disable Interrupts before attempting to run the algorithm. */
uint64_t current_mstatus;
uint64_t irq_disabled_mask = MSTATUS_MIE | MSTATUS_HIE | MSTATUS_SIE | MSTATUS_UIE;
if (riscv_interrupts_disable(target, irq_disabled_mask, &current_mstatus) != ERROR_OK)
riscv_reg_t current_mstatus;
if (riscv_interrupts_disable(target, &current_mstatus) != ERROR_OK)
return ERROR_FAIL;
/* Run algorithm */
@ -4227,14 +4230,12 @@ static int riscv_openocd_step_impl(struct target *target, int current,
}
bool success = true;
uint64_t current_mstatus;
riscv_reg_t current_mstatus;
RISCV_INFO(info);
if (info->isrmask_mode == RISCV_ISRMASK_STEPONLY) {
/* Disable Interrupts before stepping. */
uint64_t irq_disabled_mask = MSTATUS_MIE | MSTATUS_HIE | MSTATUS_SIE | MSTATUS_UIE;
if (riscv_interrupts_disable(target, irq_disabled_mask,
&current_mstatus) != ERROR_OK) {
if (riscv_interrupts_disable(target, &current_mstatus) != ERROR_OK) {
success = false;
LOG_TARGET_ERROR(target, "Unable to disable interrupts.");
goto _exit;
@ -6001,50 +6002,32 @@ static int riscv_resume_go_all_harts(struct target *target)
return ERROR_OK;
}
int riscv_interrupts_disable(struct target *target, uint64_t irq_mask, uint64_t *old_mstatus)
static int riscv_interrupts_disable(struct target *target, riscv_reg_t *old_mstatus)
{
LOG_TARGET_DEBUG(target, "Disabling interrupts.");
struct reg *reg_mstatus = register_get_by_name(target->reg_cache,
"mstatus", true);
if (!reg_mstatus) {
LOG_TARGET_ERROR(target, "Couldn't find mstatus!");
return ERROR_FAIL;
riscv_reg_t current_mstatus;
int ret = riscv_reg_get(target, &current_mstatus, GDB_REGNO_MSTATUS);
if (ret != ERROR_OK) {
LOG_TARGET_ERROR(target, "Failed to read mstatus!");
return ret;
}
int retval = reg_mstatus->type->get(reg_mstatus);
if (retval != ERROR_OK)
return retval;
RISCV_INFO(info);
uint8_t mstatus_bytes[8] = { 0 };
uint64_t current_mstatus = buf_get_u64(reg_mstatus->value, 0, reg_mstatus->size);
buf_set_u64(mstatus_bytes, 0, info->xlen, set_field(current_mstatus,
irq_mask, 0));
retval = reg_mstatus->type->set(reg_mstatus, mstatus_bytes);
if (retval != ERROR_OK)
return retval;
if (old_mstatus)
*old_mstatus = current_mstatus;
return ERROR_OK;
return riscv_reg_set(target, GDB_REGNO_MSTATUS, current_mstatus & ~mstatus_ie_mask);
}
int riscv_interrupts_restore(struct target *target, uint64_t old_mstatus)
static int riscv_interrupts_restore(struct target *target, riscv_reg_t old_mstatus)
{
LOG_TARGET_DEBUG(target, "Restoring interrupts.");
struct reg *reg_mstatus = register_get_by_name(target->reg_cache,
"mstatus", true);
if (!reg_mstatus) {
LOG_TARGET_ERROR(target, "Couldn't find mstatus!");
return ERROR_FAIL;
riscv_reg_t current_mstatus;
int ret = riscv_reg_get(target, &current_mstatus, GDB_REGNO_MSTATUS);
if (ret != ERROR_OK) {
LOG_TARGET_ERROR(target, "Failed to read mstatus!");
return ret;
}
RISCV_INFO(info);
uint8_t mstatus_bytes[8];
buf_set_u64(mstatus_bytes, 0, info->xlen, old_mstatus);
return reg_mstatus->type->set(reg_mstatus, mstatus_bytes);
if ((current_mstatus & mstatus_ie_mask) != 0)
LOG_TARGET_WARNING(target, "Interrupt enable bits in mstatus changed!");
return riscv_reg_set(target, GDB_REGNO_MSTATUS, current_mstatus | (old_mstatus & mstatus_ie_mask));
}
static int riscv_step_rtos_hart(struct target *target)

3
src/target/riscv/riscv.h
View File

@ -503,7 +503,4 @@ void riscv_add_bscan_tunneled_scan(struct jtag_tap *tap, const struct scan_field
int riscv_read_by_any_size(struct target *target, target_addr_t address, uint32_t size, uint8_t *buffer);
int riscv_write_by_any_size(struct target *target, target_addr_t address, uint32_t size, uint8_t *buffer);
int riscv_interrupts_disable(struct target *target, uint64_t ie_mask, uint64_t *old_mstatus);
int riscv_interrupts_restore(struct target *target, uint64_t old_mstatus);
#endif /* OPENOCD_TARGET_RISCV_RISCV_H */