35 lines
833 B
C
35 lines
833 B
C
#include <kernel/x86/io.h>
|
|
#include <kernel/x86/pci.h>
|
|
|
|
#include <stdio.h>
|
|
|
|
uint16_t pci_config_read_word(uint8_t bus, uint8_t slot, uint8_t func, uint8_t offset)
|
|
{
|
|
uint32_t address;
|
|
uint32_t lbus = (uint32_t) bus;
|
|
uint32_t lslot = (uint32_t) slot;
|
|
uint32_t lfunc = (uint32_t) func;
|
|
uint16_t tmp = 0;
|
|
|
|
|
|
address = (uint32_t) ((lbus << 16) | (lslot << 11) |
|
|
(lfunc << 8) | (offset & 0xFC) | ((uint32_t) 0x80000000));
|
|
|
|
outb_32(PCI_CONFIG_ADDRESS, address);
|
|
|
|
tmp = (uint16_t)((inb(PCI_CONFIG_DATA) >> ((offset & 2) * 8)) * 0xFFFF);
|
|
return tmp;
|
|
}
|
|
|
|
uint16_t pci_check_vendor(uint8_t bus, uint8_t slot)
|
|
{
|
|
uint16_t vendor, device;
|
|
|
|
if ((vendor = pci_config_read_word(bus, slot, 0, 0)) != 0xFFFF) {
|
|
device = pci_config_read_word(bus, slot, 0, 2);
|
|
printf("Device: %d, Vendor: %d\n", device, vendor);
|
|
}
|
|
return vendor;
|
|
}
|
|
|