178bf93f0SYJwu2023 #![allow(dead_code)] 278bf93f0SYJwu2023 // 目前仅支持单主桥单Segment 378bf93f0SYJwu2023 4cc36cf4aSYJwu2023 use super::pci_irq::{IrqType, PciIrqError}; 5*370472f7SLoGin use super::root::{pci_root_0, PciRoot}; 67ae679ddSLoGin use crate::arch::{PciArch, TraitPciArch}; 7e2841179SLoGin use crate::exception::IrqNumber; 878bf93f0SYJwu2023 use crate::libs::rwlock::{RwLock, RwLockReadGuard, RwLockWriteGuard}; 92dd9f0c7SLoGin 102dd9f0c7SLoGin use crate::mm::mmio_buddy::{mmio_pool, MMIOSpaceGuard}; 112dd9f0c7SLoGin 12*370472f7SLoGin use crate::mm::VirtAddr; 1378bf93f0SYJwu2023 use crate::{kdebug, kerror, kinfo, kwarn}; 142dd9f0c7SLoGin use alloc::sync::Arc; 1578bf93f0SYJwu2023 use alloc::vec::Vec; 1678bf93f0SYJwu2023 use alloc::{boxed::Box, collections::LinkedList}; 1726d84a31SYJwu2023 use bitflags::bitflags; 1840fe15e0SLoGin 1926d84a31SYJwu2023 use core::{ 2026d84a31SYJwu2023 convert::TryFrom, 215c1e552cSYJwu2023 fmt::{self, Debug, Display, Formatter}, 2226d84a31SYJwu2023 }; 2378bf93f0SYJwu2023 // PCI_DEVICE_LINKEDLIST 添加了读写锁的全局链表,里面存储了检索到的PCI设备结构体 2478bf93f0SYJwu2023 lazy_static! { 2578bf93f0SYJwu2023 pub static ref PCI_DEVICE_LINKEDLIST: PciDeviceLinkedList = PciDeviceLinkedList::new(); 262709e017SLoGin } 272709e017SLoGin 285c1e552cSYJwu2023 /// PCI域地址 295c1e552cSYJwu2023 #[derive(Clone, Copy, Eq, Ord, PartialEq, PartialOrd)] 305c1e552cSYJwu2023 #[repr(transparent)] 315c1e552cSYJwu2023 pub struct PciAddr(usize); 325c1e552cSYJwu2023 335c1e552cSYJwu2023 impl PciAddr { 345c1e552cSYJwu2023 #[inline(always)] 355c1e552cSYJwu2023 pub const fn new(address: usize) -> Self { 365c1e552cSYJwu2023 Self(address) 375c1e552cSYJwu2023 } 385c1e552cSYJwu2023 395c1e552cSYJwu2023 /// @brief 获取PCI域地址的值 405c1e552cSYJwu2023 #[inline(always)] 415c1e552cSYJwu2023 pub fn data(&self) -> usize { 425c1e552cSYJwu2023 self.0 435c1e552cSYJwu2023 } 445c1e552cSYJwu2023 455c1e552cSYJwu2023 /// @brief 将PCI域地址加上一个偏移量 465c1e552cSYJwu2023 #[inline(always)] 475c1e552cSYJwu2023 pub fn add(self, offset: usize) -> Self { 485c1e552cSYJwu2023 Self(self.0 + offset) 495c1e552cSYJwu2023 } 505c1e552cSYJwu2023 515c1e552cSYJwu2023 /// @brief 判断PCI域地址是否按照指定要求对齐 525c1e552cSYJwu2023 #[inline(always)] 535c1e552cSYJwu2023 pub fn check_aligned(&self, align: usize) -> bool { 545c1e552cSYJwu2023 return self.0 & (align - 1) == 0; 555c1e552cSYJwu2023 } 565c1e552cSYJwu2023 } 575c1e552cSYJwu2023 impl Debug for PciAddr { 585c1e552cSYJwu2023 fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result { 595c1e552cSYJwu2023 write!(f, "PciAddr({:#x})", self.0) 605c1e552cSYJwu2023 } 615c1e552cSYJwu2023 } 6278bf93f0SYJwu2023 6378bf93f0SYJwu2023 /// 添加了读写锁的链表,存储PCI设备结构体 6478bf93f0SYJwu2023 pub struct PciDeviceLinkedList { 6578bf93f0SYJwu2023 list: RwLock<LinkedList<Box<dyn PciDeviceStructure>>>, 6678bf93f0SYJwu2023 } 6778bf93f0SYJwu2023 6878bf93f0SYJwu2023 impl PciDeviceLinkedList { 6978bf93f0SYJwu2023 /// @brief 初始化结构体 7078bf93f0SYJwu2023 fn new() -> Self { 7178bf93f0SYJwu2023 PciDeviceLinkedList { 7278bf93f0SYJwu2023 list: RwLock::new(LinkedList::new()), 7378bf93f0SYJwu2023 } 7478bf93f0SYJwu2023 } 7578bf93f0SYJwu2023 /// @brief 获取可读的linkedlist(读锁守卫) 7678bf93f0SYJwu2023 /// @return RwLockReadGuard<LinkedList<Box<dyn PciDeviceStructure>>> 读锁守卫 7713776c11Slogin pub fn read(&self) -> RwLockReadGuard<LinkedList<Box<dyn PciDeviceStructure>>> { 7878bf93f0SYJwu2023 self.list.read() 7978bf93f0SYJwu2023 } 8078bf93f0SYJwu2023 /// @brief 获取可写的linkedlist(写锁守卫) 8178bf93f0SYJwu2023 /// @return RwLockWriteGuard<LinkedList<Box<dyn PciDeviceStructure>>> 写锁守卫 8213776c11Slogin pub fn write(&self) -> RwLockWriteGuard<LinkedList<Box<dyn PciDeviceStructure>>> { 8378bf93f0SYJwu2023 self.list.write() 8478bf93f0SYJwu2023 } 8578bf93f0SYJwu2023 /// @brief 获取链表中PCI结构体数目 8678bf93f0SYJwu2023 /// @return usize 链表中PCI结构体数目 8778bf93f0SYJwu2023 pub fn num(&self) -> usize { 8878bf93f0SYJwu2023 let list = self.list.read(); 8978bf93f0SYJwu2023 list.len() 9078bf93f0SYJwu2023 } 9178bf93f0SYJwu2023 /// @brief 添加Pci设备结构体到链表中 9278bf93f0SYJwu2023 pub fn add(&self, device: Box<dyn PciDeviceStructure>) { 9378bf93f0SYJwu2023 let mut list = self.list.write(); 9478bf93f0SYJwu2023 list.push_back(device); 9578bf93f0SYJwu2023 } 9678bf93f0SYJwu2023 } 9778bf93f0SYJwu2023 9878bf93f0SYJwu2023 /// @brief 在链表中寻找满足条件的PCI设备结构体并返回其可变引用 9978bf93f0SYJwu2023 /// @param list 链表的写锁守卫 10078bf93f0SYJwu2023 /// @param class_code 寄存器值 10178bf93f0SYJwu2023 /// @param subclass 寄存器值,与class_code一起确定设备类型 10278bf93f0SYJwu2023 /// @return Vec<&'a mut Box<(dyn PciDeviceStructure) 包含链表中所有满足条件的PCI结构体的可变引用的容器 10378bf93f0SYJwu2023 pub fn get_pci_device_structure_mut<'a>( 10478bf93f0SYJwu2023 list: &'a mut RwLockWriteGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>, 10578bf93f0SYJwu2023 class_code: u8, 10678bf93f0SYJwu2023 subclass: u8, 10778bf93f0SYJwu2023 ) -> Vec<&'a mut Box<(dyn PciDeviceStructure)>> { 10878bf93f0SYJwu2023 let mut result = Vec::new(); 10978bf93f0SYJwu2023 for box_pci_device_structure in list.iter_mut() { 11078bf93f0SYJwu2023 let common_header = (*box_pci_device_structure).common_header(); 11178bf93f0SYJwu2023 if (common_header.class_code == class_code) && (common_header.subclass == subclass) { 11278bf93f0SYJwu2023 result.push(box_pci_device_structure); 11378bf93f0SYJwu2023 } 11478bf93f0SYJwu2023 } 11578bf93f0SYJwu2023 result 11678bf93f0SYJwu2023 } 11778bf93f0SYJwu2023 /// @brief 在链表中寻找满足条件的PCI设备结构体并返回其不可变引用 11878bf93f0SYJwu2023 /// @param list 链表的读锁守卫 11978bf93f0SYJwu2023 /// @param class_code 寄存器值 12078bf93f0SYJwu2023 /// @param subclass 寄存器值,与class_code一起确定设备类型 12178bf93f0SYJwu2023 /// @return Vec<&'a Box<(dyn PciDeviceStructure) 包含链表中所有满足条件的PCI结构体的不可变引用的容器 122b5b571e0SLoGin #[allow(clippy::borrowed_box)] 12378bf93f0SYJwu2023 pub fn get_pci_device_structure<'a>( 12478bf93f0SYJwu2023 list: &'a mut RwLockReadGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>, 12578bf93f0SYJwu2023 class_code: u8, 12678bf93f0SYJwu2023 subclass: u8, 12778bf93f0SYJwu2023 ) -> Vec<&'a Box<(dyn PciDeviceStructure)>> { 12878bf93f0SYJwu2023 let mut result = Vec::new(); 12978bf93f0SYJwu2023 for box_pci_device_structure in list.iter() { 13078bf93f0SYJwu2023 let common_header = (*box_pci_device_structure).common_header(); 13178bf93f0SYJwu2023 if (common_header.class_code == class_code) && (common_header.subclass == subclass) { 13278bf93f0SYJwu2023 result.push(box_pci_device_structure); 13378bf93f0SYJwu2023 } 13478bf93f0SYJwu2023 } 13578bf93f0SYJwu2023 result 13678bf93f0SYJwu2023 } 13778bf93f0SYJwu2023 13826d84a31SYJwu2023 //Bar0寄存器的offset 13926d84a31SYJwu2023 const BAR0_OFFSET: u8 = 0x10; 14026d84a31SYJwu2023 //Status、Command寄存器的offset 14126d84a31SYJwu2023 const STATUS_COMMAND_OFFSET: u8 = 0x04; 14226d84a31SYJwu2023 /// ID for vendor-specific PCI capabilities.(Virtio Capabilities) 14326d84a31SYJwu2023 pub const PCI_CAP_ID_VNDR: u8 = 0x09; 144cc36cf4aSYJwu2023 pub const PCI_CAP_ID_MSI: u8 = 0x05; 145cc36cf4aSYJwu2023 pub const PCI_CAP_ID_MSIX: u8 = 0x11; 14678bf93f0SYJwu2023 pub const PORT_PCI_CONFIG_ADDRESS: u16 = 0xcf8; 14778bf93f0SYJwu2023 pub const PORT_PCI_CONFIG_DATA: u16 = 0xcfc; 14878bf93f0SYJwu2023 // pci设备分组的id 14978bf93f0SYJwu2023 pub type SegmentGroupNumber = u16; //理论上最多支持65535个Segment_Group 15026d84a31SYJwu2023 15126d84a31SYJwu2023 bitflags! { 15226d84a31SYJwu2023 /// The status register in PCI configuration space. 15326d84a31SYJwu2023 pub struct Status: u16 { 15426d84a31SYJwu2023 // Bits 0-2 are reserved. 15526d84a31SYJwu2023 /// The state of the device's INTx# signal. 15626d84a31SYJwu2023 const INTERRUPT_STATUS = 1 << 3; 15726d84a31SYJwu2023 /// The device has a linked list of capabilities. 15826d84a31SYJwu2023 const CAPABILITIES_LIST = 1 << 4; 15926d84a31SYJwu2023 /// The device is capabile of running at 66 MHz rather than 33 MHz. 16026d84a31SYJwu2023 const MHZ_66_CAPABLE = 1 << 5; 16126d84a31SYJwu2023 // Bit 6 is reserved. 16226d84a31SYJwu2023 /// The device can accept fast back-to-back transactions not from the same agent. 16326d84a31SYJwu2023 const FAST_BACK_TO_BACK_CAPABLE = 1 << 7; 16426d84a31SYJwu2023 /// The bus agent observed a parity error (if parity error handling is enabled). 16526d84a31SYJwu2023 const MASTER_DATA_PARITY_ERROR = 1 << 8; 16626d84a31SYJwu2023 // Bits 9-10 are DEVSEL timing. 16726d84a31SYJwu2023 /// A target device terminated a transaction with target-abort. 16826d84a31SYJwu2023 const SIGNALED_TARGET_ABORT = 1 << 11; 16926d84a31SYJwu2023 /// A master device transaction was terminated with target-abort. 17026d84a31SYJwu2023 const RECEIVED_TARGET_ABORT = 1 << 12; 17126d84a31SYJwu2023 /// A master device transaction was terminated with master-abort. 17226d84a31SYJwu2023 const RECEIVED_MASTER_ABORT = 1 << 13; 17326d84a31SYJwu2023 /// A device asserts SERR#. 17426d84a31SYJwu2023 const SIGNALED_SYSTEM_ERROR = 1 << 14; 17526d84a31SYJwu2023 /// The device detects a parity error, even if parity error handling is disabled. 17626d84a31SYJwu2023 const DETECTED_PARITY_ERROR = 1 << 15; 17726d84a31SYJwu2023 } 17826d84a31SYJwu2023 } 17926d84a31SYJwu2023 18026d84a31SYJwu2023 bitflags! { 18126d84a31SYJwu2023 /// The command register in PCI configuration space. 18278bf93f0SYJwu2023 pub struct Command: u16 { 18326d84a31SYJwu2023 /// The device can respond to I/O Space accesses. 18426d84a31SYJwu2023 const IO_SPACE = 1 << 0; 18526d84a31SYJwu2023 /// The device can respond to Memory Space accesses. 18626d84a31SYJwu2023 const MEMORY_SPACE = 1 << 1; 18726d84a31SYJwu2023 /// The device can behave as a bus master. 18826d84a31SYJwu2023 const BUS_MASTER = 1 << 2; 18926d84a31SYJwu2023 /// The device can monitor Special Cycle operations. 19026d84a31SYJwu2023 const SPECIAL_CYCLES = 1 << 3; 19126d84a31SYJwu2023 /// The device can generate the Memory Write and Invalidate command. 19226d84a31SYJwu2023 const MEMORY_WRITE_AND_INVALIDATE_ENABLE = 1 << 4; 19326d84a31SYJwu2023 /// The device will snoop palette register data. 19426d84a31SYJwu2023 const VGA_PALETTE_SNOOP = 1 << 5; 19526d84a31SYJwu2023 /// The device should take its normal action when a parity error is detected. 19626d84a31SYJwu2023 const PARITY_ERROR_RESPONSE = 1 << 6; 19726d84a31SYJwu2023 // Bit 7 is reserved. 19826d84a31SYJwu2023 /// The SERR# driver is enabled. 19926d84a31SYJwu2023 const SERR_ENABLE = 1 << 8; 20026d84a31SYJwu2023 /// The device is allowed to generate fast back-to-back transactions. 20126d84a31SYJwu2023 const FAST_BACK_TO_BACK_ENABLE = 1 << 9; 20226d84a31SYJwu2023 /// Assertion of the device's INTx# signal is disabled. 20326d84a31SYJwu2023 const INTERRUPT_DISABLE = 1 << 10; 20426d84a31SYJwu2023 } 20526d84a31SYJwu2023 } 20626d84a31SYJwu2023 20778bf93f0SYJwu2023 /// The type of a PCI device function header. 20878bf93f0SYJwu2023 /// 标头类型/设备类型 20978bf93f0SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)] 21078bf93f0SYJwu2023 pub enum HeaderType { 21178bf93f0SYJwu2023 /// A normal PCI device. 21278bf93f0SYJwu2023 Standard, 21378bf93f0SYJwu2023 /// A PCI to PCI bridge. 21478bf93f0SYJwu2023 PciPciBridge, 21578bf93f0SYJwu2023 /// A PCI to CardBus bridge. 21678bf93f0SYJwu2023 PciCardbusBridge, 21778bf93f0SYJwu2023 /// Unrecognised header type. 21878bf93f0SYJwu2023 Unrecognised(u8), 21978bf93f0SYJwu2023 } 22078bf93f0SYJwu2023 /// u8到HeaderType的转换 22178bf93f0SYJwu2023 impl From<u8> for HeaderType { 22278bf93f0SYJwu2023 fn from(value: u8) -> Self { 22378bf93f0SYJwu2023 match value { 22478bf93f0SYJwu2023 0x00 => Self::Standard, 22578bf93f0SYJwu2023 0x01 => Self::PciPciBridge, 22678bf93f0SYJwu2023 0x02 => Self::PciCardbusBridge, 22778bf93f0SYJwu2023 _ => Self::Unrecognised(value), 22878bf93f0SYJwu2023 } 22978bf93f0SYJwu2023 } 23078bf93f0SYJwu2023 } 23178bf93f0SYJwu2023 /// Pci可能触发的各种错误 23278bf93f0SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)] 23378bf93f0SYJwu2023 pub enum PciError { 23478bf93f0SYJwu2023 /// The device reported an invalid BAR type. 23578bf93f0SYJwu2023 InvalidBarType, 23678bf93f0SYJwu2023 CreateMmioError, 23778bf93f0SYJwu2023 InvalidBusDeviceFunction, 23878bf93f0SYJwu2023 SegmentNotFound, 239cc36cf4aSYJwu2023 McfgTableNotFound, 24078bf93f0SYJwu2023 GetWrongHeader, 24178bf93f0SYJwu2023 UnrecognisedHeaderType, 24278bf93f0SYJwu2023 PciDeviceStructureTransformError, 243cc36cf4aSYJwu2023 PciIrqError(PciIrqError), 24478bf93f0SYJwu2023 } 24578bf93f0SYJwu2023 ///实现PciError的Display trait,使其可以直接输出 24678bf93f0SYJwu2023 impl Display for PciError { 24778bf93f0SYJwu2023 fn fmt(&self, f: &mut Formatter) -> fmt::Result { 24878bf93f0SYJwu2023 match self { 24978bf93f0SYJwu2023 Self::InvalidBarType => write!(f, "Invalid PCI BAR type."), 25078bf93f0SYJwu2023 Self::CreateMmioError => write!(f, "Error occurred while creating mmio."), 25178bf93f0SYJwu2023 Self::InvalidBusDeviceFunction => write!(f, "Found invalid BusDeviceFunction."), 25278bf93f0SYJwu2023 Self::SegmentNotFound => write!(f, "Target segment not found"), 253cc36cf4aSYJwu2023 Self::McfgTableNotFound => write!(f, "ACPI MCFG Table not found"), 25478bf93f0SYJwu2023 Self::GetWrongHeader => write!(f, "GetWrongHeader with vendor id 0xffff"), 25578bf93f0SYJwu2023 Self::UnrecognisedHeaderType => write!(f, "Found device with unrecognised header type"), 25678bf93f0SYJwu2023 Self::PciDeviceStructureTransformError => { 25778bf93f0SYJwu2023 write!(f, "Found None When transform Pci device structure") 25878bf93f0SYJwu2023 } 259cc36cf4aSYJwu2023 Self::PciIrqError(err) => write!(f, "Error occurred while setting irq :{:?}.", err), 26078bf93f0SYJwu2023 } 26178bf93f0SYJwu2023 } 26278bf93f0SYJwu2023 } 26378bf93f0SYJwu2023 26478bf93f0SYJwu2023 /// trait类型Pci_Device_Structure表示pci设备,动态绑定三种具体设备类型:Pci_Device_Structure_General_Device、Pci_Device_Structure_Pci_to_Pci_Bridge、Pci_Device_Structure_Pci_to_Cardbus_Bridge 26578bf93f0SYJwu2023 pub trait PciDeviceStructure: Send + Sync { 26678bf93f0SYJwu2023 /// @brief 获取设备类型 26778bf93f0SYJwu2023 /// @return HeaderType 设备类型 26878bf93f0SYJwu2023 fn header_type(&self) -> HeaderType; 26978bf93f0SYJwu2023 /// @brief 当其为standard设备时返回&Pci_Device_Structure_General_Device,其余情况返回None 270cc36cf4aSYJwu2023 #[inline(always)] 27178bf93f0SYJwu2023 fn as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice> { 27278bf93f0SYJwu2023 None 27378bf93f0SYJwu2023 } 27478bf93f0SYJwu2023 /// @brief 当其为pci to pci bridge设备时返回&Pci_Device_Structure_Pci_to_Pci_Bridge,其余情况返回None 275cc36cf4aSYJwu2023 #[inline(always)] 27678bf93f0SYJwu2023 fn as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge> { 27778bf93f0SYJwu2023 None 27878bf93f0SYJwu2023 } 27978bf93f0SYJwu2023 /// @brief 当其为pci to cardbus bridge设备时返回&Pci_Device_Structure_Pci_to_Cardbus_Bridge,其余情况返回None 280cc36cf4aSYJwu2023 #[inline(always)] 28178bf93f0SYJwu2023 fn as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge> { 28278bf93f0SYJwu2023 None 28378bf93f0SYJwu2023 } 28478bf93f0SYJwu2023 /// @brief 获取Pci设备共有的common_header 28578bf93f0SYJwu2023 /// @return 返回其不可变引用 28678bf93f0SYJwu2023 fn common_header(&self) -> &PciDeviceStructureHeader; 28778bf93f0SYJwu2023 /// @brief 当其为standard设备时返回&mut Pci_Device_Structure_General_Device,其余情况返回None 288cc36cf4aSYJwu2023 #[inline(always)] 28978bf93f0SYJwu2023 fn as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice> { 29078bf93f0SYJwu2023 None 29178bf93f0SYJwu2023 } 29278bf93f0SYJwu2023 /// @brief 当其为pci to pci bridge设备时返回&mut Pci_Device_Structure_Pci_to_Pci_Bridge,其余情况返回None 293cc36cf4aSYJwu2023 #[inline(always)] 29478bf93f0SYJwu2023 fn as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge> { 29578bf93f0SYJwu2023 None 29678bf93f0SYJwu2023 } 29778bf93f0SYJwu2023 /// @brief 当其为pci to cardbus bridge设备时返回&mut Pci_Device_Structure_Pci_to_Cardbus_Bridge,其余情况返回None 298cc36cf4aSYJwu2023 #[inline(always)] 29978bf93f0SYJwu2023 fn as_pci_to_carbus_bridge_device_mut( 30078bf93f0SYJwu2023 &mut self, 30178bf93f0SYJwu2023 ) -> Option<&mut PciDeviceStructurePciToCardbusBridge> { 30278bf93f0SYJwu2023 None 30378bf93f0SYJwu2023 } 30478bf93f0SYJwu2023 /// @brief 返回迭代器,遍历capabilities 30578bf93f0SYJwu2023 fn capabilities(&self) -> Option<CapabilityIterator> { 30678bf93f0SYJwu2023 None 30778bf93f0SYJwu2023 } 30878bf93f0SYJwu2023 /// @brief 获取Status、Command寄存器的值 30978bf93f0SYJwu2023 fn status_command(&self) -> (Status, Command) { 31078bf93f0SYJwu2023 let common_header = self.common_header(); 31178bf93f0SYJwu2023 let status = Status::from_bits_truncate(common_header.status); 31278bf93f0SYJwu2023 let command = Command::from_bits_truncate(common_header.command); 31378bf93f0SYJwu2023 (status, command) 31478bf93f0SYJwu2023 } 31578bf93f0SYJwu2023 /// @brief 设置Command寄存器的值 31678bf93f0SYJwu2023 fn set_command(&mut self, command: Command) { 31778bf93f0SYJwu2023 let common_header = self.common_header_mut(); 31878bf93f0SYJwu2023 let command = command.bits(); 31978bf93f0SYJwu2023 common_header.command = command; 3202709e017SLoGin pci_root_0().write_config( 3212709e017SLoGin common_header.bus_device_function, 3222709e017SLoGin STATUS_COMMAND_OFFSET.into(), 32378bf93f0SYJwu2023 command as u32, 32478bf93f0SYJwu2023 ); 32578bf93f0SYJwu2023 } 32678bf93f0SYJwu2023 /// @brief 获取Pci设备共有的common_header 32778bf93f0SYJwu2023 /// @return 返回其可变引用 32878bf93f0SYJwu2023 fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader; 329cc36cf4aSYJwu2023 33078bf93f0SYJwu2023 /// @brief 读取standard设备的bar寄存器,映射后将结果加入结构体的standard_device_bar变量 33178bf93f0SYJwu2023 /// @return 只有standard设备才返回成功或者错误,其余返回None 332cc36cf4aSYJwu2023 #[inline(always)] 333cc36cf4aSYJwu2023 fn bar_ioremap(&mut self) -> Option<Result<u8, PciError>> { 33478bf93f0SYJwu2023 None 33578bf93f0SYJwu2023 } 336cc36cf4aSYJwu2023 /// @brief 获取PCI设备的bar寄存器的引用 337cc36cf4aSYJwu2023 /// @return 338cc36cf4aSYJwu2023 #[inline(always)] 339cc36cf4aSYJwu2023 fn bar(&mut self) -> Option<&PciStandardDeviceBar> { 34078bf93f0SYJwu2023 None 34178bf93f0SYJwu2023 } 342cc36cf4aSYJwu2023 /// @brief 通过设置该pci设备的command 34378bf93f0SYJwu2023 fn enable_master(&mut self) { 34478bf93f0SYJwu2023 self.set_command(Command::IO_SPACE | Command::MEMORY_SPACE | Command::BUS_MASTER); 34578bf93f0SYJwu2023 } 346cc36cf4aSYJwu2023 /// @brief 寻找设备的msix空间的offset 347cc36cf4aSYJwu2023 fn msix_capability_offset(&self) -> Option<u8> { 348cc36cf4aSYJwu2023 for capability in self.capabilities()? { 349cc36cf4aSYJwu2023 if capability.id == PCI_CAP_ID_MSIX { 350cc36cf4aSYJwu2023 return Some(capability.offset); 351cc36cf4aSYJwu2023 } 352cc36cf4aSYJwu2023 } 353cc36cf4aSYJwu2023 None 354cc36cf4aSYJwu2023 } 355cc36cf4aSYJwu2023 /// @brief 寻找设备的msi空间的offset 356cc36cf4aSYJwu2023 fn msi_capability_offset(&self) -> Option<u8> { 357cc36cf4aSYJwu2023 for capability in self.capabilities()? { 358cc36cf4aSYJwu2023 if capability.id == PCI_CAP_ID_MSI { 359cc36cf4aSYJwu2023 return Some(capability.offset); 360cc36cf4aSYJwu2023 } 361cc36cf4aSYJwu2023 } 362cc36cf4aSYJwu2023 None 363cc36cf4aSYJwu2023 } 364cc36cf4aSYJwu2023 /// @brief 返回结构体中的irq_type的可变引用 365cc36cf4aSYJwu2023 fn irq_type_mut(&mut self) -> Option<&mut IrqType>; 366cc36cf4aSYJwu2023 /// @brief 返回结构体中的irq_vector的可变引用 367e2841179SLoGin fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>>; 36878bf93f0SYJwu2023 } 36978bf93f0SYJwu2023 37078bf93f0SYJwu2023 /// Pci_Device_Structure_Header PCI设备结构体共有的头部 37178bf93f0SYJwu2023 #[derive(Clone, Debug)] 37278bf93f0SYJwu2023 pub struct PciDeviceStructureHeader { 37378bf93f0SYJwu2023 // ==== busdevicefunction变量表示该结构体所处的位置 37478bf93f0SYJwu2023 pub bus_device_function: BusDeviceFunction, 37578bf93f0SYJwu2023 pub vendor_id: u16, // 供应商ID 0xffff是一个无效值,在读取访问不存在的设备的配置空间寄存器时返回 37678bf93f0SYJwu2023 pub device_id: u16, // 设备ID,标志特定设备 37778bf93f0SYJwu2023 pub command: u16, // 提供对设备生成和响应pci周期的能力的控制 向该寄存器写入0时,设备与pci总线断开除配置空间访问以外的所有连接 37878bf93f0SYJwu2023 pub status: u16, // 用于记录pci总线相关时间的状态信息寄存器 37978bf93f0SYJwu2023 pub revision_id: u8, // 修订ID,指定特定设备的修订标志符 38078bf93f0SYJwu2023 pub prog_if: u8, // 编程接口字节,一个只读寄存器,指定设备具有的寄存器级别的编程接口(如果有的话) 38178bf93f0SYJwu2023 pub subclass: u8, // 子类。指定设备执行的特定功能的只读寄存器 38278bf93f0SYJwu2023 pub class_code: u8, // 类代码,一个只读寄存器,指定设备执行的功能类型 38378bf93f0SYJwu2023 pub cache_line_size: u8, // 缓存线大小:以 32 位为单位指定系统缓存线大小。设备可以限制它可以支持的缓存线大小的数量,如果不支持的值写入该字段,设备将表现得好像写入了 0 值 38478bf93f0SYJwu2023 pub latency_timer: u8, // 延迟计时器:以 PCI 总线时钟为单位指定延迟计时器。 38578bf93f0SYJwu2023 pub header_type: u8, // 标头类型 a value of 0x0 specifies a general device, a value of 0x1 specifies a PCI-to-PCI bridge, and a value of 0x2 specifies a CardBus bridge. If bit 7 of this register is set, the device has multiple functions; otherwise, it is a single function device. 38678bf93f0SYJwu2023 pub bist: u8, // Represents that status and allows control of a devices BIST (built-in self test). 38778bf93f0SYJwu2023 // Here is the layout of the BIST register: 38878bf93f0SYJwu2023 // | bit7 | bit6 | Bits 5-4 | Bits 3-0 | 38978bf93f0SYJwu2023 // | BIST Capable | Start BIST | Reserved | Completion Code | 39078bf93f0SYJwu2023 // for more details, please visit https://wiki.osdev.org/PCI 39178bf93f0SYJwu2023 } 39278bf93f0SYJwu2023 39378bf93f0SYJwu2023 /// Pci_Device_Structure_General_Device PCI标准设备结构体 39478bf93f0SYJwu2023 #[derive(Clone, Debug)] 39578bf93f0SYJwu2023 pub struct PciDeviceStructureGeneralDevice { 39678bf93f0SYJwu2023 pub common_header: PciDeviceStructureHeader, 397cc36cf4aSYJwu2023 // 中断结构体,包括legacy,msi,msix三种情况 398cc36cf4aSYJwu2023 pub irq_type: IrqType, 399cc36cf4aSYJwu2023 // 使用的中断号的vec集合 400e2841179SLoGin pub irq_vector: Vec<IrqNumber>, 40178bf93f0SYJwu2023 pub standard_device_bar: PciStandardDeviceBar, 40278bf93f0SYJwu2023 pub cardbus_cis_pointer: u32, // 指向卡信息结构,供在 CardBus 和 PCI 之间共享芯片的设备使用。 40378bf93f0SYJwu2023 pub subsystem_vendor_id: u16, 40478bf93f0SYJwu2023 pub subsystem_id: u16, 40578bf93f0SYJwu2023 pub expansion_rom_base_address: u32, 40678bf93f0SYJwu2023 pub capabilities_pointer: u8, 40778bf93f0SYJwu2023 pub reserved0: u8, 40878bf93f0SYJwu2023 pub reserved1: u16, 40978bf93f0SYJwu2023 pub reserved2: u32, 41078bf93f0SYJwu2023 pub interrupt_line: u8, // 指定设备的中断引脚连接到系统中断控制器的哪个输入,并由任何使用中断引脚的设备实现。对于 x86 架构,此寄存器对应于 PIC IRQ 编号 0-15(而不是 I/O APIC IRQ 编号),并且值0xFF定义为无连接。 41178bf93f0SYJwu2023 pub interrupt_pin: u8, // 指定设备使用的中断引脚。其中值为0x1INTA#、0x2INTB#、0x3INTC#、0x4INTD#,0x0表示设备不使用中断引脚。 41278bf93f0SYJwu2023 pub min_grant: u8, // 一个只读寄存器,用于指定设备所需的突发周期长度(以 1/4 微秒为单位)(假设时钟速率为 33 MHz) 41378bf93f0SYJwu2023 pub max_latency: u8, // 一个只读寄存器,指定设备需要多长时间访问一次 PCI 总线(以 1/4 微秒为单位)。 41478bf93f0SYJwu2023 } 41578bf93f0SYJwu2023 impl PciDeviceStructure for PciDeviceStructureGeneralDevice { 416cc36cf4aSYJwu2023 #[inline(always)] 41778bf93f0SYJwu2023 fn header_type(&self) -> HeaderType { 41878bf93f0SYJwu2023 HeaderType::Standard 41978bf93f0SYJwu2023 } 420cc36cf4aSYJwu2023 #[inline(always)] 42178bf93f0SYJwu2023 fn as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice> { 42278bf93f0SYJwu2023 Some(self) 42378bf93f0SYJwu2023 } 424cc36cf4aSYJwu2023 #[inline(always)] 42578bf93f0SYJwu2023 fn as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice> { 42678bf93f0SYJwu2023 Some(self) 42778bf93f0SYJwu2023 } 428cc36cf4aSYJwu2023 #[inline(always)] 42978bf93f0SYJwu2023 fn common_header(&self) -> &PciDeviceStructureHeader { 43078bf93f0SYJwu2023 &self.common_header 43178bf93f0SYJwu2023 } 432cc36cf4aSYJwu2023 #[inline(always)] 43378bf93f0SYJwu2023 fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader { 43478bf93f0SYJwu2023 &mut self.common_header 43578bf93f0SYJwu2023 } 43678bf93f0SYJwu2023 fn capabilities(&self) -> Option<CapabilityIterator> { 43778bf93f0SYJwu2023 Some(CapabilityIterator { 43878bf93f0SYJwu2023 bus_device_function: self.common_header.bus_device_function, 43978bf93f0SYJwu2023 next_capability_offset: Some(self.capabilities_pointer), 44078bf93f0SYJwu2023 }) 44178bf93f0SYJwu2023 } 442cc36cf4aSYJwu2023 fn bar_ioremap(&mut self) -> Option<Result<u8, PciError>> { 44378bf93f0SYJwu2023 let common_header = &self.common_header; 44478bf93f0SYJwu2023 match pci_bar_init(common_header.bus_device_function) { 44578bf93f0SYJwu2023 Ok(bar) => { 44678bf93f0SYJwu2023 self.standard_device_bar = bar; 44778bf93f0SYJwu2023 Some(Ok(0)) 44878bf93f0SYJwu2023 } 44978bf93f0SYJwu2023 Err(e) => Some(Err(e)), 45078bf93f0SYJwu2023 } 45178bf93f0SYJwu2023 } 452cc36cf4aSYJwu2023 fn bar(&mut self) -> Option<&PciStandardDeviceBar> { 453cc36cf4aSYJwu2023 Some(&self.standard_device_bar) 45478bf93f0SYJwu2023 } 455cc36cf4aSYJwu2023 #[inline(always)] 456cc36cf4aSYJwu2023 fn irq_type_mut(&mut self) -> Option<&mut IrqType> { 457cc36cf4aSYJwu2023 Some(&mut self.irq_type) 458cc36cf4aSYJwu2023 } 459cc36cf4aSYJwu2023 #[inline(always)] 460e2841179SLoGin fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>> { 461cc36cf4aSYJwu2023 Some(&mut self.irq_vector) 462cc36cf4aSYJwu2023 } 463cc36cf4aSYJwu2023 } 464cc36cf4aSYJwu2023 46578bf93f0SYJwu2023 /// Pci_Device_Structure_Pci_to_Pci_Bridge pci-to-pci桥设备结构体 46678bf93f0SYJwu2023 #[derive(Clone, Debug)] 46778bf93f0SYJwu2023 pub struct PciDeviceStructurePciToPciBridge { 46878bf93f0SYJwu2023 pub common_header: PciDeviceStructureHeader, 469cc36cf4aSYJwu2023 // 中断结构体,包括legacy,msi,msix三种情况 470cc36cf4aSYJwu2023 pub irq_type: IrqType, 471cc36cf4aSYJwu2023 // 使用的中断号的vec集合 472e2841179SLoGin pub irq_vector: Vec<IrqNumber>, 47378bf93f0SYJwu2023 pub bar0: u32, 47478bf93f0SYJwu2023 pub bar1: u32, 47578bf93f0SYJwu2023 pub primary_bus_number: u8, 47678bf93f0SYJwu2023 pub secondary_bus_number: u8, 47778bf93f0SYJwu2023 pub subordinate_bus_number: u8, 47878bf93f0SYJwu2023 pub secondary_latency_timer: u8, 47978bf93f0SYJwu2023 pub io_base: u8, 48078bf93f0SYJwu2023 pub io_limit: u8, 48178bf93f0SYJwu2023 pub secondary_status: u16, 48278bf93f0SYJwu2023 pub memory_base: u16, 48378bf93f0SYJwu2023 pub memory_limit: u16, 48478bf93f0SYJwu2023 pub prefetchable_memory_base: u16, 48578bf93f0SYJwu2023 pub prefetchable_memory_limit: u16, 48678bf93f0SYJwu2023 pub prefetchable_base_upper_32_bits: u32, 48778bf93f0SYJwu2023 pub prefetchable_limit_upper_32_bits: u32, 48878bf93f0SYJwu2023 pub io_base_upper_16_bits: u16, 48978bf93f0SYJwu2023 pub io_limit_upper_16_bits: u16, 49078bf93f0SYJwu2023 pub capability_pointer: u8, 49178bf93f0SYJwu2023 pub reserved0: u8, 49278bf93f0SYJwu2023 pub reserved1: u16, 49378bf93f0SYJwu2023 pub expansion_rom_base_address: u32, 49478bf93f0SYJwu2023 pub interrupt_line: u8, 49578bf93f0SYJwu2023 pub interrupt_pin: u8, 49678bf93f0SYJwu2023 pub bridge_control: u16, 49778bf93f0SYJwu2023 } 49878bf93f0SYJwu2023 impl PciDeviceStructure for PciDeviceStructurePciToPciBridge { 499cc36cf4aSYJwu2023 #[inline(always)] 50078bf93f0SYJwu2023 fn header_type(&self) -> HeaderType { 50178bf93f0SYJwu2023 HeaderType::PciPciBridge 50278bf93f0SYJwu2023 } 503cc36cf4aSYJwu2023 #[inline(always)] 50478bf93f0SYJwu2023 fn as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge> { 50578bf93f0SYJwu2023 Some(self) 50678bf93f0SYJwu2023 } 507cc36cf4aSYJwu2023 #[inline(always)] 50878bf93f0SYJwu2023 fn as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge> { 50978bf93f0SYJwu2023 Some(self) 51078bf93f0SYJwu2023 } 511cc36cf4aSYJwu2023 #[inline(always)] 51278bf93f0SYJwu2023 fn common_header(&self) -> &PciDeviceStructureHeader { 51378bf93f0SYJwu2023 &self.common_header 51478bf93f0SYJwu2023 } 515cc36cf4aSYJwu2023 #[inline(always)] 51678bf93f0SYJwu2023 fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader { 51778bf93f0SYJwu2023 &mut self.common_header 51878bf93f0SYJwu2023 } 519cc36cf4aSYJwu2023 #[inline(always)] 520cc36cf4aSYJwu2023 fn irq_type_mut(&mut self) -> Option<&mut IrqType> { 521cc36cf4aSYJwu2023 Some(&mut self.irq_type) 522cc36cf4aSYJwu2023 } 523cc36cf4aSYJwu2023 #[inline(always)] 524e2841179SLoGin fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>> { 525cc36cf4aSYJwu2023 Some(&mut self.irq_vector) 526cc36cf4aSYJwu2023 } 52778bf93f0SYJwu2023 } 52878bf93f0SYJwu2023 /// Pci_Device_Structure_Pci_to_Cardbus_Bridge Pci_to_Cardbus桥设备结构体 52978bf93f0SYJwu2023 #[derive(Clone, Debug)] 53078bf93f0SYJwu2023 pub struct PciDeviceStructurePciToCardbusBridge { 53178bf93f0SYJwu2023 pub common_header: PciDeviceStructureHeader, 53278bf93f0SYJwu2023 pub cardbus_socket_ex_ca_base_address: u32, 53378bf93f0SYJwu2023 pub offset_of_capabilities_list: u8, 53478bf93f0SYJwu2023 pub reserved: u8, 53578bf93f0SYJwu2023 pub secondary_status: u16, 53678bf93f0SYJwu2023 pub pci_bus_number: u8, 53778bf93f0SYJwu2023 pub card_bus_bus_number: u8, 53878bf93f0SYJwu2023 pub subordinate_bus_number: u8, 53978bf93f0SYJwu2023 pub card_bus_latency_timer: u8, 54078bf93f0SYJwu2023 pub memory_base_address0: u32, 54178bf93f0SYJwu2023 pub memory_limit0: u32, 54278bf93f0SYJwu2023 pub memory_base_address1: u32, 54378bf93f0SYJwu2023 pub memory_limit1: u32, 54478bf93f0SYJwu2023 pub io_base_address0: u32, 54578bf93f0SYJwu2023 pub io_limit0: u32, 54678bf93f0SYJwu2023 pub io_base_address1: u32, 54778bf93f0SYJwu2023 pub io_limit1: u32, 54878bf93f0SYJwu2023 pub interrupt_line: u8, 54978bf93f0SYJwu2023 pub interrupt_pin: u8, 55078bf93f0SYJwu2023 pub bridge_control: u16, 55178bf93f0SYJwu2023 pub subsystem_device_id: u16, 55278bf93f0SYJwu2023 pub subsystem_vendor_id: u16, 55378bf93f0SYJwu2023 pub pc_card_legacy_mode_base_address_16_bit: u32, 55478bf93f0SYJwu2023 } 55578bf93f0SYJwu2023 impl PciDeviceStructure for PciDeviceStructurePciToCardbusBridge { 556cc36cf4aSYJwu2023 #[inline(always)] 55778bf93f0SYJwu2023 fn header_type(&self) -> HeaderType { 55878bf93f0SYJwu2023 HeaderType::PciCardbusBridge 55978bf93f0SYJwu2023 } 560cc36cf4aSYJwu2023 #[inline(always)] 56178bf93f0SYJwu2023 fn as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge> { 562b5b571e0SLoGin Some(self) 56378bf93f0SYJwu2023 } 564cc36cf4aSYJwu2023 #[inline(always)] 56578bf93f0SYJwu2023 fn as_pci_to_carbus_bridge_device_mut( 56678bf93f0SYJwu2023 &mut self, 56778bf93f0SYJwu2023 ) -> Option<&mut PciDeviceStructurePciToCardbusBridge> { 56878bf93f0SYJwu2023 Some(self) 56978bf93f0SYJwu2023 } 570cc36cf4aSYJwu2023 #[inline(always)] 57178bf93f0SYJwu2023 fn common_header(&self) -> &PciDeviceStructureHeader { 57278bf93f0SYJwu2023 &self.common_header 57378bf93f0SYJwu2023 } 574cc36cf4aSYJwu2023 #[inline(always)] 57578bf93f0SYJwu2023 fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader { 57678bf93f0SYJwu2023 &mut self.common_header 57778bf93f0SYJwu2023 } 578cc36cf4aSYJwu2023 #[inline(always)] 579cc36cf4aSYJwu2023 fn irq_type_mut(&mut self) -> Option<&mut IrqType> { 580cc36cf4aSYJwu2023 None 581cc36cf4aSYJwu2023 } 582cc36cf4aSYJwu2023 #[inline(always)] 583e2841179SLoGin fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>> { 584cc36cf4aSYJwu2023 None 585cc36cf4aSYJwu2023 } 58678bf93f0SYJwu2023 } 58778bf93f0SYJwu2023 5882709e017SLoGin /// PCI配置空间访问机制 5892709e017SLoGin /// 5902709e017SLoGin /// 用于访问PCI设备的功能配置空间的一组机制。 5912709e017SLoGin #[derive(Copy, Clone, Debug, Eq, PartialEq)] 5922709e017SLoGin pub enum PciCam { 5932709e017SLoGin /// PCI内存映射配置访问机制 5942709e017SLoGin /// 5952709e017SLoGin /// 为每个设备功能提供256字节的配置空间访问。 5962709e017SLoGin MmioCam, 5972709e017SLoGin /// PCIe内存映射增强配置访问机制 5982709e017SLoGin /// 5992709e017SLoGin /// 为每个设备功能提供4千字节(4096字节)的配置空间访问。 6002709e017SLoGin Ecam, 6012709e017SLoGin } 6022709e017SLoGin 6032709e017SLoGin impl PciCam { 6042709e017SLoGin /// Returns the total size in bytes of the memory-mapped region. 6052709e017SLoGin pub const fn size(self) -> u32 { 6062709e017SLoGin match self { 6072709e017SLoGin Self::MmioCam => 0x1000000, 6082709e017SLoGin Self::Ecam => 0x10000000, 6092709e017SLoGin } 6102709e017SLoGin } 6112709e017SLoGin } 6122709e017SLoGin 61326d84a31SYJwu2023 /// Gets the capabilities 'pointer' for the device function, if any. 61426d84a31SYJwu2023 /// @brief 获取第一个capability 的offset 61578bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识 61626d84a31SYJwu2023 /// @return Option<u8> offset 61778bf93f0SYJwu2023 pub fn capabilities_offset(bus_device_function: BusDeviceFunction) -> Option<u8> { 6182709e017SLoGin let result = pci_root_0().read_config(bus_device_function, STATUS_COMMAND_OFFSET.into()); 61978bf93f0SYJwu2023 let status: Status = Status::from_bits_truncate((result >> 16) as u16); 62026d84a31SYJwu2023 if status.contains(Status::CAPABILITIES_LIST) { 6212709e017SLoGin let cap_pointer = pci_root_0().read_config(bus_device_function, 0x34) as u8 & 0xFC; 62226d84a31SYJwu2023 Some(cap_pointer) 62326d84a31SYJwu2023 } else { 62426d84a31SYJwu2023 None 62526d84a31SYJwu2023 } 62626d84a31SYJwu2023 } 62778bf93f0SYJwu2023 62878bf93f0SYJwu2023 /// @brief 读取pci设备头部 62978bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识 63078bf93f0SYJwu2023 /// @param add_to_list 是否添加到链表 63178bf93f0SYJwu2023 /// @return 返回的header(trait 类型) 63278bf93f0SYJwu2023 fn pci_read_header( 63378bf93f0SYJwu2023 bus_device_function: BusDeviceFunction, 63478bf93f0SYJwu2023 add_to_list: bool, 63578bf93f0SYJwu2023 ) -> Result<Box<dyn PciDeviceStructure>, PciError> { 63678bf93f0SYJwu2023 // 先读取公共header 6372709e017SLoGin let result = pci_root_0().read_config(bus_device_function, 0x00); 63878bf93f0SYJwu2023 let vendor_id = result as u16; 63978bf93f0SYJwu2023 let device_id = (result >> 16) as u16; 64078bf93f0SYJwu2023 6412709e017SLoGin let result = pci_root_0().read_config(bus_device_function, 0x04); 64278bf93f0SYJwu2023 let command = result as u16; 64378bf93f0SYJwu2023 let status = (result >> 16) as u16; 64478bf93f0SYJwu2023 6452709e017SLoGin let result = pci_root_0().read_config(bus_device_function, 0x08); 64678bf93f0SYJwu2023 let revision_id = result as u8; 64778bf93f0SYJwu2023 let prog_if = (result >> 8) as u8; 64878bf93f0SYJwu2023 let subclass = (result >> 16) as u8; 64978bf93f0SYJwu2023 let class_code = (result >> 24) as u8; 65078bf93f0SYJwu2023 6512709e017SLoGin let result = pci_root_0().read_config(bus_device_function, 0x0c); 65278bf93f0SYJwu2023 let cache_line_size = result as u8; 65378bf93f0SYJwu2023 let latency_timer = (result >> 8) as u8; 65478bf93f0SYJwu2023 let header_type = (result >> 16) as u8; 65578bf93f0SYJwu2023 let bist = (result >> 24) as u8; 65678bf93f0SYJwu2023 if vendor_id == 0xffff { 65778bf93f0SYJwu2023 return Err(PciError::GetWrongHeader); 65878bf93f0SYJwu2023 } 65978bf93f0SYJwu2023 let header = PciDeviceStructureHeader { 66078bf93f0SYJwu2023 bus_device_function, 66178bf93f0SYJwu2023 vendor_id, 66278bf93f0SYJwu2023 device_id, 66378bf93f0SYJwu2023 command, 66478bf93f0SYJwu2023 status, 66578bf93f0SYJwu2023 revision_id, 66678bf93f0SYJwu2023 prog_if, 66778bf93f0SYJwu2023 subclass, 66878bf93f0SYJwu2023 class_code, 66978bf93f0SYJwu2023 cache_line_size, 67078bf93f0SYJwu2023 latency_timer, 67178bf93f0SYJwu2023 header_type, 67278bf93f0SYJwu2023 bist, 67378bf93f0SYJwu2023 }; 67478bf93f0SYJwu2023 match HeaderType::from(header_type & 0x7f) { 67578bf93f0SYJwu2023 HeaderType::Standard => { 67678bf93f0SYJwu2023 let general_device = pci_read_general_device_header(header, &bus_device_function); 67778bf93f0SYJwu2023 let box_general_device = Box::new(general_device); 67878bf93f0SYJwu2023 let box_general_device_clone = box_general_device.clone(); 67978bf93f0SYJwu2023 if add_to_list { 68078bf93f0SYJwu2023 PCI_DEVICE_LINKEDLIST.add(box_general_device); 68178bf93f0SYJwu2023 } 68278bf93f0SYJwu2023 Ok(box_general_device_clone) 68378bf93f0SYJwu2023 } 68478bf93f0SYJwu2023 HeaderType::PciPciBridge => { 68578bf93f0SYJwu2023 let pci_to_pci_bridge = pci_read_pci_to_pci_bridge_header(header, &bus_device_function); 68678bf93f0SYJwu2023 let box_pci_to_pci_bridge = Box::new(pci_to_pci_bridge); 68778bf93f0SYJwu2023 let box_pci_to_pci_bridge_clone = box_pci_to_pci_bridge.clone(); 68878bf93f0SYJwu2023 if add_to_list { 68978bf93f0SYJwu2023 PCI_DEVICE_LINKEDLIST.add(box_pci_to_pci_bridge); 69078bf93f0SYJwu2023 } 69178bf93f0SYJwu2023 Ok(box_pci_to_pci_bridge_clone) 69278bf93f0SYJwu2023 } 69378bf93f0SYJwu2023 HeaderType::PciCardbusBridge => { 69478bf93f0SYJwu2023 let pci_cardbus_bridge = 69578bf93f0SYJwu2023 pci_read_pci_to_cardbus_bridge_header(header, &bus_device_function); 69678bf93f0SYJwu2023 let box_pci_cardbus_bridge = Box::new(pci_cardbus_bridge); 69778bf93f0SYJwu2023 let box_pci_cardbus_bridge_clone = box_pci_cardbus_bridge.clone(); 69878bf93f0SYJwu2023 if add_to_list { 69978bf93f0SYJwu2023 PCI_DEVICE_LINKEDLIST.add(box_pci_cardbus_bridge); 70078bf93f0SYJwu2023 } 70178bf93f0SYJwu2023 Ok(box_pci_cardbus_bridge_clone) 70278bf93f0SYJwu2023 } 70378bf93f0SYJwu2023 HeaderType::Unrecognised(_) => Err(PciError::UnrecognisedHeaderType), 70478bf93f0SYJwu2023 } 70578bf93f0SYJwu2023 } 70678bf93f0SYJwu2023 70778bf93f0SYJwu2023 /// @brief 读取type为0x0的pci设备的header 70878bf93f0SYJwu2023 /// 本函数只应被 pci_read_header()调用 70978bf93f0SYJwu2023 /// @param common_header 共有头部 71078bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识 71178bf93f0SYJwu2023 /// @return Pci_Device_Structure_General_Device 标准设备头部 71278bf93f0SYJwu2023 fn pci_read_general_device_header( 71378bf93f0SYJwu2023 common_header: PciDeviceStructureHeader, 71478bf93f0SYJwu2023 bus_device_function: &BusDeviceFunction, 71578bf93f0SYJwu2023 ) -> PciDeviceStructureGeneralDevice { 71678bf93f0SYJwu2023 let standard_device_bar = PciStandardDeviceBar::default(); 7172709e017SLoGin let cardbus_cis_pointer = pci_root_0().read_config(*bus_device_function, 0x28); 71878bf93f0SYJwu2023 7192709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x2c); 72078bf93f0SYJwu2023 let subsystem_vendor_id = result as u16; 72178bf93f0SYJwu2023 let subsystem_id = (result >> 16) as u16; 72278bf93f0SYJwu2023 7232709e017SLoGin let expansion_rom_base_address = pci_root_0().read_config(*bus_device_function, 0x30); 72478bf93f0SYJwu2023 7252709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x34); 72678bf93f0SYJwu2023 let capabilities_pointer = result as u8; 72778bf93f0SYJwu2023 let reserved0 = (result >> 8) as u8; 72878bf93f0SYJwu2023 let reserved1 = (result >> 16) as u16; 72978bf93f0SYJwu2023 7302709e017SLoGin let reserved2 = pci_root_0().read_config(*bus_device_function, 0x38); 73178bf93f0SYJwu2023 7322709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x3c); 73378bf93f0SYJwu2023 let interrupt_line = result as u8; 73478bf93f0SYJwu2023 let interrupt_pin = (result >> 8) as u8; 73578bf93f0SYJwu2023 let min_grant = (result >> 16) as u8; 73678bf93f0SYJwu2023 let max_latency = (result >> 24) as u8; 73778bf93f0SYJwu2023 PciDeviceStructureGeneralDevice { 73878bf93f0SYJwu2023 common_header, 739cc36cf4aSYJwu2023 irq_type: IrqType::Unused, 740cc36cf4aSYJwu2023 irq_vector: Vec::new(), 74178bf93f0SYJwu2023 standard_device_bar, 74278bf93f0SYJwu2023 cardbus_cis_pointer, 74378bf93f0SYJwu2023 subsystem_vendor_id, 74478bf93f0SYJwu2023 subsystem_id, 74578bf93f0SYJwu2023 expansion_rom_base_address, 74678bf93f0SYJwu2023 capabilities_pointer, 74778bf93f0SYJwu2023 reserved0, 74878bf93f0SYJwu2023 reserved1, 74978bf93f0SYJwu2023 reserved2, 75078bf93f0SYJwu2023 interrupt_line, 75178bf93f0SYJwu2023 interrupt_pin, 75278bf93f0SYJwu2023 min_grant, 75378bf93f0SYJwu2023 max_latency, 75478bf93f0SYJwu2023 } 75578bf93f0SYJwu2023 } 75678bf93f0SYJwu2023 75778bf93f0SYJwu2023 /// @brief 读取type为0x1的pci设备的header 75878bf93f0SYJwu2023 /// 本函数只应被 pci_read_header()调用 75978bf93f0SYJwu2023 /// @param common_header 共有头部 76078bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识 76178bf93f0SYJwu2023 /// @return Pci_Device_Structure_Pci_to_Pci_Bridge pci-to-pci 桥设备头部 76278bf93f0SYJwu2023 fn pci_read_pci_to_pci_bridge_header( 76378bf93f0SYJwu2023 common_header: PciDeviceStructureHeader, 76478bf93f0SYJwu2023 bus_device_function: &BusDeviceFunction, 76578bf93f0SYJwu2023 ) -> PciDeviceStructurePciToPciBridge { 7662709e017SLoGin let bar0 = pci_root_0().read_config(*bus_device_function, 0x10); 7672709e017SLoGin let bar1 = pci_root_0().read_config(*bus_device_function, 0x14); 76878bf93f0SYJwu2023 7692709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x18); 77078bf93f0SYJwu2023 77178bf93f0SYJwu2023 let primary_bus_number = result as u8; 77278bf93f0SYJwu2023 let secondary_bus_number = (result >> 8) as u8; 77378bf93f0SYJwu2023 let subordinate_bus_number = (result >> 16) as u8; 77478bf93f0SYJwu2023 let secondary_latency_timer = (result >> 24) as u8; 77578bf93f0SYJwu2023 7762709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x1c); 77778bf93f0SYJwu2023 let io_base = result as u8; 77878bf93f0SYJwu2023 let io_limit = (result >> 8) as u8; 77978bf93f0SYJwu2023 let secondary_status = (result >> 16) as u16; 78078bf93f0SYJwu2023 7812709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x20); 78278bf93f0SYJwu2023 let memory_base = result as u16; 78378bf93f0SYJwu2023 let memory_limit = (result >> 16) as u16; 78478bf93f0SYJwu2023 7852709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x24); 78678bf93f0SYJwu2023 let prefetchable_memory_base = result as u16; 78778bf93f0SYJwu2023 let prefetchable_memory_limit = (result >> 16) as u16; 78878bf93f0SYJwu2023 7892709e017SLoGin let prefetchable_base_upper_32_bits = pci_root_0().read_config(*bus_device_function, 0x28); 7902709e017SLoGin let prefetchable_limit_upper_32_bits = pci_root_0().read_config(*bus_device_function, 0x2c); 79178bf93f0SYJwu2023 7922709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x30); 79378bf93f0SYJwu2023 let io_base_upper_16_bits = result as u16; 79478bf93f0SYJwu2023 let io_limit_upper_16_bits = (result >> 16) as u16; 79578bf93f0SYJwu2023 7962709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x34); 79778bf93f0SYJwu2023 let capability_pointer = result as u8; 79878bf93f0SYJwu2023 let reserved0 = (result >> 8) as u8; 79978bf93f0SYJwu2023 let reserved1 = (result >> 16) as u16; 80078bf93f0SYJwu2023 8012709e017SLoGin let expansion_rom_base_address = pci_root_0().read_config(*bus_device_function, 0x38); 80278bf93f0SYJwu2023 8032709e017SLoGin let result = pci_root_0().read_config(*bus_device_function, 0x3c); 80478bf93f0SYJwu2023 let interrupt_line = result as u8; 80578bf93f0SYJwu2023 let interrupt_pin = (result >> 8) as u8; 80678bf93f0SYJwu2023 let bridge_control = (result >> 16) as u16; 80778bf93f0SYJwu2023 PciDeviceStructurePciToPciBridge { 80878bf93f0SYJwu2023 common_header, 809cc36cf4aSYJwu2023 irq_type: IrqType::Unused, 810cc36cf4aSYJwu2023 irq_vector: Vec::new(), 81178bf93f0SYJwu2023 bar0, 81278bf93f0SYJwu2023 bar1, 81378bf93f0SYJwu2023 primary_bus_number, 81478bf93f0SYJwu2023 secondary_bus_number, 81578bf93f0SYJwu2023 subordinate_bus_number, 81678bf93f0SYJwu2023 secondary_latency_timer, 81778bf93f0SYJwu2023 io_base, 81878bf93f0SYJwu2023 io_limit, 81978bf93f0SYJwu2023 secondary_status, 82078bf93f0SYJwu2023 memory_base, 82178bf93f0SYJwu2023 memory_limit, 82278bf93f0SYJwu2023 prefetchable_memory_base, 82378bf93f0SYJwu2023 prefetchable_memory_limit, 82478bf93f0SYJwu2023 prefetchable_base_upper_32_bits, 82578bf93f0SYJwu2023 prefetchable_limit_upper_32_bits, 82678bf93f0SYJwu2023 io_base_upper_16_bits, 82778bf93f0SYJwu2023 io_limit_upper_16_bits, 82878bf93f0SYJwu2023 capability_pointer, 82978bf93f0SYJwu2023 reserved0, 83078bf93f0SYJwu2023 reserved1, 83178bf93f0SYJwu2023 expansion_rom_base_address, 83278bf93f0SYJwu2023 interrupt_line, 83378bf93f0SYJwu2023 interrupt_pin, 83478bf93f0SYJwu2023 bridge_control, 83578bf93f0SYJwu2023 } 83678bf93f0SYJwu2023 } 83778bf93f0SYJwu2023 83878bf93f0SYJwu2023 /// @brief 读取type为0x2的pci设备的header 83978bf93f0SYJwu2023 /// 本函数只应被 pci_read_header()调用 84078bf93f0SYJwu2023 /// @param common_header 共有头部 84178bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识 842cc36cf4aSYJwu2023 /// @return Pci_Device_Structure_Pci_to_Cardbus_Bridge pci-to-cardbus 桥设备头部 84378bf93f0SYJwu2023 fn pci_read_pci_to_cardbus_bridge_header( 84478bf93f0SYJwu2023 common_header: PciDeviceStructureHeader, 84578bf93f0SYJwu2023 busdevicefunction: &BusDeviceFunction, 84678bf93f0SYJwu2023 ) -> PciDeviceStructurePciToCardbusBridge { 8472709e017SLoGin let cardbus_socket_ex_ca_base_address = pci_root_0().read_config(*busdevicefunction, 0x10); 84878bf93f0SYJwu2023 8492709e017SLoGin let result = pci_root_0().read_config(*busdevicefunction, 0x14); 85078bf93f0SYJwu2023 let offset_of_capabilities_list = result as u8; 85178bf93f0SYJwu2023 let reserved = (result >> 8) as u8; 85278bf93f0SYJwu2023 let secondary_status = (result >> 16) as u16; 85378bf93f0SYJwu2023 8542709e017SLoGin let result = pci_root_0().read_config(*busdevicefunction, 0x18); 85578bf93f0SYJwu2023 let pci_bus_number = result as u8; 85678bf93f0SYJwu2023 let card_bus_bus_number = (result >> 8) as u8; 85778bf93f0SYJwu2023 let subordinate_bus_number = (result >> 16) as u8; 85878bf93f0SYJwu2023 let card_bus_latency_timer = (result >> 24) as u8; 85978bf93f0SYJwu2023 8602709e017SLoGin let memory_base_address0 = pci_root_0().read_config(*busdevicefunction, 0x1c); 8612709e017SLoGin let memory_limit0 = pci_root_0().read_config(*busdevicefunction, 0x20); 8622709e017SLoGin let memory_base_address1 = pci_root_0().read_config(*busdevicefunction, 0x24); 8632709e017SLoGin let memory_limit1 = pci_root_0().read_config(*busdevicefunction, 0x28); 86478bf93f0SYJwu2023 8652709e017SLoGin let io_base_address0 = pci_root_0().read_config(*busdevicefunction, 0x2c); 8662709e017SLoGin let io_limit0 = pci_root_0().read_config(*busdevicefunction, 0x30); 8672709e017SLoGin let io_base_address1 = pci_root_0().read_config(*busdevicefunction, 0x34); 8682709e017SLoGin let io_limit1 = pci_root_0().read_config(*busdevicefunction, 0x38); 8692709e017SLoGin let result = pci_root_0().read_config(*busdevicefunction, 0x3c); 87078bf93f0SYJwu2023 let interrupt_line = result as u8; 87178bf93f0SYJwu2023 let interrupt_pin = (result >> 8) as u8; 87278bf93f0SYJwu2023 let bridge_control = (result >> 16) as u16; 87378bf93f0SYJwu2023 8742709e017SLoGin let result = pci_root_0().read_config(*busdevicefunction, 0x40); 87578bf93f0SYJwu2023 let subsystem_device_id = result as u16; 87678bf93f0SYJwu2023 let subsystem_vendor_id = (result >> 16) as u16; 87778bf93f0SYJwu2023 8782709e017SLoGin let pc_card_legacy_mode_base_address_16_bit = 8792709e017SLoGin pci_root_0().read_config(*busdevicefunction, 0x44); 88078bf93f0SYJwu2023 PciDeviceStructurePciToCardbusBridge { 88178bf93f0SYJwu2023 common_header, 88278bf93f0SYJwu2023 cardbus_socket_ex_ca_base_address, 88378bf93f0SYJwu2023 offset_of_capabilities_list, 88478bf93f0SYJwu2023 reserved, 88578bf93f0SYJwu2023 secondary_status, 88678bf93f0SYJwu2023 pci_bus_number, 88778bf93f0SYJwu2023 card_bus_bus_number, 88878bf93f0SYJwu2023 subordinate_bus_number, 88978bf93f0SYJwu2023 card_bus_latency_timer, 89078bf93f0SYJwu2023 memory_base_address0, 89178bf93f0SYJwu2023 memory_limit0, 89278bf93f0SYJwu2023 memory_base_address1, 89378bf93f0SYJwu2023 memory_limit1, 89478bf93f0SYJwu2023 io_base_address0, 89578bf93f0SYJwu2023 io_limit0, 89678bf93f0SYJwu2023 io_base_address1, 89778bf93f0SYJwu2023 io_limit1, 89878bf93f0SYJwu2023 interrupt_line, 89978bf93f0SYJwu2023 interrupt_pin, 90078bf93f0SYJwu2023 bridge_control, 90178bf93f0SYJwu2023 subsystem_device_id, 90278bf93f0SYJwu2023 subsystem_vendor_id, 90378bf93f0SYJwu2023 pc_card_legacy_mode_base_address_16_bit, 90478bf93f0SYJwu2023 } 90578bf93f0SYJwu2023 } 90678bf93f0SYJwu2023 90778bf93f0SYJwu2023 /// @brief 检查所有bus上的设备并将其加入链表 90878bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因 90978bf93f0SYJwu2023 fn pci_check_all_buses() -> Result<u8, PciError> { 91078bf93f0SYJwu2023 kinfo!("Checking all devices in PCI bus..."); 91178bf93f0SYJwu2023 let busdevicefunction = BusDeviceFunction { 91278bf93f0SYJwu2023 bus: 0, 91378bf93f0SYJwu2023 device: 0, 91478bf93f0SYJwu2023 function: 0, 91578bf93f0SYJwu2023 }; 91678bf93f0SYJwu2023 let header = pci_read_header(busdevicefunction, false)?; 91778bf93f0SYJwu2023 let common_header = header.common_header(); 91878bf93f0SYJwu2023 pci_check_bus(0)?; 91978bf93f0SYJwu2023 if common_header.header_type & 0x80 != 0 { 92078bf93f0SYJwu2023 for function in 1..8 { 92178bf93f0SYJwu2023 pci_check_bus(function)?; 92278bf93f0SYJwu2023 } 92378bf93f0SYJwu2023 } 92478bf93f0SYJwu2023 Ok(0) 92578bf93f0SYJwu2023 } 92678bf93f0SYJwu2023 /// @brief 检查特定设备并将其加入链表 92778bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因 92878bf93f0SYJwu2023 fn pci_check_function(busdevicefunction: BusDeviceFunction) -> Result<u8, PciError> { 92978bf93f0SYJwu2023 //kdebug!("PCI check function {}", busdevicefunction.function); 93078bf93f0SYJwu2023 let header = match pci_read_header(busdevicefunction, true) { 93178bf93f0SYJwu2023 Ok(header) => header, 93278bf93f0SYJwu2023 Err(PciError::GetWrongHeader) => { 93378bf93f0SYJwu2023 return Ok(255); 93478bf93f0SYJwu2023 } 93578bf93f0SYJwu2023 Err(e) => { 93678bf93f0SYJwu2023 return Err(e); 93778bf93f0SYJwu2023 } 93878bf93f0SYJwu2023 }; 93978bf93f0SYJwu2023 let common_header = header.common_header(); 94078bf93f0SYJwu2023 if (common_header.class_code == 0x06) 94178bf93f0SYJwu2023 && (common_header.subclass == 0x04 || common_header.subclass == 0x09) 94278bf93f0SYJwu2023 { 94378bf93f0SYJwu2023 let pci_to_pci_bridge = header 94478bf93f0SYJwu2023 .as_pci_to_pci_bridge_device() 94578bf93f0SYJwu2023 .ok_or(PciError::PciDeviceStructureTransformError)?; 94678bf93f0SYJwu2023 let secondary_bus = pci_to_pci_bridge.secondary_bus_number; 94778bf93f0SYJwu2023 pci_check_bus(secondary_bus)?; 94878bf93f0SYJwu2023 } 94978bf93f0SYJwu2023 Ok(0) 95078bf93f0SYJwu2023 } 95178bf93f0SYJwu2023 95278bf93f0SYJwu2023 /// @brief 检查device上的设备并将其加入链表 95378bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因 95478bf93f0SYJwu2023 fn pci_check_device(bus: u8, device: u8) -> Result<u8, PciError> { 95578bf93f0SYJwu2023 //kdebug!("PCI check device {}", device); 95678bf93f0SYJwu2023 let busdevicefunction = BusDeviceFunction { 95778bf93f0SYJwu2023 bus, 95878bf93f0SYJwu2023 device, 95978bf93f0SYJwu2023 function: 0, 96078bf93f0SYJwu2023 }; 96178bf93f0SYJwu2023 let header = match pci_read_header(busdevicefunction, false) { 96278bf93f0SYJwu2023 Ok(header) => header, 96378bf93f0SYJwu2023 Err(PciError::GetWrongHeader) => { 96478bf93f0SYJwu2023 //设备不存在,直接返回即可,不用终止遍历 96578bf93f0SYJwu2023 return Ok(255); 96678bf93f0SYJwu2023 } 96778bf93f0SYJwu2023 Err(e) => { 96878bf93f0SYJwu2023 return Err(e); 96978bf93f0SYJwu2023 } 97078bf93f0SYJwu2023 }; 97178bf93f0SYJwu2023 pci_check_function(busdevicefunction)?; 97278bf93f0SYJwu2023 let common_header = header.common_header(); 97378bf93f0SYJwu2023 if common_header.header_type & 0x80 != 0 { 97478bf93f0SYJwu2023 kdebug!( 97578bf93f0SYJwu2023 "Detected multi func device in bus{},device{}", 97678bf93f0SYJwu2023 busdevicefunction.bus, 97778bf93f0SYJwu2023 busdevicefunction.device 97878bf93f0SYJwu2023 ); 97978bf93f0SYJwu2023 // 这是一个多function的设备,因此查询剩余的function 98078bf93f0SYJwu2023 for function in 1..8 { 98178bf93f0SYJwu2023 let busdevicefunction = BusDeviceFunction { 98278bf93f0SYJwu2023 bus, 98378bf93f0SYJwu2023 device, 98478bf93f0SYJwu2023 function, 98578bf93f0SYJwu2023 }; 98678bf93f0SYJwu2023 pci_check_function(busdevicefunction)?; 98778bf93f0SYJwu2023 } 98878bf93f0SYJwu2023 } 98978bf93f0SYJwu2023 Ok(0) 99078bf93f0SYJwu2023 } 99178bf93f0SYJwu2023 /// @brief 检查该bus上的设备并将其加入链表 99278bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因 99378bf93f0SYJwu2023 fn pci_check_bus(bus: u8) -> Result<u8, PciError> { 99478bf93f0SYJwu2023 //kdebug!("PCI check bus {}", bus); 99578bf93f0SYJwu2023 for device in 0..32 { 99678bf93f0SYJwu2023 pci_check_device(bus, device)?; 99778bf93f0SYJwu2023 } 99878bf93f0SYJwu2023 Ok(0) 99978bf93f0SYJwu2023 } 10005b59005fSLoGin 10015b59005fSLoGin /// pci初始化函数 10025b59005fSLoGin #[inline(never)] 100378bf93f0SYJwu2023 pub fn pci_init() { 100478bf93f0SYJwu2023 kinfo!("Initializing PCI bus..."); 100578bf93f0SYJwu2023 if let Err(e) = pci_check_all_buses() { 100678bf93f0SYJwu2023 kerror!("pci init failed when checking bus because of error: {}", e); 100778bf93f0SYJwu2023 return; 100878bf93f0SYJwu2023 } 100978bf93f0SYJwu2023 kinfo!( 101078bf93f0SYJwu2023 "Total pci device and function num = {}", 101178bf93f0SYJwu2023 PCI_DEVICE_LINKEDLIST.num() 101278bf93f0SYJwu2023 ); 101378bf93f0SYJwu2023 let list = PCI_DEVICE_LINKEDLIST.read(); 101478bf93f0SYJwu2023 for box_pci_device in list.iter() { 101578bf93f0SYJwu2023 let common_header = box_pci_device.common_header(); 101678bf93f0SYJwu2023 match box_pci_device.header_type() { 101778bf93f0SYJwu2023 HeaderType::Standard if common_header.status & 0x10 != 0 => { 10185c1e552cSYJwu2023 kinfo!("Found pci standard device with class code ={} subclass={} status={:#x} cap_pointer={:#x} vendor={:#x}, device id={:#x},bdf={}", common_header.class_code, common_header.subclass, common_header.status, box_pci_device.as_standard_device().unwrap().capabilities_pointer,common_header.vendor_id, common_header.device_id,common_header.bus_device_function); 101978bf93f0SYJwu2023 } 102078bf93f0SYJwu2023 HeaderType::Standard => { 102178bf93f0SYJwu2023 kinfo!( 102278bf93f0SYJwu2023 "Found pci standard device with class code ={} subclass={} status={:#x} ", 102378bf93f0SYJwu2023 common_header.class_code, 102478bf93f0SYJwu2023 common_header.subclass, 102578bf93f0SYJwu2023 common_header.status 102678bf93f0SYJwu2023 ); 102778bf93f0SYJwu2023 } 102878bf93f0SYJwu2023 HeaderType::PciPciBridge if common_header.status & 0x10 != 0 => { 102978bf93f0SYJwu2023 kinfo!("Found pci-to-pci bridge device with class code ={} subclass={} status={:#x} cap_pointer={:#x}", common_header.class_code, common_header.subclass, common_header.status, box_pci_device.as_standard_device().unwrap().capabilities_pointer); 103078bf93f0SYJwu2023 } 103178bf93f0SYJwu2023 HeaderType::PciPciBridge => { 103278bf93f0SYJwu2023 kinfo!( 103378bf93f0SYJwu2023 "Found pci-to-pci bridge device with class code ={} subclass={} status={:#x} ", 103478bf93f0SYJwu2023 common_header.class_code, 103578bf93f0SYJwu2023 common_header.subclass, 103678bf93f0SYJwu2023 common_header.status 103778bf93f0SYJwu2023 ); 103878bf93f0SYJwu2023 } 103978bf93f0SYJwu2023 HeaderType::PciCardbusBridge => { 104078bf93f0SYJwu2023 kinfo!( 104178bf93f0SYJwu2023 "Found pcicardbus bridge device with class code ={} subclass={} status={:#x} ", 104278bf93f0SYJwu2023 common_header.class_code, 104378bf93f0SYJwu2023 common_header.subclass, 104478bf93f0SYJwu2023 common_header.status 104578bf93f0SYJwu2023 ); 104678bf93f0SYJwu2023 } 104778bf93f0SYJwu2023 HeaderType::Unrecognised(_) => {} 104878bf93f0SYJwu2023 } 104978bf93f0SYJwu2023 } 105078bf93f0SYJwu2023 kinfo!("PCI bus initialized."); 105178bf93f0SYJwu2023 } 105278bf93f0SYJwu2023 105326d84a31SYJwu2023 /// An identifier for a PCI bus, device and function. 105426d84a31SYJwu2023 /// PCI设备的唯一标识 105526d84a31SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)] 105678bf93f0SYJwu2023 pub struct BusDeviceFunction { 105726d84a31SYJwu2023 /// The PCI bus number, between 0 and 255. 105826d84a31SYJwu2023 pub bus: u8, 105926d84a31SYJwu2023 /// The device number on the bus, between 0 and 31. 106026d84a31SYJwu2023 pub device: u8, 106126d84a31SYJwu2023 /// The function number of the device, between 0 and 7. 106226d84a31SYJwu2023 pub function: u8, 106326d84a31SYJwu2023 } 106478bf93f0SYJwu2023 impl BusDeviceFunction { 106526d84a31SYJwu2023 /// Returns whether the device and function numbers are valid, i.e. the device is between 0 and 106678bf93f0SYJwu2023 ///@brief 检测BusDeviceFunction实例是否有效 106726d84a31SYJwu2023 ///@param self 106826d84a31SYJwu2023 ///@return bool 是否有效 106973c607aaSYJwu2023 #[allow(dead_code)] 107026d84a31SYJwu2023 pub fn valid(&self) -> bool { 107126d84a31SYJwu2023 self.device < 32 && self.function < 8 107226d84a31SYJwu2023 } 107326d84a31SYJwu2023 } 107478bf93f0SYJwu2023 ///实现BusDeviceFunction的Display trait,使其可以直接输出 107578bf93f0SYJwu2023 impl Display for BusDeviceFunction { 107626d84a31SYJwu2023 fn fmt(&self, f: &mut Formatter) -> fmt::Result { 10775c1e552cSYJwu2023 write!( 10785c1e552cSYJwu2023 f, 10795c1e552cSYJwu2023 "bus {} device {} function{}", 10805c1e552cSYJwu2023 self.bus, self.device, self.function 10815c1e552cSYJwu2023 ) 108226d84a31SYJwu2023 } 108326d84a31SYJwu2023 } 108426d84a31SYJwu2023 /// The location allowed for a memory BAR. 108526d84a31SYJwu2023 /// memory BAR的三种情况 108626d84a31SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)] 108726d84a31SYJwu2023 pub enum MemoryBarType { 108826d84a31SYJwu2023 /// The BAR has a 32-bit address and can be mapped anywhere in 32-bit address space. 108926d84a31SYJwu2023 Width32, 109026d84a31SYJwu2023 /// The BAR must be mapped below 1MiB. 109126d84a31SYJwu2023 Below1MiB, 109226d84a31SYJwu2023 /// The BAR has a 64-bit address and can be mapped anywhere in 64-bit address space. 109326d84a31SYJwu2023 Width64, 109426d84a31SYJwu2023 } 109526d84a31SYJwu2023 ///实现MemoryBarType与u8的类型转换 109626d84a31SYJwu2023 impl From<MemoryBarType> for u8 { 109726d84a31SYJwu2023 fn from(bar_type: MemoryBarType) -> Self { 109826d84a31SYJwu2023 match bar_type { 109926d84a31SYJwu2023 MemoryBarType::Width32 => 0, 110026d84a31SYJwu2023 MemoryBarType::Below1MiB => 1, 110126d84a31SYJwu2023 MemoryBarType::Width64 => 2, 110226d84a31SYJwu2023 } 110326d84a31SYJwu2023 } 110426d84a31SYJwu2023 } 110526d84a31SYJwu2023 ///实现MemoryBarType与u8的类型转换 110626d84a31SYJwu2023 impl TryFrom<u8> for MemoryBarType { 110726d84a31SYJwu2023 type Error = PciError; 110826d84a31SYJwu2023 fn try_from(value: u8) -> Result<Self, Self::Error> { 110926d84a31SYJwu2023 match value { 111026d84a31SYJwu2023 0 => Ok(Self::Width32), 111126d84a31SYJwu2023 1 => Ok(Self::Below1MiB), 111226d84a31SYJwu2023 2 => Ok(Self::Width64), 111326d84a31SYJwu2023 _ => Err(PciError::InvalidBarType), 111426d84a31SYJwu2023 } 111526d84a31SYJwu2023 } 111626d84a31SYJwu2023 } 111726d84a31SYJwu2023 111826d84a31SYJwu2023 /// Information about a PCI Base Address Register. 111926d84a31SYJwu2023 /// BAR的三种类型 Memory/IO/Unused 11202dd9f0c7SLoGin #[derive(Clone, Debug)] 112126d84a31SYJwu2023 pub enum BarInfo { 112226d84a31SYJwu2023 /// The BAR is for a memory region. 112326d84a31SYJwu2023 Memory { 112426d84a31SYJwu2023 /// The size of the BAR address and where it can be located. 112526d84a31SYJwu2023 address_type: MemoryBarType, 112626d84a31SYJwu2023 /// If true, then reading from the region doesn't have side effects. The CPU may cache reads 112726d84a31SYJwu2023 /// and merge repeated stores. 112826d84a31SYJwu2023 prefetchable: bool, 112926d84a31SYJwu2023 /// The memory address, always 16-byte aligned. 113026d84a31SYJwu2023 address: u64, 113126d84a31SYJwu2023 /// The size of the BAR in bytes. 113226d84a31SYJwu2023 size: u32, 113326d84a31SYJwu2023 /// The virtaddress for a memory bar(mapped). 11342dd9f0c7SLoGin mmio_guard: Arc<MMIOSpaceGuard>, 113526d84a31SYJwu2023 }, 113626d84a31SYJwu2023 /// The BAR is for an I/O region. 113726d84a31SYJwu2023 IO { 113826d84a31SYJwu2023 /// The I/O address, always 4-byte aligned. 113926d84a31SYJwu2023 address: u32, 114026d84a31SYJwu2023 /// The size of the BAR in bytes. 114126d84a31SYJwu2023 size: u32, 114226d84a31SYJwu2023 }, 114326d84a31SYJwu2023 Unused, 114426d84a31SYJwu2023 } 114526d84a31SYJwu2023 114626d84a31SYJwu2023 impl BarInfo { 114726d84a31SYJwu2023 /// Returns the address and size of this BAR if it is a memory bar, or `None` if it is an IO 114826d84a31SYJwu2023 /// BAR. 114926d84a31SYJwu2023 ///@brief 得到某个bar的memory_address与size(前提是他的类型为Memory Bar) 115026d84a31SYJwu2023 ///@param self 115126d84a31SYJwu2023 ///@return Option<(u64, u32) 是Memory Bar返回内存地址与大小,不是则返回None 115226d84a31SYJwu2023 pub fn memory_address_size(&self) -> Option<(u64, u32)> { 115326d84a31SYJwu2023 if let Self::Memory { address, size, .. } = self { 115426d84a31SYJwu2023 Some((*address, *size)) 115526d84a31SYJwu2023 } else { 115626d84a31SYJwu2023 None 115726d84a31SYJwu2023 } 115826d84a31SYJwu2023 } 115926d84a31SYJwu2023 ///@brief 得到某个bar的virtaddress(前提是他的类型为Memory Bar) 116026d84a31SYJwu2023 ///@param self 116126d84a31SYJwu2023 ///@return Option<(u64) 是Memory Bar返回映射的虚拟地址,不是则返回None 11622dd9f0c7SLoGin pub fn virtual_address(&self) -> Option<VirtAddr> { 11632dd9f0c7SLoGin if let Self::Memory { mmio_guard, .. } = self { 11642dd9f0c7SLoGin Some(mmio_guard.vaddr()) 116526d84a31SYJwu2023 } else { 116626d84a31SYJwu2023 None 116726d84a31SYJwu2023 } 116826d84a31SYJwu2023 } 116926d84a31SYJwu2023 } 117078bf93f0SYJwu2023 ///实现BarInfo的Display trait,自定义输出 117126d84a31SYJwu2023 impl Display for BarInfo { 117226d84a31SYJwu2023 fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result { 117326d84a31SYJwu2023 match self { 117426d84a31SYJwu2023 Self::Memory { 117526d84a31SYJwu2023 address_type, 117626d84a31SYJwu2023 prefetchable, 117726d84a31SYJwu2023 address, 117826d84a31SYJwu2023 size, 11792dd9f0c7SLoGin mmio_guard, 118026d84a31SYJwu2023 } => write!( 118126d84a31SYJwu2023 f, 11822dd9f0c7SLoGin "Memory space at {:#010x}, size {}, type {:?}, prefetchable {}, mmio_guard: {:?}", 11832dd9f0c7SLoGin address, size, address_type, prefetchable, mmio_guard 118426d84a31SYJwu2023 ), 118526d84a31SYJwu2023 Self::IO { address, size } => { 118626d84a31SYJwu2023 write!(f, "I/O space at {:#010x}, size {}", address, size) 118726d84a31SYJwu2023 } 118826d84a31SYJwu2023 Self::Unused => { 118926d84a31SYJwu2023 write!(f, "Unused bar") 119026d84a31SYJwu2023 } 119126d84a31SYJwu2023 } 119226d84a31SYJwu2023 } 119326d84a31SYJwu2023 } 1194cc36cf4aSYJwu2023 // todo 增加对桥的bar的支持 1195cc36cf4aSYJwu2023 pub trait PciDeviceBar {} 119640fe15e0SLoGin 119778bf93f0SYJwu2023 ///一个普通PCI设备(非桥)有6个BAR寄存器,PciStandardDeviceBar存储其全部信息 11982dd9f0c7SLoGin #[derive(Clone, Debug)] 119978bf93f0SYJwu2023 pub struct PciStandardDeviceBar { 120026d84a31SYJwu2023 bar0: BarInfo, 120126d84a31SYJwu2023 bar1: BarInfo, 120226d84a31SYJwu2023 bar2: BarInfo, 120326d84a31SYJwu2023 bar3: BarInfo, 120426d84a31SYJwu2023 bar4: BarInfo, 120526d84a31SYJwu2023 bar5: BarInfo, 120626d84a31SYJwu2023 } 120726d84a31SYJwu2023 120878bf93f0SYJwu2023 impl PciStandardDeviceBar { 120926d84a31SYJwu2023 ///@brief 得到某个bar的barinfo 121026d84a31SYJwu2023 ///@param self ,bar_index(0-5) 121126d84a31SYJwu2023 ///@return Result<&BarInfo, PciError> bar_index在0-5则返回对应的bar_info结构体,超出范围则返回错误 121226d84a31SYJwu2023 pub fn get_bar(&self, bar_index: u8) -> Result<&BarInfo, PciError> { 121326d84a31SYJwu2023 match bar_index { 121426d84a31SYJwu2023 0 => Ok(&self.bar0), 121526d84a31SYJwu2023 1 => Ok(&self.bar1), 121626d84a31SYJwu2023 2 => Ok(&self.bar2), 121726d84a31SYJwu2023 3 => Ok(&self.bar3), 121826d84a31SYJwu2023 4 => Ok(&self.bar4), 121978bf93f0SYJwu2023 5 => Ok(&self.bar5), 122026d84a31SYJwu2023 _ => Err(PciError::InvalidBarType), 122126d84a31SYJwu2023 } 122226d84a31SYJwu2023 } 122326d84a31SYJwu2023 } 122478bf93f0SYJwu2023 ///实现PciStandardDeviceBar的Display trait,使其可以直接输出 122578bf93f0SYJwu2023 impl Display for PciStandardDeviceBar { 122626d84a31SYJwu2023 fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result { 122726d84a31SYJwu2023 write!( 122826d84a31SYJwu2023 f, 122926d84a31SYJwu2023 "\r\nBar0:{}\r\nBar1:{}\r\nBar2:{}\r\nBar3:{}\r\nBar4:{}\r\nBar5:{}", 123026d84a31SYJwu2023 self.bar0, self.bar1, self.bar2, self.bar3, self.bar4, self.bar5 123126d84a31SYJwu2023 ) 123226d84a31SYJwu2023 } 123326d84a31SYJwu2023 } 123478bf93f0SYJwu2023 ///实现PciStandardDeviceBar的Default trait,使其可以简单初始化 123578bf93f0SYJwu2023 impl Default for PciStandardDeviceBar { 123626d84a31SYJwu2023 fn default() -> Self { 123778bf93f0SYJwu2023 PciStandardDeviceBar { 123826d84a31SYJwu2023 bar0: BarInfo::Unused, 123926d84a31SYJwu2023 bar1: BarInfo::Unused, 124026d84a31SYJwu2023 bar2: BarInfo::Unused, 124126d84a31SYJwu2023 bar3: BarInfo::Unused, 124226d84a31SYJwu2023 bar4: BarInfo::Unused, 124326d84a31SYJwu2023 bar5: BarInfo::Unused, 124426d84a31SYJwu2023 } 124526d84a31SYJwu2023 } 124626d84a31SYJwu2023 } 124726d84a31SYJwu2023 124878bf93f0SYJwu2023 ///@brief 将某个pci设备的bar寄存器读取值后映射到虚拟地址 124978bf93f0SYJwu2023 ///@param self ,bus_device_function PCI设备的唯一标识符 125078bf93f0SYJwu2023 ///@return Result<PciStandardDeviceBar, PciError> 成功则返回对应的PciStandardDeviceBar结构体,失败则返回错误类型 125178bf93f0SYJwu2023 pub fn pci_bar_init( 125278bf93f0SYJwu2023 bus_device_function: BusDeviceFunction, 125378bf93f0SYJwu2023 ) -> Result<PciStandardDeviceBar, PciError> { 125478bf93f0SYJwu2023 let mut device_bar: PciStandardDeviceBar = PciStandardDeviceBar::default(); 125526d84a31SYJwu2023 let mut bar_index_ignore: u8 = 255; 125626d84a31SYJwu2023 for bar_index in 0..6 { 125726d84a31SYJwu2023 if bar_index == bar_index_ignore { 125826d84a31SYJwu2023 continue; 125926d84a31SYJwu2023 } 126026d84a31SYJwu2023 let bar_info; 12612709e017SLoGin let bar_orig = 12622709e017SLoGin pci_root_0().read_config(bus_device_function, (BAR0_OFFSET + 4 * bar_index).into()); 12632709e017SLoGin pci_root_0().write_config( 12642709e017SLoGin bus_device_function, 12652709e017SLoGin (BAR0_OFFSET + 4 * bar_index).into(), 126626d84a31SYJwu2023 0xffffffff, 126726d84a31SYJwu2023 ); 12682709e017SLoGin let size_mask = 12692709e017SLoGin pci_root_0().read_config(bus_device_function, (BAR0_OFFSET + 4 * bar_index).into()); 127026d84a31SYJwu2023 // A wrapping add is necessary to correctly handle the case of unused BARs, which read back 127126d84a31SYJwu2023 // as 0, and should be treated as size 0. 127226d84a31SYJwu2023 let size = (!(size_mask & 0xfffffff0)).wrapping_add(1); 127326d84a31SYJwu2023 //kdebug!("bar_orig:{:#x},size: {:#x}", bar_orig,size); 127426d84a31SYJwu2023 // Restore the original value. 12752709e017SLoGin pci_root_0().write_config( 12762709e017SLoGin bus_device_function, 12772709e017SLoGin (BAR0_OFFSET + 4 * bar_index).into(), 12782709e017SLoGin bar_orig, 12792709e017SLoGin ); 128026d84a31SYJwu2023 if size == 0 { 128126d84a31SYJwu2023 continue; 128226d84a31SYJwu2023 } 128326d84a31SYJwu2023 if bar_orig & 0x00000001 == 0x00000001 { 128426d84a31SYJwu2023 // I/O space 128526d84a31SYJwu2023 let address = bar_orig & 0xfffffffc; 128626d84a31SYJwu2023 bar_info = BarInfo::IO { address, size }; 128726d84a31SYJwu2023 } else { 128826d84a31SYJwu2023 // Memory space 128926d84a31SYJwu2023 let mut address = u64::from(bar_orig & 0xfffffff0); 129026d84a31SYJwu2023 let prefetchable = bar_orig & 0x00000008 != 0; 129126d84a31SYJwu2023 let address_type = MemoryBarType::try_from(((bar_orig & 0x00000006) >> 1) as u8)?; 129226d84a31SYJwu2023 if address_type == MemoryBarType::Width64 { 129326d84a31SYJwu2023 if bar_index >= 5 { 129426d84a31SYJwu2023 return Err(PciError::InvalidBarType); 129526d84a31SYJwu2023 } 12962709e017SLoGin let address_top = pci_root_0().read_config( 12972709e017SLoGin bus_device_function, 12982709e017SLoGin (BAR0_OFFSET + 4 * (bar_index + 1)).into(), 12992709e017SLoGin ); 130026d84a31SYJwu2023 address |= u64::from(address_top) << 32; 130126d84a31SYJwu2023 bar_index_ignore = bar_index + 1; //下个bar跳过,因为64位的memory bar覆盖了两个bar 130226d84a31SYJwu2023 } 13035c1e552cSYJwu2023 let pci_address = PciAddr::new(address as usize); 13042dd9f0c7SLoGin let paddr = PciArch::address_pci_to_physical(pci_address); //PCI总线域物理地址转换为存储器域物理地址 13052dd9f0c7SLoGin 13062dd9f0c7SLoGin let space_guard: Arc<MMIOSpaceGuard>; 130726d84a31SYJwu2023 unsafe { 130840fe15e0SLoGin let size_want = size as usize; 13092dd9f0c7SLoGin let tmp = mmio_pool() 13102dd9f0c7SLoGin .create_mmio(size_want) 13112dd9f0c7SLoGin .map_err(|_| PciError::CreateMmioError)?; 13122dd9f0c7SLoGin space_guard = Arc::new(tmp); 1313afc95d5cSYJwu2023 //kdebug!("Pci bar init: mmio space: {space_guard:?}, paddr={paddr:?}, size_want={size_want}"); 13142dd9f0c7SLoGin assert!( 13157ae679ddSLoGin space_guard.map_phys(paddr, size_want).is_ok(), 13162dd9f0c7SLoGin "pci_bar_init: map_phys failed" 13172dd9f0c7SLoGin ); 131826d84a31SYJwu2023 } 131926d84a31SYJwu2023 bar_info = BarInfo::Memory { 132026d84a31SYJwu2023 address_type, 132126d84a31SYJwu2023 prefetchable, 132226d84a31SYJwu2023 address, 132326d84a31SYJwu2023 size, 13242dd9f0c7SLoGin mmio_guard: space_guard, 132526d84a31SYJwu2023 }; 132626d84a31SYJwu2023 } 132726d84a31SYJwu2023 match bar_index { 132826d84a31SYJwu2023 0 => { 132926d84a31SYJwu2023 device_bar.bar0 = bar_info; 133026d84a31SYJwu2023 } 133126d84a31SYJwu2023 1 => { 133226d84a31SYJwu2023 device_bar.bar1 = bar_info; 133326d84a31SYJwu2023 } 133426d84a31SYJwu2023 2 => { 133526d84a31SYJwu2023 device_bar.bar2 = bar_info; 133626d84a31SYJwu2023 } 133726d84a31SYJwu2023 3 => { 133826d84a31SYJwu2023 device_bar.bar3 = bar_info; 133926d84a31SYJwu2023 } 134026d84a31SYJwu2023 4 => { 134126d84a31SYJwu2023 device_bar.bar4 = bar_info; 134226d84a31SYJwu2023 } 134326d84a31SYJwu2023 5 => { 134426d84a31SYJwu2023 device_bar.bar5 = bar_info; 134526d84a31SYJwu2023 } 134626d84a31SYJwu2023 _ => {} 134726d84a31SYJwu2023 } 134826d84a31SYJwu2023 } 1349afc95d5cSYJwu2023 //kdebug!("pci_device_bar:{}", device_bar); 135026d84a31SYJwu2023 return Ok(device_bar); 135126d84a31SYJwu2023 } 135226d84a31SYJwu2023 135326d84a31SYJwu2023 /// Information about a PCI device capability. 135426d84a31SYJwu2023 /// PCI设备的capability的信息 135526d84a31SYJwu2023 #[derive(Debug, Copy, Clone, Eq, PartialEq)] 135626d84a31SYJwu2023 pub struct CapabilityInfo { 135726d84a31SYJwu2023 /// The offset of the capability in the PCI configuration space of the device function. 135826d84a31SYJwu2023 pub offset: u8, 135926d84a31SYJwu2023 /// The ID of the capability. 136026d84a31SYJwu2023 pub id: u8, 136126d84a31SYJwu2023 /// The third and fourth bytes of the capability, to save reading them again. 136226d84a31SYJwu2023 pub private_header: u16, 136326d84a31SYJwu2023 } 136473c607aaSYJwu2023 136526d84a31SYJwu2023 /// Iterator over capabilities for a device. 136626d84a31SYJwu2023 /// 创建迭代器以遍历PCI设备的capability 136726d84a31SYJwu2023 #[derive(Debug)] 136826d84a31SYJwu2023 pub struct CapabilityIterator { 136978bf93f0SYJwu2023 pub bus_device_function: BusDeviceFunction, 137026d84a31SYJwu2023 pub next_capability_offset: Option<u8>, 137126d84a31SYJwu2023 } 137226d84a31SYJwu2023 137326d84a31SYJwu2023 impl Iterator for CapabilityIterator { 137426d84a31SYJwu2023 type Item = CapabilityInfo; 137526d84a31SYJwu2023 fn next(&mut self) -> Option<Self::Item> { 137626d84a31SYJwu2023 let offset = self.next_capability_offset?; 137726d84a31SYJwu2023 137826d84a31SYJwu2023 // Read the first 4 bytes of the capability. 13792709e017SLoGin let capability_header = pci_root_0().read_config(self.bus_device_function, offset.into()); 138026d84a31SYJwu2023 let id = capability_header as u8; 138126d84a31SYJwu2023 let next_offset = (capability_header >> 8) as u8; 138226d84a31SYJwu2023 let private_header = (capability_header >> 16) as u16; 138326d84a31SYJwu2023 138426d84a31SYJwu2023 self.next_capability_offset = if next_offset == 0 { 138526d84a31SYJwu2023 None 138626d84a31SYJwu2023 } else if next_offset < 64 || next_offset & 0x3 != 0 { 138726d84a31SYJwu2023 kwarn!("Invalid next capability offset {:#04x}", next_offset); 138826d84a31SYJwu2023 None 138926d84a31SYJwu2023 } else { 139026d84a31SYJwu2023 Some(next_offset) 139126d84a31SYJwu2023 }; 139226d84a31SYJwu2023 139326d84a31SYJwu2023 Some(CapabilityInfo { 139426d84a31SYJwu2023 offset, 139526d84a31SYJwu2023 id, 139626d84a31SYJwu2023 private_header, 139726d84a31SYJwu2023 }) 139826d84a31SYJwu2023 } 139926d84a31SYJwu2023 } 140073c607aaSYJwu2023 140178bf93f0SYJwu2023 /// Information about a PCIe device capability. 140278bf93f0SYJwu2023 /// PCIe设备的external capability的信息 140378bf93f0SYJwu2023 #[derive(Debug, Copy, Clone, Eq, PartialEq)] 140478bf93f0SYJwu2023 pub struct ExternalCapabilityInfo { 140578bf93f0SYJwu2023 /// The offset of the capability in the PCI configuration space of the device function. 140678bf93f0SYJwu2023 pub offset: u16, 140778bf93f0SYJwu2023 /// The ID of the capability. 140878bf93f0SYJwu2023 pub id: u16, 140978bf93f0SYJwu2023 /// The third and fourth bytes of the capability, to save reading them again. 141078bf93f0SYJwu2023 pub capability_version: u8, 141173c607aaSYJwu2023 } 141278bf93f0SYJwu2023 141378bf93f0SYJwu2023 /// Iterator over capabilities for a device. 141478bf93f0SYJwu2023 /// 创建迭代器以遍历PCIe设备的external capability 141578bf93f0SYJwu2023 #[derive(Debug)] 141678bf93f0SYJwu2023 pub struct ExternalCapabilityIterator<'a> { 141778bf93f0SYJwu2023 pub root: &'a PciRoot, 141878bf93f0SYJwu2023 pub bus_device_function: BusDeviceFunction, 141978bf93f0SYJwu2023 pub next_capability_offset: Option<u16>, 142073c607aaSYJwu2023 } 142178bf93f0SYJwu2023 impl<'a> Iterator for ExternalCapabilityIterator<'a> { 142278bf93f0SYJwu2023 type Item = ExternalCapabilityInfo; 142378bf93f0SYJwu2023 fn next(&mut self) -> Option<Self::Item> { 142478bf93f0SYJwu2023 let offset = self.next_capability_offset?; 142578bf93f0SYJwu2023 142678bf93f0SYJwu2023 // Read the first 4 bytes of the capability. 142778bf93f0SYJwu2023 let capability_header = self.root.read_config(self.bus_device_function, offset); 142878bf93f0SYJwu2023 let id = capability_header as u16; 142978bf93f0SYJwu2023 let next_offset = (capability_header >> 20) as u16; 143078bf93f0SYJwu2023 let capability_version = ((capability_header >> 16) & 0xf) as u8; 143178bf93f0SYJwu2023 143278bf93f0SYJwu2023 self.next_capability_offset = if next_offset == 0 { 143378bf93f0SYJwu2023 None 143478bf93f0SYJwu2023 } else if next_offset < 0x100 || next_offset & 0x3 != 0 { 143578bf93f0SYJwu2023 kwarn!("Invalid next capability offset {:#04x}", next_offset); 143678bf93f0SYJwu2023 None 143778bf93f0SYJwu2023 } else { 143878bf93f0SYJwu2023 Some(next_offset) 143978bf93f0SYJwu2023 }; 144078bf93f0SYJwu2023 144178bf93f0SYJwu2023 Some(ExternalCapabilityInfo { 144278bf93f0SYJwu2023 offset, 144378bf93f0SYJwu2023 id, 144478bf93f0SYJwu2023 capability_version, 144578bf93f0SYJwu2023 }) 144678bf93f0SYJwu2023 } 144773c607aaSYJwu2023 } 1448