432 lines
10 KiB
C
432 lines
10 KiB
C
/*
|
|
* RISC-V GDB Server Stub
|
|
*
|
|
* Copyright (c) 2016-2017 Sagar Karandikar, sagark@eecs.berkeley.edu
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2 or later, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "exec/gdbstub.h"
|
|
#include "cpu.h"
|
|
|
|
/*
|
|
* The GDB CSR xml files list them in documentation order, not numerical order,
|
|
* and are missing entries for unnamed CSRs. So we need to map the gdb numbers
|
|
* to the hardware numbers.
|
|
*/
|
|
|
|
static int csr_register_map[] = {
|
|
CSR_USTATUS,
|
|
CSR_UIE,
|
|
CSR_UTVEC,
|
|
CSR_USCRATCH,
|
|
CSR_UEPC,
|
|
CSR_UCAUSE,
|
|
CSR_UTVAL,
|
|
CSR_UIP,
|
|
CSR_FFLAGS,
|
|
CSR_FRM,
|
|
CSR_FCSR,
|
|
CSR_CYCLE,
|
|
CSR_TIME,
|
|
CSR_INSTRET,
|
|
CSR_HPMCOUNTER3,
|
|
CSR_HPMCOUNTER4,
|
|
CSR_HPMCOUNTER5,
|
|
CSR_HPMCOUNTER6,
|
|
CSR_HPMCOUNTER7,
|
|
CSR_HPMCOUNTER8,
|
|
CSR_HPMCOUNTER9,
|
|
CSR_HPMCOUNTER10,
|
|
CSR_HPMCOUNTER11,
|
|
CSR_HPMCOUNTER12,
|
|
CSR_HPMCOUNTER13,
|
|
CSR_HPMCOUNTER14,
|
|
CSR_HPMCOUNTER15,
|
|
CSR_HPMCOUNTER16,
|
|
CSR_HPMCOUNTER17,
|
|
CSR_HPMCOUNTER18,
|
|
CSR_HPMCOUNTER19,
|
|
CSR_HPMCOUNTER20,
|
|
CSR_HPMCOUNTER21,
|
|
CSR_HPMCOUNTER22,
|
|
CSR_HPMCOUNTER23,
|
|
CSR_HPMCOUNTER24,
|
|
CSR_HPMCOUNTER25,
|
|
CSR_HPMCOUNTER26,
|
|
CSR_HPMCOUNTER27,
|
|
CSR_HPMCOUNTER28,
|
|
CSR_HPMCOUNTER29,
|
|
CSR_HPMCOUNTER30,
|
|
CSR_HPMCOUNTER31,
|
|
CSR_CYCLEH,
|
|
CSR_TIMEH,
|
|
CSR_INSTRETH,
|
|
CSR_HPMCOUNTER3H,
|
|
CSR_HPMCOUNTER4H,
|
|
CSR_HPMCOUNTER5H,
|
|
CSR_HPMCOUNTER6H,
|
|
CSR_HPMCOUNTER7H,
|
|
CSR_HPMCOUNTER8H,
|
|
CSR_HPMCOUNTER9H,
|
|
CSR_HPMCOUNTER10H,
|
|
CSR_HPMCOUNTER11H,
|
|
CSR_HPMCOUNTER12H,
|
|
CSR_HPMCOUNTER13H,
|
|
CSR_HPMCOUNTER14H,
|
|
CSR_HPMCOUNTER15H,
|
|
CSR_HPMCOUNTER16H,
|
|
CSR_HPMCOUNTER17H,
|
|
CSR_HPMCOUNTER18H,
|
|
CSR_HPMCOUNTER19H,
|
|
CSR_HPMCOUNTER20H,
|
|
CSR_HPMCOUNTER21H,
|
|
CSR_HPMCOUNTER22H,
|
|
CSR_HPMCOUNTER23H,
|
|
CSR_HPMCOUNTER24H,
|
|
CSR_HPMCOUNTER25H,
|
|
CSR_HPMCOUNTER26H,
|
|
CSR_HPMCOUNTER27H,
|
|
CSR_HPMCOUNTER28H,
|
|
CSR_HPMCOUNTER29H,
|
|
CSR_HPMCOUNTER30H,
|
|
CSR_HPMCOUNTER31H,
|
|
CSR_SSTATUS,
|
|
CSR_SEDELEG,
|
|
CSR_SIDELEG,
|
|
CSR_SIE,
|
|
CSR_STVEC,
|
|
CSR_SCOUNTEREN,
|
|
CSR_SSCRATCH,
|
|
CSR_SEPC,
|
|
CSR_SCAUSE,
|
|
CSR_STVAL,
|
|
CSR_SIP,
|
|
CSR_SATP,
|
|
CSR_MVENDORID,
|
|
CSR_MARCHID,
|
|
CSR_MIMPID,
|
|
CSR_MHARTID,
|
|
CSR_MSTATUS,
|
|
CSR_MISA,
|
|
CSR_MEDELEG,
|
|
CSR_MIDELEG,
|
|
CSR_MIE,
|
|
CSR_MTVEC,
|
|
CSR_MCOUNTEREN,
|
|
CSR_MSCRATCH,
|
|
CSR_MEPC,
|
|
CSR_MCAUSE,
|
|
CSR_MTVAL,
|
|
CSR_MIP,
|
|
CSR_MTINST,
|
|
CSR_MTVAL2,
|
|
CSR_PMPCFG0,
|
|
CSR_PMPCFG1,
|
|
CSR_PMPCFG2,
|
|
CSR_PMPCFG3,
|
|
CSR_PMPADDR0,
|
|
CSR_PMPADDR1,
|
|
CSR_PMPADDR2,
|
|
CSR_PMPADDR3,
|
|
CSR_PMPADDR4,
|
|
CSR_PMPADDR5,
|
|
CSR_PMPADDR6,
|
|
CSR_PMPADDR7,
|
|
CSR_PMPADDR8,
|
|
CSR_PMPADDR9,
|
|
CSR_PMPADDR10,
|
|
CSR_PMPADDR11,
|
|
CSR_PMPADDR12,
|
|
CSR_PMPADDR13,
|
|
CSR_PMPADDR14,
|
|
CSR_PMPADDR15,
|
|
CSR_MCYCLE,
|
|
CSR_MINSTRET,
|
|
CSR_MHPMCOUNTER3,
|
|
CSR_MHPMCOUNTER4,
|
|
CSR_MHPMCOUNTER5,
|
|
CSR_MHPMCOUNTER6,
|
|
CSR_MHPMCOUNTER7,
|
|
CSR_MHPMCOUNTER8,
|
|
CSR_MHPMCOUNTER9,
|
|
CSR_MHPMCOUNTER10,
|
|
CSR_MHPMCOUNTER11,
|
|
CSR_MHPMCOUNTER12,
|
|
CSR_MHPMCOUNTER13,
|
|
CSR_MHPMCOUNTER14,
|
|
CSR_MHPMCOUNTER15,
|
|
CSR_MHPMCOUNTER16,
|
|
CSR_MHPMCOUNTER17,
|
|
CSR_MHPMCOUNTER18,
|
|
CSR_MHPMCOUNTER19,
|
|
CSR_MHPMCOUNTER20,
|
|
CSR_MHPMCOUNTER21,
|
|
CSR_MHPMCOUNTER22,
|
|
CSR_MHPMCOUNTER23,
|
|
CSR_MHPMCOUNTER24,
|
|
CSR_MHPMCOUNTER25,
|
|
CSR_MHPMCOUNTER26,
|
|
CSR_MHPMCOUNTER27,
|
|
CSR_MHPMCOUNTER28,
|
|
CSR_MHPMCOUNTER29,
|
|
CSR_MHPMCOUNTER30,
|
|
CSR_MHPMCOUNTER31,
|
|
CSR_MCYCLEH,
|
|
CSR_MINSTRETH,
|
|
CSR_MHPMCOUNTER3H,
|
|
CSR_MHPMCOUNTER4H,
|
|
CSR_MHPMCOUNTER5H,
|
|
CSR_MHPMCOUNTER6H,
|
|
CSR_MHPMCOUNTER7H,
|
|
CSR_MHPMCOUNTER8H,
|
|
CSR_MHPMCOUNTER9H,
|
|
CSR_MHPMCOUNTER10H,
|
|
CSR_MHPMCOUNTER11H,
|
|
CSR_MHPMCOUNTER12H,
|
|
CSR_MHPMCOUNTER13H,
|
|
CSR_MHPMCOUNTER14H,
|
|
CSR_MHPMCOUNTER15H,
|
|
CSR_MHPMCOUNTER16H,
|
|
CSR_MHPMCOUNTER17H,
|
|
CSR_MHPMCOUNTER18H,
|
|
CSR_MHPMCOUNTER19H,
|
|
CSR_MHPMCOUNTER20H,
|
|
CSR_MHPMCOUNTER21H,
|
|
CSR_MHPMCOUNTER22H,
|
|
CSR_MHPMCOUNTER23H,
|
|
CSR_MHPMCOUNTER24H,
|
|
CSR_MHPMCOUNTER25H,
|
|
CSR_MHPMCOUNTER26H,
|
|
CSR_MHPMCOUNTER27H,
|
|
CSR_MHPMCOUNTER28H,
|
|
CSR_MHPMCOUNTER29H,
|
|
CSR_MHPMCOUNTER30H,
|
|
CSR_MHPMCOUNTER31H,
|
|
CSR_MHPMEVENT3,
|
|
CSR_MHPMEVENT4,
|
|
CSR_MHPMEVENT5,
|
|
CSR_MHPMEVENT6,
|
|
CSR_MHPMEVENT7,
|
|
CSR_MHPMEVENT8,
|
|
CSR_MHPMEVENT9,
|
|
CSR_MHPMEVENT10,
|
|
CSR_MHPMEVENT11,
|
|
CSR_MHPMEVENT12,
|
|
CSR_MHPMEVENT13,
|
|
CSR_MHPMEVENT14,
|
|
CSR_MHPMEVENT15,
|
|
CSR_MHPMEVENT16,
|
|
CSR_MHPMEVENT17,
|
|
CSR_MHPMEVENT18,
|
|
CSR_MHPMEVENT19,
|
|
CSR_MHPMEVENT20,
|
|
CSR_MHPMEVENT21,
|
|
CSR_MHPMEVENT22,
|
|
CSR_MHPMEVENT23,
|
|
CSR_MHPMEVENT24,
|
|
CSR_MHPMEVENT25,
|
|
CSR_MHPMEVENT26,
|
|
CSR_MHPMEVENT27,
|
|
CSR_MHPMEVENT28,
|
|
CSR_MHPMEVENT29,
|
|
CSR_MHPMEVENT30,
|
|
CSR_MHPMEVENT31,
|
|
CSR_TSELECT,
|
|
CSR_TDATA1,
|
|
CSR_TDATA2,
|
|
CSR_TDATA3,
|
|
CSR_DCSR,
|
|
CSR_DPC,
|
|
CSR_DSCRATCH,
|
|
CSR_HSTATUS,
|
|
CSR_HEDELEG,
|
|
CSR_HIDELEG,
|
|
CSR_HIE,
|
|
CSR_HCOUNTEREN,
|
|
CSR_HTVAL,
|
|
CSR_HIP,
|
|
CSR_HTINST,
|
|
CSR_HGATP,
|
|
CSR_MBASE,
|
|
CSR_MBOUND,
|
|
CSR_MIBASE,
|
|
CSR_MIBOUND,
|
|
CSR_MDBASE,
|
|
CSR_MDBOUND,
|
|
CSR_MUCOUNTEREN,
|
|
CSR_MSCOUNTEREN,
|
|
CSR_MHCOUNTEREN,
|
|
};
|
|
|
|
int riscv_cpu_gdb_read_register(CPUState *cs, GByteArray *mem_buf, int n)
|
|
{
|
|
RISCVCPU *cpu = RISCV_CPU(cs);
|
|
CPURISCVState *env = &cpu->env;
|
|
|
|
if (n < 32) {
|
|
return gdb_get_regl(mem_buf, env->gpr[n]);
|
|
} else if (n == 32) {
|
|
return gdb_get_regl(mem_buf, env->pc);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int riscv_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n)
|
|
{
|
|
RISCVCPU *cpu = RISCV_CPU(cs);
|
|
CPURISCVState *env = &cpu->env;
|
|
|
|
if (n == 0) {
|
|
/* discard writes to x0 */
|
|
return sizeof(target_ulong);
|
|
} else if (n < 32) {
|
|
env->gpr[n] = ldtul_p(mem_buf);
|
|
return sizeof(target_ulong);
|
|
} else if (n == 32) {
|
|
env->pc = ldtul_p(mem_buf);
|
|
return sizeof(target_ulong);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int riscv_gdb_get_fpu(CPURISCVState *env, GByteArray *buf, int n)
|
|
{
|
|
if (n < 32) {
|
|
if (env->misa & RVD) {
|
|
return gdb_get_reg64(buf, env->fpr[n]);
|
|
}
|
|
if (env->misa & RVF) {
|
|
return gdb_get_reg32(buf, env->fpr[n]);
|
|
}
|
|
/* there is hole between ft11 and fflags in fpu.xml */
|
|
} else if (n < 36 && n > 32) {
|
|
target_ulong val = 0;
|
|
int result;
|
|
/*
|
|
* CSR_FFLAGS is at index 8 in csr_register, and gdb says it is FP
|
|
* register 33, so we recalculate the map index.
|
|
* This also works for CSR_FRM and CSR_FCSR.
|
|
*/
|
|
result = riscv_csrrw_debug(env, n - 33 + csr_register_map[8], &val,
|
|
0, 0);
|
|
if (result == 0) {
|
|
return gdb_get_regl(buf, val);
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int riscv_gdb_set_fpu(CPURISCVState *env, uint8_t *mem_buf, int n)
|
|
{
|
|
if (n < 32) {
|
|
env->fpr[n] = ldq_p(mem_buf); /* always 64-bit */
|
|
return sizeof(uint64_t);
|
|
/* there is hole between ft11 and fflags in fpu.xml */
|
|
} else if (n < 36 && n > 32) {
|
|
target_ulong val = ldtul_p(mem_buf);
|
|
int result;
|
|
/*
|
|
* CSR_FFLAGS is at index 8 in csr_register, and gdb says it is FP
|
|
* register 33, so we recalculate the map index.
|
|
* This also works for CSR_FRM and CSR_FCSR.
|
|
*/
|
|
result = riscv_csrrw_debug(env, n - 33 + csr_register_map[8], NULL,
|
|
val, -1);
|
|
if (result == 0) {
|
|
return sizeof(target_ulong);
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int riscv_gdb_get_csr(CPURISCVState *env, GByteArray *buf, int n)
|
|
{
|
|
if (n < ARRAY_SIZE(csr_register_map)) {
|
|
target_ulong val = 0;
|
|
int result;
|
|
|
|
result = riscv_csrrw_debug(env, csr_register_map[n], &val, 0, 0);
|
|
if (result == 0) {
|
|
return gdb_get_regl(buf, val);
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int riscv_gdb_set_csr(CPURISCVState *env, uint8_t *mem_buf, int n)
|
|
{
|
|
if (n < ARRAY_SIZE(csr_register_map)) {
|
|
target_ulong val = ldtul_p(mem_buf);
|
|
int result;
|
|
|
|
result = riscv_csrrw_debug(env, csr_register_map[n], NULL, val, -1);
|
|
if (result == 0) {
|
|
return sizeof(target_ulong);
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int riscv_gdb_get_virtual(CPURISCVState *cs, GByteArray *buf, int n)
|
|
{
|
|
if (n == 0) {
|
|
#ifdef CONFIG_USER_ONLY
|
|
return gdb_get_regl(buf, 0);
|
|
#else
|
|
return gdb_get_regl(buf, cs->priv);
|
|
#endif
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int riscv_gdb_set_virtual(CPURISCVState *cs, uint8_t *mem_buf, int n)
|
|
{
|
|
if (n == 0) {
|
|
#ifndef CONFIG_USER_ONLY
|
|
cs->priv = ldtul_p(mem_buf) & 0x3;
|
|
if (cs->priv == PRV_H) {
|
|
cs->priv = PRV_S;
|
|
}
|
|
#endif
|
|
return sizeof(target_ulong);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void riscv_cpu_register_gdb_regs_for_features(CPUState *cs)
|
|
{
|
|
RISCVCPU *cpu = RISCV_CPU(cs);
|
|
CPURISCVState *env = &cpu->env;
|
|
if (env->misa & RVD) {
|
|
gdb_register_coprocessor(cs, riscv_gdb_get_fpu, riscv_gdb_set_fpu,
|
|
36, "riscv-64bit-fpu.xml", 0);
|
|
} else if (env->misa & RVF) {
|
|
gdb_register_coprocessor(cs, riscv_gdb_get_fpu, riscv_gdb_set_fpu,
|
|
36, "riscv-32bit-fpu.xml", 0);
|
|
}
|
|
#if defined(TARGET_RISCV32)
|
|
gdb_register_coprocessor(cs, riscv_gdb_get_csr, riscv_gdb_set_csr,
|
|
240, "riscv-32bit-csr.xml", 0);
|
|
|
|
gdb_register_coprocessor(cs, riscv_gdb_get_virtual, riscv_gdb_set_virtual,
|
|
1, "riscv-32bit-virtual.xml", 0);
|
|
#elif defined(TARGET_RISCV64)
|
|
gdb_register_coprocessor(cs, riscv_gdb_get_csr, riscv_gdb_set_csr,
|
|
240, "riscv-64bit-csr.xml", 0);
|
|
|
|
gdb_register_coprocessor(cs, riscv_gdb_get_virtual, riscv_gdb_set_virtual,
|
|
1, "riscv-64bit-virtual.xml", 0);
|
|
#endif
|
|
}
|