Support PCI configuration space mechanism #2 if necessary.

1 files changed, 48 insertions, 0 deletions

diff --git a/com32/lib/pci/readx.c b/com32/lib/pci/readx.c
new file mode 100644
index 00000000..f1e542d7
--- /dev/null
+++ b/com32/lib/pci/readx.c
@@ -0,0 +1,48 @@
+#include "pci/pci.h"
+
+TYPE BWL(pci_read) (pciaddr_t a)
+{
+  TYPE r;
+
+  for (;;) {
+    switch ( __pci_cfg_type ) {
+    case PCI_CFG_AUTO:
+      pci_set_config_type(PCI_CFG_AUTO);
+      break;			/* Try again */
+      
+    case PCI_CFG_TYPE1:
+      {
+	uint32_t oldcf8;
+	cli();
+	oldcf8 = inl(0xcf8);
+	outl(a, 0xcf8);
+	r = BWL(in) (0xcfc + (a & 3));
+	outl(oldcf8, 0xcf8);
+	sti();
+      }
+      return r;
+      
+    case PCI_CFG_TYPE2:
+      {
+	uint8_t oldcf8, oldcfa;
+	
+	if ( a & (0x10 << 11) )
+	  return (TYPE)~0;
+	
+	cli();
+	oldcf8 = inb(0xcf8);
+	oldcfa = inb(0xcfa);
+	outb(0xf0 + ((a >> (8-1)) & 0x0e), 0xcf8);
+	outb(a >> 16, 0xcfa);
+	r = BWL(in) (0xc000 + ((a >> (11-8)) & 0xf00) + (a & 0xff));
+	outb(oldcf8, 0xcf8);
+	outb(oldcfa, 0xcfa);
+	sti();
+      }
+      return r;
+      
+    default:
+      return (TYPE)~0;
+    }
+  }
+}