1 files changed, 40 insertions, 0 deletions
diff --git a/stage3/pci.c b/stage3/pci.c
new file mode 100644
index 0000000..164071d
--- /dev/null
+++ b/stage3/pci.c
@@ -0,0 +1,40 @@
+#include "pci.h"
+#include "def.h"
+#include "io.h"
+#include "font.h"
+
+#define PCI_CONFIG_ADDRESS 0xCF8
+#define PCI_CONFIG_DATA 0xCFC
+
+void pci_enumerate()
+{
+	typedef struct __attribute__((packed)) {
+		u8 offset;
+		unsigned int func : 3;
+		unsigned int dev : 5;
+		u8 bus;
+		unsigned int reserved : 7;
+		bool enable : 1;
+	} pci_config_addr;
+
+	for (int bus = 0; bus < 256; bus++)
+	for (int dev = 0; dev < 32; dev++) {
+		pci_config_addr addr = {
+			.offset = 0,
+			.func = 0,
+			.dev = dev,
+			.bus = bus,
+			.enable = true,
+		};
+
+		outl(PCI_CONFIG_ADDRESS, BITCAST(addr, pci_config_addr, u32));
+		u32 x = inl(PCI_CONFIG_DATA);
+		if (x != 0xFFFFFFFF) {
+			print("bus: "); print_num(bus, 16, 2);
+			print(" dev: "); print_num(dev, 16, 1);
+			print(" vendor: "); print_num(x & 0xFFFF, 16, 4);
+			print(" id: "); print_num((x >> 16) & 0xFFFF, 16, 4);
+			print("\n");
+		}
+	}
+}