xref: /openbmc/qemu/target/arm/machine.c (revision dd873966)
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[M_REG_NS], ARMCPU),
106         VMSTATE_UINT32(env.v7m.primask[M_REG_NS], 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[M_REG_NS], ARMCPU),
118         VMSTATE_UINT32(env.v7m.basepri[M_REG_NS], ARMCPU),
119         VMSTATE_UINT32(env.v7m.control[M_REG_NS], ARMCPU),
120         VMSTATE_UINT32(env.v7m.ccr[M_REG_NS], ARMCPU),
121         VMSTATE_UINT32(env.v7m.cfsr[M_REG_NS], ARMCPU),
122         VMSTATE_UINT32(env.v7m.hfsr, ARMCPU),
123         VMSTATE_UINT32(env.v7m.dfsr, ARMCPU),
124         VMSTATE_UINT32(env.v7m.mmfar[M_REG_NS], ARMCPU),
125         VMSTATE_UINT32(env.v7m.bfar, ARMCPU),
126         VMSTATE_UINT32(env.v7m.mpu_ctrl[M_REG_NS], 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[M_REG_NS] < 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[M_REG_NS], 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[M_REG_NS], ARMCPU, pmsav7_dregion,
229                               0, vmstate_info_uint32, uint32_t),
230         VMSTATE_VARRAY_UINT32(env.pmsav8.rlar[M_REG_NS], ARMCPU, pmsav7_dregion,
231                               0, vmstate_info_uint32, uint32_t),
232         VMSTATE_UINT32(env.pmsav8.mair0[M_REG_NS], ARMCPU),
233         VMSTATE_UINT32(env.pmsav8.mair1[M_REG_NS], ARMCPU),
234         VMSTATE_END_OF_LIST()
235     }
236 };
237 
238 static bool s_rnr_vmstate_validate(void *opaque, int version_id)
239 {
240     ARMCPU *cpu = opaque;
241 
242     return cpu->env.pmsav7.rnr[M_REG_S] < cpu->pmsav7_dregion;
243 }
244 
245 static bool sau_rnr_vmstate_validate(void *opaque, int version_id)
246 {
247     ARMCPU *cpu = opaque;
248 
249     return cpu->env.sau.rnr < cpu->sau_sregion;
250 }
251 
252 static bool m_security_needed(void *opaque)
253 {
254     ARMCPU *cpu = opaque;
255     CPUARMState *env = &cpu->env;
256 
257     return arm_feature(env, ARM_FEATURE_M_SECURITY);
258 }
259 
260 static const VMStateDescription vmstate_m_security = {
261     .name = "cpu/m-security",
262     .version_id = 1,
263     .minimum_version_id = 1,
264     .needed = m_security_needed,
265     .fields = (VMStateField[]) {
266         VMSTATE_UINT32(env.v7m.secure, ARMCPU),
267         VMSTATE_UINT32(env.v7m.other_ss_msp, ARMCPU),
268         VMSTATE_UINT32(env.v7m.other_ss_psp, ARMCPU),
269         VMSTATE_UINT32(env.v7m.basepri[M_REG_S], ARMCPU),
270         VMSTATE_UINT32(env.v7m.primask[M_REG_S], ARMCPU),
271         VMSTATE_UINT32(env.v7m.faultmask[M_REG_S], ARMCPU),
272         VMSTATE_UINT32(env.v7m.control[M_REG_S], ARMCPU),
273         VMSTATE_UINT32(env.v7m.vecbase[M_REG_S], ARMCPU),
274         VMSTATE_UINT32(env.pmsav8.mair0[M_REG_S], ARMCPU),
275         VMSTATE_UINT32(env.pmsav8.mair1[M_REG_S], ARMCPU),
276         VMSTATE_VARRAY_UINT32(env.pmsav8.rbar[M_REG_S], ARMCPU, pmsav7_dregion,
277                               0, vmstate_info_uint32, uint32_t),
278         VMSTATE_VARRAY_UINT32(env.pmsav8.rlar[M_REG_S], ARMCPU, pmsav7_dregion,
279                               0, vmstate_info_uint32, uint32_t),
280         VMSTATE_UINT32(env.pmsav7.rnr[M_REG_S], ARMCPU),
281         VMSTATE_VALIDATE("secure MPU_RNR is valid", s_rnr_vmstate_validate),
282         VMSTATE_UINT32(env.v7m.mpu_ctrl[M_REG_S], ARMCPU),
283         VMSTATE_UINT32(env.v7m.ccr[M_REG_S], ARMCPU),
284         VMSTATE_UINT32(env.v7m.mmfar[M_REG_S], ARMCPU),
285         VMSTATE_UINT32(env.v7m.cfsr[M_REG_S], ARMCPU),
286         VMSTATE_UINT32(env.v7m.sfsr, ARMCPU),
287         VMSTATE_UINT32(env.v7m.sfar, ARMCPU),
288         VMSTATE_VARRAY_UINT32(env.sau.rbar, ARMCPU, sau_sregion, 0,
289                               vmstate_info_uint32, uint32_t),
290         VMSTATE_VARRAY_UINT32(env.sau.rlar, ARMCPU, sau_sregion, 0,
291                               vmstate_info_uint32, uint32_t),
292         VMSTATE_UINT32(env.sau.rnr, ARMCPU),
293         VMSTATE_VALIDATE("SAU_RNR is valid", sau_rnr_vmstate_validate),
294         VMSTATE_UINT32(env.sau.ctrl, ARMCPU),
295         VMSTATE_END_OF_LIST()
296     }
297 };
298 
299 static int get_cpsr(QEMUFile *f, void *opaque, size_t size,
300                     VMStateField *field)
301 {
302     ARMCPU *cpu = opaque;
303     CPUARMState *env = &cpu->env;
304     uint32_t val = qemu_get_be32(f);
305 
306     if (arm_feature(env, ARM_FEATURE_M)) {
307         if (val & XPSR_EXCP) {
308             /* This is a CPSR format value from an older QEMU. (We can tell
309              * because values transferred in XPSR format always have zero
310              * for the EXCP field, and CPSR format will always have bit 4
311              * set in CPSR_M.) Rearrange it into XPSR format. The significant
312              * differences are that the T bit is not in the same place, the
313              * primask/faultmask info may be in the CPSR I and F bits, and
314              * we do not want the mode bits.
315              * We know that this cleanup happened before v8M, so there
316              * is no complication with banked primask/faultmask.
317              */
318             uint32_t newval = val;
319 
320             assert(!arm_feature(env, ARM_FEATURE_M_SECURITY));
321 
322             newval &= (CPSR_NZCV | CPSR_Q | CPSR_IT | CPSR_GE);
323             if (val & CPSR_T) {
324                 newval |= XPSR_T;
325             }
326             /* If the I or F bits are set then this is a migration from
327              * an old QEMU which still stored the M profile FAULTMASK
328              * and PRIMASK in env->daif. For a new QEMU, the data is
329              * transferred using the vmstate_m_faultmask_primask subsection.
330              */
331             if (val & CPSR_F) {
332                 env->v7m.faultmask[M_REG_NS] = 1;
333             }
334             if (val & CPSR_I) {
335                 env->v7m.primask[M_REG_NS] = 1;
336             }
337             val = newval;
338         }
339         /* Ignore the low bits, they are handled by vmstate_m. */
340         xpsr_write(env, val, ~XPSR_EXCP);
341         return 0;
342     }
343 
344     env->aarch64 = ((val & PSTATE_nRW) == 0);
345 
346     if (is_a64(env)) {
347         pstate_write(env, val);
348         return 0;
349     }
350 
351     cpsr_write(env, val, 0xffffffff, CPSRWriteRaw);
352     return 0;
353 }
354 
355 static int put_cpsr(QEMUFile *f, void *opaque, size_t size,
356                     VMStateField *field, QJSON *vmdesc)
357 {
358     ARMCPU *cpu = opaque;
359     CPUARMState *env = &cpu->env;
360     uint32_t val;
361 
362     if (arm_feature(env, ARM_FEATURE_M)) {
363         /* The low 9 bits are v7m.exception, which is handled by vmstate_m. */
364         val = xpsr_read(env) & ~XPSR_EXCP;
365     } else if (is_a64(env)) {
366         val = pstate_read(env);
367     } else {
368         val = cpsr_read(env);
369     }
370 
371     qemu_put_be32(f, val);
372     return 0;
373 }
374 
375 static const VMStateInfo vmstate_cpsr = {
376     .name = "cpsr",
377     .get = get_cpsr,
378     .put = put_cpsr,
379 };
380 
381 static int get_power(QEMUFile *f, void *opaque, size_t size,
382                     VMStateField *field)
383 {
384     ARMCPU *cpu = opaque;
385     bool powered_off = qemu_get_byte(f);
386     cpu->power_state = powered_off ? PSCI_OFF : PSCI_ON;
387     return 0;
388 }
389 
390 static int put_power(QEMUFile *f, void *opaque, size_t size,
391                     VMStateField *field, QJSON *vmdesc)
392 {
393     ARMCPU *cpu = opaque;
394 
395     /* Migration should never happen while we transition power states */
396 
397     if (cpu->power_state == PSCI_ON ||
398         cpu->power_state == PSCI_OFF) {
399         bool powered_off = (cpu->power_state == PSCI_OFF) ? true : false;
400         qemu_put_byte(f, powered_off);
401         return 0;
402     } else {
403         return 1;
404     }
405 }
406 
407 static const VMStateInfo vmstate_powered_off = {
408     .name = "powered_off",
409     .get = get_power,
410     .put = put_power,
411 };
412 
413 static int cpu_pre_save(void *opaque)
414 {
415     ARMCPU *cpu = opaque;
416 
417     if (kvm_enabled()) {
418         if (!write_kvmstate_to_list(cpu)) {
419             /* This should never fail */
420             abort();
421         }
422     } else {
423         if (!write_cpustate_to_list(cpu)) {
424             /* This should never fail. */
425             abort();
426         }
427     }
428 
429     cpu->cpreg_vmstate_array_len = cpu->cpreg_array_len;
430     memcpy(cpu->cpreg_vmstate_indexes, cpu->cpreg_indexes,
431            cpu->cpreg_array_len * sizeof(uint64_t));
432     memcpy(cpu->cpreg_vmstate_values, cpu->cpreg_values,
433            cpu->cpreg_array_len * sizeof(uint64_t));
434 
435     return 0;
436 }
437 
438 static int cpu_post_load(void *opaque, int version_id)
439 {
440     ARMCPU *cpu = opaque;
441     int i, v;
442 
443     /* Update the values list from the incoming migration data.
444      * Anything in the incoming data which we don't know about is
445      * a migration failure; anything we know about but the incoming
446      * data doesn't specify retains its current (reset) value.
447      * The indexes list remains untouched -- we only inspect the
448      * incoming migration index list so we can match the values array
449      * entries with the right slots in our own values array.
450      */
451 
452     for (i = 0, v = 0; i < cpu->cpreg_array_len
453              && v < cpu->cpreg_vmstate_array_len; i++) {
454         if (cpu->cpreg_vmstate_indexes[v] > cpu->cpreg_indexes[i]) {
455             /* register in our list but not incoming : skip it */
456             continue;
457         }
458         if (cpu->cpreg_vmstate_indexes[v] < cpu->cpreg_indexes[i]) {
459             /* register in their list but not ours: fail migration */
460             return -1;
461         }
462         /* matching register, copy the value over */
463         cpu->cpreg_values[i] = cpu->cpreg_vmstate_values[v];
464         v++;
465     }
466 
467     if (kvm_enabled()) {
468         if (!write_list_to_kvmstate(cpu, KVM_PUT_FULL_STATE)) {
469             return -1;
470         }
471         /* Note that it's OK for the TCG side not to know about
472          * every register in the list; KVM is authoritative if
473          * we're using it.
474          */
475         write_list_to_cpustate(cpu);
476     } else {
477         if (!write_list_to_cpustate(cpu)) {
478             return -1;
479         }
480     }
481 
482     hw_breakpoint_update_all(cpu);
483     hw_watchpoint_update_all(cpu);
484 
485     return 0;
486 }
487 
488 const VMStateDescription vmstate_arm_cpu = {
489     .name = "cpu",
490     .version_id = 22,
491     .minimum_version_id = 22,
492     .pre_save = cpu_pre_save,
493     .post_load = cpu_post_load,
494     .fields = (VMStateField[]) {
495         VMSTATE_UINT32_ARRAY(env.regs, ARMCPU, 16),
496         VMSTATE_UINT64_ARRAY(env.xregs, ARMCPU, 32),
497         VMSTATE_UINT64(env.pc, ARMCPU),
498         {
499             .name = "cpsr",
500             .version_id = 0,
501             .size = sizeof(uint32_t),
502             .info = &vmstate_cpsr,
503             .flags = VMS_SINGLE,
504             .offset = 0,
505         },
506         VMSTATE_UINT32(env.spsr, ARMCPU),
507         VMSTATE_UINT64_ARRAY(env.banked_spsr, ARMCPU, 8),
508         VMSTATE_UINT32_ARRAY(env.banked_r13, ARMCPU, 8),
509         VMSTATE_UINT32_ARRAY(env.banked_r14, ARMCPU, 8),
510         VMSTATE_UINT32_ARRAY(env.usr_regs, ARMCPU, 5),
511         VMSTATE_UINT32_ARRAY(env.fiq_regs, ARMCPU, 5),
512         VMSTATE_UINT64_ARRAY(env.elr_el, ARMCPU, 4),
513         VMSTATE_UINT64_ARRAY(env.sp_el, ARMCPU, 4),
514         /* The length-check must come before the arrays to avoid
515          * incoming data possibly overflowing the array.
516          */
517         VMSTATE_INT32_POSITIVE_LE(cpreg_vmstate_array_len, ARMCPU),
518         VMSTATE_VARRAY_INT32(cpreg_vmstate_indexes, ARMCPU,
519                              cpreg_vmstate_array_len,
520                              0, vmstate_info_uint64, uint64_t),
521         VMSTATE_VARRAY_INT32(cpreg_vmstate_values, ARMCPU,
522                              cpreg_vmstate_array_len,
523                              0, vmstate_info_uint64, uint64_t),
524         VMSTATE_UINT64(env.exclusive_addr, ARMCPU),
525         VMSTATE_UINT64(env.exclusive_val, ARMCPU),
526         VMSTATE_UINT64(env.exclusive_high, ARMCPU),
527         VMSTATE_UINT64(env.features, ARMCPU),
528         VMSTATE_UINT32(env.exception.syndrome, ARMCPU),
529         VMSTATE_UINT32(env.exception.fsr, ARMCPU),
530         VMSTATE_UINT64(env.exception.vaddress, ARMCPU),
531         VMSTATE_TIMER_PTR(gt_timer[GTIMER_PHYS], ARMCPU),
532         VMSTATE_TIMER_PTR(gt_timer[GTIMER_VIRT], ARMCPU),
533         {
534             .name = "power_state",
535             .version_id = 0,
536             .size = sizeof(bool),
537             .info = &vmstate_powered_off,
538             .flags = VMS_SINGLE,
539             .offset = 0,
540         },
541         VMSTATE_END_OF_LIST()
542     },
543     .subsections = (const VMStateDescription*[]) {
544         &vmstate_vfp,
545         &vmstate_iwmmxt,
546         &vmstate_m,
547         &vmstate_thumb2ee,
548         /* pmsav7_rnr must come before pmsav7 so that we have the
549          * region number before we test it in the VMSTATE_VALIDATE
550          * in vmstate_pmsav7.
551          */
552         &vmstate_pmsav7_rnr,
553         &vmstate_pmsav7,
554         &vmstate_pmsav8,
555         &vmstate_m_security,
556         NULL
557     }
558 };
559