1 /* 2 * LOONGARCH gdb server stub 3 * 4 * Copyright (c) 2021 Loongson Technology Corporation Limited 5 * 6 * SPDX-License-Identifier: LGPL-2.1+ 7 */ 8 9 #include "qemu/osdep.h" 10 #include "cpu.h" 11 #include "internals.h" 12 #include "exec/gdbstub.h" 13 14 int loongarch_cpu_gdb_read_register(CPUState *cs, GByteArray *mem_buf, int n) 15 { 16 LoongArchCPU *cpu = LOONGARCH_CPU(cs); 17 CPULoongArchState *env = &cpu->env; 18 19 if (0 <= n && n < 32) { 20 return gdb_get_regl(mem_buf, env->gpr[n]); 21 } else if (n == 32) { 22 /* orig_a0 */ 23 return gdb_get_regl(mem_buf, 0); 24 } else if (n == 33) { 25 return gdb_get_regl(mem_buf, env->pc); 26 } else if (n == 34) { 27 return gdb_get_regl(mem_buf, env->CSR_BADV); 28 } 29 return 0; 30 } 31 32 int loongarch_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n) 33 { 34 LoongArchCPU *cpu = LOONGARCH_CPU(cs); 35 CPULoongArchState *env = &cpu->env; 36 target_ulong tmp = ldtul_p(mem_buf); 37 int length = 0; 38 39 if (0 <= n && n < 32) { 40 env->gpr[n] = tmp; 41 length = sizeof(target_ulong); 42 } else if (n == 33) { 43 env->pc = tmp; 44 length = sizeof(target_ulong); 45 } 46 return length; 47 } 48 49 static int loongarch_gdb_get_fpu(CPULoongArchState *env, 50 GByteArray *mem_buf, int n) 51 { 52 if (0 <= n && n < 32) { 53 return gdb_get_reg64(mem_buf, env->fpr[n]); 54 } else if (32 <= n && n < 40) { 55 return gdb_get_reg8(mem_buf, env->cf[n - 32]); 56 } else if (n == 40) { 57 return gdb_get_reg32(mem_buf, env->fcsr0); 58 } 59 return 0; 60 } 61 62 static int loongarch_gdb_set_fpu(CPULoongArchState *env, 63 uint8_t *mem_buf, int n) 64 { 65 int length = 0; 66 67 if (0 <= n && n < 32) { 68 env->fpr[n] = ldq_p(mem_buf); 69 length = 8; 70 } else if (32 <= n && n < 40) { 71 env->cf[n - 32] = ldub_p(mem_buf); 72 length = 1; 73 } else if (n == 40) { 74 env->fcsr0 = ldl_p(mem_buf); 75 length = 4; 76 } 77 return length; 78 } 79 80 void loongarch_cpu_register_gdb_regs_for_features(CPUState *cs) 81 { 82 gdb_register_coprocessor(cs, loongarch_gdb_get_fpu, loongarch_gdb_set_fpu, 83 41, "loongarch-fpu64.xml", 0); 84 } 85