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
read_fcc(CPULoongArchState * env)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
write_fcc(CPULoongArchState * env,uint64_t val)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
loongarch_cpu_gdb_read_register(CPUState * cs,GByteArray * mem_buf,int n)34 int loongarch_cpu_gdb_read_register(CPUState *cs, GByteArray *mem_buf, int n)
35 {
36 CPULoongArchState *env = cpu_env(cs);
37
38 if (0 <= n && n <= 34) {
39 uint64_t val;
40
41 if (n < 32) {
42 val = env->gpr[n];
43 } else if (n == 32) {
44 /* orig_a0 */
45 val = 0;
46 } else if (n == 33) {
47 val = env->pc;
48 } else /* if (n == 34) */ {
49 val = env->CSR_BADV;
50 }
51
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
59 return 0;
60 }
61
loongarch_cpu_gdb_write_register(CPUState * cs,uint8_t * mem_buf,int n)62 int loongarch_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n)
63 {
64 CPULoongArchState *env = cpu_env(cs);
65 target_ulong tmp;
66 int read_length;
67 int length = 0;
68
69 if (is_la64(env)) {
70 tmp = ldq_le_p(mem_buf);
71 read_length = 8;
72 } else {
73 tmp = ldl_le_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
loongarch_gdb_get_fpu(CPUState * cs,GByteArray * mem_buf,int n)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
loongarch_gdb_set_fpu(CPUState * cs,uint8_t * mem_buf,int n)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_le_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_le_p(mem_buf);
116 length = 4;
117 }
118 return length;
119 }
120
121 #define VREG_NUM 32
122 #define REG64_LEN 64
123
loongarch_gdb_get_vec(CPUState * cs,GByteArray * mem_buf,int n,int vl)124 static int loongarch_gdb_get_vec(CPUState *cs, GByteArray *mem_buf, int n, int vl)
125 {
126 LoongArchCPU *cpu = LOONGARCH_CPU(cs);
127 CPULoongArchState *env = &cpu->env;
128 int i, length = 0;
129
130 if (0 <= n && n < VREG_NUM) {
131 for (i = 0; i < vl / REG64_LEN; i++) {
132 length += gdb_get_reg64(mem_buf, env->fpr[n].vreg.D(i));
133 }
134 }
135
136 return length;
137 }
138
loongarch_gdb_set_vec(CPUState * cs,uint8_t * mem_buf,int n,int vl)139 static int loongarch_gdb_set_vec(CPUState *cs, uint8_t *mem_buf, int n, int vl)
140 {
141 LoongArchCPU *cpu = LOONGARCH_CPU(cs);
142 CPULoongArchState *env = &cpu->env;
143 int i, length = 0;
144
145 if (0 <= n && n < VREG_NUM) {
146 for (i = 0; i < vl / REG64_LEN; i++) {
147 env->fpr[n].vreg.D(i) = ldq_le_p(mem_buf + 8 * i);
148 length += 8;
149 }
150 }
151
152 return length;
153 }
154
loongarch_gdb_get_lsx(CPUState * cs,GByteArray * mem_buf,int n)155 static int loongarch_gdb_get_lsx(CPUState *cs, GByteArray *mem_buf, int n)
156 {
157 return loongarch_gdb_get_vec(cs, mem_buf, n, LSX_LEN);
158 }
159
loongarch_gdb_set_lsx(CPUState * cs,uint8_t * mem_buf,int n)160 static int loongarch_gdb_set_lsx(CPUState *cs, uint8_t *mem_buf, int n)
161 {
162 return loongarch_gdb_set_vec(cs, mem_buf, n, LSX_LEN);
163 }
164
loongarch_gdb_get_lasx(CPUState * cs,GByteArray * mem_buf,int n)165 static int loongarch_gdb_get_lasx(CPUState *cs, GByteArray *mem_buf, int n)
166 {
167 return loongarch_gdb_get_vec(cs, mem_buf, n, LASX_LEN);
168 }
169
loongarch_gdb_set_lasx(CPUState * cs,uint8_t * mem_buf,int n)170 static int loongarch_gdb_set_lasx(CPUState *cs, uint8_t *mem_buf, int n)
171 {
172 return loongarch_gdb_set_vec(cs, mem_buf, n, LASX_LEN);
173 }
174
loongarch_cpu_register_gdb_regs_for_features(CPUState * cs)175 void loongarch_cpu_register_gdb_regs_for_features(CPUState *cs)
176 {
177 LoongArchCPU *cpu = LOONGARCH_CPU(cs);
178 CPULoongArchState *env = &cpu->env;
179
180 if (FIELD_EX32(env->cpucfg[2], CPUCFG2, FP)) {
181 gdb_register_coprocessor(cs, loongarch_gdb_get_fpu, loongarch_gdb_set_fpu,
182 gdb_find_static_feature("loongarch-fpu.xml"), 0);
183 }
184
185 if (FIELD_EX32(env->cpucfg[2], CPUCFG2, LSX)) {
186 gdb_register_coprocessor(cs, loongarch_gdb_get_lsx, loongarch_gdb_set_lsx,
187 gdb_find_static_feature("loongarch-lsx.xml"), 0);
188 }
189
190 if (FIELD_EX32(env->cpucfg[2], CPUCFG2, LASX)) {
191 gdb_register_coprocessor(cs, loongarch_gdb_get_lasx, loongarch_gdb_set_lasx,
192 gdb_find_static_feature("loongarch-lasx.xml"), 0);
193 }
194 }
195