int cmd_set(char **arg)
{
char *reg_text = get_arg(arg);
char *val_text = get_arg(arg);
int reg;
address_t value = 0;
address_t regs[DEVICE_NUM_REGS];
if (!(reg_text && val_text)) {
printc_err("set: must specify a register and a value\n");
return -1;
}
reg = dis_reg_from_name(reg_text);
if (reg < 0) {
printc_err("set: unknown register: %s\n", reg_text);
return -1;
}
if (expr_eval(val_text, &value) < 0) {
printc_err("set: can't parse value: %s\n", val_text);
return -1;
}
if (device_getregs(regs) < 0)
return -1;
regs[reg] = value;
if (device_setregs(regs) < 0)
return -1;
show_regs(regs);
return 0;
}
static int run_set_pc(struct gdb_data *data, char *buf)
{
address_t regs[DEVICE_NUM_REGS];
if (!*buf)
return 0;
if (device_getregs(regs) < 0)
return -1;
regs[0] = strtoul(buf, NULL, 16);
return device_setregs(regs);
}
static int write_registers(struct gdb_data *data, char *buf)
{
address_t regs[DEVICE_NUM_REGS];
int i;
if (strlen(buf) < DEVICE_NUM_REGS * 4)
return gdb_send(data, "E00");
printc("Writing registers\n");
for (i = 0; i < DEVICE_NUM_REGS; i++) {
regs[i] = (hexval(buf[2]) << 12) |
(hexval(buf[3]) << 8) |
(hexval(buf[0]) << 4) |
hexval(buf[1]);
buf += 4;
}
if (device_setregs(regs) < 0)
return gdb_send(data, "E00");
return gdb_send(data, "OK");
}
