Add v0.7 source

2013-04-21 14:54:35 +01:00 · 2013-04-21 14:54:35 +01:00 · 3c253c2cf8
commit 3c253c2cf8
188 changed files with 52566 additions and 0 deletions
--- a/src/pci.c
+++ b/src/pci.c
@ -0,0 +1,99 @@
+#include "ibm.h"
+#include "io.h"
+#include "mem.h"
+
+#include "pci.h"
+
+void    (*pci_card_write[32])(int func, int addr, uint8_t val);
+uint8_t  (*pci_card_read[32])(int func, int addr);
+static int pci_index, pci_func, pci_card, pci_bus, pci_enable;
+static uint8_t card_16[256];
+static uint8_t card_18[256];
+
+void pci_write(uint16_t port, uint8_t val)
+{
+        switch (port)
+        {
+                case 0xcf8:
+                pci_index = val;
+                break;
+                case 0xcf9:
+                pci_func = val & 7;
+                pci_card = val >> 3;
+                break;
+                case 0xcfa:
+                pci_bus = val;
+                break;
+                case 0xcfb:
+                pci_enable = val & 0x80;
+                break;
+                
+                case 0xcfc: case 0xcfd: case 0xcfe: case 0xcff:
+                if (!pci_enable) 
+                   return;
+                   
+                pclog("PCI write bus %i card %i index %02X val %02X  %04X:%04X\n", pci_bus, pci_card, pci_index | (port & 3), val, CS, pc);
+                
+                if (!pci_bus && pci_card_write[pci_card])
+                   pci_card_write[pci_card](pci_func, pci_index | (port & 3), val);
+                
+                break;
+        }
+}
+
+uint8_t pci_read(uint16_t port)
+{
+        switch (port)
+        {
+                case 0xcf8:
+                return pci_index;
+                case 0xcf9:
+                return pci_card << 3;
+                case 0xcfa:
+                return pci_bus;
+                case 0xcfb:
+                return pci_enable;
+                
+                case 0xcfc: case 0xcfd: case 0xcfe: case 0xcff:
+                if (!pci_enable) 
+                   return 0xff;
+
+                pclog("PCI read  bus %i card %i index %02X\n", pci_bus, pci_card, pci_index | (port & 3));
+
+                if (!pci_bus && pci_card_read[pci_card])
+                   return pci_card_read[pci_card](pci_func, pci_index | (port & 3));
+
+                return 0xff;
+        }
+}
+                
+void pci_init()
+{
+        int c;
+
+        io_sethandler(0x0cf8, 0x0008, pci_read, NULL, NULL, pci_write, NULL, NULL);
+        
+        for (c = 0; c < 32; c++)
+            pci_card_read[c] = pci_card_write[c] = NULL;
+}
+
+void pci_add_specific(int card, uint8_t (*read)(int func, int addr), void (*write)(int func, int addr, uint8_t val))
+{
+         pci_card_read[card] = read;
+        pci_card_write[card] = write;
+}
+
+void pci_add(uint8_t (*read)(int func, int addr), void (*write)(int func, int addr, uint8_t val))
+{
+        int c;
+        
+        for (c = 0; c < 32; c++)
+        {
+                if (!pci_card_read[c] && !pci_card_write[c])
+                {
+                         pci_card_read[c] = read;
+                        pci_card_write[c] = write;
+                        return;
+                }
+        }
+}