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" 14ca61e750SXiaojuan Yang 152f149c75SSong Gao uint64_t read_fcc(CPULoongArchState *env) 162f149c75SSong Gao { 172f149c75SSong Gao uint64_t ret = 0; 182f149c75SSong Gao 192f149c75SSong Gao for (int i = 0; i < 8; ++i) { 202f149c75SSong Gao ret |= (uint64_t)env->cf[i] << (i * 8); 212f149c75SSong Gao } 222f149c75SSong Gao 232f149c75SSong Gao return ret; 242f149c75SSong Gao } 252f149c75SSong Gao 262f149c75SSong Gao void write_fcc(CPULoongArchState *env, uint64_t val) 272f149c75SSong Gao { 282f149c75SSong Gao for (int i = 0; i < 8; ++i) { 292f149c75SSong Gao env->cf[i] = (val >> (i * 8)) & 1; 302f149c75SSong Gao } 312f149c75SSong Gao } 322f149c75SSong Gao 33ca61e750SXiaojuan Yang int loongarch_cpu_gdb_read_register(CPUState *cs, GByteArray *mem_buf, int n) 34ca61e750SXiaojuan Yang { 35ca61e750SXiaojuan Yang LoongArchCPU *cpu = LOONGARCH_CPU(cs); 36ca61e750SXiaojuan Yang CPULoongArchState *env = &cpu->env; 37*ebda3036SJiajie Chen uint64_t val; 38ca61e750SXiaojuan Yang 39ca61e750SXiaojuan Yang if (0 <= n && n < 32) { 40*ebda3036SJiajie Chen val = env->gpr[n]; 41ca61e750SXiaojuan Yang } else if (n == 32) { 421fe8ac35SSong Gao /* orig_a0 */ 43*ebda3036SJiajie Chen val = 0; 44ca61e750SXiaojuan Yang } else if (n == 33) { 45*ebda3036SJiajie Chen val = env->pc; 461fe8ac35SSong Gao } else if (n == 34) { 47*ebda3036SJiajie Chen val = env->CSR_BADV; 48*ebda3036SJiajie Chen } 49*ebda3036SJiajie Chen 50*ebda3036SJiajie Chen if (0 <= n && n <= 34) { 51*ebda3036SJiajie Chen if (is_la64(env)) { 52*ebda3036SJiajie Chen return gdb_get_reg64(mem_buf, val); 53*ebda3036SJiajie Chen } else { 54*ebda3036SJiajie Chen return gdb_get_reg32(mem_buf, val); 55*ebda3036SJiajie Chen } 56ca61e750SXiaojuan Yang } 57ca61e750SXiaojuan Yang return 0; 58ca61e750SXiaojuan Yang } 59ca61e750SXiaojuan Yang 60ca61e750SXiaojuan Yang int loongarch_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n) 61ca61e750SXiaojuan Yang { 62ca61e750SXiaojuan Yang LoongArchCPU *cpu = LOONGARCH_CPU(cs); 63ca61e750SXiaojuan Yang CPULoongArchState *env = &cpu->env; 64*ebda3036SJiajie Chen target_ulong tmp; 65*ebda3036SJiajie Chen int read_length; 66ca61e750SXiaojuan Yang int length = 0; 67ca61e750SXiaojuan Yang 68*ebda3036SJiajie Chen if (is_la64(env)) { 69*ebda3036SJiajie Chen tmp = ldq_p(mem_buf); 70*ebda3036SJiajie Chen read_length = 8; 71*ebda3036SJiajie Chen } else { 72*ebda3036SJiajie Chen tmp = ldl_p(mem_buf); 73*ebda3036SJiajie Chen read_length = 4; 74*ebda3036SJiajie Chen } 75*ebda3036SJiajie Chen 76ca61e750SXiaojuan Yang if (0 <= n && n < 32) { 77ca61e750SXiaojuan Yang env->gpr[n] = tmp; 78*ebda3036SJiajie Chen length = read_length; 791fe8ac35SSong Gao } else if (n == 33) { 80ca61e750SXiaojuan Yang env->pc = tmp; 81*ebda3036SJiajie Chen length = read_length; 82ca61e750SXiaojuan Yang } 83ca61e750SXiaojuan Yang return length; 84ca61e750SXiaojuan Yang } 85ca61e750SXiaojuan Yang 86ca61e750SXiaojuan Yang static int loongarch_gdb_get_fpu(CPULoongArchState *env, 87ca61e750SXiaojuan Yang GByteArray *mem_buf, int n) 88ca61e750SXiaojuan Yang { 89ca61e750SXiaojuan Yang if (0 <= n && n < 32) { 9016f5396cSSong Gao return gdb_get_reg64(mem_buf, env->fpr[n].vreg.D(0)); 912f149c75SSong Gao } else if (n == 32) { 922f149c75SSong Gao uint64_t val = read_fcc(env); 932f149c75SSong Gao return gdb_get_reg64(mem_buf, val); 942f149c75SSong Gao } else if (n == 33) { 95ca61e750SXiaojuan Yang return gdb_get_reg32(mem_buf, env->fcsr0); 96ca61e750SXiaojuan Yang } 97ca61e750SXiaojuan Yang return 0; 98ca61e750SXiaojuan Yang } 99ca61e750SXiaojuan Yang 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; 1082f149c75SSong Gao } else if (n == 32) { 1092f149c75SSong Gao uint64_t val = ldq_p(mem_buf); 1102f149c75SSong Gao write_fcc(env, val); 1112f149c75SSong Gao length = 8; 1122f149c75SSong Gao } else if (n == 33) { 113ca61e750SXiaojuan Yang env->fcsr0 = ldl_p(mem_buf); 114ca61e750SXiaojuan Yang length = 4; 115ca61e750SXiaojuan Yang } 116ca61e750SXiaojuan Yang return length; 117ca61e750SXiaojuan Yang } 118ca61e750SXiaojuan Yang 119ca61e750SXiaojuan Yang void loongarch_cpu_register_gdb_regs_for_features(CPUState *cs) 120ca61e750SXiaojuan Yang { 121ca61e750SXiaojuan Yang gdb_register_coprocessor(cs, loongarch_gdb_get_fpu, loongarch_gdb_set_fpu, 122d182c390SSong Gao 41, "loongarch-fpu.xml", 0); 123ca61e750SXiaojuan Yang } 124