// Copyright © 2021 Intel Corporation // // SPDX-License-Identifier: Apache-2.0 // use crate::vfio::{Interrupt, Vfio, VfioCommon, VfioError}; use crate::{BarReprogrammingParams, PciBarRegionType, VfioPciError}; use crate::{ PciClassCode, PciConfiguration, PciDevice, PciDeviceError, PciHeaderType, PciSubclass, }; use hypervisor::HypervisorVmError; use std::any::Any; use std::os::unix::prelude::AsRawFd; use std::ptr::null_mut; use std::sync::{Arc, Barrier, Mutex}; use std::u32; use thiserror::Error; use vfio_bindings::bindings::vfio::*; use vfio_ioctls::VfioIrq; use vfio_user::{Client, Error as VfioUserError}; use vm_allocator::{AddressAllocator, SystemAllocator}; use vm_device::dma_mapping::ExternalDmaMapping; use vm_device::interrupt::{InterruptManager, InterruptSourceGroup, MsiIrqGroupConfig}; use vm_device::BusDevice; use vm_memory::bitmap::AtomicBitmap; use vm_memory::{ Address, GuestAddress, GuestAddressSpace, GuestMemory, GuestMemoryRegion, GuestRegionMmap, GuestUsize, }; use vmm_sys_util::eventfd::EventFd; pub struct VfioUserPciDevice { vm: Arc, client: Arc>, vfio_wrapper: VfioUserClientWrapper, common: VfioCommon, } #[derive(Error, Debug)] pub enum VfioUserPciDeviceError { #[error("Client error: {0}")] Client(#[source] VfioUserError), #[error("Failed to map VFIO PCI region into guest: {0}")] MapRegionGuest(#[source] HypervisorVmError), #[error("Failed to DMA map: {0}")] DmaMap(#[source] VfioUserError), #[error("Failed to DMA unmap: {0}")] DmaUnmap(#[source] VfioUserError), #[error("Failed to initialize legacy interrupts: {0}")] InitializeLegacyInterrupts(#[source] VfioPciError), } #[derive(Copy, Clone)] enum PciVfioUserSubclass { VfioUserSubclass = 0xff, } impl PciSubclass for PciVfioUserSubclass { fn get_register_value(&self) -> u8 { *self as u8 } } impl VfioUserPciDevice { pub fn new( vm: &Arc, client: Arc>, msi_interrupt_manager: &Arc>, legacy_interrupt_group: Option>, ) -> Result { // This is used for the BAR and capabilities only let configuration = PciConfiguration::new( 0, 0, 0, PciClassCode::Other, &PciVfioUserSubclass::VfioUserSubclass, None, PciHeaderType::Device, 0, 0, None, ); let resettable = client.lock().unwrap().resettable(); if resettable { client .lock() .unwrap() .reset() .map_err(VfioUserPciDeviceError::Client)?; } let vfio_wrapper = VfioUserClientWrapper { client: client.clone(), }; let mut common = VfioCommon { mmio_regions: Vec::new(), configuration, interrupt: Interrupt { intx: None, msi: None, msix: None, }, }; common.parse_capabilities(msi_interrupt_manager, &vfio_wrapper); common .initialize_legacy_interrupt(legacy_interrupt_group, &vfio_wrapper) .map_err(VfioUserPciDeviceError::InitializeLegacyInterrupts)?; Ok(Self { vm: vm.clone(), client, vfio_wrapper, common, }) } pub fn map_mmio_regions( &mut self, vm: &Arc, mem_slot: F, ) -> Result<(), VfioUserPciDeviceError> where F: Fn() -> u32, { for mmio_region in &mut self.common.mmio_regions { let region_flags = self .client .lock() .unwrap() .region(mmio_region.index) .unwrap() .flags; let file_offset = self .client .lock() .unwrap() .region(mmio_region.index) .unwrap() .file_offset .clone(); if region_flags & VFIO_REGION_INFO_FLAG_MMAP != 0 { let mut prot = 0; if region_flags & VFIO_REGION_INFO_FLAG_READ != 0 { prot |= libc::PROT_READ; } if region_flags & VFIO_REGION_INFO_FLAG_WRITE != 0 { prot |= libc::PROT_WRITE; } let host_addr = unsafe { libc::mmap( null_mut(), mmio_region.length as usize, prot, libc::MAP_SHARED, file_offset.as_ref().unwrap().file().as_raw_fd(), file_offset.as_ref().unwrap().start() as libc::off_t, ) }; if host_addr == libc::MAP_FAILED { error!( "Could not mmap regions, error:{}", std::io::Error::last_os_error() ); continue; } let slot = mem_slot(); let mem_region = vm.make_user_memory_region( slot, mmio_region.start.0, mmio_region.length as u64, host_addr as u64, false, false, ); vm.create_user_memory_region(mem_region) .map_err(VfioUserPciDeviceError::MapRegionGuest)?; mmio_region.mem_slot = Some(slot); mmio_region.host_addr = Some(host_addr as u64); mmio_region.mmap_size = Some(mmio_region.length as usize); } } Ok(()) } pub fn unmap_mmio_regions(&mut self) { for mmio_region in self.common.mmio_regions.iter() { if let (Some(host_addr), Some(mmap_size), Some(mem_slot)) = ( mmio_region.host_addr, mmio_region.mmap_size, mmio_region.mem_slot, ) { // Remove region let r = self.vm.make_user_memory_region( mem_slot, mmio_region.start.raw_value(), mmap_size as u64, host_addr as u64, false, false, ); if let Err(e) = self.vm.remove_user_memory_region(r) { error!("Could not remove the userspace memory region: {}", e); } let ret = unsafe { libc::munmap(host_addr as *mut libc::c_void, mmap_size) }; if ret != 0 { error!( "Could not unmap region {}, error:{}", mmio_region.index, std::io::Error::last_os_error() ); } } } } pub fn dma_map( &mut self, region: &GuestRegionMmap, ) -> Result<(), VfioUserPciDeviceError> { let (fd, offset) = match region.file_offset() { Some(_file_offset) => (_file_offset.file().as_raw_fd(), _file_offset.start()), None => return Ok(()), }; self.client .lock() .unwrap() .dma_map( offset, region.start_addr().raw_value(), region.len() as u64, fd, ) .map_err(VfioUserPciDeviceError::DmaMap) } pub fn dma_unmap( &mut self, region: &GuestRegionMmap, ) -> Result<(), VfioUserPciDeviceError> { self.client .lock() .unwrap() .dma_unmap(region.start_addr().raw_value(), region.len() as u64) .map_err(VfioUserPciDeviceError::DmaUnmap) } } impl BusDevice for VfioUserPciDevice { fn read(&mut self, base: u64, offset: u64, data: &mut [u8]) { self.read_bar(base, offset, data) } fn write(&mut self, base: u64, offset: u64, data: &[u8]) -> Option> { self.write_bar(base, offset, data) } } #[repr(u32)] #[derive(Debug, PartialEq, Eq, PartialOrd, Ord)] #[allow(dead_code)] enum Regions { Bar0, Bar1, Bar2, Bar3, Bar4, Bar5, Rom, Config, Vga, Migration, } struct VfioUserClientWrapper { client: Arc>, } impl Vfio for VfioUserClientWrapper { fn region_read(&self, index: u32, offset: u64, data: &mut [u8]) { self.client .lock() .unwrap() .region_read(index, offset, data) .ok(); } fn region_write(&self, index: u32, offset: u64, data: &[u8]) { self.client .lock() .unwrap() .region_write(index, offset, data) .ok(); } fn get_irq_info(&self, irq_index: u32) -> Option { self.client .lock() .unwrap() .get_irq_info(irq_index) .ok() .map(|i| VfioIrq { index: i.index, flags: i.flags, count: i.count, }) } fn enable_irq(&self, irq_index: u32, event_fds: Vec<&EventFd>) -> Result<(), VfioError> { info!( "Enabling IRQ {:x} number of fds = {:?}", irq_index, event_fds.len() ); let fds: Vec = event_fds.iter().map(|e| e.as_raw_fd()).collect(); self.client .lock() .unwrap() .set_irqs( irq_index, VFIO_IRQ_SET_DATA_EVENTFD | VFIO_IRQ_SET_ACTION_TRIGGER, 0, event_fds.len() as u32, &fds, ) .map_err(VfioError::VfioUser) } fn disable_irq(&self, irq_index: u32) -> Result<(), VfioError> { info!("Disabling IRQ {:x}", irq_index); self.client .lock() .unwrap() .set_irqs( irq_index, VFIO_IRQ_SET_DATA_NONE | VFIO_IRQ_SET_ACTION_TRIGGER, 0, 0, &[], ) .map_err(VfioError::VfioUser) } fn unmask_irq(&self, irq_index: u32) -> Result<(), VfioError> { info!("Unmasking IRQ {:x}", irq_index); self.client .lock() .unwrap() .set_irqs( irq_index, VFIO_IRQ_SET_DATA_NONE | VFIO_IRQ_SET_ACTION_UNMASK, 0, 1, &[], ) .map_err(VfioError::VfioUser) } } impl PciDevice for VfioUserPciDevice { fn allocate_bars( &mut self, allocator: &mut SystemAllocator, mmio_allocator: &mut AddressAllocator, ) -> Result, PciDeviceError> { self.common .allocate_bars(allocator, mmio_allocator, &self.vfio_wrapper) } fn free_bars( &mut self, allocator: &mut SystemAllocator, mmio_allocator: &mut AddressAllocator, ) -> Result<(), PciDeviceError> { self.common.free_bars(allocator, mmio_allocator) } fn as_any(&mut self) -> &mut dyn Any { self } fn detect_bar_reprogramming( &mut self, reg_idx: usize, data: &[u8], ) -> Option { self.common .configuration .detect_bar_reprogramming(reg_idx, data) } fn write_config_register( &mut self, reg_idx: usize, offset: u64, data: &[u8], ) -> Option> { self.common .write_config_register(reg_idx, offset, data, &self.vfio_wrapper) } fn read_config_register(&mut self, reg_idx: usize) -> u32 { self.common .read_config_register(reg_idx, &self.vfio_wrapper) } fn read_bar(&mut self, base: u64, offset: u64, data: &mut [u8]) { self.common.read_bar(base, offset, data, &self.vfio_wrapper) } fn write_bar(&mut self, base: u64, offset: u64, data: &[u8]) -> Option> { self.common .write_bar(base, offset, data, &self.vfio_wrapper) } fn move_bar(&mut self, old_base: u64, new_base: u64) -> Result<(), std::io::Error> { info!("Moving BAR 0x{:x} -> 0x{:x}", old_base, new_base); for mmio_region in self.common.mmio_regions.iter_mut() { if mmio_region.start.raw_value() == old_base { mmio_region.start = GuestAddress(new_base); if let Some(mem_slot) = mmio_region.mem_slot { if let Some(host_addr) = mmio_region.host_addr { // Remove original region let old_region = self.vm.make_user_memory_region( mem_slot, old_base, mmio_region.length as u64, host_addr as u64, false, false, ); self.vm .remove_user_memory_region(old_region) .map_err(|e| std::io::Error::new(std::io::ErrorKind::Other, e))?; let new_region = self.vm.make_user_memory_region( mem_slot, new_base, mmio_region.length as u64, host_addr as u64, false, false, ); self.vm .create_user_memory_region(new_region) .map_err(|e| std::io::Error::new(std::io::ErrorKind::Other, e))?; } } info!("Moved bar 0x{:x} -> 0x{:x}", old_base, new_base); } } Ok(()) } } impl Drop for VfioUserPciDevice { fn drop(&mut self) { self.unmap_mmio_regions(); if let Some(msix) = &self.common.interrupt.msix { if msix.bar.enabled() { self.common.disable_msix(&self.vfio_wrapper); } } if let Some(msi) = &self.common.interrupt.msi { if msi.cfg.enabled() { self.common.disable_msi(&self.vfio_wrapper) } } if self.common.interrupt.intx_in_use() { self.common.disable_intx(&self.vfio_wrapper); } } } pub struct VfioUserDmaMapping { client: Arc>, memory: Arc, } impl VfioUserDmaMapping { pub fn new(client: Arc>, memory: Arc) -> Self { Self { client, memory } } } impl ExternalDmaMapping for VfioUserDmaMapping { fn map(&self, iova: u64, gpa: u64, size: u64) -> std::result::Result<(), std::io::Error> { let mem = self.memory.memory(); let guest_addr = GuestAddress(gpa); let region = mem.find_region(guest_addr); if let Some(region) = region { let file_offset = region.file_offset().unwrap(); let offset = (GuestAddress(gpa).checked_offset_from(region.start_addr())).unwrap() + file_offset.start(); self.client .lock() .unwrap() .dma_map(offset, iova, size, file_offset.file().as_raw_fd()) .map_err(|e| { std::io::Error::new( std::io::ErrorKind::Other, format!("Error mapping region: {}", e), ) }) } else { return Err(std::io::Error::new( std::io::ErrorKind::Other, format!("Region not found for 0x{:x}", gpa), )); } } fn unmap(&self, iova: u64, size: u64) -> std::result::Result<(), std::io::Error> { self.client .lock() .unwrap() .dma_unmap(iova, size) .map_err(|e| { std::io::Error::new( std::io::ErrorKind::Other, format!("Error unmapping region: {}", e), ) }) } }