2021-11-02 20:03:11 +00:00
|
|
|
#include "pci.h"
|
2021-11-28 15:46:16 +00:00
|
|
|
|
2021-11-25 21:05:16 +00:00
|
|
|
#define PCI_BUS_ADDR_SHIFT 16
|
|
|
|
#define PCI_DEVICE_ADDR_SHIFT 11
|
|
|
|
#define PCI_FUNCTION_ADDR_SHIFT 8
|
|
|
|
#define PCI_ENABLE_ADDR_SHIFT 31
|
2021-11-02 20:03:11 +00:00
|
|
|
|
2021-11-28 15:46:16 +00:00
|
|
|
const char* GetClassCodeName (uint64_t ClassCode ) {
|
|
|
|
|
|
|
|
switch (ClassCode)
|
|
|
|
{
|
|
|
|
case 0x0 :
|
|
|
|
return "Unclassified";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x1:
|
|
|
|
return "Mass Storage Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x2:
|
|
|
|
return "Network Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x3:
|
|
|
|
return "Display Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x4:
|
|
|
|
return "Multimedia Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x5:
|
|
|
|
return "Memory Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x6:
|
|
|
|
return "Bridge";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x7 :
|
|
|
|
return "Simple Communication Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x8:
|
|
|
|
return "Base System Peripheral";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x9:
|
|
|
|
return "Input Device Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0xA:
|
|
|
|
return "Docking station";
|
|
|
|
break;
|
|
|
|
case 0xB:
|
|
|
|
return "Processor";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0xC:
|
|
|
|
return "Serial Bus Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0xD:
|
|
|
|
return "Wireless Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0xE:
|
|
|
|
return "Intelligent Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0xF:
|
|
|
|
return "Satellite Communication Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x10:
|
|
|
|
return "Encryption Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x11:
|
|
|
|
return "Signal Processing Controller";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x12:
|
|
|
|
return "Processing Accelerator";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x13:
|
|
|
|
return "Non-Essential Instrumentation";
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
return "Unknown";
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
2021-11-28 20:07:05 +00:00
|
|
|
const char* getVendor( uint32_t VendorID){
|
2021-11-28 15:46:16 +00:00
|
|
|
switch (VendorID)
|
|
|
|
{
|
2021-11-28 20:07:05 +00:00
|
|
|
case 0x8086:
|
|
|
|
return "Intel Corporation";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x10DE:
|
|
|
|
return "NVIDIA Corporation";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x1022:
|
|
|
|
return "Advanced Micro Devices, Inc.[AMD]";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x1002:
|
|
|
|
return "Advanced Micor Devices, Inc.[AMD/ATI]";
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
return "Vendor Unkown";
|
|
|
|
break;
|
2021-11-28 15:46:16 +00:00
|
|
|
}
|
2021-11-28 20:07:05 +00:00
|
|
|
|
2021-11-28 15:46:16 +00:00
|
|
|
}
|
|
|
|
|
2021-11-02 20:03:11 +00:00
|
|
|
|
|
|
|
|
2021-11-28 15:46:16 +00:00
|
|
|
uint32_t ConfigReadWord ( PCIBusAddress& PCIDeviceAddress , uint8_t offset){
|
|
|
|
outl(CONFIG_ADDRESS , PCIDeviceAddress.getAddress() | offset );
|
|
|
|
return inl(CONFIG_DATA);
|
|
|
|
}
|
|
|
|
|
2021-11-25 21:05:16 +00:00
|
|
|
uint32_t ConfigReadWord (uint8_t bus, uint8_t device, uint8_t func, uint8_t offset){
|
|
|
|
uint32_t address;
|
2021-11-02 20:03:11 +00:00
|
|
|
|
2021-11-25 21:05:16 +00:00
|
|
|
address = (uint32_t) (
|
|
|
|
((uint32_t) 1 << PCI_ENABLE_ADDR_SHIFT) |
|
|
|
|
((uint32_t)bus << PCI_BUS_ADDR_SHIFT) |
|
|
|
|
((uint32_t)device << PCI_DEVICE_ADDR_SHIFT) |
|
|
|
|
((uint32_t)func << PCI_FUNCTION_ADDR_SHIFT) |
|
|
|
|
offset );
|
2021-11-02 20:03:11 +00:00
|
|
|
|
2021-11-25 21:05:16 +00:00
|
|
|
outl(CONFIG_ADDRESS, address);
|
2021-11-02 20:03:11 +00:00
|
|
|
|
2021-11-25 21:05:16 +00:00
|
|
|
|
|
|
|
return inl(CONFIG_DATA);
|
2021-11-02 20:03:11 +00:00
|
|
|
}
|
|
|
|
|
2021-11-28 15:46:16 +00:00
|
|
|
|
|
|
|
|
|
|
|
uint8_t GetHeaderType( PCIBusAddress& PCIDeviceAddress ){
|
|
|
|
uint32_t header_information = ConfigReadWord(PCIDeviceAddress , 0xC);
|
|
|
|
return (uint8_t) (
|
2021-11-28 20:07:05 +00:00
|
|
|
((header_information >> 16) //Get higher half
|
|
|
|
& 0x00FF) // Select the last two bytes
|
|
|
|
& 0x7F ); // Mask bit 7 as it indicates if the device is a mulit function device!
|
2021-11-28 15:46:16 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
uint16_t GetClassCodes( PCIBusAddress& PCIDeviceAddress ){
|
|
|
|
uint32_t classcodes = ConfigReadWord(PCIDeviceAddress, 0x8);
|
|
|
|
return (uint16_t)((uint32_t)classcodes >> 16);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
2021-11-28 20:07:05 +00:00
|
|
|
bool IsMultiFunctionDevice(PCIBusAddress& PCIDeviceAddress){
|
|
|
|
uint32_t header_information = ConfigReadWord(PCIDeviceAddress, 0xC);
|
|
|
|
return (((header_information>>16)
|
|
|
|
& 0x80)
|
|
|
|
>> 7 );
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void PrintPCIDeviceInfo (PCIBusAddress& PCIDeviceAddress)
|
|
|
|
{
|
|
|
|
uint32_t DeviceID = (GetDevice(PCIDeviceAddress.bus, PCIDeviceAddress.device, PCIDeviceAddress.function) >> 16);
|
|
|
|
uint32_t VendorID = GetDevice(PCIDeviceAddress.bus, PCIDeviceAddress.device, PCIDeviceAddress.function) & 0xFFFF;
|
|
|
|
printf("Device found!\n");
|
|
|
|
printf("Bus: %d, Device: %d, function: %d \n", PCIDeviceAddress.bus, PCIDeviceAddress.device, PCIDeviceAddress.function);
|
|
|
|
printf("DeviceID: 0x%x, Vendor: %s\n",
|
|
|
|
DeviceID
|
|
|
|
, getVendor(VendorID) );
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t header_type = GetHeaderType(PCIDeviceAddress);
|
|
|
|
printf( "Header type: 0x%x\n", header_type);
|
|
|
|
|
|
|
|
uint16_t deviceClasses = GetClassCodes(PCIDeviceAddress);
|
|
|
|
printf("class: %s, subClass: %d\n\n", GetClassCodeName((deviceClasses >>8)), deviceClasses & 0xFF);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
2021-11-28 15:46:16 +00:00
|
|
|
void PCI_Enumerate(){
|
|
|
|
int devicesFound = 0;
|
|
|
|
// loop through all possible busses, devices and their functions;
|
|
|
|
for( int bus = 0 ; bus < 256 ; bus++)
|
|
|
|
{
|
|
|
|
|
|
|
|
for(int device = 0; device < 32 ; device ++)
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
|
|
int function = 0;
|
|
|
|
|
|
|
|
//uint64_t DeviceIdentify = ConfigReadWord(bus, device, function,0x0);
|
|
|
|
uint32_t DeviceID = GetDevice(bus, device, function) >> 16;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if( DeviceID != 0xFFFF){
|
2021-11-28 20:07:05 +00:00
|
|
|
PCIBusAddress busAddress =
|
|
|
|
PCIBusAddress{bus, device, function };
|
|
|
|
|
|
|
|
PrintPCIDeviceInfo(busAddress);
|
2021-11-28 15:46:16 +00:00
|
|
|
|
|
|
|
// iterate over the functions if it is a multi function device!
|
2021-11-28 20:07:05 +00:00
|
|
|
if( IsMultiFunctionDevice(busAddress) ){
|
|
|
|
printf("Multi function device! \n");
|
|
|
|
printf("Check remaining Functions\n");
|
|
|
|
for ( function = 1 ; function < 8; function++)
|
2021-11-28 15:46:16 +00:00
|
|
|
{
|
2021-11-28 20:07:05 +00:00
|
|
|
uint32_t DeviceID = GetDevice(bus, device, function) >> 16;
|
|
|
|
|
|
|
|
if( DeviceID != 0xFFFF){
|
|
|
|
PCIBusAddress busAddress2 = PCIBusAddress{bus, device, function};
|
|
|
|
PrintPCIDeviceInfo(busAddress2);
|
|
|
|
devicesFound++;
|
|
|
|
}
|
2021-11-28 15:46:16 +00:00
|
|
|
}
|
2021-11-28 20:07:05 +00:00
|
|
|
|
2021-11-28 15:46:16 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
devicesFound++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
printf("Found %d PCI devices!\n", devicesFound);
|
|
|
|
}
|