703f17d60f
Reviewed by: grehan (mentor) Differential Revision: https://reviews.freebsd.org/D27898
1002 lines
22 KiB
C
1002 lines
22 KiB
C
/*-
|
|
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
|
|
*
|
|
* Copyright (c) 2017, Bryan Venteicher <bryanv@FreeBSD.org>
|
|
* 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 unmodified, 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 ``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 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 <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/sbuf.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/module.h>
|
|
#include <sys/malloc.h>
|
|
|
|
#include <machine/bus.h>
|
|
#include <machine/resource.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/rman.h>
|
|
|
|
#include <dev/pci/pcivar.h>
|
|
#include <dev/pci/pcireg.h>
|
|
|
|
#include <dev/virtio/virtio.h>
|
|
#include <dev/virtio/virtqueue.h>
|
|
#include <dev/virtio/pci/virtio_pci.h>
|
|
#include <dev/virtio/pci/virtio_pci_var.h>
|
|
|
|
#include "virtio_pci_if.h"
|
|
#include "virtio_if.h"
|
|
|
|
static void vtpci_describe_features(struct vtpci_common *, const char *,
|
|
uint64_t);
|
|
static int vtpci_alloc_msix(struct vtpci_common *, int);
|
|
static int vtpci_alloc_msi(struct vtpci_common *);
|
|
static int vtpci_alloc_intr_msix_pervq(struct vtpci_common *);
|
|
static int vtpci_alloc_intr_msix_shared(struct vtpci_common *);
|
|
static int vtpci_alloc_intr_msi(struct vtpci_common *);
|
|
static int vtpci_alloc_intr_intx(struct vtpci_common *);
|
|
static int vtpci_alloc_interrupt(struct vtpci_common *, int, int,
|
|
struct vtpci_interrupt *);
|
|
static void vtpci_free_interrupt(struct vtpci_common *,
|
|
struct vtpci_interrupt *);
|
|
|
|
static void vtpci_free_interrupts(struct vtpci_common *);
|
|
static void vtpci_free_virtqueues(struct vtpci_common *);
|
|
static void vtpci_cleanup_setup_intr_attempt(struct vtpci_common *);
|
|
static int vtpci_alloc_intr_resources(struct vtpci_common *);
|
|
static int vtpci_setup_intx_interrupt(struct vtpci_common *,
|
|
enum intr_type);
|
|
static int vtpci_setup_pervq_msix_interrupts(struct vtpci_common *,
|
|
enum intr_type);
|
|
static int vtpci_set_host_msix_vectors(struct vtpci_common *);
|
|
static int vtpci_setup_msix_interrupts(struct vtpci_common *,
|
|
enum intr_type);
|
|
static int vtpci_setup_intrs(struct vtpci_common *, enum intr_type);
|
|
static int vtpci_reinit_virtqueue(struct vtpci_common *, int);
|
|
static void vtpci_intx_intr(void *);
|
|
static int vtpci_vq_shared_intr_filter(void *);
|
|
static void vtpci_vq_shared_intr(void *);
|
|
static int vtpci_vq_intr_filter(void *);
|
|
static void vtpci_vq_intr(void *);
|
|
static void vtpci_config_intr(void *);
|
|
|
|
static void vtpci_setup_sysctl(struct vtpci_common *);
|
|
|
|
#define vtpci_setup_msi_interrupt vtpci_setup_intx_interrupt
|
|
|
|
/*
|
|
* This module contains two drivers:
|
|
* - virtio_pci_legacy for pre-V1 support
|
|
* - virtio_pci_modern for V1 support
|
|
*/
|
|
MODULE_VERSION(virtio_pci, 1);
|
|
MODULE_DEPEND(virtio_pci, pci, 1, 1, 1);
|
|
MODULE_DEPEND(virtio_pci, virtio, 1, 1, 1);
|
|
|
|
int vtpci_disable_msix = 0;
|
|
TUNABLE_INT("hw.virtio.pci.disable_msix", &vtpci_disable_msix);
|
|
|
|
static uint8_t
|
|
vtpci_read_isr(struct vtpci_common *cn)
|
|
{
|
|
return (VIRTIO_PCI_READ_ISR(cn->vtpci_dev));
|
|
}
|
|
|
|
static uint16_t
|
|
vtpci_get_vq_size(struct vtpci_common *cn, int idx)
|
|
{
|
|
return (VIRTIO_PCI_GET_VQ_SIZE(cn->vtpci_dev, idx));
|
|
}
|
|
|
|
static bus_size_t
|
|
vtpci_get_vq_notify_off(struct vtpci_common *cn, int idx)
|
|
{
|
|
return (VIRTIO_PCI_GET_VQ_NOTIFY_OFF(cn->vtpci_dev, idx));
|
|
}
|
|
|
|
static void
|
|
vtpci_set_vq(struct vtpci_common *cn, struct virtqueue *vq)
|
|
{
|
|
VIRTIO_PCI_SET_VQ(cn->vtpci_dev, vq);
|
|
}
|
|
|
|
static void
|
|
vtpci_disable_vq(struct vtpci_common *cn, int idx)
|
|
{
|
|
VIRTIO_PCI_DISABLE_VQ(cn->vtpci_dev, idx);
|
|
}
|
|
|
|
static int
|
|
vtpci_register_cfg_msix(struct vtpci_common *cn, struct vtpci_interrupt *intr)
|
|
{
|
|
return (VIRTIO_PCI_REGISTER_CFG_MSIX(cn->vtpci_dev, intr));
|
|
}
|
|
|
|
static int
|
|
vtpci_register_vq_msix(struct vtpci_common *cn, int idx,
|
|
struct vtpci_interrupt *intr)
|
|
{
|
|
return (VIRTIO_PCI_REGISTER_VQ_MSIX(cn->vtpci_dev, idx, intr));
|
|
}
|
|
|
|
void
|
|
vtpci_init(struct vtpci_common *cn, device_t dev, bool modern)
|
|
{
|
|
|
|
cn->vtpci_dev = dev;
|
|
|
|
pci_enable_busmaster(dev);
|
|
|
|
if (modern)
|
|
cn->vtpci_flags |= VTPCI_FLAG_MODERN;
|
|
if (pci_find_cap(dev, PCIY_MSI, NULL) != 0)
|
|
cn->vtpci_flags |= VTPCI_FLAG_NO_MSI;
|
|
if (pci_find_cap(dev, PCIY_MSIX, NULL) != 0)
|
|
cn->vtpci_flags |= VTPCI_FLAG_NO_MSIX;
|
|
|
|
vtpci_setup_sysctl(cn);
|
|
}
|
|
|
|
int
|
|
vtpci_add_child(struct vtpci_common *cn)
|
|
{
|
|
device_t dev, child;
|
|
|
|
dev = cn->vtpci_dev;
|
|
|
|
child = device_add_child(dev, NULL, -1);
|
|
if (child == NULL) {
|
|
device_printf(dev, "cannot create child device\n");
|
|
return (ENOMEM);
|
|
}
|
|
|
|
cn->vtpci_child_dev = child;
|
|
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
vtpci_delete_child(struct vtpci_common *cn)
|
|
{
|
|
device_t dev, child;
|
|
int error;
|
|
|
|
dev = cn->vtpci_dev;
|
|
|
|
child = cn->vtpci_child_dev;
|
|
if (child != NULL) {
|
|
error = device_delete_child(dev, child);
|
|
if (error)
|
|
return (error);
|
|
cn->vtpci_child_dev = NULL;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
void
|
|
vtpci_child_detached(struct vtpci_common *cn)
|
|
{
|
|
|
|
vtpci_release_child_resources(cn);
|
|
|
|
cn->vtpci_child_feat_desc = NULL;
|
|
cn->vtpci_host_features = 0;
|
|
cn->vtpci_features = 0;
|
|
}
|
|
|
|
int
|
|
vtpci_reinit(struct vtpci_common *cn)
|
|
{
|
|
int idx, error;
|
|
|
|
for (idx = 0; idx < cn->vtpci_nvqs; idx++) {
|
|
error = vtpci_reinit_virtqueue(cn, idx);
|
|
if (error)
|
|
return (error);
|
|
}
|
|
|
|
if (vtpci_is_msix_enabled(cn)) {
|
|
error = vtpci_set_host_msix_vectors(cn);
|
|
if (error)
|
|
return (error);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
vtpci_describe_features(struct vtpci_common *cn, const char *msg,
|
|
uint64_t features)
|
|
{
|
|
device_t dev, child;
|
|
|
|
dev = cn->vtpci_dev;
|
|
child = cn->vtpci_child_dev;
|
|
|
|
if (device_is_attached(child) || bootverbose == 0)
|
|
return;
|
|
|
|
virtio_describe(dev, msg, features, cn->vtpci_child_feat_desc);
|
|
}
|
|
|
|
uint64_t
|
|
vtpci_negotiate_features(struct vtpci_common *cn,
|
|
uint64_t child_features, uint64_t host_features)
|
|
{
|
|
uint64_t features;
|
|
|
|
cn->vtpci_host_features = host_features;
|
|
vtpci_describe_features(cn, "host", host_features);
|
|
|
|
/*
|
|
* Limit negotiated features to what the driver, virtqueue, and
|
|
* host all support.
|
|
*/
|
|
features = host_features & child_features;
|
|
features = virtio_filter_transport_features(features);
|
|
|
|
cn->vtpci_features = features;
|
|
vtpci_describe_features(cn, "negotiated", features);
|
|
|
|
return (features);
|
|
}
|
|
|
|
int
|
|
vtpci_with_feature(struct vtpci_common *cn, uint64_t feature)
|
|
{
|
|
return ((cn->vtpci_features & feature) != 0);
|
|
}
|
|
|
|
int
|
|
vtpci_read_ivar(struct vtpci_common *cn, int index, uintptr_t *result)
|
|
{
|
|
device_t dev;
|
|
int error;
|
|
|
|
dev = cn->vtpci_dev;
|
|
error = 0;
|
|
|
|
switch (index) {
|
|
case VIRTIO_IVAR_SUBDEVICE:
|
|
*result = pci_get_subdevice(dev);
|
|
break;
|
|
case VIRTIO_IVAR_VENDOR:
|
|
*result = pci_get_vendor(dev);
|
|
break;
|
|
case VIRTIO_IVAR_DEVICE:
|
|
*result = pci_get_device(dev);
|
|
break;
|
|
case VIRTIO_IVAR_SUBVENDOR:
|
|
*result = pci_get_subvendor(dev);
|
|
break;
|
|
case VIRTIO_IVAR_MODERN:
|
|
*result = vtpci_is_modern(cn);
|
|
break;
|
|
default:
|
|
error = ENOENT;
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
int
|
|
vtpci_write_ivar(struct vtpci_common *cn, int index, uintptr_t value)
|
|
{
|
|
int error;
|
|
|
|
error = 0;
|
|
|
|
switch (index) {
|
|
case VIRTIO_IVAR_FEATURE_DESC:
|
|
cn->vtpci_child_feat_desc = (void *) value;
|
|
break;
|
|
default:
|
|
error = ENOENT;
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
int
|
|
vtpci_alloc_virtqueues(struct vtpci_common *cn, int flags, int nvqs,
|
|
struct vq_alloc_info *vq_info)
|
|
{
|
|
device_t dev;
|
|
int idx, align, error;
|
|
|
|
dev = cn->vtpci_dev;
|
|
|
|
/*
|
|
* This is VIRTIO_PCI_VRING_ALIGN from legacy VirtIO. In modern VirtIO,
|
|
* the tables do not have to be allocated contiguously, but we do so
|
|
* anyways.
|
|
*/
|
|
align = 4096;
|
|
|
|
if (cn->vtpci_nvqs != 0)
|
|
return (EALREADY);
|
|
if (nvqs <= 0)
|
|
return (EINVAL);
|
|
|
|
cn->vtpci_vqs = malloc(nvqs * sizeof(struct vtpci_virtqueue),
|
|
M_DEVBUF, M_NOWAIT | M_ZERO);
|
|
if (cn->vtpci_vqs == NULL)
|
|
return (ENOMEM);
|
|
|
|
for (idx = 0; idx < nvqs; idx++) {
|
|
struct vtpci_virtqueue *vqx;
|
|
struct vq_alloc_info *info;
|
|
struct virtqueue *vq;
|
|
bus_size_t notify_offset;
|
|
uint16_t size;
|
|
|
|
vqx = &cn->vtpci_vqs[idx];
|
|
info = &vq_info[idx];
|
|
|
|
size = vtpci_get_vq_size(cn, idx);
|
|
notify_offset = vtpci_get_vq_notify_off(cn, idx);
|
|
|
|
error = virtqueue_alloc(dev, idx, size, notify_offset, align,
|
|
~(vm_paddr_t)0, info, &vq);
|
|
if (error) {
|
|
device_printf(dev,
|
|
"cannot allocate virtqueue %d: %d\n", idx, error);
|
|
break;
|
|
}
|
|
|
|
vtpci_set_vq(cn, vq);
|
|
|
|
vqx->vtv_vq = *info->vqai_vq = vq;
|
|
vqx->vtv_no_intr = info->vqai_intr == NULL;
|
|
|
|
cn->vtpci_nvqs++;
|
|
}
|
|
|
|
if (error)
|
|
vtpci_free_virtqueues(cn);
|
|
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_msix(struct vtpci_common *cn, int nvectors)
|
|
{
|
|
device_t dev;
|
|
int nmsix, cnt, required;
|
|
|
|
dev = cn->vtpci_dev;
|
|
|
|
/* Allocate an additional vector for the config changes. */
|
|
required = nvectors + 1;
|
|
|
|
nmsix = pci_msix_count(dev);
|
|
if (nmsix < required)
|
|
return (1);
|
|
|
|
cnt = required;
|
|
if (pci_alloc_msix(dev, &cnt) == 0 && cnt >= required) {
|
|
cn->vtpci_nmsix_resources = required;
|
|
return (0);
|
|
}
|
|
|
|
pci_release_msi(dev);
|
|
|
|
return (1);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_msi(struct vtpci_common *cn)
|
|
{
|
|
device_t dev;
|
|
int nmsi, cnt, required;
|
|
|
|
dev = cn->vtpci_dev;
|
|
required = 1;
|
|
|
|
nmsi = pci_msi_count(dev);
|
|
if (nmsi < required)
|
|
return (1);
|
|
|
|
cnt = required;
|
|
if (pci_alloc_msi(dev, &cnt) == 0 && cnt >= required)
|
|
return (0);
|
|
|
|
pci_release_msi(dev);
|
|
|
|
return (1);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_intr_msix_pervq(struct vtpci_common *cn)
|
|
{
|
|
int i, nvectors, error;
|
|
|
|
if (vtpci_disable_msix != 0 || cn->vtpci_flags & VTPCI_FLAG_NO_MSIX)
|
|
return (ENOTSUP);
|
|
|
|
for (nvectors = 0, i = 0; i < cn->vtpci_nvqs; i++) {
|
|
if (cn->vtpci_vqs[i].vtv_no_intr == 0)
|
|
nvectors++;
|
|
}
|
|
|
|
error = vtpci_alloc_msix(cn, nvectors);
|
|
if (error)
|
|
return (error);
|
|
|
|
cn->vtpci_flags |= VTPCI_FLAG_MSIX;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_intr_msix_shared(struct vtpci_common *cn)
|
|
{
|
|
int error;
|
|
|
|
if (vtpci_disable_msix != 0 || cn->vtpci_flags & VTPCI_FLAG_NO_MSIX)
|
|
return (ENOTSUP);
|
|
|
|
error = vtpci_alloc_msix(cn, 1);
|
|
if (error)
|
|
return (error);
|
|
|
|
cn->vtpci_flags |= VTPCI_FLAG_MSIX | VTPCI_FLAG_SHARED_MSIX;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_intr_msi(struct vtpci_common *cn)
|
|
{
|
|
int error;
|
|
|
|
/* Only BHyVe supports MSI. */
|
|
if (cn->vtpci_flags & VTPCI_FLAG_NO_MSI)
|
|
return (ENOTSUP);
|
|
|
|
error = vtpci_alloc_msi(cn);
|
|
if (error)
|
|
return (error);
|
|
|
|
cn->vtpci_flags |= VTPCI_FLAG_MSI;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_intr_intx(struct vtpci_common *cn)
|
|
{
|
|
|
|
cn->vtpci_flags |= VTPCI_FLAG_INTX;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_interrupt(struct vtpci_common *cn, int rid, int flags,
|
|
struct vtpci_interrupt *intr)
|
|
{
|
|
struct resource *irq;
|
|
|
|
irq = bus_alloc_resource_any(cn->vtpci_dev, SYS_RES_IRQ, &rid, flags);
|
|
if (irq == NULL)
|
|
return (ENXIO);
|
|
|
|
intr->vti_irq = irq;
|
|
intr->vti_rid = rid;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
vtpci_free_interrupt(struct vtpci_common *cn, struct vtpci_interrupt *intr)
|
|
{
|
|
device_t dev;
|
|
|
|
dev = cn->vtpci_dev;
|
|
|
|
if (intr->vti_handler != NULL) {
|
|
bus_teardown_intr(dev, intr->vti_irq, intr->vti_handler);
|
|
intr->vti_handler = NULL;
|
|
}
|
|
|
|
if (intr->vti_irq != NULL) {
|
|
bus_release_resource(dev, SYS_RES_IRQ, intr->vti_rid,
|
|
intr->vti_irq);
|
|
intr->vti_irq = NULL;
|
|
intr->vti_rid = -1;
|
|
}
|
|
}
|
|
|
|
static void
|
|
vtpci_free_interrupts(struct vtpci_common *cn)
|
|
{
|
|
struct vtpci_interrupt *intr;
|
|
int i, nvq_intrs;
|
|
|
|
vtpci_free_interrupt(cn, &cn->vtpci_device_interrupt);
|
|
|
|
if (cn->vtpci_nmsix_resources != 0) {
|
|
nvq_intrs = cn->vtpci_nmsix_resources - 1;
|
|
cn->vtpci_nmsix_resources = 0;
|
|
|
|
if ((intr = cn->vtpci_msix_vq_interrupts) != NULL) {
|
|
for (i = 0; i < nvq_intrs; i++, intr++)
|
|
vtpci_free_interrupt(cn, intr);
|
|
|
|
free(cn->vtpci_msix_vq_interrupts, M_DEVBUF);
|
|
cn->vtpci_msix_vq_interrupts = NULL;
|
|
}
|
|
}
|
|
|
|
if (cn->vtpci_flags & (VTPCI_FLAG_MSI | VTPCI_FLAG_MSIX))
|
|
pci_release_msi(cn->vtpci_dev);
|
|
|
|
cn->vtpci_flags &= ~VTPCI_FLAG_ITYPE_MASK;
|
|
}
|
|
|
|
static void
|
|
vtpci_free_virtqueues(struct vtpci_common *cn)
|
|
{
|
|
struct vtpci_virtqueue *vqx;
|
|
int idx;
|
|
|
|
for (idx = 0; idx < cn->vtpci_nvqs; idx++) {
|
|
vtpci_disable_vq(cn, idx);
|
|
|
|
vqx = &cn->vtpci_vqs[idx];
|
|
virtqueue_free(vqx->vtv_vq);
|
|
vqx->vtv_vq = NULL;
|
|
}
|
|
|
|
free(cn->vtpci_vqs, M_DEVBUF);
|
|
cn->vtpci_vqs = NULL;
|
|
cn->vtpci_nvqs = 0;
|
|
}
|
|
|
|
void
|
|
vtpci_release_child_resources(struct vtpci_common *cn)
|
|
{
|
|
|
|
vtpci_free_interrupts(cn);
|
|
vtpci_free_virtqueues(cn);
|
|
}
|
|
|
|
static void
|
|
vtpci_cleanup_setup_intr_attempt(struct vtpci_common *cn)
|
|
{
|
|
int idx;
|
|
|
|
if (cn->vtpci_flags & VTPCI_FLAG_MSIX) {
|
|
vtpci_register_cfg_msix(cn, NULL);
|
|
|
|
for (idx = 0; idx < cn->vtpci_nvqs; idx++)
|
|
vtpci_register_vq_msix(cn, idx, NULL);
|
|
}
|
|
|
|
vtpci_free_interrupts(cn);
|
|
}
|
|
|
|
static int
|
|
vtpci_alloc_intr_resources(struct vtpci_common *cn)
|
|
{
|
|
struct vtpci_interrupt *intr;
|
|
int i, rid, flags, nvq_intrs, error;
|
|
|
|
flags = RF_ACTIVE;
|
|
|
|
if (cn->vtpci_flags & VTPCI_FLAG_INTX) {
|
|
rid = 0;
|
|
flags |= RF_SHAREABLE;
|
|
} else
|
|
rid = 1;
|
|
|
|
/*
|
|
* When using INTX or MSI interrupts, this resource handles all
|
|
* interrupts. When using MSIX, this resource handles just the
|
|
* configuration changed interrupt.
|
|
*/
|
|
intr = &cn->vtpci_device_interrupt;
|
|
|
|
error = vtpci_alloc_interrupt(cn, rid, flags, intr);
|
|
if (error || cn->vtpci_flags & (VTPCI_FLAG_INTX | VTPCI_FLAG_MSI))
|
|
return (error);
|
|
|
|
/*
|
|
* Now allocate the interrupts for the virtqueues. This may be one
|
|
* for all the virtqueues, or one for each virtqueue. Subtract one
|
|
* below for because of the configuration changed interrupt.
|
|
*/
|
|
nvq_intrs = cn->vtpci_nmsix_resources - 1;
|
|
|
|
cn->vtpci_msix_vq_interrupts = malloc(nvq_intrs *
|
|
sizeof(struct vtpci_interrupt), M_DEVBUF, M_NOWAIT | M_ZERO);
|
|
if (cn->vtpci_msix_vq_interrupts == NULL)
|
|
return (ENOMEM);
|
|
|
|
intr = cn->vtpci_msix_vq_interrupts;
|
|
|
|
for (i = 0, rid++; i < nvq_intrs; i++, rid++, intr++) {
|
|
error = vtpci_alloc_interrupt(cn, rid, flags, intr);
|
|
if (error)
|
|
return (error);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
vtpci_setup_intx_interrupt(struct vtpci_common *cn, enum intr_type type)
|
|
{
|
|
struct vtpci_interrupt *intr;
|
|
int error;
|
|
|
|
intr = &cn->vtpci_device_interrupt;
|
|
|
|
error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type, NULL,
|
|
vtpci_intx_intr, cn, &intr->vti_handler);
|
|
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
vtpci_setup_pervq_msix_interrupts(struct vtpci_common *cn, enum intr_type type)
|
|
{
|
|
struct vtpci_virtqueue *vqx;
|
|
struct vtpci_interrupt *intr;
|
|
int i, error;
|
|
|
|
intr = cn->vtpci_msix_vq_interrupts;
|
|
|
|
for (i = 0; i < cn->vtpci_nvqs; i++) {
|
|
vqx = &cn->vtpci_vqs[i];
|
|
|
|
if (vqx->vtv_no_intr)
|
|
continue;
|
|
|
|
error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type,
|
|
vtpci_vq_intr_filter, vtpci_vq_intr, vqx->vtv_vq,
|
|
&intr->vti_handler);
|
|
if (error)
|
|
return (error);
|
|
|
|
intr++;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
vtpci_set_host_msix_vectors(struct vtpci_common *cn)
|
|
{
|
|
struct vtpci_interrupt *intr, *tintr;
|
|
int idx, error;
|
|
|
|
intr = &cn->vtpci_device_interrupt;
|
|
error = vtpci_register_cfg_msix(cn, intr);
|
|
if (error)
|
|
return (error);
|
|
|
|
intr = cn->vtpci_msix_vq_interrupts;
|
|
for (idx = 0; idx < cn->vtpci_nvqs; idx++) {
|
|
if (cn->vtpci_vqs[idx].vtv_no_intr)
|
|
tintr = NULL;
|
|
else
|
|
tintr = intr;
|
|
|
|
error = vtpci_register_vq_msix(cn, idx, tintr);
|
|
if (error)
|
|
break;
|
|
|
|
/*
|
|
* For shared MSIX, all the virtqueues share the first
|
|
* interrupt.
|
|
*/
|
|
if (!cn->vtpci_vqs[idx].vtv_no_intr &&
|
|
(cn->vtpci_flags & VTPCI_FLAG_SHARED_MSIX) == 0)
|
|
intr++;
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
vtpci_setup_msix_interrupts(struct vtpci_common *cn, enum intr_type type)
|
|
{
|
|
struct vtpci_interrupt *intr;
|
|
int error;
|
|
|
|
intr = &cn->vtpci_device_interrupt;
|
|
|
|
error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type, NULL,
|
|
vtpci_config_intr, cn, &intr->vti_handler);
|
|
if (error)
|
|
return (error);
|
|
|
|
if (cn->vtpci_flags & VTPCI_FLAG_SHARED_MSIX) {
|
|
intr = &cn->vtpci_msix_vq_interrupts[0];
|
|
|
|
error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type,
|
|
vtpci_vq_shared_intr_filter, vtpci_vq_shared_intr, cn,
|
|
&intr->vti_handler);
|
|
} else
|
|
error = vtpci_setup_pervq_msix_interrupts(cn, type);
|
|
|
|
return (error ? error : vtpci_set_host_msix_vectors(cn));
|
|
}
|
|
|
|
static int
|
|
vtpci_setup_intrs(struct vtpci_common *cn, enum intr_type type)
|
|
{
|
|
int error;
|
|
|
|
type |= INTR_MPSAFE;
|
|
KASSERT(cn->vtpci_flags & VTPCI_FLAG_ITYPE_MASK,
|
|
("%s: no interrupt type selected %#x", __func__, cn->vtpci_flags));
|
|
|
|
error = vtpci_alloc_intr_resources(cn);
|
|
if (error)
|
|
return (error);
|
|
|
|
if (cn->vtpci_flags & VTPCI_FLAG_INTX)
|
|
error = vtpci_setup_intx_interrupt(cn, type);
|
|
else if (cn->vtpci_flags & VTPCI_FLAG_MSI)
|
|
error = vtpci_setup_msi_interrupt(cn, type);
|
|
else
|
|
error = vtpci_setup_msix_interrupts(cn, type);
|
|
|
|
return (error);
|
|
}
|
|
|
|
int
|
|
vtpci_setup_interrupts(struct vtpci_common *cn, enum intr_type type)
|
|
{
|
|
device_t dev;
|
|
int attempt, error;
|
|
|
|
dev = cn->vtpci_dev;
|
|
|
|
for (attempt = 0; attempt < 5; attempt++) {
|
|
/*
|
|
* Start with the most desirable interrupt configuration and
|
|
* fallback towards less desirable ones.
|
|
*/
|
|
switch (attempt) {
|
|
case 0:
|
|
error = vtpci_alloc_intr_msix_pervq(cn);
|
|
break;
|
|
case 1:
|
|
error = vtpci_alloc_intr_msix_shared(cn);
|
|
break;
|
|
case 2:
|
|
error = vtpci_alloc_intr_msi(cn);
|
|
break;
|
|
case 3:
|
|
error = vtpci_alloc_intr_intx(cn);
|
|
break;
|
|
default:
|
|
device_printf(dev,
|
|
"exhausted all interrupt allocation attempts\n");
|
|
return (ENXIO);
|
|
}
|
|
|
|
if (error == 0 && vtpci_setup_intrs(cn, type) == 0)
|
|
break;
|
|
|
|
vtpci_cleanup_setup_intr_attempt(cn);
|
|
}
|
|
|
|
if (bootverbose) {
|
|
if (cn->vtpci_flags & VTPCI_FLAG_INTX)
|
|
device_printf(dev, "using legacy interrupt\n");
|
|
else if (cn->vtpci_flags & VTPCI_FLAG_MSI)
|
|
device_printf(dev, "using MSI interrupt\n");
|
|
else if (cn->vtpci_flags & VTPCI_FLAG_SHARED_MSIX)
|
|
device_printf(dev, "using shared MSIX interrupts\n");
|
|
else
|
|
device_printf(dev, "using per VQ MSIX interrupts\n");
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
vtpci_reinit_virtqueue(struct vtpci_common *cn, int idx)
|
|
{
|
|
struct vtpci_virtqueue *vqx;
|
|
struct virtqueue *vq;
|
|
int error;
|
|
|
|
vqx = &cn->vtpci_vqs[idx];
|
|
vq = vqx->vtv_vq;
|
|
|
|
KASSERT(vq != NULL, ("%s: vq %d not allocated", __func__, idx));
|
|
|
|
error = virtqueue_reinit(vq, vtpci_get_vq_size(cn, idx));
|
|
if (error == 0)
|
|
vtpci_set_vq(cn, vq);
|
|
|
|
return (error);
|
|
}
|
|
|
|
static void
|
|
vtpci_intx_intr(void *xcn)
|
|
{
|
|
struct vtpci_common *cn;
|
|
struct vtpci_virtqueue *vqx;
|
|
int i;
|
|
uint8_t isr;
|
|
|
|
cn = xcn;
|
|
isr = vtpci_read_isr(cn);
|
|
|
|
if (isr & VIRTIO_PCI_ISR_CONFIG)
|
|
vtpci_config_intr(cn);
|
|
|
|
if (isr & VIRTIO_PCI_ISR_INTR) {
|
|
vqx = &cn->vtpci_vqs[0];
|
|
for (i = 0; i < cn->vtpci_nvqs; i++, vqx++) {
|
|
if (vqx->vtv_no_intr == 0)
|
|
virtqueue_intr(vqx->vtv_vq);
|
|
}
|
|
}
|
|
}
|
|
|
|
static int
|
|
vtpci_vq_shared_intr_filter(void *xcn)
|
|
{
|
|
struct vtpci_common *cn;
|
|
struct vtpci_virtqueue *vqx;
|
|
int i, rc;
|
|
|
|
cn = xcn;
|
|
vqx = &cn->vtpci_vqs[0];
|
|
rc = 0;
|
|
|
|
for (i = 0; i < cn->vtpci_nvqs; i++, vqx++) {
|
|
if (vqx->vtv_no_intr == 0)
|
|
rc |= virtqueue_intr_filter(vqx->vtv_vq);
|
|
}
|
|
|
|
return (rc ? FILTER_SCHEDULE_THREAD : FILTER_STRAY);
|
|
}
|
|
|
|
static void
|
|
vtpci_vq_shared_intr(void *xcn)
|
|
{
|
|
struct vtpci_common *cn;
|
|
struct vtpci_virtqueue *vqx;
|
|
int i;
|
|
|
|
cn = xcn;
|
|
vqx = &cn->vtpci_vqs[0];
|
|
|
|
for (i = 0; i < cn->vtpci_nvqs; i++, vqx++) {
|
|
if (vqx->vtv_no_intr == 0)
|
|
virtqueue_intr(vqx->vtv_vq);
|
|
}
|
|
}
|
|
|
|
static int
|
|
vtpci_vq_intr_filter(void *xvq)
|
|
{
|
|
struct virtqueue *vq;
|
|
int rc;
|
|
|
|
vq = xvq;
|
|
rc = virtqueue_intr_filter(vq);
|
|
|
|
return (rc ? FILTER_SCHEDULE_THREAD : FILTER_STRAY);
|
|
}
|
|
|
|
static void
|
|
vtpci_vq_intr(void *xvq)
|
|
{
|
|
struct virtqueue *vq;
|
|
|
|
vq = xvq;
|
|
virtqueue_intr(vq);
|
|
}
|
|
|
|
static void
|
|
vtpci_config_intr(void *xcn)
|
|
{
|
|
struct vtpci_common *cn;
|
|
device_t child;
|
|
|
|
cn = xcn;
|
|
child = cn->vtpci_child_dev;
|
|
|
|
if (child != NULL)
|
|
VIRTIO_CONFIG_CHANGE(child);
|
|
}
|
|
|
|
static int
|
|
vtpci_feature_sysctl(struct sysctl_req *req, struct vtpci_common *cn,
|
|
uint64_t features)
|
|
{
|
|
struct sbuf *sb;
|
|
int error;
|
|
|
|
sb = sbuf_new_for_sysctl(NULL, NULL, 256, req);
|
|
if (sb == NULL)
|
|
return (ENOMEM);
|
|
|
|
error = virtio_describe_sbuf(sb, features, cn->vtpci_child_feat_desc);
|
|
sbuf_delete(sb);
|
|
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
vtpci_host_features_sysctl(SYSCTL_HANDLER_ARGS)
|
|
{
|
|
struct vtpci_common *cn;
|
|
|
|
cn = arg1;
|
|
|
|
return (vtpci_feature_sysctl(req, cn, cn->vtpci_host_features));
|
|
}
|
|
|
|
static int
|
|
vtpci_negotiated_features_sysctl(SYSCTL_HANDLER_ARGS)
|
|
{
|
|
struct vtpci_common *cn;
|
|
|
|
cn = arg1;
|
|
|
|
return (vtpci_feature_sysctl(req, cn, cn->vtpci_features));
|
|
}
|
|
|
|
static void
|
|
vtpci_setup_sysctl(struct vtpci_common *cn)
|
|
{
|
|
device_t dev;
|
|
struct sysctl_ctx_list *ctx;
|
|
struct sysctl_oid *tree;
|
|
struct sysctl_oid_list *child;
|
|
|
|
dev = cn->vtpci_dev;
|
|
ctx = device_get_sysctl_ctx(dev);
|
|
tree = device_get_sysctl_tree(dev);
|
|
child = SYSCTL_CHILDREN(tree);
|
|
|
|
SYSCTL_ADD_INT(ctx, child, OID_AUTO, "nvqs",
|
|
CTLFLAG_RD, &cn->vtpci_nvqs, 0, "Number of virtqueues");
|
|
|
|
SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "host_features",
|
|
CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, cn, 0,
|
|
vtpci_host_features_sysctl, "A", "Features supported by the host");
|
|
SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "negotiated_features",
|
|
CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, cn, 0,
|
|
vtpci_negotiated_features_sysctl, "A", "Features negotiated");
|
|
}
|