|
| 1 | +#include <assert.h> |
| 2 | +#include "mini-gdbstub/include/gdbstub.h" |
| 3 | +#include "riscv.h" |
| 4 | + |
| 5 | +size_t rv_read_reg(void *args, int regno) |
| 6 | +{ |
| 7 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 8 | + |
| 9 | + if (regno < 32) { |
| 10 | + return rv_get_reg(rv, regno); |
| 11 | + } else if (regno == 32) { |
| 12 | + return rv_get_pc(rv); |
| 13 | + } |
| 14 | + |
| 15 | + return -1; |
| 16 | +} |
| 17 | + |
| 18 | +void rv_read_mem(void *args, size_t addr, size_t len, void *val) |
| 19 | +{ |
| 20 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 21 | + |
| 22 | + for (size_t i = 0; i < len; i++) |
| 23 | + *((uint8_t *) val + i) = rv_get_mem(rv, addr); |
| 24 | +} |
| 25 | + |
| 26 | +gdb_action_t rv_cont(void *args) |
| 27 | +{ |
| 28 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 29 | + const uint32_t cycles_per_step = 1; |
| 30 | + riscv_word_t bp_addr; |
| 31 | + |
| 32 | + |
| 33 | + for (; !rv_has_halted(rv);) { |
| 34 | + if (rv_get_breakpoint(rv, &bp_addr) && (rv_get_pc(rv) == bp_addr)) { |
| 35 | + break; |
| 36 | + } |
| 37 | + /* step instructions */ |
| 38 | + rv_step(rv, cycles_per_step); |
| 39 | + } |
| 40 | + |
| 41 | + return ACT_RESUME; |
| 42 | +} |
| 43 | + |
| 44 | +bool rv_set_bp(void *args, size_t addr, bp_type_t type) |
| 45 | +{ |
| 46 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 47 | + if (type != BP_SOFTWARE) |
| 48 | + return false; |
| 49 | + |
| 50 | + return rv_set_breakpoint(rv, addr); |
| 51 | +} |
| 52 | + |
| 53 | +bool rv_rm_bp(void *args, size_t addr, bp_type_t type) |
| 54 | +{ |
| 55 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 56 | + if (type != BP_SOFTWARE) |
| 57 | + return false; |
| 58 | + // It's fine when there's no matching breakpoint, just doing nothing |
| 59 | + rv_reset_breakpoint(rv, addr); |
| 60 | + |
| 61 | + return true; |
| 62 | +} |
| 63 | + |
| 64 | +struct target_ops rv_ops = { |
| 65 | + .read_reg = rv_read_reg, |
| 66 | + .read_mem = rv_read_mem, |
| 67 | + .cont = rv_cont, |
| 68 | + .stepi = NULL, |
| 69 | + .set_bp = rv_set_bp, |
| 70 | + .rm_bp = rv_rm_bp, |
| 71 | +}; |
0 commit comments