1 #![allow(dead_code)]
2 // 目前仅支持单主桥单Segment
3 
4 use super::pci_irq::{IrqType, PciIrqError};
5 use crate::arch::{PciArch, TraitPciArch};
6 use crate::exception::IrqNumber;
7 use crate::include::bindings::bindings::PAGE_2M_SIZE;
8 use crate::libs::rwlock::{RwLock, RwLockReadGuard, RwLockWriteGuard};
9 
10 use crate::mm::mmio_buddy::{mmio_pool, MMIOSpaceGuard};
11 
12 use crate::mm::{PhysAddr, VirtAddr};
13 use crate::{kdebug, kerror, kinfo, kwarn};
14 use alloc::sync::Arc;
15 use alloc::vec::Vec;
16 use alloc::{boxed::Box, collections::LinkedList};
17 use bitflags::bitflags;
18 
19 use core::{
20     convert::TryFrom,
21     fmt::{self, Debug, Display, Formatter},
22 };
23 // PCI_DEVICE_LINKEDLIST 添加了读写锁的全局链表,里面存储了检索到的PCI设备结构体
24 // PCI_ROOT_0 Segment为0的全局PciRoot
25 lazy_static! {
26     pub static ref PCI_DEVICE_LINKEDLIST: PciDeviceLinkedList = PciDeviceLinkedList::new();
27     pub static ref PCI_ROOT_0: Option<PciRoot> = {
28         match PciRoot::new(0) {
29             Ok(root) => Some(root),
30             Err(err) => {
31                 kerror!("Pci_root init failed because of error: {}", err);
32                 None
33             }
34         }
35     };
36 }
37 /// PCI域地址
38 #[derive(Clone, Copy, Eq, Ord, PartialEq, PartialOrd)]
39 #[repr(transparent)]
40 pub struct PciAddr(usize);
41 
42 impl PciAddr {
43     #[inline(always)]
new(address: usize) -> Self44     pub const fn new(address: usize) -> Self {
45         Self(address)
46     }
47 
48     /// @brief 获取PCI域地址的值
49     #[inline(always)]
data(&self) -> usize50     pub fn data(&self) -> usize {
51         self.0
52     }
53 
54     /// @brief 将PCI域地址加上一个偏移量
55     #[inline(always)]
add(self, offset: usize) -> Self56     pub fn add(self, offset: usize) -> Self {
57         Self(self.0 + offset)
58     }
59 
60     /// @brief 判断PCI域地址是否按照指定要求对齐
61     #[inline(always)]
check_aligned(&self, align: usize) -> bool62     pub fn check_aligned(&self, align: usize) -> bool {
63         return self.0 & (align - 1) == 0;
64     }
65 }
66 impl Debug for PciAddr {
fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result67     fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
68         write!(f, "PciAddr({:#x})", self.0)
69     }
70 }
71 
72 /// 添加了读写锁的链表,存储PCI设备结构体
73 pub struct PciDeviceLinkedList {
74     list: RwLock<LinkedList<Box<dyn PciDeviceStructure>>>,
75 }
76 
77 impl PciDeviceLinkedList {
78     /// @brief 初始化结构体
new() -> Self79     fn new() -> Self {
80         PciDeviceLinkedList {
81             list: RwLock::new(LinkedList::new()),
82         }
83     }
84     /// @brief 获取可读的linkedlist(读锁守卫)
85     /// @return RwLockReadGuard<LinkedList<Box<dyn PciDeviceStructure>>>  读锁守卫
read(&self) -> RwLockReadGuard<LinkedList<Box<dyn PciDeviceStructure>>>86     pub fn read(&self) -> RwLockReadGuard<LinkedList<Box<dyn PciDeviceStructure>>> {
87         self.list.read()
88     }
89     /// @brief 获取可写的linkedlist(写锁守卫)
90     /// @return RwLockWriteGuard<LinkedList<Box<dyn PciDeviceStructure>>>  写锁守卫
write(&self) -> RwLockWriteGuard<LinkedList<Box<dyn PciDeviceStructure>>>91     pub fn write(&self) -> RwLockWriteGuard<LinkedList<Box<dyn PciDeviceStructure>>> {
92         self.list.write()
93     }
94     /// @brief 获取链表中PCI结构体数目
95     /// @return usize 链表中PCI结构体数目
num(&self) -> usize96     pub fn num(&self) -> usize {
97         let list = self.list.read();
98         list.len()
99     }
100     /// @brief 添加Pci设备结构体到链表中
add(&self, device: Box<dyn PciDeviceStructure>)101     pub fn add(&self, device: Box<dyn PciDeviceStructure>) {
102         let mut list = self.list.write();
103         list.push_back(device);
104     }
105 }
106 
107 /// @brief 在链表中寻找满足条件的PCI设备结构体并返回其可变引用
108 /// @param list 链表的写锁守卫
109 /// @param class_code 寄存器值
110 /// @param subclass 寄存器值,与class_code一起确定设备类型
111 /// @return Vec<&'a mut Box<(dyn PciDeviceStructure)  包含链表中所有满足条件的PCI结构体的可变引用的容器
get_pci_device_structure_mut<'a>( list: &'a mut RwLockWriteGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>, class_code: u8, subclass: u8, ) -> Vec<&'a mut Box<(dyn PciDeviceStructure)>>112 pub fn get_pci_device_structure_mut<'a>(
113     list: &'a mut RwLockWriteGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>,
114     class_code: u8,
115     subclass: u8,
116 ) -> Vec<&'a mut Box<(dyn PciDeviceStructure)>> {
117     let mut result = Vec::new();
118     for box_pci_device_structure in list.iter_mut() {
119         let common_header = (*box_pci_device_structure).common_header();
120         if (common_header.class_code == class_code) && (common_header.subclass == subclass) {
121             result.push(box_pci_device_structure);
122         }
123     }
124     result
125 }
126 /// @brief 在链表中寻找满足条件的PCI设备结构体并返回其不可变引用
127 /// @param list 链表的读锁守卫
128 /// @param class_code 寄存器值
129 /// @param subclass 寄存器值,与class_code一起确定设备类型
130 /// @return Vec<&'a Box<(dyn PciDeviceStructure)  包含链表中所有满足条件的PCI结构体的不可变引用的容器
get_pci_device_structure<'a>( list: &'a mut RwLockReadGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>, class_code: u8, subclass: u8, ) -> Vec<&'a Box<(dyn PciDeviceStructure)>>131 pub fn get_pci_device_structure<'a>(
132     list: &'a mut RwLockReadGuard<'_, LinkedList<Box<dyn PciDeviceStructure>>>,
133     class_code: u8,
134     subclass: u8,
135 ) -> Vec<&'a Box<(dyn PciDeviceStructure)>> {
136     let mut result = Vec::new();
137     for box_pci_device_structure in list.iter() {
138         let common_header = (*box_pci_device_structure).common_header();
139         if (common_header.class_code == class_code) && (common_header.subclass == subclass) {
140             result.push(box_pci_device_structure);
141         }
142     }
143     result
144 }
145 
146 //Bar0寄存器的offset
147 const BAR0_OFFSET: u8 = 0x10;
148 //Status、Command寄存器的offset
149 const STATUS_COMMAND_OFFSET: u8 = 0x04;
150 /// ID for vendor-specific PCI capabilities.(Virtio Capabilities)
151 pub const PCI_CAP_ID_VNDR: u8 = 0x09;
152 pub const PCI_CAP_ID_MSI: u8 = 0x05;
153 pub const PCI_CAP_ID_MSIX: u8 = 0x11;
154 pub const PORT_PCI_CONFIG_ADDRESS: u16 = 0xcf8;
155 pub const PORT_PCI_CONFIG_DATA: u16 = 0xcfc;
156 // pci设备分组的id
157 pub type SegmentGroupNumber = u16; //理论上最多支持65535个Segment_Group
158 
159 bitflags! {
160     /// The status register in PCI configuration space.
161     pub struct Status: u16 {
162         // Bits 0-2 are reserved.
163         /// The state of the device's INTx# signal.
164         const INTERRUPT_STATUS = 1 << 3;
165         /// The device has a linked list of capabilities.
166         const CAPABILITIES_LIST = 1 << 4;
167         /// The device is capabile of running at 66 MHz rather than 33 MHz.
168         const MHZ_66_CAPABLE = 1 << 5;
169         // Bit 6 is reserved.
170         /// The device can accept fast back-to-back transactions not from the same agent.
171         const FAST_BACK_TO_BACK_CAPABLE = 1 << 7;
172         /// The bus agent observed a parity error (if parity error handling is enabled).
173         const MASTER_DATA_PARITY_ERROR = 1 << 8;
174         // Bits 9-10 are DEVSEL timing.
175         /// A target device terminated a transaction with target-abort.
176         const SIGNALED_TARGET_ABORT = 1 << 11;
177         /// A master device transaction was terminated with target-abort.
178         const RECEIVED_TARGET_ABORT = 1 << 12;
179         /// A master device transaction was terminated with master-abort.
180         const RECEIVED_MASTER_ABORT = 1 << 13;
181         /// A device asserts SERR#.
182         const SIGNALED_SYSTEM_ERROR = 1 << 14;
183         /// The device detects a parity error, even if parity error handling is disabled.
184         const DETECTED_PARITY_ERROR = 1 << 15;
185     }
186 }
187 
188 bitflags! {
189     /// The command register in PCI configuration space.
190     pub struct Command: u16 {
191         /// The device can respond to I/O Space accesses.
192         const IO_SPACE = 1 << 0;
193         /// The device can respond to Memory Space accesses.
194         const MEMORY_SPACE = 1 << 1;
195         /// The device can behave as a bus master.
196         const BUS_MASTER = 1 << 2;
197         /// The device can monitor Special Cycle operations.
198         const SPECIAL_CYCLES = 1 << 3;
199         /// The device can generate the Memory Write and Invalidate command.
200         const MEMORY_WRITE_AND_INVALIDATE_ENABLE = 1 << 4;
201         /// The device will snoop palette register data.
202         const VGA_PALETTE_SNOOP = 1 << 5;
203         /// The device should take its normal action when a parity error is detected.
204         const PARITY_ERROR_RESPONSE = 1 << 6;
205         // Bit 7 is reserved.
206         /// The SERR# driver is enabled.
207         const SERR_ENABLE = 1 << 8;
208         /// The device is allowed to generate fast back-to-back transactions.
209         const FAST_BACK_TO_BACK_ENABLE = 1 << 9;
210         /// Assertion of the device's INTx# signal is disabled.
211         const INTERRUPT_DISABLE = 1 << 10;
212     }
213 }
214 
215 /// The type of a PCI device function header.
216 /// 标头类型/设备类型
217 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
218 pub enum HeaderType {
219     /// A normal PCI device.
220     Standard,
221     /// A PCI to PCI bridge.
222     PciPciBridge,
223     /// A PCI to CardBus bridge.
224     PciCardbusBridge,
225     /// Unrecognised header type.
226     Unrecognised(u8),
227 }
228 /// u8到HeaderType的转换
229 impl From<u8> for HeaderType {
from(value: u8) -> Self230     fn from(value: u8) -> Self {
231         match value {
232             0x00 => Self::Standard,
233             0x01 => Self::PciPciBridge,
234             0x02 => Self::PciCardbusBridge,
235             _ => Self::Unrecognised(value),
236         }
237     }
238 }
239 /// Pci可能触发的各种错误
240 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
241 pub enum PciError {
242     /// The device reported an invalid BAR type.
243     InvalidBarType,
244     CreateMmioError,
245     InvalidBusDeviceFunction,
246     SegmentNotFound,
247     McfgTableNotFound,
248     GetWrongHeader,
249     UnrecognisedHeaderType,
250     PciDeviceStructureTransformError,
251     PciIrqError(PciIrqError),
252 }
253 ///实现PciError的Display trait,使其可以直接输出
254 impl Display for PciError {
fmt(&self, f: &mut Formatter) -> fmt::Result255     fn fmt(&self, f: &mut Formatter) -> fmt::Result {
256         match self {
257             Self::InvalidBarType => write!(f, "Invalid PCI BAR type."),
258             Self::CreateMmioError => write!(f, "Error occurred while creating mmio."),
259             Self::InvalidBusDeviceFunction => write!(f, "Found invalid BusDeviceFunction."),
260             Self::SegmentNotFound => write!(f, "Target segment not found"),
261             Self::McfgTableNotFound => write!(f, "ACPI MCFG Table not found"),
262             Self::GetWrongHeader => write!(f, "GetWrongHeader with vendor id 0xffff"),
263             Self::UnrecognisedHeaderType => write!(f, "Found device with unrecognised header type"),
264             Self::PciDeviceStructureTransformError => {
265                 write!(f, "Found None When transform Pci device structure")
266             }
267             Self::PciIrqError(err) => write!(f, "Error occurred while setting irq :{:?}.", err),
268         }
269     }
270 }
271 
272 /// trait类型Pci_Device_Structure表示pci设备,动态绑定三种具体设备类型:Pci_Device_Structure_General_Device、Pci_Device_Structure_Pci_to_Pci_Bridge、Pci_Device_Structure_Pci_to_Cardbus_Bridge
273 pub trait PciDeviceStructure: Send + Sync {
274     /// @brief 获取设备类型
275     /// @return HeaderType 设备类型
header_type(&self) -> HeaderType276     fn header_type(&self) -> HeaderType;
277     /// @brief 当其为standard设备时返回&Pci_Device_Structure_General_Device,其余情况返回None
278     #[inline(always)]
as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice>279     fn as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice> {
280         None
281     }
282     /// @brief 当其为pci to pci bridge设备时返回&Pci_Device_Structure_Pci_to_Pci_Bridge,其余情况返回None
283     #[inline(always)]
as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge>284     fn as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge> {
285         None
286     }
287     /// @brief 当其为pci to cardbus bridge设备时返回&Pci_Device_Structure_Pci_to_Cardbus_Bridge,其余情况返回None
288     #[inline(always)]
as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge>289     fn as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge> {
290         None
291     }
292     /// @brief 获取Pci设备共有的common_header
293     /// @return 返回其不可变引用
common_header(&self) -> &PciDeviceStructureHeader294     fn common_header(&self) -> &PciDeviceStructureHeader;
295     /// @brief 当其为standard设备时返回&mut Pci_Device_Structure_General_Device,其余情况返回None
296     #[inline(always)]
as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice>297     fn as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice> {
298         None
299     }
300     /// @brief 当其为pci to pci bridge设备时返回&mut Pci_Device_Structure_Pci_to_Pci_Bridge,其余情况返回None
301     #[inline(always)]
as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge>302     fn as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge> {
303         None
304     }
305     /// @brief 当其为pci to cardbus bridge设备时返回&mut Pci_Device_Structure_Pci_to_Cardbus_Bridge,其余情况返回None
306     #[inline(always)]
as_pci_to_carbus_bridge_device_mut( &mut self, ) -> Option<&mut PciDeviceStructurePciToCardbusBridge>307     fn as_pci_to_carbus_bridge_device_mut(
308         &mut self,
309     ) -> Option<&mut PciDeviceStructurePciToCardbusBridge> {
310         None
311     }
312     /// @brief 返回迭代器,遍历capabilities
capabilities(&self) -> Option<CapabilityIterator>313     fn capabilities(&self) -> Option<CapabilityIterator> {
314         None
315     }
316     /// @brief 获取Status、Command寄存器的值
status_command(&self) -> (Status, Command)317     fn status_command(&self) -> (Status, Command) {
318         let common_header = self.common_header();
319         let status = Status::from_bits_truncate(common_header.status);
320         let command = Command::from_bits_truncate(common_header.command);
321         (status, command)
322     }
323     /// @brief 设置Command寄存器的值
set_command(&mut self, command: Command)324     fn set_command(&mut self, command: Command) {
325         let common_header = self.common_header_mut();
326         let command = command.bits();
327         common_header.command = command;
328         PciArch::write_config(
329             &common_header.bus_device_function,
330             STATUS_COMMAND_OFFSET,
331             command as u32,
332         );
333     }
334     /// @brief 获取Pci设备共有的common_header
335     /// @return 返回其可变引用
common_header_mut(&mut self) -> &mut PciDeviceStructureHeader336     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader;
337 
338     /// @brief 读取standard设备的bar寄存器,映射后将结果加入结构体的standard_device_bar变量
339     /// @return 只有standard设备才返回成功或者错误,其余返回None
340     #[inline(always)]
bar_ioremap(&mut self) -> Option<Result<u8, PciError>>341     fn bar_ioremap(&mut self) -> Option<Result<u8, PciError>> {
342         None
343     }
344     /// @brief 获取PCI设备的bar寄存器的引用
345     /// @return
346     #[inline(always)]
bar(&mut self) -> Option<&PciStandardDeviceBar>347     fn bar(&mut self) -> Option<&PciStandardDeviceBar> {
348         None
349     }
350     /// @brief 通过设置该pci设备的command
enable_master(&mut self)351     fn enable_master(&mut self) {
352         self.set_command(Command::IO_SPACE | Command::MEMORY_SPACE | Command::BUS_MASTER);
353     }
354     /// @brief 寻找设备的msix空间的offset
msix_capability_offset(&self) -> Option<u8>355     fn msix_capability_offset(&self) -> Option<u8> {
356         for capability in self.capabilities()? {
357             if capability.id == PCI_CAP_ID_MSIX {
358                 return Some(capability.offset);
359             }
360         }
361         None
362     }
363     /// @brief 寻找设备的msi空间的offset
msi_capability_offset(&self) -> Option<u8>364     fn msi_capability_offset(&self) -> Option<u8> {
365         for capability in self.capabilities()? {
366             if capability.id == PCI_CAP_ID_MSI {
367                 return Some(capability.offset);
368             }
369         }
370         None
371     }
372     /// @brief 返回结构体中的irq_type的可变引用
irq_type_mut(&mut self) -> Option<&mut IrqType>373     fn irq_type_mut(&mut self) -> Option<&mut IrqType>;
374     /// @brief 返回结构体中的irq_vector的可变引用
irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>>375     fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>>;
376 }
377 
378 /// Pci_Device_Structure_Header PCI设备结构体共有的头部
379 #[derive(Clone, Debug)]
380 pub struct PciDeviceStructureHeader {
381     // ==== busdevicefunction变量表示该结构体所处的位置
382     pub bus_device_function: BusDeviceFunction,
383     pub vendor_id: u16, // 供应商ID 0xffff是一个无效值,在读取访问不存在的设备的配置空间寄存器时返回
384     pub device_id: u16, // 设备ID,标志特定设备
385     pub command: u16, // 提供对设备生成和响应pci周期的能力的控制 向该寄存器写入0时,设备与pci总线断开除配置空间访问以外的所有连接
386     pub status: u16,  // 用于记录pci总线相关时间的状态信息寄存器
387     pub revision_id: u8, // 修订ID,指定特定设备的修订标志符
388     pub prog_if: u8, // 编程接口字节,一个只读寄存器,指定设备具有的寄存器级别的编程接口(如果有的话)
389     pub subclass: u8, // 子类。指定设备执行的特定功能的只读寄存器
390     pub class_code: u8, // 类代码,一个只读寄存器,指定设备执行的功能类型
391     pub cache_line_size: u8, // 缓存线大小:以 32 位为单位指定系统缓存线大小。设备可以限制它可以支持的缓存线大小的数量,如果不支持的值写入该字段,设备将表现得好像写入了 0 值
392     pub latency_timer: u8,   // 延迟计时器:以 PCI 总线时钟为单位指定延迟计时器。
393     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.
394     pub bist: u8, // Represents that status and allows control of a devices BIST (built-in self test).
395                   // Here is the layout of the BIST register:
396                   // |     bit7     |    bit6    | Bits 5-4 |     Bits 3-0    |
397                   // | BIST Capable | Start BIST | Reserved | Completion Code |
398                   // for more details, please visit https://wiki.osdev.org/PCI
399 }
400 
401 /// Pci_Device_Structure_General_Device PCI标准设备结构体
402 #[derive(Clone, Debug)]
403 pub struct PciDeviceStructureGeneralDevice {
404     pub common_header: PciDeviceStructureHeader,
405     // 中断结构体,包括legacy,msi,msix三种情况
406     pub irq_type: IrqType,
407     // 使用的中断号的vec集合
408     pub irq_vector: Vec<IrqNumber>,
409     pub standard_device_bar: PciStandardDeviceBar,
410     pub cardbus_cis_pointer: u32, // 指向卡信息结构,供在 CardBus 和 PCI 之间共享芯片的设备使用。
411     pub subsystem_vendor_id: u16,
412     pub subsystem_id: u16,
413     pub expansion_rom_base_address: u32,
414     pub capabilities_pointer: u8,
415     pub reserved0: u8,
416     pub reserved1: u16,
417     pub reserved2: u32,
418     pub interrupt_line: u8, // 指定设备的中断引脚连接到系统中断控制器的哪个输入,并由任何使用中断引脚的设备实现。对于 x86 架构,此寄存器对应于 PIC IRQ 编号 0-15(而不是 I/O APIC IRQ 编号),并且值0xFF定义为无连接。
419     pub interrupt_pin: u8, // 指定设备使用的中断引脚。其中值为0x1INTA#、0x2INTB#、0x3INTC#、0x4INTD#,0x0表示设备不使用中断引脚。
420     pub min_grant: u8, // 一个只读寄存器,用于指定设备所需的突发周期长度(以 1/4 微秒为单位)(假设时钟速率为 33 MHz)
421     pub max_latency: u8, // 一个只读寄存器,指定设备需要多长时间访问一次 PCI 总线(以 1/4 微秒为单位)。
422 }
423 impl PciDeviceStructure for PciDeviceStructureGeneralDevice {
424     #[inline(always)]
header_type(&self) -> HeaderType425     fn header_type(&self) -> HeaderType {
426         HeaderType::Standard
427     }
428     #[inline(always)]
as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice>429     fn as_standard_device(&self) -> Option<&PciDeviceStructureGeneralDevice> {
430         Some(self)
431     }
432     #[inline(always)]
as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice>433     fn as_standard_device_mut(&mut self) -> Option<&mut PciDeviceStructureGeneralDevice> {
434         Some(self)
435     }
436     #[inline(always)]
common_header(&self) -> &PciDeviceStructureHeader437     fn common_header(&self) -> &PciDeviceStructureHeader {
438         &self.common_header
439     }
440     #[inline(always)]
common_header_mut(&mut self) -> &mut PciDeviceStructureHeader441     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader {
442         &mut self.common_header
443     }
capabilities(&self) -> Option<CapabilityIterator>444     fn capabilities(&self) -> Option<CapabilityIterator> {
445         Some(CapabilityIterator {
446             bus_device_function: self.common_header.bus_device_function,
447             next_capability_offset: Some(self.capabilities_pointer),
448         })
449     }
bar_ioremap(&mut self) -> Option<Result<u8, PciError>>450     fn bar_ioremap(&mut self) -> Option<Result<u8, PciError>> {
451         let common_header = &self.common_header;
452         match pci_bar_init(common_header.bus_device_function) {
453             Ok(bar) => {
454                 self.standard_device_bar = bar;
455                 Some(Ok(0))
456             }
457             Err(e) => Some(Err(e)),
458         }
459     }
bar(&mut self) -> Option<&PciStandardDeviceBar>460     fn bar(&mut self) -> Option<&PciStandardDeviceBar> {
461         Some(&self.standard_device_bar)
462     }
463     #[inline(always)]
irq_type_mut(&mut self) -> Option<&mut IrqType>464     fn irq_type_mut(&mut self) -> Option<&mut IrqType> {
465         Some(&mut self.irq_type)
466     }
467     #[inline(always)]
irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>>468     fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>> {
469         Some(&mut self.irq_vector)
470     }
471 }
472 
473 /// Pci_Device_Structure_Pci_to_Pci_Bridge pci-to-pci桥设备结构体
474 #[derive(Clone, Debug)]
475 pub struct PciDeviceStructurePciToPciBridge {
476     pub common_header: PciDeviceStructureHeader,
477     // 中断结构体,包括legacy,msi,msix三种情况
478     pub irq_type: IrqType,
479     // 使用的中断号的vec集合
480     pub irq_vector: Vec<IrqNumber>,
481     pub bar0: u32,
482     pub bar1: u32,
483     pub primary_bus_number: u8,
484     pub secondary_bus_number: u8,
485     pub subordinate_bus_number: u8,
486     pub secondary_latency_timer: u8,
487     pub io_base: u8,
488     pub io_limit: u8,
489     pub secondary_status: u16,
490     pub memory_base: u16,
491     pub memory_limit: u16,
492     pub prefetchable_memory_base: u16,
493     pub prefetchable_memory_limit: u16,
494     pub prefetchable_base_upper_32_bits: u32,
495     pub prefetchable_limit_upper_32_bits: u32,
496     pub io_base_upper_16_bits: u16,
497     pub io_limit_upper_16_bits: u16,
498     pub capability_pointer: u8,
499     pub reserved0: u8,
500     pub reserved1: u16,
501     pub expansion_rom_base_address: u32,
502     pub interrupt_line: u8,
503     pub interrupt_pin: u8,
504     pub bridge_control: u16,
505 }
506 impl PciDeviceStructure for PciDeviceStructurePciToPciBridge {
507     #[inline(always)]
header_type(&self) -> HeaderType508     fn header_type(&self) -> HeaderType {
509         HeaderType::PciPciBridge
510     }
511     #[inline(always)]
as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge>512     fn as_pci_to_pci_bridge_device(&self) -> Option<&PciDeviceStructurePciToPciBridge> {
513         Some(self)
514     }
515     #[inline(always)]
as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge>516     fn as_pci_to_pci_bridge_device_mut(&mut self) -> Option<&mut PciDeviceStructurePciToPciBridge> {
517         Some(self)
518     }
519     #[inline(always)]
common_header(&self) -> &PciDeviceStructureHeader520     fn common_header(&self) -> &PciDeviceStructureHeader {
521         &self.common_header
522     }
523     #[inline(always)]
common_header_mut(&mut self) -> &mut PciDeviceStructureHeader524     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader {
525         &mut self.common_header
526     }
527     #[inline(always)]
irq_type_mut(&mut self) -> Option<&mut IrqType>528     fn irq_type_mut(&mut self) -> Option<&mut IrqType> {
529         Some(&mut self.irq_type)
530     }
531     #[inline(always)]
irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>>532     fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>> {
533         Some(&mut self.irq_vector)
534     }
535 }
536 /// Pci_Device_Structure_Pci_to_Cardbus_Bridge Pci_to_Cardbus桥设备结构体
537 #[derive(Clone, Debug)]
538 pub struct PciDeviceStructurePciToCardbusBridge {
539     pub common_header: PciDeviceStructureHeader,
540     pub cardbus_socket_ex_ca_base_address: u32,
541     pub offset_of_capabilities_list: u8,
542     pub reserved: u8,
543     pub secondary_status: u16,
544     pub pci_bus_number: u8,
545     pub card_bus_bus_number: u8,
546     pub subordinate_bus_number: u8,
547     pub card_bus_latency_timer: u8,
548     pub memory_base_address0: u32,
549     pub memory_limit0: u32,
550     pub memory_base_address1: u32,
551     pub memory_limit1: u32,
552     pub io_base_address0: u32,
553     pub io_limit0: u32,
554     pub io_base_address1: u32,
555     pub io_limit1: u32,
556     pub interrupt_line: u8,
557     pub interrupt_pin: u8,
558     pub bridge_control: u16,
559     pub subsystem_device_id: u16,
560     pub subsystem_vendor_id: u16,
561     pub pc_card_legacy_mode_base_address_16_bit: u32,
562 }
563 impl PciDeviceStructure for PciDeviceStructurePciToCardbusBridge {
564     #[inline(always)]
header_type(&self) -> HeaderType565     fn header_type(&self) -> HeaderType {
566         HeaderType::PciCardbusBridge
567     }
568     #[inline(always)]
as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge>569     fn as_pci_to_carbus_bridge_device(&self) -> Option<&PciDeviceStructurePciToCardbusBridge> {
570         Some(&self)
571     }
572     #[inline(always)]
as_pci_to_carbus_bridge_device_mut( &mut self, ) -> Option<&mut PciDeviceStructurePciToCardbusBridge>573     fn as_pci_to_carbus_bridge_device_mut(
574         &mut self,
575     ) -> Option<&mut PciDeviceStructurePciToCardbusBridge> {
576         Some(self)
577     }
578     #[inline(always)]
common_header(&self) -> &PciDeviceStructureHeader579     fn common_header(&self) -> &PciDeviceStructureHeader {
580         &self.common_header
581     }
582     #[inline(always)]
common_header_mut(&mut self) -> &mut PciDeviceStructureHeader583     fn common_header_mut(&mut self) -> &mut PciDeviceStructureHeader {
584         &mut self.common_header
585     }
586     #[inline(always)]
irq_type_mut(&mut self) -> Option<&mut IrqType>587     fn irq_type_mut(&mut self) -> Option<&mut IrqType> {
588         None
589     }
590     #[inline(always)]
irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>>591     fn irq_vector_mut(&mut self) -> Option<&mut Vec<IrqNumber>> {
592         None
593     }
594 }
595 
596 /// 代表一个PCI segement greoup.
597 #[derive(Clone, Debug)]
598 pub struct PciRoot {
599     pub physical_address_base: PhysAddr,         //物理地址,acpi获取
600     pub mmio_guard: Option<Arc<MMIOSpaceGuard>>, //映射后的虚拟地址,为方便访问数据这里转化成指针
601     pub segement_group_number: SegmentGroupNumber, //segement greoup的id
602     pub bus_begin: u8,                           //该分组中的最小bus
603     pub bus_end: u8,                             //该分组中的最大bus
604 }
605 ///线程间共享需要,该结构体只需要在初始化时写入数据,无需读写锁保证线程安全
606 unsafe impl Send for PciRoot {}
607 unsafe impl Sync for PciRoot {}
608 ///实现PciRoot的Display trait,自定义输出
609 impl Display for PciRoot {
fmt(&self, f: &mut Formatter<'_>) -> fmt::Result610     fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result {
611         write!(
612                 f,
613                 "PCI Root with segement:{}, bus begin at {}, bus end at {}, physical address at {:?},mapped at {:?}",
614                 self.segement_group_number, self.bus_begin, self.bus_end, self.physical_address_base, self.mmio_guard
615             )
616     }
617 }
618 
619 impl PciRoot {
620     /// @brief 初始化结构体,获取ecam root所在物理地址后map到虚拟地址,再将该虚拟地址加入mmio_base变量
621     /// @return 成功返回结果,错误返回错误类型
new(segment_group_number: SegmentGroupNumber) -> Result<Self, PciError>622     pub fn new(segment_group_number: SegmentGroupNumber) -> Result<Self, PciError> {
623         let mut pci_root = PciArch::ecam_root(segment_group_number)?;
624         pci_root.map()?;
625         Ok(pci_root)
626     }
627     /// @brief  完成物理地址到虚拟地址的映射,并将虚拟地址加入mmio_base变量
628     /// @return 返回错误或Ok(0)
map(&mut self) -> Result<u8, PciError>629     fn map(&mut self) -> Result<u8, PciError> {
630         //kdebug!("bus_begin={},bus_end={}", self.bus_begin,self.bus_end);
631         let bus_number = (self.bus_end - self.bus_begin) as u32 + 1;
632         let bus_number_double = (bus_number - 1) / 2 + 1; //一个bus占据1MB空间,计算全部bus占据空间相对于2MB空间的个数
633 
634         let size = (bus_number_double as usize) * (PAGE_2M_SIZE as usize);
635         unsafe {
636             let space_guard = mmio_pool()
637                 .create_mmio(size as usize)
638                 .map_err(|_| PciError::CreateMmioError)?;
639             let space_guard = Arc::new(space_guard);
640             self.mmio_guard = Some(space_guard.clone());
641 
642             assert!(space_guard
643                 .map_phys(self.physical_address_base, size)
644                 .is_ok());
645         }
646         return Ok(0);
647     }
648     /// @brief 获得要操作的寄存器相对于mmio_offset的偏移量
649     /// @param bus_device_function 在同一个group中pci设备的唯一标识符
650     /// @param register_offset 寄存器在设备中的offset
651     /// @return u32 要操作的寄存器相对于mmio_offset的偏移量
cam_offset(&self, bus_device_function: BusDeviceFunction, register_offset: u16) -> u32652     fn cam_offset(&self, bus_device_function: BusDeviceFunction, register_offset: u16) -> u32 {
653         assert!(bus_device_function.valid());
654         let bdf = ((bus_device_function.bus - self.bus_begin) as u32) << 8
655             | (bus_device_function.device as u32) << 3
656             | bus_device_function.function as u32;
657         let address = bdf << 12 | register_offset as u32;
658         // Ensure that address is word-aligned.
659         assert!(address & 0x3 == 0);
660         address
661     }
662     /// @brief 通过bus_device_function和offset读取相应位置寄存器的值(32位)
663     /// @param bus_device_function 在同一个group中pci设备的唯一标识符
664     /// @param register_offset 寄存器在设备中的offset
665     /// @return u32 寄存器读值结果
read_config(&self, bus_device_function: BusDeviceFunction, register_offset: u16) -> u32666     pub fn read_config(&self, bus_device_function: BusDeviceFunction, register_offset: u16) -> u32 {
667         let address = self.cam_offset(bus_device_function, register_offset);
668         unsafe {
669             // Right shift to convert from byte offset to word offset.
670             ((self.mmio_guard.as_ref().unwrap().vaddr().data() as *mut u32)
671                 .add((address >> 2) as usize))
672             .read_volatile()
673         }
674     }
675 
676     /// @brief 通过bus_device_function和offset写入相应位置寄存器值(32位)
677     /// @param bus_device_function 在同一个group中pci设备的唯一标识符
678     /// @param register_offset 寄存器在设备中的offset
679     /// @param data 要写入的值
write_config( &mut self, bus_device_function: BusDeviceFunction, register_offset: u16, data: u32, )680     pub fn write_config(
681         &mut self,
682         bus_device_function: BusDeviceFunction,
683         register_offset: u16,
684         data: u32,
685     ) {
686         let address = self.cam_offset(bus_device_function, register_offset);
687         // Safe because both the `mmio_base` and the address offset are properly aligned, and the
688         // resulting pointer is within the MMIO range of the CAM.
689         unsafe {
690             // Right shift to convert from byte offset to word offset.
691             ((self.mmio_guard.as_ref().unwrap().vaddr().data() as *mut u32)
692                 .add((address >> 2) as usize))
693             .write_volatile(data)
694         }
695     }
696     /// @brief 返回迭代器,遍历pcie设备的external_capabilities
external_capabilities( &self, bus_device_function: BusDeviceFunction, ) -> ExternalCapabilityIterator697     pub fn external_capabilities(
698         &self,
699         bus_device_function: BusDeviceFunction,
700     ) -> ExternalCapabilityIterator {
701         ExternalCapabilityIterator {
702             root: self,
703             bus_device_function,
704             next_capability_offset: Some(0x100),
705         }
706     }
707 }
708 /// Gets the capabilities 'pointer' for the device function, if any.
709 /// @brief 获取第一个capability 的offset
710 /// @param bus_device_function PCI设备的唯一标识
711 /// @return Option<u8> offset
capabilities_offset(bus_device_function: BusDeviceFunction) -> Option<u8>712 pub fn capabilities_offset(bus_device_function: BusDeviceFunction) -> Option<u8> {
713     let result = PciArch::read_config(&bus_device_function, STATUS_COMMAND_OFFSET);
714     let status: Status = Status::from_bits_truncate((result >> 16) as u16);
715     if status.contains(Status::CAPABILITIES_LIST) {
716         let cap_pointer = PciArch::read_config(&bus_device_function, 0x34) as u8 & 0xFC;
717         Some(cap_pointer)
718     } else {
719         None
720     }
721 }
722 
723 /// @brief 读取pci设备头部
724 /// @param bus_device_function PCI设备的唯一标识
725 /// @param add_to_list 是否添加到链表
726 /// @return 返回的header(trait 类型)
pci_read_header( bus_device_function: BusDeviceFunction, add_to_list: bool, ) -> Result<Box<dyn PciDeviceStructure>, PciError>727 fn pci_read_header(
728     bus_device_function: BusDeviceFunction,
729     add_to_list: bool,
730 ) -> Result<Box<dyn PciDeviceStructure>, PciError> {
731     // 先读取公共header
732     let result = PciArch::read_config(&bus_device_function, 0x00);
733     let vendor_id = result as u16;
734     let device_id = (result >> 16) as u16;
735 
736     let result = PciArch::read_config(&bus_device_function, 0x04);
737     let command = result as u16;
738     let status = (result >> 16) as u16;
739 
740     let result = PciArch::read_config(&bus_device_function, 0x08);
741     let revision_id = result as u8;
742     let prog_if = (result >> 8) as u8;
743     let subclass = (result >> 16) as u8;
744     let class_code = (result >> 24) as u8;
745 
746     let result = PciArch::read_config(&bus_device_function, 0x0c);
747     let cache_line_size = result as u8;
748     let latency_timer = (result >> 8) as u8;
749     let header_type = (result >> 16) as u8;
750     let bist = (result >> 24) as u8;
751     if vendor_id == 0xffff {
752         return Err(PciError::GetWrongHeader);
753     }
754     let header = PciDeviceStructureHeader {
755         bus_device_function,
756         vendor_id,
757         device_id,
758         command,
759         status,
760         revision_id,
761         prog_if,
762         subclass,
763         class_code,
764         cache_line_size,
765         latency_timer,
766         header_type,
767         bist,
768     };
769     match HeaderType::from(header_type & 0x7f) {
770         HeaderType::Standard => {
771             let general_device = pci_read_general_device_header(header, &bus_device_function);
772             let box_general_device = Box::new(general_device);
773             let box_general_device_clone = box_general_device.clone();
774             if add_to_list {
775                 PCI_DEVICE_LINKEDLIST.add(box_general_device);
776             }
777             Ok(box_general_device_clone)
778         }
779         HeaderType::PciPciBridge => {
780             let pci_to_pci_bridge = pci_read_pci_to_pci_bridge_header(header, &bus_device_function);
781             let box_pci_to_pci_bridge = Box::new(pci_to_pci_bridge);
782             let box_pci_to_pci_bridge_clone = box_pci_to_pci_bridge.clone();
783             if add_to_list {
784                 PCI_DEVICE_LINKEDLIST.add(box_pci_to_pci_bridge);
785             }
786             Ok(box_pci_to_pci_bridge_clone)
787         }
788         HeaderType::PciCardbusBridge => {
789             let pci_cardbus_bridge =
790                 pci_read_pci_to_cardbus_bridge_header(header, &bus_device_function);
791             let box_pci_cardbus_bridge = Box::new(pci_cardbus_bridge);
792             let box_pci_cardbus_bridge_clone = box_pci_cardbus_bridge.clone();
793             if add_to_list {
794                 PCI_DEVICE_LINKEDLIST.add(box_pci_cardbus_bridge);
795             }
796             Ok(box_pci_cardbus_bridge_clone)
797         }
798         HeaderType::Unrecognised(_) => Err(PciError::UnrecognisedHeaderType),
799     }
800 }
801 
802 /// @brief 读取type为0x0的pci设备的header
803 /// 本函数只应被 pci_read_header()调用
804 /// @param common_header 共有头部
805 /// @param bus_device_function PCI设备的唯一标识
806 /// @return Pci_Device_Structure_General_Device 标准设备头部
pci_read_general_device_header( common_header: PciDeviceStructureHeader, bus_device_function: &BusDeviceFunction, ) -> PciDeviceStructureGeneralDevice807 fn pci_read_general_device_header(
808     common_header: PciDeviceStructureHeader,
809     bus_device_function: &BusDeviceFunction,
810 ) -> PciDeviceStructureGeneralDevice {
811     let standard_device_bar = PciStandardDeviceBar::default();
812     let cardbus_cis_pointer = PciArch::read_config(bus_device_function, 0x28);
813 
814     let result = PciArch::read_config(bus_device_function, 0x2c);
815     let subsystem_vendor_id = result as u16;
816     let subsystem_id = (result >> 16) as u16;
817 
818     let expansion_rom_base_address = PciArch::read_config(bus_device_function, 0x30);
819 
820     let result = PciArch::read_config(bus_device_function, 0x34);
821     let capabilities_pointer = result as u8;
822     let reserved0 = (result >> 8) as u8;
823     let reserved1 = (result >> 16) as u16;
824 
825     let reserved2 = PciArch::read_config(bus_device_function, 0x38);
826 
827     let result = PciArch::read_config(bus_device_function, 0x3c);
828     let interrupt_line = result as u8;
829     let interrupt_pin = (result >> 8) as u8;
830     let min_grant = (result >> 16) as u8;
831     let max_latency = (result >> 24) as u8;
832     PciDeviceStructureGeneralDevice {
833         common_header,
834         irq_type: IrqType::Unused,
835         irq_vector: Vec::new(),
836         standard_device_bar,
837         cardbus_cis_pointer,
838         subsystem_vendor_id,
839         subsystem_id,
840         expansion_rom_base_address,
841         capabilities_pointer,
842         reserved0,
843         reserved1,
844         reserved2,
845         interrupt_line,
846         interrupt_pin,
847         min_grant,
848         max_latency,
849     }
850 }
851 
852 /// @brief 读取type为0x1的pci设备的header
853 /// 本函数只应被 pci_read_header()调用
854 /// @param common_header 共有头部
855 /// @param bus_device_function PCI设备的唯一标识
856 /// @return Pci_Device_Structure_Pci_to_Pci_Bridge pci-to-pci 桥设备头部
pci_read_pci_to_pci_bridge_header( common_header: PciDeviceStructureHeader, bus_device_function: &BusDeviceFunction, ) -> PciDeviceStructurePciToPciBridge857 fn pci_read_pci_to_pci_bridge_header(
858     common_header: PciDeviceStructureHeader,
859     bus_device_function: &BusDeviceFunction,
860 ) -> PciDeviceStructurePciToPciBridge {
861     let bar0 = PciArch::read_config(bus_device_function, 0x10);
862     let bar1 = PciArch::read_config(bus_device_function, 0x14);
863 
864     let result = PciArch::read_config(bus_device_function, 0x18);
865 
866     let primary_bus_number = result as u8;
867     let secondary_bus_number = (result >> 8) as u8;
868     let subordinate_bus_number = (result >> 16) as u8;
869     let secondary_latency_timer = (result >> 24) as u8;
870 
871     let result = PciArch::read_config(bus_device_function, 0x1c);
872     let io_base = result as u8;
873     let io_limit = (result >> 8) as u8;
874     let secondary_status = (result >> 16) as u16;
875 
876     let result = PciArch::read_config(bus_device_function, 0x20);
877     let memory_base = result as u16;
878     let memory_limit = (result >> 16) as u16;
879 
880     let result = PciArch::read_config(bus_device_function, 0x24);
881     let prefetchable_memory_base = result as u16;
882     let prefetchable_memory_limit = (result >> 16) as u16;
883 
884     let prefetchable_base_upper_32_bits = PciArch::read_config(bus_device_function, 0x28);
885     let prefetchable_limit_upper_32_bits = PciArch::read_config(bus_device_function, 0x2c);
886 
887     let result = PciArch::read_config(bus_device_function, 0x30);
888     let io_base_upper_16_bits = result as u16;
889     let io_limit_upper_16_bits = (result >> 16) as u16;
890 
891     let result = PciArch::read_config(bus_device_function, 0x34);
892     let capability_pointer = result as u8;
893     let reserved0 = (result >> 8) as u8;
894     let reserved1 = (result >> 16) as u16;
895 
896     let expansion_rom_base_address = PciArch::read_config(bus_device_function, 0x38);
897 
898     let result = PciArch::read_config(bus_device_function, 0x3c);
899     let interrupt_line = result as u8;
900     let interrupt_pin = (result >> 8) as u8;
901     let bridge_control = (result >> 16) as u16;
902     PciDeviceStructurePciToPciBridge {
903         common_header,
904         irq_type: IrqType::Unused,
905         irq_vector: Vec::new(),
906         bar0,
907         bar1,
908         primary_bus_number,
909         secondary_bus_number,
910         subordinate_bus_number,
911         secondary_latency_timer,
912         io_base,
913         io_limit,
914         secondary_status,
915         memory_base,
916         memory_limit,
917         prefetchable_memory_base,
918         prefetchable_memory_limit,
919         prefetchable_base_upper_32_bits,
920         prefetchable_limit_upper_32_bits,
921         io_base_upper_16_bits,
922         io_limit_upper_16_bits,
923         capability_pointer,
924         reserved0,
925         reserved1,
926         expansion_rom_base_address,
927         interrupt_line,
928         interrupt_pin,
929         bridge_control,
930     }
931 }
932 
933 /// @brief 读取type为0x2的pci设备的header
934 /// 本函数只应被 pci_read_header()调用
935 /// @param common_header 共有头部
936 /// @param bus_device_function PCI设备的唯一标识
937 /// @return   Pci_Device_Structure_Pci_to_Cardbus_Bridge  pci-to-cardbus 桥设备头部
pci_read_pci_to_cardbus_bridge_header( common_header: PciDeviceStructureHeader, busdevicefunction: &BusDeviceFunction, ) -> PciDeviceStructurePciToCardbusBridge938 fn pci_read_pci_to_cardbus_bridge_header(
939     common_header: PciDeviceStructureHeader,
940     busdevicefunction: &BusDeviceFunction,
941 ) -> PciDeviceStructurePciToCardbusBridge {
942     let cardbus_socket_ex_ca_base_address = PciArch::read_config(busdevicefunction, 0x10);
943 
944     let result = PciArch::read_config(busdevicefunction, 0x14);
945     let offset_of_capabilities_list = result as u8;
946     let reserved = (result >> 8) as u8;
947     let secondary_status = (result >> 16) as u16;
948 
949     let result = PciArch::read_config(busdevicefunction, 0x18);
950     let pci_bus_number = result as u8;
951     let card_bus_bus_number = (result >> 8) as u8;
952     let subordinate_bus_number = (result >> 16) as u8;
953     let card_bus_latency_timer = (result >> 24) as u8;
954 
955     let memory_base_address0 = PciArch::read_config(busdevicefunction, 0x1c);
956     let memory_limit0 = PciArch::read_config(busdevicefunction, 0x20);
957     let memory_base_address1 = PciArch::read_config(busdevicefunction, 0x24);
958     let memory_limit1 = PciArch::read_config(busdevicefunction, 0x28);
959 
960     let io_base_address0 = PciArch::read_config(busdevicefunction, 0x2c);
961     let io_limit0 = PciArch::read_config(busdevicefunction, 0x30);
962     let io_base_address1 = PciArch::read_config(busdevicefunction, 0x34);
963     let io_limit1 = PciArch::read_config(busdevicefunction, 0x38);
964     let result = PciArch::read_config(busdevicefunction, 0x3c);
965     let interrupt_line = result as u8;
966     let interrupt_pin = (result >> 8) as u8;
967     let bridge_control = (result >> 16) as u16;
968 
969     let result = PciArch::read_config(busdevicefunction, 0x40);
970     let subsystem_device_id = result as u16;
971     let subsystem_vendor_id = (result >> 16) as u16;
972 
973     let pc_card_legacy_mode_base_address_16_bit = PciArch::read_config(busdevicefunction, 0x44);
974     PciDeviceStructurePciToCardbusBridge {
975         common_header,
976         cardbus_socket_ex_ca_base_address,
977         offset_of_capabilities_list,
978         reserved,
979         secondary_status,
980         pci_bus_number,
981         card_bus_bus_number,
982         subordinate_bus_number,
983         card_bus_latency_timer,
984         memory_base_address0,
985         memory_limit0,
986         memory_base_address1,
987         memory_limit1,
988         io_base_address0,
989         io_limit0,
990         io_base_address1,
991         io_limit1,
992         interrupt_line,
993         interrupt_pin,
994         bridge_control,
995         subsystem_device_id,
996         subsystem_vendor_id,
997         pc_card_legacy_mode_base_address_16_bit,
998     }
999 }
1000 
1001 /// @brief 检查所有bus上的设备并将其加入链表
1002 /// @return 成功返回ok(),失败返回失败原因
pci_check_all_buses() -> Result<u8, PciError>1003 fn pci_check_all_buses() -> Result<u8, PciError> {
1004     kinfo!("Checking all devices in PCI bus...");
1005     let busdevicefunction = BusDeviceFunction {
1006         bus: 0,
1007         device: 0,
1008         function: 0,
1009     };
1010     let header = pci_read_header(busdevicefunction, false)?;
1011     let common_header = header.common_header();
1012     pci_check_bus(0)?;
1013     if common_header.header_type & 0x80 != 0 {
1014         for function in 1..8 {
1015             pci_check_bus(function)?;
1016         }
1017     }
1018     Ok(0)
1019 }
1020 /// @brief 检查特定设备并将其加入链表
1021 /// @return 成功返回ok(),失败返回失败原因
pci_check_function(busdevicefunction: BusDeviceFunction) -> Result<u8, PciError>1022 fn pci_check_function(busdevicefunction: BusDeviceFunction) -> Result<u8, PciError> {
1023     //kdebug!("PCI check function {}", busdevicefunction.function);
1024     let header = match pci_read_header(busdevicefunction, true) {
1025         Ok(header) => header,
1026         Err(PciError::GetWrongHeader) => {
1027             return Ok(255);
1028         }
1029         Err(e) => {
1030             return Err(e);
1031         }
1032     };
1033     let common_header = header.common_header();
1034     if (common_header.class_code == 0x06)
1035         && (common_header.subclass == 0x04 || common_header.subclass == 0x09)
1036     {
1037         let pci_to_pci_bridge = header
1038             .as_pci_to_pci_bridge_device()
1039             .ok_or(PciError::PciDeviceStructureTransformError)?;
1040         let secondary_bus = pci_to_pci_bridge.secondary_bus_number;
1041         pci_check_bus(secondary_bus)?;
1042     }
1043     Ok(0)
1044 }
1045 
1046 /// @brief 检查device上的设备并将其加入链表
1047 /// @return 成功返回ok(),失败返回失败原因
pci_check_device(bus: u8, device: u8) -> Result<u8, PciError>1048 fn pci_check_device(bus: u8, device: u8) -> Result<u8, PciError> {
1049     //kdebug!("PCI check device {}", device);
1050     let busdevicefunction = BusDeviceFunction {
1051         bus,
1052         device,
1053         function: 0,
1054     };
1055     let header = match pci_read_header(busdevicefunction, false) {
1056         Ok(header) => header,
1057         Err(PciError::GetWrongHeader) => {
1058             //设备不存在,直接返回即可,不用终止遍历
1059             return Ok(255);
1060         }
1061         Err(e) => {
1062             return Err(e);
1063         }
1064     };
1065     pci_check_function(busdevicefunction)?;
1066     let common_header = header.common_header();
1067     if common_header.header_type & 0x80 != 0 {
1068         kdebug!(
1069             "Detected multi func device in bus{},device{}",
1070             busdevicefunction.bus,
1071             busdevicefunction.device
1072         );
1073         // 这是一个多function的设备,因此查询剩余的function
1074         for function in 1..8 {
1075             let busdevicefunction = BusDeviceFunction {
1076                 bus,
1077                 device,
1078                 function,
1079             };
1080             pci_check_function(busdevicefunction)?;
1081         }
1082     }
1083     Ok(0)
1084 }
1085 /// @brief 检查该bus上的设备并将其加入链表
1086 /// @return 成功返回ok(),失败返回失败原因
pci_check_bus(bus: u8) -> Result<u8, PciError>1087 fn pci_check_bus(bus: u8) -> Result<u8, PciError> {
1088     //kdebug!("PCI check bus {}", bus);
1089     for device in 0..32 {
1090         pci_check_device(bus, device)?;
1091     }
1092     Ok(0)
1093 }
1094 
1095 /// pci初始化函数
1096 #[inline(never)]
pci_init()1097 pub fn pci_init() {
1098     kinfo!("Initializing PCI bus...");
1099     if let Err(e) = pci_check_all_buses() {
1100         kerror!("pci init failed when checking bus because of error: {}", e);
1101         return;
1102     }
1103     kinfo!(
1104         "Total pci device and function num = {}",
1105         PCI_DEVICE_LINKEDLIST.num()
1106     );
1107     let list = PCI_DEVICE_LINKEDLIST.read();
1108     for box_pci_device in list.iter() {
1109         let common_header = box_pci_device.common_header();
1110         match box_pci_device.header_type() {
1111             HeaderType::Standard if common_header.status & 0x10 != 0 => {
1112                 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);
1113             }
1114             HeaderType::Standard => {
1115                 kinfo!(
1116                     "Found pci standard device with class code ={} subclass={} status={:#x} ",
1117                     common_header.class_code,
1118                     common_header.subclass,
1119                     common_header.status
1120                 );
1121             }
1122             HeaderType::PciPciBridge if common_header.status & 0x10 != 0 => {
1123                 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);
1124             }
1125             HeaderType::PciPciBridge => {
1126                 kinfo!(
1127                     "Found pci-to-pci bridge device with class code ={} subclass={} status={:#x} ",
1128                     common_header.class_code,
1129                     common_header.subclass,
1130                     common_header.status
1131                 );
1132             }
1133             HeaderType::PciCardbusBridge => {
1134                 kinfo!(
1135                     "Found pcicardbus bridge device with class code ={} subclass={} status={:#x} ",
1136                     common_header.class_code,
1137                     common_header.subclass,
1138                     common_header.status
1139                 );
1140             }
1141             HeaderType::Unrecognised(_) => {}
1142         }
1143     }
1144     kinfo!("PCI bus initialized.");
1145 }
1146 
1147 /// An identifier for a PCI bus, device and function.
1148 /// PCI设备的唯一标识
1149 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
1150 pub struct BusDeviceFunction {
1151     /// The PCI bus number, between 0 and 255.
1152     pub bus: u8,
1153     /// The device number on the bus, between 0 and 31.
1154     pub device: u8,
1155     /// The function number of the device, between 0 and 7.
1156     pub function: u8,
1157 }
1158 impl BusDeviceFunction {
1159     /// Returns whether the device and function numbers are valid, i.e. the device is between 0 and
1160     ///@brief 检测BusDeviceFunction实例是否有效
1161     ///@param self
1162     ///@return bool 是否有效
1163     #[allow(dead_code)]
valid(&self) -> bool1164     pub fn valid(&self) -> bool {
1165         self.device < 32 && self.function < 8
1166     }
1167 }
1168 ///实现BusDeviceFunction的Display trait,使其可以直接输出
1169 impl Display for BusDeviceFunction {
fmt(&self, f: &mut Formatter) -> fmt::Result1170     fn fmt(&self, f: &mut Formatter) -> fmt::Result {
1171         write!(
1172             f,
1173             "bus {} device {} function{}",
1174             self.bus, self.device, self.function
1175         )
1176     }
1177 }
1178 /// The location allowed for a memory BAR.
1179 /// memory BAR的三种情况
1180 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
1181 pub enum MemoryBarType {
1182     /// The BAR has a 32-bit address and can be mapped anywhere in 32-bit address space.
1183     Width32,
1184     /// The BAR must be mapped below 1MiB.
1185     Below1MiB,
1186     /// The BAR has a 64-bit address and can be mapped anywhere in 64-bit address space.
1187     Width64,
1188 }
1189 ///实现MemoryBarType与u8的类型转换
1190 impl From<MemoryBarType> for u8 {
from(bar_type: MemoryBarType) -> Self1191     fn from(bar_type: MemoryBarType) -> Self {
1192         match bar_type {
1193             MemoryBarType::Width32 => 0,
1194             MemoryBarType::Below1MiB => 1,
1195             MemoryBarType::Width64 => 2,
1196         }
1197     }
1198 }
1199 ///实现MemoryBarType与u8的类型转换
1200 impl TryFrom<u8> for MemoryBarType {
1201     type Error = PciError;
try_from(value: u8) -> Result<Self, Self::Error>1202     fn try_from(value: u8) -> Result<Self, Self::Error> {
1203         match value {
1204             0 => Ok(Self::Width32),
1205             1 => Ok(Self::Below1MiB),
1206             2 => Ok(Self::Width64),
1207             _ => Err(PciError::InvalidBarType),
1208         }
1209     }
1210 }
1211 
1212 /// Information about a PCI Base Address Register.
1213 /// BAR的三种类型 Memory/IO/Unused
1214 #[derive(Clone, Debug)]
1215 pub enum BarInfo {
1216     /// The BAR is for a memory region.
1217     Memory {
1218         /// The size of the BAR address and where it can be located.
1219         address_type: MemoryBarType,
1220         /// If true, then reading from the region doesn't have side effects. The CPU may cache reads
1221         /// and merge repeated stores.
1222         prefetchable: bool,
1223         /// The memory address, always 16-byte aligned.
1224         address: u64,
1225         /// The size of the BAR in bytes.
1226         size: u32,
1227         /// The virtaddress for a memory bar(mapped).
1228         mmio_guard: Arc<MMIOSpaceGuard>,
1229     },
1230     /// The BAR is for an I/O region.
1231     IO {
1232         /// The I/O address, always 4-byte aligned.
1233         address: u32,
1234         /// The size of the BAR in bytes.
1235         size: u32,
1236     },
1237     Unused,
1238 }
1239 
1240 impl BarInfo {
1241     /// Returns the address and size of this BAR if it is a memory bar, or `None` if it is an IO
1242     /// BAR.
1243     ///@brief 得到某个bar的memory_address与size(前提是他的类型为Memory Bar)
1244     ///@param self
1245     ///@return Option<(u64, u32) 是Memory Bar返回内存地址与大小,不是则返回None
memory_address_size(&self) -> Option<(u64, u32)>1246     pub fn memory_address_size(&self) -> Option<(u64, u32)> {
1247         if let Self::Memory { address, size, .. } = self {
1248             Some((*address, *size))
1249         } else {
1250             None
1251         }
1252     }
1253     ///@brief 得到某个bar的virtaddress(前提是他的类型为Memory Bar)
1254     ///@param self
1255     ///@return Option<(u64) 是Memory Bar返回映射的虚拟地址,不是则返回None
virtual_address(&self) -> Option<VirtAddr>1256     pub fn virtual_address(&self) -> Option<VirtAddr> {
1257         if let Self::Memory { mmio_guard, .. } = self {
1258             Some(mmio_guard.vaddr())
1259         } else {
1260             None
1261         }
1262     }
1263 }
1264 ///实现BarInfo的Display trait,自定义输出
1265 impl Display for BarInfo {
fmt(&self, f: &mut Formatter<'_>) -> fmt::Result1266     fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result {
1267         match self {
1268             Self::Memory {
1269                 address_type,
1270                 prefetchable,
1271                 address,
1272                 size,
1273                 mmio_guard,
1274             } => write!(
1275                 f,
1276                 "Memory space at {:#010x}, size {}, type {:?}, prefetchable {}, mmio_guard: {:?}",
1277                 address, size, address_type, prefetchable, mmio_guard
1278             ),
1279             Self::IO { address, size } => {
1280                 write!(f, "I/O space at {:#010x}, size {}", address, size)
1281             }
1282             Self::Unused => {
1283                 write!(f, "Unused bar")
1284             }
1285         }
1286     }
1287 }
1288 // todo 增加对桥的bar的支持
1289 pub trait PciDeviceBar {}
1290 
1291 ///一个普通PCI设备(非桥)有6个BAR寄存器,PciStandardDeviceBar存储其全部信息
1292 #[derive(Clone, Debug)]
1293 pub struct PciStandardDeviceBar {
1294     bar0: BarInfo,
1295     bar1: BarInfo,
1296     bar2: BarInfo,
1297     bar3: BarInfo,
1298     bar4: BarInfo,
1299     bar5: BarInfo,
1300 }
1301 
1302 impl PciStandardDeviceBar {
1303     ///@brief 得到某个bar的barinfo
1304     ///@param self ,bar_index(0-5)
1305     ///@return Result<&BarInfo, PciError> bar_index在0-5则返回对应的bar_info结构体,超出范围则返回错误
get_bar(&self, bar_index: u8) -> Result<&BarInfo, PciError>1306     pub fn get_bar(&self, bar_index: u8) -> Result<&BarInfo, PciError> {
1307         match bar_index {
1308             0 => Ok(&self.bar0),
1309             1 => Ok(&self.bar1),
1310             2 => Ok(&self.bar2),
1311             3 => Ok(&self.bar3),
1312             4 => Ok(&self.bar4),
1313             5 => Ok(&self.bar5),
1314             _ => Err(PciError::InvalidBarType),
1315         }
1316     }
1317 }
1318 ///实现PciStandardDeviceBar的Display trait,使其可以直接输出
1319 impl Display for PciStandardDeviceBar {
fmt(&self, f: &mut Formatter<'_>) -> fmt::Result1320     fn fmt(&self, f: &mut Formatter<'_>) -> fmt::Result {
1321         write!(
1322             f,
1323             "\r\nBar0:{}\r\nBar1:{}\r\nBar2:{}\r\nBar3:{}\r\nBar4:{}\r\nBar5:{}",
1324             self.bar0, self.bar1, self.bar2, self.bar3, self.bar4, self.bar5
1325         )
1326     }
1327 }
1328 ///实现PciStandardDeviceBar的Default trait,使其可以简单初始化
1329 impl Default for PciStandardDeviceBar {
default() -> Self1330     fn default() -> Self {
1331         PciStandardDeviceBar {
1332             bar0: BarInfo::Unused,
1333             bar1: BarInfo::Unused,
1334             bar2: BarInfo::Unused,
1335             bar3: BarInfo::Unused,
1336             bar4: BarInfo::Unused,
1337             bar5: BarInfo::Unused,
1338         }
1339     }
1340 }
1341 
1342 ///@brief 将某个pci设备的bar寄存器读取值后映射到虚拟地址
1343 ///@param self ,bus_device_function PCI设备的唯一标识符
1344 ///@return Result<PciStandardDeviceBar, PciError> 成功则返回对应的PciStandardDeviceBar结构体,失败则返回错误类型
pci_bar_init( bus_device_function: BusDeviceFunction, ) -> Result<PciStandardDeviceBar, PciError>1345 pub fn pci_bar_init(
1346     bus_device_function: BusDeviceFunction,
1347 ) -> Result<PciStandardDeviceBar, PciError> {
1348     let mut device_bar: PciStandardDeviceBar = PciStandardDeviceBar::default();
1349     let mut bar_index_ignore: u8 = 255;
1350     for bar_index in 0..6 {
1351         if bar_index == bar_index_ignore {
1352             continue;
1353         }
1354         let bar_info;
1355         let bar_orig = PciArch::read_config(&bus_device_function, BAR0_OFFSET + 4 * bar_index);
1356         PciArch::write_config(
1357             &bus_device_function,
1358             BAR0_OFFSET + 4 * bar_index,
1359             0xffffffff,
1360         );
1361         let size_mask = PciArch::read_config(&bus_device_function, BAR0_OFFSET + 4 * bar_index);
1362         // A wrapping add is necessary to correctly handle the case of unused BARs, which read back
1363         // as 0, and should be treated as size 0.
1364         let size = (!(size_mask & 0xfffffff0)).wrapping_add(1);
1365         //kdebug!("bar_orig:{:#x},size: {:#x}", bar_orig,size);
1366         // Restore the original value.
1367         PciArch::write_config(&bus_device_function, BAR0_OFFSET + 4 * bar_index, bar_orig);
1368         if size == 0 {
1369             continue;
1370         }
1371         if bar_orig & 0x00000001 == 0x00000001 {
1372             // I/O space
1373             let address = bar_orig & 0xfffffffc;
1374             bar_info = BarInfo::IO { address, size };
1375         } else {
1376             // Memory space
1377             let mut address = u64::from(bar_orig & 0xfffffff0);
1378             let prefetchable = bar_orig & 0x00000008 != 0;
1379             let address_type = MemoryBarType::try_from(((bar_orig & 0x00000006) >> 1) as u8)?;
1380             if address_type == MemoryBarType::Width64 {
1381                 if bar_index >= 5 {
1382                     return Err(PciError::InvalidBarType);
1383                 }
1384                 let address_top =
1385                     PciArch::read_config(&bus_device_function, BAR0_OFFSET + 4 * (bar_index + 1));
1386                 address |= u64::from(address_top) << 32;
1387                 bar_index_ignore = bar_index + 1; //下个bar跳过,因为64位的memory bar覆盖了两个bar
1388             }
1389             let pci_address = PciAddr::new(address as usize);
1390             let paddr = PciArch::address_pci_to_physical(pci_address); //PCI总线域物理地址转换为存储器域物理地址
1391 
1392             let space_guard: Arc<MMIOSpaceGuard>;
1393             unsafe {
1394                 let size_want = size as usize;
1395                 let tmp = mmio_pool()
1396                     .create_mmio(size_want)
1397                     .map_err(|_| PciError::CreateMmioError)?;
1398                 space_guard = Arc::new(tmp);
1399                 //kdebug!("Pci bar init: mmio space: {space_guard:?}, paddr={paddr:?}, size_want={size_want}");
1400                 assert!(
1401                     space_guard.map_phys(paddr, size_want).is_ok(),
1402                     "pci_bar_init: map_phys failed"
1403                 );
1404             }
1405             bar_info = BarInfo::Memory {
1406                 address_type,
1407                 prefetchable,
1408                 address,
1409                 size,
1410                 mmio_guard: space_guard,
1411             };
1412         }
1413         match bar_index {
1414             0 => {
1415                 device_bar.bar0 = bar_info;
1416             }
1417             1 => {
1418                 device_bar.bar1 = bar_info;
1419             }
1420             2 => {
1421                 device_bar.bar2 = bar_info;
1422             }
1423             3 => {
1424                 device_bar.bar3 = bar_info;
1425             }
1426             4 => {
1427                 device_bar.bar4 = bar_info;
1428             }
1429             5 => {
1430                 device_bar.bar5 = bar_info;
1431             }
1432             _ => {}
1433         }
1434     }
1435     //kdebug!("pci_device_bar:{}", device_bar);
1436     return Ok(device_bar);
1437 }
1438 
1439 /// Information about a PCI device capability.
1440 /// PCI设备的capability的信息
1441 #[derive(Debug, Copy, Clone, Eq, PartialEq)]
1442 pub struct CapabilityInfo {
1443     /// The offset of the capability in the PCI configuration space of the device function.
1444     pub offset: u8,
1445     /// The ID of the capability.
1446     pub id: u8,
1447     /// The third and fourth bytes of the capability, to save reading them again.
1448     pub private_header: u16,
1449 }
1450 
1451 /// Iterator over capabilities for a device.
1452 /// 创建迭代器以遍历PCI设备的capability
1453 #[derive(Debug)]
1454 pub struct CapabilityIterator {
1455     pub bus_device_function: BusDeviceFunction,
1456     pub next_capability_offset: Option<u8>,
1457 }
1458 
1459 impl Iterator for CapabilityIterator {
1460     type Item = CapabilityInfo;
next(&mut self) -> Option<Self::Item>1461     fn next(&mut self) -> Option<Self::Item> {
1462         let offset = self.next_capability_offset?;
1463 
1464         // Read the first 4 bytes of the capability.
1465         let capability_header = PciArch::read_config(&self.bus_device_function, offset);
1466         let id = capability_header as u8;
1467         let next_offset = (capability_header >> 8) as u8;
1468         let private_header = (capability_header >> 16) as u16;
1469 
1470         self.next_capability_offset = if next_offset == 0 {
1471             None
1472         } else if next_offset < 64 || next_offset & 0x3 != 0 {
1473             kwarn!("Invalid next capability offset {:#04x}", next_offset);
1474             None
1475         } else {
1476             Some(next_offset)
1477         };
1478 
1479         Some(CapabilityInfo {
1480             offset,
1481             id,
1482             private_header,
1483         })
1484     }
1485 }
1486 
1487 /// Information about a PCIe device capability.
1488 /// PCIe设备的external capability的信息
1489 #[derive(Debug, Copy, Clone, Eq, PartialEq)]
1490 pub struct ExternalCapabilityInfo {
1491     /// The offset of the capability in the PCI configuration space of the device function.
1492     pub offset: u16,
1493     /// The ID of the capability.
1494     pub id: u16,
1495     /// The third and fourth bytes of the capability, to save reading them again.
1496     pub capability_version: u8,
1497 }
1498 
1499 /// Iterator over capabilities for a device.
1500 /// 创建迭代器以遍历PCIe设备的external capability
1501 #[derive(Debug)]
1502 pub struct ExternalCapabilityIterator<'a> {
1503     pub root: &'a PciRoot,
1504     pub bus_device_function: BusDeviceFunction,
1505     pub next_capability_offset: Option<u16>,
1506 }
1507 impl<'a> Iterator for ExternalCapabilityIterator<'a> {
1508     type Item = ExternalCapabilityInfo;
next(&mut self) -> Option<Self::Item>1509     fn next(&mut self) -> Option<Self::Item> {
1510         let offset = self.next_capability_offset?;
1511 
1512         // Read the first 4 bytes of the capability.
1513         let capability_header = self.root.read_config(self.bus_device_function, offset);
1514         let id = capability_header as u16;
1515         let next_offset = (capability_header >> 20) as u16;
1516         let capability_version = ((capability_header >> 16) & 0xf) as u8;
1517 
1518         self.next_capability_offset = if next_offset == 0 {
1519             None
1520         } else if next_offset < 0x100 || next_offset & 0x3 != 0 {
1521             kwarn!("Invalid next capability offset {:#04x}", next_offset);
1522             None
1523         } else {
1524             Some(next_offset)
1525         };
1526 
1527         Some(ExternalCapabilityInfo {
1528             offset,
1529             id,
1530             capability_version,
1531         })
1532     }
1533 }
1534