diff options
-rw-r--r-- | Kernel/PCI/Access.cpp | 44 | ||||
-rw-r--r-- | Kernel/PCI/IOAccess.cpp | 29 | ||||
-rw-r--r-- | Kernel/PCI/MMIOAccess.cpp | 26 |
3 files changed, 90 insertions, 9 deletions
diff --git a/Kernel/PCI/Access.cpp b/Kernel/PCI/Access.cpp index cb1fb7e18d..402f3f4d90 100644 --- a/Kernel/PCI/Access.cpp +++ b/Kernel/PCI/Access.cpp @@ -28,6 +28,8 @@ #include <Kernel/PCI/Access.h> #include <Kernel/PCI/IOAccess.h> +//#define PCI_DEBUG + namespace Kernel { namespace PCI { @@ -73,29 +75,44 @@ PhysicalID Access::get_physical_id(Address address) const u8 Access::early_read8_field(Address address, u32 field) { +#ifdef PCI_DEBUG + dbg() << "PCI: Early reading 8-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; +#endif IO::out32(PCI_ADDRESS_PORT, address.io_address_for_field(field)); return IO::in8(PCI_VALUE_PORT + (field & 3)); } u16 Access::early_read16_field(Address address, u32 field) { +#ifdef PCI_DEBUG + dbg() << "PCI: Early reading 16-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; +#endif IO::out32(PCI_ADDRESS_PORT, address.io_address_for_field(field)); return IO::in16(PCI_VALUE_PORT + (field & 2)); } u32 Access::early_read32_field(Address address, u32 field) { +#ifdef PCI_DEBUG + dbg() << "PCI: Early reading 32-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; +#endif IO::out32(PCI_ADDRESS_PORT, address.io_address_for_field(field)); return IO::in32(PCI_VALUE_PORT); } u16 Access::early_read_type(Address address) { +#ifdef PCI_DEBUG + dbg() << "PCI: Early reading type for " << address; +#endif return (early_read8_field(address, PCI_CLASS) << 8u) | early_read8_field(address, PCI_SUBCLASS); } void Access::enumerate_functions(int type, u8 bus, u8 slot, u8 function, Function<void(Address, ID)>& callback) { +#ifdef PCI_DEBUG + dbg() << "PCI: Enumerating function type=" << type << ", bus=" << bus << ", slot=" << slot << ", function=" << function; +#endif Address address(0, bus, slot, function); if (type == -1 || type == early_read_type(address)) callback(address, { early_read16_field(address, PCI_VENDOR_ID), early_read16_field(address, PCI_DEVICE_ID) }); @@ -111,6 +128,9 @@ void Access::enumerate_functions(int type, u8 bus, u8 slot, u8 function, Functio void Access::enumerate_slot(int type, u8 bus, u8 slot, Function<void(Address, ID)>& callback) { +#ifdef PCI_DEBUG + dbg() << "PCI: Enumerating slot type=" << type << ", bus=" << bus << ", slot=" << slot; +#endif Address address(0, bus, slot, 0); if (early_read16_field(address, PCI_VENDOR_ID) == PCI_NONE) return; @@ -126,6 +146,9 @@ void Access::enumerate_slot(int type, u8 bus, u8 slot, Function<void(Address, ID void Access::enumerate_bus(int type, u8 bus, Function<void(Address, ID)>& callback) { +#ifdef PCI_DEBUG + dbg() << "PCI: Enumerating bus type=" << type << ", bus=" << bus; +#endif for (u8 slot = 0; slot < 32; ++slot) enumerate_slot(type, bus, slot, callback); } @@ -144,9 +167,18 @@ void enumerate(Function<void(Address, ID)> callback) Optional<u8> get_capabilities_pointer(Address address) { +#ifdef PCI_DEBUG + dbg() << "PCI: Getting capabilities pointer for " << address; +#endif if (PCI::read16(address, PCI_STATUS) & (1 << 4)) { +#ifdef PCI_DEBUG + dbg() << "PCI: Found capabilities pointer for " << address; +#endif return PCI::read8(address, PCI_CAPABILITIES_POINTER); } +#ifdef PCI_DEBUG + dbg() << "PCI: No capabilities pointer for " << address; +#endif return {}; } @@ -157,12 +189,22 @@ PhysicalID get_physical_id(Address address) Vector<Capability> get_capabilities(Address address) { +#ifdef PCI_DEBUG + dbg() << "PCI: Getting capabilities for " << address; +#endif auto capabilities_pointer = PCI::get_capabilities_pointer(address); - if (!capabilities_pointer.has_value()) + if (!capabilities_pointer.has_value()) { +#ifdef PCI_DEBUG + dbg() << "PCI: No capabilities for " << address; +#endif return {}; + } Vector<Capability> capabilities; auto capability_pointer = capabilities_pointer.value(); while (capability_pointer != 0) { +#ifdef PCI_DEBUG + dbg() << "PCI: Reading in capability at 0x" << String::formatted("{:02x}", capability_pointer) << " for " << address; +#endif u16 capability_header = PCI::read16(address, capability_pointer); u8 capability_id = capability_header & 0xff; capability_pointer = capability_header >> 8; diff --git a/Kernel/PCI/IOAccess.cpp b/Kernel/PCI/IOAccess.cpp index 3be5f5e5ee..9bb33ebf0c 100644 --- a/Kernel/PCI/IOAccess.cpp +++ b/Kernel/PCI/IOAccess.cpp @@ -27,13 +27,19 @@ #include <Kernel/IO.h> #include <Kernel/PCI/IOAccess.h> +//#define PCI_DEBUG + namespace Kernel { namespace PCI { void IOAccess::initialize() { - if (!Access::is_initialized()) + if (!Access::is_initialized()) { new IOAccess(); +#ifdef PCI_DEBUG + dbg() << "PCI: IO access initialised."; +#endif + } } IOAccess::IOAccess() @@ -46,37 +52,58 @@ IOAccess::IOAccess() u8 IOAccess::read8_field(Address address, u32 field) { +#ifdef PCI_DEBUG + dbg() << "PCI: IO Reading 8-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; +#endif return Access::early_read8_field(address, field); } u16 IOAccess::read16_field(Address address, u32 field) { +#ifdef PCI_DEBUG + dbg() << "PCI: IO Reading 16-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; +#endif return Access::early_read16_field(address, field); } u32 IOAccess::read32_field(Address address, u32 field) { +#ifdef PCI_DEBUG + dbg() << "PCI: IO Reading 32-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; +#endif return Access::early_read32_field(address, field); } void IOAccess::write8_field(Address address, u32 field, u8 value) { +#ifdef PCI_DEBUG + dbg() << "PCI: IO Writing to 8-bit field 0x" << String::formatted("{:08x}", field) << ", value=0x" << String::formatted("{:02x}", value) << " for " << address; +#endif IO::out32(PCI_ADDRESS_PORT, address.io_address_for_field(field)); IO::out8(PCI_VALUE_PORT + (field & 3), value); } void IOAccess::write16_field(Address address, u32 field, u16 value) { +#ifdef PCI_DEBUG + dbg() << "PCI: IO Writing to 16-bit field 0x" << String::formatted("{:08x}", field) << ", value=0x" << String::formatted("{:04x}", value) << " for " << address; +#endif IO::out32(PCI_ADDRESS_PORT, address.io_address_for_field(field)); IO::out16(PCI_VALUE_PORT + (field & 2), value); } void IOAccess::write32_field(Address address, u32 field, u32 value) { +#ifdef PCI_DEBUG + dbg() << "PCI: IO Writing to 32-bit field 0x" << String::formatted("{:08x}", field) << ", value=0x" << String::formatted("{:08x}", value) << " for " << address; +#endif IO::out32(PCI_ADDRESS_PORT, address.io_address_for_field(field)); IO::out32(PCI_VALUE_PORT, value); } void IOAccess::enumerate_hardware(Function<void(Address, ID)> callback) { +#ifdef PCI_DEBUG + dbg() << "PCI: IO enumerating hardware"; +#endif // Single PCI host controller. if ((read8_field(Address(), PCI_HEADER_TYPE) & 0x80) == 0) { enumerate_bus(-1, 0, callback); diff --git a/Kernel/PCI/MMIOAccess.cpp b/Kernel/PCI/MMIOAccess.cpp index fbb692eb00..793aa20ba2 100644 --- a/Kernel/PCI/MMIOAccess.cpp +++ b/Kernel/PCI/MMIOAccess.cpp @@ -29,6 +29,8 @@ #include <Kernel/PCI/MMIOAccess.h> #include <Kernel/VM/MemoryManager.h> +//#define PCI_DEBUG + namespace Kernel { namespace PCI { @@ -80,8 +82,12 @@ uint8_t MMIOAccess::segment_end_bus(u32 seg) const void MMIOAccess::initialize(PhysicalAddress mcfg) { - if (!Access::is_initialized()) + if (!Access::is_initialized()) { new MMIOAccess(mcfg); +#ifdef PCI_DEBUG + dbg() << "PCI: MMIO access initialised."; +#endif + } } MMIOAccess::MMIOAccess(PhysicalAddress p_mcfg) @@ -133,6 +139,9 @@ MMIOAccess::MMIOAccess(PhysicalAddress p_mcfg) Optional<VirtualAddress> MMIOAccess::get_device_configuration_space(Address address) { +#ifdef PCI_DEBUG + dbg() << "PCI: Getting device configuration space for " << address; +#endif for (auto& mapping : m_mapped_device_regions) { auto checked_address = mapping.address(); #ifdef PCI_DEBUG @@ -148,6 +157,9 @@ Optional<VirtualAddress> MMIOAccess::get_device_configuration_space(Address addr return mapping.vaddr(); } } +#ifdef PCI_DEBUG + dbg() << "PCI: No device configuration space found for " << address; +#endif return {}; } @@ -156,7 +168,7 @@ u8 MMIOAccess::read8_field(Address address, u32 field) InterruptDisabler disabler; ASSERT(field <= 0xfff); #ifdef PCI_DEBUG - dbg() << "PCI: Reading field " << field << ", Address(" << String::format("%w", address.seg()) << ":" << String::format("%b", address.bus()) << ":" << String::format("%b", address.slot()) << "." << String::format("%b", address.function()) << ")"; + dbg() << "PCI: MMIO Reading 8-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; #endif return *((u8*)(get_device_configuration_space(address).value().get() + (field & 0xfff))); } @@ -166,7 +178,7 @@ u16 MMIOAccess::read16_field(Address address, u32 field) InterruptDisabler disabler; ASSERT(field < 0xfff); #ifdef PCI_DEBUG - dbg() << "PCI: Reading field " << field << ", Address(" << String::format("%w", address.seg()) << ":" << String::format("%b", address.bus()) << ":" << String::format("%b", address.slot()) << "." << String::format("%b", address.function()) << ")"; + dbg() << "PCI: MMIO Reading 16-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; #endif return *((u16*)(get_device_configuration_space(address).value().get() + (field & 0xfff))); } @@ -176,7 +188,7 @@ u32 MMIOAccess::read32_field(Address address, u32 field) InterruptDisabler disabler; ASSERT(field <= 0xffc); #ifdef PCI_DEBUG - dbg() << "PCI: Reading field " << field << ", Address(" << String::format("%w", address.seg()) << ":" << String::format("%b", address.bus()) << ":" << String::format("%b", address.slot()) << "." << String::format("%b", address.function()) << ")"; + dbg() << "PCI: MMIO Reading 32-bit field 0x" << String::formatted("{:08x}", field) << " for " << address; #endif return *((u32*)(get_device_configuration_space(address).value().get() + (field & 0xfff))); } @@ -186,7 +198,7 @@ void MMIOAccess::write8_field(Address address, u32 field, u8 value) InterruptDisabler disabler; ASSERT(field <= 0xfff); #ifdef PCI_DEBUG - dbg() << "PCI: Writing to field " << field << ", Address(" << String::format("%w", address.seg()) << ":" << String::format("%b", address.bus()) << ":" << String::format("%b", address.slot()) << "." << String::format("%b", address.function()) << ") value 0x" << String::format("%x", value); + dbg() << "PCI: MMIO Writing to 8-bit field 0x" << String::formatted("{:08x}", field) << ", value=0x" << String::formatted("{:02x}", value) << " for " << address; #endif *((u8*)(get_device_configuration_space(address).value().get() + (field & 0xfff))) = value; } @@ -195,7 +207,7 @@ void MMIOAccess::write16_field(Address address, u32 field, u16 value) InterruptDisabler disabler; ASSERT(field < 0xfff); #ifdef PCI_DEBUG - dbg() << "PCI: Writing to field " << field << ", Address(" << String::format("%w", address.seg()) << ":" << String::format("%b", address.bus()) << ":" << String::format("%b", address.slot()) << "." << String::format("%b", address.function()) << ") value 0x" << String::format("%x", value); + dbg() << "PCI: MMIO Writing to 16-bit field 0x" << String::formatted("{:08x}", field) << ", value=0x" << String::formatted("{:04x}", value) << " for " << address; #endif *((u16*)(get_device_configuration_space(address).value().get() + (field & 0xfff))) = value; } @@ -204,7 +216,7 @@ void MMIOAccess::write32_field(Address address, u32 field, u32 value) InterruptDisabler disabler; ASSERT(field <= 0xffc); #ifdef PCI_DEBUG - dbg() << "PCI: Writing to field " << field << ", Address(" << String::format("%w", address.seg()) << ":" << String::format("%b", address.bus()) << ":" << String::format("%b", address.slot()) << "." << String::format("%b", address.function()) << ") value 0x" << String::format("%x", value); + dbg() << "PCI: MMIO Writing to 32-bit field 0x" << String::formatted("{:08x}", field) << ", value=0x" << String::formatted("{:08x}", value) << " for " << address; #endif *((u32*)(get_device_configuration_space(address).value().get() + (field & 0xfff))) = value; } |