xref: /DragonOS/kernel/src/driver/pci/pci.rs (revision 40fe15e0953f989ccfeb74826d61621d43dea6bb)
178bf93f0SYJwu2023 #![allow(dead_code)]
278bf93f0SYJwu2023 // 目前仅支持单主桥单Segment
378bf93f0SYJwu2023 
4cc36cf4aSYJwu2023 use super::pci_irq::{IrqType, PciIrqError};
578bf93f0SYJwu2023 use crate::arch::{PciArch, TraitPciArch};
6*40fe15e0SLoGin use crate::include::bindings::bindings::{PAGE_2M_SIZE, VM_DONTCOPY, VM_IO};
778bf93f0SYJwu2023 use crate::libs::rwlock::{RwLock, RwLockReadGuard, RwLockWriteGuard};
8*40fe15e0SLoGin use crate::mm::kernel_mapper::KernelMapper;
9*40fe15e0SLoGin use crate::mm::mmio_buddy::mmio_pool;
10*40fe15e0SLoGin use crate::mm::page::PageFlags;
11*40fe15e0SLoGin use crate::mm::{PhysAddr, VirtAddr};
1278bf93f0SYJwu2023 use crate::{kdebug, kerror, kinfo, kwarn};
1378bf93f0SYJwu2023 use alloc::vec::Vec;
1478bf93f0SYJwu2023 use alloc::{boxed::Box, collections::LinkedList};
1526d84a31SYJwu2023 use bitflags::bitflags;
16*40fe15e0SLoGin 
1726d84a31SYJwu2023 use core::{
1826d84a31SYJwu2023     convert::TryFrom,
195c1e552cSYJwu2023     fmt::{self, Debug, Display, Formatter},
2026d84a31SYJwu2023 };
2178bf93f0SYJwu2023 // PCI_DEVICE_LINKEDLIST 添加了读写锁的全局链表,里面存储了检索到的PCI设备结构体
2278bf93f0SYJwu2023 // PCI_ROOT_0 Segment为0的全局PciRoot
2378bf93f0SYJwu2023 lazy_static! {
2478bf93f0SYJwu2023     pub static ref PCI_DEVICE_LINKEDLIST: PciDeviceLinkedList = PciDeviceLinkedList::new();
2578bf93f0SYJwu2023     pub static ref PCI_ROOT_0: Option<PciRoot> = {
2678bf93f0SYJwu2023         match PciRoot::new(0) {
2778bf93f0SYJwu2023             Ok(root) => Some(root),
2878bf93f0SYJwu2023             Err(err) => {
2978bf93f0SYJwu2023                 kerror!("Pci_root init failed because of error: {}", err);
3078bf93f0SYJwu2023                 None
3178bf93f0SYJwu2023             }
3278bf93f0SYJwu2023         }
3378bf93f0SYJwu2023     };
3478bf93f0SYJwu2023 }
355c1e552cSYJwu2023 /// PCI域地址
365c1e552cSYJwu2023 #[derive(Clone, Copy, Eq, Ord, PartialEq, PartialOrd)]
375c1e552cSYJwu2023 #[repr(transparent)]
385c1e552cSYJwu2023 pub struct PciAddr(usize);
395c1e552cSYJwu2023 
405c1e552cSYJwu2023 impl PciAddr {
415c1e552cSYJwu2023     #[inline(always)]
425c1e552cSYJwu2023     pub const fn new(address: usize) -> Self {
435c1e552cSYJwu2023         Self(address)
445c1e552cSYJwu2023     }
455c1e552cSYJwu2023 
465c1e552cSYJwu2023     /// @brief 获取PCI域地址的值
475c1e552cSYJwu2023     #[inline(always)]
485c1e552cSYJwu2023     pub fn data(&self) -> usize {
495c1e552cSYJwu2023         self.0
505c1e552cSYJwu2023     }
515c1e552cSYJwu2023 
525c1e552cSYJwu2023     /// @brief 将PCI域地址加上一个偏移量
535c1e552cSYJwu2023     #[inline(always)]
545c1e552cSYJwu2023     pub fn add(self, offset: usize) -> Self {
555c1e552cSYJwu2023         Self(self.0 + offset)
565c1e552cSYJwu2023     }
575c1e552cSYJwu2023 
585c1e552cSYJwu2023     /// @brief 判断PCI域地址是否按照指定要求对齐
595c1e552cSYJwu2023     #[inline(always)]
605c1e552cSYJwu2023     pub fn check_aligned(&self, align: usize) -> bool {
615c1e552cSYJwu2023         return self.0 & (align - 1) == 0;
625c1e552cSYJwu2023     }
635c1e552cSYJwu2023 }
645c1e552cSYJwu2023 impl Debug for PciAddr {
655c1e552cSYJwu2023     fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
665c1e552cSYJwu2023         write!(f, "PciAddr({:#x})", self.0)
675c1e552cSYJwu2023     }
685c1e552cSYJwu2023 }
6978bf93f0SYJwu2023 
7078bf93f0SYJwu2023 /// 添加了读写锁的链表,存储PCI设备结构体
7178bf93f0SYJwu2023 pub struct PciDeviceLinkedList {
7278bf93f0SYJwu2023     list: RwLock<LinkedList<Box<dyn PciDeviceStructure>>>,
7378bf93f0SYJwu2023 }
7478bf93f0SYJwu2023 
7578bf93f0SYJwu2023 impl PciDeviceLinkedList {
7678bf93f0SYJwu2023     /// @brief 初始化结构体
7778bf93f0SYJwu2023     fn new() -> Self {
7878bf93f0SYJwu2023         PciDeviceLinkedList {
7978bf93f0SYJwu2023             list: RwLock::new(LinkedList::new()),
8078bf93f0SYJwu2023         }
8178bf93f0SYJwu2023     }
8278bf93f0SYJwu2023     /// @brief 获取可读的linkedlist(读锁守卫)
8378bf93f0SYJwu2023     /// @return RwLockReadGuard<LinkedList<Box<dyn PciDeviceStructure>>>  读锁守卫
8413776c11Slogin     pub fn read(&self) -> RwLockReadGuard<LinkedList<Box<dyn PciDeviceStructure>>> {
8578bf93f0SYJwu2023         self.list.read()
8678bf93f0SYJwu2023     }
8778bf93f0SYJwu2023     /// @brief 获取可写的linkedlist(写锁守卫)
8878bf93f0SYJwu2023     /// @return RwLockWriteGuard<LinkedList<Box<dyn PciDeviceStructure>>>  写锁守卫
8913776c11Slogin     pub fn write(&self) -> RwLockWriteGuard<LinkedList<Box<dyn PciDeviceStructure>>> {
9078bf93f0SYJwu2023         self.list.write()
9178bf93f0SYJwu2023     }
9278bf93f0SYJwu2023     /// @brief 获取链表中PCI结构体数目
9378bf93f0SYJwu2023     /// @return usize 链表中PCI结构体数目
9478bf93f0SYJwu2023     pub fn num(&self) -> usize {
9578bf93f0SYJwu2023         let list = self.list.read();
9678bf93f0SYJwu2023         list.len()
9778bf93f0SYJwu2023     }
9878bf93f0SYJwu2023     /// @brief 添加Pci设备结构体到链表中
9978bf93f0SYJwu2023     pub fn add(&self, device: Box<dyn PciDeviceStructure>) {
10078bf93f0SYJwu2023         let mut list = self.list.write();
10178bf93f0SYJwu2023         list.push_back(device);
10278bf93f0SYJwu2023     }
10378bf93f0SYJwu2023 }
10478bf93f0SYJwu2023 
10578bf93f0SYJwu2023 /// @brief 在链表中寻找满足条件的PCI设备结构体并返回其可变引用
10678bf93f0SYJwu2023 /// @param list 链表的写锁守卫
10778bf93f0SYJwu2023 /// @param class_code 寄存器值
10878bf93f0SYJwu2023 /// @param subclass 寄存器值,与class_code一起确定设备类型
10978bf93f0SYJwu2023 /// @return Vec<&'a mut Box<(dyn PciDeviceStructure)  包含链表中所有满足条件的PCI结构体的可变引用的容器
11078bf93f0SYJwu2023 pub fn get_pci_device_structure_mut<'a>(
11178bf93f0SYJwu2023     list: &'a mut RwLockWriteGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>,
11278bf93f0SYJwu2023     class_code: u8,
11378bf93f0SYJwu2023     subclass: u8,
11478bf93f0SYJwu2023 ) -> Vec<&'a mut Box<(dyn PciDeviceStructure)>> {
11578bf93f0SYJwu2023     let mut result = Vec::new();
11678bf93f0SYJwu2023     for box_pci_device_structure in list.iter_mut() {
11778bf93f0SYJwu2023         let common_header = (*box_pci_device_structure).common_header();
11878bf93f0SYJwu2023         if (common_header.class_code == class_code) && (common_header.subclass == subclass) {
11978bf93f0SYJwu2023             result.push(box_pci_device_structure);
12078bf93f0SYJwu2023         }
12178bf93f0SYJwu2023     }
12278bf93f0SYJwu2023     result
12378bf93f0SYJwu2023 }
12478bf93f0SYJwu2023 /// @brief 在链表中寻找满足条件的PCI设备结构体并返回其不可变引用
12578bf93f0SYJwu2023 /// @param list 链表的读锁守卫
12678bf93f0SYJwu2023 /// @param class_code 寄存器值
12778bf93f0SYJwu2023 /// @param subclass 寄存器值,与class_code一起确定设备类型
12878bf93f0SYJwu2023 /// @return Vec<&'a Box<(dyn PciDeviceStructure)  包含链表中所有满足条件的PCI结构体的不可变引用的容器
12978bf93f0SYJwu2023 pub fn get_pci_device_structure<'a>(
13078bf93f0SYJwu2023     list: &'a mut RwLockReadGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>,
13178bf93f0SYJwu2023     class_code: u8,
13278bf93f0SYJwu2023     subclass: u8,
13378bf93f0SYJwu2023 ) -> Vec<&'a Box<(dyn PciDeviceStructure)>> {
13478bf93f0SYJwu2023     let mut result = Vec::new();
13578bf93f0SYJwu2023     for box_pci_device_structure in list.iter() {
13678bf93f0SYJwu2023         let common_header = (*box_pci_device_structure).common_header();
13778bf93f0SYJwu2023         if (common_header.class_code == class_code) && (common_header.subclass == subclass) {
13878bf93f0SYJwu2023             result.push(box_pci_device_structure);
13978bf93f0SYJwu2023         }
14078bf93f0SYJwu2023     }
14178bf93f0SYJwu2023     result
14278bf93f0SYJwu2023 }
14378bf93f0SYJwu2023 
14426d84a31SYJwu2023 //Bar0寄存器的offset
14526d84a31SYJwu2023 const BAR0_OFFSET: u8 = 0x10;
14626d84a31SYJwu2023 //Status、Command寄存器的offset
14726d84a31SYJwu2023 const STATUS_COMMAND_OFFSET: u8 = 0x04;
14826d84a31SYJwu2023 /// ID for vendor-specific PCI capabilities.(Virtio Capabilities)
14926d84a31SYJwu2023 pub const PCI_CAP_ID_VNDR: u8 = 0x09;
150cc36cf4aSYJwu2023 pub const PCI_CAP_ID_MSI: u8 = 0x05;
151cc36cf4aSYJwu2023 pub const PCI_CAP_ID_MSIX: u8 = 0x11;
15278bf93f0SYJwu2023 pub const PORT_PCI_CONFIG_ADDRESS: u16 = 0xcf8;
15378bf93f0SYJwu2023 pub const PORT_PCI_CONFIG_DATA: u16 = 0xcfc;
15478bf93f0SYJwu2023 // pci设备分组的id
15578bf93f0SYJwu2023 pub type SegmentGroupNumber = u16; //理论上最多支持65535个Segment_Group
15626d84a31SYJwu2023 
15726d84a31SYJwu2023 bitflags! {
15826d84a31SYJwu2023     /// The status register in PCI configuration space.
15926d84a31SYJwu2023     pub struct Status: u16 {
16026d84a31SYJwu2023         // Bits 0-2 are reserved.
16126d84a31SYJwu2023         /// The state of the device's INTx# signal.
16226d84a31SYJwu2023         const INTERRUPT_STATUS = 1 << 3;
16326d84a31SYJwu2023         /// The device has a linked list of capabilities.
16426d84a31SYJwu2023         const CAPABILITIES_LIST = 1 << 4;
16526d84a31SYJwu2023         /// The device is capabile of running at 66 MHz rather than 33 MHz.
16626d84a31SYJwu2023         const MHZ_66_CAPABLE = 1 << 5;
16726d84a31SYJwu2023         // Bit 6 is reserved.
16826d84a31SYJwu2023         /// The device can accept fast back-to-back transactions not from the same agent.
16926d84a31SYJwu2023         const FAST_BACK_TO_BACK_CAPABLE = 1 << 7;
17026d84a31SYJwu2023         /// The bus agent observed a parity error (if parity error handling is enabled).
17126d84a31SYJwu2023         const MASTER_DATA_PARITY_ERROR = 1 << 8;
17226d84a31SYJwu2023         // Bits 9-10 are DEVSEL timing.
17326d84a31SYJwu2023         /// A target device terminated a transaction with target-abort.
17426d84a31SYJwu2023         const SIGNALED_TARGET_ABORT = 1 << 11;
17526d84a31SYJwu2023         /// A master device transaction was terminated with target-abort.
17626d84a31SYJwu2023         const RECEIVED_TARGET_ABORT = 1 << 12;
17726d84a31SYJwu2023         /// A master device transaction was terminated with master-abort.
17826d84a31SYJwu2023         const RECEIVED_MASTER_ABORT = 1 << 13;
17926d84a31SYJwu2023         /// A device asserts SERR#.
18026d84a31SYJwu2023         const SIGNALED_SYSTEM_ERROR = 1 << 14;
18126d84a31SYJwu2023         /// The device detects a parity error, even if parity error handling is disabled.
18226d84a31SYJwu2023         const DETECTED_PARITY_ERROR = 1 << 15;
18326d84a31SYJwu2023     }
18426d84a31SYJwu2023 }
18526d84a31SYJwu2023 
18626d84a31SYJwu2023 bitflags! {
18726d84a31SYJwu2023     /// The command register in PCI configuration space.
18878bf93f0SYJwu2023     pub struct Command: u16 {
18926d84a31SYJwu2023         /// The device can respond to I/O Space accesses.
19026d84a31SYJwu2023         const IO_SPACE = 1 << 0;
19126d84a31SYJwu2023         /// The device can respond to Memory Space accesses.
19226d84a31SYJwu2023         const MEMORY_SPACE = 1 << 1;
19326d84a31SYJwu2023         /// The device can behave as a bus master.
19426d84a31SYJwu2023         const BUS_MASTER = 1 << 2;
19526d84a31SYJwu2023         /// The device can monitor Special Cycle operations.
19626d84a31SYJwu2023         const SPECIAL_CYCLES = 1 << 3;
19726d84a31SYJwu2023         /// The device can generate the Memory Write and Invalidate command.
19826d84a31SYJwu2023         const MEMORY_WRITE_AND_INVALIDATE_ENABLE = 1 << 4;
19926d84a31SYJwu2023         /// The device will snoop palette register data.
20026d84a31SYJwu2023         const VGA_PALETTE_SNOOP = 1 << 5;
20126d84a31SYJwu2023         /// The device should take its normal action when a parity error is detected.
20226d84a31SYJwu2023         const PARITY_ERROR_RESPONSE = 1 << 6;
20326d84a31SYJwu2023         // Bit 7 is reserved.
20426d84a31SYJwu2023         /// The SERR# driver is enabled.
20526d84a31SYJwu2023         const SERR_ENABLE = 1 << 8;
20626d84a31SYJwu2023         /// The device is allowed to generate fast back-to-back transactions.
20726d84a31SYJwu2023         const FAST_BACK_TO_BACK_ENABLE = 1 << 9;
20826d84a31SYJwu2023         /// Assertion of the device's INTx# signal is disabled.
20926d84a31SYJwu2023         const INTERRUPT_DISABLE = 1 << 10;
21026d84a31SYJwu2023     }
21126d84a31SYJwu2023 }
21226d84a31SYJwu2023 
21378bf93f0SYJwu2023 /// The type of a PCI device function header.
21478bf93f0SYJwu2023 /// 标头类型/设备类型
21578bf93f0SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
21678bf93f0SYJwu2023 pub enum HeaderType {
21778bf93f0SYJwu2023     /// A normal PCI device.
21878bf93f0SYJwu2023     Standard,
21978bf93f0SYJwu2023     /// A PCI to PCI bridge.
22078bf93f0SYJwu2023     PciPciBridge,
22178bf93f0SYJwu2023     /// A PCI to CardBus bridge.
22278bf93f0SYJwu2023     PciCardbusBridge,
22378bf93f0SYJwu2023     /// Unrecognised header type.
22478bf93f0SYJwu2023     Unrecognised(u8),
22578bf93f0SYJwu2023 }
22678bf93f0SYJwu2023 /// u8到HeaderType的转换
22778bf93f0SYJwu2023 impl From<u8> for HeaderType {
22878bf93f0SYJwu2023     fn from(value: u8) -> Self {
22978bf93f0SYJwu2023         match value {
23078bf93f0SYJwu2023             0x00 => Self::Standard,
23178bf93f0SYJwu2023             0x01 => Self::PciPciBridge,
23278bf93f0SYJwu2023             0x02 => Self::PciCardbusBridge,
23378bf93f0SYJwu2023             _ => Self::Unrecognised(value),
23478bf93f0SYJwu2023         }
23578bf93f0SYJwu2023     }
23678bf93f0SYJwu2023 }
23778bf93f0SYJwu2023 /// Pci可能触发的各种错误
23878bf93f0SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
23978bf93f0SYJwu2023 pub enum PciError {
24078bf93f0SYJwu2023     /// The device reported an invalid BAR type.
24178bf93f0SYJwu2023     InvalidBarType,
24278bf93f0SYJwu2023     CreateMmioError,
24378bf93f0SYJwu2023     InvalidBusDeviceFunction,
24478bf93f0SYJwu2023     SegmentNotFound,
245cc36cf4aSYJwu2023     McfgTableNotFound,
24678bf93f0SYJwu2023     GetWrongHeader,
24778bf93f0SYJwu2023     UnrecognisedHeaderType,
24878bf93f0SYJwu2023     PciDeviceStructureTransformError,
249cc36cf4aSYJwu2023     PciIrqError(PciIrqError),
25078bf93f0SYJwu2023 }
25178bf93f0SYJwu2023 ///实现PciError的Display trait,使其可以直接输出
25278bf93f0SYJwu2023 impl Display for PciError {
25378bf93f0SYJwu2023     fn fmt(&self, f: &mut Formatter) -> fmt::Result {
25478bf93f0SYJwu2023         match self {
25578bf93f0SYJwu2023             Self::InvalidBarType => write!(f, "Invalid PCI BAR type."),
25678bf93f0SYJwu2023             Self::CreateMmioError => write!(f, "Error occurred while creating mmio."),
25778bf93f0SYJwu2023             Self::InvalidBusDeviceFunction => write!(f, "Found invalid BusDeviceFunction."),
25878bf93f0SYJwu2023             Self::SegmentNotFound => write!(f, "Target segment not found"),
259cc36cf4aSYJwu2023             Self::McfgTableNotFound => write!(f, "ACPI MCFG Table not found"),
26078bf93f0SYJwu2023             Self::GetWrongHeader => write!(f, "GetWrongHeader with vendor id 0xffff"),
26178bf93f0SYJwu2023             Self::UnrecognisedHeaderType => write!(f, "Found device with unrecognised header type"),
26278bf93f0SYJwu2023             Self::PciDeviceStructureTransformError => {
26378bf93f0SYJwu2023                 write!(f, "Found None When transform Pci device structure")
26478bf93f0SYJwu2023             }
265cc36cf4aSYJwu2023             Self::PciIrqError(err) => write!(f, "Error occurred while setting irq :{:?}.", err),
26678bf93f0SYJwu2023         }
26778bf93f0SYJwu2023     }
26878bf93f0SYJwu2023 }
26978bf93f0SYJwu2023 
27078bf93f0SYJwu2023 /// trait类型Pci_Device_Structure表示pci设备,动态绑定三种具体设备类型:Pci_Device_Structure_General_Device、Pci_Device_Structure_Pci_to_Pci_Bridge、Pci_Device_Structure_Pci_to_Cardbus_Bridge
27178bf93f0SYJwu2023 pub trait PciDeviceStructure: Send + Sync {
27278bf93f0SYJwu2023     /// @brief 获取设备类型
27378bf93f0SYJwu2023     /// @return HeaderType 设备类型
27478bf93f0SYJwu2023     fn header_type(&self) -> HeaderType;
27578bf93f0SYJwu2023     /// @brief 当其为standard设备时返回&Pci_Device_Structure_General_Device,其余情况返回None
276cc36cf4aSYJwu2023     #[inline(always)]
27778bf93f0SYJwu2023     fn as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice> {
27878bf93f0SYJwu2023         None
27978bf93f0SYJwu2023     }
28078bf93f0SYJwu2023     /// @brief 当其为pci to pci bridge设备时返回&Pci_Device_Structure_Pci_to_Pci_Bridge,其余情况返回None
281cc36cf4aSYJwu2023     #[inline(always)]
28278bf93f0SYJwu2023     fn as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge> {
28378bf93f0SYJwu2023         None
28478bf93f0SYJwu2023     }
28578bf93f0SYJwu2023     /// @brief 当其为pci to cardbus bridge设备时返回&Pci_Device_Structure_Pci_to_Cardbus_Bridge,其余情况返回None
286cc36cf4aSYJwu2023     #[inline(always)]
28778bf93f0SYJwu2023     fn as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge> {
28878bf93f0SYJwu2023         None
28978bf93f0SYJwu2023     }
29078bf93f0SYJwu2023     /// @brief 获取Pci设备共有的common_header
29178bf93f0SYJwu2023     /// @return 返回其不可变引用
29278bf93f0SYJwu2023     fn common_header(&self) -> &PciDeviceStructureHeader;
29378bf93f0SYJwu2023     /// @brief 当其为standard设备时返回&mut Pci_Device_Structure_General_Device,其余情况返回None
294cc36cf4aSYJwu2023     #[inline(always)]
29578bf93f0SYJwu2023     fn as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice> {
29678bf93f0SYJwu2023         None
29778bf93f0SYJwu2023     }
29878bf93f0SYJwu2023     /// @brief 当其为pci to pci bridge设备时返回&mut Pci_Device_Structure_Pci_to_Pci_Bridge,其余情况返回None
299cc36cf4aSYJwu2023     #[inline(always)]
30078bf93f0SYJwu2023     fn as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge> {
30178bf93f0SYJwu2023         None
30278bf93f0SYJwu2023     }
30378bf93f0SYJwu2023     /// @brief 当其为pci to cardbus bridge设备时返回&mut Pci_Device_Structure_Pci_to_Cardbus_Bridge,其余情况返回None
304cc36cf4aSYJwu2023     #[inline(always)]
30578bf93f0SYJwu2023     fn as_pci_to_carbus_bridge_device_mut(
30678bf93f0SYJwu2023         &mut self,
30778bf93f0SYJwu2023     ) -> Option<&mut PciDeviceStructurePciToCardbusBridge> {
30878bf93f0SYJwu2023         None
30978bf93f0SYJwu2023     }
31078bf93f0SYJwu2023     /// @brief 返回迭代器,遍历capabilities
31178bf93f0SYJwu2023     fn capabilities(&self) -> Option<CapabilityIterator> {
31278bf93f0SYJwu2023         None
31378bf93f0SYJwu2023     }
31478bf93f0SYJwu2023     /// @brief 获取Status、Command寄存器的值
31578bf93f0SYJwu2023     fn status_command(&self) -> (Status, Command) {
31678bf93f0SYJwu2023         let common_header = self.common_header();
31778bf93f0SYJwu2023         let status = Status::from_bits_truncate(common_header.status);
31878bf93f0SYJwu2023         let command = Command::from_bits_truncate(common_header.command);
31978bf93f0SYJwu2023         (status, command)
32078bf93f0SYJwu2023     }
32178bf93f0SYJwu2023     /// @brief 设置Command寄存器的值
32278bf93f0SYJwu2023     fn set_command(&mut self, command: Command) {
32378bf93f0SYJwu2023         let common_header = self.common_header_mut();
32478bf93f0SYJwu2023         let command = command.bits();
32578bf93f0SYJwu2023         common_header.command = command;
32678bf93f0SYJwu2023         PciArch::write_config(
32778bf93f0SYJwu2023             &common_header.bus_device_function,
32878bf93f0SYJwu2023             STATUS_COMMAND_OFFSET,
32978bf93f0SYJwu2023             command as u32,
33078bf93f0SYJwu2023         );
33178bf93f0SYJwu2023     }
33278bf93f0SYJwu2023     /// @brief 获取Pci设备共有的common_header
33378bf93f0SYJwu2023     /// @return 返回其可变引用
33478bf93f0SYJwu2023     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader;
335cc36cf4aSYJwu2023 
33678bf93f0SYJwu2023     /// @brief 读取standard设备的bar寄存器,映射后将结果加入结构体的standard_device_bar变量
33778bf93f0SYJwu2023     /// @return 只有standard设备才返回成功或者错误,其余返回None
338cc36cf4aSYJwu2023     #[inline(always)]
339cc36cf4aSYJwu2023     fn bar_ioremap(&mut self) -> Option<Result<u8, PciError>> {
34078bf93f0SYJwu2023         None
34178bf93f0SYJwu2023     }
342cc36cf4aSYJwu2023     /// @brief 获取PCI设备的bar寄存器的引用
343cc36cf4aSYJwu2023     /// @return
344cc36cf4aSYJwu2023     #[inline(always)]
345cc36cf4aSYJwu2023     fn bar(&mut self) -> Option<&PciStandardDeviceBar> {
34678bf93f0SYJwu2023         None
34778bf93f0SYJwu2023     }
348cc36cf4aSYJwu2023     /// @brief 通过设置该pci设备的command
34978bf93f0SYJwu2023     fn enable_master(&mut self) {
35078bf93f0SYJwu2023         self.set_command(Command::IO_SPACE | Command::MEMORY_SPACE | Command::BUS_MASTER);
35178bf93f0SYJwu2023     }
352cc36cf4aSYJwu2023     /// @brief 寻找设备的msix空间的offset
353cc36cf4aSYJwu2023     fn msix_capability_offset(&self) -> Option<u8> {
354cc36cf4aSYJwu2023         for capability in self.capabilities()? {
355cc36cf4aSYJwu2023             if capability.id == PCI_CAP_ID_MSIX {
356cc36cf4aSYJwu2023                 return Some(capability.offset);
357cc36cf4aSYJwu2023             }
358cc36cf4aSYJwu2023         }
359cc36cf4aSYJwu2023         None
360cc36cf4aSYJwu2023     }
361cc36cf4aSYJwu2023     /// @brief 寻找设备的msi空间的offset
362cc36cf4aSYJwu2023     fn msi_capability_offset(&self) -> Option<u8> {
363cc36cf4aSYJwu2023         for capability in self.capabilities()? {
364cc36cf4aSYJwu2023             if capability.id == PCI_CAP_ID_MSI {
365cc36cf4aSYJwu2023                 return Some(capability.offset);
366cc36cf4aSYJwu2023             }
367cc36cf4aSYJwu2023         }
368cc36cf4aSYJwu2023         None
369cc36cf4aSYJwu2023     }
370cc36cf4aSYJwu2023     /// @brief 返回结构体中的irq_type的可变引用
371cc36cf4aSYJwu2023     fn irq_type_mut(&mut self) -> Option<&mut IrqType>;
372cc36cf4aSYJwu2023     /// @brief 返回结构体中的irq_vector的可变引用
373cc36cf4aSYJwu2023     fn irq_vector_mut(&mut self) -> Option<&mut Vec<u16>>;
37478bf93f0SYJwu2023 }
37578bf93f0SYJwu2023 
37678bf93f0SYJwu2023 /// Pci_Device_Structure_Header PCI设备结构体共有的头部
37778bf93f0SYJwu2023 #[derive(Clone, Debug)]
37878bf93f0SYJwu2023 pub struct PciDeviceStructureHeader {
37978bf93f0SYJwu2023     // ==== busdevicefunction变量表示该结构体所处的位置
38078bf93f0SYJwu2023     pub bus_device_function: BusDeviceFunction,
38178bf93f0SYJwu2023     pub vendor_id: u16, // 供应商ID 0xffff是一个无效值,在读取访问不存在的设备的配置空间寄存器时返回
38278bf93f0SYJwu2023     pub device_id: u16, // 设备ID,标志特定设备
38378bf93f0SYJwu2023     pub command: u16, // 提供对设备生成和响应pci周期的能力的控制 向该寄存器写入0时,设备与pci总线断开除配置空间访问以外的所有连接
38478bf93f0SYJwu2023     pub status: u16,  // 用于记录pci总线相关时间的状态信息寄存器
38578bf93f0SYJwu2023     pub revision_id: u8, // 修订ID,指定特定设备的修订标志符
38678bf93f0SYJwu2023     pub prog_if: u8, // 编程接口字节,一个只读寄存器,指定设备具有的寄存器级别的编程接口(如果有的话)
38778bf93f0SYJwu2023     pub subclass: u8, // 子类。指定设备执行的特定功能的只读寄存器
38878bf93f0SYJwu2023     pub class_code: u8, // 类代码,一个只读寄存器,指定设备执行的功能类型
38978bf93f0SYJwu2023     pub cache_line_size: u8, // 缓存线大小:以 32 位为单位指定系统缓存线大小。设备可以限制它可以支持的缓存线大小的数量,如果不支持的值写入该字段,设备将表现得好像写入了 0 值
39078bf93f0SYJwu2023     pub latency_timer: u8,   // 延迟计时器:以 PCI 总线时钟为单位指定延迟计时器。
39178bf93f0SYJwu2023     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.
39278bf93f0SYJwu2023     pub bist: u8, // Represents that status and allows control of a devices BIST (built-in self test).
39378bf93f0SYJwu2023                   // Here is the layout of the BIST register:
39478bf93f0SYJwu2023                   // |     bit7     |    bit6    | Bits 5-4 |     Bits 3-0    |
39578bf93f0SYJwu2023                   // | BIST Capable | Start BIST | Reserved | Completion Code |
39678bf93f0SYJwu2023                   // for more details, please visit https://wiki.osdev.org/PCI
39778bf93f0SYJwu2023 }
39878bf93f0SYJwu2023 
39978bf93f0SYJwu2023 /// Pci_Device_Structure_General_Device PCI标准设备结构体
40078bf93f0SYJwu2023 #[derive(Clone, Debug)]
40178bf93f0SYJwu2023 pub struct PciDeviceStructureGeneralDevice {
40278bf93f0SYJwu2023     pub common_header: PciDeviceStructureHeader,
403cc36cf4aSYJwu2023     // 中断结构体,包括legacy,msi,msix三种情况
404cc36cf4aSYJwu2023     pub irq_type: IrqType,
405cc36cf4aSYJwu2023     // 使用的中断号的vec集合
406cc36cf4aSYJwu2023     pub irq_vector: Vec<u16>,
40778bf93f0SYJwu2023     pub standard_device_bar: PciStandardDeviceBar,
40878bf93f0SYJwu2023     pub cardbus_cis_pointer: u32, // 指向卡信息结构,供在 CardBus 和 PCI 之间共享芯片的设备使用。
40978bf93f0SYJwu2023     pub subsystem_vendor_id: u16,
41078bf93f0SYJwu2023     pub subsystem_id: u16,
41178bf93f0SYJwu2023     pub expansion_rom_base_address: u32,
41278bf93f0SYJwu2023     pub capabilities_pointer: u8,
41378bf93f0SYJwu2023     pub reserved0: u8,
41478bf93f0SYJwu2023     pub reserved1: u16,
41578bf93f0SYJwu2023     pub reserved2: u32,
41678bf93f0SYJwu2023     pub interrupt_line: u8, // 指定设备的中断引脚连接到系统中断控制器的哪个输入,并由任何使用中断引脚的设备实现。对于 x86 架构,此寄存器对应于 PIC IRQ 编号 0-15(而不是 I/O APIC IRQ 编号),并且值0xFF定义为无连接。
41778bf93f0SYJwu2023     pub interrupt_pin: u8, // 指定设备使用的中断引脚。其中值为0x1INTA#、0x2INTB#、0x3INTC#、0x4INTD#,0x0表示设备不使用中断引脚。
41878bf93f0SYJwu2023     pub min_grant: u8, // 一个只读寄存器,用于指定设备所需的突发周期长度(以 1/4 微秒为单位)(假设时钟速率为 33 MHz)
41978bf93f0SYJwu2023     pub max_latency: u8, // 一个只读寄存器,指定设备需要多长时间访问一次 PCI 总线(以 1/4 微秒为单位)。
42078bf93f0SYJwu2023 }
42178bf93f0SYJwu2023 impl PciDeviceStructure for PciDeviceStructureGeneralDevice {
422cc36cf4aSYJwu2023     #[inline(always)]
42378bf93f0SYJwu2023     fn header_type(&self) -> HeaderType {
42478bf93f0SYJwu2023         HeaderType::Standard
42578bf93f0SYJwu2023     }
426cc36cf4aSYJwu2023     #[inline(always)]
42778bf93f0SYJwu2023     fn as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice> {
42878bf93f0SYJwu2023         Some(self)
42978bf93f0SYJwu2023     }
430cc36cf4aSYJwu2023     #[inline(always)]
43178bf93f0SYJwu2023     fn as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice> {
43278bf93f0SYJwu2023         Some(self)
43378bf93f0SYJwu2023     }
434cc36cf4aSYJwu2023     #[inline(always)]
43578bf93f0SYJwu2023     fn common_header(&self) -> &PciDeviceStructureHeader {
43678bf93f0SYJwu2023         &self.common_header
43778bf93f0SYJwu2023     }
438cc36cf4aSYJwu2023     #[inline(always)]
43978bf93f0SYJwu2023     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader {
44078bf93f0SYJwu2023         &mut self.common_header
44178bf93f0SYJwu2023     }
44278bf93f0SYJwu2023     fn capabilities(&self) -> Option<CapabilityIterator> {
44378bf93f0SYJwu2023         Some(CapabilityIterator {
44478bf93f0SYJwu2023             bus_device_function: self.common_header.bus_device_function,
44578bf93f0SYJwu2023             next_capability_offset: Some(self.capabilities_pointer),
44678bf93f0SYJwu2023         })
44778bf93f0SYJwu2023     }
448cc36cf4aSYJwu2023     fn bar_ioremap(&mut self) -> Option<Result<u8, PciError>> {
44978bf93f0SYJwu2023         let common_header = &self.common_header;
45078bf93f0SYJwu2023         match pci_bar_init(common_header.bus_device_function) {
45178bf93f0SYJwu2023             Ok(bar) => {
45278bf93f0SYJwu2023                 self.standard_device_bar = bar;
45378bf93f0SYJwu2023                 Some(Ok(0))
45478bf93f0SYJwu2023             }
45578bf93f0SYJwu2023             Err(e) => Some(Err(e)),
45678bf93f0SYJwu2023         }
45778bf93f0SYJwu2023     }
458cc36cf4aSYJwu2023     fn bar(&mut self) -> Option<&PciStandardDeviceBar> {
459cc36cf4aSYJwu2023         Some(&self.standard_device_bar)
46078bf93f0SYJwu2023     }
461cc36cf4aSYJwu2023     #[inline(always)]
462cc36cf4aSYJwu2023     fn irq_type_mut(&mut self) -> Option<&mut IrqType> {
463cc36cf4aSYJwu2023         Some(&mut self.irq_type)
464cc36cf4aSYJwu2023     }
465cc36cf4aSYJwu2023     #[inline(always)]
466cc36cf4aSYJwu2023     fn irq_vector_mut(&mut self) -> Option<&mut Vec<u16>> {
467cc36cf4aSYJwu2023         Some(&mut self.irq_vector)
468cc36cf4aSYJwu2023     }
469cc36cf4aSYJwu2023 }
470cc36cf4aSYJwu2023 
47178bf93f0SYJwu2023 /// Pci_Device_Structure_Pci_to_Pci_Bridge pci-to-pci桥设备结构体
47278bf93f0SYJwu2023 #[derive(Clone, Debug)]
47378bf93f0SYJwu2023 pub struct PciDeviceStructurePciToPciBridge {
47478bf93f0SYJwu2023     pub common_header: PciDeviceStructureHeader,
475cc36cf4aSYJwu2023     // 中断结构体,包括legacy,msi,msix三种情况
476cc36cf4aSYJwu2023     pub irq_type: IrqType,
477cc36cf4aSYJwu2023     // 使用的中断号的vec集合
478cc36cf4aSYJwu2023     pub irq_vector: Vec<u16>,
47978bf93f0SYJwu2023     pub bar0: u32,
48078bf93f0SYJwu2023     pub bar1: u32,
48178bf93f0SYJwu2023     pub primary_bus_number: u8,
48278bf93f0SYJwu2023     pub secondary_bus_number: u8,
48378bf93f0SYJwu2023     pub subordinate_bus_number: u8,
48478bf93f0SYJwu2023     pub secondary_latency_timer: u8,
48578bf93f0SYJwu2023     pub io_base: u8,
48678bf93f0SYJwu2023     pub io_limit: u8,
48778bf93f0SYJwu2023     pub secondary_status: u16,
48878bf93f0SYJwu2023     pub memory_base: u16,
48978bf93f0SYJwu2023     pub memory_limit: u16,
49078bf93f0SYJwu2023     pub prefetchable_memory_base: u16,
49178bf93f0SYJwu2023     pub prefetchable_memory_limit: u16,
49278bf93f0SYJwu2023     pub prefetchable_base_upper_32_bits: u32,
49378bf93f0SYJwu2023     pub prefetchable_limit_upper_32_bits: u32,
49478bf93f0SYJwu2023     pub io_base_upper_16_bits: u16,
49578bf93f0SYJwu2023     pub io_limit_upper_16_bits: u16,
49678bf93f0SYJwu2023     pub capability_pointer: u8,
49778bf93f0SYJwu2023     pub reserved0: u8,
49878bf93f0SYJwu2023     pub reserved1: u16,
49978bf93f0SYJwu2023     pub expansion_rom_base_address: u32,
50078bf93f0SYJwu2023     pub interrupt_line: u8,
50178bf93f0SYJwu2023     pub interrupt_pin: u8,
50278bf93f0SYJwu2023     pub bridge_control: u16,
50378bf93f0SYJwu2023 }
50478bf93f0SYJwu2023 impl PciDeviceStructure for PciDeviceStructurePciToPciBridge {
505cc36cf4aSYJwu2023     #[inline(always)]
50678bf93f0SYJwu2023     fn header_type(&self) -> HeaderType {
50778bf93f0SYJwu2023         HeaderType::PciPciBridge
50878bf93f0SYJwu2023     }
509cc36cf4aSYJwu2023     #[inline(always)]
51078bf93f0SYJwu2023     fn as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge> {
51178bf93f0SYJwu2023         Some(self)
51278bf93f0SYJwu2023     }
513cc36cf4aSYJwu2023     #[inline(always)]
51478bf93f0SYJwu2023     fn as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge> {
51578bf93f0SYJwu2023         Some(self)
51678bf93f0SYJwu2023     }
517cc36cf4aSYJwu2023     #[inline(always)]
51878bf93f0SYJwu2023     fn common_header(&self) -> &PciDeviceStructureHeader {
51978bf93f0SYJwu2023         &self.common_header
52078bf93f0SYJwu2023     }
521cc36cf4aSYJwu2023     #[inline(always)]
52278bf93f0SYJwu2023     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader {
52378bf93f0SYJwu2023         &mut self.common_header
52478bf93f0SYJwu2023     }
525cc36cf4aSYJwu2023     #[inline(always)]
526cc36cf4aSYJwu2023     fn irq_type_mut(&mut self) -> Option<&mut IrqType> {
527cc36cf4aSYJwu2023         Some(&mut self.irq_type)
528cc36cf4aSYJwu2023     }
529cc36cf4aSYJwu2023     #[inline(always)]
530cc36cf4aSYJwu2023     fn irq_vector_mut(&mut self) -> Option<&mut Vec<u16>> {
531cc36cf4aSYJwu2023         Some(&mut self.irq_vector)
532cc36cf4aSYJwu2023     }
53378bf93f0SYJwu2023 }
53478bf93f0SYJwu2023 /// Pci_Device_Structure_Pci_to_Cardbus_Bridge Pci_to_Cardbus桥设备结构体
53578bf93f0SYJwu2023 #[derive(Clone, Debug)]
53678bf93f0SYJwu2023 pub struct PciDeviceStructurePciToCardbusBridge {
53778bf93f0SYJwu2023     pub common_header: PciDeviceStructureHeader,
53878bf93f0SYJwu2023     pub cardbus_socket_ex_ca_base_address: u32,
53978bf93f0SYJwu2023     pub offset_of_capabilities_list: u8,
54078bf93f0SYJwu2023     pub reserved: u8,
54178bf93f0SYJwu2023     pub secondary_status: u16,
54278bf93f0SYJwu2023     pub pci_bus_number: u8,
54378bf93f0SYJwu2023     pub card_bus_bus_number: u8,
54478bf93f0SYJwu2023     pub subordinate_bus_number: u8,
54578bf93f0SYJwu2023     pub card_bus_latency_timer: u8,
54678bf93f0SYJwu2023     pub memory_base_address0: u32,
54778bf93f0SYJwu2023     pub memory_limit0: u32,
54878bf93f0SYJwu2023     pub memory_base_address1: u32,
54978bf93f0SYJwu2023     pub memory_limit1: u32,
55078bf93f0SYJwu2023     pub io_base_address0: u32,
55178bf93f0SYJwu2023     pub io_limit0: u32,
55278bf93f0SYJwu2023     pub io_base_address1: u32,
55378bf93f0SYJwu2023     pub io_limit1: u32,
55478bf93f0SYJwu2023     pub interrupt_line: u8,
55578bf93f0SYJwu2023     pub interrupt_pin: u8,
55678bf93f0SYJwu2023     pub bridge_control: u16,
55778bf93f0SYJwu2023     pub subsystem_device_id: u16,
55878bf93f0SYJwu2023     pub subsystem_vendor_id: u16,
55978bf93f0SYJwu2023     pub pc_card_legacy_mode_base_address_16_bit: u32,
56078bf93f0SYJwu2023 }
56178bf93f0SYJwu2023 impl PciDeviceStructure for PciDeviceStructurePciToCardbusBridge {
562cc36cf4aSYJwu2023     #[inline(always)]
56378bf93f0SYJwu2023     fn header_type(&self) -> HeaderType {
56478bf93f0SYJwu2023         HeaderType::PciCardbusBridge
56578bf93f0SYJwu2023     }
566cc36cf4aSYJwu2023     #[inline(always)]
56778bf93f0SYJwu2023     fn as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge> {
56878bf93f0SYJwu2023         Some(&self)
56978bf93f0SYJwu2023     }
570cc36cf4aSYJwu2023     #[inline(always)]
57178bf93f0SYJwu2023     fn as_pci_to_carbus_bridge_device_mut(
57278bf93f0SYJwu2023         &mut self,
57378bf93f0SYJwu2023     ) -> Option<&mut PciDeviceStructurePciToCardbusBridge> {
57478bf93f0SYJwu2023         Some(self)
57578bf93f0SYJwu2023     }
576cc36cf4aSYJwu2023     #[inline(always)]
57778bf93f0SYJwu2023     fn common_header(&self) -> &PciDeviceStructureHeader {
57878bf93f0SYJwu2023         &self.common_header
57978bf93f0SYJwu2023     }
580cc36cf4aSYJwu2023     #[inline(always)]
58178bf93f0SYJwu2023     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader {
58278bf93f0SYJwu2023         &mut self.common_header
58378bf93f0SYJwu2023     }
584cc36cf4aSYJwu2023     #[inline(always)]
585cc36cf4aSYJwu2023     fn irq_type_mut(&mut self) -> Option<&mut IrqType> {
586cc36cf4aSYJwu2023         None
587cc36cf4aSYJwu2023     }
588cc36cf4aSYJwu2023     #[inline(always)]
589cc36cf4aSYJwu2023     fn irq_vector_mut(&mut self) -> Option<&mut Vec<u16>> {
590cc36cf4aSYJwu2023         None
591cc36cf4aSYJwu2023     }
59278bf93f0SYJwu2023 }
59378bf93f0SYJwu2023 
59478bf93f0SYJwu2023 /// 代表一个PCI segement greoup.
59578bf93f0SYJwu2023 #[derive(Copy, Clone, Debug, PartialEq)]
59678bf93f0SYJwu2023 pub struct PciRoot {
59778bf93f0SYJwu2023     pub physical_address_base: u64,                //物理地址,acpi获取
59878bf93f0SYJwu2023     pub mmio_base: Option<*mut u32>,               //映射后的虚拟地址,为方便访问数据这里转化成指针
59978bf93f0SYJwu2023     pub segement_group_number: SegmentGroupNumber, //segement greoup的id
60078bf93f0SYJwu2023     pub bus_begin: u8,                             //该分组中的最小bus
60178bf93f0SYJwu2023     pub bus_end: u8,                               //该分组中的最大bus
60278bf93f0SYJwu2023 }
60378bf93f0SYJwu2023 ///线程间共享需要,该结构体只需要在初始化时写入数据,无需读写锁保证线程安全
60478bf93f0SYJwu2023 unsafe impl Send for PciRoot {}
60578bf93f0SYJwu2023 unsafe impl Sync for PciRoot {}
60678bf93f0SYJwu2023 ///实现PciRoot的Display trait,自定义输出
60778bf93f0SYJwu2023 impl Display for PciRoot {
60878bf93f0SYJwu2023     fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result {
60978bf93f0SYJwu2023         write!(
61078bf93f0SYJwu2023                 f,
6115c1e552cSYJwu2023                 "PCI Root with segement:{}, bus begin at {}, bus end at {}, physical address at {:#x},mapped at {:#x}",
61278bf93f0SYJwu2023                 self.segement_group_number, self.bus_begin, self.bus_end, self.physical_address_base, self.mmio_base.unwrap() as usize
61378bf93f0SYJwu2023             )
61478bf93f0SYJwu2023     }
61578bf93f0SYJwu2023 }
61678bf93f0SYJwu2023 
61778bf93f0SYJwu2023 impl PciRoot {
61878bf93f0SYJwu2023     /// @brief 初始化结构体,获取ecam root所在物理地址后map到虚拟地址,再将该虚拟地址加入mmio_base变量
61978bf93f0SYJwu2023     /// @return 成功返回结果,错误返回错误类型
62078bf93f0SYJwu2023     pub fn new(segment_group_number: SegmentGroupNumber) -> Result<Self, PciError> {
62178bf93f0SYJwu2023         let mut pci_root = PciArch::ecam_root(segment_group_number)?;
62278bf93f0SYJwu2023         pci_root.map()?;
62378bf93f0SYJwu2023         Ok(pci_root)
62478bf93f0SYJwu2023     }
62578bf93f0SYJwu2023     /// @brief  完成物理地址到虚拟地址的映射,并将虚拟地址加入mmio_base变量
62678bf93f0SYJwu2023     /// @return 返回错误或Ok(0)
62778bf93f0SYJwu2023     fn map(&mut self) -> Result<u8, PciError> {
6285c1e552cSYJwu2023         //kdebug!("bus_begin={},bus_end={}", self.bus_begin,self.bus_end);
6295c1e552cSYJwu2023         let bus_number = (self.bus_end - self.bus_begin) as u32 + 1;
6305c1e552cSYJwu2023         let bus_number_double = (bus_number - 1) / 2 + 1; //一个bus占据1MB空间,计算全部bus占据空间相对于2MB空间的个数
63178bf93f0SYJwu2023         let mut virtaddress: u64 = 0;
63278bf93f0SYJwu2023         let vaddr_ptr = &mut virtaddress as *mut u64;
63378bf93f0SYJwu2023         let mut virtsize: u64 = 0;
63478bf93f0SYJwu2023         let virtsize_ptr = &mut virtsize as *mut u64;
6355c1e552cSYJwu2023         let size = bus_number_double * PAGE_2M_SIZE;
63678bf93f0SYJwu2023         unsafe {
637*40fe15e0SLoGin             if let Err(_) = mmio_pool().create_mmio(
638*40fe15e0SLoGin                 size as usize,
639*40fe15e0SLoGin                 (VM_IO | VM_DONTCOPY) as u64,
640*40fe15e0SLoGin                 vaddr_ptr,
641*40fe15e0SLoGin                 virtsize_ptr,
642*40fe15e0SLoGin             ) {
64378bf93f0SYJwu2023                 kerror!("Create mmio failed when initing ecam");
64478bf93f0SYJwu2023                 return Err(PciError::CreateMmioError);
64578bf93f0SYJwu2023             };
646*40fe15e0SLoGin 
64778bf93f0SYJwu2023             //kdebug!("virtaddress={:#x},virtsize={:#x}",virtaddress,virtsize);
648*40fe15e0SLoGin             let vaddr = VirtAddr::new(virtaddress as usize);
649*40fe15e0SLoGin             let paddr = PhysAddr::new(self.physical_address_base as usize);
650*40fe15e0SLoGin             // kdebug!("pci root: map: vaddr={vaddr:?}, paddr={paddr:?}, size={size}");
651*40fe15e0SLoGin             let page_flags = PageFlags::mmio_flags();
652*40fe15e0SLoGin             let mut kernel_mapper = KernelMapper::lock();
653*40fe15e0SLoGin             // todo: 添加错误处理代码。因为内核映射器可能是只读的,所以可能会出错
654*40fe15e0SLoGin             assert!(kernel_mapper
655*40fe15e0SLoGin                 .map_phys_with_size(vaddr, paddr, size as usize, page_flags, true)
656*40fe15e0SLoGin                 .is_ok());
657*40fe15e0SLoGin             drop(kernel_mapper);
65878bf93f0SYJwu2023         }
65978bf93f0SYJwu2023         self.mmio_base = Some(virtaddress as *mut u32);
66078bf93f0SYJwu2023         Ok(0)
66178bf93f0SYJwu2023     }
66278bf93f0SYJwu2023     /// @brief 获得要操作的寄存器相对于mmio_offset的偏移量
66378bf93f0SYJwu2023     /// @param bus_device_function 在同一个group中pci设备的唯一标识符
66478bf93f0SYJwu2023     /// @param register_offset 寄存器在设备中的offset
66578bf93f0SYJwu2023     /// @return u32 要操作的寄存器相对于mmio_offset的偏移量
66678bf93f0SYJwu2023     fn cam_offset(&self, bus_device_function: BusDeviceFunction, register_offset: u16) -> u32 {
66778bf93f0SYJwu2023         assert!(bus_device_function.valid());
66878bf93f0SYJwu2023         let bdf = ((bus_device_function.bus - self.bus_begin) as u32) << 8
66978bf93f0SYJwu2023             | (bus_device_function.device as u32) << 3
67078bf93f0SYJwu2023             | bus_device_function.function as u32;
67178bf93f0SYJwu2023         let address = bdf << 12 | register_offset as u32;
67278bf93f0SYJwu2023         // Ensure that address is word-aligned.
67378bf93f0SYJwu2023         assert!(address & 0x3 == 0);
67478bf93f0SYJwu2023         address
67578bf93f0SYJwu2023     }
67678bf93f0SYJwu2023     /// @brief 通过bus_device_function和offset读取相应位置寄存器的值(32位)
67778bf93f0SYJwu2023     /// @param bus_device_function 在同一个group中pci设备的唯一标识符
67878bf93f0SYJwu2023     /// @param register_offset 寄存器在设备中的offset
67978bf93f0SYJwu2023     /// @return u32 寄存器读值结果
68013776c11Slogin     pub fn read_config(&self, bus_device_function: BusDeviceFunction, register_offset: u16) -> u32 {
68178bf93f0SYJwu2023         let address = self.cam_offset(bus_device_function, register_offset);
68278bf93f0SYJwu2023         unsafe {
68378bf93f0SYJwu2023             // Right shift to convert from byte offset to word offset.
68478bf93f0SYJwu2023             (self.mmio_base.unwrap().add((address >> 2) as usize)).read_volatile()
68578bf93f0SYJwu2023         }
68678bf93f0SYJwu2023     }
68778bf93f0SYJwu2023 
68878bf93f0SYJwu2023     /// @brief 通过bus_device_function和offset写入相应位置寄存器值(32位)
68978bf93f0SYJwu2023     /// @param bus_device_function 在同一个group中pci设备的唯一标识符
69078bf93f0SYJwu2023     /// @param register_offset 寄存器在设备中的offset
69178bf93f0SYJwu2023     /// @param data 要写入的值
69278bf93f0SYJwu2023     pub fn write_config(
69378bf93f0SYJwu2023         &mut self,
69478bf93f0SYJwu2023         bus_device_function: BusDeviceFunction,
69578bf93f0SYJwu2023         register_offset: u16,
69678bf93f0SYJwu2023         data: u32,
69778bf93f0SYJwu2023     ) {
69878bf93f0SYJwu2023         let address = self.cam_offset(bus_device_function, register_offset);
69978bf93f0SYJwu2023         // Safe because both the `mmio_base` and the address offset are properly aligned, and the
70078bf93f0SYJwu2023         // resulting pointer is within the MMIO range of the CAM.
70178bf93f0SYJwu2023         unsafe {
70278bf93f0SYJwu2023             // Right shift to convert from byte offset to word offset.
70378bf93f0SYJwu2023             (self.mmio_base.unwrap().add((address >> 2) as usize)).write_volatile(data)
70478bf93f0SYJwu2023         }
70578bf93f0SYJwu2023     }
70678bf93f0SYJwu2023     /// @brief 返回迭代器,遍历pcie设备的external_capabilities
70778bf93f0SYJwu2023     pub fn external_capabilities(
70878bf93f0SYJwu2023         &self,
70978bf93f0SYJwu2023         bus_device_function: BusDeviceFunction,
71078bf93f0SYJwu2023     ) -> ExternalCapabilityIterator {
71178bf93f0SYJwu2023         ExternalCapabilityIterator {
71278bf93f0SYJwu2023             root: self,
71378bf93f0SYJwu2023             bus_device_function,
71478bf93f0SYJwu2023             next_capability_offset: Some(0x100),
71578bf93f0SYJwu2023         }
71678bf93f0SYJwu2023     }
71778bf93f0SYJwu2023 }
71826d84a31SYJwu2023 /// Gets the capabilities 'pointer' for the device function, if any.
71926d84a31SYJwu2023 /// @brief 获取第一个capability 的offset
72078bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识
72126d84a31SYJwu2023 /// @return Option<u8> offset
72278bf93f0SYJwu2023 pub fn capabilities_offset(bus_device_function: BusDeviceFunction) -> Option<u8> {
72378bf93f0SYJwu2023     let result = PciArch::read_config(&bus_device_function, STATUS_COMMAND_OFFSET);
72478bf93f0SYJwu2023     let status: Status = Status::from_bits_truncate((result >> 16) as u16);
72526d84a31SYJwu2023     if status.contains(Status::CAPABILITIES_LIST) {
72678bf93f0SYJwu2023         let cap_pointer = PciArch::read_config(&bus_device_function, 0x34) as u8 & 0xFC;
72726d84a31SYJwu2023         Some(cap_pointer)
72826d84a31SYJwu2023     } else {
72926d84a31SYJwu2023         None
73026d84a31SYJwu2023     }
73126d84a31SYJwu2023 }
73278bf93f0SYJwu2023 
73378bf93f0SYJwu2023 /// @brief 读取pci设备头部
73478bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识
73578bf93f0SYJwu2023 /// @param add_to_list 是否添加到链表
73678bf93f0SYJwu2023 /// @return 返回的header(trait 类型)
73778bf93f0SYJwu2023 fn pci_read_header(
73878bf93f0SYJwu2023     bus_device_function: BusDeviceFunction,
73978bf93f0SYJwu2023     add_to_list: bool,
74078bf93f0SYJwu2023 ) -> Result<Box<dyn PciDeviceStructure>, PciError> {
74178bf93f0SYJwu2023     // 先读取公共header
74278bf93f0SYJwu2023     let result = PciArch::read_config(&bus_device_function, 0x00);
74378bf93f0SYJwu2023     let vendor_id = result as u16;
74478bf93f0SYJwu2023     let device_id = (result >> 16) as u16;
74578bf93f0SYJwu2023 
74678bf93f0SYJwu2023     let result = PciArch::read_config(&bus_device_function, 0x04);
74778bf93f0SYJwu2023     let command = result as u16;
74878bf93f0SYJwu2023     let status = (result >> 16) as u16;
74978bf93f0SYJwu2023 
75078bf93f0SYJwu2023     let result = PciArch::read_config(&bus_device_function, 0x08);
75178bf93f0SYJwu2023     let revision_id = result as u8;
75278bf93f0SYJwu2023     let prog_if = (result >> 8) as u8;
75378bf93f0SYJwu2023     let subclass = (result >> 16) as u8;
75478bf93f0SYJwu2023     let class_code = (result >> 24) as u8;
75578bf93f0SYJwu2023 
75678bf93f0SYJwu2023     let result = PciArch::read_config(&bus_device_function, 0x0c);
75778bf93f0SYJwu2023     let cache_line_size = result as u8;
75878bf93f0SYJwu2023     let latency_timer = (result >> 8) as u8;
75978bf93f0SYJwu2023     let header_type = (result >> 16) as u8;
76078bf93f0SYJwu2023     let bist = (result >> 24) as u8;
76178bf93f0SYJwu2023     if vendor_id == 0xffff {
76278bf93f0SYJwu2023         return Err(PciError::GetWrongHeader);
76378bf93f0SYJwu2023     }
76478bf93f0SYJwu2023     let header = PciDeviceStructureHeader {
76578bf93f0SYJwu2023         bus_device_function,
76678bf93f0SYJwu2023         vendor_id,
76778bf93f0SYJwu2023         device_id,
76878bf93f0SYJwu2023         command,
76978bf93f0SYJwu2023         status,
77078bf93f0SYJwu2023         revision_id,
77178bf93f0SYJwu2023         prog_if,
77278bf93f0SYJwu2023         subclass,
77378bf93f0SYJwu2023         class_code,
77478bf93f0SYJwu2023         cache_line_size,
77578bf93f0SYJwu2023         latency_timer,
77678bf93f0SYJwu2023         header_type,
77778bf93f0SYJwu2023         bist,
77878bf93f0SYJwu2023     };
77978bf93f0SYJwu2023     match HeaderType::from(header_type & 0x7f) {
78078bf93f0SYJwu2023         HeaderType::Standard => {
78178bf93f0SYJwu2023             let general_device = pci_read_general_device_header(header, &bus_device_function);
78278bf93f0SYJwu2023             let box_general_device = Box::new(general_device);
78378bf93f0SYJwu2023             let box_general_device_clone = box_general_device.clone();
78478bf93f0SYJwu2023             if add_to_list {
78578bf93f0SYJwu2023                 PCI_DEVICE_LINKEDLIST.add(box_general_device);
78678bf93f0SYJwu2023             }
78778bf93f0SYJwu2023             Ok(box_general_device_clone)
78878bf93f0SYJwu2023         }
78978bf93f0SYJwu2023         HeaderType::PciPciBridge => {
79078bf93f0SYJwu2023             let pci_to_pci_bridge = pci_read_pci_to_pci_bridge_header(header, &bus_device_function);
79178bf93f0SYJwu2023             let box_pci_to_pci_bridge = Box::new(pci_to_pci_bridge);
79278bf93f0SYJwu2023             let box_pci_to_pci_bridge_clone = box_pci_to_pci_bridge.clone();
79378bf93f0SYJwu2023             if add_to_list {
79478bf93f0SYJwu2023                 PCI_DEVICE_LINKEDLIST.add(box_pci_to_pci_bridge);
79578bf93f0SYJwu2023             }
79678bf93f0SYJwu2023             Ok(box_pci_to_pci_bridge_clone)
79778bf93f0SYJwu2023         }
79878bf93f0SYJwu2023         HeaderType::PciCardbusBridge => {
79978bf93f0SYJwu2023             let pci_cardbus_bridge =
80078bf93f0SYJwu2023                 pci_read_pci_to_cardbus_bridge_header(header, &bus_device_function);
80178bf93f0SYJwu2023             let box_pci_cardbus_bridge = Box::new(pci_cardbus_bridge);
80278bf93f0SYJwu2023             let box_pci_cardbus_bridge_clone = box_pci_cardbus_bridge.clone();
80378bf93f0SYJwu2023             if add_to_list {
80478bf93f0SYJwu2023                 PCI_DEVICE_LINKEDLIST.add(box_pci_cardbus_bridge);
80578bf93f0SYJwu2023             }
80678bf93f0SYJwu2023             Ok(box_pci_cardbus_bridge_clone)
80778bf93f0SYJwu2023         }
80878bf93f0SYJwu2023         HeaderType::Unrecognised(_) => Err(PciError::UnrecognisedHeaderType),
80978bf93f0SYJwu2023     }
81078bf93f0SYJwu2023 }
81178bf93f0SYJwu2023 
81278bf93f0SYJwu2023 /// @brief 读取type为0x0的pci设备的header
81378bf93f0SYJwu2023 /// 本函数只应被 pci_read_header()调用
81478bf93f0SYJwu2023 /// @param common_header 共有头部
81578bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识
81678bf93f0SYJwu2023 /// @return Pci_Device_Structure_General_Device 标准设备头部
81778bf93f0SYJwu2023 fn pci_read_general_device_header(
81878bf93f0SYJwu2023     common_header: PciDeviceStructureHeader,
81978bf93f0SYJwu2023     bus_device_function: &BusDeviceFunction,
82078bf93f0SYJwu2023 ) -> PciDeviceStructureGeneralDevice {
82178bf93f0SYJwu2023     let standard_device_bar = PciStandardDeviceBar::default();
82278bf93f0SYJwu2023     let cardbus_cis_pointer = PciArch::read_config(bus_device_function, 0x28);
82378bf93f0SYJwu2023 
82478bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x2c);
82578bf93f0SYJwu2023     let subsystem_vendor_id = result as u16;
82678bf93f0SYJwu2023     let subsystem_id = (result >> 16) as u16;
82778bf93f0SYJwu2023 
82878bf93f0SYJwu2023     let expansion_rom_base_address = PciArch::read_config(bus_device_function, 0x30);
82978bf93f0SYJwu2023 
83078bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x34);
83178bf93f0SYJwu2023     let capabilities_pointer = result as u8;
83278bf93f0SYJwu2023     let reserved0 = (result >> 8) as u8;
83378bf93f0SYJwu2023     let reserved1 = (result >> 16) as u16;
83478bf93f0SYJwu2023 
83578bf93f0SYJwu2023     let reserved2 = PciArch::read_config(bus_device_function, 0x38);
83678bf93f0SYJwu2023 
83778bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x3c);
83878bf93f0SYJwu2023     let interrupt_line = result as u8;
83978bf93f0SYJwu2023     let interrupt_pin = (result >> 8) as u8;
84078bf93f0SYJwu2023     let min_grant = (result >> 16) as u8;
84178bf93f0SYJwu2023     let max_latency = (result >> 24) as u8;
84278bf93f0SYJwu2023     PciDeviceStructureGeneralDevice {
84378bf93f0SYJwu2023         common_header,
844cc36cf4aSYJwu2023         irq_type: IrqType::Unused,
845cc36cf4aSYJwu2023         irq_vector: Vec::new(),
84678bf93f0SYJwu2023         standard_device_bar,
84778bf93f0SYJwu2023         cardbus_cis_pointer,
84878bf93f0SYJwu2023         subsystem_vendor_id,
84978bf93f0SYJwu2023         subsystem_id,
85078bf93f0SYJwu2023         expansion_rom_base_address,
85178bf93f0SYJwu2023         capabilities_pointer,
85278bf93f0SYJwu2023         reserved0,
85378bf93f0SYJwu2023         reserved1,
85478bf93f0SYJwu2023         reserved2,
85578bf93f0SYJwu2023         interrupt_line,
85678bf93f0SYJwu2023         interrupt_pin,
85778bf93f0SYJwu2023         min_grant,
85878bf93f0SYJwu2023         max_latency,
85978bf93f0SYJwu2023     }
86078bf93f0SYJwu2023 }
86178bf93f0SYJwu2023 
86278bf93f0SYJwu2023 /// @brief 读取type为0x1的pci设备的header
86378bf93f0SYJwu2023 /// 本函数只应被 pci_read_header()调用
86478bf93f0SYJwu2023 /// @param common_header 共有头部
86578bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识
86678bf93f0SYJwu2023 /// @return Pci_Device_Structure_Pci_to_Pci_Bridge pci-to-pci 桥设备头部
86778bf93f0SYJwu2023 fn pci_read_pci_to_pci_bridge_header(
86878bf93f0SYJwu2023     common_header: PciDeviceStructureHeader,
86978bf93f0SYJwu2023     bus_device_function: &BusDeviceFunction,
87078bf93f0SYJwu2023 ) -> PciDeviceStructurePciToPciBridge {
87178bf93f0SYJwu2023     let bar0 = PciArch::read_config(bus_device_function, 0x10);
87278bf93f0SYJwu2023     let bar1 = PciArch::read_config(bus_device_function, 0x14);
87378bf93f0SYJwu2023 
87478bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x18);
87578bf93f0SYJwu2023 
87678bf93f0SYJwu2023     let primary_bus_number = result as u8;
87778bf93f0SYJwu2023     let secondary_bus_number = (result >> 8) as u8;
87878bf93f0SYJwu2023     let subordinate_bus_number = (result >> 16) as u8;
87978bf93f0SYJwu2023     let secondary_latency_timer = (result >> 24) as u8;
88078bf93f0SYJwu2023 
88178bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x1c);
88278bf93f0SYJwu2023     let io_base = result as u8;
88378bf93f0SYJwu2023     let io_limit = (result >> 8) as u8;
88478bf93f0SYJwu2023     let secondary_status = (result >> 16) as u16;
88578bf93f0SYJwu2023 
88678bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x20);
88778bf93f0SYJwu2023     let memory_base = result as u16;
88878bf93f0SYJwu2023     let memory_limit = (result >> 16) as u16;
88978bf93f0SYJwu2023 
89078bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x24);
89178bf93f0SYJwu2023     let prefetchable_memory_base = result as u16;
89278bf93f0SYJwu2023     let prefetchable_memory_limit = (result >> 16) as u16;
89378bf93f0SYJwu2023 
89478bf93f0SYJwu2023     let prefetchable_base_upper_32_bits = PciArch::read_config(bus_device_function, 0x28);
89578bf93f0SYJwu2023     let prefetchable_limit_upper_32_bits = PciArch::read_config(bus_device_function, 0x2c);
89678bf93f0SYJwu2023 
89778bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x30);
89878bf93f0SYJwu2023     let io_base_upper_16_bits = result as u16;
89978bf93f0SYJwu2023     let io_limit_upper_16_bits = (result >> 16) as u16;
90078bf93f0SYJwu2023 
90178bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x34);
90278bf93f0SYJwu2023     let capability_pointer = result as u8;
90378bf93f0SYJwu2023     let reserved0 = (result >> 8) as u8;
90478bf93f0SYJwu2023     let reserved1 = (result >> 16) as u16;
90578bf93f0SYJwu2023 
90678bf93f0SYJwu2023     let expansion_rom_base_address = PciArch::read_config(bus_device_function, 0x38);
90778bf93f0SYJwu2023 
90878bf93f0SYJwu2023     let result = PciArch::read_config(bus_device_function, 0x3c);
90978bf93f0SYJwu2023     let interrupt_line = result as u8;
91078bf93f0SYJwu2023     let interrupt_pin = (result >> 8) as u8;
91178bf93f0SYJwu2023     let bridge_control = (result >> 16) as u16;
91278bf93f0SYJwu2023     PciDeviceStructurePciToPciBridge {
91378bf93f0SYJwu2023         common_header,
914cc36cf4aSYJwu2023         irq_type: IrqType::Unused,
915cc36cf4aSYJwu2023         irq_vector: Vec::new(),
91678bf93f0SYJwu2023         bar0,
91778bf93f0SYJwu2023         bar1,
91878bf93f0SYJwu2023         primary_bus_number,
91978bf93f0SYJwu2023         secondary_bus_number,
92078bf93f0SYJwu2023         subordinate_bus_number,
92178bf93f0SYJwu2023         secondary_latency_timer,
92278bf93f0SYJwu2023         io_base,
92378bf93f0SYJwu2023         io_limit,
92478bf93f0SYJwu2023         secondary_status,
92578bf93f0SYJwu2023         memory_base,
92678bf93f0SYJwu2023         memory_limit,
92778bf93f0SYJwu2023         prefetchable_memory_base,
92878bf93f0SYJwu2023         prefetchable_memory_limit,
92978bf93f0SYJwu2023         prefetchable_base_upper_32_bits,
93078bf93f0SYJwu2023         prefetchable_limit_upper_32_bits,
93178bf93f0SYJwu2023         io_base_upper_16_bits,
93278bf93f0SYJwu2023         io_limit_upper_16_bits,
93378bf93f0SYJwu2023         capability_pointer,
93478bf93f0SYJwu2023         reserved0,
93578bf93f0SYJwu2023         reserved1,
93678bf93f0SYJwu2023         expansion_rom_base_address,
93778bf93f0SYJwu2023         interrupt_line,
93878bf93f0SYJwu2023         interrupt_pin,
93978bf93f0SYJwu2023         bridge_control,
94078bf93f0SYJwu2023     }
94178bf93f0SYJwu2023 }
94278bf93f0SYJwu2023 
94378bf93f0SYJwu2023 /// @brief 读取type为0x2的pci设备的header
94478bf93f0SYJwu2023 /// 本函数只应被 pci_read_header()调用
94578bf93f0SYJwu2023 /// @param common_header 共有头部
94678bf93f0SYJwu2023 /// @param bus_device_function PCI设备的唯一标识
947cc36cf4aSYJwu2023 /// @return   Pci_Device_Structure_Pci_to_Cardbus_Bridge  pci-to-cardbus 桥设备头部
94878bf93f0SYJwu2023 fn pci_read_pci_to_cardbus_bridge_header(
94978bf93f0SYJwu2023     common_header: PciDeviceStructureHeader,
95078bf93f0SYJwu2023     busdevicefunction: &BusDeviceFunction,
95178bf93f0SYJwu2023 ) -> PciDeviceStructurePciToCardbusBridge {
95278bf93f0SYJwu2023     let cardbus_socket_ex_ca_base_address = PciArch::read_config(busdevicefunction, 0x10);
95378bf93f0SYJwu2023 
95478bf93f0SYJwu2023     let result = PciArch::read_config(busdevicefunction, 0x14);
95578bf93f0SYJwu2023     let offset_of_capabilities_list = result as u8;
95678bf93f0SYJwu2023     let reserved = (result >> 8) as u8;
95778bf93f0SYJwu2023     let secondary_status = (result >> 16) as u16;
95878bf93f0SYJwu2023 
95978bf93f0SYJwu2023     let result = PciArch::read_config(busdevicefunction, 0x18);
96078bf93f0SYJwu2023     let pci_bus_number = result as u8;
96178bf93f0SYJwu2023     let card_bus_bus_number = (result >> 8) as u8;
96278bf93f0SYJwu2023     let subordinate_bus_number = (result >> 16) as u8;
96378bf93f0SYJwu2023     let card_bus_latency_timer = (result >> 24) as u8;
96478bf93f0SYJwu2023 
96578bf93f0SYJwu2023     let memory_base_address0 = PciArch::read_config(busdevicefunction, 0x1c);
96678bf93f0SYJwu2023     let memory_limit0 = PciArch::read_config(busdevicefunction, 0x20);
96778bf93f0SYJwu2023     let memory_base_address1 = PciArch::read_config(busdevicefunction, 0x24);
96878bf93f0SYJwu2023     let memory_limit1 = PciArch::read_config(busdevicefunction, 0x28);
96978bf93f0SYJwu2023 
97078bf93f0SYJwu2023     let io_base_address0 = PciArch::read_config(busdevicefunction, 0x2c);
97178bf93f0SYJwu2023     let io_limit0 = PciArch::read_config(busdevicefunction, 0x30);
97278bf93f0SYJwu2023     let io_base_address1 = PciArch::read_config(busdevicefunction, 0x34);
97378bf93f0SYJwu2023     let io_limit1 = PciArch::read_config(busdevicefunction, 0x38);
97478bf93f0SYJwu2023     let result = PciArch::read_config(busdevicefunction, 0x3c);
97578bf93f0SYJwu2023     let interrupt_line = result as u8;
97678bf93f0SYJwu2023     let interrupt_pin = (result >> 8) as u8;
97778bf93f0SYJwu2023     let bridge_control = (result >> 16) as u16;
97878bf93f0SYJwu2023 
97978bf93f0SYJwu2023     let result = PciArch::read_config(busdevicefunction, 0x40);
98078bf93f0SYJwu2023     let subsystem_device_id = result as u16;
98178bf93f0SYJwu2023     let subsystem_vendor_id = (result >> 16) as u16;
98278bf93f0SYJwu2023 
98378bf93f0SYJwu2023     let pc_card_legacy_mode_base_address_16_bit = PciArch::read_config(busdevicefunction, 0x44);
98478bf93f0SYJwu2023     PciDeviceStructurePciToCardbusBridge {
98578bf93f0SYJwu2023         common_header,
98678bf93f0SYJwu2023         cardbus_socket_ex_ca_base_address,
98778bf93f0SYJwu2023         offset_of_capabilities_list,
98878bf93f0SYJwu2023         reserved,
98978bf93f0SYJwu2023         secondary_status,
99078bf93f0SYJwu2023         pci_bus_number,
99178bf93f0SYJwu2023         card_bus_bus_number,
99278bf93f0SYJwu2023         subordinate_bus_number,
99378bf93f0SYJwu2023         card_bus_latency_timer,
99478bf93f0SYJwu2023         memory_base_address0,
99578bf93f0SYJwu2023         memory_limit0,
99678bf93f0SYJwu2023         memory_base_address1,
99778bf93f0SYJwu2023         memory_limit1,
99878bf93f0SYJwu2023         io_base_address0,
99978bf93f0SYJwu2023         io_limit0,
100078bf93f0SYJwu2023         io_base_address1,
100178bf93f0SYJwu2023         io_limit1,
100278bf93f0SYJwu2023         interrupt_line,
100378bf93f0SYJwu2023         interrupt_pin,
100478bf93f0SYJwu2023         bridge_control,
100578bf93f0SYJwu2023         subsystem_device_id,
100678bf93f0SYJwu2023         subsystem_vendor_id,
100778bf93f0SYJwu2023         pc_card_legacy_mode_base_address_16_bit,
100878bf93f0SYJwu2023     }
100978bf93f0SYJwu2023 }
101078bf93f0SYJwu2023 
101178bf93f0SYJwu2023 /// @brief 检查所有bus上的设备并将其加入链表
101278bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因
101378bf93f0SYJwu2023 fn pci_check_all_buses() -> Result<u8, PciError> {
101478bf93f0SYJwu2023     kinfo!("Checking all devices in PCI bus...");
101578bf93f0SYJwu2023     let busdevicefunction = BusDeviceFunction {
101678bf93f0SYJwu2023         bus: 0,
101778bf93f0SYJwu2023         device: 0,
101878bf93f0SYJwu2023         function: 0,
101978bf93f0SYJwu2023     };
102078bf93f0SYJwu2023     let header = pci_read_header(busdevicefunction, false)?;
102178bf93f0SYJwu2023     let common_header = header.common_header();
102278bf93f0SYJwu2023     pci_check_bus(0)?;
102378bf93f0SYJwu2023     if common_header.header_type & 0x80 != 0 {
102478bf93f0SYJwu2023         for function in 1..8 {
102578bf93f0SYJwu2023             pci_check_bus(function)?;
102678bf93f0SYJwu2023         }
102778bf93f0SYJwu2023     }
102878bf93f0SYJwu2023     Ok(0)
102978bf93f0SYJwu2023 }
103078bf93f0SYJwu2023 /// @brief 检查特定设备并将其加入链表
103178bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因
103278bf93f0SYJwu2023 fn pci_check_function(busdevicefunction: BusDeviceFunction) -> Result<u8, PciError> {
103378bf93f0SYJwu2023     //kdebug!("PCI check function {}", busdevicefunction.function);
103478bf93f0SYJwu2023     let header = match pci_read_header(busdevicefunction, true) {
103578bf93f0SYJwu2023         Ok(header) => header,
103678bf93f0SYJwu2023         Err(PciError::GetWrongHeader) => {
103778bf93f0SYJwu2023             return Ok(255);
103878bf93f0SYJwu2023         }
103978bf93f0SYJwu2023         Err(e) => {
104078bf93f0SYJwu2023             return Err(e);
104178bf93f0SYJwu2023         }
104278bf93f0SYJwu2023     };
104378bf93f0SYJwu2023     let common_header = header.common_header();
104478bf93f0SYJwu2023     if (common_header.class_code == 0x06)
104578bf93f0SYJwu2023         && (common_header.subclass == 0x04 || common_header.subclass == 0x09)
104678bf93f0SYJwu2023     {
104778bf93f0SYJwu2023         let pci_to_pci_bridge = header
104878bf93f0SYJwu2023             .as_pci_to_pci_bridge_device()
104978bf93f0SYJwu2023             .ok_or(PciError::PciDeviceStructureTransformError)?;
105078bf93f0SYJwu2023         let secondary_bus = pci_to_pci_bridge.secondary_bus_number;
105178bf93f0SYJwu2023         pci_check_bus(secondary_bus)?;
105278bf93f0SYJwu2023     }
105378bf93f0SYJwu2023     Ok(0)
105478bf93f0SYJwu2023 }
105578bf93f0SYJwu2023 
105678bf93f0SYJwu2023 /// @brief 检查device上的设备并将其加入链表
105778bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因
105878bf93f0SYJwu2023 fn pci_check_device(bus: u8, device: u8) -> Result<u8, PciError> {
105978bf93f0SYJwu2023     //kdebug!("PCI check device {}", device);
106078bf93f0SYJwu2023     let busdevicefunction = BusDeviceFunction {
106178bf93f0SYJwu2023         bus,
106278bf93f0SYJwu2023         device,
106378bf93f0SYJwu2023         function: 0,
106478bf93f0SYJwu2023     };
106578bf93f0SYJwu2023     let header = match pci_read_header(busdevicefunction, false) {
106678bf93f0SYJwu2023         Ok(header) => header,
106778bf93f0SYJwu2023         Err(PciError::GetWrongHeader) => {
106878bf93f0SYJwu2023             //设备不存在,直接返回即可,不用终止遍历
106978bf93f0SYJwu2023             return Ok(255);
107078bf93f0SYJwu2023         }
107178bf93f0SYJwu2023         Err(e) => {
107278bf93f0SYJwu2023             return Err(e);
107378bf93f0SYJwu2023         }
107478bf93f0SYJwu2023     };
107578bf93f0SYJwu2023     pci_check_function(busdevicefunction)?;
107678bf93f0SYJwu2023     let common_header = header.common_header();
107778bf93f0SYJwu2023     if common_header.header_type & 0x80 != 0 {
107878bf93f0SYJwu2023         kdebug!(
107978bf93f0SYJwu2023             "Detected multi func device in bus{},device{}",
108078bf93f0SYJwu2023             busdevicefunction.bus,
108178bf93f0SYJwu2023             busdevicefunction.device
108278bf93f0SYJwu2023         );
108378bf93f0SYJwu2023         // 这是一个多function的设备,因此查询剩余的function
108478bf93f0SYJwu2023         for function in 1..8 {
108578bf93f0SYJwu2023             let busdevicefunction = BusDeviceFunction {
108678bf93f0SYJwu2023                 bus,
108778bf93f0SYJwu2023                 device,
108878bf93f0SYJwu2023                 function,
108978bf93f0SYJwu2023             };
109078bf93f0SYJwu2023             pci_check_function(busdevicefunction)?;
109178bf93f0SYJwu2023         }
109278bf93f0SYJwu2023     }
109378bf93f0SYJwu2023     Ok(0)
109478bf93f0SYJwu2023 }
109578bf93f0SYJwu2023 /// @brief 检查该bus上的设备并将其加入链表
109678bf93f0SYJwu2023 /// @return 成功返回ok(),失败返回失败原因
109778bf93f0SYJwu2023 fn pci_check_bus(bus: u8) -> Result<u8, PciError> {
109878bf93f0SYJwu2023     //kdebug!("PCI check bus {}", bus);
109978bf93f0SYJwu2023     for device in 0..32 {
110078bf93f0SYJwu2023         pci_check_device(bus, device)?;
110178bf93f0SYJwu2023     }
110278bf93f0SYJwu2023     Ok(0)
110378bf93f0SYJwu2023 }
110478bf93f0SYJwu2023 /// @brief pci初始化函数(for c)
110578bf93f0SYJwu2023 #[no_mangle]
110678bf93f0SYJwu2023 pub extern "C" fn rs_pci_init() {
110778bf93f0SYJwu2023     pci_init();
11085c1e552cSYJwu2023     if PCI_ROOT_0.is_some() {
11095c1e552cSYJwu2023         kdebug!("{}", PCI_ROOT_0.unwrap());
11105c1e552cSYJwu2023         //以下为ecam的读取寄存器值测试,经测试可正常读取
11115c1e552cSYJwu2023         // let bus_device_function = BusDeviceFunction {
11125c1e552cSYJwu2023         //     bus: 0,
11135c1e552cSYJwu2023         //     device: 2,
11145c1e552cSYJwu2023         //     function: 0,
11155c1e552cSYJwu2023         // };
11165c1e552cSYJwu2023         // kdebug!(
11175c1e552cSYJwu2023         //     "Ecam read virtio-net device status={:#x}",
11185c1e552cSYJwu2023         //     (PCI_ROOT_0.unwrap().read_config(bus_device_function, 4)>>16) as u16
11195c1e552cSYJwu2023         // );
11205c1e552cSYJwu2023     }
112178bf93f0SYJwu2023 }
112278bf93f0SYJwu2023 /// @brief pci初始化函数
112378bf93f0SYJwu2023 pub fn pci_init() {
112478bf93f0SYJwu2023     kinfo!("Initializing PCI bus...");
112578bf93f0SYJwu2023     if let Err(e) = pci_check_all_buses() {
112678bf93f0SYJwu2023         kerror!("pci init failed when checking bus because of error: {}", e);
112778bf93f0SYJwu2023         return;
112878bf93f0SYJwu2023     }
112978bf93f0SYJwu2023     kinfo!(
113078bf93f0SYJwu2023         "Total pci device and function num = {}",
113178bf93f0SYJwu2023         PCI_DEVICE_LINKEDLIST.num()
113278bf93f0SYJwu2023     );
113378bf93f0SYJwu2023     let list = PCI_DEVICE_LINKEDLIST.read();
113478bf93f0SYJwu2023     for box_pci_device in list.iter() {
113578bf93f0SYJwu2023         let common_header = box_pci_device.common_header();
113678bf93f0SYJwu2023         match box_pci_device.header_type() {
113778bf93f0SYJwu2023             HeaderType::Standard if common_header.status & 0x10 != 0 => {
11385c1e552cSYJwu2023                 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);
113978bf93f0SYJwu2023             }
114078bf93f0SYJwu2023             HeaderType::Standard => {
114178bf93f0SYJwu2023                 kinfo!(
114278bf93f0SYJwu2023                     "Found pci standard device with class code ={} subclass={} status={:#x} ",
114378bf93f0SYJwu2023                     common_header.class_code,
114478bf93f0SYJwu2023                     common_header.subclass,
114578bf93f0SYJwu2023                     common_header.status
114678bf93f0SYJwu2023                 );
114778bf93f0SYJwu2023             }
114878bf93f0SYJwu2023             HeaderType::PciPciBridge if common_header.status & 0x10 != 0 => {
114978bf93f0SYJwu2023                 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);
115078bf93f0SYJwu2023             }
115178bf93f0SYJwu2023             HeaderType::PciPciBridge => {
115278bf93f0SYJwu2023                 kinfo!(
115378bf93f0SYJwu2023                     "Found pci-to-pci bridge device with class code ={} subclass={} status={:#x} ",
115478bf93f0SYJwu2023                     common_header.class_code,
115578bf93f0SYJwu2023                     common_header.subclass,
115678bf93f0SYJwu2023                     common_header.status
115778bf93f0SYJwu2023                 );
115878bf93f0SYJwu2023             }
115978bf93f0SYJwu2023             HeaderType::PciCardbusBridge => {
116078bf93f0SYJwu2023                 kinfo!(
116178bf93f0SYJwu2023                     "Found pcicardbus bridge device with class code ={} subclass={} status={:#x} ",
116278bf93f0SYJwu2023                     common_header.class_code,
116378bf93f0SYJwu2023                     common_header.subclass,
116478bf93f0SYJwu2023                     common_header.status
116578bf93f0SYJwu2023                 );
116678bf93f0SYJwu2023             }
116778bf93f0SYJwu2023             HeaderType::Unrecognised(_) => {}
116878bf93f0SYJwu2023         }
116978bf93f0SYJwu2023     }
117078bf93f0SYJwu2023     kinfo!("PCI bus initialized.");
117178bf93f0SYJwu2023 }
117278bf93f0SYJwu2023 
117326d84a31SYJwu2023 /// An identifier for a PCI bus, device and function.
117426d84a31SYJwu2023 /// PCI设备的唯一标识
117526d84a31SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
117678bf93f0SYJwu2023 pub struct BusDeviceFunction {
117726d84a31SYJwu2023     /// The PCI bus number, between 0 and 255.
117826d84a31SYJwu2023     pub bus: u8,
117926d84a31SYJwu2023     /// The device number on the bus, between 0 and 31.
118026d84a31SYJwu2023     pub device: u8,
118126d84a31SYJwu2023     /// The function number of the device, between 0 and 7.
118226d84a31SYJwu2023     pub function: u8,
118326d84a31SYJwu2023 }
118478bf93f0SYJwu2023 impl BusDeviceFunction {
118526d84a31SYJwu2023     /// Returns whether the device and function numbers are valid, i.e. the device is between 0 and
118678bf93f0SYJwu2023     ///@brief 检测BusDeviceFunction实例是否有效
118726d84a31SYJwu2023     ///@param self
118826d84a31SYJwu2023     ///@return bool 是否有效
118973c607aaSYJwu2023     #[allow(dead_code)]
119026d84a31SYJwu2023     pub fn valid(&self) -> bool {
119126d84a31SYJwu2023         self.device < 32 && self.function < 8
119226d84a31SYJwu2023     }
119326d84a31SYJwu2023 }
119478bf93f0SYJwu2023 ///实现BusDeviceFunction的Display trait,使其可以直接输出
119578bf93f0SYJwu2023 impl Display for BusDeviceFunction {
119626d84a31SYJwu2023     fn fmt(&self, f: &mut Formatter) -> fmt::Result {
11975c1e552cSYJwu2023         write!(
11985c1e552cSYJwu2023             f,
11995c1e552cSYJwu2023             "bus {} device {} function{}",
12005c1e552cSYJwu2023             self.bus, self.device, self.function
12015c1e552cSYJwu2023         )
120226d84a31SYJwu2023     }
120326d84a31SYJwu2023 }
120426d84a31SYJwu2023 /// The location allowed for a memory BAR.
120526d84a31SYJwu2023 /// memory BAR的三种情况
120626d84a31SYJwu2023 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
120726d84a31SYJwu2023 pub enum MemoryBarType {
120826d84a31SYJwu2023     /// The BAR has a 32-bit address and can be mapped anywhere in 32-bit address space.
120926d84a31SYJwu2023     Width32,
121026d84a31SYJwu2023     /// The BAR must be mapped below 1MiB.
121126d84a31SYJwu2023     Below1MiB,
121226d84a31SYJwu2023     /// The BAR has a 64-bit address and can be mapped anywhere in 64-bit address space.
121326d84a31SYJwu2023     Width64,
121426d84a31SYJwu2023 }
121526d84a31SYJwu2023 ///实现MemoryBarType与u8的类型转换
121626d84a31SYJwu2023 impl From<MemoryBarType> for u8 {
121726d84a31SYJwu2023     fn from(bar_type: MemoryBarType) -> Self {
121826d84a31SYJwu2023         match bar_type {
121926d84a31SYJwu2023             MemoryBarType::Width32 => 0,
122026d84a31SYJwu2023             MemoryBarType::Below1MiB => 1,
122126d84a31SYJwu2023             MemoryBarType::Width64 => 2,
122226d84a31SYJwu2023         }
122326d84a31SYJwu2023     }
122426d84a31SYJwu2023 }
122526d84a31SYJwu2023 ///实现MemoryBarType与u8的类型转换
122626d84a31SYJwu2023 impl TryFrom<u8> for MemoryBarType {
122726d84a31SYJwu2023     type Error = PciError;
122826d84a31SYJwu2023     fn try_from(value: u8) -> Result<Self, Self::Error> {
122926d84a31SYJwu2023         match value {
123026d84a31SYJwu2023             0 => Ok(Self::Width32),
123126d84a31SYJwu2023             1 => Ok(Self::Below1MiB),
123226d84a31SYJwu2023             2 => Ok(Self::Width64),
123326d84a31SYJwu2023             _ => Err(PciError::InvalidBarType),
123426d84a31SYJwu2023         }
123526d84a31SYJwu2023     }
123626d84a31SYJwu2023 }
123726d84a31SYJwu2023 
123826d84a31SYJwu2023 /// Information about a PCI Base Address Register.
123926d84a31SYJwu2023 /// BAR的三种类型 Memory/IO/Unused
124026d84a31SYJwu2023 #[derive(Clone, Debug, Eq, PartialEq)]
124126d84a31SYJwu2023 pub enum BarInfo {
124226d84a31SYJwu2023     /// The BAR is for a memory region.
124326d84a31SYJwu2023     Memory {
124426d84a31SYJwu2023         /// The size of the BAR address and where it can be located.
124526d84a31SYJwu2023         address_type: MemoryBarType,
124626d84a31SYJwu2023         /// If true, then reading from the region doesn't have side effects. The CPU may cache reads
124726d84a31SYJwu2023         /// and merge repeated stores.
124826d84a31SYJwu2023         prefetchable: bool,
124926d84a31SYJwu2023         /// The memory address, always 16-byte aligned.
125026d84a31SYJwu2023         address: u64,
125126d84a31SYJwu2023         /// The size of the BAR in bytes.
125226d84a31SYJwu2023         size: u32,
125326d84a31SYJwu2023         /// The virtaddress for a memory bar(mapped).
125426d84a31SYJwu2023         virtaddress: u64,
125526d84a31SYJwu2023     },
125626d84a31SYJwu2023     /// The BAR is for an I/O region.
125726d84a31SYJwu2023     IO {
125826d84a31SYJwu2023         /// The I/O address, always 4-byte aligned.
125926d84a31SYJwu2023         address: u32,
126026d84a31SYJwu2023         /// The size of the BAR in bytes.
126126d84a31SYJwu2023         size: u32,
126226d84a31SYJwu2023     },
126326d84a31SYJwu2023     Unused,
126426d84a31SYJwu2023 }
126526d84a31SYJwu2023 
126626d84a31SYJwu2023 impl BarInfo {
126726d84a31SYJwu2023     /// Returns the address and size of this BAR if it is a memory bar, or `None` if it is an IO
126826d84a31SYJwu2023     /// BAR.
126926d84a31SYJwu2023     ///@brief 得到某个bar的memory_address与size(前提是他的类型为Memory Bar)
127026d84a31SYJwu2023     ///@param self
127126d84a31SYJwu2023     ///@return Option<(u64, u32) 是Memory Bar返回内存地址与大小,不是则返回None
127226d84a31SYJwu2023     pub fn memory_address_size(&self) -> Option<(u64, u32)> {
127326d84a31SYJwu2023         if let Self::Memory { address, size, .. } = self {
127426d84a31SYJwu2023             Some((*address, *size))
127526d84a31SYJwu2023         } else {
127626d84a31SYJwu2023             None
127726d84a31SYJwu2023         }
127826d84a31SYJwu2023     }
127926d84a31SYJwu2023     ///@brief 得到某个bar的virtaddress(前提是他的类型为Memory Bar)
128026d84a31SYJwu2023     ///@param self
128126d84a31SYJwu2023     ///@return Option<(u64) 是Memory Bar返回映射的虚拟地址,不是则返回None
128226d84a31SYJwu2023     pub fn virtual_address(&self) -> Option<u64> {
128326d84a31SYJwu2023         if let Self::Memory { virtaddress, .. } = self {
128426d84a31SYJwu2023             Some(*virtaddress)
128526d84a31SYJwu2023         } else {
128626d84a31SYJwu2023             None
128726d84a31SYJwu2023         }
128826d84a31SYJwu2023     }
128926d84a31SYJwu2023 }
129078bf93f0SYJwu2023 ///实现BarInfo的Display trait,自定义输出
129126d84a31SYJwu2023 impl Display for BarInfo {
129226d84a31SYJwu2023     fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result {
129326d84a31SYJwu2023         match self {
129426d84a31SYJwu2023             Self::Memory {
129526d84a31SYJwu2023                 address_type,
129626d84a31SYJwu2023                 prefetchable,
129726d84a31SYJwu2023                 address,
129826d84a31SYJwu2023                 size,
129926d84a31SYJwu2023                 virtaddress,
130026d84a31SYJwu2023             } => write!(
130126d84a31SYJwu2023                 f,
130226d84a31SYJwu2023                 "Memory space at {:#010x}, size {}, type {:?}, prefetchable {},mapped at {:#x}",
130326d84a31SYJwu2023                 address, size, address_type, prefetchable, virtaddress
130426d84a31SYJwu2023             ),
130526d84a31SYJwu2023             Self::IO { address, size } => {
130626d84a31SYJwu2023                 write!(f, "I/O space at {:#010x}, size {}", address, size)
130726d84a31SYJwu2023             }
130826d84a31SYJwu2023             Self::Unused => {
130926d84a31SYJwu2023                 write!(f, "Unused bar")
131026d84a31SYJwu2023             }
131126d84a31SYJwu2023         }
131226d84a31SYJwu2023     }
131326d84a31SYJwu2023 }
1314cc36cf4aSYJwu2023 // todo 增加对桥的bar的支持
1315cc36cf4aSYJwu2023 pub trait PciDeviceBar {}
1316*40fe15e0SLoGin 
131778bf93f0SYJwu2023 ///一个普通PCI设备(非桥)有6个BAR寄存器,PciStandardDeviceBar存储其全部信息
131826d84a31SYJwu2023 #[derive(Clone, Debug, Eq, PartialEq)]
131978bf93f0SYJwu2023 pub struct PciStandardDeviceBar {
132026d84a31SYJwu2023     bar0: BarInfo,
132126d84a31SYJwu2023     bar1: BarInfo,
132226d84a31SYJwu2023     bar2: BarInfo,
132326d84a31SYJwu2023     bar3: BarInfo,
132426d84a31SYJwu2023     bar4: BarInfo,
132526d84a31SYJwu2023     bar5: BarInfo,
132626d84a31SYJwu2023 }
132726d84a31SYJwu2023 
132878bf93f0SYJwu2023 impl PciStandardDeviceBar {
132926d84a31SYJwu2023     ///@brief 得到某个bar的barinfo
133026d84a31SYJwu2023     ///@param self ,bar_index(0-5)
133126d84a31SYJwu2023     ///@return Result<&BarInfo, PciError> bar_index在0-5则返回对应的bar_info结构体,超出范围则返回错误
133226d84a31SYJwu2023     pub fn get_bar(&self, bar_index: u8) -> Result<&BarInfo, PciError> {
133326d84a31SYJwu2023         match bar_index {
133426d84a31SYJwu2023             0 => Ok(&self.bar0),
133526d84a31SYJwu2023             1 => Ok(&self.bar1),
133626d84a31SYJwu2023             2 => Ok(&self.bar2),
133726d84a31SYJwu2023             3 => Ok(&self.bar3),
133826d84a31SYJwu2023             4 => Ok(&self.bar4),
133978bf93f0SYJwu2023             5 => Ok(&self.bar5),
134026d84a31SYJwu2023             _ => Err(PciError::InvalidBarType),
134126d84a31SYJwu2023         }
134226d84a31SYJwu2023     }
134326d84a31SYJwu2023 }
134478bf93f0SYJwu2023 ///实现PciStandardDeviceBar的Display trait,使其可以直接输出
134578bf93f0SYJwu2023 impl Display for PciStandardDeviceBar {
134626d84a31SYJwu2023     fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result {
134726d84a31SYJwu2023         write!(
134826d84a31SYJwu2023             f,
134926d84a31SYJwu2023             "\r\nBar0:{}\r\n Bar1:{}\r\n Bar2:{}\r\n Bar3:{}\r\nBar4:{}\r\nBar5:{}",
135026d84a31SYJwu2023             self.bar0, self.bar1, self.bar2, self.bar3, self.bar4, self.bar5
135126d84a31SYJwu2023         )
135226d84a31SYJwu2023     }
135326d84a31SYJwu2023 }
135478bf93f0SYJwu2023 ///实现PciStandardDeviceBar的Default trait,使其可以简单初始化
135578bf93f0SYJwu2023 impl Default for PciStandardDeviceBar {
135626d84a31SYJwu2023     fn default() -> Self {
135778bf93f0SYJwu2023         PciStandardDeviceBar {
135826d84a31SYJwu2023             bar0: BarInfo::Unused,
135926d84a31SYJwu2023             bar1: BarInfo::Unused,
136026d84a31SYJwu2023             bar2: BarInfo::Unused,
136126d84a31SYJwu2023             bar3: BarInfo::Unused,
136226d84a31SYJwu2023             bar4: BarInfo::Unused,
136326d84a31SYJwu2023             bar5: BarInfo::Unused,
136426d84a31SYJwu2023         }
136526d84a31SYJwu2023     }
136626d84a31SYJwu2023 }
136726d84a31SYJwu2023 
136878bf93f0SYJwu2023 ///@brief 将某个pci设备的bar寄存器读取值后映射到虚拟地址
136978bf93f0SYJwu2023 ///@param self ,bus_device_function PCI设备的唯一标识符
137078bf93f0SYJwu2023 ///@return Result<PciStandardDeviceBar, PciError> 成功则返回对应的PciStandardDeviceBar结构体,失败则返回错误类型
137178bf93f0SYJwu2023 pub fn pci_bar_init(
137278bf93f0SYJwu2023     bus_device_function: BusDeviceFunction,
137378bf93f0SYJwu2023 ) -> Result<PciStandardDeviceBar, PciError> {
137478bf93f0SYJwu2023     let mut device_bar: PciStandardDeviceBar = PciStandardDeviceBar::default();
137526d84a31SYJwu2023     let mut bar_index_ignore: u8 = 255;
137626d84a31SYJwu2023     for bar_index in 0..6 {
137726d84a31SYJwu2023         if bar_index == bar_index_ignore {
137826d84a31SYJwu2023             continue;
137926d84a31SYJwu2023         }
138026d84a31SYJwu2023         let bar_info;
138126d84a31SYJwu2023         let mut virtaddress: u64 = 0;
138278bf93f0SYJwu2023         let bar_orig = PciArch::read_config(&bus_device_function, BAR0_OFFSET + 4 * bar_index);
138378bf93f0SYJwu2023         PciArch::write_config(
138478bf93f0SYJwu2023             &bus_device_function,
138526d84a31SYJwu2023             BAR0_OFFSET + 4 * bar_index,
138626d84a31SYJwu2023             0xffffffff,
138726d84a31SYJwu2023         );
138878bf93f0SYJwu2023         let size_mask = PciArch::read_config(&bus_device_function, BAR0_OFFSET + 4 * bar_index);
138926d84a31SYJwu2023         // A wrapping add is necessary to correctly handle the case of unused BARs, which read back
139026d84a31SYJwu2023         // as 0, and should be treated as size 0.
139126d84a31SYJwu2023         let size = (!(size_mask & 0xfffffff0)).wrapping_add(1);
139226d84a31SYJwu2023         //kdebug!("bar_orig:{:#x},size: {:#x}", bar_orig,size);
139326d84a31SYJwu2023         // Restore the original value.
139478bf93f0SYJwu2023         PciArch::write_config(&bus_device_function, BAR0_OFFSET + 4 * bar_index, bar_orig);
139526d84a31SYJwu2023         if size == 0 {
139626d84a31SYJwu2023             continue;
139726d84a31SYJwu2023         }
139826d84a31SYJwu2023         if bar_orig & 0x00000001 == 0x00000001 {
139926d84a31SYJwu2023             // I/O space
140026d84a31SYJwu2023             let address = bar_orig & 0xfffffffc;
140126d84a31SYJwu2023             bar_info = BarInfo::IO { address, size };
140226d84a31SYJwu2023         } else {
140326d84a31SYJwu2023             // Memory space
140426d84a31SYJwu2023             let mut address = u64::from(bar_orig & 0xfffffff0);
140526d84a31SYJwu2023             let prefetchable = bar_orig & 0x00000008 != 0;
140626d84a31SYJwu2023             let address_type = MemoryBarType::try_from(((bar_orig & 0x00000006) >> 1) as u8)?;
140726d84a31SYJwu2023             if address_type == MemoryBarType::Width64 {
140826d84a31SYJwu2023                 if bar_index >= 5 {
140926d84a31SYJwu2023                     return Err(PciError::InvalidBarType);
141026d84a31SYJwu2023                 }
141178bf93f0SYJwu2023                 let address_top =
141278bf93f0SYJwu2023                     PciArch::read_config(&bus_device_function, BAR0_OFFSET + 4 * (bar_index + 1));
141326d84a31SYJwu2023                 address |= u64::from(address_top) << 32;
141426d84a31SYJwu2023                 bar_index_ignore = bar_index + 1; //下个bar跳过,因为64位的memory bar覆盖了两个bar
141526d84a31SYJwu2023             }
14165c1e552cSYJwu2023             let pci_address = PciAddr::new(address as usize);
14175c1e552cSYJwu2023             address = PciArch::address_pci_to_physical(pci_address) as u64; //PCI总线域物理地址转换为存储器域物理地址
141826d84a31SYJwu2023             unsafe {
141926d84a31SYJwu2023                 let vaddr_ptr = &mut virtaddress as *mut u64;
142026d84a31SYJwu2023                 let mut virtsize: u64 = 0;
142126d84a31SYJwu2023                 let virtsize_ptr = &mut virtsize as *mut u64;
1422*40fe15e0SLoGin 
1423*40fe15e0SLoGin                 let size_want = size as usize;
1424*40fe15e0SLoGin 
1425*40fe15e0SLoGin                 if let Err(_) = mmio_pool().create_mmio(
1426*40fe15e0SLoGin                     size_want,
142726d84a31SYJwu2023                     (VM_IO | VM_DONTCOPY) as u64,
142826d84a31SYJwu2023                     vaddr_ptr,
142926d84a31SYJwu2023                     virtsize_ptr,
143026d84a31SYJwu2023                 ) {
143126d84a31SYJwu2023                     kerror!("Create mmio failed when initing pci bar");
143226d84a31SYJwu2023                     return Err(PciError::CreateMmioError);
143326d84a31SYJwu2023                 };
143426d84a31SYJwu2023                 //kdebug!("virtaddress={:#x},virtsize={:#x}",virtaddress,virtsize);
1435*40fe15e0SLoGin                 let vaddr = VirtAddr::new(virtaddress as usize);
1436*40fe15e0SLoGin                 let paddr = PhysAddr::new(address as usize);
1437*40fe15e0SLoGin                 let page_flags = PageFlags::new()
1438*40fe15e0SLoGin                     .set_write(true)
1439*40fe15e0SLoGin                     .set_execute(true)
1440*40fe15e0SLoGin                     .set_page_cache_disable(true)
1441*40fe15e0SLoGin                     .set_page_write_through(true);
1442*40fe15e0SLoGin                 kdebug!("Pci bar init: vaddr={vaddr:?}, paddr={paddr:?}, size_want={size_want}, page_flags={page_flags:?}");
1443*40fe15e0SLoGin                 let mut kernel_mapper = KernelMapper::lock();
1444*40fe15e0SLoGin                 // todo: 添加错误处理代码。因为内核映射器可能是只读的,所以可能会出错
1445*40fe15e0SLoGin                 assert!(kernel_mapper
1446*40fe15e0SLoGin                     .map_phys_with_size(vaddr, paddr, size_want, page_flags, true)
1447*40fe15e0SLoGin                     .is_ok());
1448*40fe15e0SLoGin                 drop(kernel_mapper);
144926d84a31SYJwu2023             }
145026d84a31SYJwu2023             bar_info = BarInfo::Memory {
145126d84a31SYJwu2023                 address_type,
145226d84a31SYJwu2023                 prefetchable,
145326d84a31SYJwu2023                 address,
145426d84a31SYJwu2023                 size,
145526d84a31SYJwu2023                 virtaddress,
145626d84a31SYJwu2023             };
145726d84a31SYJwu2023         }
145826d84a31SYJwu2023         match bar_index {
145926d84a31SYJwu2023             0 => {
146026d84a31SYJwu2023                 device_bar.bar0 = bar_info;
146126d84a31SYJwu2023             }
146226d84a31SYJwu2023             1 => {
146326d84a31SYJwu2023                 device_bar.bar1 = bar_info;
146426d84a31SYJwu2023             }
146526d84a31SYJwu2023             2 => {
146626d84a31SYJwu2023                 device_bar.bar2 = bar_info;
146726d84a31SYJwu2023             }
146826d84a31SYJwu2023             3 => {
146926d84a31SYJwu2023                 device_bar.bar3 = bar_info;
147026d84a31SYJwu2023             }
147126d84a31SYJwu2023             4 => {
147226d84a31SYJwu2023                 device_bar.bar4 = bar_info;
147326d84a31SYJwu2023             }
147426d84a31SYJwu2023             5 => {
147526d84a31SYJwu2023                 device_bar.bar5 = bar_info;
147626d84a31SYJwu2023             }
147726d84a31SYJwu2023             _ => {}
147826d84a31SYJwu2023         }
147926d84a31SYJwu2023     }
148026d84a31SYJwu2023     kdebug!("pci_device_bar:{}", device_bar);
148126d84a31SYJwu2023     return Ok(device_bar);
148226d84a31SYJwu2023 }
148326d84a31SYJwu2023 
148426d84a31SYJwu2023 /// Information about a PCI device capability.
148526d84a31SYJwu2023 /// PCI设备的capability的信息
148626d84a31SYJwu2023 #[derive(Debug, Copy, Clone, Eq, PartialEq)]
148726d84a31SYJwu2023 pub struct CapabilityInfo {
148826d84a31SYJwu2023     /// The offset of the capability in the PCI configuration space of the device function.
148926d84a31SYJwu2023     pub offset: u8,
149026d84a31SYJwu2023     /// The ID of the capability.
149126d84a31SYJwu2023     pub id: u8,
149226d84a31SYJwu2023     /// The third and fourth bytes of the capability, to save reading them again.
149326d84a31SYJwu2023     pub private_header: u16,
149426d84a31SYJwu2023 }
149573c607aaSYJwu2023 
149626d84a31SYJwu2023 /// Iterator over capabilities for a device.
149726d84a31SYJwu2023 /// 创建迭代器以遍历PCI设备的capability
149826d84a31SYJwu2023 #[derive(Debug)]
149926d84a31SYJwu2023 pub struct CapabilityIterator {
150078bf93f0SYJwu2023     pub bus_device_function: BusDeviceFunction,
150126d84a31SYJwu2023     pub next_capability_offset: Option<u8>,
150226d84a31SYJwu2023 }
150326d84a31SYJwu2023 
150426d84a31SYJwu2023 impl Iterator for CapabilityIterator {
150526d84a31SYJwu2023     type Item = CapabilityInfo;
150626d84a31SYJwu2023     fn next(&mut self) -> Option<Self::Item> {
150726d84a31SYJwu2023         let offset = self.next_capability_offset?;
150826d84a31SYJwu2023 
150926d84a31SYJwu2023         // Read the first 4 bytes of the capability.
151078bf93f0SYJwu2023         let capability_header = PciArch::read_config(&self.bus_device_function, offset);
151126d84a31SYJwu2023         let id = capability_header as u8;
151226d84a31SYJwu2023         let next_offset = (capability_header >> 8) as u8;
151326d84a31SYJwu2023         let private_header = (capability_header >> 16) as u16;
151426d84a31SYJwu2023 
151526d84a31SYJwu2023         self.next_capability_offset = if next_offset == 0 {
151626d84a31SYJwu2023             None
151726d84a31SYJwu2023         } else if next_offset < 64 || next_offset & 0x3 != 0 {
151826d84a31SYJwu2023             kwarn!("Invalid next capability offset {:#04x}", next_offset);
151926d84a31SYJwu2023             None
152026d84a31SYJwu2023         } else {
152126d84a31SYJwu2023             Some(next_offset)
152226d84a31SYJwu2023         };
152326d84a31SYJwu2023 
152426d84a31SYJwu2023         Some(CapabilityInfo {
152526d84a31SYJwu2023             offset,
152626d84a31SYJwu2023             id,
152726d84a31SYJwu2023             private_header,
152826d84a31SYJwu2023         })
152926d84a31SYJwu2023     }
153026d84a31SYJwu2023 }
153173c607aaSYJwu2023 
153278bf93f0SYJwu2023 /// Information about a PCIe device capability.
153378bf93f0SYJwu2023 /// PCIe设备的external capability的信息
153478bf93f0SYJwu2023 #[derive(Debug, Copy, Clone, Eq, PartialEq)]
153578bf93f0SYJwu2023 pub struct ExternalCapabilityInfo {
153678bf93f0SYJwu2023     /// The offset of the capability in the PCI configuration space of the device function.
153778bf93f0SYJwu2023     pub offset: u16,
153878bf93f0SYJwu2023     /// The ID of the capability.
153978bf93f0SYJwu2023     pub id: u16,
154078bf93f0SYJwu2023     /// The third and fourth bytes of the capability, to save reading them again.
154178bf93f0SYJwu2023     pub capability_version: u8,
154273c607aaSYJwu2023 }
154378bf93f0SYJwu2023 
154478bf93f0SYJwu2023 /// Iterator over capabilities for a device.
154578bf93f0SYJwu2023 /// 创建迭代器以遍历PCIe设备的external capability
154678bf93f0SYJwu2023 #[derive(Debug)]
154778bf93f0SYJwu2023 pub struct ExternalCapabilityIterator<'a> {
154878bf93f0SYJwu2023     pub root: &'a PciRoot,
154978bf93f0SYJwu2023     pub bus_device_function: BusDeviceFunction,
155078bf93f0SYJwu2023     pub next_capability_offset: Option<u16>,
155173c607aaSYJwu2023 }
155278bf93f0SYJwu2023 impl<'a> Iterator for ExternalCapabilityIterator<'a> {
155378bf93f0SYJwu2023     type Item = ExternalCapabilityInfo;
155478bf93f0SYJwu2023     fn next(&mut self) -> Option<Self::Item> {
155578bf93f0SYJwu2023         let offset = self.next_capability_offset?;
155678bf93f0SYJwu2023 
155778bf93f0SYJwu2023         // Read the first 4 bytes of the capability.
155878bf93f0SYJwu2023         let capability_header = self.root.read_config(self.bus_device_function, offset);
155978bf93f0SYJwu2023         let id = capability_header as u16;
156078bf93f0SYJwu2023         let next_offset = (capability_header >> 20) as u16;
156178bf93f0SYJwu2023         let capability_version = ((capability_header >> 16) & 0xf) as u8;
156278bf93f0SYJwu2023 
156378bf93f0SYJwu2023         self.next_capability_offset = if next_offset == 0 {
156478bf93f0SYJwu2023             None
156578bf93f0SYJwu2023         } else if next_offset < 0x100 || next_offset & 0x3 != 0 {
156678bf93f0SYJwu2023             kwarn!("Invalid next capability offset {:#04x}", next_offset);
156778bf93f0SYJwu2023             None
156878bf93f0SYJwu2023         } else {
156978bf93f0SYJwu2023             Some(next_offset)
157078bf93f0SYJwu2023         };
157178bf93f0SYJwu2023 
157278bf93f0SYJwu2023         Some(ExternalCapabilityInfo {
157378bf93f0SYJwu2023             offset,
157478bf93f0SYJwu2023             id,
157578bf93f0SYJwu2023             capability_version,
157678bf93f0SYJwu2023         })
157778bf93f0SYJwu2023     }
157873c607aaSYJwu2023 }
1579