xref: /qemu/target/mips/kvm.c (revision 81ddae7c3095065466d235f782aa2af620db78d0)
1e2132e0bSSanjay Lal /*
2e2132e0bSSanjay Lal  * This file is subject to the terms and conditions of the GNU General Public
3e2132e0bSSanjay Lal  * License.  See the file "COPYING" in the main directory of this archive
4e2132e0bSSanjay Lal  * for more details.
5e2132e0bSSanjay Lal  *
6e2132e0bSSanjay Lal  * KVM/MIPS: MIPS specific KVM APIs
7e2132e0bSSanjay Lal  *
8e2132e0bSSanjay Lal  * Copyright (C) 2012-2014 Imagination Technologies Ltd.
9e2132e0bSSanjay Lal  * Authors: Sanjay Lal <sanjayl@kymasys.com>
10e2132e0bSSanjay Lal */
11e2132e0bSSanjay Lal 
12c684822aSPeter Maydell #include "qemu/osdep.h"
13e2132e0bSSanjay Lal #include <sys/ioctl.h>
14e2132e0bSSanjay Lal 
15e2132e0bSSanjay Lal #include <linux/kvm.h>
16e2132e0bSSanjay Lal 
17e2132e0bSSanjay Lal #include "qemu-common.h"
1833c11879SPaolo Bonzini #include "cpu.h"
1926aa3d9aSPhilippe Mathieu-Daudé #include "internal.h"
20e2132e0bSSanjay Lal #include "qemu/error-report.h"
21db725815SMarkus Armbruster #include "qemu/main-loop.h"
22e2132e0bSSanjay Lal #include "sysemu/kvm.h"
23719d109bSHuacai Chen #include "sysemu/kvm_int.h"
2454d31236SMarkus Armbruster #include "sysemu/runstate.h"
25e2132e0bSSanjay Lal #include "kvm_mips.h"
26719d109bSHuacai Chen #include "hw/boards.h"
27*81ddae7cSPhilippe Mathieu-Daudé #include "fpu_helper.h"
28e2132e0bSSanjay Lal 
29e2132e0bSSanjay Lal #define DEBUG_KVM 0
30e2132e0bSSanjay Lal 
31e2132e0bSSanjay Lal #define DPRINTF(fmt, ...) \
32e2132e0bSSanjay Lal     do { if (DEBUG_KVM) { fprintf(stderr, fmt, ## __VA_ARGS__); } } while (0)
33e2132e0bSSanjay Lal 
34152db36aSJames Hogan static int kvm_mips_fpu_cap;
35bee62662SJames Hogan static int kvm_mips_msa_cap;
36152db36aSJames Hogan 
37e2132e0bSSanjay Lal const KVMCapabilityInfo kvm_arch_required_capabilities[] = {
38e2132e0bSSanjay Lal     KVM_CAP_LAST_INFO
39e2132e0bSSanjay Lal };
40e2132e0bSSanjay Lal 
41e2132e0bSSanjay Lal static void kvm_mips_update_state(void *opaque, int running, RunState state);
42e2132e0bSSanjay Lal 
43e2132e0bSSanjay Lal unsigned long kvm_arch_vcpu_id(CPUState *cs)
44e2132e0bSSanjay Lal {
45e2132e0bSSanjay Lal     return cs->cpu_index;
46e2132e0bSSanjay Lal }
47e2132e0bSSanjay Lal 
48b16565b3SMarcel Apfelbaum int kvm_arch_init(MachineState *ms, KVMState *s)
49e2132e0bSSanjay Lal {
50e2132e0bSSanjay Lal     /* MIPS has 128 signals */
51e2132e0bSSanjay Lal     kvm_set_sigmask_len(s, 16);
52e2132e0bSSanjay Lal 
53152db36aSJames Hogan     kvm_mips_fpu_cap = kvm_check_extension(s, KVM_CAP_MIPS_FPU);
54bee62662SJames Hogan     kvm_mips_msa_cap = kvm_check_extension(s, KVM_CAP_MIPS_MSA);
55152db36aSJames Hogan 
56e2132e0bSSanjay Lal     DPRINTF("%s\n", __func__);
57e2132e0bSSanjay Lal     return 0;
58e2132e0bSSanjay Lal }
59e2132e0bSSanjay Lal 
604376c40dSPaolo Bonzini int kvm_arch_irqchip_create(KVMState *s)
61d525ffabSPaolo Bonzini {
62d525ffabSPaolo Bonzini     return 0;
63d525ffabSPaolo Bonzini }
64d525ffabSPaolo Bonzini 
65e2132e0bSSanjay Lal int kvm_arch_init_vcpu(CPUState *cs)
66e2132e0bSSanjay Lal {
67152db36aSJames Hogan     MIPSCPU *cpu = MIPS_CPU(cs);
68152db36aSJames Hogan     CPUMIPSState *env = &cpu->env;
69e2132e0bSSanjay Lal     int ret = 0;
70e2132e0bSSanjay Lal 
71e2132e0bSSanjay Lal     qemu_add_vm_change_state_handler(kvm_mips_update_state, cs);
72e2132e0bSSanjay Lal 
73152db36aSJames Hogan     if (kvm_mips_fpu_cap && env->CP0_Config1 & (1 << CP0C1_FP)) {
74152db36aSJames Hogan         ret = kvm_vcpu_enable_cap(cs, KVM_CAP_MIPS_FPU, 0, 0);
75152db36aSJames Hogan         if (ret < 0) {
76152db36aSJames Hogan             /* mark unsupported so it gets disabled on reset */
77152db36aSJames Hogan             kvm_mips_fpu_cap = 0;
78152db36aSJames Hogan             ret = 0;
79152db36aSJames Hogan         }
80152db36aSJames Hogan     }
81152db36aSJames Hogan 
82bee62662SJames Hogan     if (kvm_mips_msa_cap && env->CP0_Config3 & (1 << CP0C3_MSAP)) {
83bee62662SJames Hogan         ret = kvm_vcpu_enable_cap(cs, KVM_CAP_MIPS_MSA, 0, 0);
84bee62662SJames Hogan         if (ret < 0) {
85bee62662SJames Hogan             /* mark unsupported so it gets disabled on reset */
86bee62662SJames Hogan             kvm_mips_msa_cap = 0;
87bee62662SJames Hogan             ret = 0;
88bee62662SJames Hogan         }
89bee62662SJames Hogan     }
90bee62662SJames Hogan 
91e2132e0bSSanjay Lal     DPRINTF("%s\n", __func__);
92e2132e0bSSanjay Lal     return ret;
93e2132e0bSSanjay Lal }
94e2132e0bSSanjay Lal 
95b1115c99SLiran Alon int kvm_arch_destroy_vcpu(CPUState *cs)
96b1115c99SLiran Alon {
97b1115c99SLiran Alon     return 0;
98b1115c99SLiran Alon }
99b1115c99SLiran Alon 
100e2132e0bSSanjay Lal void kvm_mips_reset_vcpu(MIPSCPU *cpu)
101e2132e0bSSanjay Lal {
1020e928b12SJames Hogan     CPUMIPSState *env = &cpu->env;
1030e928b12SJames Hogan 
104152db36aSJames Hogan     if (!kvm_mips_fpu_cap && env->CP0_Config1 & (1 << CP0C1_FP)) {
1052ab4b135SAlistair Francis         warn_report("KVM does not support FPU, disabling");
1060e928b12SJames Hogan         env->CP0_Config1 &= ~(1 << CP0C1_FP);
1070e928b12SJames Hogan     }
108bee62662SJames Hogan     if (!kvm_mips_msa_cap && env->CP0_Config3 & (1 << CP0C3_MSAP)) {
1092ab4b135SAlistair Francis         warn_report("KVM does not support MSA, disabling");
110bee62662SJames Hogan         env->CP0_Config3 &= ~(1 << CP0C3_MSAP);
111bee62662SJames Hogan     }
1120e928b12SJames Hogan 
113e2132e0bSSanjay Lal     DPRINTF("%s\n", __func__);
114e2132e0bSSanjay Lal }
115e2132e0bSSanjay Lal 
116e2132e0bSSanjay Lal int kvm_arch_insert_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
117e2132e0bSSanjay Lal {
118e2132e0bSSanjay Lal     DPRINTF("%s\n", __func__);
119e2132e0bSSanjay Lal     return 0;
120e2132e0bSSanjay Lal }
121e2132e0bSSanjay Lal 
122e2132e0bSSanjay Lal int kvm_arch_remove_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
123e2132e0bSSanjay Lal {
124e2132e0bSSanjay Lal     DPRINTF("%s\n", __func__);
125e2132e0bSSanjay Lal     return 0;
126e2132e0bSSanjay Lal }
127e2132e0bSSanjay Lal 
128e2132e0bSSanjay Lal static inline int cpu_mips_io_interrupts_pending(MIPSCPU *cpu)
129e2132e0bSSanjay Lal {
130e2132e0bSSanjay Lal     CPUMIPSState *env = &cpu->env;
131e2132e0bSSanjay Lal 
132e2132e0bSSanjay Lal     return env->CP0_Cause & (0x1 << (2 + CP0Ca_IP));
133e2132e0bSSanjay Lal }
134e2132e0bSSanjay Lal 
135e2132e0bSSanjay Lal 
136e2132e0bSSanjay Lal void kvm_arch_pre_run(CPUState *cs, struct kvm_run *run)
137e2132e0bSSanjay Lal {
138e2132e0bSSanjay Lal     MIPSCPU *cpu = MIPS_CPU(cs);
139e2132e0bSSanjay Lal     int r;
140e2132e0bSSanjay Lal     struct kvm_mips_interrupt intr;
141e2132e0bSSanjay Lal 
1424b8523eeSJan Kiszka     qemu_mutex_lock_iothread();
1434b8523eeSJan Kiszka 
144e2132e0bSSanjay Lal     if ((cs->interrupt_request & CPU_INTERRUPT_HARD) &&
145e2132e0bSSanjay Lal             cpu_mips_io_interrupts_pending(cpu)) {
146e2132e0bSSanjay Lal         intr.cpu = -1;
147e2132e0bSSanjay Lal         intr.irq = 2;
148e2132e0bSSanjay Lal         r = kvm_vcpu_ioctl(cs, KVM_INTERRUPT, &intr);
149e2132e0bSSanjay Lal         if (r < 0) {
150e2132e0bSSanjay Lal             error_report("%s: cpu %d: failed to inject IRQ %x",
151e2132e0bSSanjay Lal                          __func__, cs->cpu_index, intr.irq);
152e2132e0bSSanjay Lal         }
153e2132e0bSSanjay Lal     }
1544b8523eeSJan Kiszka 
1554b8523eeSJan Kiszka     qemu_mutex_unlock_iothread();
156e2132e0bSSanjay Lal }
157e2132e0bSSanjay Lal 
1584c663752SPaolo Bonzini MemTxAttrs kvm_arch_post_run(CPUState *cs, struct kvm_run *run)
159e2132e0bSSanjay Lal {
1604c663752SPaolo Bonzini     return MEMTXATTRS_UNSPECIFIED;
161e2132e0bSSanjay Lal }
162e2132e0bSSanjay Lal 
163e2132e0bSSanjay Lal int kvm_arch_process_async_events(CPUState *cs)
164e2132e0bSSanjay Lal {
165e2132e0bSSanjay Lal     return cs->halted;
166e2132e0bSSanjay Lal }
167e2132e0bSSanjay Lal 
168e2132e0bSSanjay Lal int kvm_arch_handle_exit(CPUState *cs, struct kvm_run *run)
169e2132e0bSSanjay Lal {
170e2132e0bSSanjay Lal     int ret;
171e2132e0bSSanjay Lal 
172e2132e0bSSanjay Lal     DPRINTF("%s\n", __func__);
173e2132e0bSSanjay Lal     switch (run->exit_reason) {
174e2132e0bSSanjay Lal     default:
175e2132e0bSSanjay Lal         error_report("%s: unknown exit reason %d",
176e2132e0bSSanjay Lal                      __func__, run->exit_reason);
177e2132e0bSSanjay Lal         ret = -1;
178e2132e0bSSanjay Lal         break;
179e2132e0bSSanjay Lal     }
180e2132e0bSSanjay Lal 
181e2132e0bSSanjay Lal     return ret;
182e2132e0bSSanjay Lal }
183e2132e0bSSanjay Lal 
184e2132e0bSSanjay Lal bool kvm_arch_stop_on_emulation_error(CPUState *cs)
185e2132e0bSSanjay Lal {
186e2132e0bSSanjay Lal     DPRINTF("%s\n", __func__);
187e2132e0bSSanjay Lal     return true;
188e2132e0bSSanjay Lal }
189e2132e0bSSanjay Lal 
190e2132e0bSSanjay Lal void kvm_arch_init_irq_routing(KVMState *s)
191e2132e0bSSanjay Lal {
192e2132e0bSSanjay Lal }
193e2132e0bSSanjay Lal 
194e2132e0bSSanjay Lal int kvm_mips_set_interrupt(MIPSCPU *cpu, int irq, int level)
195e2132e0bSSanjay Lal {
196e2132e0bSSanjay Lal     CPUState *cs = CPU(cpu);
197e2132e0bSSanjay Lal     struct kvm_mips_interrupt intr;
198e2132e0bSSanjay Lal 
19911cb076bSPhilippe Mathieu-Daudé     assert(kvm_enabled());
200e2132e0bSSanjay Lal 
201e2132e0bSSanjay Lal     intr.cpu = -1;
202e2132e0bSSanjay Lal 
203e2132e0bSSanjay Lal     if (level) {
204e2132e0bSSanjay Lal         intr.irq = irq;
205e2132e0bSSanjay Lal     } else {
206e2132e0bSSanjay Lal         intr.irq = -irq;
207e2132e0bSSanjay Lal     }
208e2132e0bSSanjay Lal 
209e2132e0bSSanjay Lal     kvm_vcpu_ioctl(cs, KVM_INTERRUPT, &intr);
210e2132e0bSSanjay Lal 
211e2132e0bSSanjay Lal     return 0;
212e2132e0bSSanjay Lal }
213e2132e0bSSanjay Lal 
214e2132e0bSSanjay Lal int kvm_mips_set_ipi_interrupt(MIPSCPU *cpu, int irq, int level)
215e2132e0bSSanjay Lal {
216e2132e0bSSanjay Lal     CPUState *cs = current_cpu;
217e2132e0bSSanjay Lal     CPUState *dest_cs = CPU(cpu);
218e2132e0bSSanjay Lal     struct kvm_mips_interrupt intr;
219e2132e0bSSanjay Lal 
22011cb076bSPhilippe Mathieu-Daudé     assert(kvm_enabled());
221e2132e0bSSanjay Lal 
222e2132e0bSSanjay Lal     intr.cpu = dest_cs->cpu_index;
223e2132e0bSSanjay Lal 
224e2132e0bSSanjay Lal     if (level) {
225e2132e0bSSanjay Lal         intr.irq = irq;
226e2132e0bSSanjay Lal     } else {
227e2132e0bSSanjay Lal         intr.irq = -irq;
228e2132e0bSSanjay Lal     }
229e2132e0bSSanjay Lal 
230e2132e0bSSanjay Lal     DPRINTF("%s: CPU %d, IRQ: %d\n", __func__, intr.cpu, intr.irq);
231e2132e0bSSanjay Lal 
232e2132e0bSSanjay Lal     kvm_vcpu_ioctl(cs, KVM_INTERRUPT, &intr);
233e2132e0bSSanjay Lal 
234e2132e0bSSanjay Lal     return 0;
235e2132e0bSSanjay Lal }
236e2132e0bSSanjay Lal 
237e2132e0bSSanjay Lal #define MIPS_CP0_32(_R, _S)                                     \
2385a2db896SJames Hogan     (KVM_REG_MIPS_CP0 | KVM_REG_SIZE_U32 | (8 * (_R) + (_S)))
239e2132e0bSSanjay Lal 
240e2132e0bSSanjay Lal #define MIPS_CP0_64(_R, _S)                                     \
2415a2db896SJames Hogan     (KVM_REG_MIPS_CP0 | KVM_REG_SIZE_U64 | (8 * (_R) + (_S)))
242e2132e0bSSanjay Lal 
243e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_INDEX          MIPS_CP0_32(0, 0)
2447e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_RANDOM         MIPS_CP0_32(1, 0)
245e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_CONTEXT        MIPS_CP0_64(4, 0)
246e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_USERLOCAL      MIPS_CP0_64(4, 2)
247e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_PAGEMASK       MIPS_CP0_32(5, 0)
2487e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_PAGEGRAIN      MIPS_CP0_32(5, 1)
2497e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_PWBASE         MIPS_CP0_64(5, 5)
2507e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_PWFIELD        MIPS_CP0_64(5, 6)
2517e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_PWSIZE         MIPS_CP0_64(5, 7)
252e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_WIRED          MIPS_CP0_32(6, 0)
2537e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_PWCTL          MIPS_CP0_32(6, 6)
254e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_HWRENA         MIPS_CP0_32(7, 0)
255e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_BADVADDR       MIPS_CP0_64(8, 0)
256e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_COUNT          MIPS_CP0_32(9, 0)
257e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_ENTRYHI        MIPS_CP0_64(10, 0)
258e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_COMPARE        MIPS_CP0_32(11, 0)
259e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_STATUS         MIPS_CP0_32(12, 0)
260e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_CAUSE          MIPS_CP0_32(13, 0)
261e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_EPC            MIPS_CP0_64(14, 0)
262461a1582SJames Hogan #define KVM_REG_MIPS_CP0_PRID           MIPS_CP0_32(15, 0)
2637e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_EBASE          MIPS_CP0_64(15, 1)
26403cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG         MIPS_CP0_32(16, 0)
26503cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG1        MIPS_CP0_32(16, 1)
26603cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG2        MIPS_CP0_32(16, 2)
26703cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG3        MIPS_CP0_32(16, 3)
26803cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG4        MIPS_CP0_32(16, 4)
26903cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG5        MIPS_CP0_32(16, 5)
2707e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_CONFIG6        MIPS_CP0_32(16, 6)
2717e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_XCONTEXT       MIPS_CP0_64(20, 0)
272e2132e0bSSanjay Lal #define KVM_REG_MIPS_CP0_ERROREPC       MIPS_CP0_64(30, 0)
2737e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_KSCRATCH1      MIPS_CP0_64(31, 2)
2747e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_KSCRATCH2      MIPS_CP0_64(31, 3)
2757e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_KSCRATCH3      MIPS_CP0_64(31, 4)
2767e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_KSCRATCH4      MIPS_CP0_64(31, 5)
2777e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_KSCRATCH5      MIPS_CP0_64(31, 6)
2787e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_KSCRATCH6      MIPS_CP0_64(31, 7)
279e2132e0bSSanjay Lal 
280e2132e0bSSanjay Lal static inline int kvm_mips_put_one_reg(CPUState *cs, uint64_t reg_id,
281e2132e0bSSanjay Lal                                        int32_t *addr)
282e2132e0bSSanjay Lal {
283e2132e0bSSanjay Lal     struct kvm_one_reg cp0reg = {
284e2132e0bSSanjay Lal         .id = reg_id,
285f8b3e48bSJames Hogan         .addr = (uintptr_t)addr
286e2132e0bSSanjay Lal     };
287e2132e0bSSanjay Lal 
288e2132e0bSSanjay Lal     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
289e2132e0bSSanjay Lal }
290e2132e0bSSanjay Lal 
2910759487bSJames Hogan static inline int kvm_mips_put_one_ureg(CPUState *cs, uint64_t reg_id,
2920759487bSJames Hogan                                         uint32_t *addr)
2930759487bSJames Hogan {
2940759487bSJames Hogan     struct kvm_one_reg cp0reg = {
2950759487bSJames Hogan         .id = reg_id,
2960759487bSJames Hogan         .addr = (uintptr_t)addr
2970759487bSJames Hogan     };
2980759487bSJames Hogan 
2990759487bSJames Hogan     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
3000759487bSJames Hogan }
3010759487bSJames Hogan 
302e2132e0bSSanjay Lal static inline int kvm_mips_put_one_ulreg(CPUState *cs, uint64_t reg_id,
303e2132e0bSSanjay Lal                                          target_ulong *addr)
304e2132e0bSSanjay Lal {
305e2132e0bSSanjay Lal     uint64_t val64 = *addr;
306e2132e0bSSanjay Lal     struct kvm_one_reg cp0reg = {
307e2132e0bSSanjay Lal         .id = reg_id,
308e2132e0bSSanjay Lal         .addr = (uintptr_t)&val64
309e2132e0bSSanjay Lal     };
310e2132e0bSSanjay Lal 
311e2132e0bSSanjay Lal     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
312e2132e0bSSanjay Lal }
313e2132e0bSSanjay Lal 
314e2132e0bSSanjay Lal static inline int kvm_mips_put_one_reg64(CPUState *cs, uint64_t reg_id,
315d319f83fSJames Hogan                                          int64_t *addr)
316d319f83fSJames Hogan {
317d319f83fSJames Hogan     struct kvm_one_reg cp0reg = {
318d319f83fSJames Hogan         .id = reg_id,
319d319f83fSJames Hogan         .addr = (uintptr_t)addr
320d319f83fSJames Hogan     };
321d319f83fSJames Hogan 
322d319f83fSJames Hogan     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
323d319f83fSJames Hogan }
324d319f83fSJames Hogan 
325d319f83fSJames Hogan static inline int kvm_mips_put_one_ureg64(CPUState *cs, uint64_t reg_id,
326e2132e0bSSanjay Lal                                           uint64_t *addr)
327e2132e0bSSanjay Lal {
328e2132e0bSSanjay Lal     struct kvm_one_reg cp0reg = {
329e2132e0bSSanjay Lal         .id = reg_id,
330e2132e0bSSanjay Lal         .addr = (uintptr_t)addr
331e2132e0bSSanjay Lal     };
332e2132e0bSSanjay Lal 
333e2132e0bSSanjay Lal     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
334e2132e0bSSanjay Lal }
335e2132e0bSSanjay Lal 
336e2132e0bSSanjay Lal static inline int kvm_mips_get_one_reg(CPUState *cs, uint64_t reg_id,
337e2132e0bSSanjay Lal                                        int32_t *addr)
338e2132e0bSSanjay Lal {
339e2132e0bSSanjay Lal     struct kvm_one_reg cp0reg = {
340e2132e0bSSanjay Lal         .id = reg_id,
341f8b3e48bSJames Hogan         .addr = (uintptr_t)addr
342e2132e0bSSanjay Lal     };
343e2132e0bSSanjay Lal 
344f8b3e48bSJames Hogan     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
345e2132e0bSSanjay Lal }
346e2132e0bSSanjay Lal 
3470759487bSJames Hogan static inline int kvm_mips_get_one_ureg(CPUState *cs, uint64_t reg_id,
3480759487bSJames Hogan                                         uint32_t *addr)
3490759487bSJames Hogan {
3500759487bSJames Hogan     struct kvm_one_reg cp0reg = {
3510759487bSJames Hogan         .id = reg_id,
3520759487bSJames Hogan         .addr = (uintptr_t)addr
3530759487bSJames Hogan     };
3540759487bSJames Hogan 
3550759487bSJames Hogan     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
3560759487bSJames Hogan }
3570759487bSJames Hogan 
358182f42fdSPeter Maydell static inline int kvm_mips_get_one_ulreg(CPUState *cs, uint64_t reg_id,
359e2132e0bSSanjay Lal                                          target_ulong *addr)
360e2132e0bSSanjay Lal {
361e2132e0bSSanjay Lal     int ret;
362e2132e0bSSanjay Lal     uint64_t val64 = 0;
363e2132e0bSSanjay Lal     struct kvm_one_reg cp0reg = {
364e2132e0bSSanjay Lal         .id = reg_id,
365e2132e0bSSanjay Lal         .addr = (uintptr_t)&val64
366e2132e0bSSanjay Lal     };
367e2132e0bSSanjay Lal 
368e2132e0bSSanjay Lal     ret = kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
369e2132e0bSSanjay Lal     if (ret >= 0) {
370e2132e0bSSanjay Lal         *addr = val64;
371e2132e0bSSanjay Lal     }
372e2132e0bSSanjay Lal     return ret;
373e2132e0bSSanjay Lal }
374e2132e0bSSanjay Lal 
375182f42fdSPeter Maydell static inline int kvm_mips_get_one_reg64(CPUState *cs, uint64_t reg_id,
376d319f83fSJames Hogan                                          int64_t *addr)
377d319f83fSJames Hogan {
378d319f83fSJames Hogan     struct kvm_one_reg cp0reg = {
379d319f83fSJames Hogan         .id = reg_id,
380d319f83fSJames Hogan         .addr = (uintptr_t)addr
381d319f83fSJames Hogan     };
382d319f83fSJames Hogan 
383d319f83fSJames Hogan     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
384d319f83fSJames Hogan }
385d319f83fSJames Hogan 
386d319f83fSJames Hogan static inline int kvm_mips_get_one_ureg64(CPUState *cs, uint64_t reg_id,
387e2132e0bSSanjay Lal                                           uint64_t *addr)
388e2132e0bSSanjay Lal {
389e2132e0bSSanjay Lal     struct kvm_one_reg cp0reg = {
390e2132e0bSSanjay Lal         .id = reg_id,
391e2132e0bSSanjay Lal         .addr = (uintptr_t)addr
392e2132e0bSSanjay Lal     };
393e2132e0bSSanjay Lal 
394e2132e0bSSanjay Lal     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
395e2132e0bSSanjay Lal }
396e2132e0bSSanjay Lal 
39703cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG_MASK    (1U << CP0C0_M)
398152db36aSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG1_MASK   ((1U << CP0C1_M) | \
399152db36aSJames Hogan                                          (1U << CP0C1_FP))
40003cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG2_MASK   (1U << CP0C2_M)
401bee62662SJames Hogan #define KVM_REG_MIPS_CP0_CONFIG3_MASK   ((1U << CP0C3_M) | \
402bee62662SJames Hogan                                          (1U << CP0C3_MSAP))
40303cbfd7bSJames Hogan #define KVM_REG_MIPS_CP0_CONFIG4_MASK   (1U << CP0C4_M)
404bee62662SJames Hogan #define KVM_REG_MIPS_CP0_CONFIG5_MASK   ((1U << CP0C5_MSAEn) | \
405bee62662SJames Hogan                                          (1U << CP0C5_UFE) | \
406152db36aSJames Hogan                                          (1U << CP0C5_FRE) | \
407152db36aSJames Hogan                                          (1U << CP0C5_UFR))
4087e0896b0SHuacai Chen #define KVM_REG_MIPS_CP0_CONFIG6_MASK   ((1U << CP0C6_BPPASS) | \
4097e0896b0SHuacai Chen                                          (0x3fU << CP0C6_KPOS) | \
4107e0896b0SHuacai Chen                                          (1U << CP0C6_KE) | \
4117e0896b0SHuacai Chen                                          (1U << CP0C6_VTLBONLY) | \
4127e0896b0SHuacai Chen                                          (1U << CP0C6_LASX) | \
4137e0896b0SHuacai Chen                                          (1U << CP0C6_SSEN) | \
4147e0896b0SHuacai Chen                                          (1U << CP0C6_DISDRTIME) | \
4157e0896b0SHuacai Chen                                          (1U << CP0C6_PIXNUEN) | \
4167e0896b0SHuacai Chen                                          (1U << CP0C6_SCRAND) | \
4177e0896b0SHuacai Chen                                          (1U << CP0C6_LLEXCEN) | \
4187e0896b0SHuacai Chen                                          (1U << CP0C6_DISVC) | \
4197e0896b0SHuacai Chen                                          (1U << CP0C6_VCLRU) | \
4207e0896b0SHuacai Chen                                          (1U << CP0C6_DCLRU) | \
4217e0896b0SHuacai Chen                                          (1U << CP0C6_PIXUEN) | \
4227e0896b0SHuacai Chen                                          (1U << CP0C6_DISBLKLYEN) | \
4237e0896b0SHuacai Chen                                          (1U << CP0C6_UMEMUALEN) | \
4247e0896b0SHuacai Chen                                          (1U << CP0C6_SFBEN) | \
4257e0896b0SHuacai Chen                                          (1U << CP0C6_FLTINT) | \
4267e0896b0SHuacai Chen                                          (1U << CP0C6_VLTINT) | \
4277e0896b0SHuacai Chen                                          (1U << CP0C6_DISBTB) | \
4287e0896b0SHuacai Chen                                          (3U << CP0C6_STPREFCTL) | \
4297e0896b0SHuacai Chen                                          (1U << CP0C6_INSTPREF) | \
4307e0896b0SHuacai Chen                                          (1U << CP0C6_DATAPREF))
43103cbfd7bSJames Hogan 
43203cbfd7bSJames Hogan static inline int kvm_mips_change_one_reg(CPUState *cs, uint64_t reg_id,
43303cbfd7bSJames Hogan                                           int32_t *addr, int32_t mask)
43403cbfd7bSJames Hogan {
43503cbfd7bSJames Hogan     int err;
43603cbfd7bSJames Hogan     int32_t tmp, change;
43703cbfd7bSJames Hogan 
43803cbfd7bSJames Hogan     err = kvm_mips_get_one_reg(cs, reg_id, &tmp);
43903cbfd7bSJames Hogan     if (err < 0) {
44003cbfd7bSJames Hogan         return err;
44103cbfd7bSJames Hogan     }
44203cbfd7bSJames Hogan 
44303cbfd7bSJames Hogan     /* only change bits in mask */
44403cbfd7bSJames Hogan     change = (*addr ^ tmp) & mask;
44503cbfd7bSJames Hogan     if (!change) {
44603cbfd7bSJames Hogan         return 0;
44703cbfd7bSJames Hogan     }
44803cbfd7bSJames Hogan 
44903cbfd7bSJames Hogan     tmp = tmp ^ change;
45003cbfd7bSJames Hogan     return kvm_mips_put_one_reg(cs, reg_id, &tmp);
45103cbfd7bSJames Hogan }
45203cbfd7bSJames Hogan 
453e2132e0bSSanjay Lal /*
454e2132e0bSSanjay Lal  * We freeze the KVM timer when either the VM clock is stopped or the state is
455e2132e0bSSanjay Lal  * saved (the state is dirty).
456e2132e0bSSanjay Lal  */
457e2132e0bSSanjay Lal 
458e2132e0bSSanjay Lal /*
459e2132e0bSSanjay Lal  * Save the state of the KVM timer when VM clock is stopped or state is synced
460e2132e0bSSanjay Lal  * to QEMU.
461e2132e0bSSanjay Lal  */
462e2132e0bSSanjay Lal static int kvm_mips_save_count(CPUState *cs)
463e2132e0bSSanjay Lal {
464e2132e0bSSanjay Lal     MIPSCPU *cpu = MIPS_CPU(cs);
465e2132e0bSSanjay Lal     CPUMIPSState *env = &cpu->env;
466e2132e0bSSanjay Lal     uint64_t count_ctl;
467e2132e0bSSanjay Lal     int err, ret = 0;
468e2132e0bSSanjay Lal 
469e2132e0bSSanjay Lal     /* freeze KVM timer */
470d319f83fSJames Hogan     err = kvm_mips_get_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
471e2132e0bSSanjay Lal     if (err < 0) {
472e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get COUNT_CTL (%d)\n", __func__, err);
473e2132e0bSSanjay Lal         ret = err;
474e2132e0bSSanjay Lal     } else if (!(count_ctl & KVM_REG_MIPS_COUNT_CTL_DC)) {
475e2132e0bSSanjay Lal         count_ctl |= KVM_REG_MIPS_COUNT_CTL_DC;
476d319f83fSJames Hogan         err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
477e2132e0bSSanjay Lal         if (err < 0) {
478e2132e0bSSanjay Lal             DPRINTF("%s: Failed to set COUNT_CTL.DC=1 (%d)\n", __func__, err);
479e2132e0bSSanjay Lal             ret = err;
480e2132e0bSSanjay Lal         }
481e2132e0bSSanjay Lal     }
482e2132e0bSSanjay Lal 
483e2132e0bSSanjay Lal     /* read CP0_Cause */
484e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CAUSE, &env->CP0_Cause);
485e2132e0bSSanjay Lal     if (err < 0) {
486e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_CAUSE (%d)\n", __func__, err);
487e2132e0bSSanjay Lal         ret = err;
488e2132e0bSSanjay Lal     }
489e2132e0bSSanjay Lal 
490e2132e0bSSanjay Lal     /* read CP0_Count */
491e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_COUNT, &env->CP0_Count);
492e2132e0bSSanjay Lal     if (err < 0) {
493e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_COUNT (%d)\n", __func__, err);
494e2132e0bSSanjay Lal         ret = err;
495e2132e0bSSanjay Lal     }
496e2132e0bSSanjay Lal 
497e2132e0bSSanjay Lal     return ret;
498e2132e0bSSanjay Lal }
499e2132e0bSSanjay Lal 
500e2132e0bSSanjay Lal /*
501e2132e0bSSanjay Lal  * Restore the state of the KVM timer when VM clock is restarted or state is
502e2132e0bSSanjay Lal  * synced to KVM.
503e2132e0bSSanjay Lal  */
504e2132e0bSSanjay Lal static int kvm_mips_restore_count(CPUState *cs)
505e2132e0bSSanjay Lal {
506e2132e0bSSanjay Lal     MIPSCPU *cpu = MIPS_CPU(cs);
507e2132e0bSSanjay Lal     CPUMIPSState *env = &cpu->env;
508e2132e0bSSanjay Lal     uint64_t count_ctl;
509e2132e0bSSanjay Lal     int err_dc, err, ret = 0;
510e2132e0bSSanjay Lal 
511e2132e0bSSanjay Lal     /* check the timer is frozen */
512d319f83fSJames Hogan     err_dc = kvm_mips_get_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
513e2132e0bSSanjay Lal     if (err_dc < 0) {
514e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get COUNT_CTL (%d)\n", __func__, err_dc);
515e2132e0bSSanjay Lal         ret = err_dc;
516e2132e0bSSanjay Lal     } else if (!(count_ctl & KVM_REG_MIPS_COUNT_CTL_DC)) {
517e2132e0bSSanjay Lal         /* freeze timer (sets COUNT_RESUME for us) */
518e2132e0bSSanjay Lal         count_ctl |= KVM_REG_MIPS_COUNT_CTL_DC;
519d319f83fSJames Hogan         err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
520e2132e0bSSanjay Lal         if (err < 0) {
521e2132e0bSSanjay Lal             DPRINTF("%s: Failed to set COUNT_CTL.DC=1 (%d)\n", __func__, err);
522e2132e0bSSanjay Lal             ret = err;
523e2132e0bSSanjay Lal         }
524e2132e0bSSanjay Lal     }
525e2132e0bSSanjay Lal 
526e2132e0bSSanjay Lal     /* load CP0_Cause */
527e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_CAUSE, &env->CP0_Cause);
528e2132e0bSSanjay Lal     if (err < 0) {
529e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_CAUSE (%d)\n", __func__, err);
530e2132e0bSSanjay Lal         ret = err;
531e2132e0bSSanjay Lal     }
532e2132e0bSSanjay Lal 
533e2132e0bSSanjay Lal     /* load CP0_Count */
534e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_COUNT, &env->CP0_Count);
535e2132e0bSSanjay Lal     if (err < 0) {
536e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_COUNT (%d)\n", __func__, err);
537e2132e0bSSanjay Lal         ret = err;
538e2132e0bSSanjay Lal     }
539e2132e0bSSanjay Lal 
540e2132e0bSSanjay Lal     /* resume KVM timer */
541e2132e0bSSanjay Lal     if (err_dc >= 0) {
542e2132e0bSSanjay Lal         count_ctl &= ~KVM_REG_MIPS_COUNT_CTL_DC;
543d319f83fSJames Hogan         err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
544e2132e0bSSanjay Lal         if (err < 0) {
545e2132e0bSSanjay Lal             DPRINTF("%s: Failed to set COUNT_CTL.DC=0 (%d)\n", __func__, err);
546e2132e0bSSanjay Lal             ret = err;
547e2132e0bSSanjay Lal         }
548e2132e0bSSanjay Lal     }
549e2132e0bSSanjay Lal 
550e2132e0bSSanjay Lal     return ret;
551e2132e0bSSanjay Lal }
552e2132e0bSSanjay Lal 
553e2132e0bSSanjay Lal /*
554e2132e0bSSanjay Lal  * Handle the VM clock being started or stopped
555e2132e0bSSanjay Lal  */
556e2132e0bSSanjay Lal static void kvm_mips_update_state(void *opaque, int running, RunState state)
557e2132e0bSSanjay Lal {
558e2132e0bSSanjay Lal     CPUState *cs = opaque;
559e2132e0bSSanjay Lal     int ret;
560e2132e0bSSanjay Lal     uint64_t count_resume;
561e2132e0bSSanjay Lal 
562e2132e0bSSanjay Lal     /*
563e2132e0bSSanjay Lal      * If state is already dirty (synced to QEMU) then the KVM timer state is
564e2132e0bSSanjay Lal      * already saved and can be restored when it is synced back to KVM.
565e2132e0bSSanjay Lal      */
566e2132e0bSSanjay Lal     if (!running) {
56799f31832SSergio Andres Gomez Del Real         if (!cs->vcpu_dirty) {
568e2132e0bSSanjay Lal             ret = kvm_mips_save_count(cs);
569e2132e0bSSanjay Lal             if (ret < 0) {
570288cb949SAlistair Francis                 warn_report("Failed saving count");
571e2132e0bSSanjay Lal             }
572e2132e0bSSanjay Lal         }
573e2132e0bSSanjay Lal     } else {
574e2132e0bSSanjay Lal         /* Set clock restore time to now */
575906b53a2SPaolo Bonzini         count_resume = qemu_clock_get_ns(QEMU_CLOCK_REALTIME);
576d319f83fSJames Hogan         ret = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_RESUME,
577e2132e0bSSanjay Lal                                       &count_resume);
578e2132e0bSSanjay Lal         if (ret < 0) {
579288cb949SAlistair Francis             warn_report("Failed setting COUNT_RESUME");
580e2132e0bSSanjay Lal             return;
581e2132e0bSSanjay Lal         }
582e2132e0bSSanjay Lal 
58399f31832SSergio Andres Gomez Del Real         if (!cs->vcpu_dirty) {
584e2132e0bSSanjay Lal             ret = kvm_mips_restore_count(cs);
585e2132e0bSSanjay Lal             if (ret < 0) {
586288cb949SAlistair Francis                 warn_report("Failed restoring count");
587e2132e0bSSanjay Lal             }
588e2132e0bSSanjay Lal         }
589e2132e0bSSanjay Lal     }
590e2132e0bSSanjay Lal }
591e2132e0bSSanjay Lal 
592152db36aSJames Hogan static int kvm_mips_put_fpu_registers(CPUState *cs, int level)
593152db36aSJames Hogan {
594152db36aSJames Hogan     MIPSCPU *cpu = MIPS_CPU(cs);
595152db36aSJames Hogan     CPUMIPSState *env = &cpu->env;
596152db36aSJames Hogan     int err, ret = 0;
597152db36aSJames Hogan     unsigned int i;
598152db36aSJames Hogan 
599152db36aSJames Hogan     /* Only put FPU state if we're emulating a CPU with an FPU */
600152db36aSJames Hogan     if (env->CP0_Config1 & (1 << CP0C1_FP)) {
601152db36aSJames Hogan         /* FPU Control Registers */
602152db36aSJames Hogan         if (level == KVM_PUT_FULL_STATE) {
603152db36aSJames Hogan             err = kvm_mips_put_one_ureg(cs, KVM_REG_MIPS_FCR_IR,
604152db36aSJames Hogan                                         &env->active_fpu.fcr0);
605152db36aSJames Hogan             if (err < 0) {
606152db36aSJames Hogan                 DPRINTF("%s: Failed to put FCR_IR (%d)\n", __func__, err);
607152db36aSJames Hogan                 ret = err;
608152db36aSJames Hogan             }
609152db36aSJames Hogan         }
610152db36aSJames Hogan         err = kvm_mips_put_one_ureg(cs, KVM_REG_MIPS_FCR_CSR,
611152db36aSJames Hogan                                     &env->active_fpu.fcr31);
612152db36aSJames Hogan         if (err < 0) {
613152db36aSJames Hogan             DPRINTF("%s: Failed to put FCR_CSR (%d)\n", __func__, err);
614152db36aSJames Hogan             ret = err;
615152db36aSJames Hogan         }
616152db36aSJames Hogan 
617bee62662SJames Hogan         /*
618bee62662SJames Hogan          * FPU register state is a subset of MSA vector state, so don't put FPU
619bee62662SJames Hogan          * registers if we're emulating a CPU with MSA.
620bee62662SJames Hogan          */
621bee62662SJames Hogan         if (!(env->CP0_Config3 & (1 << CP0C3_MSAP))) {
622152db36aSJames Hogan             /* Floating point registers */
623152db36aSJames Hogan             for (i = 0; i < 32; ++i) {
624152db36aSJames Hogan                 if (env->CP0_Status & (1 << CP0St_FR)) {
625152db36aSJames Hogan                     err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_FPR_64(i),
626152db36aSJames Hogan                                                   &env->active_fpu.fpr[i].d);
627152db36aSJames Hogan                 } else {
628152db36aSJames Hogan                     err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FPR_32(i),
629152db36aSJames Hogan                                     &env->active_fpu.fpr[i].w[FP_ENDIAN_IDX]);
630152db36aSJames Hogan                 }
631152db36aSJames Hogan                 if (err < 0) {
632152db36aSJames Hogan                     DPRINTF("%s: Failed to put FPR%u (%d)\n", __func__, i, err);
633152db36aSJames Hogan                     ret = err;
634152db36aSJames Hogan                 }
635152db36aSJames Hogan             }
636152db36aSJames Hogan         }
637bee62662SJames Hogan     }
638bee62662SJames Hogan 
639bee62662SJames Hogan     /* Only put MSA state if we're emulating a CPU with MSA */
640bee62662SJames Hogan     if (env->CP0_Config3 & (1 << CP0C3_MSAP)) {
641bee62662SJames Hogan         /* MSA Control Registers */
642bee62662SJames Hogan         if (level == KVM_PUT_FULL_STATE) {
643bee62662SJames Hogan             err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_MSA_IR,
644bee62662SJames Hogan                                        &env->msair);
645bee62662SJames Hogan             if (err < 0) {
646bee62662SJames Hogan                 DPRINTF("%s: Failed to put MSA_IR (%d)\n", __func__, err);
647bee62662SJames Hogan                 ret = err;
648bee62662SJames Hogan             }
649bee62662SJames Hogan         }
650bee62662SJames Hogan         err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_MSA_CSR,
651bee62662SJames Hogan                                    &env->active_tc.msacsr);
652bee62662SJames Hogan         if (err < 0) {
653bee62662SJames Hogan             DPRINTF("%s: Failed to put MSA_CSR (%d)\n", __func__, err);
654bee62662SJames Hogan             ret = err;
655bee62662SJames Hogan         }
656bee62662SJames Hogan 
657bee62662SJames Hogan         /* Vector registers (includes FP registers) */
658bee62662SJames Hogan         for (i = 0; i < 32; ++i) {
659bee62662SJames Hogan             /* Big endian MSA not supported by QEMU yet anyway */
660bee62662SJames Hogan             err = kvm_mips_put_one_reg64(cs, KVM_REG_MIPS_VEC_128(i),
661bee62662SJames Hogan                                          env->active_fpu.fpr[i].wr.d);
662bee62662SJames Hogan             if (err < 0) {
663bee62662SJames Hogan                 DPRINTF("%s: Failed to put VEC%u (%d)\n", __func__, i, err);
664bee62662SJames Hogan                 ret = err;
665bee62662SJames Hogan             }
666bee62662SJames Hogan         }
667bee62662SJames Hogan     }
668152db36aSJames Hogan 
669152db36aSJames Hogan     return ret;
670152db36aSJames Hogan }
671152db36aSJames Hogan 
672152db36aSJames Hogan static int kvm_mips_get_fpu_registers(CPUState *cs)
673152db36aSJames Hogan {
674152db36aSJames Hogan     MIPSCPU *cpu = MIPS_CPU(cs);
675152db36aSJames Hogan     CPUMIPSState *env = &cpu->env;
676152db36aSJames Hogan     int err, ret = 0;
677152db36aSJames Hogan     unsigned int i;
678152db36aSJames Hogan 
679152db36aSJames Hogan     /* Only get FPU state if we're emulating a CPU with an FPU */
680152db36aSJames Hogan     if (env->CP0_Config1 & (1 << CP0C1_FP)) {
681152db36aSJames Hogan         /* FPU Control Registers */
682152db36aSJames Hogan         err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FCR_IR,
683152db36aSJames Hogan                                     &env->active_fpu.fcr0);
684152db36aSJames Hogan         if (err < 0) {
685152db36aSJames Hogan             DPRINTF("%s: Failed to get FCR_IR (%d)\n", __func__, err);
686152db36aSJames Hogan             ret = err;
687152db36aSJames Hogan         }
688152db36aSJames Hogan         err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FCR_CSR,
689152db36aSJames Hogan                                     &env->active_fpu.fcr31);
690152db36aSJames Hogan         if (err < 0) {
691152db36aSJames Hogan             DPRINTF("%s: Failed to get FCR_CSR (%d)\n", __func__, err);
692152db36aSJames Hogan             ret = err;
693152db36aSJames Hogan         } else {
694152db36aSJames Hogan             restore_fp_status(env);
695152db36aSJames Hogan         }
696152db36aSJames Hogan 
697bee62662SJames Hogan         /*
698bee62662SJames Hogan          * FPU register state is a subset of MSA vector state, so don't save FPU
699bee62662SJames Hogan          * registers if we're emulating a CPU with MSA.
700bee62662SJames Hogan          */
701bee62662SJames Hogan         if (!(env->CP0_Config3 & (1 << CP0C3_MSAP))) {
702152db36aSJames Hogan             /* Floating point registers */
703152db36aSJames Hogan             for (i = 0; i < 32; ++i) {
704152db36aSJames Hogan                 if (env->CP0_Status & (1 << CP0St_FR)) {
705152db36aSJames Hogan                     err = kvm_mips_get_one_ureg64(cs, KVM_REG_MIPS_FPR_64(i),
706152db36aSJames Hogan                                                   &env->active_fpu.fpr[i].d);
707152db36aSJames Hogan                 } else {
708152db36aSJames Hogan                     err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FPR_32(i),
709152db36aSJames Hogan                                     &env->active_fpu.fpr[i].w[FP_ENDIAN_IDX]);
710152db36aSJames Hogan                 }
711152db36aSJames Hogan                 if (err < 0) {
712152db36aSJames Hogan                     DPRINTF("%s: Failed to get FPR%u (%d)\n", __func__, i, err);
713152db36aSJames Hogan                     ret = err;
714152db36aSJames Hogan                 }
715152db36aSJames Hogan             }
716152db36aSJames Hogan         }
717bee62662SJames Hogan     }
718bee62662SJames Hogan 
719bee62662SJames Hogan     /* Only get MSA state if we're emulating a CPU with MSA */
720bee62662SJames Hogan     if (env->CP0_Config3 & (1 << CP0C3_MSAP)) {
721bee62662SJames Hogan         /* MSA Control Registers */
722bee62662SJames Hogan         err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_MSA_IR,
723bee62662SJames Hogan                                    &env->msair);
724bee62662SJames Hogan         if (err < 0) {
725bee62662SJames Hogan             DPRINTF("%s: Failed to get MSA_IR (%d)\n", __func__, err);
726bee62662SJames Hogan             ret = err;
727bee62662SJames Hogan         }
728bee62662SJames Hogan         err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_MSA_CSR,
729bee62662SJames Hogan                                    &env->active_tc.msacsr);
730bee62662SJames Hogan         if (err < 0) {
731bee62662SJames Hogan             DPRINTF("%s: Failed to get MSA_CSR (%d)\n", __func__, err);
732bee62662SJames Hogan             ret = err;
733bee62662SJames Hogan         } else {
734bee62662SJames Hogan             restore_msa_fp_status(env);
735bee62662SJames Hogan         }
736bee62662SJames Hogan 
737bee62662SJames Hogan         /* Vector registers (includes FP registers) */
738bee62662SJames Hogan         for (i = 0; i < 32; ++i) {
739bee62662SJames Hogan             /* Big endian MSA not supported by QEMU yet anyway */
740bee62662SJames Hogan             err = kvm_mips_get_one_reg64(cs, KVM_REG_MIPS_VEC_128(i),
741bee62662SJames Hogan                                          env->active_fpu.fpr[i].wr.d);
742bee62662SJames Hogan             if (err < 0) {
743bee62662SJames Hogan                 DPRINTF("%s: Failed to get VEC%u (%d)\n", __func__, i, err);
744bee62662SJames Hogan                 ret = err;
745bee62662SJames Hogan             }
746bee62662SJames Hogan         }
747bee62662SJames Hogan     }
748152db36aSJames Hogan 
749152db36aSJames Hogan     return ret;
750152db36aSJames Hogan }
751152db36aSJames Hogan 
752152db36aSJames Hogan 
753e2132e0bSSanjay Lal static int kvm_mips_put_cp0_registers(CPUState *cs, int level)
754e2132e0bSSanjay Lal {
755e2132e0bSSanjay Lal     MIPSCPU *cpu = MIPS_CPU(cs);
756e2132e0bSSanjay Lal     CPUMIPSState *env = &cpu->env;
757e2132e0bSSanjay Lal     int err, ret = 0;
758e2132e0bSSanjay Lal 
759e2132e0bSSanjay Lal     (void)level;
760e2132e0bSSanjay Lal 
761e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_INDEX, &env->CP0_Index);
762e2132e0bSSanjay Lal     if (err < 0) {
763e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_INDEX (%d)\n", __func__, err);
764e2132e0bSSanjay Lal         ret = err;
765e2132e0bSSanjay Lal     }
7667e0896b0SHuacai Chen     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_RANDOM, &env->CP0_Random);
7677e0896b0SHuacai Chen     if (err < 0) {
7687e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_RANDOM (%d)\n", __func__, err);
7697e0896b0SHuacai Chen         ret = err;
7707e0896b0SHuacai Chen     }
771e2132e0bSSanjay Lal     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_CONTEXT,
772e2132e0bSSanjay Lal                                  &env->CP0_Context);
773e2132e0bSSanjay Lal     if (err < 0) {
774e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_CONTEXT (%d)\n", __func__, err);
775e2132e0bSSanjay Lal         ret = err;
776e2132e0bSSanjay Lal     }
777e2132e0bSSanjay Lal     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_USERLOCAL,
778e2132e0bSSanjay Lal                                  &env->active_tc.CP0_UserLocal);
779e2132e0bSSanjay Lal     if (err < 0) {
780e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_USERLOCAL (%d)\n", __func__, err);
781e2132e0bSSanjay Lal         ret = err;
782e2132e0bSSanjay Lal     }
783e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PAGEMASK,
784e2132e0bSSanjay Lal                                &env->CP0_PageMask);
785e2132e0bSSanjay Lal     if (err < 0) {
786e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_PAGEMASK (%d)\n", __func__, err);
787e2132e0bSSanjay Lal         ret = err;
788e2132e0bSSanjay Lal     }
7897e0896b0SHuacai Chen     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PAGEGRAIN,
7907e0896b0SHuacai Chen                                &env->CP0_PageGrain);
7917e0896b0SHuacai Chen     if (err < 0) {
7927e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_PAGEGRAIN (%d)\n", __func__, err);
7937e0896b0SHuacai Chen         ret = err;
7947e0896b0SHuacai Chen     }
7957e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_PWBASE,
7967e0896b0SHuacai Chen                                &env->CP0_PWBase);
7977e0896b0SHuacai Chen     if (err < 0) {
7987e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_PWBASE (%d)\n", __func__, err);
7997e0896b0SHuacai Chen         ret = err;
8007e0896b0SHuacai Chen     }
8017e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_PWFIELD,
8027e0896b0SHuacai Chen                                &env->CP0_PWField);
8037e0896b0SHuacai Chen     if (err < 0) {
8047e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_PWField (%d)\n", __func__, err);
8057e0896b0SHuacai Chen         ret = err;
8067e0896b0SHuacai Chen     }
8077e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_PWSIZE,
8087e0896b0SHuacai Chen                                &env->CP0_PWSize);
8097e0896b0SHuacai Chen     if (err < 0) {
8107e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_PWSIZE (%d)\n", __func__, err);
8117e0896b0SHuacai Chen         ret = err;
8127e0896b0SHuacai Chen     }
813e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_WIRED, &env->CP0_Wired);
814e2132e0bSSanjay Lal     if (err < 0) {
815e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_WIRED (%d)\n", __func__, err);
816e2132e0bSSanjay Lal         ret = err;
817e2132e0bSSanjay Lal     }
8187e0896b0SHuacai Chen     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PWCTL, &env->CP0_PWCtl);
8197e0896b0SHuacai Chen     if (err < 0) {
8207e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_PWCTL (%d)\n", __func__, err);
8217e0896b0SHuacai Chen         ret = err;
8227e0896b0SHuacai Chen     }
823e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_HWRENA, &env->CP0_HWREna);
824e2132e0bSSanjay Lal     if (err < 0) {
825e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_HWRENA (%d)\n", __func__, err);
826e2132e0bSSanjay Lal         ret = err;
827e2132e0bSSanjay Lal     }
828e2132e0bSSanjay Lal     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_BADVADDR,
829e2132e0bSSanjay Lal                                  &env->CP0_BadVAddr);
830e2132e0bSSanjay Lal     if (err < 0) {
831e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_BADVADDR (%d)\n", __func__, err);
832e2132e0bSSanjay Lal         ret = err;
833e2132e0bSSanjay Lal     }
834e2132e0bSSanjay Lal 
835e2132e0bSSanjay Lal     /* If VM clock stopped then state will be restored when it is restarted */
836e2132e0bSSanjay Lal     if (runstate_is_running()) {
837e2132e0bSSanjay Lal         err = kvm_mips_restore_count(cs);
838e2132e0bSSanjay Lal         if (err < 0) {
839e2132e0bSSanjay Lal             ret = err;
840e2132e0bSSanjay Lal         }
841e2132e0bSSanjay Lal     }
842e2132e0bSSanjay Lal 
843e2132e0bSSanjay Lal     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_ENTRYHI,
844e2132e0bSSanjay Lal                                  &env->CP0_EntryHi);
845e2132e0bSSanjay Lal     if (err < 0) {
846e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_ENTRYHI (%d)\n", __func__, err);
847e2132e0bSSanjay Lal         ret = err;
848e2132e0bSSanjay Lal     }
849e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_COMPARE,
850e2132e0bSSanjay Lal                                &env->CP0_Compare);
851e2132e0bSSanjay Lal     if (err < 0) {
852e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_COMPARE (%d)\n", __func__, err);
853e2132e0bSSanjay Lal         ret = err;
854e2132e0bSSanjay Lal     }
855e2132e0bSSanjay Lal     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_STATUS, &env->CP0_Status);
856e2132e0bSSanjay Lal     if (err < 0) {
857e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_STATUS (%d)\n", __func__, err);
858e2132e0bSSanjay Lal         ret = err;
859e2132e0bSSanjay Lal     }
860e2132e0bSSanjay Lal     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_EPC, &env->CP0_EPC);
861e2132e0bSSanjay Lal     if (err < 0) {
862e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_EPC (%d)\n", __func__, err);
863e2132e0bSSanjay Lal         ret = err;
864e2132e0bSSanjay Lal     }
865461a1582SJames Hogan     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PRID, &env->CP0_PRid);
866461a1582SJames Hogan     if (err < 0) {
867461a1582SJames Hogan         DPRINTF("%s: Failed to put CP0_PRID (%d)\n", __func__, err);
868461a1582SJames Hogan         ret = err;
869461a1582SJames Hogan     }
8707e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_EBASE, &env->CP0_EBase);
8717e0896b0SHuacai Chen     if (err < 0) {
8727e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_EBASE (%d)\n", __func__, err);
8737e0896b0SHuacai Chen         ret = err;
8747e0896b0SHuacai Chen     }
87503cbfd7bSJames Hogan     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG,
87603cbfd7bSJames Hogan                                   &env->CP0_Config0,
87703cbfd7bSJames Hogan                                   KVM_REG_MIPS_CP0_CONFIG_MASK);
87803cbfd7bSJames Hogan     if (err < 0) {
87903cbfd7bSJames Hogan         DPRINTF("%s: Failed to change CP0_CONFIG (%d)\n", __func__, err);
88003cbfd7bSJames Hogan         ret = err;
88103cbfd7bSJames Hogan     }
88203cbfd7bSJames Hogan     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG1,
88303cbfd7bSJames Hogan                                   &env->CP0_Config1,
88403cbfd7bSJames Hogan                                   KVM_REG_MIPS_CP0_CONFIG1_MASK);
88503cbfd7bSJames Hogan     if (err < 0) {
88603cbfd7bSJames Hogan         DPRINTF("%s: Failed to change CP0_CONFIG1 (%d)\n", __func__, err);
88703cbfd7bSJames Hogan         ret = err;
88803cbfd7bSJames Hogan     }
88903cbfd7bSJames Hogan     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG2,
89003cbfd7bSJames Hogan                                   &env->CP0_Config2,
89103cbfd7bSJames Hogan                                   KVM_REG_MIPS_CP0_CONFIG2_MASK);
89203cbfd7bSJames Hogan     if (err < 0) {
89303cbfd7bSJames Hogan         DPRINTF("%s: Failed to change CP0_CONFIG2 (%d)\n", __func__, err);
89403cbfd7bSJames Hogan         ret = err;
89503cbfd7bSJames Hogan     }
89603cbfd7bSJames Hogan     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG3,
89703cbfd7bSJames Hogan                                   &env->CP0_Config3,
89803cbfd7bSJames Hogan                                   KVM_REG_MIPS_CP0_CONFIG3_MASK);
89903cbfd7bSJames Hogan     if (err < 0) {
90003cbfd7bSJames Hogan         DPRINTF("%s: Failed to change CP0_CONFIG3 (%d)\n", __func__, err);
90103cbfd7bSJames Hogan         ret = err;
90203cbfd7bSJames Hogan     }
90303cbfd7bSJames Hogan     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG4,
90403cbfd7bSJames Hogan                                   &env->CP0_Config4,
90503cbfd7bSJames Hogan                                   KVM_REG_MIPS_CP0_CONFIG4_MASK);
90603cbfd7bSJames Hogan     if (err < 0) {
90703cbfd7bSJames Hogan         DPRINTF("%s: Failed to change CP0_CONFIG4 (%d)\n", __func__, err);
90803cbfd7bSJames Hogan         ret = err;
90903cbfd7bSJames Hogan     }
91003cbfd7bSJames Hogan     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG5,
91103cbfd7bSJames Hogan                                   &env->CP0_Config5,
91203cbfd7bSJames Hogan                                   KVM_REG_MIPS_CP0_CONFIG5_MASK);
91303cbfd7bSJames Hogan     if (err < 0) {
91403cbfd7bSJames Hogan         DPRINTF("%s: Failed to change CP0_CONFIG5 (%d)\n", __func__, err);
91503cbfd7bSJames Hogan         ret = err;
91603cbfd7bSJames Hogan     }
9177e0896b0SHuacai Chen     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG6,
9187e0896b0SHuacai Chen                                   &env->CP0_Config6,
9197e0896b0SHuacai Chen                                   KVM_REG_MIPS_CP0_CONFIG6_MASK);
9207e0896b0SHuacai Chen     if (err < 0) {
9217e0896b0SHuacai Chen         DPRINTF("%s: Failed to change CP0_CONFIG6 (%d)\n", __func__, err);
9227e0896b0SHuacai Chen         ret = err;
9237e0896b0SHuacai Chen     }
9247e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_XCONTEXT,
9257e0896b0SHuacai Chen                                  &env->CP0_XContext);
9267e0896b0SHuacai Chen     if (err < 0) {
9277e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_XCONTEXT (%d)\n", __func__, err);
9287e0896b0SHuacai Chen         ret = err;
9297e0896b0SHuacai Chen     }
930e2132e0bSSanjay Lal     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_ERROREPC,
931e2132e0bSSanjay Lal                                  &env->CP0_ErrorEPC);
932e2132e0bSSanjay Lal     if (err < 0) {
933e2132e0bSSanjay Lal         DPRINTF("%s: Failed to put CP0_ERROREPC (%d)\n", __func__, err);
934e2132e0bSSanjay Lal         ret = err;
935e2132e0bSSanjay Lal     }
9367e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH1,
9377e0896b0SHuacai Chen                                  &env->CP0_KScratch[0]);
9387e0896b0SHuacai Chen     if (err < 0) {
9397e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_KSCRATCH1 (%d)\n", __func__, err);
9407e0896b0SHuacai Chen         ret = err;
9417e0896b0SHuacai Chen     }
9427e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH2,
9437e0896b0SHuacai Chen                                  &env->CP0_KScratch[1]);
9447e0896b0SHuacai Chen     if (err < 0) {
9457e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_KSCRATCH2 (%d)\n", __func__, err);
9467e0896b0SHuacai Chen         ret = err;
9477e0896b0SHuacai Chen     }
9487e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH3,
9497e0896b0SHuacai Chen                                  &env->CP0_KScratch[2]);
9507e0896b0SHuacai Chen     if (err < 0) {
9517e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_KSCRATCH3 (%d)\n", __func__, err);
9527e0896b0SHuacai Chen         ret = err;
9537e0896b0SHuacai Chen     }
9547e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH4,
9557e0896b0SHuacai Chen                                  &env->CP0_KScratch[3]);
9567e0896b0SHuacai Chen     if (err < 0) {
9577e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_KSCRATCH4 (%d)\n", __func__, err);
9587e0896b0SHuacai Chen         ret = err;
9597e0896b0SHuacai Chen     }
9607e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH5,
9617e0896b0SHuacai Chen                                  &env->CP0_KScratch[4]);
9627e0896b0SHuacai Chen     if (err < 0) {
9637e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_KSCRATCH5 (%d)\n", __func__, err);
9647e0896b0SHuacai Chen         ret = err;
9657e0896b0SHuacai Chen     }
9667e0896b0SHuacai Chen     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH6,
9677e0896b0SHuacai Chen                                  &env->CP0_KScratch[5]);
9687e0896b0SHuacai Chen     if (err < 0) {
9697e0896b0SHuacai Chen         DPRINTF("%s: Failed to put CP0_KSCRATCH6 (%d)\n", __func__, err);
9707e0896b0SHuacai Chen         ret = err;
9717e0896b0SHuacai Chen     }
972e2132e0bSSanjay Lal 
973e2132e0bSSanjay Lal     return ret;
974e2132e0bSSanjay Lal }
975e2132e0bSSanjay Lal 
976e2132e0bSSanjay Lal static int kvm_mips_get_cp0_registers(CPUState *cs)
977e2132e0bSSanjay Lal {
978e2132e0bSSanjay Lal     MIPSCPU *cpu = MIPS_CPU(cs);
979e2132e0bSSanjay Lal     CPUMIPSState *env = &cpu->env;
980e2132e0bSSanjay Lal     int err, ret = 0;
981e2132e0bSSanjay Lal 
982e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_INDEX, &env->CP0_Index);
983e2132e0bSSanjay Lal     if (err < 0) {
984e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_INDEX (%d)\n", __func__, err);
985e2132e0bSSanjay Lal         ret = err;
986e2132e0bSSanjay Lal     }
9877e0896b0SHuacai Chen     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_RANDOM, &env->CP0_Random);
9887e0896b0SHuacai Chen     if (err < 0) {
9897e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_RANDOM (%d)\n", __func__, err);
9907e0896b0SHuacai Chen         ret = err;
9917e0896b0SHuacai Chen     }
992e2132e0bSSanjay Lal     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_CONTEXT,
993e2132e0bSSanjay Lal                                  &env->CP0_Context);
994e2132e0bSSanjay Lal     if (err < 0) {
995e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_CONTEXT (%d)\n", __func__, err);
996e2132e0bSSanjay Lal         ret = err;
997e2132e0bSSanjay Lal     }
998e2132e0bSSanjay Lal     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_USERLOCAL,
999e2132e0bSSanjay Lal                                  &env->active_tc.CP0_UserLocal);
1000e2132e0bSSanjay Lal     if (err < 0) {
1001e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_USERLOCAL (%d)\n", __func__, err);
1002e2132e0bSSanjay Lal         ret = err;
1003e2132e0bSSanjay Lal     }
1004e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PAGEMASK,
1005e2132e0bSSanjay Lal                                &env->CP0_PageMask);
1006e2132e0bSSanjay Lal     if (err < 0) {
1007e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_PAGEMASK (%d)\n", __func__, err);
1008e2132e0bSSanjay Lal         ret = err;
1009e2132e0bSSanjay Lal     }
10107e0896b0SHuacai Chen     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PAGEGRAIN,
10117e0896b0SHuacai Chen                                &env->CP0_PageGrain);
10127e0896b0SHuacai Chen     if (err < 0) {
10137e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_PAGEGRAIN (%d)\n", __func__, err);
10147e0896b0SHuacai Chen         ret = err;
10157e0896b0SHuacai Chen     }
10167e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_PWBASE,
10177e0896b0SHuacai Chen                                &env->CP0_PWBase);
10187e0896b0SHuacai Chen     if (err < 0) {
10197e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_PWBASE (%d)\n", __func__, err);
10207e0896b0SHuacai Chen         ret = err;
10217e0896b0SHuacai Chen     }
10227e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_PWFIELD,
10237e0896b0SHuacai Chen                                &env->CP0_PWField);
10247e0896b0SHuacai Chen     if (err < 0) {
10257e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_PWFIELD (%d)\n", __func__, err);
10267e0896b0SHuacai Chen         ret = err;
10277e0896b0SHuacai Chen     }
10287e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_PWSIZE,
10297e0896b0SHuacai Chen                                &env->CP0_PWSize);
10307e0896b0SHuacai Chen     if (err < 0) {
10317e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_PWSIZE (%d)\n", __func__, err);
10327e0896b0SHuacai Chen         ret = err;
10337e0896b0SHuacai Chen     }
1034e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_WIRED, &env->CP0_Wired);
1035e2132e0bSSanjay Lal     if (err < 0) {
1036e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_WIRED (%d)\n", __func__, err);
1037e2132e0bSSanjay Lal         ret = err;
1038e2132e0bSSanjay Lal     }
10397e0896b0SHuacai Chen     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PWCTL, &env->CP0_PWCtl);
10407e0896b0SHuacai Chen     if (err < 0) {
10417e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_PWCtl (%d)\n", __func__, err);
10427e0896b0SHuacai Chen         ret = err;
10437e0896b0SHuacai Chen     }
1044e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_HWRENA, &env->CP0_HWREna);
1045e2132e0bSSanjay Lal     if (err < 0) {
1046e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_HWRENA (%d)\n", __func__, err);
1047e2132e0bSSanjay Lal         ret = err;
1048e2132e0bSSanjay Lal     }
1049e2132e0bSSanjay Lal     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_BADVADDR,
1050e2132e0bSSanjay Lal                                  &env->CP0_BadVAddr);
1051e2132e0bSSanjay Lal     if (err < 0) {
1052e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_BADVADDR (%d)\n", __func__, err);
1053e2132e0bSSanjay Lal         ret = err;
1054e2132e0bSSanjay Lal     }
1055e2132e0bSSanjay Lal     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_ENTRYHI,
1056e2132e0bSSanjay Lal                                  &env->CP0_EntryHi);
1057e2132e0bSSanjay Lal     if (err < 0) {
1058e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_ENTRYHI (%d)\n", __func__, err);
1059e2132e0bSSanjay Lal         ret = err;
1060e2132e0bSSanjay Lal     }
1061e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_COMPARE,
1062e2132e0bSSanjay Lal                                &env->CP0_Compare);
1063e2132e0bSSanjay Lal     if (err < 0) {
1064e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_COMPARE (%d)\n", __func__, err);
1065e2132e0bSSanjay Lal         ret = err;
1066e2132e0bSSanjay Lal     }
1067e2132e0bSSanjay Lal     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_STATUS, &env->CP0_Status);
1068e2132e0bSSanjay Lal     if (err < 0) {
1069e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_STATUS (%d)\n", __func__, err);
1070e2132e0bSSanjay Lal         ret = err;
1071e2132e0bSSanjay Lal     }
1072e2132e0bSSanjay Lal 
1073e2132e0bSSanjay Lal     /* If VM clock stopped then state was already saved when it was stopped */
1074e2132e0bSSanjay Lal     if (runstate_is_running()) {
1075e2132e0bSSanjay Lal         err = kvm_mips_save_count(cs);
1076e2132e0bSSanjay Lal         if (err < 0) {
1077e2132e0bSSanjay Lal             ret = err;
1078e2132e0bSSanjay Lal         }
1079e2132e0bSSanjay Lal     }
1080e2132e0bSSanjay Lal 
1081e2132e0bSSanjay Lal     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_EPC, &env->CP0_EPC);
1082e2132e0bSSanjay Lal     if (err < 0) {
1083e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_EPC (%d)\n", __func__, err);
1084e2132e0bSSanjay Lal         ret = err;
1085e2132e0bSSanjay Lal     }
1086461a1582SJames Hogan     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PRID, &env->CP0_PRid);
1087461a1582SJames Hogan     if (err < 0) {
1088461a1582SJames Hogan         DPRINTF("%s: Failed to get CP0_PRID (%d)\n", __func__, err);
1089461a1582SJames Hogan         ret = err;
1090461a1582SJames Hogan     }
10917e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_EBASE, &env->CP0_EBase);
10927e0896b0SHuacai Chen     if (err < 0) {
10937e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_EBASE (%d)\n", __func__, err);
10947e0896b0SHuacai Chen         ret = err;
10957e0896b0SHuacai Chen     }
109603cbfd7bSJames Hogan     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG, &env->CP0_Config0);
109703cbfd7bSJames Hogan     if (err < 0) {
109803cbfd7bSJames Hogan         DPRINTF("%s: Failed to get CP0_CONFIG (%d)\n", __func__, err);
109903cbfd7bSJames Hogan         ret = err;
110003cbfd7bSJames Hogan     }
110103cbfd7bSJames Hogan     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG1, &env->CP0_Config1);
110203cbfd7bSJames Hogan     if (err < 0) {
110303cbfd7bSJames Hogan         DPRINTF("%s: Failed to get CP0_CONFIG1 (%d)\n", __func__, err);
110403cbfd7bSJames Hogan         ret = err;
110503cbfd7bSJames Hogan     }
110603cbfd7bSJames Hogan     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG2, &env->CP0_Config2);
110703cbfd7bSJames Hogan     if (err < 0) {
110803cbfd7bSJames Hogan         DPRINTF("%s: Failed to get CP0_CONFIG2 (%d)\n", __func__, err);
110903cbfd7bSJames Hogan         ret = err;
111003cbfd7bSJames Hogan     }
111103cbfd7bSJames Hogan     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG3, &env->CP0_Config3);
111203cbfd7bSJames Hogan     if (err < 0) {
111303cbfd7bSJames Hogan         DPRINTF("%s: Failed to get CP0_CONFIG3 (%d)\n", __func__, err);
111403cbfd7bSJames Hogan         ret = err;
111503cbfd7bSJames Hogan     }
111603cbfd7bSJames Hogan     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG4, &env->CP0_Config4);
111703cbfd7bSJames Hogan     if (err < 0) {
111803cbfd7bSJames Hogan         DPRINTF("%s: Failed to get CP0_CONFIG4 (%d)\n", __func__, err);
111903cbfd7bSJames Hogan         ret = err;
112003cbfd7bSJames Hogan     }
112103cbfd7bSJames Hogan     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG5, &env->CP0_Config5);
112203cbfd7bSJames Hogan     if (err < 0) {
112303cbfd7bSJames Hogan         DPRINTF("%s: Failed to get CP0_CONFIG5 (%d)\n", __func__, err);
112403cbfd7bSJames Hogan         ret = err;
112503cbfd7bSJames Hogan     }
11267e0896b0SHuacai Chen     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG6, &env->CP0_Config6);
11277e0896b0SHuacai Chen     if (err < 0) {
11287e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_CONFIG6 (%d)\n", __func__, err);
11297e0896b0SHuacai Chen         ret = err;
11307e0896b0SHuacai Chen     }
11317e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_XCONTEXT,
11327e0896b0SHuacai Chen                                  &env->CP0_XContext);
11337e0896b0SHuacai Chen     if (err < 0) {
11347e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_XCONTEXT (%d)\n", __func__, err);
11357e0896b0SHuacai Chen         ret = err;
11367e0896b0SHuacai Chen     }
1137e2132e0bSSanjay Lal     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_ERROREPC,
1138e2132e0bSSanjay Lal                                  &env->CP0_ErrorEPC);
1139e2132e0bSSanjay Lal     if (err < 0) {
1140e2132e0bSSanjay Lal         DPRINTF("%s: Failed to get CP0_ERROREPC (%d)\n", __func__, err);
1141e2132e0bSSanjay Lal         ret = err;
1142e2132e0bSSanjay Lal     }
11437e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH1,
11447e0896b0SHuacai Chen                                  &env->CP0_KScratch[0]);
11457e0896b0SHuacai Chen     if (err < 0) {
11467e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_KSCRATCH1 (%d)\n", __func__, err);
11477e0896b0SHuacai Chen         ret = err;
11487e0896b0SHuacai Chen     }
11497e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH2,
11507e0896b0SHuacai Chen                                  &env->CP0_KScratch[1]);
11517e0896b0SHuacai Chen     if (err < 0) {
11527e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_KSCRATCH2 (%d)\n", __func__, err);
11537e0896b0SHuacai Chen         ret = err;
11547e0896b0SHuacai Chen     }
11557e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH3,
11567e0896b0SHuacai Chen                                  &env->CP0_KScratch[2]);
11577e0896b0SHuacai Chen     if (err < 0) {
11587e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_KSCRATCH3 (%d)\n", __func__, err);
11597e0896b0SHuacai Chen         ret = err;
11607e0896b0SHuacai Chen     }
11617e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH4,
11627e0896b0SHuacai Chen                                  &env->CP0_KScratch[3]);
11637e0896b0SHuacai Chen     if (err < 0) {
11647e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_KSCRATCH4 (%d)\n", __func__, err);
11657e0896b0SHuacai Chen         ret = err;
11667e0896b0SHuacai Chen     }
11677e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH5,
11687e0896b0SHuacai Chen                                  &env->CP0_KScratch[4]);
11697e0896b0SHuacai Chen     if (err < 0) {
11707e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_KSCRATCH5 (%d)\n", __func__, err);
11717e0896b0SHuacai Chen         ret = err;
11727e0896b0SHuacai Chen     }
11737e0896b0SHuacai Chen     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH6,
11747e0896b0SHuacai Chen                                  &env->CP0_KScratch[5]);
11757e0896b0SHuacai Chen     if (err < 0) {
11767e0896b0SHuacai Chen         DPRINTF("%s: Failed to get CP0_KSCRATCH6 (%d)\n", __func__, err);
11777e0896b0SHuacai Chen         ret = err;
11787e0896b0SHuacai Chen     }
1179e2132e0bSSanjay Lal 
1180e2132e0bSSanjay Lal     return ret;
1181e2132e0bSSanjay Lal }
1182e2132e0bSSanjay Lal 
1183e2132e0bSSanjay Lal int kvm_arch_put_registers(CPUState *cs, int level)
1184e2132e0bSSanjay Lal {
1185e2132e0bSSanjay Lal     MIPSCPU *cpu = MIPS_CPU(cs);
1186e2132e0bSSanjay Lal     CPUMIPSState *env = &cpu->env;
1187e2132e0bSSanjay Lal     struct kvm_regs regs;
1188e2132e0bSSanjay Lal     int ret;
1189e2132e0bSSanjay Lal     int i;
1190e2132e0bSSanjay Lal 
1191e2132e0bSSanjay Lal     /* Set the registers based on QEMU's view of things */
1192e2132e0bSSanjay Lal     for (i = 0; i < 32; i++) {
119302dae26aSJames Hogan         regs.gpr[i] = (int64_t)(target_long)env->active_tc.gpr[i];
1194e2132e0bSSanjay Lal     }
1195e2132e0bSSanjay Lal 
119602dae26aSJames Hogan     regs.hi = (int64_t)(target_long)env->active_tc.HI[0];
119702dae26aSJames Hogan     regs.lo = (int64_t)(target_long)env->active_tc.LO[0];
119802dae26aSJames Hogan     regs.pc = (int64_t)(target_long)env->active_tc.PC;
1199e2132e0bSSanjay Lal 
1200e2132e0bSSanjay Lal     ret = kvm_vcpu_ioctl(cs, KVM_SET_REGS, &regs);
1201e2132e0bSSanjay Lal 
1202e2132e0bSSanjay Lal     if (ret < 0) {
1203e2132e0bSSanjay Lal         return ret;
1204e2132e0bSSanjay Lal     }
1205e2132e0bSSanjay Lal 
1206e2132e0bSSanjay Lal     ret = kvm_mips_put_cp0_registers(cs, level);
1207e2132e0bSSanjay Lal     if (ret < 0) {
1208e2132e0bSSanjay Lal         return ret;
1209e2132e0bSSanjay Lal     }
1210e2132e0bSSanjay Lal 
1211152db36aSJames Hogan     ret = kvm_mips_put_fpu_registers(cs, level);
1212152db36aSJames Hogan     if (ret < 0) {
1213152db36aSJames Hogan         return ret;
1214152db36aSJames Hogan     }
1215152db36aSJames Hogan 
1216e2132e0bSSanjay Lal     return ret;
1217e2132e0bSSanjay Lal }
1218e2132e0bSSanjay Lal 
1219e2132e0bSSanjay Lal int kvm_arch_get_registers(CPUState *cs)
1220e2132e0bSSanjay Lal {
1221e2132e0bSSanjay Lal     MIPSCPU *cpu = MIPS_CPU(cs);
1222e2132e0bSSanjay Lal     CPUMIPSState *env = &cpu->env;
1223e2132e0bSSanjay Lal     int ret = 0;
1224e2132e0bSSanjay Lal     struct kvm_regs regs;
1225e2132e0bSSanjay Lal     int i;
1226e2132e0bSSanjay Lal 
1227e2132e0bSSanjay Lal     /* Get the current register set as KVM seems it */
1228e2132e0bSSanjay Lal     ret = kvm_vcpu_ioctl(cs, KVM_GET_REGS, &regs);
1229e2132e0bSSanjay Lal 
1230e2132e0bSSanjay Lal     if (ret < 0) {
1231e2132e0bSSanjay Lal         return ret;
1232e2132e0bSSanjay Lal     }
1233e2132e0bSSanjay Lal 
1234e2132e0bSSanjay Lal     for (i = 0; i < 32; i++) {
1235e2132e0bSSanjay Lal         env->active_tc.gpr[i] = regs.gpr[i];
1236e2132e0bSSanjay Lal     }
1237e2132e0bSSanjay Lal 
1238e2132e0bSSanjay Lal     env->active_tc.HI[0] = regs.hi;
1239e2132e0bSSanjay Lal     env->active_tc.LO[0] = regs.lo;
1240e2132e0bSSanjay Lal     env->active_tc.PC = regs.pc;
1241e2132e0bSSanjay Lal 
1242e2132e0bSSanjay Lal     kvm_mips_get_cp0_registers(cs);
1243152db36aSJames Hogan     kvm_mips_get_fpu_registers(cs);
1244e2132e0bSSanjay Lal 
1245e2132e0bSSanjay Lal     return ret;
1246e2132e0bSSanjay Lal }
12479e03a040SFrank Blaschka 
12489e03a040SFrank Blaschka int kvm_arch_fixup_msi_route(struct kvm_irq_routing_entry *route,
1249dc9f06caSPavel Fedin                              uint64_t address, uint32_t data, PCIDevice *dev)
12509e03a040SFrank Blaschka {
12519e03a040SFrank Blaschka     return 0;
12529e03a040SFrank Blaschka }
12531850b6b7SEric Auger 
125438d87493SPeter Xu int kvm_arch_add_msi_route_post(struct kvm_irq_routing_entry *route,
125538d87493SPeter Xu                                 int vector, PCIDevice *dev)
125638d87493SPeter Xu {
125738d87493SPeter Xu     return 0;
125838d87493SPeter Xu }
125938d87493SPeter Xu 
126038d87493SPeter Xu int kvm_arch_release_virq_post(int virq)
126138d87493SPeter Xu {
126238d87493SPeter Xu     return 0;
126338d87493SPeter Xu }
126438d87493SPeter Xu 
12651850b6b7SEric Auger int kvm_arch_msi_data_to_gsi(uint32_t data)
12661850b6b7SEric Auger {
12671850b6b7SEric Auger     abort();
12681850b6b7SEric Auger }
1269719d109bSHuacai Chen 
1270719d109bSHuacai Chen int mips_kvm_type(MachineState *machine, const char *vm_type)
1271719d109bSHuacai Chen {
1272719d109bSHuacai Chen #if defined(KVM_CAP_MIPS_VZ) || defined(KVM_CAP_MIPS_TE)
1273719d109bSHuacai Chen     int r;
1274719d109bSHuacai Chen     KVMState *s = KVM_STATE(machine->accelerator);
1275719d109bSHuacai Chen #endif
1276719d109bSHuacai Chen 
1277719d109bSHuacai Chen #if defined(KVM_CAP_MIPS_VZ)
1278719d109bSHuacai Chen     r = kvm_check_extension(s, KVM_CAP_MIPS_VZ);
1279719d109bSHuacai Chen     if (r > 0) {
1280719d109bSHuacai Chen         return KVM_VM_MIPS_VZ;
1281719d109bSHuacai Chen     }
1282719d109bSHuacai Chen #endif
1283719d109bSHuacai Chen 
1284719d109bSHuacai Chen #if defined(KVM_CAP_MIPS_TE)
1285719d109bSHuacai Chen     r = kvm_check_extension(s, KVM_CAP_MIPS_TE);
1286719d109bSHuacai Chen     if (r > 0) {
1287719d109bSHuacai Chen         return KVM_VM_MIPS_TE;
1288719d109bSHuacai Chen     }
1289719d109bSHuacai Chen #endif
1290719d109bSHuacai Chen 
1291719d109bSHuacai Chen     return -1;
1292719d109bSHuacai Chen }
1293