| /* |
| * Xilinx PCIe host controller emulation. |
| * |
| * Copyright (c) 2016 Imagination Technologies |
| * |
| * This library is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU Lesser General Public |
| * License as published by the Free Software Foundation; either |
| * version 2.1 of the License, or (at your option) any later version. |
| * |
| * This library is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| * Lesser General Public License for more details. |
| * |
| * You should have received a copy of the GNU Lesser General Public |
| * License along with this library; if not, see <http://www.gnu.org/licenses/>. |
| */ |
| |
| #include "qemu/osdep.h" |
| #include "qemu/module.h" |
| #include "qemu/units.h" |
| #include "qapi/error.h" |
| #include "hw/pci/pci_bridge.h" |
| #include "hw/qdev-properties.h" |
| #include "hw/irq.h" |
| #include "hw/pci-host/xilinx-pcie.h" |
| |
| enum root_cfg_reg { |
| /* Interrupt Decode Register */ |
| ROOTCFG_INTDEC = 0x138, |
| |
| /* Interrupt Mask Register */ |
| ROOTCFG_INTMASK = 0x13c, |
| /* INTx Interrupt Received */ |
| #define ROOTCFG_INTMASK_INTX (1 << 16) |
| /* MSI Interrupt Received */ |
| #define ROOTCFG_INTMASK_MSI (1 << 17) |
| |
| /* PHY Status/Control Register */ |
| ROOTCFG_PSCR = 0x144, |
| /* Link Up */ |
| #define ROOTCFG_PSCR_LINK_UP (1 << 11) |
| |
| /* Root Port Status/Control Register */ |
| ROOTCFG_RPSCR = 0x148, |
| /* Bridge Enable */ |
| #define ROOTCFG_RPSCR_BRIDGEEN (1 << 0) |
| /* Interrupt FIFO Not Empty */ |
| #define ROOTCFG_RPSCR_INTNEMPTY (1 << 18) |
| /* Interrupt FIFO Overflow */ |
| #define ROOTCFG_RPSCR_INTOVF (1 << 19) |
| |
| /* Root Port Interrupt FIFO Read Register 1 */ |
| ROOTCFG_RPIFR1 = 0x158, |
| #define ROOTCFG_RPIFR1_INT_LANE_SHIFT 27 |
| #define ROOTCFG_RPIFR1_INT_ASSERT_SHIFT 29 |
| #define ROOTCFG_RPIFR1_INT_VALID_SHIFT 31 |
| /* Root Port Interrupt FIFO Read Register 2 */ |
| ROOTCFG_RPIFR2 = 0x15c, |
| }; |
| |
| static void xilinx_pcie_update_intr(XilinxPCIEHost *s, |
| uint32_t set, uint32_t clear) |
| { |
| int level; |
| |
| s->intr |= set; |
| s->intr &= ~clear; |
| |
| if (s->intr_fifo_r != s->intr_fifo_w) { |
| s->intr |= ROOTCFG_INTMASK_INTX; |
| } |
| |
| level = !!(s->intr & s->intr_mask); |
| qemu_set_irq(s->irq, level); |
| } |
| |
| static void xilinx_pcie_queue_intr(XilinxPCIEHost *s, |
| uint32_t fifo_reg1, uint32_t fifo_reg2) |
| { |
| XilinxPCIEInt *intr; |
| unsigned int new_w; |
| |
| new_w = (s->intr_fifo_w + 1) % ARRAY_SIZE(s->intr_fifo); |
| if (new_w == s->intr_fifo_r) { |
| s->rpscr |= ROOTCFG_RPSCR_INTOVF; |
| return; |
| } |
| |
| intr = &s->intr_fifo[s->intr_fifo_w]; |
| s->intr_fifo_w = new_w; |
| |
| intr->fifo_reg1 = fifo_reg1; |
| intr->fifo_reg2 = fifo_reg2; |
| |
| xilinx_pcie_update_intr(s, ROOTCFG_INTMASK_INTX, 0); |
| } |
| |
| static void xilinx_pcie_set_irq(void *opaque, int irq_num, int level) |
| { |
| XilinxPCIEHost *s = XILINX_PCIE_HOST(opaque); |
| |
| xilinx_pcie_queue_intr(s, |
| (irq_num << ROOTCFG_RPIFR1_INT_LANE_SHIFT) | |
| (level << ROOTCFG_RPIFR1_INT_ASSERT_SHIFT) | |
| (1 << ROOTCFG_RPIFR1_INT_VALID_SHIFT), |
| 0); |
| } |
| |
| static void xilinx_pcie_host_realize(DeviceState *dev, Error **errp) |
| { |
| PCIHostState *pci = PCI_HOST_BRIDGE(dev); |
| XilinxPCIEHost *s = XILINX_PCIE_HOST(dev); |
| SysBusDevice *sbd = SYS_BUS_DEVICE(dev); |
| PCIExpressHost *pex = PCIE_HOST_BRIDGE(dev); |
| |
| snprintf(s->name, sizeof(s->name), "pcie%u", s->bus_nr); |
| |
| /* PCI configuration space */ |
| pcie_host_mmcfg_init(pex, s->cfg_size); |
| |
| /* MMIO region */ |
| memory_region_init(&s->mmio, OBJECT(s), "mmio", UINT64_MAX); |
| memory_region_set_enabled(&s->mmio, false); |
| |
| /* dummy PCI I/O region (not visible to the CPU) */ |
| memory_region_init(&s->io, OBJECT(s), "io", 16); |
| |
| /* interrupt out */ |
| qdev_init_gpio_out_named(dev, &s->irq, "interrupt_out", 1); |
| |
| sysbus_init_mmio(sbd, &pex->mmio); |
| sysbus_init_mmio(sbd, &s->mmio); |
| |
| pci->bus = pci_register_root_bus(dev, s->name, xilinx_pcie_set_irq, |
| pci_swizzle_map_irq_fn, s, &s->mmio, |
| &s->io, 0, 4, TYPE_PCIE_BUS); |
| |
| qdev_realize(DEVICE(&s->root), BUS(pci->bus), &error_fatal); |
| } |
| |
| static const char *xilinx_pcie_host_root_bus_path(PCIHostState *host_bridge, |
| PCIBus *rootbus) |
| { |
| return "0000:00"; |
| } |
| |
| static void xilinx_pcie_host_init(Object *obj) |
| { |
| XilinxPCIEHost *s = XILINX_PCIE_HOST(obj); |
| XilinxPCIERoot *root = &s->root; |
| |
| object_initialize_child(obj, "root", root, TYPE_XILINX_PCIE_ROOT); |
| qdev_prop_set_int32(DEVICE(root), "addr", PCI_DEVFN(0, 0)); |
| qdev_prop_set_bit(DEVICE(root), "multifunction", false); |
| } |
| |
| static Property xilinx_pcie_host_props[] = { |
| DEFINE_PROP_UINT32("bus_nr", XilinxPCIEHost, bus_nr, 0), |
| DEFINE_PROP_SIZE("cfg_base", XilinxPCIEHost, cfg_base, 0), |
| DEFINE_PROP_SIZE("cfg_size", XilinxPCIEHost, cfg_size, 32 * MiB), |
| DEFINE_PROP_SIZE("mmio_base", XilinxPCIEHost, mmio_base, 0), |
| DEFINE_PROP_SIZE("mmio_size", XilinxPCIEHost, mmio_size, 1 * MiB), |
| DEFINE_PROP_BOOL("link_up", XilinxPCIEHost, link_up, true), |
| DEFINE_PROP_END_OF_LIST(), |
| }; |
| |
| static void xilinx_pcie_host_class_init(ObjectClass *klass, void *data) |
| { |
| DeviceClass *dc = DEVICE_CLASS(klass); |
| PCIHostBridgeClass *hc = PCI_HOST_BRIDGE_CLASS(klass); |
| |
| hc->root_bus_path = xilinx_pcie_host_root_bus_path; |
| dc->realize = xilinx_pcie_host_realize; |
| set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories); |
| dc->fw_name = "pci"; |
| device_class_set_props(dc, xilinx_pcie_host_props); |
| } |
| |
| static const TypeInfo xilinx_pcie_host_info = { |
| .name = TYPE_XILINX_PCIE_HOST, |
| .parent = TYPE_PCIE_HOST_BRIDGE, |
| .instance_size = sizeof(XilinxPCIEHost), |
| .instance_init = xilinx_pcie_host_init, |
| .class_init = xilinx_pcie_host_class_init, |
| }; |
| |
| static uint32_t xilinx_pcie_root_config_read(PCIDevice *d, |
| uint32_t address, int len) |
| { |
| XilinxPCIEHost *s = XILINX_PCIE_HOST(OBJECT(d)->parent); |
| uint32_t val; |
| |
| switch (address) { |
| case ROOTCFG_INTDEC: |
| val = s->intr; |
| break; |
| case ROOTCFG_INTMASK: |
| val = s->intr_mask; |
| break; |
| case ROOTCFG_PSCR: |
| val = s->link_up ? ROOTCFG_PSCR_LINK_UP : 0; |
| break; |
| case ROOTCFG_RPSCR: |
| if (s->intr_fifo_r != s->intr_fifo_w) { |
| s->rpscr &= ~ROOTCFG_RPSCR_INTNEMPTY; |
| } else { |
| s->rpscr |= ROOTCFG_RPSCR_INTNEMPTY; |
| } |
| val = s->rpscr; |
| break; |
| case ROOTCFG_RPIFR1: |
| if (s->intr_fifo_w == s->intr_fifo_r) { |
| /* FIFO empty */ |
| val = 0; |
| } else { |
| val = s->intr_fifo[s->intr_fifo_r].fifo_reg1; |
| } |
| break; |
| case ROOTCFG_RPIFR2: |
| if (s->intr_fifo_w == s->intr_fifo_r) { |
| /* FIFO empty */ |
| val = 0; |
| } else { |
| val = s->intr_fifo[s->intr_fifo_r].fifo_reg2; |
| } |
| break; |
| default: |
| val = pci_default_read_config(d, address, len); |
| break; |
| } |
| return val; |
| } |
| |
| static void xilinx_pcie_root_config_write(PCIDevice *d, uint32_t address, |
| uint32_t val, int len) |
| { |
| XilinxPCIEHost *s = XILINX_PCIE_HOST(OBJECT(d)->parent); |
| switch (address) { |
| case ROOTCFG_INTDEC: |
| xilinx_pcie_update_intr(s, 0, val); |
| break; |
| case ROOTCFG_INTMASK: |
| s->intr_mask = val; |
| xilinx_pcie_update_intr(s, 0, 0); |
| break; |
| case ROOTCFG_RPSCR: |
| s->rpscr &= ~ROOTCFG_RPSCR_BRIDGEEN; |
| s->rpscr |= val & ROOTCFG_RPSCR_BRIDGEEN; |
| memory_region_set_enabled(&s->mmio, val & ROOTCFG_RPSCR_BRIDGEEN); |
| |
| if (val & ROOTCFG_INTMASK_INTX) { |
| s->rpscr &= ~ROOTCFG_INTMASK_INTX; |
| } |
| break; |
| case ROOTCFG_RPIFR1: |
| case ROOTCFG_RPIFR2: |
| if (s->intr_fifo_w == s->intr_fifo_r) { |
| /* FIFO empty */ |
| return; |
| } else { |
| s->intr_fifo_r = (s->intr_fifo_r + 1) % ARRAY_SIZE(s->intr_fifo); |
| } |
| break; |
| default: |
| pci_default_write_config(d, address, val, len); |
| break; |
| } |
| } |
| |
| static void xilinx_pcie_root_realize(PCIDevice *pci_dev, Error **errp) |
| { |
| BusState *bus = qdev_get_parent_bus(DEVICE(pci_dev)); |
| XilinxPCIEHost *s = XILINX_PCIE_HOST(bus->parent); |
| |
| pci_set_word(pci_dev->config + PCI_COMMAND, |
| PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER); |
| pci_set_word(pci_dev->config + PCI_MEMORY_BASE, s->mmio_base >> 16); |
| pci_set_word(pci_dev->config + PCI_MEMORY_LIMIT, |
| ((s->mmio_base + s->mmio_size - 1) >> 16) & 0xfff0); |
| |
| pci_bridge_initfn(pci_dev, TYPE_PCI_BUS); |
| |
| if (pcie_endpoint_cap_v1_init(pci_dev, 0x80) < 0) { |
| error_setg(errp, "Failed to initialize PCIe capability"); |
| } |
| } |
| |
| static void xilinx_pcie_root_class_init(ObjectClass *klass, void *data) |
| { |
| PCIDeviceClass *k = PCI_DEVICE_CLASS(klass); |
| DeviceClass *dc = DEVICE_CLASS(klass); |
| |
| set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories); |
| dc->desc = "Xilinx AXI-PCIe Host Bridge"; |
| k->vendor_id = PCI_VENDOR_ID_XILINX; |
| k->device_id = 0x7021; |
| k->revision = 0; |
| k->class_id = PCI_CLASS_BRIDGE_HOST; |
| k->realize = xilinx_pcie_root_realize; |
| k->exit = pci_bridge_exitfn; |
| device_class_set_legacy_reset(dc, pci_bridge_reset); |
| k->config_read = xilinx_pcie_root_config_read; |
| k->config_write = xilinx_pcie_root_config_write; |
| /* |
| * PCI-facing part of the host bridge, not usable without the |
| * host-facing part, which can't be device_add'ed, yet. |
| */ |
| dc->user_creatable = false; |
| } |
| |
| static const TypeInfo xilinx_pcie_root_info = { |
| .name = TYPE_XILINX_PCIE_ROOT, |
| .parent = TYPE_PCI_BRIDGE, |
| .instance_size = sizeof(XilinxPCIERoot), |
| .class_init = xilinx_pcie_root_class_init, |
| .interfaces = (InterfaceInfo[]) { |
| { INTERFACE_PCIE_DEVICE }, |
| { } |
| }, |
| }; |
| |
| static void xilinx_pcie_register(void) |
| { |
| type_register_static(&xilinx_pcie_root_info); |
| type_register_static(&xilinx_pcie_host_info); |
| } |
| |
| type_init(xilinx_pcie_register) |