1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2018, Red Hat, Inc.
4 *
5 * Tests for SMM.
6 */
7 #define _GNU_SOURCE /* for program_invocation_short_name */
8 #include <fcntl.h>
9 #include <stdio.h>
10 #include <stdlib.h>
11 #include <stdint.h>
12 #include <string.h>
13 #include <sys/ioctl.h>
14
15 #include "test_util.h"
16
17 #include "kvm_util.h"
18
19 #include "vmx.h"
20
21 #define VCPU_ID 1
22
23 #define PAGE_SIZE 4096
24
25 #define SMRAM_SIZE 65536
26 #define SMRAM_MEMSLOT ((1 << 16) | 1)
27 #define SMRAM_PAGES (SMRAM_SIZE / PAGE_SIZE)
28 #define SMRAM_GPA 0x1000000
29 #define SMRAM_STAGE 0xfe
30
31 #define STR(x) #x
32 #define XSTR(s) STR(s)
33
34 #define SYNC_PORT 0xe
35 #define DONE 0xff
36
37 /*
38 * This is compiled as normal 64-bit code, however, SMI handler is executed
39 * in real-address mode. To stay simple we're limiting ourselves to a mode
40 * independent subset of asm here.
41 * SMI handler always report back fixed stage SMRAM_STAGE.
42 */
43 uint8_t smi_handler[] = {
44 0xb0, SMRAM_STAGE, /* mov $SMRAM_STAGE, %al */
45 0xe4, SYNC_PORT, /* in $SYNC_PORT, %al */
46 0x0f, 0xaa, /* rsm */
47 };
48
sync_with_host(uint64_t phase)49 void sync_with_host(uint64_t phase)
50 {
51 asm volatile("in $" XSTR(SYNC_PORT)", %%al \n"
52 : : "a" (phase));
53 }
54
self_smi(void)55 void self_smi(void)
56 {
57 wrmsr(APIC_BASE_MSR + (APIC_ICR >> 4),
58 APIC_DEST_SELF | APIC_INT_ASSERT | APIC_DM_SMI);
59 }
60
guest_code(struct vmx_pages * vmx_pages)61 void guest_code(struct vmx_pages *vmx_pages)
62 {
63 uint64_t apicbase = rdmsr(MSR_IA32_APICBASE);
64
65 sync_with_host(1);
66
67 wrmsr(MSR_IA32_APICBASE, apicbase | X2APIC_ENABLE);
68
69 sync_with_host(2);
70
71 self_smi();
72
73 sync_with_host(4);
74
75 if (vmx_pages) {
76 GUEST_ASSERT(prepare_for_vmx_operation(vmx_pages));
77
78 sync_with_host(5);
79
80 self_smi();
81
82 sync_with_host(7);
83 }
84
85 sync_with_host(DONE);
86 }
87
main(int argc,char * argv[])88 int main(int argc, char *argv[])
89 {
90 vm_vaddr_t vmx_pages_gva = 0;
91
92 struct kvm_regs regs;
93 struct kvm_vm *vm;
94 struct kvm_run *run;
95 struct kvm_x86_state *state;
96 int stage, stage_reported;
97
98 /* Create VM */
99 vm = vm_create_default(VCPU_ID, 0, guest_code);
100
101 vcpu_set_cpuid(vm, VCPU_ID, kvm_get_supported_cpuid());
102
103 run = vcpu_state(vm, VCPU_ID);
104
105 vm_userspace_mem_region_add(vm, VM_MEM_SRC_ANONYMOUS, SMRAM_GPA,
106 SMRAM_MEMSLOT, SMRAM_PAGES, 0);
107 TEST_ASSERT(vm_phy_pages_alloc(vm, SMRAM_PAGES, SMRAM_GPA, SMRAM_MEMSLOT)
108 == SMRAM_GPA, "could not allocate guest physical addresses?");
109
110 memset(addr_gpa2hva(vm, SMRAM_GPA), 0x0, SMRAM_SIZE);
111 memcpy(addr_gpa2hva(vm, SMRAM_GPA) + 0x8000, smi_handler,
112 sizeof(smi_handler));
113
114 vcpu_set_msr(vm, VCPU_ID, MSR_IA32_SMBASE, SMRAM_GPA);
115
116 if (kvm_check_cap(KVM_CAP_NESTED_STATE)) {
117 vcpu_alloc_vmx(vm, &vmx_pages_gva);
118 vcpu_args_set(vm, VCPU_ID, 1, vmx_pages_gva);
119 } else {
120 printf("will skip SMM test with VMX enabled\n");
121 vcpu_args_set(vm, VCPU_ID, 1, 0);
122 }
123
124 for (stage = 1;; stage++) {
125 _vcpu_run(vm, VCPU_ID);
126 TEST_ASSERT(run->exit_reason == KVM_EXIT_IO,
127 "Stage %d: unexpected exit reason: %u (%s),\n",
128 stage, run->exit_reason,
129 exit_reason_str(run->exit_reason));
130
131 memset(®s, 0, sizeof(regs));
132 vcpu_regs_get(vm, VCPU_ID, ®s);
133
134 stage_reported = regs.rax & 0xff;
135
136 if (stage_reported == DONE)
137 goto done;
138
139 TEST_ASSERT(stage_reported == stage ||
140 stage_reported == SMRAM_STAGE,
141 "Unexpected stage: #%x, got %x",
142 stage, stage_reported);
143
144 state = vcpu_save_state(vm, VCPU_ID);
145 kvm_vm_release(vm);
146 kvm_vm_restart(vm, O_RDWR);
147 vm_vcpu_add(vm, VCPU_ID);
148 vcpu_set_cpuid(vm, VCPU_ID, kvm_get_supported_cpuid());
149 vcpu_load_state(vm, VCPU_ID, state);
150 run = vcpu_state(vm, VCPU_ID);
151 free(state);
152 }
153
154 done:
155 kvm_vm_free(vm);
156 }
157