/* * Copyright (c) 2014 Roger Pau Monné * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. */ #include __FBSDID("$FreeBSD$"); #include #include #include #include #include #include #include #include #include #include #include #include #include "pcib_if.h" #include "pci_if.h" static int xen_pci_probe(device_t dev); static void xen_pci_enable_msi_method(device_t dev, device_t child, uint64_t address, uint16_t data); static void xen_pci_disable_msi_method(device_t dev, device_t child); static void xen_pci_child_added_method(device_t dev, device_t child); static device_method_t xen_pci_methods[] = { /* Device interface */ DEVMETHOD(device_probe, xen_pci_probe), /* PCI interface overwrites */ DEVMETHOD(pci_enable_msi, xen_pci_enable_msi_method), DEVMETHOD(pci_disable_msi, xen_pci_disable_msi_method), DEVMETHOD(pci_child_added, xen_pci_child_added_method), DEVMETHOD_END }; static devclass_t pci_devclass; DECLARE_CLASS(acpi_pci_driver); DEFINE_CLASS_1(pci, xen_pci_driver, xen_pci_methods, sizeof(struct pci_softc), acpi_pci_driver); DRIVER_MODULE(xen_pci, pcib, xen_pci_driver, pci_devclass, 0, 0); MODULE_DEPEND(xen_pci, pci, 1, 1, 1); MODULE_DEPEND(xen_pci, acpi, 1, 1, 1); MODULE_VERSION(xen_pci, 1); static int xen_pci_probe(device_t dev) { device_set_desc(dev, "Xen PCI bus"); if (!xen_pv_domain()) return (ENXIO); return (BUS_PROBE_SPECIFIC); } static void xen_pci_enable_msi_method(device_t dev, device_t child, uint64_t address, uint16_t data) { struct pci_devinfo *dinfo = device_get_ivars(child); struct pcicfg_msi *msi = &dinfo->cfg.msi; /* Enable MSI in the control register. */ msi->msi_ctrl |= PCIM_MSICTRL_MSI_ENABLE; pci_write_config(child, msi->msi_location + PCIR_MSI_CTRL, msi->msi_ctrl, 2); } static void xen_pci_disable_msi_method(device_t dev, device_t child) { struct pci_devinfo *dinfo = device_get_ivars(child); struct pcicfg_msi *msi = &dinfo->cfg.msi; msi->msi_ctrl &= ~PCIM_MSICTRL_MSI_ENABLE; pci_write_config(child, msi->msi_location + PCIR_MSI_CTRL, msi->msi_ctrl, 2); } static void xen_pci_child_added_method(device_t dev, device_t child) { struct pci_devinfo *dinfo; struct physdev_pci_device_add add_pci; int error; dinfo = device_get_ivars(child); KASSERT((dinfo != NULL), ("xen_pci_add_child_method called with NULL dinfo")); bzero(&add_pci, sizeof(add_pci)); add_pci.seg = dinfo->cfg.domain; add_pci.bus = dinfo->cfg.bus; add_pci.devfn = (dinfo->cfg.slot << 3) | dinfo->cfg.func; error = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_add, &add_pci); if (error) panic("unable to add device bus %u devfn %u error: %d\n", add_pci.bus, add_pci.devfn, error); }