sparc64: implement basic IOMMU/interrupt handling

Also add reset control.

Signed-off-by: Blue Swirl <blauwirbel@gmail.com>

hw/apb_pci.c

@@ -50,23 +50,74 @@ do { printf("APB: " fmt , ## __VA_ARGS__); } while (0)
  * http://www.sun.com/processors/manuals/805-1251.pdf
  */
 
+#define PBM_PCI_IMR_MASK    0x7fffffff
+#define PBM_PCI_IMR_ENABLED 0x80000000
+
+#define POR          (1 << 31)
+#define SOFT_POR     (1 << 30)
+#define SOFT_XIR     (1 << 29)
+#define BTN_POR      (1 << 28)
+#define BTN_XIR      (1 << 27)
+#define RESET_MASK   0xf8000000
+#define RESET_WCMASK 0x98000000
+#define RESET_WMASK  0x60000000
+
 typedef struct APBState {
     SysBusDevice busdev;
     PCIHostState host_state;
+    uint32_t iommu[4];
+    uint32_t pci_control[16];
+    uint32_t pci_irq_map[8];
+    uint32_t obio_irq_map[32];
+    qemu_irq pci_irqs[32];
+    uint32_t reset_control;
 } APBState;
 
+static unsigned int nr_resets;
+
 static void apb_config_writel (void *opaque, target_phys_addr_t addr,
                                uint32_t val)
 {
-    //PCIBus *s = opaque;
+    APBState *s = opaque;
 
-    switch (addr & 0x3f) {
+    APB_DPRINTF("%s: addr " TARGET_FMT_lx " val %x\n", __func__, addr, val);
-    case 0x00: // Control/Status
+
-    case 0x10: // AFSR
+    switch (addr & 0xffff) {
-    case 0x18: // AFAR
+    case 0x30 ... 0x4f: /* DMA error registers */
-    case 0x20: // Diagnostic
+        /* XXX: not implemented yet */
-    case 0x28: // Target address space
+        break;
-        // XXX
+    case 0x200 ... 0x20b: /* IOMMU */
+        s->iommu[(addr & 0xf) >> 2] = val;
+        break;
+    case 0x20c ... 0x3ff: /* IOMMU flush */
+        break;
+    case 0xc00 ... 0xc3f: /* PCI interrupt control */
+        if (addr & 4) {
+            s->pci_irq_map[(addr & 0x3f) >> 3] &= PBM_PCI_IMR_MASK;
+            s->pci_irq_map[(addr & 0x3f) >> 3] |= val & ~PBM_PCI_IMR_MASK;
+        }
+        break;
+    case 0x2000 ... 0x202f: /* PCI control */
+        s->pci_control[(addr & 0x3f) >> 2] = val;
+        break;
+    case 0xf020 ... 0xf027: /* Reset control */
+        if (addr & 4) {
+            val &= RESET_MASK;
+            s->reset_control &= ~(val & RESET_WCMASK);
+            s->reset_control |= val & RESET_WMASK;
+            if (val & SOFT_POR) {
+                nr_resets = 0;
+                qemu_system_reset_request();
+            } else if (val & SOFT_XIR) {
+                qemu_system_reset_request();
+            }
+        }
+        break;
+    case 0x5000 ... 0x51cf: /* PIO/DMA diagnostics */
+    case 0xa400 ... 0xa67f: /* IOMMU diagnostics */
+    case 0xa800 ... 0xa80f: /* Interrupt diagnostics */
+    case 0xf000 ... 0xf01f: /* FFB config, memory control */
+        /* we don't care */
     default:
         break;
     }
@@ -75,20 +126,48 @@ static void apb_config_writel (void *opaque, target_phys_addr_t addr,
 static uint32_t apb_config_readl (void *opaque,
                                   target_phys_addr_t addr)
 {
-    //PCIBus *s = opaque;
+    APBState *s = opaque;
     uint32_t val;
 
-    switch (addr & 0x3f) {
+    switch (addr & 0xffff) {
-    case 0x00: // Control/Status
+    case 0x30 ... 0x4f: /* DMA error registers */
-    case 0x10: // AFSR
+        val = 0;
-    case 0x18: // AFAR
+        /* XXX: not implemented yet */
-    case 0x20: // Diagnostic
+        break;
-    case 0x28: // Target address space
+    case 0x200 ... 0x20b: /* IOMMU */
-        // XXX
+        val = s->iommu[(addr & 0xf) >> 2];
+        break;
+    case 0x20c ... 0x3ff: /* IOMMU flush */
+        val = 0;
+        break;
+    case 0xc00 ... 0xc3f: /* PCI interrupt control */
+        if (addr & 4) {
+            val = s->pci_irq_map[(addr & 0x3f) >> 3];
+        } else {
+            val = 0;
+        }
+        break;
+    case 0x2000 ... 0x202f: /* PCI control */
+        val = s->pci_control[(addr & 0x3f) >> 2];
+        break;
+    case 0xf020 ... 0xf027: /* Reset control */
+        if (addr & 4) {
+            val = s->reset_control;
+        } else {
+            val = 0;
+        }
+        break;
+    case 0x5000 ... 0x51cf: /* PIO/DMA diagnostics */
+    case 0xa400 ... 0xa67f: /* IOMMU diagnostics */
+    case 0xa800 ... 0xa80f: /* Interrupt diagnostics */
+    case 0xf000 ... 0xf01f: /* FFB config, memory control */
+        /* we don't care */
     default:
         val = 0;
         break;
     }
+    APB_DPRINTF("%s: addr " TARGET_FMT_lx " -> %x\n", __func__, addr, val);
+
     return val;
 }
 
@@ -252,10 +331,18 @@ static int pci_pbm_map_irq(PCIDevice *pci_dev, int irq_num)
 
 static void pci_apb_set_irq(void *opaque, int irq_num, int level)
 {
-    qemu_irq *pic = opaque;
+    APBState *s = opaque;
 
     /* PCI IRQ map onto the first 32 INO.  */
-    qemu_set_irq(pic[irq_num], level);
+    if (irq_num < 32) {
+        if (s->pci_irq_map[irq_num >> 2] & PBM_PCI_IMR_ENABLED) {
+            APB_DPRINTF("%s: set irq %d level %d\n", __func__, irq_num, level);
+            qemu_set_irq(s->pci_irqs[irq_num], level);
+        } else {
+            APB_DPRINTF("%s: not enabled: lower irq %d\n", __func__, irq_num);
+            qemu_irq_lower(s->pci_irqs[irq_num]);
+        }
+    }
 }
 
 static void apb_pci_bridge_init(PCIBus *b)
@@ -284,6 +371,7 @@ PCIBus *pci_apb_init(target_phys_addr_t special_base,
     DeviceState *dev;
     SysBusDevice *s;
     APBState *d;
+    unsigned int i;
 
     /* Ultrasparc PBM main bus */
     dev = qdev_create(NULL, "pbm");
@@ -299,10 +387,14 @@ PCIBus *pci_apb_init(target_phys_addr_t special_base,
     sysbus_mmio_map(s, 3, mem_base);
     d = FROM_SYSBUS(APBState, s);
     d->host_state.bus = pci_register_bus(&d->busdev.qdev, "pci",
-                                         pci_apb_set_irq, pci_pbm_map_irq, pic,
+                                         pci_apb_set_irq, pci_pbm_map_irq, d,
                                          0, 32);
     pci_bus_set_mem_base(d->host_state.bus, mem_base);
 
+    for (i = 0; i < 32; i++) {
+        sysbus_connect_irq(s, i, pic[i]);
+    }
+
     pci_create_simple(d->host_state.bus, 0, "pbm");
     /* APB secondary busses */
     *bus2 = pci_bridge_init(d->host_state.bus, PCI_DEVFN(1, 0),
@@ -320,13 +412,35 @@ PCIBus *pci_apb_init(target_phys_addr_t special_base,
     return d->host_state.bus;
 }
 
+static void pci_pbm_reset(DeviceState *d)
+{
+    unsigned int i;
+    APBState *s = container_of(d, APBState, busdev.qdev);
+
+    for (i = 0; i < 8; i++) {
+        s->pci_irq_map[i] &= PBM_PCI_IMR_MASK;
+    }
+
+    if (nr_resets++ == 0) {
+        /* Power on reset */
+        s->reset_control = POR;
+    }
+}
+
 static int pci_pbm_init_device(SysBusDevice *dev)
 {
-
     APBState *s;
     int pci_mem_data, apb_config, pci_ioport, pci_config;
+    unsigned int i;
 
     s = FROM_SYSBUS(APBState, dev);
+    for (i = 0; i < 8; i++) {
+        s->pci_irq_map[i] = (0x1f << 6) | (i << 2);
+    }
+    for (i = 0; i < 32; i++) {
+        sysbus_init_irq(dev, &s->pci_irqs[i]);
+    }
+
     /* apb_config */
     apb_config = cpu_register_io_memory(apb_config_read,
                                         apb_config_write, s);
@@ -368,9 +482,15 @@ static PCIDeviceInfo pbm_pci_host_info = {
     .header_type  = PCI_HEADER_TYPE_BRIDGE,
 };
 
+static SysBusDeviceInfo pbm_host_info = {
+    .qdev.name = "pbm",
+    .qdev.size = sizeof(APBState),
+    .qdev.reset = pci_pbm_reset,
+    .init = pci_pbm_init_device,
+};
 static void pbm_register_devices(void)
 {
-    sysbus_register_dev("pbm", sizeof(APBState), pci_pbm_init_device);
+    sysbus_register_withprop(&pbm_host_info);
     pci_qdev_register(&pbm_pci_host_info);
 }