2 * Jailhouse, a Linux-based partitioning hypervisor
4 * Copyright (c) Siemens AG, 2013
5 * Copyright (c) Valentine Sinitsyn, 2014
8 * Jan Kiszka <jan.kiszka@siemens.com>
9 * Valentine Sinitsyn <valentine.sinitsyn@gmail.com>
11 * Based on vmx.c written by Jan Kiszka.
13 * This work is licensed under the terms of the GNU GPL, version 2. See
14 * the COPYING file in the top-level directory.
17 #include <jailhouse/entry.h>
18 #include <jailhouse/cell-config.h>
19 #include <jailhouse/control.h>
20 #include <jailhouse/paging.h>
21 #include <jailhouse/printk.h>
22 #include <jailhouse/processor.h>
23 #include <jailhouse/string.h>
24 #include <jailhouse/utils.h>
27 #include <asm/control.h>
28 #include <asm/iommu.h>
29 #include <asm/paging.h>
30 #include <asm/percpu.h>
31 #include <asm/processor.h>
36 * NW bit is ignored by all modern processors, however some
37 * combinations of NW and CD bits are prohibited by SVM (see APMv2,
38 * Sect. 15.5). To handle this, we always keep the NW bit off.
40 #define SVM_CR0_ALLOWED_BITS (~X86_CR0_NW)
42 #define MTRR_DEFTYPE 0x2ff
44 static bool has_avic, has_assists, has_flush_by_asid;
46 static const struct segment invalid_seg;
48 static struct paging npt_paging[NPT_PAGE_DIR_LEVELS];
50 /* bit cleared: direct access allowed */
51 // TODO: convert to whitelist
52 static u8 __attribute__((aligned(PAGE_SIZE))) msrpm[][0x2000/4] = {
53 [ SVM_MSRPM_0000 ] = {
54 [ 0/4 ... 0x017/4 ] = 0,
55 [ 0x018/4 ... 0x01b/4 ] = 0x80, /* 0x01b (w) */
56 [ 0x01c/4 ... 0x273/4 ] = 0,
57 [ 0x274/4 ... 0x277/4 ] = 0xc0, /* 0x277 (rw) */
58 [ 0x278/4 ... 0x2fb/4 ] = 0,
59 [ 0x2fc/4 ... 0x2ff/4 ] = 0x80, /* 0x2ff (w) */
60 [ 0x300/4 ... 0x7ff/4 ] = 0,
61 /* x2APIC MSRs - emulated if not present */
62 [ 0x800/4 ... 0x803/4 ] = 0x90, /* 0x802 (r), 0x803 (r) */
63 [ 0x804/4 ... 0x807/4 ] = 0,
64 [ 0x808/4 ... 0x80b/4 ] = 0x93, /* 0x808 (rw), 0x80a (r), 0x80b (w) */
65 [ 0x80c/4 ... 0x80f/4 ] = 0xc8, /* 0x80d (w), 0x80f (rw) */
66 [ 0x810/4 ... 0x813/4 ] = 0x55, /* 0x810 - 0x813 (r) */
67 [ 0x814/4 ... 0x817/4 ] = 0x55, /* 0x814 - 0x817 (r) */
68 [ 0x818/4 ... 0x81b/4 ] = 0x55, /* 0x818 - 0x81b (r) */
69 [ 0x81c/4 ... 0x81f/4 ] = 0x55, /* 0x81c - 0x81f (r) */
70 [ 0x820/4 ... 0x823/4 ] = 0x55, /* 0x820 - 0x823 (r) */
71 [ 0x824/4 ... 0x827/4 ] = 0x55, /* 0x823 - 0x827 (r) */
72 [ 0x828/4 ... 0x82b/4 ] = 0x03, /* 0x828 (rw) */
73 [ 0x82c/4 ... 0x82f/4 ] = 0xc0, /* 0x82f (rw) */
74 [ 0x830/4 ... 0x833/4 ] = 0xf3, /* 0x830 (rw), 0x832 (rw), 0x833 (rw) */
75 [ 0x834/4 ... 0x837/4 ] = 0xff, /* 0x834 - 0x837 (rw) */
76 [ 0x838/4 ... 0x83b/4 ] = 0x07, /* 0x838 (rw), 0x839 (r) */
77 [ 0x83c/4 ... 0x83f/4 ] = 0x70, /* 0x83e (rw), 0x83f (r) */
78 [ 0x840/4 ... 0x1fff/4 ] = 0,
80 [ SVM_MSRPM_C000 ] = {
81 [ 0/4 ... 0x07f/4 ] = 0,
82 [ 0x080/4 ... 0x083/4 ] = 0x02, /* 0x080 (w) */
83 [ 0x084/4 ... 0x1fff/4 ] = 0
85 [ SVM_MSRPM_C001 ] = {
86 [ 0/4 ... 0x1fff/4 ] = 0,
88 [ SVM_MSRPM_RESV ] = {
89 [ 0/4 ... 0x1fff/4 ] = 0,
93 /* This page is mapped so the code begins at 0x000ffff0 */
94 static u8 __attribute__((aligned(PAGE_SIZE))) parking_code[PAGE_SIZE] = {
95 [0xff0] = 0xfa, /* 1: cli */
96 [0xff1] = 0xf4, /* hlt */
98 [0xff3] = 0xfc /* jmp 1b */
101 static void *parked_mode_npt;
103 static void *avic_page;
105 static int svm_check_features(void)
107 /* SVM is available */
108 if (!(cpuid_ecx(0x80000001) & X86_FEATURE_SVM))
109 return trace_error(-ENODEV);
112 if (!(cpuid_edx(0x8000000A) & X86_FEATURE_NP))
113 return trace_error(-EIO);
116 if ((cpuid_edx(0x8000000A) & X86_FEATURE_DECODE_ASSISTS))
120 if (cpuid_edx(0x8000000A) & X86_FEATURE_AVIC)
123 /* TLB Flush by ASID support */
124 if (cpuid_edx(0x8000000A) & X86_FEATURE_FLUSH_BY_ASID)
125 has_flush_by_asid = true;
130 static void set_svm_segment_from_dtr(struct svm_segment *svm_segment,
131 const struct desc_table_reg *dtr)
133 struct svm_segment tmp = { 0 };
136 tmp.base = dtr->base;
137 tmp.limit = dtr->limit & 0xffff;
143 /* TODO: struct segment needs to be x86 generic, not VMX-specific one here */
144 static void set_svm_segment_from_segment(struct svm_segment *svm_segment,
145 const struct segment *segment)
149 svm_segment->selector = segment->selector;
151 if (segment->access_rights == 0x10000) {
152 svm_segment->access_rights = 0;
154 ar = segment->access_rights;
155 svm_segment->access_rights =
156 ((ar & 0xf000) >> 4) | (ar & 0x00ff);
159 svm_segment->limit = segment->limit;
160 svm_segment->base = segment->base;
163 static bool svm_set_cell_config(struct cell *cell, struct vmcb *vmcb)
165 /* No real need for this function; used for consistency with vmx.c */
166 vmcb->iopm_base_pa = paging_hvirt2phys(cell->svm.iopm);
167 vmcb->n_cr3 = paging_hvirt2phys(cell->svm.npt_structs.root_table);
172 static int vmcb_setup(struct per_cpu *cpu_data)
174 struct vmcb *vmcb = &cpu_data->vmcb;
176 memset(vmcb, 0, sizeof(struct vmcb));
178 vmcb->cr0 = cpu_data->linux_cr0 & SVM_CR0_ALLOWED_BITS;
179 vmcb->cr3 = cpu_data->linux_cr3;
180 vmcb->cr4 = cpu_data->linux_cr4;
182 set_svm_segment_from_segment(&vmcb->cs, &cpu_data->linux_cs);
183 set_svm_segment_from_segment(&vmcb->ds, &cpu_data->linux_ds);
184 set_svm_segment_from_segment(&vmcb->es, &cpu_data->linux_es);
185 set_svm_segment_from_segment(&vmcb->fs, &cpu_data->linux_fs);
186 set_svm_segment_from_segment(&vmcb->gs, &cpu_data->linux_gs);
187 set_svm_segment_from_segment(&vmcb->ss, &invalid_seg);
188 set_svm_segment_from_segment(&vmcb->tr, &cpu_data->linux_tss);
190 set_svm_segment_from_dtr(&vmcb->ldtr, NULL);
191 set_svm_segment_from_dtr(&vmcb->gdtr, &cpu_data->linux_gdtr);
192 set_svm_segment_from_dtr(&vmcb->idtr, &cpu_data->linux_idtr);
194 vmcb->cpl = 0; /* Linux runs in ring 0 before migration */
197 /* Indicate success to the caller of arch_entry */
199 vmcb->rsp = cpu_data->linux_sp +
200 (NUM_ENTRY_REGS + 1) * sizeof(unsigned long);
201 vmcb->rip = cpu_data->linux_ip;
203 vmcb->sysenter_cs = read_msr(MSR_IA32_SYSENTER_CS);
204 vmcb->sysenter_eip = read_msr(MSR_IA32_SYSENTER_EIP);
205 vmcb->sysenter_esp = read_msr(MSR_IA32_SYSENTER_ESP);
206 vmcb->star = read_msr(MSR_STAR);
207 vmcb->lstar = read_msr(MSR_LSTAR);
208 vmcb->cstar = read_msr(MSR_CSTAR);
209 vmcb->sfmask = read_msr(MSR_SFMASK);
210 vmcb->kerngsbase = read_msr(MSR_KERNGS_BASE);
212 vmcb->dr6 = 0x00000ff0;
213 vmcb->dr7 = 0x00000400;
215 /* Make the hypervisor visible */
216 vmcb->efer = (cpu_data->linux_efer | EFER_SVME);
218 vmcb->g_pat = cpu_data->pat;
220 vmcb->general1_intercepts |= GENERAL1_INTERCEPT_NMI;
221 vmcb->general1_intercepts |= GENERAL1_INTERCEPT_CR0_SEL_WRITE;
222 /* TODO: Do we need this for SVM ? */
223 /* vmcb->general1_intercepts |= GENERAL1_INTERCEPT_CPUID; */
224 vmcb->general1_intercepts |= GENERAL1_INTERCEPT_IOIO_PROT;
225 vmcb->general1_intercepts |= GENERAL1_INTERCEPT_MSR_PROT;
226 vmcb->general1_intercepts |= GENERAL1_INTERCEPT_SHUTDOWN_EVT;
228 vmcb->general2_intercepts |= GENERAL2_INTERCEPT_VMRUN; /* Required */
229 vmcb->general2_intercepts |= GENERAL2_INTERCEPT_VMMCALL;
231 vmcb->msrpm_base_pa = paging_hvirt2phys(msrpm);
234 /* No more than one guest owns the CPU */
235 vmcb->guest_asid = 1;
237 /* TODO: Setup AVIC */
239 /* Explicitly mark all of the state as new */
240 vmcb->clean_bits = 0;
242 return svm_set_cell_config(cpu_data->cell, vmcb);
245 unsigned long arch_paging_gphys2phys(struct per_cpu *cpu_data,
249 return paging_virt2phys(&cpu_data->cell->svm.npt_structs,
253 static void npt_set_next_pt(pt_entry_t pte, unsigned long next_pt)
255 /* See APMv2, Section 15.25.5 */
256 *pte = (next_pt & 0x000ffffffffff000UL) |
257 (PAGE_DEFAULT_FLAGS | PAGE_FLAG_US);
260 int vcpu_vendor_init(void)
262 struct paging_structures parking_pt;
266 err = svm_check_features();
270 vm_cr = read_msr(MSR_VM_CR);
271 if (vm_cr & VM_CR_SVMDIS)
272 /* SVM disabled in BIOS */
273 return trace_error(-EPERM);
275 /* Nested paging is the same as the native one */
276 memcpy(npt_paging, x86_64_paging, sizeof(npt_paging));
277 for (n = 0; n < NPT_PAGE_DIR_LEVELS; n++)
278 npt_paging[n].set_next_pt = npt_set_next_pt;
280 /* Map guest parking code (shared between cells and CPUs) */
281 parking_pt.root_paging = npt_paging;
282 parking_pt.root_table = parked_mode_npt = page_alloc(&mem_pool, 1);
283 if (!parked_mode_npt)
285 err = paging_create(&parking_pt, paging_hvirt2phys(parking_code),
286 PAGE_SIZE, 0x000ff000,
287 PAGE_READONLY_FLAGS | PAGE_FLAG_US,
288 PAGING_NON_COHERENT);
292 /* This is always false for AMD now (except in nested SVM);
293 see Sect. 16.3.1 in APMv2 */
295 /* allow direct x2APIC access except for ICR writes */
296 memset(&msrpm[SVM_MSRPM_0000][MSR_X2APIC_BASE/4], 0,
297 (MSR_X2APIC_END - MSR_X2APIC_BASE + 1)/4);
298 msrpm[SVM_MSRPM_0000][MSR_X2APIC_ICR/4] = 0x02;
301 avic_page = page_alloc(&remap_pool, 1);
303 return trace_error(-ENOMEM);
307 return vcpu_cell_init(&root_cell);
310 int vcpu_vendor_cell_init(struct cell *cell)
315 /* allocate iopm (two 4-K pages + 3 bits) */
316 cell->svm.iopm = page_alloc(&mem_pool, 3);
320 /* build root NPT of cell */
321 cell->svm.npt_structs.root_paging = npt_paging;
322 cell->svm.npt_structs.root_table = page_alloc(&mem_pool, 1);
323 if (!cell->svm.npt_structs.root_table)
328 * Map xAPIC as is; reads are passed, writes are trapped.
330 flags = PAGE_READONLY_FLAGS | PAGE_FLAG_US | PAGE_FLAG_DEVICE;
331 err = paging_create(&cell->svm.npt_structs, XAPIC_BASE,
332 PAGE_SIZE, XAPIC_BASE,
334 PAGING_NON_COHERENT);
336 flags = PAGE_DEFAULT_FLAGS | PAGE_FLAG_DEVICE;
337 err = paging_create(&cell->svm.npt_structs,
338 paging_hvirt2phys(avic_page),
339 PAGE_SIZE, XAPIC_BASE,
341 PAGING_NON_COHERENT);
347 int vcpu_map_memory_region(struct cell *cell,
348 const struct jailhouse_memory *mem)
350 u64 phys_start = mem->phys_start;
351 u64 flags = PAGE_FLAG_US; /* See APMv2, Section 15.25.5 */
353 if (mem->flags & JAILHOUSE_MEM_READ)
354 flags |= PAGE_FLAG_PRESENT;
355 if (mem->flags & JAILHOUSE_MEM_WRITE)
356 flags |= PAGE_FLAG_RW;
357 if (!(mem->flags & JAILHOUSE_MEM_EXECUTE))
358 flags |= PAGE_FLAG_NOEXECUTE;
359 if (mem->flags & JAILHOUSE_MEM_COMM_REGION)
360 phys_start = paging_hvirt2phys(&cell->comm_page);
362 return paging_create(&cell->svm.npt_structs, phys_start, mem->size,
363 mem->virt_start, flags, PAGING_NON_COHERENT);
366 int vcpu_unmap_memory_region(struct cell *cell,
367 const struct jailhouse_memory *mem)
369 return paging_destroy(&cell->svm.npt_structs, mem->virt_start,
370 mem->size, PAGING_NON_COHERENT);
373 void vcpu_vendor_cell_exit(struct cell *cell)
375 paging_destroy(&cell->svm.npt_structs, XAPIC_BASE, PAGE_SIZE,
376 PAGING_NON_COHERENT);
377 page_free(&mem_pool, cell->svm.npt_structs.root_table, 1);
380 int vcpu_init(struct per_cpu *cpu_data)
385 err = svm_check_features();
389 efer = read_msr(MSR_EFER);
390 if (efer & EFER_SVME)
391 return trace_error(-EBUSY);
394 write_msr(MSR_EFER, efer);
396 cpu_data->svm_state = SVMON;
398 if (!vmcb_setup(cpu_data))
399 return trace_error(-EIO);
402 * APM Volume 2, 3.1.1: "When writing the CR0 register, software should
403 * set the values of reserved bits to the values found during the
404 * previous CR0 read."
405 * But we want to avoid surprises with new features unknown to us but
406 * set by Linux. So check if any assumed revered bit was set and bail
408 * Note that the APM defines all reserved CR4 bits as must-be-zero.
410 if (cpu_data->linux_cr0 & X86_CR0_RESERVED)
413 /* bring CR0 and CR4 into well-defined states */
414 write_cr0(X86_CR0_HOST_STATE);
415 write_cr4(X86_CR4_HOST_STATE);
417 write_msr(MSR_VM_HSAVE_PA, paging_hvirt2phys(cpu_data->host_state));
422 void vcpu_exit(struct per_cpu *cpu_data)
426 if (cpu_data->svm_state == SVMOFF)
429 cpu_data->svm_state = SVMOFF;
431 /* We are leaving - set the GIF */
432 asm volatile ("stgi" : : : "memory");
434 efer = read_msr(MSR_EFER);
436 write_msr(MSR_EFER, efer);
438 write_msr(MSR_VM_HSAVE_PA, 0);
441 void __attribute__((noreturn)) vcpu_activate_vmm(struct per_cpu *cpu_data)
443 unsigned long vmcb_pa, host_stack;
445 vmcb_pa = paging_hvirt2phys(&cpu_data->vmcb);
446 host_stack = (unsigned long)cpu_data->stack + sizeof(cpu_data->stack);
448 /* We enter Linux at the point arch_entry would return to as well.
449 * rax is cleared to signal success to the caller. */
452 "mov (%%rdi),%%r15\n\t"
453 "mov 0x8(%%rdi),%%r14\n\t"
454 "mov 0x10(%%rdi),%%r13\n\t"
455 "mov 0x18(%%rdi),%%r12\n\t"
456 "mov 0x20(%%rdi),%%rbx\n\t"
457 "mov 0x28(%%rdi),%%rbp\n\t"
462 /* Restore hypervisor stack */
466 : "m" (vmcb_pa), "D" (cpu_data->linux_reg), "m" (host_stack)
467 : "memory", "r15", "r14", "r13", "r12",
468 "rbx", "rbp", "rax", "cc");
469 __builtin_unreachable();
472 void __attribute__((noreturn))
473 vcpu_deactivate_vmm(struct registers *guest_regs)
475 struct per_cpu *cpu_data = this_cpu_data();
476 struct vmcb *vmcb = &cpu_data->vmcb;
477 unsigned long *stack = (unsigned long *)vmcb->rsp;
478 unsigned long linux_ip = vmcb->rip;
483 * XXX: One could argue this is better to be done in
484 * arch_cpu_restore(), however, it would require changes
485 * to cpu_data to store STAR and friends.
487 write_msr(MSR_STAR, vmcb->star);
488 write_msr(MSR_LSTAR, vmcb->lstar);
489 write_msr(MSR_CSTAR, vmcb->cstar);
490 write_msr(MSR_SFMASK, vmcb->sfmask);
491 write_msr(MSR_KERNGS_BASE, vmcb->kerngsbase);
493 cpu_data->linux_cr0 = vmcb->cr0;
494 cpu_data->linux_cr3 = vmcb->cr3;
496 cpu_data->linux_gdtr.base = vmcb->gdtr.base;
497 cpu_data->linux_gdtr.limit = vmcb->gdtr.limit;
498 cpu_data->linux_idtr.base = vmcb->idtr.base;
499 cpu_data->linux_idtr.limit = vmcb->idtr.limit;
501 cpu_data->linux_cs.selector = vmcb->cs.selector;
503 cpu_data->linux_tss.selector = vmcb->tr.selector;
505 cpu_data->linux_efer = vmcb->efer & (~EFER_SVME);
506 cpu_data->linux_fs.base = vmcb->fs.base;
507 cpu_data->linux_gs.base = vmcb->gs.base;
509 cpu_data->linux_sysenter_cs = vmcb->sysenter_cs;
510 cpu_data->linux_sysenter_eip = vmcb->sysenter_eip;
511 cpu_data->linux_sysenter_esp = vmcb->sysenter_esp;
513 cpu_data->linux_ds.selector = vmcb->ds.selector;
514 cpu_data->linux_es.selector = vmcb->es.selector;
515 cpu_data->linux_fs.selector = vmcb->fs.selector;
516 cpu_data->linux_gs.selector = vmcb->gs.selector;
518 arch_cpu_restore(cpu_data, 0);
524 "mov %%rbx,%%rsp\n\t"
540 "mov %%rax,%%rsp\n\t"
541 "xor %%rax,%%rax\n\t"
543 : : "a" (stack), "b" (guest_regs));
544 __builtin_unreachable();
547 static void svm_vcpu_reset(struct per_cpu *cpu_data, unsigned int sipi_vector)
549 struct vmcb *vmcb = &cpu_data->vmcb;
553 vmcb->cr0 = X86_CR0_NW | X86_CR0_CD | X86_CR0_ET;
560 if (sipi_vector == APIC_BSP_PSEUDO_SIPI) {
567 vmcb->cs.selector = sipi_vector << 8;
568 vmcb->cs.base = sipi_vector << 12;
569 vmcb->cs.limit = 0xffff;
570 vmcb->cs.access_rights = 0x009b;
572 vmcb->ds.selector = 0;
574 vmcb->ds.limit = 0xffff;
575 vmcb->ds.access_rights = 0x0093;
577 vmcb->es.selector = 0;
579 vmcb->es.limit = 0xffff;
580 vmcb->es.access_rights = 0x0093;
582 vmcb->fs.selector = 0;
584 vmcb->fs.limit = 0xffff;
585 vmcb->fs.access_rights = 0x0093;
587 vmcb->gs.selector = 0;
589 vmcb->gs.limit = 0xffff;
590 vmcb->gs.access_rights = 0x0093;
592 vmcb->ss.selector = 0;
594 vmcb->ss.limit = 0xffff;
595 vmcb->ss.access_rights = 0x0093;
597 vmcb->tr.selector = 0;
599 vmcb->tr.limit = 0xffff;
600 vmcb->tr.access_rights = 0x008b;
602 vmcb->ldtr.selector = 0;
604 vmcb->ldtr.limit = 0xffff;
605 vmcb->ldtr.access_rights = 0x0082;
607 vmcb->gdtr.selector = 0;
609 vmcb->gdtr.limit = 0xffff;
610 vmcb->gdtr.access_rights = 0;
612 vmcb->idtr.selector = 0;
614 vmcb->idtr.limit = 0xffff;
615 vmcb->idtr.access_rights = 0;
617 vmcb->efer = EFER_SVME;
619 /* These MSRs are undefined on reset */
624 vmcb->sysenter_cs = 0;
625 vmcb->sysenter_eip = 0;
626 vmcb->sysenter_esp = 0;
627 vmcb->kerngsbase = 0;
629 vmcb->dr7 = 0x00000400;
631 /* Almost all of the guest state changed */
632 vmcb->clean_bits = 0;
634 ok &= svm_set_cell_config(cpu_data->cell, vmcb);
636 /* This is always false, but to be consistent with vmx.c... */
638 panic_printk("FATAL: CPU reset failed\n");
643 void vcpu_skip_emulated_instruction(unsigned int inst_len)
645 struct per_cpu *cpu_data = this_cpu_data();
646 struct vmcb *vmcb = &cpu_data->vmcb;
647 vmcb->rip += inst_len;
650 static void update_efer(struct per_cpu *cpu_data)
652 struct vmcb *vmcb = &cpu_data->vmcb;
653 unsigned long efer = vmcb->efer;
655 if ((efer & (EFER_LME | EFER_LMA)) != EFER_LME)
660 /* Flush TLB on LMA/LME change: See APMv2, Sect. 15.16 */
661 if ((vmcb->efer ^ efer) & EFER_LMA)
665 vmcb->clean_bits &= ~CLEAN_BITS_CRX;
668 bool vcpu_get_guest_paging_structs(struct guest_paging_structures *pg_structs)
670 struct per_cpu *cpu_data = this_cpu_data();
671 struct vmcb *vmcb = &cpu_data->vmcb;
673 if (vmcb->efer & EFER_LMA) {
674 pg_structs->root_paging = x86_64_paging;
675 pg_structs->root_table_gphys =
676 vmcb->cr3 & 0x000ffffffffff000UL;
677 } else if ((vmcb->cr0 & X86_CR0_PG) &&
678 !(vmcb->cr4 & X86_CR4_PAE)) {
679 pg_structs->root_paging = i386_paging;
680 pg_structs->root_table_gphys =
681 vmcb->cr3 & 0xfffff000UL;
682 } else if (!(vmcb->cr0 & X86_CR0_PG)) {
684 * Can be in non-paged protected mode as well, but
685 * the translation mechanism will stay the same ayway.
687 pg_structs->root_paging = realmode_paging;
689 * This will make paging_get_guest_pages map the page
690 * that also contains the bootstrap code and, thus, is
691 * always present in a cell.
693 pg_structs->root_table_gphys = 0xff000;
695 printk("FATAL: Unsupported paging mode\n");
701 void vcpu_vendor_set_guest_pat(unsigned long val)
703 struct vmcb *vmcb = &this_cpu_data()->vmcb;
706 vmcb->clean_bits &= ~CLEAN_BITS_NP;
709 struct parse_context {
710 unsigned int remaining;
712 unsigned long cs_base;
716 static bool ctx_advance(struct parse_context *ctx,
718 struct guest_paging_structures *pg_structs)
721 ctx->size = ctx->remaining;
722 ctx->inst = vcpu_map_inst(pg_structs, ctx->cs_base + *pc,
726 ctx->remaining -= ctx->size;
732 static bool x86_parse_mov_to_cr(struct per_cpu *cpu_data,
737 struct guest_paging_structures pg_structs;
738 struct vmcb *vmcb = &cpu_data->vmcb;
739 struct parse_context ctx = {};
740 /* No prefixes are supported yet */
741 u8 opcodes[] = {0x0f, 0x22}, modrm;
745 ctx.remaining = ARRAY_SIZE(opcodes);
746 if (!vcpu_get_guest_paging_structs(&pg_structs))
748 ctx.cs_base = (vmcb->efer & EFER_LMA) ? 0 : vmcb->cs.base;
750 if (!ctx_advance(&ctx, &pc, &pg_structs))
753 for (n = 0; n < ARRAY_SIZE(opcodes); n++, ctx.inst++) {
754 if (*(ctx.inst) != opcodes[n])
756 if (!ctx_advance(&ctx, &pc, &pg_structs))
760 if (!ctx_advance(&ctx, &pc, &pg_structs))
765 if (((modrm & 0x38) >> 3) != reg)
769 *gpr = (modrm & 0x7);
777 * XXX: The only visible reason to have this function (vmx.c consistency
778 * aside) is to prevent cells from setting invalid CD+NW combinations that
779 * result in no more than VMEXIT_INVALID. Maybe we can get along without it
782 static bool svm_handle_cr(struct registers *guest_regs,
783 struct per_cpu *cpu_data)
785 struct vmcb *vmcb = &cpu_data->vmcb;
786 /* Workaround GCC 4.8 warning on uninitialized variable 'reg' */
787 unsigned long reg = -1, val, bits;
791 if (!(vmcb->exitinfo1 & (1UL << 63))) {
792 panic_printk("FATAL: Unsupported CR access (LMSW or CLTS)\n");
796 reg = vmcb->exitinfo1 & 0x07;
798 if (!x86_parse_mov_to_cr(cpu_data, vmcb->rip, 0, ®)) {
799 panic_printk("FATAL: Unable to parse MOV-to-CR instruction\n");
808 val = ((unsigned long *)guest_regs)[15 - reg];
810 vcpu_skip_emulated_instruction(X86_INST_LEN_MOV_TO_CR);
811 /* Flush TLB on PG/WP/CD/NW change: See APMv2, Sect. 15.16 */
812 bits = (X86_CR0_PG | X86_CR0_WP | X86_CR0_CD | X86_CR0_NW);
813 if ((val ^ vmcb->cr0) & bits)
815 /* TODO: better check for #GP reasons */
816 vmcb->cr0 = val & SVM_CR0_ALLOWED_BITS;
817 if (val & X86_CR0_PG)
818 update_efer(cpu_data);
819 vmcb->clean_bits &= ~CLEAN_BITS_CRX;
825 static bool svm_handle_msr_write(struct registers *guest_regs,
826 struct per_cpu *cpu_data)
828 struct vmcb *vmcb = &cpu_data->vmcb;
829 unsigned long efer, val;
831 switch (guest_regs->rcx) {
833 /* Never let a guest to disable SVME; see APMv2, Sect. 3.1.7 */
834 efer = get_wrmsr_value(guest_regs) | EFER_SVME;
835 /* Flush TLB on LME/NXE change: See APMv2, Sect. 15.16 */
836 if ((efer ^ vmcb->efer) & (EFER_LME | EFER_NXE))
839 vmcb->clean_bits &= ~CLEAN_BITS_CRX;
842 val = get_wrmsr_value(guest_regs);
844 * Quick (and very incomplete) guest MTRRs emulation.
846 * For Linux, emulating MTRR Enable bit seems to be enough.
847 * If it is cleared, we set hPAT to all zeroes, effectively
848 * making all NPT-mapped memory UC (see APMv2, Sect. 15.25.8).
850 * Otherwise, default PAT value is restored. This can also
851 * make NPT-mapped memory's type different from what Linux
855 write_msr(MSR_IA32_PAT, PAT_RESET_VALUE);
857 write_msr(MSR_IA32_PAT, 0);
860 return vcpu_handle_msr_write(guest_regs);
863 vcpu_skip_emulated_instruction(X86_INST_LEN_WRMSR);
868 * TODO: This handles unaccelerated (non-AVIC) access. AVIC should
869 * be treated separately in svm_handle_avic_access().
871 static bool svm_handle_apic_access(struct registers *guest_regs,
872 struct per_cpu *cpu_data)
874 struct vmcb *vmcb = &cpu_data->vmcb;
875 struct guest_paging_structures pg_structs;
876 unsigned int inst_len, offset;
879 /* The caller is responsible for sanity checks */
880 is_write = !!(vmcb->exitinfo1 & 0x2);
881 offset = vmcb->exitinfo2 - XAPIC_BASE;
886 if (!vcpu_get_guest_paging_structs(&pg_structs))
889 inst_len = apic_mmio_access(guest_regs, cpu_data, vmcb->rip,
890 &pg_structs, offset >> 4, is_write);
894 vcpu_skip_emulated_instruction(inst_len);
898 panic_printk("FATAL: Unhandled APIC access, offset %d, is_write: %d\n",
903 static void dump_guest_regs(struct registers *guest_regs, struct vmcb *vmcb)
905 panic_printk("RIP: %p RSP: %p FLAGS: %x\n", vmcb->rip,
906 vmcb->rsp, vmcb->rflags);
907 panic_printk("RAX: %p RBX: %p RCX: %p\n", guest_regs->rax,
908 guest_regs->rbx, guest_regs->rcx);
909 panic_printk("RDX: %p RSI: %p RDI: %p\n", guest_regs->rdx,
910 guest_regs->rsi, guest_regs->rdi);
911 panic_printk("CS: %x BASE: %p AR-BYTES: %x EFER.LMA %d\n",
912 vmcb->cs.selector, vmcb->cs.base, vmcb->cs.access_rights,
913 !!(vmcb->efer & EFER_LMA));
914 panic_printk("CR0: %p CR3: %p CR4: %p\n", vmcb->cr0,
915 vmcb->cr3, vmcb->cr4);
916 panic_printk("EFER: %p\n", vmcb->efer);
919 static void svm_get_vcpu_pf_intercept(struct per_cpu *cpu_data,
920 struct vcpu_pf_intercept *out)
922 struct vmcb *vmcb = &cpu_data->vmcb;
924 out->phys_addr = vmcb->exitinfo2;
925 out->is_write = !!(vmcb->exitinfo1 & 0x2);
928 static void svm_get_vcpu_io_intercept(struct per_cpu *cpu_data,
929 struct vcpu_io_intercept *out)
931 struct vmcb *vmcb = &cpu_data->vmcb;
932 u64 exitinfo = vmcb->exitinfo1;
934 /* parse exit info for I/O instructions (see APM, 15.10.2 ) */
935 out->port = (exitinfo >> 16) & 0xFFFF;
936 out->size = (exitinfo >> 4) & 0x7;
937 out->in = !!(exitinfo & 0x1);
938 out->inst_len = vmcb->exitinfo2 - vmcb->rip;
939 out->rep_or_str = !!(exitinfo & 0x0c);
942 void vcpu_handle_exit(struct registers *guest_regs, struct per_cpu *cpu_data)
944 struct vmcb *vmcb = &cpu_data->vmcb;
945 struct vcpu_execution_state x_state;
946 struct vcpu_pf_intercept pf;
947 struct vcpu_io_intercept io;
951 /* Restore GS value expected by per_cpu data accessors */
952 write_msr(MSR_GS_BASE, (unsigned long)cpu_data);
954 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_TOTAL]++;
956 * All guest state is marked unmodified; individual handlers must clear
957 * the bits as needed.
959 vmcb->clean_bits = 0xffffffff;
961 switch (vmcb->exitcode) {
963 panic_printk("FATAL: VM-Entry failure, error %d\n",
967 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_MANAGEMENT]++;
968 /* Temporarily enable GIF to consume pending NMI */
969 asm volatile("stgi; clgi" : : : "memory");
970 sipi_vector = x86_handle_events(cpu_data);
971 if (sipi_vector >= 0) {
972 printk("CPU %d received SIPI, vector %x\n",
973 cpu_data->cpu_id, sipi_vector);
974 svm_vcpu_reset(cpu_data, sipi_vector);
975 vcpu_reset(guest_regs);
977 iommu_check_pending_faults(cpu_data);
980 /* FIXME: We are not intercepting CPUID now */
983 vcpu_vendor_get_execution_state(&x_state);
984 vcpu_handle_hypercall(guest_regs, &x_state);
986 case VMEXIT_CR0_SEL_WRITE:
987 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_CR]++;
988 if (svm_handle_cr(guest_regs, cpu_data))
992 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_MSR]++;
993 if (!vmcb->exitinfo1)
994 res = vcpu_handle_msr_read(guest_regs);
996 res = svm_handle_msr_write(guest_regs, cpu_data);
1001 if ((vmcb->exitinfo1 & 0x7) == 0x7 &&
1002 vmcb->exitinfo2 >= XAPIC_BASE &&
1003 vmcb->exitinfo2 < XAPIC_BASE + PAGE_SIZE) {
1004 /* APIC access in non-AVIC mode */
1005 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_XAPIC]++;
1006 if (svm_handle_apic_access(guest_regs, cpu_data))
1009 /* General MMIO (IOAPIC, PCI etc) */
1010 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_MMIO]++;
1011 svm_get_vcpu_pf_intercept(cpu_data, &pf);
1012 if (vcpu_handle_pt_violation(guest_regs, &pf))
1016 panic_printk("FATAL: Unhandled Nested Page Fault for (%p), "
1017 "error code is %x\n", vmcb->exitinfo2,
1018 vmcb->exitinfo1 & 0xf);
1021 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_XSETBV]++;
1022 if ((guest_regs->rax & X86_XCR0_FP) &&
1023 (guest_regs->rax & ~cpuid_eax(0x0d)) == 0 &&
1024 guest_regs->rcx == 0 && guest_regs->rdx == 0) {
1025 vcpu_skip_emulated_instruction(X86_INST_LEN_XSETBV);
1029 : "a" (guest_regs->rax), "c" (0), "d" (0));
1032 panic_printk("FATAL: Invalid xsetbv parameters: "
1033 "xcr[%d] = %x:%x\n", guest_regs->rcx,
1034 guest_regs->rdx, guest_regs->rax);
1037 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_PIO]++;
1038 svm_get_vcpu_io_intercept(cpu_data, &io);
1039 if (vcpu_handle_io_access(guest_regs, &io))
1042 /* TODO: Handle VMEXIT_AVIC_NOACCEL and VMEXIT_AVIC_INCOMPLETE_IPI */
1044 panic_printk("FATAL: Unexpected #VMEXIT, exitcode %x, "
1045 "exitinfo1 %p exitinfo2 %p\n",
1046 vmcb->exitcode, vmcb->exitinfo1, vmcb->exitinfo2);
1048 dump_guest_regs(guest_regs, vmcb);
1052 void vcpu_park(struct per_cpu *cpu_data)
1054 struct vmcb *vmcb = &cpu_data->vmcb;
1056 svm_vcpu_reset(cpu_data, APIC_BSP_PSEUDO_SIPI);
1057 /* No need to clear VMCB Clean bit: vcpu_reset() already does this */
1058 vmcb->n_cr3 = paging_hvirt2phys(parked_mode_npt);
1063 void vcpu_nmi_handler(void)
1067 void vcpu_tlb_flush(void)
1069 struct per_cpu *cpu_data = this_cpu_data();
1070 struct vmcb *vmcb = &cpu_data->vmcb;
1072 if (has_flush_by_asid)
1073 vmcb->tlb_control = SVM_TLB_FLUSH_GUEST;
1075 vmcb->tlb_control = SVM_TLB_FLUSH_ALL;
1078 const u8 *vcpu_get_inst_bytes(const struct guest_paging_structures *pg_structs,
1079 unsigned long pc, unsigned int *size)
1081 struct per_cpu *cpu_data = this_cpu_data();
1082 struct vmcb *vmcb = &cpu_data->vmcb;
1083 unsigned long start;
1088 start = vmcb->rip - pc;
1089 if (start < vmcb->bytes_fetched) {
1090 *size = vmcb->bytes_fetched - start;
1091 return &vmcb->guest_bytes[start];
1096 return vcpu_map_inst(pg_structs, pc, size);
1100 void vcpu_vendor_get_cell_io_bitmap(struct cell *cell,
1101 struct vcpu_io_bitmap *iobm)
1103 iobm->data = cell->svm.iopm;
1104 iobm->size = sizeof(cell->svm.iopm);
1107 void vcpu_vendor_get_execution_state(struct vcpu_execution_state *x_state)
1109 struct per_cpu *cpu_data = this_cpu_data();
1111 x_state->efer = cpu_data->vmcb.efer;
1112 x_state->rflags = cpu_data->vmcb.rflags;
1113 x_state->cs = cpu_data->vmcb.cs.selector;
1114 x_state->rip = cpu_data->vmcb.rip;
1117 /* GIF must be set for interrupts to be delivered (APMv2, Sect. 15.17) */
1118 void enable_irq(void)
1120 asm volatile("stgi; sti" : : : "memory");
1123 /* Jailhouse runs with GIF cleared, so we need to restore this state */
1124 void disable_irq(void)
1126 asm volatile("cli; clgi" : : : "memory");