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 49 void sync_with_host(uint64_t phase) 50 { 51 asm volatile("in $" XSTR(SYNC_PORT)", %%al \n" 52 : : "a" (phase)); 53 } 54 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 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 88 int main(int argc, char *argv[]) 89 { 90 struct vmx_pages *vmx_pages = NULL; 91 vm_vaddr_t vmx_pages_gva = 0; 92 93 struct kvm_regs regs; 94 struct kvm_vm *vm; 95 struct kvm_run *run; 96 struct kvm_x86_state *state; 97 int stage, stage_reported; 98 99 /* Create VM */ 100 vm = vm_create_default(VCPU_ID, 0, guest_code); 101 102 vcpu_set_cpuid(vm, VCPU_ID, kvm_get_supported_cpuid()); 103 104 run = vcpu_state(vm, VCPU_ID); 105 106 vm_userspace_mem_region_add(vm, VM_MEM_SRC_ANONYMOUS, SMRAM_GPA, 107 SMRAM_MEMSLOT, SMRAM_PAGES, 0); 108 TEST_ASSERT(vm_phy_pages_alloc(vm, SMRAM_PAGES, SMRAM_GPA, SMRAM_MEMSLOT) 109 == SMRAM_GPA, "could not allocate guest physical addresses?"); 110 111 memset(addr_gpa2hva(vm, SMRAM_GPA), 0x0, SMRAM_SIZE); 112 memcpy(addr_gpa2hva(vm, SMRAM_GPA) + 0x8000, smi_handler, 113 sizeof(smi_handler)); 114 115 vcpu_set_msr(vm, VCPU_ID, MSR_IA32_SMBASE, SMRAM_GPA); 116 117 if (kvm_check_cap(KVM_CAP_NESTED_STATE)) { 118 vmx_pages = vcpu_alloc_vmx(vm, &vmx_pages_gva); 119 vcpu_args_set(vm, VCPU_ID, 1, vmx_pages_gva); 120 } else { 121 printf("will skip SMM test with VMX enabled\n"); 122 vcpu_args_set(vm, VCPU_ID, 1, 0); 123 } 124 125 for (stage = 1;; stage++) { 126 _vcpu_run(vm, VCPU_ID); 127 TEST_ASSERT(run->exit_reason == KVM_EXIT_IO, 128 "Stage %d: unexpected exit reason: %u (%s),\n", 129 stage, run->exit_reason, 130 exit_reason_str(run->exit_reason)); 131 132 memset(®s, 0, sizeof(regs)); 133 vcpu_regs_get(vm, VCPU_ID, ®s); 134 135 stage_reported = regs.rax & 0xff; 136 137 if (stage_reported == DONE) 138 goto done; 139 140 TEST_ASSERT(stage_reported == stage || 141 stage_reported == SMRAM_STAGE, 142 "Unexpected stage: #%x, got %x", 143 stage, stage_reported); 144 145 state = vcpu_save_state(vm, VCPU_ID); 146 kvm_vm_release(vm); 147 kvm_vm_restart(vm, O_RDWR); 148 vm_vcpu_add(vm, VCPU_ID, 0, 0); 149 vcpu_set_cpuid(vm, VCPU_ID, kvm_get_supported_cpuid()); 150 vcpu_load_state(vm, VCPU_ID, state); 151 run = vcpu_state(vm, VCPU_ID); 152 free(state); 153 } 154 155 done: 156 kvm_vm_free(vm); 157 } 158