#include <sys/param.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/module.h>
#include <sys/stdarg.h>
#include <machine/bus.h>
#include <machine/resource.h>
#include <sys/rman.h>
#include <xen/xen-os.h>
#include <xen/features.h>
#include <xen/hypervisor.h>
#include <xen/hvm.h>
#include <xen/xen_intr.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
#include <dev/xen/xenpci/xenpcivar.h>
static int
xenpci_irq_init(device_t device, struct xenpci_softc *scp)
{
int error;
error = BUS_SETUP_INTR(device_get_parent(device), device,
scp->res_irq, INTR_MPSAFE|INTR_TYPE_MISC,
xen_intr_handle_upcall, NULL, NULL,
&scp->intr_cookie);
if (error)
return error;
#ifdef SMP
error = BUS_BIND_INTR(device_get_parent(device), device,
scp->res_irq, 0);
if (error)
return error;
#endif
xen_hvm_set_callback(device);
return (0);
}
static int
xenpci_deallocate_resources(device_t dev)
{
struct xenpci_softc *scp = device_get_softc(dev);
if (scp->res_irq != 0) {
bus_deactivate_resource(dev, SYS_RES_IRQ,
scp->rid_irq, scp->res_irq);
bus_release_resource(dev, SYS_RES_IRQ,
scp->rid_irq, scp->res_irq);
scp->res_irq = 0;
}
return (0);
}
static int
xenpci_allocate_resources(device_t dev)
{
struct xenpci_softc *scp = device_get_softc(dev);
scp->res_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
&scp->rid_irq, RF_SHAREABLE|RF_ACTIVE);
if (scp->res_irq == NULL) {
printf("xenpci Could not allocate irq.\n");
goto errexit;
}
return (0);
errexit:
xenpci_deallocate_resources(dev);
return (ENXIO);
}
static int
xenpci_probe(device_t dev)
{
uint32_t device_id = pci_get_devid(dev);
if (device_id != 0x00015853 && device_id != 0x00025853)
return (ENXIO);
device_set_desc(dev, "Xen Platform Device");
return (BUS_PROBE_DEFAULT);
}
static int
xenpci_attach(device_t dev)
{
struct xenpci_softc *scp = device_get_softc(dev);
int error;
error = xenpci_allocate_resources(dev);
if (error) {
device_printf(dev, "xenpci_allocate_resources failed(%d).\n",
error);
goto errexit;
}
error = xenpci_irq_init(dev, scp);
if (error) {
device_printf(dev, "xenpci_irq_init failed(%d).\n",
error);
goto errexit;
}
return (0);
errexit:
xenpci_deallocate_resources(dev);
return (error);
}
static int
xenpci_detach(device_t dev)
{
struct xenpci_softc *scp = device_get_softc(dev);
device_t parent = device_get_parent(dev);
if (scp->intr_cookie != NULL) {
if (BUS_TEARDOWN_INTR(parent, dev,
scp->res_irq, scp->intr_cookie) != 0)
device_printf(dev,
"intr teardown failed.. continuing\n");
scp->intr_cookie = NULL;
}
return (xenpci_deallocate_resources(dev));
}
static int
xenpci_resume(device_t dev)
{
xen_hvm_set_callback(dev);
return (0);
}
static device_method_t xenpci_methods[] = {
DEVMETHOD(device_probe, xenpci_probe),
DEVMETHOD(device_attach, xenpci_attach),
DEVMETHOD(device_detach, xenpci_detach),
DEVMETHOD(device_resume, xenpci_resume),
DEVMETHOD_END
};
static driver_t xenpci_driver = {
"xenpci",
xenpci_methods,
sizeof(struct xenpci_softc),
};
DRIVER_MODULE(xenpci, pci, xenpci_driver, 0, 0);