ableos/sysdata/libraries/pci/src/lib.hb

92 lines
1.8 KiB
Plaintext
Raw Normal View History

2024-09-19 14:40:10 -05:00
.{string, memory, buffer, log} := @use("../../stn/src/lib.hb")
2024-09-16 20:45:00 -05:00
2024-09-14 03:51:57 -05:00
PCIAddress := struct {
bus: u8,
device: u8,
function: u8,
}
2024-09-17 12:08:19 -05:00
PCI_ID := struct {
vendor: u16,
device: u16,
}
get_ids := fn(bus: u8, device: u8, function: u8): PCI_ID {
res := config_read32(bus, device, function, 0)
dev_id := res >> 16
dev_id &= 0xFFFF
vnd_id := res & 0xFFFF
return PCI_ID.(dev_id, vnd_id)
}
PciDeviceInfo := struct {
2024-09-17 17:23:32 -05:00
header_type: u8,
device: u8,
bus: u8,
device_id: PCI_ID,
class: u16,
rev_id: u8,
2024-09-17 12:08:19 -05:00
}
calculate_address := fn(bus: u8, device: u8, function: u8, offset: u8): int {
address := bus << 16
address |= device << 11
address |= function << 8
address |= offset & 0xFC
address |= 0x80000000
return address
}
2024-09-17 17:23:32 -05:00
get_header_type := fn(bus: u8, device: u8, function: u8): u8 {
res := config_read32(bus, device, function, 0xC)
ret := res >> 16
ret &= 0xFF
return ret
}
2024-09-17 12:08:19 -05:00
check_device := fn(bus: u8, device: u8): PciDeviceInfo {
pci_id := get_ids(bus, device, 0)
if pci_id.vendor == 0xFFFF {
2024-09-19 14:40:10 -05:00
log.warn(":|\0")
2024-09-17 12:08:19 -05:00
} else {
2024-09-19 14:40:10 -05:00
log.info(":)\0")
2024-09-17 12:08:19 -05:00
}
address := calculate_address(bus, device, 0, 0x8)
reg2 := config_read32(bus, device, 0, 0x8)
2024-09-17 17:23:32 -05:00
2024-09-17 12:08:19 -05:00
class := reg2 >> 16 & 0xFFFF
2024-09-17 17:23:32 -05:00
header_type := get_header_type(bus, device, 0)
2024-09-17 12:08:19 -05:00
2024-09-17 17:23:32 -05:00
rev_id := reg2 & 0xFF
return PciDeviceInfo.(header_type, device, bus, pci_id, class, rev_id)
2024-09-17 12:08:19 -05:00
}
find_device := fn(vendor_id: int, device_id: int, pci_address: PCIAddress): PCI_ID {
pci_id := get_ids(0, 2, 0)
return pci_id
2024-09-14 03:51:57 -05:00
}
scan_bus := fn(): void {
}
config_read32 := fn(bus: u32, device: u32, func: u32, offset: u32): u32 {
// construct address param
2024-09-16 20:45:00 -05:00
offset_and := offset & 0xFC
address := bus << 16
address |= device << 11
address |= func << 8
address |= offset_and
2024-09-14 04:28:45 -05:00
address |= 0x80000000
2024-09-14 03:51:57 -05:00
// write address
2024-09-16 20:45:00 -05:00
memory.outl(0xCF8, address)
2024-09-14 03:51:57 -05:00
// read data
2024-09-16 20:45:00 -05:00
return memory.inl(0xCFC)
2024-09-14 03:51:57 -05:00
}