xref: /qemu/target/loongarch/kvm/kvm.c (revision c23a53d89429d9181bc0423e2708851b02b9ff4a)
1537ba9daSTianrui Zhao /* SPDX-License-Identifier: GPL-2.0-or-later */
2537ba9daSTianrui Zhao /*
3537ba9daSTianrui Zhao  * QEMU LoongArch KVM
4537ba9daSTianrui Zhao  *
5537ba9daSTianrui Zhao  * Copyright (c) 2023 Loongson Technology Corporation Limited
6537ba9daSTianrui Zhao  */
7537ba9daSTianrui Zhao 
8537ba9daSTianrui Zhao #include "qemu/osdep.h"
9537ba9daSTianrui Zhao #include <sys/ioctl.h>
10537ba9daSTianrui Zhao #include <linux/kvm.h>
11537ba9daSTianrui Zhao 
12*c23a53d8SBibo Mao #include "qapi/error.h"
13537ba9daSTianrui Zhao #include "qemu/timer.h"
14537ba9daSTianrui Zhao #include "qemu/error-report.h"
15537ba9daSTianrui Zhao #include "qemu/main-loop.h"
16537ba9daSTianrui Zhao #include "sysemu/sysemu.h"
17537ba9daSTianrui Zhao #include "sysemu/kvm.h"
18537ba9daSTianrui Zhao #include "sysemu/kvm_int.h"
19537ba9daSTianrui Zhao #include "hw/pci/pci.h"
20537ba9daSTianrui Zhao #include "exec/memattrs.h"
21537ba9daSTianrui Zhao #include "exec/address-spaces.h"
22537ba9daSTianrui Zhao #include "hw/boards.h"
23537ba9daSTianrui Zhao #include "hw/irq.h"
24537ba9daSTianrui Zhao #include "qemu/log.h"
25537ba9daSTianrui Zhao #include "hw/loader.h"
26537ba9daSTianrui Zhao #include "sysemu/runstate.h"
27537ba9daSTianrui Zhao #include "cpu-csr.h"
28537ba9daSTianrui Zhao #include "kvm_loongarch.h"
29f8447436STianrui Zhao #include "trace.h"
30537ba9daSTianrui Zhao 
31537ba9daSTianrui Zhao static bool cap_has_mp_state;
32d38e31efSBibo Mao static unsigned int brk_insn;
33537ba9daSTianrui Zhao const KVMCapabilityInfo kvm_arch_required_capabilities[] = {
34537ba9daSTianrui Zhao     KVM_CAP_LAST_INFO
35537ba9daSTianrui Zhao };
36537ba9daSTianrui Zhao 
37f8447436STianrui Zhao static int kvm_loongarch_get_regs_core(CPUState *cs)
38f8447436STianrui Zhao {
39f8447436STianrui Zhao     int ret = 0;
40f8447436STianrui Zhao     int i;
41f8447436STianrui Zhao     struct kvm_regs regs;
42f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
43f8447436STianrui Zhao 
44f8447436STianrui Zhao     /* Get the current register set as KVM seems it */
45f8447436STianrui Zhao     ret = kvm_vcpu_ioctl(cs, KVM_GET_REGS, &regs);
46f8447436STianrui Zhao     if (ret < 0) {
47f8447436STianrui Zhao         trace_kvm_failed_get_regs_core(strerror(errno));
48f8447436STianrui Zhao         return ret;
49f8447436STianrui Zhao     }
50f8447436STianrui Zhao     /* gpr[0] value is always 0 */
51f8447436STianrui Zhao     env->gpr[0] = 0;
52f8447436STianrui Zhao     for (i = 1; i < 32; i++) {
53f8447436STianrui Zhao         env->gpr[i] = regs.gpr[i];
54f8447436STianrui Zhao     }
55f8447436STianrui Zhao 
56f8447436STianrui Zhao     env->pc = regs.pc;
57f8447436STianrui Zhao     return ret;
58f8447436STianrui Zhao }
59f8447436STianrui Zhao 
60f8447436STianrui Zhao static int kvm_loongarch_put_regs_core(CPUState *cs)
61f8447436STianrui Zhao {
62f8447436STianrui Zhao     int ret = 0;
63f8447436STianrui Zhao     int i;
64f8447436STianrui Zhao     struct kvm_regs regs;
65f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
66f8447436STianrui Zhao 
67f8447436STianrui Zhao     /* Set the registers based on QEMU's view of things */
68f8447436STianrui Zhao     for (i = 0; i < 32; i++) {
69f8447436STianrui Zhao         regs.gpr[i] = env->gpr[i];
70f8447436STianrui Zhao     }
71f8447436STianrui Zhao 
72f8447436STianrui Zhao     regs.pc = env->pc;
73f8447436STianrui Zhao     ret = kvm_vcpu_ioctl(cs, KVM_SET_REGS, &regs);
74f8447436STianrui Zhao     if (ret < 0) {
75f8447436STianrui Zhao         trace_kvm_failed_put_regs_core(strerror(errno));
76f8447436STianrui Zhao     }
77f8447436STianrui Zhao 
78f8447436STianrui Zhao     return ret;
79f8447436STianrui Zhao }
80f8447436STianrui Zhao 
81f8447436STianrui Zhao static int kvm_loongarch_get_csr(CPUState *cs)
82f8447436STianrui Zhao {
83f8447436STianrui Zhao     int ret = 0;
84f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
85f8447436STianrui Zhao 
86f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_CRMD),
87f8447436STianrui Zhao                            &env->CSR_CRMD);
88f8447436STianrui Zhao 
89f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRMD),
90f8447436STianrui Zhao                            &env->CSR_PRMD);
91f8447436STianrui Zhao 
92f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_EUEN),
93f8447436STianrui Zhao                            &env->CSR_EUEN);
94f8447436STianrui Zhao 
95f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_MISC),
96f8447436STianrui Zhao                            &env->CSR_MISC);
97f8447436STianrui Zhao 
98f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ECFG),
99f8447436STianrui Zhao                            &env->CSR_ECFG);
100f8447436STianrui Zhao 
101f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ESTAT),
102f8447436STianrui Zhao                            &env->CSR_ESTAT);
103f8447436STianrui Zhao 
104f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ERA),
105f8447436STianrui Zhao                            &env->CSR_ERA);
106f8447436STianrui Zhao 
107f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_BADV),
108f8447436STianrui Zhao                            &env->CSR_BADV);
109f8447436STianrui Zhao 
110f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_BADI),
111f8447436STianrui Zhao                            &env->CSR_BADI);
112f8447436STianrui Zhao 
113f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_EENTRY),
114f8447436STianrui Zhao                            &env->CSR_EENTRY);
115f8447436STianrui Zhao 
116f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBIDX),
117f8447436STianrui Zhao                            &env->CSR_TLBIDX);
118f8447436STianrui Zhao 
119f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBEHI),
120f8447436STianrui Zhao                            &env->CSR_TLBEHI);
121f8447436STianrui Zhao 
122f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBELO0),
123f8447436STianrui Zhao                            &env->CSR_TLBELO0);
124f8447436STianrui Zhao 
125f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBELO1),
126f8447436STianrui Zhao                            &env->CSR_TLBELO1);
127f8447436STianrui Zhao 
128f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ASID),
129f8447436STianrui Zhao                            &env->CSR_ASID);
130f8447436STianrui Zhao 
131f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PGDL),
132f8447436STianrui Zhao                            &env->CSR_PGDL);
133f8447436STianrui Zhao 
134f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PGDH),
135f8447436STianrui Zhao                            &env->CSR_PGDH);
136f8447436STianrui Zhao 
137f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PGD),
138f8447436STianrui Zhao                            &env->CSR_PGD);
139f8447436STianrui Zhao 
140f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PWCL),
141f8447436STianrui Zhao                            &env->CSR_PWCL);
142f8447436STianrui Zhao 
143f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PWCH),
144f8447436STianrui Zhao                            &env->CSR_PWCH);
145f8447436STianrui Zhao 
146f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_STLBPS),
147f8447436STianrui Zhao                            &env->CSR_STLBPS);
148f8447436STianrui Zhao 
149f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_RVACFG),
150f8447436STianrui Zhao                            &env->CSR_RVACFG);
151f8447436STianrui Zhao 
152f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_CPUID),
153f8447436STianrui Zhao                            &env->CSR_CPUID);
154f8447436STianrui Zhao 
155f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRCFG1),
156f8447436STianrui Zhao                            &env->CSR_PRCFG1);
157f8447436STianrui Zhao 
158f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRCFG2),
159f8447436STianrui Zhao                            &env->CSR_PRCFG2);
160f8447436STianrui Zhao 
161f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRCFG3),
162f8447436STianrui Zhao                            &env->CSR_PRCFG3);
163f8447436STianrui Zhao 
164f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(0)),
165f8447436STianrui Zhao                            &env->CSR_SAVE[0]);
166f8447436STianrui Zhao 
167f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(1)),
168f8447436STianrui Zhao                            &env->CSR_SAVE[1]);
169f8447436STianrui Zhao 
170f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(2)),
171f8447436STianrui Zhao                            &env->CSR_SAVE[2]);
172f8447436STianrui Zhao 
173f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(3)),
174f8447436STianrui Zhao                            &env->CSR_SAVE[3]);
175f8447436STianrui Zhao 
176f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(4)),
177f8447436STianrui Zhao                            &env->CSR_SAVE[4]);
178f8447436STianrui Zhao 
179f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(5)),
180f8447436STianrui Zhao                            &env->CSR_SAVE[5]);
181f8447436STianrui Zhao 
182f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(6)),
183f8447436STianrui Zhao                            &env->CSR_SAVE[6]);
184f8447436STianrui Zhao 
185f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(7)),
186f8447436STianrui Zhao                            &env->CSR_SAVE[7]);
187f8447436STianrui Zhao 
188f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TID),
189f8447436STianrui Zhao                            &env->CSR_TID);
190f8447436STianrui Zhao 
191f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_CNTC),
192f8447436STianrui Zhao                            &env->CSR_CNTC);
193f8447436STianrui Zhao 
194f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TICLR),
195f8447436STianrui Zhao                            &env->CSR_TICLR);
196f8447436STianrui Zhao 
197f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_LLBCTL),
198f8447436STianrui Zhao                            &env->CSR_LLBCTL);
199f8447436STianrui Zhao 
200f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_IMPCTL1),
201f8447436STianrui Zhao                            &env->CSR_IMPCTL1);
202f8447436STianrui Zhao 
203f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_IMPCTL2),
204f8447436STianrui Zhao                            &env->CSR_IMPCTL2);
205f8447436STianrui Zhao 
206f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRENTRY),
207f8447436STianrui Zhao                            &env->CSR_TLBRENTRY);
208f8447436STianrui Zhao 
209f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRBADV),
210f8447436STianrui Zhao                            &env->CSR_TLBRBADV);
211f8447436STianrui Zhao 
212f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRERA),
213f8447436STianrui Zhao                            &env->CSR_TLBRERA);
214f8447436STianrui Zhao 
215f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRSAVE),
216f8447436STianrui Zhao                            &env->CSR_TLBRSAVE);
217f8447436STianrui Zhao 
218f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRELO0),
219f8447436STianrui Zhao                            &env->CSR_TLBRELO0);
220f8447436STianrui Zhao 
221f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRELO1),
222f8447436STianrui Zhao                            &env->CSR_TLBRELO1);
223f8447436STianrui Zhao 
224f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBREHI),
225f8447436STianrui Zhao                            &env->CSR_TLBREHI);
226f8447436STianrui Zhao 
227f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRPRMD),
228f8447436STianrui Zhao                            &env->CSR_TLBRPRMD);
229f8447436STianrui Zhao 
230f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(0)),
231f8447436STianrui Zhao                            &env->CSR_DMW[0]);
232f8447436STianrui Zhao 
233f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(1)),
234f8447436STianrui Zhao                            &env->CSR_DMW[1]);
235f8447436STianrui Zhao 
236f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(2)),
237f8447436STianrui Zhao                            &env->CSR_DMW[2]);
238f8447436STianrui Zhao 
239f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(3)),
240f8447436STianrui Zhao                            &env->CSR_DMW[3]);
241f8447436STianrui Zhao 
242f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TVAL),
243f8447436STianrui Zhao                            &env->CSR_TVAL);
244f8447436STianrui Zhao 
245f8447436STianrui Zhao     ret |= kvm_get_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TCFG),
246f8447436STianrui Zhao                            &env->CSR_TCFG);
247f8447436STianrui Zhao 
248f8447436STianrui Zhao     return ret;
249f8447436STianrui Zhao }
250f8447436STianrui Zhao 
25161f6e150SBibo Mao static int kvm_loongarch_put_csr(CPUState *cs, int level)
252f8447436STianrui Zhao {
253f8447436STianrui Zhao     int ret = 0;
254f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
255f8447436STianrui Zhao 
256f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_CRMD),
257f8447436STianrui Zhao                            &env->CSR_CRMD);
258f8447436STianrui Zhao 
259f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRMD),
260f8447436STianrui Zhao                            &env->CSR_PRMD);
261f8447436STianrui Zhao 
262f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_EUEN),
263f8447436STianrui Zhao                            &env->CSR_EUEN);
264f8447436STianrui Zhao 
265f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_MISC),
266f8447436STianrui Zhao                            &env->CSR_MISC);
267f8447436STianrui Zhao 
268f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ECFG),
269f8447436STianrui Zhao                            &env->CSR_ECFG);
270f8447436STianrui Zhao 
271f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ESTAT),
272f8447436STianrui Zhao                            &env->CSR_ESTAT);
273f8447436STianrui Zhao 
274f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ERA),
275f8447436STianrui Zhao                            &env->CSR_ERA);
276f8447436STianrui Zhao 
277f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_BADV),
278f8447436STianrui Zhao                            &env->CSR_BADV);
279f8447436STianrui Zhao 
280f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_BADI),
281f8447436STianrui Zhao                            &env->CSR_BADI);
282f8447436STianrui Zhao 
283f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_EENTRY),
284f8447436STianrui Zhao                            &env->CSR_EENTRY);
285f8447436STianrui Zhao 
286f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBIDX),
287f8447436STianrui Zhao                            &env->CSR_TLBIDX);
288f8447436STianrui Zhao 
289f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBEHI),
290f8447436STianrui Zhao                            &env->CSR_TLBEHI);
291f8447436STianrui Zhao 
292f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBELO0),
293f8447436STianrui Zhao                            &env->CSR_TLBELO0);
294f8447436STianrui Zhao 
295f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBELO1),
296f8447436STianrui Zhao                            &env->CSR_TLBELO1);
297f8447436STianrui Zhao 
298f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_ASID),
299f8447436STianrui Zhao                            &env->CSR_ASID);
300f8447436STianrui Zhao 
301f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PGDL),
302f8447436STianrui Zhao                            &env->CSR_PGDL);
303f8447436STianrui Zhao 
304f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PGDH),
305f8447436STianrui Zhao                            &env->CSR_PGDH);
306f8447436STianrui Zhao 
307f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PGD),
308f8447436STianrui Zhao                            &env->CSR_PGD);
309f8447436STianrui Zhao 
310f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PWCL),
311f8447436STianrui Zhao                            &env->CSR_PWCL);
312f8447436STianrui Zhao 
313f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PWCH),
314f8447436STianrui Zhao                            &env->CSR_PWCH);
315f8447436STianrui Zhao 
316f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_STLBPS),
317f8447436STianrui Zhao                            &env->CSR_STLBPS);
318f8447436STianrui Zhao 
319f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_RVACFG),
320f8447436STianrui Zhao                            &env->CSR_RVACFG);
321f8447436STianrui Zhao 
32261f6e150SBibo Mao     /* CPUID is constant after poweron, it should be set only once */
32361f6e150SBibo Mao     if (level >= KVM_PUT_FULL_STATE) {
324f8447436STianrui Zhao         ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_CPUID),
325f8447436STianrui Zhao                            &env->CSR_CPUID);
32661f6e150SBibo Mao     }
327f8447436STianrui Zhao 
328f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRCFG1),
329f8447436STianrui Zhao                            &env->CSR_PRCFG1);
330f8447436STianrui Zhao 
331f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRCFG2),
332f8447436STianrui Zhao                            &env->CSR_PRCFG2);
333f8447436STianrui Zhao 
334f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_PRCFG3),
335f8447436STianrui Zhao                            &env->CSR_PRCFG3);
336f8447436STianrui Zhao 
337f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(0)),
338f8447436STianrui Zhao                            &env->CSR_SAVE[0]);
339f8447436STianrui Zhao 
340f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(1)),
341f8447436STianrui Zhao                            &env->CSR_SAVE[1]);
342f8447436STianrui Zhao 
343f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(2)),
344f8447436STianrui Zhao                            &env->CSR_SAVE[2]);
345f8447436STianrui Zhao 
346f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(3)),
347f8447436STianrui Zhao                            &env->CSR_SAVE[3]);
348f8447436STianrui Zhao 
349f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(4)),
350f8447436STianrui Zhao                            &env->CSR_SAVE[4]);
351f8447436STianrui Zhao 
352f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(5)),
353f8447436STianrui Zhao                            &env->CSR_SAVE[5]);
354f8447436STianrui Zhao 
355f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(6)),
356f8447436STianrui Zhao                            &env->CSR_SAVE[6]);
357f8447436STianrui Zhao 
358f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_SAVE(7)),
359f8447436STianrui Zhao                            &env->CSR_SAVE[7]);
360f8447436STianrui Zhao 
361f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TID),
362f8447436STianrui Zhao                            &env->CSR_TID);
363f8447436STianrui Zhao 
364f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_CNTC),
365f8447436STianrui Zhao                            &env->CSR_CNTC);
366f8447436STianrui Zhao 
367f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TICLR),
368f8447436STianrui Zhao                            &env->CSR_TICLR);
369f8447436STianrui Zhao 
370f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_LLBCTL),
371f8447436STianrui Zhao                            &env->CSR_LLBCTL);
372f8447436STianrui Zhao 
373f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_IMPCTL1),
374f8447436STianrui Zhao                            &env->CSR_IMPCTL1);
375f8447436STianrui Zhao 
376f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_IMPCTL2),
377f8447436STianrui Zhao                            &env->CSR_IMPCTL2);
378f8447436STianrui Zhao 
379f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRENTRY),
380f8447436STianrui Zhao                            &env->CSR_TLBRENTRY);
381f8447436STianrui Zhao 
382f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRBADV),
383f8447436STianrui Zhao                            &env->CSR_TLBRBADV);
384f8447436STianrui Zhao 
385f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRERA),
386f8447436STianrui Zhao                            &env->CSR_TLBRERA);
387f8447436STianrui Zhao 
388f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRSAVE),
389f8447436STianrui Zhao                            &env->CSR_TLBRSAVE);
390f8447436STianrui Zhao 
391f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRELO0),
392f8447436STianrui Zhao                            &env->CSR_TLBRELO0);
393f8447436STianrui Zhao 
394f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRELO1),
395f8447436STianrui Zhao                            &env->CSR_TLBRELO1);
396f8447436STianrui Zhao 
397f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBREHI),
398f8447436STianrui Zhao                            &env->CSR_TLBREHI);
399f8447436STianrui Zhao 
400f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TLBRPRMD),
401f8447436STianrui Zhao                            &env->CSR_TLBRPRMD);
402f8447436STianrui Zhao 
403f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(0)),
404f8447436STianrui Zhao                            &env->CSR_DMW[0]);
405f8447436STianrui Zhao 
406f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(1)),
407f8447436STianrui Zhao                            &env->CSR_DMW[1]);
408f8447436STianrui Zhao 
409f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(2)),
410f8447436STianrui Zhao                            &env->CSR_DMW[2]);
411f8447436STianrui Zhao 
412f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_DMW(3)),
413f8447436STianrui Zhao                            &env->CSR_DMW[3]);
414f8447436STianrui Zhao     /*
415f8447436STianrui Zhao      * timer cfg must be put at last since it is used to enable
416f8447436STianrui Zhao      * guest timer
417f8447436STianrui Zhao      */
418f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TVAL),
419f8447436STianrui Zhao                            &env->CSR_TVAL);
420f8447436STianrui Zhao 
421f8447436STianrui Zhao     ret |= kvm_set_one_reg(cs, KVM_IOC_CSRID(LOONGARCH_CSR_TCFG),
422f8447436STianrui Zhao                            &env->CSR_TCFG);
423f8447436STianrui Zhao     return ret;
424f8447436STianrui Zhao }
425f8447436STianrui Zhao 
426f8447436STianrui Zhao static int kvm_loongarch_get_regs_fp(CPUState *cs)
427f8447436STianrui Zhao {
428f8447436STianrui Zhao     int ret, i;
429f8447436STianrui Zhao     struct kvm_fpu fpu;
430f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
431f8447436STianrui Zhao 
432f8447436STianrui Zhao     ret = kvm_vcpu_ioctl(cs, KVM_GET_FPU, &fpu);
433f8447436STianrui Zhao     if (ret < 0) {
434f8447436STianrui Zhao         trace_kvm_failed_get_fpu(strerror(errno));
435f8447436STianrui Zhao         return ret;
436f8447436STianrui Zhao     }
437f8447436STianrui Zhao 
438f8447436STianrui Zhao     env->fcsr0 = fpu.fcsr;
439f8447436STianrui Zhao     for (i = 0; i < 32; i++) {
440f8447436STianrui Zhao         env->fpr[i].vreg.UD[0] = fpu.fpr[i].val64[0];
44107c08661SSong Gao         env->fpr[i].vreg.UD[1] = fpu.fpr[i].val64[1];
44207c08661SSong Gao         env->fpr[i].vreg.UD[2] = fpu.fpr[i].val64[2];
44307c08661SSong Gao         env->fpr[i].vreg.UD[3] = fpu.fpr[i].val64[3];
444f8447436STianrui Zhao     }
445f8447436STianrui Zhao     for (i = 0; i < 8; i++) {
446f8447436STianrui Zhao         env->cf[i] = fpu.fcc & 0xFF;
447f8447436STianrui Zhao         fpu.fcc = fpu.fcc >> 8;
448f8447436STianrui Zhao     }
449f8447436STianrui Zhao 
450f8447436STianrui Zhao     return ret;
451f8447436STianrui Zhao }
452f8447436STianrui Zhao 
453f8447436STianrui Zhao static int kvm_loongarch_put_regs_fp(CPUState *cs)
454f8447436STianrui Zhao {
455f8447436STianrui Zhao     int ret, i;
456f8447436STianrui Zhao     struct kvm_fpu fpu;
457f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
458f8447436STianrui Zhao 
459f8447436STianrui Zhao     fpu.fcsr = env->fcsr0;
460f8447436STianrui Zhao     fpu.fcc = 0;
461f8447436STianrui Zhao     for (i = 0; i < 32; i++) {
462f8447436STianrui Zhao         fpu.fpr[i].val64[0] = env->fpr[i].vreg.UD[0];
46307c08661SSong Gao         fpu.fpr[i].val64[1] = env->fpr[i].vreg.UD[1];
46407c08661SSong Gao         fpu.fpr[i].val64[2] = env->fpr[i].vreg.UD[2];
46507c08661SSong Gao         fpu.fpr[i].val64[3] = env->fpr[i].vreg.UD[3];
466f8447436STianrui Zhao     }
467f8447436STianrui Zhao 
468f8447436STianrui Zhao     for (i = 0; i < 8; i++) {
469f8447436STianrui Zhao         fpu.fcc |= env->cf[i] << (8 * i);
470f8447436STianrui Zhao     }
471f8447436STianrui Zhao 
472f8447436STianrui Zhao     ret = kvm_vcpu_ioctl(cs, KVM_SET_FPU, &fpu);
473f8447436STianrui Zhao     if (ret < 0) {
474f8447436STianrui Zhao         trace_kvm_failed_put_fpu(strerror(errno));
475f8447436STianrui Zhao     }
476f8447436STianrui Zhao 
477f8447436STianrui Zhao     return ret;
478f8447436STianrui Zhao }
479f8447436STianrui Zhao 
480a724f5a8SBibo Mao void kvm_arch_reset_vcpu(CPUState *cs)
481f8447436STianrui Zhao {
482a724f5a8SBibo Mao     CPULoongArchState *env = cpu_env(cs);
483a724f5a8SBibo Mao 
484f8447436STianrui Zhao     env->mp_state = KVM_MP_STATE_RUNNABLE;
485a724f5a8SBibo Mao     kvm_set_one_reg(cs, KVM_REG_LOONGARCH_VCPU_RESET, 0);
486f8447436STianrui Zhao }
487f8447436STianrui Zhao 
488f8447436STianrui Zhao static int kvm_loongarch_get_mpstate(CPUState *cs)
489f8447436STianrui Zhao {
490f8447436STianrui Zhao     int ret = 0;
491f8447436STianrui Zhao     struct kvm_mp_state mp_state;
492f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
493f8447436STianrui Zhao 
494f8447436STianrui Zhao     if (cap_has_mp_state) {
495f8447436STianrui Zhao         ret = kvm_vcpu_ioctl(cs, KVM_GET_MP_STATE, &mp_state);
496f8447436STianrui Zhao         if (ret) {
497f8447436STianrui Zhao             trace_kvm_failed_get_mpstate(strerror(errno));
498f8447436STianrui Zhao             return ret;
499f8447436STianrui Zhao         }
500f8447436STianrui Zhao         env->mp_state = mp_state.mp_state;
501f8447436STianrui Zhao     }
502f8447436STianrui Zhao 
503f8447436STianrui Zhao     return ret;
504f8447436STianrui Zhao }
505f8447436STianrui Zhao 
506f8447436STianrui Zhao static int kvm_loongarch_put_mpstate(CPUState *cs)
507f8447436STianrui Zhao {
508f8447436STianrui Zhao     int ret = 0;
509f8447436STianrui Zhao     struct kvm_mp_state mp_state = {
510f3b603b9SPhilippe Mathieu-Daudé         .mp_state = cpu_env(cs)->mp_state
511f8447436STianrui Zhao     };
512f8447436STianrui Zhao 
513f8447436STianrui Zhao     if (cap_has_mp_state) {
514f8447436STianrui Zhao         ret = kvm_vcpu_ioctl(cs, KVM_SET_MP_STATE, &mp_state);
515f8447436STianrui Zhao         if (ret) {
516f8447436STianrui Zhao             trace_kvm_failed_put_mpstate(strerror(errno));
517f8447436STianrui Zhao         }
518f8447436STianrui Zhao     }
519f8447436STianrui Zhao 
520f8447436STianrui Zhao     return ret;
521f8447436STianrui Zhao }
522f8447436STianrui Zhao 
523f8447436STianrui Zhao static int kvm_loongarch_get_cpucfg(CPUState *cs)
524f8447436STianrui Zhao {
525f8447436STianrui Zhao     int i, ret = 0;
526f8447436STianrui Zhao     uint64_t val;
527f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
528f8447436STianrui Zhao 
529f8447436STianrui Zhao     for (i = 0; i < 21; i++) {
530f8447436STianrui Zhao         ret = kvm_get_one_reg(cs, KVM_IOC_CPUCFG(i), &val);
531f8447436STianrui Zhao         if (ret < 0) {
532f8447436STianrui Zhao             trace_kvm_failed_get_cpucfg(strerror(errno));
533f8447436STianrui Zhao         }
534f8447436STianrui Zhao         env->cpucfg[i] = (uint32_t)val;
535f8447436STianrui Zhao     }
536f8447436STianrui Zhao     return ret;
537f8447436STianrui Zhao }
538f8447436STianrui Zhao 
539fc700996SSong Gao static int kvm_check_cpucfg2(CPUState *cs)
540fc700996SSong Gao {
541fc700996SSong Gao     int ret;
542fc700996SSong Gao     uint64_t val;
543fc700996SSong Gao     struct kvm_device_attr attr = {
544fc700996SSong Gao         .group = KVM_LOONGARCH_VCPU_CPUCFG,
545fc700996SSong Gao         .attr = 2,
546fc700996SSong Gao         .addr = (uint64_t)&val,
547fc700996SSong Gao     };
548f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
549fc700996SSong Gao 
550fc700996SSong Gao     ret = kvm_vcpu_ioctl(cs, KVM_HAS_DEVICE_ATTR, &attr);
551fc700996SSong Gao 
552fc700996SSong Gao     if (!ret) {
553fc700996SSong Gao         kvm_vcpu_ioctl(cs, KVM_GET_DEVICE_ATTR, &attr);
554fc700996SSong Gao         env->cpucfg[2] &= val;
555fc700996SSong Gao 
556fc700996SSong Gao         if (FIELD_EX32(env->cpucfg[2], CPUCFG2, FP)) {
557fc700996SSong Gao             /* The FP minimal version is 1. */
558fc700996SSong Gao             env->cpucfg[2] = FIELD_DP32(env->cpucfg[2], CPUCFG2, FP_VER, 1);
559fc700996SSong Gao         }
560fc700996SSong Gao 
561fc700996SSong Gao         if (FIELD_EX32(env->cpucfg[2], CPUCFG2, LLFTP)) {
562fc700996SSong Gao             /* The LLFTP minimal version is 1. */
563fc700996SSong Gao             env->cpucfg[2] = FIELD_DP32(env->cpucfg[2], CPUCFG2, LLFTP_VER, 1);
564fc700996SSong Gao         }
565fc700996SSong Gao     }
566fc700996SSong Gao 
567fc700996SSong Gao     return ret;
568fc700996SSong Gao }
569fc700996SSong Gao 
570f8447436STianrui Zhao static int kvm_loongarch_put_cpucfg(CPUState *cs)
571f8447436STianrui Zhao {
572f8447436STianrui Zhao     int i, ret = 0;
573f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
574f8447436STianrui Zhao     uint64_t val;
575f8447436STianrui Zhao 
576f8447436STianrui Zhao     for (i = 0; i < 21; i++) {
577f8447436STianrui Zhao 	if (i == 2) {
578fc700996SSong Gao             ret = kvm_check_cpucfg2(cs);
579fc700996SSong Gao             if (ret) {
580fc700996SSong Gao                 return ret;
581f8447436STianrui Zhao             }
582fc700996SSong Gao 	}
583fc700996SSong Gao         val = env->cpucfg[i];
584f8447436STianrui Zhao         ret = kvm_set_one_reg(cs, KVM_IOC_CPUCFG(i), &val);
585f8447436STianrui Zhao         if (ret < 0) {
586f8447436STianrui Zhao             trace_kvm_failed_put_cpucfg(strerror(errno));
587f8447436STianrui Zhao         }
588f8447436STianrui Zhao     }
589f8447436STianrui Zhao     return ret;
590f8447436STianrui Zhao }
591f8447436STianrui Zhao 
592a1676bb3SJulia Suvorova int kvm_arch_get_registers(CPUState *cs, Error **errp)
593537ba9daSTianrui Zhao {
594f8447436STianrui Zhao     int ret;
595f8447436STianrui Zhao 
596f8447436STianrui Zhao     ret = kvm_loongarch_get_regs_core(cs);
597f8447436STianrui Zhao     if (ret) {
598f8447436STianrui Zhao         return ret;
599537ba9daSTianrui Zhao     }
600f8447436STianrui Zhao 
6015872966dSBibo Mao     ret = kvm_loongarch_get_cpucfg(cs);
6025872966dSBibo Mao     if (ret) {
6035872966dSBibo Mao         return ret;
6045872966dSBibo Mao     }
6055872966dSBibo Mao 
606f8447436STianrui Zhao     ret = kvm_loongarch_get_csr(cs);
607f8447436STianrui Zhao     if (ret) {
608f8447436STianrui Zhao         return ret;
609f8447436STianrui Zhao     }
610f8447436STianrui Zhao 
611f8447436STianrui Zhao     ret = kvm_loongarch_get_regs_fp(cs);
612f8447436STianrui Zhao     if (ret) {
613f8447436STianrui Zhao         return ret;
614f8447436STianrui Zhao     }
615f8447436STianrui Zhao 
616f8447436STianrui Zhao     ret = kvm_loongarch_get_mpstate(cs);
617f8447436STianrui Zhao     return ret;
618f8447436STianrui Zhao }
619f8447436STianrui Zhao 
620a1676bb3SJulia Suvorova int kvm_arch_put_registers(CPUState *cs, int level, Error **errp)
621537ba9daSTianrui Zhao {
622f8447436STianrui Zhao     int ret;
623f8447436STianrui Zhao 
624f8447436STianrui Zhao     ret = kvm_loongarch_put_regs_core(cs);
625f8447436STianrui Zhao     if (ret) {
626f8447436STianrui Zhao         return ret;
627f8447436STianrui Zhao     }
628f8447436STianrui Zhao 
6295872966dSBibo Mao     ret = kvm_loongarch_put_cpucfg(cs);
6305872966dSBibo Mao     if (ret) {
6315872966dSBibo Mao         return ret;
6325872966dSBibo Mao     }
6335872966dSBibo Mao 
63461f6e150SBibo Mao     ret = kvm_loongarch_put_csr(cs, level);
635f8447436STianrui Zhao     if (ret) {
636f8447436STianrui Zhao         return ret;
637f8447436STianrui Zhao     }
638f8447436STianrui Zhao 
639f8447436STianrui Zhao     ret = kvm_loongarch_put_regs_fp(cs);
640f8447436STianrui Zhao     if (ret) {
641f8447436STianrui Zhao         return ret;
642f8447436STianrui Zhao     }
643f8447436STianrui Zhao 
644f8447436STianrui Zhao     ret = kvm_loongarch_put_mpstate(cs);
645f8447436STianrui Zhao     return ret;
646537ba9daSTianrui Zhao }
647537ba9daSTianrui Zhao 
648d11681c9STianrui Zhao static void kvm_loongarch_vm_stage_change(void *opaque, bool running,
649d11681c9STianrui Zhao                                           RunState state)
650d11681c9STianrui Zhao {
651d11681c9STianrui Zhao     int ret;
652d11681c9STianrui Zhao     CPUState *cs = opaque;
653d11681c9STianrui Zhao     LoongArchCPU *cpu = LOONGARCH_CPU(cs);
654d11681c9STianrui Zhao 
655d11681c9STianrui Zhao     if (running) {
656d11681c9STianrui Zhao         ret = kvm_set_one_reg(cs, KVM_REG_LOONGARCH_COUNTER,
657d11681c9STianrui Zhao                               &cpu->kvm_state_counter);
658d11681c9STianrui Zhao         if (ret < 0) {
659d11681c9STianrui Zhao             trace_kvm_failed_put_counter(strerror(errno));
660d11681c9STianrui Zhao         }
661d11681c9STianrui Zhao     } else {
662d11681c9STianrui Zhao         ret = kvm_get_one_reg(cs, KVM_REG_LOONGARCH_COUNTER,
663d11681c9STianrui Zhao                               &cpu->kvm_state_counter);
664d11681c9STianrui Zhao         if (ret < 0) {
665d11681c9STianrui Zhao             trace_kvm_failed_get_counter(strerror(errno));
666d11681c9STianrui Zhao         }
667d11681c9STianrui Zhao     }
668d11681c9STianrui Zhao }
669d11681c9STianrui Zhao 
670*c23a53d8SBibo Mao static bool kvm_feature_supported(CPUState *cs, enum loongarch_features feature)
671*c23a53d8SBibo Mao {
672*c23a53d8SBibo Mao     int ret;
673*c23a53d8SBibo Mao     struct kvm_device_attr attr;
674*c23a53d8SBibo Mao 
675*c23a53d8SBibo Mao     switch (feature) {
676*c23a53d8SBibo Mao     case LOONGARCH_FEATURE_LBT:
677*c23a53d8SBibo Mao         /*
678*c23a53d8SBibo Mao          * Return all if all the LBT features are supported such as:
679*c23a53d8SBibo Mao          *  KVM_LOONGARCH_VM_FEAT_X86BT
680*c23a53d8SBibo Mao          *  KVM_LOONGARCH_VM_FEAT_ARMBT
681*c23a53d8SBibo Mao          *  KVM_LOONGARCH_VM_FEAT_MIPSBT
682*c23a53d8SBibo Mao          */
683*c23a53d8SBibo Mao         attr.group = KVM_LOONGARCH_VM_FEAT_CTRL;
684*c23a53d8SBibo Mao         attr.attr = KVM_LOONGARCH_VM_FEAT_X86BT;
685*c23a53d8SBibo Mao         ret = kvm_vm_ioctl(kvm_state, KVM_HAS_DEVICE_ATTR, &attr);
686*c23a53d8SBibo Mao         attr.attr = KVM_LOONGARCH_VM_FEAT_ARMBT;
687*c23a53d8SBibo Mao         ret |= kvm_vm_ioctl(kvm_state, KVM_HAS_DEVICE_ATTR, &attr);
688*c23a53d8SBibo Mao         attr.attr = KVM_LOONGARCH_VM_FEAT_MIPSBT;
689*c23a53d8SBibo Mao         ret |= kvm_vm_ioctl(kvm_state, KVM_HAS_DEVICE_ATTR, &attr);
690*c23a53d8SBibo Mao         return (ret == 0);
691*c23a53d8SBibo Mao     default:
692*c23a53d8SBibo Mao         return false;
693*c23a53d8SBibo Mao     }
694*c23a53d8SBibo Mao }
695*c23a53d8SBibo Mao 
696*c23a53d8SBibo Mao static int kvm_cpu_check_lbt(CPUState *cs, Error **errp)
697*c23a53d8SBibo Mao {
698*c23a53d8SBibo Mao     CPULoongArchState *env = cpu_env(cs);
699*c23a53d8SBibo Mao     LoongArchCPU *cpu = LOONGARCH_CPU(cs);
700*c23a53d8SBibo Mao     bool kvm_supported;
701*c23a53d8SBibo Mao 
702*c23a53d8SBibo Mao     kvm_supported = kvm_feature_supported(cs, LOONGARCH_FEATURE_LBT);
703*c23a53d8SBibo Mao     if (cpu->lbt == ON_OFF_AUTO_ON) {
704*c23a53d8SBibo Mao         if (kvm_supported) {
705*c23a53d8SBibo Mao             env->cpucfg[2] = FIELD_DP32(env->cpucfg[2], CPUCFG2, LBT_ALL, 7);
706*c23a53d8SBibo Mao         } else {
707*c23a53d8SBibo Mao             error_setg(errp, "'lbt' feature not supported by KVM on this host");
708*c23a53d8SBibo Mao             return -ENOTSUP;
709*c23a53d8SBibo Mao         }
710*c23a53d8SBibo Mao     } else if ((cpu->lbt == ON_OFF_AUTO_AUTO) && kvm_supported) {
711*c23a53d8SBibo Mao         env->cpucfg[2] = FIELD_DP32(env->cpucfg[2], CPUCFG2, LBT_ALL, 7);
712*c23a53d8SBibo Mao     }
713*c23a53d8SBibo Mao 
714*c23a53d8SBibo Mao     return 0;
715*c23a53d8SBibo Mao }
716*c23a53d8SBibo Mao 
717537ba9daSTianrui Zhao int kvm_arch_init_vcpu(CPUState *cs)
718537ba9daSTianrui Zhao {
719d38e31efSBibo Mao     uint64_t val;
720*c23a53d8SBibo Mao     int ret;
721*c23a53d8SBibo Mao     Error *local_err = NULL;
722d38e31efSBibo Mao 
723*c23a53d8SBibo Mao     ret = 0;
724d11681c9STianrui Zhao     qemu_add_vm_change_state_handler(kvm_loongarch_vm_stage_change, cs);
725d38e31efSBibo Mao 
726d38e31efSBibo Mao     if (!kvm_get_one_reg(cs, KVM_REG_LOONGARCH_DEBUG_INST, &val)) {
727d38e31efSBibo Mao         brk_insn = val;
728d38e31efSBibo Mao     }
729d38e31efSBibo Mao 
730*c23a53d8SBibo Mao     ret = kvm_cpu_check_lbt(cs, &local_err);
731*c23a53d8SBibo Mao     if (ret < 0) {
732*c23a53d8SBibo Mao         error_report_err(local_err);
733*c23a53d8SBibo Mao     }
734*c23a53d8SBibo Mao     return ret;
735537ba9daSTianrui Zhao }
736537ba9daSTianrui Zhao 
737537ba9daSTianrui Zhao int kvm_arch_destroy_vcpu(CPUState *cs)
738537ba9daSTianrui Zhao {
739537ba9daSTianrui Zhao     return 0;
740537ba9daSTianrui Zhao }
741537ba9daSTianrui Zhao 
742537ba9daSTianrui Zhao unsigned long kvm_arch_vcpu_id(CPUState *cs)
743537ba9daSTianrui Zhao {
744537ba9daSTianrui Zhao     return cs->cpu_index;
745537ba9daSTianrui Zhao }
746537ba9daSTianrui Zhao 
747537ba9daSTianrui Zhao int kvm_arch_release_virq_post(int virq)
748537ba9daSTianrui Zhao {
749537ba9daSTianrui Zhao     return 0;
750537ba9daSTianrui Zhao }
751537ba9daSTianrui Zhao 
752537ba9daSTianrui Zhao int kvm_arch_msi_data_to_gsi(uint32_t data)
753537ba9daSTianrui Zhao {
754537ba9daSTianrui Zhao     abort();
755537ba9daSTianrui Zhao }
756537ba9daSTianrui Zhao 
757537ba9daSTianrui Zhao int kvm_arch_fixup_msi_route(struct kvm_irq_routing_entry *route,
758537ba9daSTianrui Zhao                              uint64_t address, uint32_t data, PCIDevice *dev)
759537ba9daSTianrui Zhao {
760537ba9daSTianrui Zhao     return 0;
761537ba9daSTianrui Zhao }
762537ba9daSTianrui Zhao 
763537ba9daSTianrui Zhao int kvm_arch_add_msi_route_post(struct kvm_irq_routing_entry *route,
764537ba9daSTianrui Zhao                                 int vector, PCIDevice *dev)
765537ba9daSTianrui Zhao {
766537ba9daSTianrui Zhao     return 0;
767537ba9daSTianrui Zhao }
768537ba9daSTianrui Zhao 
769537ba9daSTianrui Zhao void kvm_arch_init_irq_routing(KVMState *s)
770537ba9daSTianrui Zhao {
771537ba9daSTianrui Zhao }
772537ba9daSTianrui Zhao 
773537ba9daSTianrui Zhao int kvm_arch_get_default_type(MachineState *ms)
774537ba9daSTianrui Zhao {
775537ba9daSTianrui Zhao     return 0;
776537ba9daSTianrui Zhao }
777537ba9daSTianrui Zhao 
778537ba9daSTianrui Zhao int kvm_arch_init(MachineState *ms, KVMState *s)
779537ba9daSTianrui Zhao {
78041958c99STianrui Zhao     cap_has_mp_state = kvm_check_extension(s, KVM_CAP_MP_STATE);
781537ba9daSTianrui Zhao     return 0;
782537ba9daSTianrui Zhao }
783537ba9daSTianrui Zhao 
784537ba9daSTianrui Zhao int kvm_arch_irqchip_create(KVMState *s)
785537ba9daSTianrui Zhao {
786537ba9daSTianrui Zhao     return 0;
787537ba9daSTianrui Zhao }
788537ba9daSTianrui Zhao 
789537ba9daSTianrui Zhao void kvm_arch_pre_run(CPUState *cs, struct kvm_run *run)
790537ba9daSTianrui Zhao {
791537ba9daSTianrui Zhao }
792537ba9daSTianrui Zhao 
793537ba9daSTianrui Zhao MemTxAttrs kvm_arch_post_run(CPUState *cs, struct kvm_run *run)
794537ba9daSTianrui Zhao {
795537ba9daSTianrui Zhao     return MEMTXATTRS_UNSPECIFIED;
796537ba9daSTianrui Zhao }
797537ba9daSTianrui Zhao 
798537ba9daSTianrui Zhao int kvm_arch_process_async_events(CPUState *cs)
799537ba9daSTianrui Zhao {
800537ba9daSTianrui Zhao     return cs->halted;
801537ba9daSTianrui Zhao }
802537ba9daSTianrui Zhao 
803537ba9daSTianrui Zhao bool kvm_arch_stop_on_emulation_error(CPUState *cs)
804537ba9daSTianrui Zhao {
805537ba9daSTianrui Zhao     return true;
806537ba9daSTianrui Zhao }
807537ba9daSTianrui Zhao 
808d38e31efSBibo Mao void kvm_arch_update_guest_debug(CPUState *cpu, struct kvm_guest_debug *dbg)
809d38e31efSBibo Mao {
810d38e31efSBibo Mao     if (kvm_sw_breakpoints_active(cpu)) {
811d38e31efSBibo Mao         dbg->control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_USE_SW_BP;
812d38e31efSBibo Mao     }
813d38e31efSBibo Mao }
814d38e31efSBibo Mao 
815d38e31efSBibo Mao int kvm_arch_insert_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
816d38e31efSBibo Mao {
817d38e31efSBibo Mao     if (cpu_memory_rw_debug(cs, bp->pc, (uint8_t *)&bp->saved_insn, 4, 0) ||
818d38e31efSBibo Mao         cpu_memory_rw_debug(cs, bp->pc, (uint8_t *)&brk_insn, 4, 1)) {
819d38e31efSBibo Mao         error_report("%s failed", __func__);
820d38e31efSBibo Mao         return -EINVAL;
821d38e31efSBibo Mao     }
822d38e31efSBibo Mao     return 0;
823d38e31efSBibo Mao }
824d38e31efSBibo Mao 
825d38e31efSBibo Mao int kvm_arch_remove_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
826d38e31efSBibo Mao {
827d38e31efSBibo Mao     static uint32_t brk;
828d38e31efSBibo Mao 
829d38e31efSBibo Mao     if (cpu_memory_rw_debug(cs, bp->pc, (uint8_t *)&brk, 4, 0) ||
830d38e31efSBibo Mao         brk != brk_insn ||
831d38e31efSBibo Mao         cpu_memory_rw_debug(cs, bp->pc, (uint8_t *)&bp->saved_insn, 4, 1)) {
832d38e31efSBibo Mao         error_report("%s failed", __func__);
833d38e31efSBibo Mao         return -EINVAL;
834d38e31efSBibo Mao     }
835d38e31efSBibo Mao     return 0;
836d38e31efSBibo Mao }
837d38e31efSBibo Mao 
838d38e31efSBibo Mao int kvm_arch_insert_hw_breakpoint(vaddr addr, vaddr len, int type)
839d38e31efSBibo Mao {
840d38e31efSBibo Mao     return -ENOSYS;
841d38e31efSBibo Mao }
842d38e31efSBibo Mao 
843d38e31efSBibo Mao int kvm_arch_remove_hw_breakpoint(vaddr addr, vaddr len, int type)
844d38e31efSBibo Mao {
845d38e31efSBibo Mao     return -ENOSYS;
846d38e31efSBibo Mao }
847d38e31efSBibo Mao 
848d38e31efSBibo Mao void kvm_arch_remove_all_hw_breakpoints(void)
849d38e31efSBibo Mao {
850d38e31efSBibo Mao }
851d38e31efSBibo Mao 
852d38e31efSBibo Mao static bool kvm_loongarch_handle_debug(CPUState *cs, struct kvm_run *run)
853d38e31efSBibo Mao {
854d38e31efSBibo Mao     LoongArchCPU *cpu = LOONGARCH_CPU(cs);
855d38e31efSBibo Mao     CPULoongArchState *env = &cpu->env;
856d38e31efSBibo Mao 
857d38e31efSBibo Mao     kvm_cpu_synchronize_state(cs);
858d38e31efSBibo Mao     if (cs->singlestep_enabled) {
859d38e31efSBibo Mao         return true;
860d38e31efSBibo Mao     }
861d38e31efSBibo Mao 
862d38e31efSBibo Mao     if (kvm_find_sw_breakpoint(cs, env->pc)) {
863d38e31efSBibo Mao         return true;
864d38e31efSBibo Mao     }
865d38e31efSBibo Mao 
866d38e31efSBibo Mao     return false;
867d38e31efSBibo Mao }
868d38e31efSBibo Mao 
869537ba9daSTianrui Zhao int kvm_arch_handle_exit(CPUState *cs, struct kvm_run *run)
870537ba9daSTianrui Zhao {
871a05a950fSTianrui Zhao     int ret = 0;
872f3b603b9SPhilippe Mathieu-Daudé     CPULoongArchState *env = cpu_env(cs);
873a05a950fSTianrui Zhao     MemTxAttrs attrs = {};
874a05a950fSTianrui Zhao 
875a05a950fSTianrui Zhao     attrs.requester_id = env_cpu(env)->cpu_index;
876a05a950fSTianrui Zhao 
877a05a950fSTianrui Zhao     trace_kvm_arch_handle_exit(run->exit_reason);
878a05a950fSTianrui Zhao     switch (run->exit_reason) {
879a05a950fSTianrui Zhao     case KVM_EXIT_LOONGARCH_IOCSR:
8805e90b8dbSBibo Mao         address_space_rw(env->address_space_iocsr,
881a05a950fSTianrui Zhao                          run->iocsr_io.phys_addr,
882a05a950fSTianrui Zhao                          attrs,
883a05a950fSTianrui Zhao                          run->iocsr_io.data,
884a05a950fSTianrui Zhao                          run->iocsr_io.len,
885a05a950fSTianrui Zhao                          run->iocsr_io.is_write);
886a05a950fSTianrui Zhao         break;
887d38e31efSBibo Mao 
888d38e31efSBibo Mao     case KVM_EXIT_DEBUG:
889d38e31efSBibo Mao         if (kvm_loongarch_handle_debug(cs, run)) {
890d38e31efSBibo Mao             ret = EXCP_DEBUG;
891d38e31efSBibo Mao         }
892d38e31efSBibo Mao         break;
893d38e31efSBibo Mao 
894a05a950fSTianrui Zhao     default:
895a05a950fSTianrui Zhao         ret = -1;
896a05a950fSTianrui Zhao         warn_report("KVM: unknown exit reason %d", run->exit_reason);
897a05a950fSTianrui Zhao         break;
898a05a950fSTianrui Zhao     }
899a05a950fSTianrui Zhao     return ret;
900537ba9daSTianrui Zhao }
901537ba9daSTianrui Zhao 
9028dcbad51STianrui Zhao int kvm_loongarch_set_interrupt(LoongArchCPU *cpu, int irq, int level)
9038dcbad51STianrui Zhao {
9048dcbad51STianrui Zhao     struct kvm_interrupt intr;
9058dcbad51STianrui Zhao     CPUState *cs = CPU(cpu);
9068dcbad51STianrui Zhao 
9078dcbad51STianrui Zhao     if (level) {
9088dcbad51STianrui Zhao         intr.irq = irq;
9098dcbad51STianrui Zhao     } else {
9108dcbad51STianrui Zhao         intr.irq = -irq;
9118dcbad51STianrui Zhao     }
9128dcbad51STianrui Zhao 
9138dcbad51STianrui Zhao     trace_kvm_set_intr(irq, level);
9148dcbad51STianrui Zhao     return kvm_vcpu_ioctl(cs, KVM_INTERRUPT, &intr);
9158dcbad51STianrui Zhao }
9168dcbad51STianrui Zhao 
917537ba9daSTianrui Zhao void kvm_arch_accel_class_init(ObjectClass *oc)
918537ba9daSTianrui Zhao {
919537ba9daSTianrui Zhao }
920