global_asm

This commit is contained in:
Masato Imai
2025-05-01 15:38:15 +00:00
parent a1277fbae1
commit 704dec9b07
4 changed files with 182 additions and 255 deletions

View File

@ -2,7 +2,6 @@
#![no_main] #![no_main]
#![feature(custom_test_frameworks)] #![feature(custom_test_frameworks)]
#![feature(new_zeroed_alloc)] #![feature(new_zeroed_alloc)]
#![feature(naked_functions)]
#![test_runner(nel_os::test_runner)] #![test_runner(nel_os::test_runner)]
#![reexport_test_harness_main = "test_main"] #![reexport_test_harness_main = "test_main"]
#![allow(unreachable_code)] #![allow(unreachable_code)]

175
src/vmm/asm.rs Normal file
View File

@ -0,0 +1,175 @@
use core::{arch::global_asm, mem::offset_of};
use super::{register::GuestRegisters, vcpu::VCpu};
#[allow(improper_ctypes)]
extern "C" {
pub fn asm_vm_entry(vcpu: *mut VCpu) -> u16;
pub fn asm_vm_entry_resume(vcpu: *mut VCpu) -> u16;
pub fn guest_entry() -> !;
pub fn vmexit_handler_asm() -> !;
}
const GUEST_REGS_OFFSET: usize = offset_of!(VCpu, guest_registers);
const LAUNCH_DONE_OFFSET: usize = offset_of!(VCpu, launch_done);
const RAX_OFFSET: usize = offset_of!(GuestRegisters, rax);
const RCX_OFFSET: usize = offset_of!(GuestRegisters, rcx);
const RDX_OFFSET: usize = offset_of!(GuestRegisters, rdx);
const RBX_OFFSET: usize = offset_of!(GuestRegisters, rbx);
const RSI_OFFSET: usize = offset_of!(GuestRegisters, rsi);
const RDI_OFFSET: usize = offset_of!(GuestRegisters, rdi);
const RBP_OFFSET: usize = offset_of!(GuestRegisters, rbp);
const R8_OFFSET: usize = offset_of!(GuestRegisters, r8);
const R9_OFFSET: usize = offset_of!(GuestRegisters, r9);
const R10_OFFSET: usize = offset_of!(GuestRegisters, r10);
const R11_OFFSET: usize = offset_of!(GuestRegisters, r11);
const R12_OFFSET: usize = offset_of!(GuestRegisters, r12);
const R13_OFFSET: usize = offset_of!(GuestRegisters, r13);
const R14_OFFSET: usize = offset_of!(GuestRegisters, r14);
const R15_OFFSET: usize = offset_of!(GuestRegisters, r15);
global_asm!(
".global guest_entry",
".type guest_entry, @function",
"guest_entry:",
"2: hlt",
"jmp 2b",
".size guest_entry, . - guest_entry",
".global asm_vm_entry_resume",
".type asm_vm_entry_resume, @function",
"asm_vm_entry_resume:",
"push rbp",
"push r15",
"push r14",
"push r13",
"push r12",
"push rbx",
"lea rbx, [rdi + {0}]",
"push rbx",
"push rdi",
"lea rdi, [rsp + 8]",
"call set_host_stack",
"pop rdi",
"mov rax, rdi",
"mov rcx, [rax+{2}]",
"mov rdx, [rax+{3}]",
"mov rbx, [rax+{4}]",
"mov rsi, [rax+{5}]",
"mov rdi, [rax+{6}]",
"mov rbp, [rax+{7}]",
"mov r8, [rax+{8}]",
"mov r9, [rax+{9}]",
"mov r10, [rax+{10}]",
"mov r11, [rax+{11}]",
"mov r12, [rax+{12}]",
"mov r13, [rax+{13}]",
"mov r14, [rax+{14}]",
"mov r15, [rax+{15}]",
"mov rax, [rax+{16}]",
"vmresume",
"mov ax, 1",
"add rsp, 8",
"pop rbx",
"pop r12",
"pop r13",
"pop r14",
"pop r15",
"pop rbp",
"ret",
".size asm_vm_entry_resume, . - asm_vm_entry_resume",
".global asm_vm_entry",
".type asm_vm_entry, @function",
"asm_vm_entry:",
"push rbp",
"push r15",
"push r14",
"push r13",
"push r12",
"push rbx",
"lea rbx, [rdi + {0}]",
"push rbx",
"push rdi",
"lea rdi, [rsp + 8]",
"call set_host_stack",
"pop rdi",
"test byte ptr [rdi + {1}], 1",
"mov rax, rdi",
"mov rcx, [rax+{2}]",
"mov rdx, [rax+{3}]",
"mov rbx, [rax+{4}]",
"mov rsi, [rax+{5}]",
"mov rdi, [rax+{6}]",
"mov rbp, [rax+{7}]",
"mov r8, [rax+{8}]",
"mov r9, [rax+{9}]",
"mov r10, [rax+{10}]",
"mov r11, [rax+{11}]",
"mov r12, [rax+{12}]",
"mov r13, [rax+{13}]",
"mov r14, [rax+{14}]",
"mov r15, [rax+{15}]",
"mov rax, [rax+{16}]",
"vmlaunch",
"mov ax, 1",
"add rsp, 8",
"pop rbx",
"pop r12",
"pop r13",
"pop r14",
"pop r15",
"pop rbp",
"ret",
".size asm_vm_entry, . - asm_vm_entry",
".global vmexit_handler_asm",
".type vmexit_handler_asm, @function",
"vmexit_handler_asm:",
"push rax",
"mov rax, [rsp+8]",
"pop [rax+{16}]",
"add rsp, 8",
"mov [rax+{2}], rcx",
"mov [rax+{3}], rdx",
"mov [rax+{4}], rbx",
"mov [rax+{5}], rsi",
"mov [rax+{6}], rdi",
"mov [rax+{7}], rbp",
"mov [rax+{8}], r8",
"mov [rax+{9}], r9",
"mov [rax+{10}], r10",
"mov [rax+{11}], r11",
"mov [rax+{12}], r12",
"mov [rax+{13}], r13",
"mov [rax+{14}], r14",
"mov [rax+{15}], r15",
"pop rbx",
"pop r12",
"pop r13",
"pop r14",
"pop r15",
"pop rbp",
"mov rax, 0",
"ret",
".size vmexit_handler_asm, . - vmexit_handler_asm",
const GUEST_REGS_OFFSET,
const LAUNCH_DONE_OFFSET,
const RCX_OFFSET,
const RDX_OFFSET,
const RBX_OFFSET,
const RSI_OFFSET,
const RDI_OFFSET,
const RBP_OFFSET,
const R8_OFFSET,
const R9_OFFSET,
const R10_OFFSET,
const R11_OFFSET,
const R12_OFFSET,
const R13_OFFSET,
const R14_OFFSET,
const R15_OFFSET,
const RAX_OFFSET,
);

