1ca61e750SXiaojuan Yang /*
2ca61e750SXiaojuan Yang * LOONGARCH gdb server stub
3ca61e750SXiaojuan Yang *
4ca61e750SXiaojuan Yang * Copyright (c) 2021 Loongson Technology Corporation Limited
5ca61e750SXiaojuan Yang *
6ca61e750SXiaojuan Yang * SPDX-License-Identifier: LGPL-2.1+
7ca61e750SXiaojuan Yang */
8ca61e750SXiaojuan Yang
9ca61e750SXiaojuan Yang #include "qemu/osdep.h"
10ca61e750SXiaojuan Yang #include "cpu.h"
11ca61e750SXiaojuan Yang #include "internals.h"
12ca61e750SXiaojuan Yang #include "exec/gdbstub.h"
134ea5fe99SAlex Bennée #include "gdbstub/helpers.h"
14*008a3b16SSong Gao #include "vec.h"
15ca61e750SXiaojuan Yang
read_fcc(CPULoongArchState * env)162f149c75SSong Gao uint64_t read_fcc(CPULoongArchState *env)
172f149c75SSong Gao {
182f149c75SSong Gao uint64_t ret = 0;
192f149c75SSong Gao
202f149c75SSong Gao for (int i = 0; i < 8; ++i) {
212f149c75SSong Gao ret |= (uint64_t)env->cf[i] << (i * 8);
222f149c75SSong Gao }
232f149c75SSong Gao
242f149c75SSong Gao return ret;
252f149c75SSong Gao }
262f149c75SSong Gao
write_fcc(CPULoongArchState * env,uint64_t val)272f149c75SSong Gao void write_fcc(CPULoongArchState *env, uint64_t val)
282f149c75SSong Gao {
292f149c75SSong Gao for (int i = 0; i < 8; ++i) {
302f149c75SSong Gao env->cf[i] = (val >> (i * 8)) & 1;
312f149c75SSong Gao }
322f149c75SSong Gao }
332f149c75SSong Gao
loongarch_cpu_gdb_read_register(CPUState * cs,GByteArray * mem_buf,int n)34ca61e750SXiaojuan Yang int loongarch_cpu_gdb_read_register(CPUState *cs, GByteArray *mem_buf, int n)
35ca61e750SXiaojuan Yang {
36ca61e750SXiaojuan Yang LoongArchCPU *cpu = LOONGARCH_CPU(cs);
37ca61e750SXiaojuan Yang CPULoongArchState *env = &cpu->env;
38ebda3036SJiajie Chen uint64_t val;
39ca61e750SXiaojuan Yang
40ca61e750SXiaojuan Yang if (0 <= n && n < 32) {
41ebda3036SJiajie Chen val = env->gpr[n];
42ca61e750SXiaojuan Yang } else if (n == 32) {
431fe8ac35SSong Gao /* orig_a0 */
44ebda3036SJiajie Chen val = 0;
45ca61e750SXiaojuan Yang } else if (n == 33) {
46ebda3036SJiajie Chen val = env->pc;
471fe8ac35SSong Gao } else if (n == 34) {
48ebda3036SJiajie Chen val = env->CSR_BADV;
49ebda3036SJiajie Chen }
50ebda3036SJiajie Chen
51ebda3036SJiajie Chen if (0 <= n && n <= 34) {
52ebda3036SJiajie Chen if (is_la64(env)) {
53ebda3036SJiajie Chen return gdb_get_reg64(mem_buf, val);
54ebda3036SJiajie Chen } else {
55ebda3036SJiajie Chen return gdb_get_reg32(mem_buf, val);
56ebda3036SJiajie Chen }
57ca61e750SXiaojuan Yang }
58ca61e750SXiaojuan Yang return 0;
59ca61e750SXiaojuan Yang }
60ca61e750SXiaojuan Yang
loongarch_cpu_gdb_write_register(CPUState * cs,uint8_t * mem_buf,int n)61ca61e750SXiaojuan Yang int loongarch_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n)
62ca61e750SXiaojuan Yang {
63ca61e750SXiaojuan Yang LoongArchCPU *cpu = LOONGARCH_CPU(cs);
64ca61e750SXiaojuan Yang CPULoongArchState *env = &cpu->env;
65ebda3036SJiajie Chen target_ulong tmp;
66ebda3036SJiajie Chen int read_length;
67ca61e750SXiaojuan Yang int length = 0;
68ca61e750SXiaojuan Yang
69ebda3036SJiajie Chen if (is_la64(env)) {
70ebda3036SJiajie Chen tmp = ldq_p(mem_buf);
71ebda3036SJiajie Chen read_length = 8;
72ebda3036SJiajie Chen } else {
73ebda3036SJiajie Chen tmp = ldl_p(mem_buf);
74ebda3036SJiajie Chen read_length = 4;
75ebda3036SJiajie Chen }
76ebda3036SJiajie Chen
77ca61e750SXiaojuan Yang if (0 <= n && n < 32) {
78ca61e750SXiaojuan Yang env->gpr[n] = tmp;
79ebda3036SJiajie Chen length = read_length;
801fe8ac35SSong Gao } else if (n == 33) {
812f6478ffSJiajie Chen set_pc(env, tmp);
82ebda3036SJiajie Chen length = read_length;
83ca61e750SXiaojuan Yang }
84ca61e750SXiaojuan Yang return length;
85ca61e750SXiaojuan Yang }
86ca61e750SXiaojuan Yang
loongarch_gdb_get_fpu(CPULoongArchState * env,GByteArray * mem_buf,int n)87ca61e750SXiaojuan Yang static int loongarch_gdb_get_fpu(CPULoongArchState *env,
88ca61e750SXiaojuan Yang GByteArray *mem_buf, int n)
89ca61e750SXiaojuan Yang {
90ca61e750SXiaojuan Yang if (0 <= n && n < 32) {
9116f5396cSSong Gao return gdb_get_reg64(mem_buf, env->fpr[n].vreg.D(0));
9217ffe331SJiajie Chen } else if (32 <= n && n < 40) {
9317ffe331SJiajie Chen return gdb_get_reg8(mem_buf, env->cf[n - 32]);
9417ffe331SJiajie Chen } else if (n == 40) {
95ca61e750SXiaojuan Yang return gdb_get_reg32(mem_buf, env->fcsr0);
96ca61e750SXiaojuan Yang }
97ca61e750SXiaojuan Yang return 0;
98ca61e750SXiaojuan Yang }
99ca61e750SXiaojuan Yang
loongarch_gdb_set_fpu(CPULoongArchState * env,uint8_t * mem_buf,int n)100ca61e750SXiaojuan Yang static int loongarch_gdb_set_fpu(CPULoongArchState *env,
101ca61e750SXiaojuan Yang uint8_t *mem_buf, int n)
102ca61e750SXiaojuan Yang {
103ca61e750SXiaojuan Yang int length = 0;
104ca61e750SXiaojuan Yang
105ca61e750SXiaojuan Yang if (0 <= n && n < 32) {
10616f5396cSSong Gao env->fpr[n].vreg.D(0) = ldq_p(mem_buf);
107ca61e750SXiaojuan Yang length = 8;
10817ffe331SJiajie Chen } else if (32 <= n && n < 40) {
10917ffe331SJiajie Chen env->cf[n - 32] = ldub_p(mem_buf);
11017ffe331SJiajie Chen length = 1;
11117ffe331SJiajie Chen } else if (n == 40) {
112ca61e750SXiaojuan Yang env->fcsr0 = ldl_p(mem_buf);
113ca61e750SXiaojuan Yang length = 4;
114ca61e750SXiaojuan Yang }
115ca61e750SXiaojuan Yang return length;
116ca61e750SXiaojuan Yang }
117ca61e750SXiaojuan Yang
loongarch_cpu_register_gdb_regs_for_features(CPUState * cs)118ca61e750SXiaojuan Yang void loongarch_cpu_register_gdb_regs_for_features(CPUState *cs)
119ca61e750SXiaojuan Yang {
120ca61e750SXiaojuan Yang gdb_register_coprocessor(cs, loongarch_gdb_get_fpu, loongarch_gdb_set_fpu,
121d182c390SSong Gao 41, "loongarch-fpu.xml", 0);
122ca61e750SXiaojuan Yang }
123