X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/8f946ddedda18836cfc4846e8496b30772503267..035d7af7dd4727735ec57f8195a4842e31ffc997:/pci/pci-smm.c

diff --git a/pci/pci-smm.c b/pci/pci-smm.c
new file mode 100644
index 0000000..117a8b5
--- /dev/null
+++ b/pci/pci-smm.c
@@ -0,0 +1,43 @@
+#include <io.h>
+#include <inttypes.h>
+
+static void __pci_config(int bus, int slot, int fn, int addr)
+{
+	outl(0xCF8, 0x80000000ULL | (bus << 16) | (slot << 11) | (fn << 8) | addr);
+}
+
+void pci_write32(int bus, int slot, int fn, int addr, uint32_t data)
+{
+	__pci_config(bus, slot, fn, addr);
+	outl(0xCFC, data);
+}
+
+void pci_write16(int bus, int slot, int fn, int addr, uint16_t data)
+{
+	__pci_config(bus, slot, fn, addr);
+	outw(0xCFC, data);
+}
+
+void pci_write8(int bus, int slot, int fn, int addr, uint8_t data)
+{
+	__pci_config(bus, slot, fn, addr);
+	outb(0xCFC, data);
+}
+
+uint32_t pci_read32(int bus, int slot, int fn, int addr)
+{
+	__pci_config(bus, slot, fn, addr);
+	return inl(0xCFC);
+}
+
+uint16_t pci_read16(int bus, int slot, int fn, int addr)
+{
+	__pci_config(bus, slot, fn, addr);
+	return inw(0xCFC);
+}
+
+uint8_t pci_read8(int bus, int slot, int fn, int addr)
+{
+	__pci_config(bus, slot, fn, addr);
+	return inb(0xCFC);
+}