mirror of
https://github.com/DragonOS-Community/DragonOS.git
synced 2025-06-09 19:36:47 +00:00
402 lines
14 KiB
C
402 lines
14 KiB
C
#include "pci.h"
|
||
#include "../../common/kprint.h"
|
||
#include "../../mm/slab.h"
|
||
|
||
static uint count_device_list = 0;
|
||
|
||
/**
|
||
* @brief 将设备信息结构体加到链表里面
|
||
*
|
||
*/
|
||
#define ADD_DEVICE_STRUCT_TO_LIST(ret) \
|
||
do \
|
||
{ \
|
||
if (count_device_list > 0) \
|
||
{ \
|
||
++count_device_list; \
|
||
list_add(pci_device_structure_list, &ret->header->list); \
|
||
} \
|
||
else \
|
||
{ \
|
||
++count_device_list; \
|
||
list_init(&ret->header->list); \
|
||
pci_device_structure_list = &ret->header->list; \
|
||
} \
|
||
} while (0)
|
||
|
||
/**
|
||
* @brief 从pci配置空间读取信息
|
||
*
|
||
* @param bus 总线号
|
||
* @param slot 设备号
|
||
* @param func 功能号
|
||
* @param offset 寄存器偏移量
|
||
* @return uint 寄存器值
|
||
*/
|
||
uint pci_read_config(uchar bus, uchar slot, uchar func, uchar offset)
|
||
{
|
||
uint lbus = (uint)bus;
|
||
uint lslot = (uint)slot;
|
||
uint lfunc = ((uint)func) & 7;
|
||
|
||
// 构造pci配置空间地址
|
||
uint address = (uint)((lbus << 16) | (lslot << 11) | (lfunc << 8) | (offset & 0xfc) | ((uint)0x80000000));
|
||
io_out32(PORT_PCI_CONFIG_ADDRESS, address);
|
||
// 读取返回的数据
|
||
return (uint)(io_in32(PORT_PCI_CONFIG_DATA));
|
||
}
|
||
|
||
/**
|
||
* @brief 读取type为0x0的pci设备的header
|
||
* 本函数只应被 pci_read_header()调用
|
||
* @param header 返回的header
|
||
* @param bus 总线号
|
||
* @param slot 插槽号
|
||
* @param func 功能号
|
||
*/
|
||
static void pci_read_general_device_header(struct pci_device_structure_general_device_t *header, uchar bus, uchar slot, uchar func)
|
||
{
|
||
uint32_t tmp32;
|
||
header->BAR0 = pci_read_config(bus, slot, func, 0x10);
|
||
header->BAR1 = pci_read_config(bus, slot, func, 0x14);
|
||
header->BAR2 = pci_read_config(bus, slot, func, 0x18);
|
||
header->BAR3 = pci_read_config(bus, slot, func, 0x1c);
|
||
header->BAR4 = pci_read_config(bus, slot, func, 0x20);
|
||
header->BAR5 = pci_read_config(bus, slot, func, 0x24);
|
||
header->Cardbus_CIS_Pointer = pci_read_config(bus, slot, func, 0x28);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x2c);
|
||
header->Subsystem_Vendor_ID = tmp32 & 0xffff;
|
||
header->Subsystem_ID = (tmp32 >> 16) & 0xffff;
|
||
|
||
header->Expansion_ROM_base_address = pci_read_config(bus, slot, func, 0x30);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x34);
|
||
header->Capabilities_Pointer = tmp32 & 0xff;
|
||
header->reserved0 = (tmp32 >> 8) & 0xff;
|
||
header->reserved1 = (tmp32 >> 16) & 0xffff;
|
||
|
||
header->reserved2 = pci_read_config(bus, slot, func, 0x38);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x3c);
|
||
header->Interrupt_Line = tmp32 & 0xff;
|
||
header->Interrupt_PIN = (tmp32 >> 8) & 0xff;
|
||
header->Min_Grant = (tmp32 >> 16) & 0xff;
|
||
header->Max_Latency = (tmp32 >> 24) & 0xff;
|
||
}
|
||
|
||
/**
|
||
* @brief 读取type为0x1的pci_to_pci_bridge的header
|
||
* 本函数只应被 pci_read_header()调用
|
||
* @param header 返回的header
|
||
* @param bus 总线号
|
||
* @param slot 插槽号
|
||
* @param func 功能号
|
||
*/
|
||
static void pci_read_pci_to_pci_bridge_header(struct pci_device_structure_pci_to_pci_bridge_t *header, uchar bus, uchar slot, uchar func)
|
||
{
|
||
uint32_t tmp32;
|
||
header->BAR0 = pci_read_config(bus, slot, func, 0x10);
|
||
header->BAR1 = pci_read_config(bus, slot, func, 0x14);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x18);
|
||
|
||
header->Primary_Bus_Number = tmp32 & 0xff;
|
||
header->Secondary_Bus_Number = (tmp32 >> 8) & 0xff;
|
||
header->Subordinate_Bus_Number = (tmp32 >> 16) & 0xff;
|
||
header->Secondary_Latency_Timer = (tmp32 >> 24) & 0xff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x1c);
|
||
header->io_base = tmp32 & 0xff;
|
||
header->io_limit = (tmp32 >> 8) & 0xff;
|
||
header->Secondary_Status = (tmp32 >> 16) & 0xffff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x20);
|
||
header->Memory_Base = tmp32 & 0xffff;
|
||
header->Memory_Limit = (tmp32 >> 16) & 0xffff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x24);
|
||
header->Prefetchable_Memory_Base = tmp32 & 0xffff;
|
||
header->Prefetchable_Memory_Limit = (tmp32 >> 16) & 0xffff;
|
||
|
||
header->Prefetchable_Base_Upper_32_Bits = pci_read_config(bus, slot, func, 0x28);
|
||
header->Prefetchable_Limit_Upper_32_Bits = pci_read_config(bus, slot, func, 0x2c);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x30);
|
||
header->io_Base_Upper_16_Bits = tmp32 & 0xffff;
|
||
header->io_Limit_Upper_16_Bits = (tmp32 >> 16) & 0xffff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x34);
|
||
header->Capability_Pointer = tmp32 & 0xff;
|
||
header->reserved0 = (tmp32 >> 8) & 0xff;
|
||
header->reserved1 = (tmp32 >> 16) & 0xffff;
|
||
|
||
header->Expansion_ROM_base_address = pci_read_config(bus, slot, func, 0x38);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x3c);
|
||
header->Interrupt_Line = tmp32 & 0xff;
|
||
header->Interrupt_PIN = (tmp32 >> 8) & 0xff;
|
||
header->Bridge_Control = (tmp32 >> 16) & 0xffff;
|
||
}
|
||
|
||
/**
|
||
* @brief 读取type为0x2的pci_to_cardbus_bridge的header
|
||
* 本函数只应被 pci_read_header()调用
|
||
* @param header 返回的header
|
||
* @param bus 总线号
|
||
* @param slot 插槽号
|
||
* @param func 功能号
|
||
*/
|
||
static void pci_read_pci_to_cardbus_bridge_header(struct pci_device_structure_pci_to_cardbus_bridge_t *header, uchar bus, uchar slot, uchar func)
|
||
{
|
||
uint32_t tmp32;
|
||
|
||
header->CardBus_Socket_ExCa_base_address = pci_read_config(bus, slot, func, 0x10);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x14);
|
||
header->Offset_of_capabilities_list = tmp32 & 0xff;
|
||
header->Reserved = (tmp32 >> 8) & 0xff;
|
||
header->Secondary_status = (tmp32 >> 16) & 0xff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x18);
|
||
header->PCI_bus_number = tmp32 & 0xff;
|
||
header->CardBus_bus_number = (tmp32 >> 8) & 0xff;
|
||
header->Subordinate_bus_number = (tmp32 >> 16) & 0xff;
|
||
header->CardBus_latency_timer = (tmp32 >> 24) & 0xff;
|
||
|
||
header->Memory_Base_Address0 = pci_read_config(bus, slot, func, 0x1c);
|
||
header->Memory_Limit0 = pci_read_config(bus, slot, func, 0x20);
|
||
header->Memory_Base_Address1 = pci_read_config(bus, slot, func, 0x24);
|
||
header->Memory_Limit1 = pci_read_config(bus, slot, func, 0x28);
|
||
|
||
header->IO_Base_Address0 = pci_read_config(bus, slot, func, 0x2c);
|
||
header->IO_Limit0 = pci_read_config(bus, slot, func, 0x30);
|
||
header->IO_Base_Address1 = pci_read_config(bus, slot, func, 0x34);
|
||
header->IO_Limit1 = pci_read_config(bus, slot, func, 0x38);
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x3c);
|
||
header->Interrupt_Line = tmp32 & 0xff;
|
||
header->Interrupt_PIN = (tmp32 >> 8) & 0xff;
|
||
header->Bridge_Control = (tmp32 >> 16) & 0xffff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x40);
|
||
header->Subsystem_Device_ID = tmp32 & 0xffff;
|
||
header->Subsystem_Vendor_ID = (tmp32 >> 16) & 0xffff;
|
||
|
||
header->PC_Card_legacy_mode_base_address_16_bit = pci_read_config(bus, slot, func, 0x44);
|
||
}
|
||
|
||
/**
|
||
* @brief 读取pci设备标头
|
||
*
|
||
* @param type 标头类型
|
||
* @param bus 总线号
|
||
* @param slot 插槽号
|
||
* @param func 功能号
|
||
* @param add_to_list 添加到链表
|
||
* @return 返回的header
|
||
*/
|
||
void *pci_read_header(int *type, uchar bus, uchar slot, uchar func, bool add_to_list)
|
||
{
|
||
struct pci_device_structure_header_t *common_header = (struct pci_device_structure_header_t *)kmalloc(sizeof(struct pci_device_structure_header_t), 0);
|
||
|
||
uint32_t tmp32;
|
||
// 先读取公共header
|
||
tmp32 = pci_read_config(bus, slot, func, 0x0);
|
||
common_header->Vendor_ID = tmp32 & 0xffff;
|
||
common_header->Device_ID = (tmp32 >> 16) & 0xffff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x4);
|
||
common_header->Command = tmp32 & 0xffff;
|
||
common_header->Status = (tmp32 >> 16) & 0xffff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0x8);
|
||
common_header->RevisionID = tmp32 & 0xff;
|
||
common_header->ProgIF = (tmp32 >> 8) & 0xff;
|
||
common_header->SubClass = (tmp32 >> 16) & 0xff;
|
||
common_header->Class_code = (tmp32 >> 24) & 0xff;
|
||
|
||
tmp32 = pci_read_config(bus, slot, func, 0xc);
|
||
common_header->CacheLineSize = tmp32 & 0xff;
|
||
common_header->LatencyTimer = (tmp32 >> 8) & 0xff;
|
||
common_header->HeaderType = (tmp32 >> 16) & 0xff;
|
||
common_header->BIST = (tmp32 >> 24) & 0xff;
|
||
|
||
// 根据公共头部,判断该结构所属的类型
|
||
switch (common_header->Vendor_ID)
|
||
{
|
||
case 0xFFFF: // 设备不可用
|
||
*type = E_DEVICE_INVALID;
|
||
kfree(common_header);
|
||
return NULL;
|
||
break;
|
||
case 0x0: // general device
|
||
struct pci_device_structure_general_device_t *ret = (struct pci_device_structure_general_device_t *)kmalloc(sizeof(struct pci_device_structure_general_device_t), 0);
|
||
|
||
ret->header = common_header;
|
||
pci_read_general_device_header(ret, bus, slot, func);
|
||
if (add_to_list)
|
||
ADD_DEVICE_STRUCT_TO_LIST(ret);
|
||
|
||
*type = 0x0;
|
||
return ret;
|
||
break;
|
||
case 0x1:
|
||
struct pci_device_structure_pci_to_pci_bridge_t *ret = (struct pci_device_structure_pci_to_pci_bridge_t *)kmalloc(sizeof(struct pci_device_structure_pci_to_pci_bridge_t), 0);
|
||
ret->header = common_header;
|
||
pci_read_pci_to_pci_bridge_header(ret, bus, slot, func);
|
||
if (add_to_list)
|
||
ADD_DEVICE_STRUCT_TO_LIST(ret);
|
||
|
||
*type = 0x1;
|
||
return ret;
|
||
break;
|
||
case 0x2:
|
||
struct pci_device_structure_pci_to_cardbus_bridge_t *ret = (struct pci_device_structure_pci_to_cardbus_bridge_t *)kmalloc(sizeof(struct pci_device_structure_pci_to_cardbus_bridge_t), 0);
|
||
ret->header = common_header;
|
||
pci_read_pci_to_cardbus_bridge_header(ret, bus, slot, func);
|
||
if (add_to_list)
|
||
ADD_DEVICE_STRUCT_TO_LIST(ret);
|
||
|
||
*type = 0x2;
|
||
return ret;
|
||
break;
|
||
default: // 错误的头类型 这里不应该被执行
|
||
kBUG("PCI->pci_read_header(): Invalid header type.");
|
||
*type = E_WRONG_HEADER_TYPE;
|
||
kfree(common_header);
|
||
return NULL;
|
||
break;
|
||
}
|
||
}
|
||
static void pci_checkFunction(uint8_t bus, uint8_t device, uint8_t function)
|
||
{
|
||
int header_type;
|
||
struct pci_device_structure_header_t *header;
|
||
void *raw_header = pci_read_header(&header_type, 0, 0, 0, true);
|
||
|
||
if (header_type == E_WRONG_HEADER_TYPE)
|
||
{
|
||
kBUG("pci_checkFunction(): wrong header type!");
|
||
// 此处内存已经在read header函数里面释放,不用重复释放
|
||
return;
|
||
}
|
||
header = ((struct pci_device_structure_general_device_t *)raw_header)->header;
|
||
|
||
if ((header->Class_code == 0x6) && (header->SubClass == 0x4))
|
||
{
|
||
uint8_t SecondaryBus = ((struct pci_device_structure_pci_to_pci_bridge_t *)raw_header)->Secondary_Bus_Number;
|
||
pci_checkBus(SecondaryBus);
|
||
}
|
||
|
||
kfree(header);
|
||
kfree(raw_header);
|
||
}
|
||
|
||
static void pci_checkDevice(uint8_t bus, uint8_t device)
|
||
{
|
||
int header_type;
|
||
void *raw_header;
|
||
struct pci_device_structure_header_t *header;
|
||
raw_header = pci_read_header(&header_type, bus, device, 0, false);
|
||
if (header_type == E_WRONG_HEADER_TYPE)
|
||
{
|
||
// 此处内存已经在read header函数里面释放,不用重复释放
|
||
kBUG("pci_checkDevice(): wrong header type!");
|
||
return;
|
||
}
|
||
header = ((struct pci_device_structure_general_device_t *)raw_header)->header;
|
||
uint16_t vendorID = header->Vendor_ID;
|
||
|
||
if (vendorID == 0xffff) // 设备不存在
|
||
{
|
||
kfree(header);
|
||
kfree(raw_header);
|
||
return;
|
||
}
|
||
pci_checkFunction(bus, device, 0);
|
||
|
||
header_type = header->HeaderType;
|
||
if ((header_type & 0x80) != 0)
|
||
{
|
||
// 这是一个多function的设备,因此查询剩余的function
|
||
for (uint8_t func = 1; func < 8; ++func)
|
||
{
|
||
struct pci_device_structure_header_t *tmp_header;
|
||
void *tmp_raw_header;
|
||
tmp_raw_header = pci_read_header(&header_type, bus, device, func, false);
|
||
tmp_header = ((struct pci_device_structure_general_device_t *)tmp_raw_header)->header;
|
||
|
||
pci_checkFunction(bus, device, func);
|
||
|
||
// 释放内存
|
||
kfree(tmp_header);
|
||
kfree(tmp_raw_header);
|
||
}
|
||
}
|
||
|
||
kfree(header);
|
||
kfree(raw_header);
|
||
}
|
||
|
||
static void pci_checkBus(uint8_t bus)
|
||
{
|
||
for (uint8_t device = 0; device < 32; ++device)
|
||
pci_checkDevice(bus, device);
|
||
}
|
||
|
||
/**
|
||
* @brief 扫描所有pci总线上的所有设备
|
||
*
|
||
*/
|
||
void pci_checkAllBuses()
|
||
{
|
||
int header_type;
|
||
void *raw_header;
|
||
struct pci_device_structure_header_t *header;
|
||
raw_header = pci_read_header(&header_type, 0, 0, 0, false);
|
||
|
||
if (header_type == E_WRONG_HEADER_TYPE)
|
||
{
|
||
kBUG("pci_checkAllBuses(): wrong header type!");
|
||
// 此处内存已经在read header函数里面释放,不用重复释放
|
||
return;
|
||
}
|
||
header = ((struct pci_device_structure_general_device_t *)raw_header)->header;
|
||
|
||
header_type = header->HeaderType;
|
||
|
||
if ((header_type & 0x80) == 0) // Single pci host controller
|
||
{
|
||
pci_checkBus(0);
|
||
}
|
||
else
|
||
{
|
||
// Multiple PCI host controller
|
||
// 那么总线0,设备0,功能1则是总线1的pci主机控制器,以此类推
|
||
void *tmp_raw_header;
|
||
struct pci_device_structure_header_t *tmp_header;
|
||
for (uint8_t func = 0; func < 8; ++func)
|
||
{
|
||
tmp_raw_header = pci_read_header(&header_type, 0, 0, func, false);
|
||
tmp_header = ((struct pci_device_structure_general_device_t *)tmp_raw_header)->header;
|
||
if (header->Vendor_ID != 0xffff) // @todo 这里的判断条件可能有点问题
|
||
{
|
||
kfree(tmp_header);
|
||
kfree(tmp_raw_header);
|
||
break;
|
||
}
|
||
|
||
pci_checkBus(func);
|
||
|
||
kfree(tmp_header);
|
||
kfree(tmp_raw_header);
|
||
}
|
||
}
|
||
kfree(header);
|
||
kfree(raw_header);
|
||
}
|
||
|
||
void pci_init()
|
||
{
|
||
} |