Merge pull request #13 from sifive/disable_interrupts
riscv: Globally disable interrupts when running algorithms.
This commit is contained in:
commit
9bab0782d3
|
@ -2696,6 +2696,19 @@ static int riscv_run_algorithm(struct target *target, int num_mem_params,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Disable Interrupts before attempting to run the algorithm.
|
||||||
|
uint64_t current_mstatus;
|
||||||
|
uint8_t mstatus_bytes[8];
|
||||||
|
|
||||||
|
LOG_DEBUG("Disabling Interrupts");
|
||||||
|
register_get(&target->reg_cache->reg_list[REG_MSTATUS]);
|
||||||
|
current_mstatus = buf_get_u64(target->reg_cache->reg_list[REG_MSTATUS].value, 0, info->xlen);
|
||||||
|
uint64_t ie_mask = MSTATUS_MIE | MSTATUS_HIE | MSTATUS_SIE | MSTATUS_UIE;
|
||||||
|
buf_set_u64(mstatus_bytes, 0, info->xlen, set_field(current_mstatus, ie_mask, 0));
|
||||||
|
|
||||||
|
register_set(&target->reg_cache->reg_list[REG_MSTATUS], mstatus_bytes);
|
||||||
|
|
||||||
/// Run algorithm
|
/// Run algorithm
|
||||||
LOG_DEBUG("resume at 0x%x", entry_point);
|
LOG_DEBUG("resume at 0x%x", entry_point);
|
||||||
if (riscv_resume(target, 0, entry_point, 0, 0) != ERROR_OK) {
|
if (riscv_resume(target, 0, entry_point, 0, 0) != ERROR_OK) {
|
||||||
|
@ -2729,6 +2742,11 @@ static int riscv_run_algorithm(struct target *target, int num_mem_params,
|
||||||
return ERROR_FAIL;
|
return ERROR_FAIL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Restore Interrupts
|
||||||
|
LOG_DEBUG("Restoring Interrupts");
|
||||||
|
buf_set_u64(mstatus_bytes, 0, info->xlen, current_mstatus);
|
||||||
|
register_set(&target->reg_cache->reg_list[REG_MSTATUS], mstatus_bytes);
|
||||||
|
|
||||||
/// Restore registers
|
/// Restore registers
|
||||||
uint8_t buf[8];
|
uint8_t buf[8];
|
||||||
buf_set_u64(buf, 0, info->xlen, saved_pc);
|
buf_set_u64(buf, 0, info->xlen, saved_pc);
|
||||||
|
|
Loading…
Reference in New Issue