xref: /openbmc/qemu/target/arm/machine.c (revision 0e1a46bbd2d6c39614b87f4e88ea305acce8a35f)
1 #include "qemu/osdep.h"
2 #include "qemu-common.h"
3 #include "cpu.h"
4 #include "hw/hw.h"
5 #include "hw/boards.h"
6 #include "qemu/error-report.h"
7 #include "sysemu/kvm.h"
8 #include "kvm_arm.h"
9 #include "internals.h"
10 #include "migration/cpu.h"
11 
12 static bool vfp_needed(void *opaque)
13 {
14     ARMCPU *cpu = opaque;
15     CPUARMState *env = &cpu->env;
16 
17     return arm_feature(env, ARM_FEATURE_VFP);
18 }
19 
20 static int get_fpscr(QEMUFile *f, void *opaque, size_t size,
21                      VMStateField *field)
22 {
23     ARMCPU *cpu = opaque;
24     CPUARMState *env = &cpu->env;
25     uint32_t val = qemu_get_be32(f);
26 
27     vfp_set_fpscr(env, val);
28     return 0;
29 }
30 
31 static int put_fpscr(QEMUFile *f, void *opaque, size_t size,
32                      VMStateField *field, QJSON *vmdesc)
33 {
34     ARMCPU *cpu = opaque;
35     CPUARMState *env = &cpu->env;
36 
37     qemu_put_be32(f, vfp_get_fpscr(env));
38     return 0;
39 }
40 
41 static const VMStateInfo vmstate_fpscr = {
42     .name = "fpscr",
43     .get = get_fpscr,
44     .put = put_fpscr,
45 };
46 
47 static const VMStateDescription vmstate_vfp = {
48     .name = "cpu/vfp",
49     .version_id = 3,
50     .minimum_version_id = 3,
51     .needed = vfp_needed,
52     .fields = (VMStateField[]) {
53         VMSTATE_FLOAT64_ARRAY(env.vfp.regs, ARMCPU, 64),
54         /* The xregs array is a little awkward because element 1 (FPSCR)
55          * requires a specific accessor, so we have to split it up in
56          * the vmstate:
57          */
58         VMSTATE_UINT32(env.vfp.xregs[0], ARMCPU),
59         VMSTATE_UINT32_SUB_ARRAY(env.vfp.xregs, ARMCPU, 2, 14),
60         {
61             .name = "fpscr",
62             .version_id = 0,
63             .size = sizeof(uint32_t),
64             .info = &vmstate_fpscr,
65             .flags = VMS_SINGLE,
66             .offset = 0,
67         },
68         VMSTATE_END_OF_LIST()
69     }
70 };
71 
72 static bool iwmmxt_needed(void *opaque)
73 {
74     ARMCPU *cpu = opaque;
75     CPUARMState *env = &cpu->env;
76 
77     return arm_feature(env, ARM_FEATURE_IWMMXT);
78 }
79 
80 static const VMStateDescription vmstate_iwmmxt = {
81     .name = "cpu/iwmmxt",
82     .version_id = 1,
83     .minimum_version_id = 1,
84     .needed = iwmmxt_needed,
85     .fields = (VMStateField[]) {
86         VMSTATE_UINT64_ARRAY(env.iwmmxt.regs, ARMCPU, 16),
87         VMSTATE_UINT32_ARRAY(env.iwmmxt.cregs, ARMCPU, 16),
88         VMSTATE_END_OF_LIST()
89     }
90 };
91 
92 static bool m_needed(void *opaque)
93 {
94     ARMCPU *cpu = opaque;
95     CPUARMState *env = &cpu->env;
96 
97     return arm_feature(env, ARM_FEATURE_M);
98 }
99 
100 static const VMStateDescription vmstate_m_faultmask_primask = {
101     .name = "cpu/m/faultmask-primask",
102     .version_id = 1,
103     .minimum_version_id = 1,
104     .fields = (VMStateField[]) {
105         VMSTATE_UINT32(env.v7m.faultmask, ARMCPU),
106         VMSTATE_UINT32(env.v7m.primask, ARMCPU),
107         VMSTATE_END_OF_LIST()
108     }
109 };
110 
111 static const VMStateDescription vmstate_m = {
112     .name = "cpu/m",
113     .version_id = 4,
114     .minimum_version_id = 4,
115     .needed = m_needed,
116     .fields = (VMStateField[]) {
117         VMSTATE_UINT32(env.v7m.vecbase, ARMCPU),
118         VMSTATE_UINT32(env.v7m.basepri, ARMCPU),
119         VMSTATE_UINT32(env.v7m.control, ARMCPU),
120         VMSTATE_UINT32(env.v7m.ccr, ARMCPU),
121         VMSTATE_UINT32(env.v7m.cfsr, ARMCPU),
122         VMSTATE_UINT32(env.v7m.hfsr, ARMCPU),
123         VMSTATE_UINT32(env.v7m.dfsr, ARMCPU),
124         VMSTATE_UINT32(env.v7m.mmfar, ARMCPU),
125         VMSTATE_UINT32(env.v7m.bfar, ARMCPU),
126         VMSTATE_UINT32(env.v7m.mpu_ctrl, ARMCPU),
127         VMSTATE_INT32(env.v7m.exception, ARMCPU),
128         VMSTATE_END_OF_LIST()
129     },
130     .subsections = (const VMStateDescription*[]) {
131         &vmstate_m_faultmask_primask,
132         NULL
133     }
134 };
135 
136 static bool thumb2ee_needed(void *opaque)
137 {
138     ARMCPU *cpu = opaque;
139     CPUARMState *env = &cpu->env;
140 
141     return arm_feature(env, ARM_FEATURE_THUMB2EE);
142 }
143 
144 static const VMStateDescription vmstate_thumb2ee = {
145     .name = "cpu/thumb2ee",
146     .version_id = 1,
147     .minimum_version_id = 1,
148     .needed = thumb2ee_needed,
149     .fields = (VMStateField[]) {
150         VMSTATE_UINT32(env.teecr, ARMCPU),
151         VMSTATE_UINT32(env.teehbr, ARMCPU),
152         VMSTATE_END_OF_LIST()
153     }
154 };
155 
156 static bool pmsav7_needed(void *opaque)
157 {
158     ARMCPU *cpu = opaque;
159     CPUARMState *env = &cpu->env;
160 
161     return arm_feature(env, ARM_FEATURE_PMSA) &&
162            arm_feature(env, ARM_FEATURE_V7) &&
163            !arm_feature(env, ARM_FEATURE_V8);
164 }
165 
166 static bool pmsav7_rgnr_vmstate_validate(void *opaque, int version_id)
167 {
168     ARMCPU *cpu = opaque;
169 
170     return cpu->env.pmsav7.rnr < cpu->pmsav7_dregion;
171 }
172 
173 static const VMStateDescription vmstate_pmsav7 = {
174     .name = "cpu/pmsav7",
175     .version_id = 1,
176     .minimum_version_id = 1,
177     .needed = pmsav7_needed,
178     .fields = (VMStateField[]) {
179         VMSTATE_VARRAY_UINT32(env.pmsav7.drbar, ARMCPU, pmsav7_dregion, 0,
180                               vmstate_info_uint32, uint32_t),
181         VMSTATE_VARRAY_UINT32(env.pmsav7.drsr, ARMCPU, pmsav7_dregion, 0,
182                               vmstate_info_uint32, uint32_t),
183         VMSTATE_VARRAY_UINT32(env.pmsav7.dracr, ARMCPU, pmsav7_dregion, 0,
184                               vmstate_info_uint32, uint32_t),
185         VMSTATE_VALIDATE("rgnr is valid", pmsav7_rgnr_vmstate_validate),
186         VMSTATE_END_OF_LIST()
187     }
188 };
189 
190 static bool pmsav7_rnr_needed(void *opaque)
191 {
192     ARMCPU *cpu = opaque;
193     CPUARMState *env = &cpu->env;
194 
195     /* For R profile cores pmsav7.rnr is migrated via the cpreg
196      * "RGNR" definition in helper.h. For M profile we have to
197      * migrate it separately.
198      */
199     return arm_feature(env, ARM_FEATURE_M);
200 }
201 
202 static const VMStateDescription vmstate_pmsav7_rnr = {
203     .name = "cpu/pmsav7-rnr",
204     .version_id = 1,
205     .minimum_version_id = 1,
206     .needed = pmsav7_rnr_needed,
207     .fields = (VMStateField[]) {
208         VMSTATE_UINT32(env.pmsav7.rnr, ARMCPU),
209         VMSTATE_END_OF_LIST()
210     }
211 };
212 
213 static bool pmsav8_needed(void *opaque)
214 {
215     ARMCPU *cpu = opaque;
216     CPUARMState *env = &cpu->env;
217 
218     return arm_feature(env, ARM_FEATURE_PMSA) &&
219         arm_feature(env, ARM_FEATURE_V8);
220 }
221 
222 static const VMStateDescription vmstate_pmsav8 = {
223     .name = "cpu/pmsav8",
224     .version_id = 1,
225     .minimum_version_id = 1,
226     .needed = pmsav8_needed,
227     .fields = (VMStateField[]) {
228         VMSTATE_VARRAY_UINT32(env.pmsav8.rbar, ARMCPU, pmsav7_dregion, 0,
229                               vmstate_info_uint32, uint32_t),
230         VMSTATE_VARRAY_UINT32(env.pmsav8.rlar, ARMCPU, pmsav7_dregion, 0,
231                               vmstate_info_uint32, uint32_t),
232         VMSTATE_UINT32(env.pmsav8.mair0, ARMCPU),
233         VMSTATE_UINT32(env.pmsav8.mair1, ARMCPU),
234         VMSTATE_END_OF_LIST()
235     }
236 };
237 
238 static int get_cpsr(QEMUFile *f, void *opaque, size_t size,
239                     VMStateField *field)
240 {
241     ARMCPU *cpu = opaque;
242     CPUARMState *env = &cpu->env;
243     uint32_t val = qemu_get_be32(f);
244 
245     if (arm_feature(env, ARM_FEATURE_M)) {
246         if (val & XPSR_EXCP) {
247             /* This is a CPSR format value from an older QEMU. (We can tell
248              * because values transferred in XPSR format always have zero
249              * for the EXCP field, and CPSR format will always have bit 4
250              * set in CPSR_M.) Rearrange it into XPSR format. The significant
251              * differences are that the T bit is not in the same place, the
252              * primask/faultmask info may be in the CPSR I and F bits, and
253              * we do not want the mode bits.
254              */
255             uint32_t newval = val;
256 
257             newval &= (CPSR_NZCV | CPSR_Q | CPSR_IT | CPSR_GE);
258             if (val & CPSR_T) {
259                 newval |= XPSR_T;
260             }
261             /* If the I or F bits are set then this is a migration from
262              * an old QEMU which still stored the M profile FAULTMASK
263              * and PRIMASK in env->daif. For a new QEMU, the data is
264              * transferred using the vmstate_m_faultmask_primask subsection.
265              */
266             if (val & CPSR_F) {
267                 env->v7m.faultmask = 1;
268             }
269             if (val & CPSR_I) {
270                 env->v7m.primask = 1;
271             }
272             val = newval;
273         }
274         /* Ignore the low bits, they are handled by vmstate_m. */
275         xpsr_write(env, val, ~XPSR_EXCP);
276         return 0;
277     }
278 
279     env->aarch64 = ((val & PSTATE_nRW) == 0);
280 
281     if (is_a64(env)) {
282         pstate_write(env, val);
283         return 0;
284     }
285 
286     cpsr_write(env, val, 0xffffffff, CPSRWriteRaw);
287     return 0;
288 }
289 
290 static int put_cpsr(QEMUFile *f, void *opaque, size_t size,
291                     VMStateField *field, QJSON *vmdesc)
292 {
293     ARMCPU *cpu = opaque;
294     CPUARMState *env = &cpu->env;
295     uint32_t val;
296 
297     if (arm_feature(env, ARM_FEATURE_M)) {
298         /* The low 9 bits are v7m.exception, which is handled by vmstate_m. */
299         val = xpsr_read(env) & ~XPSR_EXCP;
300     } else if (is_a64(env)) {
301         val = pstate_read(env);
302     } else {
303         val = cpsr_read(env);
304     }
305 
306     qemu_put_be32(f, val);
307     return 0;
308 }
309 
310 static const VMStateInfo vmstate_cpsr = {
311     .name = "cpsr",
312     .get = get_cpsr,
313     .put = put_cpsr,
314 };
315 
316 static int get_power(QEMUFile *f, void *opaque, size_t size,
317                     VMStateField *field)
318 {
319     ARMCPU *cpu = opaque;
320     bool powered_off = qemu_get_byte(f);
321     cpu->power_state = powered_off ? PSCI_OFF : PSCI_ON;
322     return 0;
323 }
324 
325 static int put_power(QEMUFile *f, void *opaque, size_t size,
326                     VMStateField *field, QJSON *vmdesc)
327 {
328     ARMCPU *cpu = opaque;
329 
330     /* Migration should never happen while we transition power states */
331 
332     if (cpu->power_state == PSCI_ON ||
333         cpu->power_state == PSCI_OFF) {
334         bool powered_off = (cpu->power_state == PSCI_OFF) ? true : false;
335         qemu_put_byte(f, powered_off);
336         return 0;
337     } else {
338         return 1;
339     }
340 }
341 
342 static const VMStateInfo vmstate_powered_off = {
343     .name = "powered_off",
344     .get = get_power,
345     .put = put_power,
346 };
347 
348 static void cpu_pre_save(void *opaque)
349 {
350     ARMCPU *cpu = opaque;
351 
352     if (kvm_enabled()) {
353         if (!write_kvmstate_to_list(cpu)) {
354             /* This should never fail */
355             abort();
356         }
357     } else {
358         if (!write_cpustate_to_list(cpu)) {
359             /* This should never fail. */
360             abort();
361         }
362     }
363 
364     cpu->cpreg_vmstate_array_len = cpu->cpreg_array_len;
365     memcpy(cpu->cpreg_vmstate_indexes, cpu->cpreg_indexes,
366            cpu->cpreg_array_len * sizeof(uint64_t));
367     memcpy(cpu->cpreg_vmstate_values, cpu->cpreg_values,
368            cpu->cpreg_array_len * sizeof(uint64_t));
369 }
370 
371 static int cpu_post_load(void *opaque, int version_id)
372 {
373     ARMCPU *cpu = opaque;
374     int i, v;
375 
376     /* Update the values list from the incoming migration data.
377      * Anything in the incoming data which we don't know about is
378      * a migration failure; anything we know about but the incoming
379      * data doesn't specify retains its current (reset) value.
380      * The indexes list remains untouched -- we only inspect the
381      * incoming migration index list so we can match the values array
382      * entries with the right slots in our own values array.
383      */
384 
385     for (i = 0, v = 0; i < cpu->cpreg_array_len
386              && v < cpu->cpreg_vmstate_array_len; i++) {
387         if (cpu->cpreg_vmstate_indexes[v] > cpu->cpreg_indexes[i]) {
388             /* register in our list but not incoming : skip it */
389             continue;
390         }
391         if (cpu->cpreg_vmstate_indexes[v] < cpu->cpreg_indexes[i]) {
392             /* register in their list but not ours: fail migration */
393             return -1;
394         }
395         /* matching register, copy the value over */
396         cpu->cpreg_values[i] = cpu->cpreg_vmstate_values[v];
397         v++;
398     }
399 
400     if (kvm_enabled()) {
401         if (!write_list_to_kvmstate(cpu, KVM_PUT_FULL_STATE)) {
402             return -1;
403         }
404         /* Note that it's OK for the TCG side not to know about
405          * every register in the list; KVM is authoritative if
406          * we're using it.
407          */
408         write_list_to_cpustate(cpu);
409     } else {
410         if (!write_list_to_cpustate(cpu)) {
411             return -1;
412         }
413     }
414 
415     hw_breakpoint_update_all(cpu);
416     hw_watchpoint_update_all(cpu);
417 
418     return 0;
419 }
420 
421 const VMStateDescription vmstate_arm_cpu = {
422     .name = "cpu",
423     .version_id = 22,
424     .minimum_version_id = 22,
425     .pre_save = cpu_pre_save,
426     .post_load = cpu_post_load,
427     .fields = (VMStateField[]) {
428         VMSTATE_UINT32_ARRAY(env.regs, ARMCPU, 16),
429         VMSTATE_UINT64_ARRAY(env.xregs, ARMCPU, 32),
430         VMSTATE_UINT64(env.pc, ARMCPU),
431         {
432             .name = "cpsr",
433             .version_id = 0,
434             .size = sizeof(uint32_t),
435             .info = &vmstate_cpsr,
436             .flags = VMS_SINGLE,
437             .offset = 0,
438         },
439         VMSTATE_UINT32(env.spsr, ARMCPU),
440         VMSTATE_UINT64_ARRAY(env.banked_spsr, ARMCPU, 8),
441         VMSTATE_UINT32_ARRAY(env.banked_r13, ARMCPU, 8),
442         VMSTATE_UINT32_ARRAY(env.banked_r14, ARMCPU, 8),
443         VMSTATE_UINT32_ARRAY(env.usr_regs, ARMCPU, 5),
444         VMSTATE_UINT32_ARRAY(env.fiq_regs, ARMCPU, 5),
445         VMSTATE_UINT64_ARRAY(env.elr_el, ARMCPU, 4),
446         VMSTATE_UINT64_ARRAY(env.sp_el, ARMCPU, 4),
447         /* The length-check must come before the arrays to avoid
448          * incoming data possibly overflowing the array.
449          */
450         VMSTATE_INT32_POSITIVE_LE(cpreg_vmstate_array_len, ARMCPU),
451         VMSTATE_VARRAY_INT32(cpreg_vmstate_indexes, ARMCPU,
452                              cpreg_vmstate_array_len,
453                              0, vmstate_info_uint64, uint64_t),
454         VMSTATE_VARRAY_INT32(cpreg_vmstate_values, ARMCPU,
455                              cpreg_vmstate_array_len,
456                              0, vmstate_info_uint64, uint64_t),
457         VMSTATE_UINT64(env.exclusive_addr, ARMCPU),
458         VMSTATE_UINT64(env.exclusive_val, ARMCPU),
459         VMSTATE_UINT64(env.exclusive_high, ARMCPU),
460         VMSTATE_UINT64(env.features, ARMCPU),
461         VMSTATE_UINT32(env.exception.syndrome, ARMCPU),
462         VMSTATE_UINT32(env.exception.fsr, ARMCPU),
463         VMSTATE_UINT64(env.exception.vaddress, ARMCPU),
464         VMSTATE_TIMER_PTR(gt_timer[GTIMER_PHYS], ARMCPU),
465         VMSTATE_TIMER_PTR(gt_timer[GTIMER_VIRT], ARMCPU),
466         {
467             .name = "power_state",
468             .version_id = 0,
469             .size = sizeof(bool),
470             .info = &vmstate_powered_off,
471             .flags = VMS_SINGLE,
472             .offset = 0,
473         },
474         VMSTATE_END_OF_LIST()
475     },
476     .subsections = (const VMStateDescription*[]) {
477         &vmstate_vfp,
478         &vmstate_iwmmxt,
479         &vmstate_m,
480         &vmstate_thumb2ee,
481         /* pmsav7_rnr must come before pmsav7 so that we have the
482          * region number before we test it in the VMSTATE_VALIDATE
483          * in vmstate_pmsav7.
484          */
485         &vmstate_pmsav7_rnr,
486         &vmstate_pmsav7,
487         &vmstate_pmsav8,
488         NULL
489     }
490 };
491