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 #include "gdbstub/helpers.h" 14 #include "vec.h" 15 16 uint64_t read_fcc(CPULoongArchState *env) 17 { 18 uint64_t ret = 0; 19 20 for (int i = 0; i < 8; ++i) { 21 ret |= (uint64_t)env->cf[i] << (i * 8); 22 } 23 24 return ret; 25 } 26 27 void write_fcc(CPULoongArchState *env, uint64_t val) 28 { 29 for (int i = 0; i < 8; ++i) { 30 env->cf[i] = (val >> (i * 8)) & 1; 31 } 32 } 33 34 int loongarch_cpu_gdb_read_register(CPUState *cs, GByteArray *mem_buf, int n) 35 { 36 LoongArchCPU *cpu = LOONGARCH_CPU(cs); 37 CPULoongArchState *env = &cpu->env; 38 uint64_t val; 39 40 if (0 <= n && n < 32) { 41 val = env->gpr[n]; 42 } else if (n == 32) { 43 /* orig_a0 */ 44 val = 0; 45 } else if (n == 33) { 46 val = env->pc; 47 } else if (n == 34) { 48 val = env->CSR_BADV; 49 } 50 51 if (0 <= n && n <= 34) { 52 if (is_la64(env)) { 53 return gdb_get_reg64(mem_buf, val); 54 } else { 55 return gdb_get_reg32(mem_buf, val); 56 } 57 } 58 return 0; 59 } 60 61 int loongarch_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n) 62 { 63 LoongArchCPU *cpu = LOONGARCH_CPU(cs); 64 CPULoongArchState *env = &cpu->env; 65 target_ulong tmp; 66 int read_length; 67 int length = 0; 68 69 if (is_la64(env)) { 70 tmp = ldq_p(mem_buf); 71 read_length = 8; 72 } else { 73 tmp = ldl_p(mem_buf); 74 read_length = 4; 75 } 76 77 if (0 <= n && n < 32) { 78 env->gpr[n] = tmp; 79 length = read_length; 80 } else if (n == 33) { 81 set_pc(env, tmp); 82 length = read_length; 83 } 84 return length; 85 } 86 87 static int loongarch_gdb_get_fpu(CPUState *cs, GByteArray *mem_buf, int n) 88 { 89 LoongArchCPU *cpu = LOONGARCH_CPU(cs); 90 CPULoongArchState *env = &cpu->env; 91 92 if (0 <= n && n < 32) { 93 return gdb_get_reg64(mem_buf, env->fpr[n].vreg.D(0)); 94 } else if (32 <= n && n < 40) { 95 return gdb_get_reg8(mem_buf, env->cf[n - 32]); 96 } else if (n == 40) { 97 return gdb_get_reg32(mem_buf, env->fcsr0); 98 } 99 return 0; 100 } 101 102 static int loongarch_gdb_set_fpu(CPUState *cs, uint8_t *mem_buf, int n) 103 { 104 LoongArchCPU *cpu = LOONGARCH_CPU(cs); 105 CPULoongArchState *env = &cpu->env; 106 int length = 0; 107 108 if (0 <= n && n < 32) { 109 env->fpr[n].vreg.D(0) = ldq_p(mem_buf); 110 length = 8; 111 } else if (32 <= n && n < 40) { 112 env->cf[n - 32] = ldub_p(mem_buf); 113 length = 1; 114 } else if (n == 40) { 115 env->fcsr0 = ldl_p(mem_buf); 116 length = 4; 117 } 118 return length; 119 } 120 121 void loongarch_cpu_register_gdb_regs_for_features(CPUState *cs) 122 { 123 gdb_register_coprocessor(cs, loongarch_gdb_get_fpu, loongarch_gdb_set_fpu, 124 gdb_find_static_feature("loongarch-fpu.xml"), 0); 125 } 126