|
| 1 | +#include <assert.h> |
| 2 | +#include "mini-gdbstub/include/gdbstub.h" |
| 3 | +#include "riscv.h" |
| 4 | + |
| 5 | +static 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 | +static 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 | +static 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 | + for (; !rv_has_halted(rv);) { |
| 33 | + if (rv_get_breakpoint(rv, &bp_addr) && (rv_get_pc(rv) == bp_addr)) { |
| 34 | + break; |
| 35 | + } |
| 36 | + rv_step(rv, cycles_per_step); |
| 37 | + } |
| 38 | + |
| 39 | + return ACT_RESUME; |
| 40 | +} |
| 41 | + |
| 42 | +static gdb_action_t rv_stepi(void *args) |
| 43 | +{ |
| 44 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 45 | + rv_step(rv, 1); |
| 46 | + return ACT_RESUME; |
| 47 | + |
| 48 | +} |
| 49 | + |
| 50 | +static bool rv_set_bp(void *args, size_t addr, bp_type_t type) |
| 51 | +{ |
| 52 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 53 | + if (type != BP_SOFTWARE) |
| 54 | + return false; |
| 55 | + |
| 56 | + return rv_set_breakpoint(rv, addr); |
| 57 | +} |
| 58 | + |
| 59 | +static bool rv_rm_bp(void *args, size_t addr, bp_type_t type) |
| 60 | +{ |
| 61 | + struct riscv_t *rv = (struct riscv_t *) args; |
| 62 | + if (type != BP_SOFTWARE) |
| 63 | + return false; |
| 64 | + // It's fine when there's no matching breakpoint, just doing nothing |
| 65 | + rv_reset_breakpoint(rv, addr); |
| 66 | + |
| 67 | + return true; |
| 68 | +} |
| 69 | + |
| 70 | +struct target_ops rv_ops = { |
| 71 | + .read_reg = rv_read_reg, |
| 72 | + .read_mem = rv_read_mem, |
| 73 | + .cont = rv_cont, |
| 74 | + .stepi = rv_stepi, |
| 75 | + .set_bp = rv_set_bp, |
| 76 | + .rm_bp = rv_rm_bp, |
| 77 | +}; |
0 commit comments