]> rtime.felk.cvut.cz Git - jailhouse.git/blob - hypervisor/arch/x86/svm.c
x86: Remove debug output from SVM NMI handler
[jailhouse.git] / hypervisor / arch / x86 / svm.c
1 /*
2  * Jailhouse, a Linux-based partitioning hypervisor
3  *
4  * Copyright (c) Siemens AG, 2013
5  * Copyright (c) Valentine Sinitsyn, 2014
6  *
7  * Authors:
8  *  Jan Kiszka <jan.kiszka@siemens.com>
9  *  Valentine Sinitsyn <valentine.sinitsyn@gmail.com>
10  *
11  * Based on vmx.c written by Jan Kiszka.
12  *
13  * This work is licensed under the terms of the GNU GPL, version 2.  See
14  * the COPYING file in the top-level directory.
15  */
16
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>
25 #include <asm/apic.h>
26 #include <asm/cell.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>
32 #include <asm/svm.h>
33 #include <asm/vcpu.h>
34
35 /*
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.
39  */
40 #define SVM_CR0_CLEARED_BITS    ~X86_CR0_NW
41
42 #define MTRR_DEFTYPE            0x2ff
43
44 #define PAT_RESET_VALUE         0x0007040600070406
45
46 static bool has_avic, has_assists, has_flush_by_asid;
47
48 static const struct segment invalid_seg;
49
50 static struct paging npt_paging[NPT_PAGE_DIR_LEVELS];
51
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 ...  0x2fb/4 ] = 0,
57                 [  0x2fc/4 ...  0x2ff/4 ] = 0x80, /* 0x2ff (w) */
58                 [  0x300/4 ...  0x7ff/4 ] = 0,
59                 /* x2APIC MSRs - emulated if not present */
60                 [  0x800/4 ...  0x803/4 ] = 0x90, /* 0x802 (r), 0x803 (r) */
61                 [  0x804/4 ...  0x807/4 ] = 0,
62                 [  0x808/4 ...  0x80b/4 ] = 0x93, /* 0x808 (rw), 0x80a (r), 0x80b (w) */
63                 [  0x80c/4 ...  0x80f/4 ] = 0xc8, /* 0x80d (w), 0x80f (rw) */
64                 [  0x810/4 ...  0x813/4 ] = 0x55, /* 0x810 - 0x813 (r) */
65                 [  0x814/4 ...  0x817/4 ] = 0x55, /* 0x814 - 0x817 (r) */
66                 [  0x818/4 ...  0x81b/4 ] = 0x55, /* 0x818 - 0x81b (r) */
67                 [  0x81c/4 ...  0x81f/4 ] = 0x55, /* 0x81c - 0x81f (r) */
68                 [  0x820/4 ...  0x823/4 ] = 0x55, /* 0x820 - 0x823 (r) */
69                 [  0x824/4 ...  0x827/4 ] = 0x55, /* 0x823 - 0x827 (r) */
70                 [  0x828/4 ...  0x82b/4 ] = 0x03, /* 0x828 (rw) */
71                 [  0x82c/4 ...  0x82f/4 ] = 0xc0, /* 0x82f (rw) */
72                 [  0x830/4 ...  0x833/4 ] = 0xf3, /* 0x830 (rw), 0x832 (rw), 0x833 (rw) */
73                 [  0x834/4 ...  0x837/4 ] = 0xff, /* 0x834 - 0x837 (rw) */
74                 [  0x838/4 ...  0x83b/4 ] = 0x07, /* 0x838 (rw), 0x839 (r) */
75                 [  0x83c/4 ...  0x83f/4 ] = 0x70, /* 0x83e (rw), 0x83f (r) */
76                 [  0x840/4 ... 0x1fff/4 ] = 0,
77         },
78         [ SVM_MSRPM_C000 ] = {
79                 [      0/4 ...  0x07f/4 ] = 0,
80                 [  0x080/4 ...  0x083/4 ] = 0x02, /* 0x080 (w) */
81                 [  0x084/4 ... 0x1fff/4 ] = 0
82         },
83         [ SVM_MSRPM_C001 ] = {
84                 [      0/4 ... 0x1fff/4 ] = 0,
85         },
86         [ SVM_MSRPM_RESV ] = {
87                 [      0/4 ... 0x1fff/4 ] = 0,
88         }
89 };
90
91 /* This page is mapped so the code begins at 0x000ffff0 */
92 static u8 __attribute__((aligned(PAGE_SIZE))) parking_code[PAGE_SIZE] = {
93         [0xff0] = 0xfa, /* 1: cli */
94         [0xff1] = 0xf4, /*    hlt */
95         [0xff2] = 0xeb,
96         [0xff3] = 0xfc  /*    jmp 1b */
97 };
98
99 static void *parked_mode_npt;
100
101 static void *avic_page;
102
103 static int svm_check_features(void)
104 {
105         /* SVM is available */
106         if (!(cpuid_ecx(0x80000001) & X86_FEATURE_SVM))
107                 return -ENODEV;
108
109         /* Nested paging */
110         if (!(cpuid_edx(0x8000000A) & X86_FEATURE_NP))
111                 return -EIO;
112
113         /* Decode assists */
114         if ((cpuid_edx(0x8000000A) & X86_FEATURE_DECODE_ASSISTS))
115                 has_assists = true;
116
117         /* AVIC support */
118         if (cpuid_edx(0x8000000A) & X86_FEATURE_AVIC)
119                 has_avic = true;
120
121         /* TLB Flush by ASID support */
122         if (cpuid_edx(0x8000000A) & X86_FEATURE_FLUSH_BY_ASID)
123                 has_flush_by_asid = true;
124
125         return 0;
126 }
127
128 static void set_svm_segment_from_dtr(struct svm_segment *svm_segment,
129                                      const struct desc_table_reg *dtr)
130 {
131         struct svm_segment tmp = { 0 };
132
133         if (dtr) {
134                 tmp.base = dtr->base;
135                 tmp.limit = dtr->limit & 0xffff;
136         }
137
138         *svm_segment = tmp;
139 }
140
141 /* TODO: struct segment needs to be x86 generic, not VMX-specific one here */
142 static void set_svm_segment_from_segment(struct svm_segment *svm_segment,
143                                          const struct segment *segment)
144 {
145         u32 ar;
146
147         svm_segment->selector = segment->selector;
148
149         if (segment->access_rights == 0x10000) {
150                 svm_segment->access_rights = 0;
151         } else {
152                 ar = segment->access_rights;
153                 svm_segment->access_rights =
154                         ((ar & 0xf000) >> 4) | (ar & 0x00ff);
155         }
156
157         svm_segment->limit = segment->limit;
158         svm_segment->base = segment->base;
159 }
160
161 static bool vcpu_set_cell_config(struct cell *cell, struct vmcb *vmcb)
162 {
163         /* No real need for this function; used for consistency with vmx.c */
164         vmcb->iopm_base_pa = paging_hvirt2phys(cell->svm.iopm);
165         vmcb->n_cr3 = paging_hvirt2phys(cell->svm.npt_structs.root_table);
166
167         return true;
168 }
169
170 static int vmcb_setup(struct per_cpu *cpu_data)
171 {
172         struct vmcb *vmcb = &cpu_data->vmcb;
173
174         memset(vmcb, 0, sizeof(struct vmcb));
175
176         vmcb->cr0 = read_cr0() & SVM_CR0_CLEARED_BITS;
177         vmcb->cr3 = cpu_data->linux_cr3;
178         vmcb->cr4 = read_cr4();
179
180         set_svm_segment_from_segment(&vmcb->cs, &cpu_data->linux_cs);
181         set_svm_segment_from_segment(&vmcb->ds, &cpu_data->linux_ds);
182         set_svm_segment_from_segment(&vmcb->es, &cpu_data->linux_es);
183         set_svm_segment_from_segment(&vmcb->fs, &cpu_data->linux_fs);
184         set_svm_segment_from_segment(&vmcb->gs, &cpu_data->linux_gs);
185         set_svm_segment_from_segment(&vmcb->ss, &invalid_seg);
186         set_svm_segment_from_segment(&vmcb->tr, &cpu_data->linux_tss);
187
188         set_svm_segment_from_dtr(&vmcb->ldtr, NULL);
189         set_svm_segment_from_dtr(&vmcb->gdtr, &cpu_data->linux_gdtr);
190         set_svm_segment_from_dtr(&vmcb->idtr, &cpu_data->linux_idtr);
191
192         vmcb->cpl = 0; /* Linux runs in ring 0 before migration */
193
194         vmcb->rflags = 0x02;
195         /* Indicate success to the caller of arch_entry */
196         vmcb->rax = 0;
197         vmcb->rsp = cpu_data->linux_sp +
198                 (NUM_ENTRY_REGS + 1) * sizeof(unsigned long);
199         vmcb->rip = cpu_data->linux_ip;
200
201         vmcb->sysenter_cs = read_msr(MSR_IA32_SYSENTER_CS);
202         vmcb->sysenter_eip = read_msr(MSR_IA32_SYSENTER_EIP);
203         vmcb->sysenter_esp = read_msr(MSR_IA32_SYSENTER_ESP);
204         vmcb->star = read_msr(MSR_STAR);
205         vmcb->lstar = read_msr(MSR_LSTAR);
206         vmcb->cstar = read_msr(MSR_CSTAR);
207         vmcb->sfmask = read_msr(MSR_SFMASK);
208         vmcb->kerngsbase = read_msr(MSR_KERNGS_BASE);
209
210         vmcb->dr6 = 0x00000ff0;
211         vmcb->dr7 = 0x00000400;
212
213         /* Make the hypervisor visible */
214         vmcb->efer = (cpu_data->linux_efer | EFER_SVME);
215
216         /* Linux uses custom PAT setting */
217         vmcb->g_pat = read_msr(MSR_IA32_PAT);
218
219         vmcb->general1_intercepts |= GENERAL1_INTERCEPT_NMI;
220         vmcb->general1_intercepts |= GENERAL1_INTERCEPT_CR0_SEL_WRITE;
221         /* TODO: Do we need this for SVM ? */
222         /* vmcb->general1_intercepts |= GENERAL1_INTERCEPT_CPUID; */
223         vmcb->general1_intercepts |= GENERAL1_INTERCEPT_IOIO_PROT;
224         vmcb->general1_intercepts |= GENERAL1_INTERCEPT_MSR_PROT;
225         vmcb->general1_intercepts |= GENERAL1_INTERCEPT_SHUTDOWN_EVT;
226
227         vmcb->general2_intercepts |= GENERAL2_INTERCEPT_VMRUN; /* Required */
228         vmcb->general2_intercepts |= GENERAL2_INTERCEPT_VMMCALL;
229
230         vmcb->msrpm_base_pa = paging_hvirt2phys(msrpm);
231
232         vmcb->np_enable = 1;
233         /* No more than one guest owns the CPU */
234         vmcb->guest_asid = 1;
235
236         /* TODO: Setup AVIC */
237
238         /* Explicitly mark all of the state as new */
239         vmcb->clean_bits = 0;
240
241         return vcpu_set_cell_config(cpu_data->cell, vmcb);
242 }
243
244 unsigned long arch_paging_gphys2phys(struct per_cpu *cpu_data,
245                                      unsigned long gphys,
246                                      unsigned long flags)
247 {
248         return paging_virt2phys(&cpu_data->cell->svm.npt_structs,
249                         gphys, flags);
250 }
251
252 static void npt_set_next_pt(pt_entry_t pte, unsigned long next_pt)
253 {
254         /* See APMv2, Section 15.25.5 */
255         *pte = (next_pt & 0x000ffffffffff000UL) |
256                 (PAGE_DEFAULT_FLAGS | PAGE_FLAG_US);
257 }
258
259 int vcpu_vendor_init(void)
260 {
261         struct paging_structures parking_pt;
262         unsigned long vm_cr;
263         int err, n;
264
265         err = svm_check_features();
266         if (err)
267                 return err;
268
269         vm_cr = read_msr(MSR_VM_CR);
270         if (vm_cr & VM_CR_SVMDIS)
271                 /* SVM disabled in BIOS */
272                 return -EPERM;
273
274         /* Nested paging is the same as the native one */
275         memcpy(npt_paging, x86_64_paging, sizeof(npt_paging));
276         for (n = 0; n < NPT_PAGE_DIR_LEVELS; n++)
277                 npt_paging[n].set_next_pt = npt_set_next_pt;
278
279         /* Map guest parking code (shared between cells and CPUs) */
280         parking_pt.root_paging = npt_paging;
281         parking_pt.root_table = parked_mode_npt = page_alloc(&mem_pool, 1);
282         if (!parked_mode_npt)
283                 return -ENOMEM;
284         err = paging_create(&parking_pt, paging_hvirt2phys(parking_code),
285                             PAGE_SIZE, 0x000ff000,
286                             PAGE_READONLY_FLAGS | PAGE_FLAG_US,
287                             PAGING_NON_COHERENT);
288         if (err)
289                 return err;
290
291         /* This is always false for AMD now (except in nested SVM);
292            see Sect. 16.3.1 in APMv2 */
293         if (using_x2apic) {
294                 /* allow direct x2APIC access except for ICR writes */
295                 memset(&msrpm[SVM_MSRPM_0000][MSR_X2APIC_BASE/4], 0,
296                                 (MSR_X2APIC_END - MSR_X2APIC_BASE + 1)/4);
297                 msrpm[SVM_MSRPM_0000][MSR_X2APIC_ICR/4] = 0x02;
298         } else {
299                 /* Enable Extended Interrupt LVT */
300                 apic_reserved_bits[0x50] = 0;
301                 if (has_avic) {
302                         avic_page = page_alloc(&remap_pool, 1);
303                         if (!avic_page)
304                                 return -ENOMEM;
305                 }
306         }
307
308         return vcpu_cell_init(&root_cell);
309 }
310
311 int vcpu_vendor_cell_init(struct cell *cell)
312 {
313         u64 flags;
314         int err;
315
316         /* allocate iopm (two 4-K pages + 3 bits) */
317         cell->svm.iopm = page_alloc(&mem_pool, 3);
318         if (!cell->svm.iopm)
319                 return -ENOMEM;
320
321         /* build root NPT of cell */
322         cell->svm.npt_structs.root_paging = npt_paging;
323         cell->svm.npt_structs.root_table = page_alloc(&mem_pool, 1);
324         if (!cell->svm.npt_structs.root_table)
325                 return -ENOMEM;
326
327         if (!has_avic) {
328                 /*
329                  * Map xAPIC as is; reads are passed, writes are trapped.
330                  */
331                 flags = PAGE_READONLY_FLAGS |
332                         PAGE_FLAG_US |
333                         PAGE_FLAG_UNCACHED;
334                 err = paging_create(&cell->svm.npt_structs, XAPIC_BASE,
335                                     PAGE_SIZE, XAPIC_BASE,
336                                     flags,
337                                     PAGING_NON_COHERENT);
338         } else {
339                 flags = PAGE_DEFAULT_FLAGS | PAGE_FLAG_UNCACHED;
340                 err = paging_create(&cell->svm.npt_structs,
341                                     paging_hvirt2phys(avic_page),
342                                     PAGE_SIZE, XAPIC_BASE,
343                                     flags,
344                                     PAGING_NON_COHERENT);
345         }
346
347         return err;
348 }
349
350 int vcpu_map_memory_region(struct cell *cell,
351                            const struct jailhouse_memory *mem)
352 {
353         u64 phys_start = mem->phys_start;
354         u32 flags = PAGE_FLAG_US; /* See APMv2, Section 15.25.5 */
355
356         if (mem->flags & JAILHOUSE_MEM_READ)
357                 flags |= PAGE_FLAG_PRESENT;
358         if (mem->flags & JAILHOUSE_MEM_WRITE)
359                 flags |= PAGE_FLAG_RW;
360         if (mem->flags & JAILHOUSE_MEM_EXECUTE)
361                 flags |= PAGE_FLAG_EXECUTE;
362         if (mem->flags & JAILHOUSE_MEM_COMM_REGION)
363                 phys_start = paging_hvirt2phys(&cell->comm_page);
364
365         return paging_create(&cell->svm.npt_structs, phys_start, mem->size,
366                              mem->virt_start, flags, PAGING_NON_COHERENT);
367 }
368
369 int vcpu_unmap_memory_region(struct cell *cell,
370                              const struct jailhouse_memory *mem)
371 {
372         return paging_destroy(&cell->svm.npt_structs, mem->virt_start,
373                               mem->size, PAGING_NON_COHERENT);
374 }
375
376 void vcpu_vendor_cell_exit(struct cell *cell)
377 {
378         paging_destroy(&cell->svm.npt_structs, XAPIC_BASE, PAGE_SIZE,
379                        PAGING_NON_COHERENT);
380         page_free(&mem_pool, cell->svm.npt_structs.root_table, 1);
381 }
382
383 int vcpu_init(struct per_cpu *cpu_data)
384 {
385         unsigned long efer;
386         int err;
387
388         err = svm_check_features();
389         if (err)
390                 return err;
391
392         efer = read_msr(MSR_EFER);
393         if (efer & EFER_SVME)
394                 return -EBUSY;
395
396         efer |= EFER_SVME;
397         write_msr(MSR_EFER, efer);
398
399         cpu_data->svm_state = SVMON;
400
401         if (!vmcb_setup(cpu_data))
402                 return -EIO;
403
404         write_msr(MSR_VM_HSAVE_PA, paging_hvirt2phys(cpu_data->host_state));
405
406         /* Enable Extended Interrupt LVT (xAPIC, as it is AMD-only) */
407         if (!using_x2apic)
408                 apic_reserved_bits[0x50] = 0;
409
410         return 0;
411 }
412
413 void vcpu_exit(struct per_cpu *cpu_data)
414 {
415         unsigned long efer;
416
417         if (cpu_data->svm_state == SVMOFF)
418                 return;
419
420         cpu_data->svm_state = SVMOFF;
421
422         /* We are leaving - set the GIF */
423         asm volatile ("stgi" : : : "memory");
424
425         efer = read_msr(MSR_EFER);
426         efer &= ~EFER_SVME;
427         write_msr(MSR_EFER, efer);
428
429         write_msr(MSR_VM_HSAVE_PA, 0);
430 }
431
432 void vcpu_activate_vmm(struct per_cpu *cpu_data)
433 {
434         unsigned long vmcb_pa, host_stack;
435
436         vmcb_pa = paging_hvirt2phys(&cpu_data->vmcb);
437         host_stack = (unsigned long)cpu_data->stack + sizeof(cpu_data->stack);
438
439         /* Clear host-mode MSRs */
440         write_msr(MSR_IA32_SYSENTER_CS, 0);
441         write_msr(MSR_IA32_SYSENTER_EIP, 0);
442         write_msr(MSR_IA32_SYSENTER_ESP, 0);
443
444         write_msr(MSR_STAR, 0);
445         write_msr(MSR_LSTAR, 0);
446         write_msr(MSR_CSTAR, 0);
447         write_msr(MSR_SFMASK, 0);
448         write_msr(MSR_KERNGS_BASE, 0);
449
450         /*
451          * XXX: Jailhouse doesn't use PAT, so it is explicitly set to the
452          * reset value. However, this value is later combined with vmcb->g_pat
453          * (as per APMv2, Sect. 15.25.8) which may lead to subtle bugs as the
454          * actual memory type might slightly differ from what Linux expects.
455          */
456         write_msr(MSR_IA32_PAT, PAT_RESET_VALUE);
457
458         /* We enter Linux at the point arch_entry would return to as well.
459          * rax is cleared to signal success to the caller. */
460         asm volatile(
461                 "clgi\n\t"
462                 "mov (%%rdi),%%r15\n\t"
463                 "mov 0x8(%%rdi),%%r14\n\t"
464                 "mov 0x10(%%rdi),%%r13\n\t"
465                 "mov 0x18(%%rdi),%%r12\n\t"
466                 "mov 0x20(%%rdi),%%rbx\n\t"
467                 "mov 0x28(%%rdi),%%rbp\n\t"
468                 "mov %0, %%rax\n\t"
469                 "vmload\n\t"
470                 "vmrun\n\t"
471                 "vmsave\n\t"
472                 /* Restore hypervisor stack */
473                 "mov %2, %%rsp\n\t"
474                 "jmp svm_vmexit"
475                 : /* no output */
476                 : "m" (vmcb_pa), "D" (cpu_data->linux_reg), "m" (host_stack)
477                 : "memory", "r15", "r14", "r13", "r12",
478                   "rbx", "rbp", "rax", "cc");
479         __builtin_unreachable();
480 }
481
482 void __attribute__((noreturn))
483 vcpu_deactivate_vmm(struct registers *guest_regs)
484 {
485         struct per_cpu *cpu_data = this_cpu_data();
486         struct vmcb *vmcb = &cpu_data->vmcb;
487         unsigned long *stack = (unsigned long *)vmcb->rsp;
488         unsigned long linux_ip = vmcb->rip;
489
490         /* We are leaving - set the GIF */
491         asm volatile ("stgi" : : : "memory");
492
493         /*
494          * Restore the MSRs.
495          *
496          * XXX: One could argue this is better to be done in
497          * arch_cpu_restore(), however, it would require changes
498          * to cpu_data to store STAR and friends.
499          */
500         write_msr(MSR_STAR, vmcb->star);
501         write_msr(MSR_LSTAR, vmcb->lstar);
502         write_msr(MSR_CSTAR, vmcb->cstar);
503         write_msr(MSR_SFMASK, vmcb->sfmask);
504         write_msr(MSR_KERNGS_BASE, vmcb->kerngsbase);
505         write_msr(MSR_IA32_PAT, vmcb->g_pat);
506
507         cpu_data->linux_cr3 = vmcb->cr3;
508
509         cpu_data->linux_gdtr.base = vmcb->gdtr.base;
510         cpu_data->linux_gdtr.limit = vmcb->gdtr.limit;
511         cpu_data->linux_idtr.base = vmcb->idtr.base;
512         cpu_data->linux_idtr.limit = vmcb->idtr.limit;
513
514         cpu_data->linux_cs.selector = vmcb->cs.selector;
515
516         cpu_data->linux_tss.selector = vmcb->tr.selector;
517
518         cpu_data->linux_efer = vmcb->efer & (~EFER_SVME);
519         cpu_data->linux_fs.base = vmcb->fs.base;
520         cpu_data->linux_gs.base = vmcb->gs.base;
521
522         cpu_data->linux_sysenter_cs = vmcb->sysenter_cs;
523         cpu_data->linux_sysenter_eip = vmcb->sysenter_eip;
524         cpu_data->linux_sysenter_esp = vmcb->sysenter_esp;
525
526         cpu_data->linux_ds.selector = vmcb->ds.selector;
527         cpu_data->linux_es.selector = vmcb->es.selector;
528         cpu_data->linux_fs.selector = vmcb->fs.selector;
529         cpu_data->linux_gs.selector = vmcb->gs.selector;
530
531         arch_cpu_restore(cpu_data);
532
533         stack--;
534         *stack = linux_ip;
535
536         asm volatile (
537                 "mov %%rbx,%%rsp\n\t"
538                 "pop %%r15\n\t"
539                 "pop %%r14\n\t"
540                 "pop %%r13\n\t"
541                 "pop %%r12\n\t"
542                 "pop %%r11\n\t"
543                 "pop %%r10\n\t"
544                 "pop %%r9\n\t"
545                 "pop %%r8\n\t"
546                 "pop %%rdi\n\t"
547                 "pop %%rsi\n\t"
548                 "pop %%rbp\n\t"
549                 "add $8,%%rsp\n\t"
550                 "pop %%rbx\n\t"
551                 "pop %%rdx\n\t"
552                 "pop %%rcx\n\t"
553                 "mov %%rax,%%rsp\n\t"
554                 "xor %%rax,%%rax\n\t"
555                 "ret"
556                 : : "a" (stack), "b" (guest_regs));
557         __builtin_unreachable();
558 }
559
560 static void vcpu_reset(struct per_cpu *cpu_data, unsigned int sipi_vector)
561 {
562         struct vmcb *vmcb = &cpu_data->vmcb;
563         unsigned long val;
564         bool ok = true;
565
566         vmcb->cr0 = X86_CR0_NW | X86_CR0_CD | X86_CR0_ET;
567         vmcb->cr3 = 0;
568         vmcb->cr4 = 0;
569
570         vmcb->rflags = 0x02;
571
572         val = 0;
573         if (sipi_vector == APIC_BSP_PSEUDO_SIPI) {
574                 val = 0xfff0;
575                 sipi_vector = 0xf0;
576         }
577         vmcb->rip = val;
578         vmcb->rsp = 0;
579
580         vmcb->cs.selector = sipi_vector << 8;
581         vmcb->cs.base = sipi_vector << 12;
582         vmcb->cs.limit = 0xffff;
583         vmcb->cs.access_rights = 0x009b;
584
585         vmcb->ds.selector = 0;
586         vmcb->ds.base = 0;
587         vmcb->ds.limit = 0xffff;
588         vmcb->ds.access_rights = 0x0093;
589
590         vmcb->es.selector = 0;
591         vmcb->es.base = 0;
592         vmcb->es.limit = 0xffff;
593         vmcb->es.access_rights = 0x0093;
594
595         vmcb->fs.selector = 0;
596         vmcb->fs.base = 0;
597         vmcb->fs.limit = 0xffff;
598         vmcb->fs.access_rights = 0x0093;
599
600         vmcb->gs.selector = 0;
601         vmcb->gs.base = 0;
602         vmcb->gs.limit = 0xffff;
603         vmcb->gs.access_rights = 0x0093;
604
605         vmcb->ss.selector = 0;
606         vmcb->ss.base = 0;
607         vmcb->ss.limit = 0xffff;
608         vmcb->ss.access_rights = 0x0093;
609
610         vmcb->tr.selector = 0;
611         vmcb->tr.base = 0;
612         vmcb->tr.limit = 0xffff;
613         vmcb->tr.access_rights = 0x008b;
614
615         vmcb->ldtr.selector = 0;
616         vmcb->ldtr.base = 0;
617         vmcb->ldtr.limit = 0xffff;
618         vmcb->ldtr.access_rights = 0x0082;
619
620         vmcb->gdtr.selector = 0;
621         vmcb->gdtr.base = 0;
622         vmcb->gdtr.limit = 0xffff;
623         vmcb->gdtr.access_rights = 0;
624
625         vmcb->idtr.selector = 0;
626         vmcb->idtr.base = 0;
627         vmcb->idtr.limit = 0xffff;
628         vmcb->idtr.access_rights = 0;
629
630         vmcb->efer = EFER_SVME;
631
632         /* These MSRs are undefined on reset */
633         vmcb->star = 0;
634         vmcb->lstar = 0;
635         vmcb->cstar = 0;
636         vmcb->sfmask = 0;
637         vmcb->sysenter_cs = 0;
638         vmcb->sysenter_eip = 0;
639         vmcb->sysenter_esp = 0;
640         vmcb->kerngsbase = 0;
641
642         vmcb->g_pat = PAT_RESET_VALUE;
643
644         vmcb->dr7 = 0x00000400;
645
646         /* Almost all of the guest state changed */
647         vmcb->clean_bits = 0;
648
649         ok &= vcpu_set_cell_config(cpu_data->cell, vmcb);
650
651         /* This is always false, but to be consistent with vmx.c... */
652         if (!ok) {
653                 panic_printk("FATAL: CPU reset failed\n");
654                 panic_stop();
655         }
656 }
657
658 void vcpu_skip_emulated_instruction(unsigned int inst_len)
659 {
660         struct per_cpu *cpu_data = this_cpu_data();
661         struct vmcb *vmcb = &cpu_data->vmcb;
662         vmcb->rip += inst_len;
663 }
664
665 static void update_efer(struct per_cpu *cpu_data)
666 {
667         struct vmcb *vmcb = &cpu_data->vmcb;
668         unsigned long efer = vmcb->efer;
669
670         if ((efer & (EFER_LME | EFER_LMA)) != EFER_LME)
671                 return;
672
673         efer |= EFER_LMA;
674
675         /* Flush TLB on LMA/LME change: See APMv2, Sect. 15.16 */
676         if ((vmcb->efer ^ efer) & EFER_LMA)
677                 vcpu_tlb_flush();
678
679         vmcb->efer = efer;
680         vmcb->clean_bits &= ~CLEAN_BITS_CRX;
681 }
682
683 bool vcpu_get_guest_paging_structs(struct guest_paging_structures *pg_structs)
684 {
685         struct per_cpu *cpu_data = this_cpu_data();
686         struct vmcb *vmcb = &cpu_data->vmcb;
687
688         if (vmcb->efer & EFER_LMA) {
689                 pg_structs->root_paging = x86_64_paging;
690                 pg_structs->root_table_gphys =
691                         vmcb->cr3 & 0x000ffffffffff000UL;
692         } else if ((vmcb->cr0 & X86_CR0_PG) &&
693                    !(vmcb->cr4 & X86_CR4_PAE)) {
694                 pg_structs->root_paging = i386_paging;
695                 pg_structs->root_table_gphys =
696                         vmcb->cr3 & 0xfffff000UL;
697         } else if (!(vmcb->cr0 & X86_CR0_PG)) {
698                 /*
699                  * Can be in non-paged protected mode as well, but
700                  * the translation mechanism will stay the same ayway.
701                  */
702                 pg_structs->root_paging = realmode_paging;
703                 /*
704                  * This will make paging_get_guest_pages map the page
705                  * that also contains the bootstrap code and, thus, is
706                  * always present in a cell.
707                  */
708                 pg_structs->root_table_gphys = 0xff000;
709         } else {
710                 printk("FATAL: Unsupported paging mode\n");
711                 return false;
712         }
713         return true;
714 }
715
716 struct parse_context {
717         unsigned int remaining;
718         unsigned int size;
719         unsigned long cs_base;
720         const u8 *inst;
721 };
722
723 static bool ctx_advance(struct parse_context *ctx,
724                         unsigned long *pc,
725                         struct guest_paging_structures *pg_structs)
726 {
727         if (!ctx->size) {
728                 ctx->size = ctx->remaining;
729                 ctx->inst = vcpu_map_inst(pg_structs, ctx->cs_base + *pc,
730                                           &ctx->size);
731                 if (!ctx->inst)
732                         return false;
733                 ctx->remaining -= ctx->size;
734                 *pc += ctx->size;
735         }
736         return true;
737 }
738
739 static bool x86_parse_mov_to_cr(struct per_cpu *cpu_data,
740                                 unsigned long pc,
741                                 unsigned char reg,
742                                 unsigned long *gpr)
743 {
744         struct guest_paging_structures pg_structs;
745         struct vmcb *vmcb = &cpu_data->vmcb;
746         struct parse_context ctx = {};
747         /* No prefixes are supported yet */
748         u8 opcodes[] = {0x0f, 0x22}, modrm;
749         bool ok = false;
750         int n;
751
752         ctx.remaining = ARRAY_SIZE(opcodes);
753         if (!vcpu_get_guest_paging_structs(&pg_structs))
754                 goto out;
755         ctx.cs_base = (vmcb->efer & EFER_LMA) ? 0 : vmcb->cs.base;
756
757         if (!ctx_advance(&ctx, &pc, &pg_structs))
758                 goto out;
759
760         for (n = 0; n < ARRAY_SIZE(opcodes); n++, ctx.inst++) {
761                 if (*(ctx.inst) != opcodes[n])
762                         goto out;
763                 if (!ctx_advance(&ctx, &pc, &pg_structs))
764                         goto out;
765         }
766
767         if (!ctx_advance(&ctx, &pc, &pg_structs))
768                 goto out;
769
770         modrm = *(ctx.inst);
771
772         if (((modrm & 0x38) >> 3) != reg)
773                 goto out;
774
775         if (gpr)
776                 *gpr = (modrm & 0x7);
777
778         ok = true;
779 out:
780         return ok;
781 }
782
783 /*
784  * XXX: The only visible reason to have this function (vmx.c consistency
785  * aside) is to prevent cells from setting invalid CD+NW combinations that
786  * result in no more than VMEXIT_INVALID. Maybe we can get along without it
787  * altogether?
788  */
789 static bool svm_handle_cr(struct registers *guest_regs,
790                           struct per_cpu *cpu_data)
791 {
792         struct vmcb *vmcb = &cpu_data->vmcb;
793         /* Workaround GCC 4.8 warning on uninitialized variable 'reg' */
794         unsigned long reg = -1, val, bits;
795         bool ok = true;
796
797         if (has_assists) {
798                 if (!(vmcb->exitinfo1 & (1UL << 63))) {
799                         panic_printk("FATAL: Unsupported CR access (LMSW or CLTS)\n");
800                         ok = false;
801                         goto out;
802                 }
803                 reg = vmcb->exitinfo1 & 0x07;
804         } else {
805                 if (!x86_parse_mov_to_cr(cpu_data, vmcb->rip, 0, &reg)) {
806                         panic_printk("FATAL: Unable to parse MOV-to-CR instruction\n");
807                         ok = false;
808                         goto out;
809                 }
810         };
811
812         if (reg == 4)
813                 val = vmcb->rsp;
814         else
815                 val = ((unsigned long *)guest_regs)[15 - reg];
816
817         vcpu_skip_emulated_instruction(X86_INST_LEN_MOV_TO_CR);
818         /* Flush TLB on PG/WP/CD/NW change: See APMv2, Sect. 15.16 */
819         bits = (X86_CR0_PG | X86_CR0_WP | X86_CR0_CD | X86_CR0_NW);
820         if ((val ^ vmcb->cr0) & bits)
821                 vcpu_tlb_flush();
822         /* TODO: better check for #GP reasons */
823         vmcb->cr0 = val & SVM_CR0_CLEARED_BITS;
824         if (val & X86_CR0_PG)
825                 update_efer(cpu_data);
826         vmcb->clean_bits &= ~CLEAN_BITS_CRX;
827
828 out:
829         return ok;
830 }
831
832 static bool svm_handle_msr_read(struct registers *guest_regs,
833                 struct per_cpu *cpu_data)
834 {
835         if (guest_regs->rcx >= MSR_X2APIC_BASE &&
836             guest_regs->rcx <= MSR_X2APIC_END) {
837                 vcpu_skip_emulated_instruction(X86_INST_LEN_RDMSR);
838                 x2apic_handle_read(guest_regs);
839                 return true;
840         } else {
841                 panic_printk("FATAL: Unhandled MSR read: %x\n",
842                              guest_regs->rcx);
843                 return false;
844         }
845 }
846
847 static bool svm_handle_msr_write(struct registers *guest_regs,
848                 struct per_cpu *cpu_data)
849 {
850         struct vmcb *vmcb = &cpu_data->vmcb;
851         unsigned long efer, val;
852         bool result = true;
853
854         if (guest_regs->rcx >= MSR_X2APIC_BASE &&
855             guest_regs->rcx <= MSR_X2APIC_END) {
856                 result = x2apic_handle_write(guest_regs, cpu_data);
857                 goto out;
858         }
859         if (guest_regs->rcx == MSR_EFER) {
860                 /* Never let a guest to disable SVME; see APMv2, Sect. 3.1.7 */
861                 efer = (guest_regs->rax & 0xffffffff) |
862                         (guest_regs->rdx << 32) | EFER_SVME;
863                 /* Flush TLB on LME/NXE change: See APMv2, Sect. 15.16 */
864                 if ((efer ^ vmcb->efer) & (EFER_LME | EFER_NXE))
865                         vcpu_tlb_flush();
866                 vmcb->efer = efer;
867                 vmcb->clean_bits &= ~CLEAN_BITS_CRX;
868                 goto out;
869         }
870         if (guest_regs->rcx == MTRR_DEFTYPE) {
871                 val = (guest_regs->rax & 0xffffffff) | (guest_regs->rdx << 32);
872                 /*
873                  * Quick (and very incomplete) guest MTRRs emulation.
874                  *
875                  * For Linux, emulating MTRR Enable bit seems to be enough.
876                  * If it is cleared, we set hPAT to all zeroes, effectively
877                  * making all NPT-mapped memory UC (see APMv2, Sect. 15.25.8).
878                  *
879                  * Otherwise, default PAT value is restored. This can also
880                  * make NPT-mapped memory's type different from what Linux
881                  * expects, however.
882                  */
883                 if (val & 0x800)
884                         write_msr(MSR_IA32_PAT, PAT_RESET_VALUE);
885                 else
886                         write_msr(MSR_IA32_PAT, 0);
887                 goto out;
888         }
889
890         result = false;
891         panic_printk("FATAL: Unhandled MSR write: %x\n",
892                      guest_regs->rcx);
893 out:
894         if (result)
895                 vcpu_skip_emulated_instruction(X86_INST_LEN_WRMSR);
896         return result;
897 }
898
899 /*
900  * TODO: This handles unaccelerated (non-AVIC) access. AVIC should
901  * be treated separately in svm_handle_avic_access().
902  */
903 static bool svm_handle_apic_access(struct registers *guest_regs,
904                                    struct per_cpu *cpu_data)
905 {
906         struct vmcb *vmcb = &cpu_data->vmcb;
907         struct guest_paging_structures pg_structs;
908         unsigned int inst_len, offset;
909         bool is_write;
910
911         /* The caller is responsible for sanity checks */
912         is_write = !!(vmcb->exitinfo1 & 0x2);
913         offset = vmcb->exitinfo2 - XAPIC_BASE;
914
915         if (offset & 0x00f)
916                 goto out_err;
917
918         if (!vcpu_get_guest_paging_structs(&pg_structs))
919                 goto out_err;
920
921         inst_len = apic_mmio_access(guest_regs, cpu_data, vmcb->rip,
922                                     &pg_structs, offset >> 4, is_write);
923         if (!inst_len)
924                 goto out_err;
925
926         vcpu_skip_emulated_instruction(inst_len);
927         return true;
928
929 out_err:
930         panic_printk("FATAL: Unhandled APIC access, offset %d, is_write: %d\n",
931                      offset, is_write);
932         return false;
933 }
934
935 static void dump_guest_regs(struct registers *guest_regs, struct vmcb *vmcb)
936 {
937         panic_printk("RIP: %p RSP: %p FLAGS: %x\n", vmcb->rip,
938                      vmcb->rsp, vmcb->rflags);
939         panic_printk("RAX: %p RBX: %p RCX: %p\n", guest_regs->rax,
940                      guest_regs->rbx, guest_regs->rcx);
941         panic_printk("RDX: %p RSI: %p RDI: %p\n", guest_regs->rdx,
942                      guest_regs->rsi, guest_regs->rdi);
943         panic_printk("CS: %x BASE: %p AR-BYTES: %x EFER.LMA %d\n",
944                      vmcb->cs.selector,
945                      vmcb->cs.base,
946                      vmcb->cs.access_rights,
947                      (vmcb->efer & EFER_LMA));
948         panic_printk("CR0: %p CR3: %p CR4: %p\n", vmcb->cr0,
949                      vmcb->cr3, vmcb->cr4);
950         panic_printk("EFER: %p\n", vmcb->efer);
951 }
952
953 static void vcpu_vendor_get_pf_intercept(struct per_cpu *cpu_data,
954                                          struct vcpu_pf_intercept *out)
955 {
956         struct vmcb *vmcb = &cpu_data->vmcb;
957
958         out->phys_addr = vmcb->exitinfo2;
959         out->is_write = !!(vmcb->exitinfo1 & 0x2);
960 }
961
962 static void vcpu_vendor_get_io_intercept(struct per_cpu *cpu_data,
963                                          struct vcpu_io_intercept *out)
964 {
965         struct vmcb *vmcb = &cpu_data->vmcb;
966         u64 exitinfo = vmcb->exitinfo1;
967
968         /* parse exit info for I/O instructions (see APM, 15.10.2 ) */
969         out->port = (exitinfo >> 16) & 0xFFFF;
970         out->size = (exitinfo >> 4) & 0x7;
971         out->in = !!(exitinfo & 0x1);
972         out->inst_len = vmcb->exitinfo2 - vmcb->rip;
973         out->rep_or_str = !!(exitinfo & 0x0c);
974 }
975
976 void vcpu_handle_exit(struct registers *guest_regs, struct per_cpu *cpu_data)
977 {
978         struct vmcb *vmcb = &cpu_data->vmcb;
979         struct vcpu_execution_state x_state;
980         struct vcpu_pf_intercept pf;
981         struct vcpu_io_intercept io;
982         bool res = false;
983         int sipi_vector;
984
985         /* Restore GS value expected by per_cpu data accessors */
986         write_msr(MSR_GS_BASE, (unsigned long)cpu_data);
987
988         cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_TOTAL]++;
989         /*
990          * All guest state is marked unmodified; individual handlers must clear
991          * the bits as needed.
992          */
993         vmcb->clean_bits = 0xffffffff;
994
995         switch (vmcb->exitcode) {
996         case VMEXIT_INVALID:
997                 panic_printk("FATAL: VM-Entry failure, error %d\n",
998                              vmcb->exitcode);
999                 break;
1000         case VMEXIT_NMI:
1001                 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_MANAGEMENT]++;
1002                 /* Temporarily enable GIF to consume pending NMI */
1003                 asm volatile("stgi; clgi" : : : "memory");
1004                 sipi_vector = x86_handle_events(cpu_data);
1005                 if (sipi_vector >= 0) {
1006                         printk("CPU %d received SIPI, vector %x\n",
1007                                cpu_data->cpu_id, sipi_vector);
1008                         vcpu_reset(cpu_data, sipi_vector);
1009                         memset(guest_regs, 0, sizeof(*guest_regs));
1010                 }
1011                 iommu_check_pending_faults(cpu_data);
1012                 return;
1013         case VMEXIT_CPUID:
1014                 /* FIXME: We are not intercepting CPUID now */
1015                 return;
1016         case VMEXIT_VMMCALL:
1017                 vcpu_vendor_get_execution_state(&x_state);
1018                 vcpu_handle_hypercall(guest_regs, &x_state);
1019                 return;
1020         case VMEXIT_CR0_SEL_WRITE:
1021                 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_CR]++;
1022                 if (svm_handle_cr(guest_regs, cpu_data))
1023                         return;
1024                 break;
1025         case VMEXIT_MSR:
1026                 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_MSR]++;
1027                 if (!vmcb->exitinfo1)
1028                         res = svm_handle_msr_read(guest_regs, cpu_data);
1029                 else
1030                         res = svm_handle_msr_write(guest_regs, cpu_data);
1031                 if (res)
1032                         return;
1033                 break;
1034         case VMEXIT_NPF:
1035                 if ((vmcb->exitinfo1 & 0x7) == 0x7 &&
1036                      vmcb->exitinfo2 >= XAPIC_BASE &&
1037                      vmcb->exitinfo2 < XAPIC_BASE + PAGE_SIZE) {
1038                         /* APIC access in non-AVIC mode */
1039                         cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_XAPIC]++;
1040                         if (svm_handle_apic_access(guest_regs, cpu_data))
1041                                 return;
1042                 } else {
1043                         /* General MMIO (IOAPIC, PCI etc) */
1044                         cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_MMIO]++;
1045                         vcpu_vendor_get_pf_intercept(cpu_data, &pf);
1046                         if (vcpu_handle_pt_violation(guest_regs, &pf))
1047                                 return;
1048                 }
1049
1050                 panic_printk("FATAL: Unhandled Nested Page Fault for (%p), "
1051                              "error code is %x\n", vmcb->exitinfo2,
1052                              vmcb->exitinfo1 & 0xf);
1053                 break;
1054         case VMEXIT_XSETBV:
1055                 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_XSETBV]++;
1056                 if ((guest_regs->rax & X86_XCR0_FP) &&
1057                     (guest_regs->rax & ~cpuid_eax(0x0d)) == 0 &&
1058                     guest_regs->rcx == 0 && guest_regs->rdx == 0) {
1059                         vcpu_skip_emulated_instruction(X86_INST_LEN_XSETBV);
1060                         asm volatile(
1061                                 "xsetbv"
1062                                 : /* no output */
1063                                 : "a" (guest_regs->rax), "c" (0), "d" (0));
1064                         return;
1065                 }
1066                 panic_printk("FATAL: Invalid xsetbv parameters: "
1067                              "xcr[%d] = %x:%x\n", guest_regs->rcx,
1068                              guest_regs->rdx, guest_regs->rax);
1069                 break;
1070         case VMEXIT_IOIO:
1071                 cpu_data->stats[JAILHOUSE_CPU_STAT_VMEXITS_PIO]++;
1072                 vcpu_vendor_get_io_intercept(cpu_data, &io);
1073                 if (vcpu_handle_io_access(guest_regs, &io))
1074                         return;
1075                 break;
1076         /* TODO: Handle VMEXIT_AVIC_NOACCEL and VMEXIT_AVIC_INCOMPLETE_IPI */
1077         default:
1078                 panic_printk("FATAL: Unexpected #VMEXIT, exitcode %x, "
1079                              "exitinfo1 %p exitinfo2 %p\n",
1080                              vmcb->exitcode, vmcb->exitinfo1, vmcb->exitinfo2);
1081         }
1082         dump_guest_regs(guest_regs, vmcb);
1083         panic_park();
1084 }
1085
1086 void vcpu_park(struct per_cpu *cpu_data)
1087 {
1088         struct vmcb *vmcb = &cpu_data->vmcb;
1089
1090         vcpu_reset(cpu_data, APIC_BSP_PSEUDO_SIPI);
1091         /* No need to clear VMCB Clean bit: vcpu_reset() already does this */
1092         vmcb->n_cr3 = paging_hvirt2phys(parked_mode_npt);
1093
1094         vcpu_tlb_flush();
1095 }
1096
1097 void vcpu_nmi_handler(struct per_cpu *cpu_data)
1098 {
1099 }
1100
1101 void vcpu_tlb_flush(void)
1102 {
1103         struct per_cpu *cpu_data = this_cpu_data();
1104         struct vmcb *vmcb = &cpu_data->vmcb;
1105
1106         if (has_flush_by_asid)
1107                 vmcb->tlb_control = SVM_TLB_FLUSH_GUEST;
1108         else
1109                 vmcb->tlb_control = SVM_TLB_FLUSH_ALL;
1110 }
1111
1112 const u8 *vcpu_get_inst_bytes(const struct guest_paging_structures *pg_structs,
1113                               unsigned long pc, unsigned int *size)
1114 {
1115         struct per_cpu *cpu_data = this_cpu_data();
1116         struct vmcb *vmcb = &cpu_data->vmcb;
1117         unsigned long start;
1118
1119         if (has_assists) {
1120                 if (!*size)
1121                         return NULL;
1122                 start = vmcb->rip - pc;
1123                 if (start < vmcb->bytes_fetched) {
1124                         *size = vmcb->bytes_fetched - start;
1125                         return &vmcb->guest_bytes[start];
1126                 } else {
1127                         return NULL;
1128                 }
1129         } else {
1130                 return vcpu_map_inst(pg_structs, pc, size);
1131         }
1132 }
1133
1134 void vcpu_vendor_get_cell_io_bitmap(struct cell *cell,
1135                                     struct vcpu_io_bitmap *iobm)
1136 {
1137         iobm->data = cell->svm.iopm;
1138         iobm->size = sizeof(cell->svm.iopm);
1139 }
1140
1141 void vcpu_vendor_get_execution_state(struct vcpu_execution_state *x_state)
1142 {
1143         struct per_cpu *cpu_data = this_cpu_data();
1144
1145         x_state->efer = cpu_data->vmcb.efer;
1146         x_state->rflags = cpu_data->vmcb.rflags;
1147         x_state->cs = cpu_data->vmcb.cs.selector;
1148         x_state->rip = cpu_data->vmcb.rip;
1149 }