View File

@ -1,3 +1,4 @@
pub mod asm;
pub mod ept; pub mod ept;
pub mod error; pub mod error;
pub mod linux; pub mod linux;

View File

@ -7,11 +7,7 @@ use x86::{
}; };
use x86_64::VirtAddr; use x86_64::VirtAddr;
use core::{ use core::sync::atomic::Ordering;
arch::{asm, naked_asm},
mem::offset_of,
sync::atomic::Ordering,
};
use crate::{ use crate::{
info, info,
@ -203,7 +199,7 @@ impl VCpu {
vmwrite(vmcs::host::CR3, cr3())?; vmwrite(vmcs::host::CR3, cr3())?;
vmwrite(vmcs::host::CR4, cr4().bits() as u64)?; vmwrite(vmcs::host::CR4, cr4().bits() as u64)?;
vmwrite(vmcs::host::RIP, Self::vmexit as u64)?; vmwrite(vmcs::host::RIP, crate::vmm::asm::vmexit_handler_asm as u64)?;
vmwrite( vmwrite(
vmcs::host::RSP, vmcs::host::RSP,
VirtAddr::from_ptr(&raw mut TEMP_STACK).as_u64() + TEMP_STACK_SIZE as u64, VirtAddr::from_ptr(&raw mut TEMP_STACK).as_u64() + TEMP_STACK_SIZE as u64,
@ -362,8 +358,6 @@ impl VCpu {
vmwrite(vmcs::guest::TR_ACCESS_RIGHTS, tr_right.0 as u64)?; vmwrite(vmcs::guest::TR_ACCESS_RIGHTS, tr_right.0 as u64)?;
vmwrite(vmcs::guest::LDTR_ACCESS_RIGHTS, ldtr_right.0 as u64)?; vmwrite(vmcs::guest::LDTR_ACCESS_RIGHTS, ldtr_right.0 as u64)?;
info!("RIP: {:#x}", Self::guest as u64);
vmwrite(vmcs::guest::RIP, Self::guest as u64)?;
vmwrite(vmcs::guest::IA32_EFER_FULL, rdmsr(IA32_EFER))?; vmwrite(vmcs::guest::IA32_EFER_FULL, rdmsr(IA32_EFER))?;
vmwrite(vmcs::guest::RFLAGS, 0x2)?; vmwrite(vmcs::guest::RFLAGS, 0x2)?;
vmwrite(vmcs::guest::LINK_PTR_FULL, u64::MAX)?; vmwrite(vmcs::guest::LINK_PTR_FULL, u64::MAX)?;
@ -380,7 +374,7 @@ impl VCpu {
pub fn vm_loop(&mut self) -> ! { pub fn vm_loop(&mut self) -> ! {
info!("Entering VM loop"); info!("Entering VM loop");
let guest_ptr = Self::guest as u64; let guest_ptr = crate::vmm::asm::guest_entry as u64;
let guest_addr = self.ept.get_phys_addr(0).unwrap() let guest_addr = self.ept.get_phys_addr(0).unwrap()
+ memory::PHYSICAL_MEMORY_OFFSET.load(Ordering::Relaxed); + memory::PHYSICAL_MEMORY_OFFSET.load(Ordering::Relaxed);
unsafe { unsafe {
@ -402,26 +396,12 @@ impl VCpu {
let result: u16; let result: u16;
if !self.launch_done { if !self.launch_done {
unsafe { unsafe {
asm!( result = crate::vmm::asm::asm_vm_entry(self as *mut _);
"mov {self}, rdi",
"call {asm_vm_entry}",
self = in(reg) self,
asm_vm_entry = sym Self::asm_vm_entry,
out("ax") result,
clobber_abi("C"),
);
}; };
result == 0 result == 0
} else { } else {
unsafe { unsafe {
asm!( result = crate::vmm::asm::asm_vm_entry_resume(self as *mut _);
"mov {self}, rdi",
"call {asm_vm_entry_resume}",
self = in(reg) self,
asm_vm_entry_resume = sym Self::asm_vm_entry_resume,
out("ax") result,
clobber_abi("C"),
);
}; };
result == 0 result == 0
} }
@ -441,176 +421,11 @@ impl VCpu {
Ok(()) Ok(())
} }
#[no_mangle]
unsafe extern "C" fn set_host_stack(rsp: u64) { unsafe extern "C" fn set_host_stack(rsp: u64) {
vmwrite(vmcs::host::RSP, rsp).unwrap(); vmwrite(vmcs::host::RSP, rsp).unwrap();
} }
#[unsafe(naked)]
unsafe extern "C" fn asm_vm_entry_resume() -> u16 {
const GUEST_REGS_OFFSET: usize = offset_of!(VCpu, guest_registers);
const RAX_OFFSET: usize = offset_of!(GuestRegisters, rax);
const RCX_OFFSET: usize = offset_of!(GuestRegisters, rcx);
const RDX_OFFSET: usize = offset_of!(GuestRegisters, rdx);
const RBX_OFFSET: usize = offset_of!(GuestRegisters, rbx);
const RSI_OFFSET: usize = offset_of!(GuestRegisters, rsi);
const RDI_OFFSET: usize = offset_of!(GuestRegisters, rdi);
const RBP_OFFSET: usize = offset_of!(GuestRegisters, rbp);
const R8_OFFSET: usize = offset_of!(GuestRegisters, r8);
const R9_OFFSET: usize = offset_of!(GuestRegisters, r9);
const R10_OFFSET: usize = offset_of!(GuestRegisters, r10);
const R11_OFFSET: usize = offset_of!(GuestRegisters, r11);
const R12_OFFSET: usize = offset_of!(GuestRegisters, r12);
const R13_OFFSET: usize = offset_of!(GuestRegisters, r13);
const R14_OFFSET: usize = offset_of!(GuestRegisters, r14);
const R15_OFFSET: usize = offset_of!(GuestRegisters, r15);
naked_asm!(
"push rbp",
"push r15",
"push r14",
"push r13",
"push r12",
"push rbx",
"lea rbx, [rdi + {0}]",
"push rbx",
"push rdi",
"lea rdi, [rsp + 8]",
"call {set_host_stack}",
"pop rdi",
"mov rax, rdi",
"mov rcx, [rax+{1}]",
"mov rdx, [rax+{2}]",
"mov rbx, [rax+{3}]",
"mov rsi, [rax+{4}]",
"mov rdi, [rax+{5}]",
"mov rbp, [rax+{6}]",
"mov r8, [rax+{7}]",
"mov r9, [rax+{8}]",
"mov r10, [rax+{9}]",
"mov r11, [rax+{10}]",
"mov r12, [rax+{11}]",
"mov r13, [rax+{12}]",
"mov r14, [rax+{13}]",
"mov r15, [rax+{14}]",
"mov rax, [rax+{15}]",
"vmresume",
"mov ax, 1",
"add rsp, 8",
"pop rbx",
"pop r12",
"pop r13",
"pop r14",
"pop r15",
"pop rbp",
"ret",
const GUEST_REGS_OFFSET,
const RCX_OFFSET,
const RDX_OFFSET,
const RBX_OFFSET,
const RSI_OFFSET,
const RDI_OFFSET,
const RBP_OFFSET,
const R8_OFFSET,
const R9_OFFSET,
const R10_OFFSET,
const R11_OFFSET,
const R12_OFFSET,
const R13_OFFSET,
const R14_OFFSET,
const R15_OFFSET,
const RAX_OFFSET,
set_host_stack = sym Self::set_host_stack,
);
}
#[unsafe(naked)]
unsafe extern "C" fn asm_vm_entry() -> u16 {
const GUEST_REGS_OFFSET: usize = offset_of!(VCpu, guest_registers);
const LAUNCH_DONE: usize = offset_of!(VCpu, launch_done);
const RAX_OFFSET: usize = offset_of!(GuestRegisters, rax);
const RCX_OFFSET: usize = offset_of!(GuestRegisters, rcx);
const RDX_OFFSET: usize = offset_of!(GuestRegisters, rdx);
const RBX_OFFSET: usize = offset_of!(GuestRegisters, rbx);
const RSI_OFFSET: usize = offset_of!(GuestRegisters, rsi);
const RDI_OFFSET: usize = offset_of!(GuestRegisters, rdi);
const RBP_OFFSET: usize = offset_of!(GuestRegisters, rbp);
const R8_OFFSET: usize = offset_of!(GuestRegisters, r8);
const R9_OFFSET: usize = offset_of!(GuestRegisters, r9);
const R10_OFFSET: usize = offset_of!(GuestRegisters, r10);
const R11_OFFSET: usize = offset_of!(GuestRegisters, r11);
const R12_OFFSET: usize = offset_of!(GuestRegisters, r12);
const R13_OFFSET: usize = offset_of!(GuestRegisters, r13);
const R14_OFFSET: usize = offset_of!(GuestRegisters, r14);
const R15_OFFSET: usize = offset_of!(GuestRegisters, r15);
naked_asm!(
"push rbp",
"push r15",
"push r14",
"push r13",
"push r12",
"push rbx",
"lea rbx, [rdi + {0}]",
"push rbx",
"push rdi",
"lea rdi, [rsp + 8]",
"call {set_host_stack}",
"pop rdi",
"test byte ptr [rdi + {1}], 1",
"mov rax, rdi",
"mov rcx, [rax+{2}]",
"mov rdx, [rax+{3}]",
"mov rbx, [rax+{4}]",
"mov rsi, [rax+{5}]",
"mov rdi, [rax+{6}]",
"mov rbp, [rax+{7}]",
"mov r8, [rax+{8}]",
"mov r9, [rax+{9}]",
"mov r10, [rax+{10}]",
"mov r11, [rax+{11}]",
"mov r12, [rax+{12}]",
"mov r13, [rax+{13}]",
"mov r14, [rax+{14}]",
"mov r15, [rax+{15}]",
"mov rax, [rax+{16}]",
"vmlaunch",
"mov ax, 1",
"add rsp, 8",
"pop rbx",
"pop r12",
"pop r13",
"pop r14",
"pop r15",
"pop rbp",
"ret",
const GUEST_REGS_OFFSET,
const LAUNCH_DONE,
const RCX_OFFSET,
const RDX_OFFSET,
const RBX_OFFSET,
const RSI_OFFSET,
const RDI_OFFSET,
const RBP_OFFSET,
const R8_OFFSET,
const R9_OFFSET,
const R10_OFFSET,
const R11_OFFSET,
const R12_OFFSET,
const R13_OFFSET,
const R14_OFFSET,
const R15_OFFSET,
const RAX_OFFSET,
set_host_stack = sym Self::set_host_stack,
);
}
#[unsafe(naked)]
unsafe extern "C" fn guest() -> ! {
naked_asm!("2: hlt; jmp 2b");
}
fn vmexit_handler(&mut self) { fn vmexit_handler(&mut self) {
let info = VmxExitInfo::read(); let info = VmxExitInfo::read();
@ -639,67 +454,4 @@ impl VCpu {
} }
} }
} }
#[unsafe(naked)]
unsafe extern "C" fn vmexit() -> ! {
const RAX_OFFSET: usize = offset_of!(GuestRegisters, rax);
const RCX_OFFSET: usize = offset_of!(GuestRegisters, rcx);
const RDX_OFFSET: usize = offset_of!(GuestRegisters, rdx);
const RBX_OFFSET: usize = offset_of!(GuestRegisters, rbx);
const RSI_OFFSET: usize = offset_of!(GuestRegisters, rsi);
const RDI_OFFSET: usize = offset_of!(GuestRegisters, rdi);
const RBP_OFFSET: usize = offset_of!(GuestRegisters, rbp);
const R8_OFFSET: usize = offset_of!(GuestRegisters, r8);
const R9_OFFSET: usize = offset_of!(GuestRegisters, r9);
const R10_OFFSET: usize = offset_of!(GuestRegisters, r10);
const R11_OFFSET: usize = offset_of!(GuestRegisters, r11);
const R12_OFFSET: usize = offset_of!(GuestRegisters, r12);
const R13_OFFSET: usize = offset_of!(GuestRegisters, r13);
const R14_OFFSET: usize = offset_of!(GuestRegisters, r14);
const R15_OFFSET: usize = offset_of!(GuestRegisters, r15);
naked_asm!(
"push rax",
"mov rax, [rsp+8]",
"pop [rax+{0}]",
"add rsp, 8",
"mov [rax+{1}], rcx",
"mov [rax+{2}], rdx",
"mov [rax+{3}], rbx",
"mov [rax+{4}], rsi",
"mov [rax+{5}], rdi",
"mov [rax+{6}], rbp",
"mov [rax+{7}], r8",
"mov [rax+{8}], r9",
"mov [rax+{9}], r10",
"mov [rax+{10}], r11",
"mov [rax+{11}], r12",
"mov [rax+{12}], r13",
"mov [rax+{13}], r14",
"mov [rax+{14}], r15",
"pop rbx",
"pop r12",
"pop r13",
"pop r14",
"pop r15",
"pop rbp",
"mov rax, 0",
"ret",
const RAX_OFFSET,
const RCX_OFFSET,
const RDX_OFFSET,
const RBX_OFFSET,
const RSI_OFFSET,
const RDI_OFFSET,
const RBP_OFFSET,
const R8_OFFSET,
const R9_OFFSET,
const R10_OFFSET,
const R11_OFFSET,
const R12_OFFSET,
const R13_OFFSET,
const R14_OFFSET,
const R15_OFFSET,
)
}
} }