xref: /freebsd/sys/dev/virtio/pci/virtio_pci.c (revision 4d846d260e2b9a3d4d0a701462568268cbfe7a5b)
110b59a9bSPeter Grehan /*-
2*4d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni  *
49da9560cSBryan Venteicher  * Copyright (c) 2017, Bryan Venteicher <bryanv@FreeBSD.org>
510b59a9bSPeter Grehan  * All rights reserved.
610b59a9bSPeter Grehan  *
710b59a9bSPeter Grehan  * Redistribution and use in source and binary forms, with or without
810b59a9bSPeter Grehan  * modification, are permitted provided that the following conditions
910b59a9bSPeter Grehan  * are met:
1010b59a9bSPeter Grehan  * 1. Redistributions of source code must retain the above copyright
1110b59a9bSPeter Grehan  *    notice unmodified, this list of conditions, and the following
1210b59a9bSPeter Grehan  *    disclaimer.
1310b59a9bSPeter Grehan  * 2. Redistributions in binary form must reproduce the above copyright
1410b59a9bSPeter Grehan  *    notice, this list of conditions and the following disclaimer in the
1510b59a9bSPeter Grehan  *    documentation and/or other materials provided with the distribution.
1610b59a9bSPeter Grehan  *
1710b59a9bSPeter Grehan  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
1810b59a9bSPeter Grehan  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
1910b59a9bSPeter Grehan  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
2010b59a9bSPeter Grehan  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
2110b59a9bSPeter Grehan  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
2210b59a9bSPeter Grehan  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
2310b59a9bSPeter Grehan  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
2410b59a9bSPeter Grehan  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
2510b59a9bSPeter Grehan  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
2610b59a9bSPeter Grehan  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2710b59a9bSPeter Grehan  */
2810b59a9bSPeter Grehan 
2910b59a9bSPeter Grehan #include <sys/cdefs.h>
3010b59a9bSPeter Grehan __FBSDID("$FreeBSD$");
3110b59a9bSPeter Grehan 
3210b59a9bSPeter Grehan #include <sys/param.h>
3310b59a9bSPeter Grehan #include <sys/systm.h>
3410b59a9bSPeter Grehan #include <sys/bus.h>
3510b59a9bSPeter Grehan #include <sys/kernel.h>
36703f17d6SBryan Venteicher #include <sys/sbuf.h>
37703f17d6SBryan Venteicher #include <sys/sysctl.h>
3810b59a9bSPeter Grehan #include <sys/module.h>
3910b59a9bSPeter Grehan #include <sys/malloc.h>
4010b59a9bSPeter Grehan 
4110b59a9bSPeter Grehan #include <machine/bus.h>
4210b59a9bSPeter Grehan #include <machine/resource.h>
4310b59a9bSPeter Grehan #include <sys/bus.h>
4410b59a9bSPeter Grehan #include <sys/rman.h>
4510b59a9bSPeter Grehan 
4610b59a9bSPeter Grehan #include <dev/pci/pcivar.h>
4710b59a9bSPeter Grehan #include <dev/pci/pcireg.h>
4810b59a9bSPeter Grehan 
4910b59a9bSPeter Grehan #include <dev/virtio/virtio.h>
5010b59a9bSPeter Grehan #include <dev/virtio/virtqueue.h>
5110b59a9bSPeter Grehan #include <dev/virtio/pci/virtio_pci.h>
529da9560cSBryan Venteicher #include <dev/virtio/pci/virtio_pci_var.h>
5310b59a9bSPeter Grehan 
549da9560cSBryan Venteicher #include "virtio_pci_if.h"
5510b59a9bSPeter Grehan #include "virtio_if.h"
5610b59a9bSPeter Grehan 
579da9560cSBryan Venteicher static void	vtpci_describe_features(struct vtpci_common *, const char *,
5810b59a9bSPeter Grehan 		    uint64_t);
599da9560cSBryan Venteicher static int	vtpci_alloc_msix(struct vtpci_common *, int);
609da9560cSBryan Venteicher static int	vtpci_alloc_msi(struct vtpci_common *);
619da9560cSBryan Venteicher static int	vtpci_alloc_intr_msix_pervq(struct vtpci_common *);
629da9560cSBryan Venteicher static int	vtpci_alloc_intr_msix_shared(struct vtpci_common *);
639da9560cSBryan Venteicher static int	vtpci_alloc_intr_msi(struct vtpci_common *);
649da9560cSBryan Venteicher static int	vtpci_alloc_intr_intx(struct vtpci_common *);
659da9560cSBryan Venteicher static int	vtpci_alloc_interrupt(struct vtpci_common *, int, int,
6662a69c41SBryan Venteicher 		    struct vtpci_interrupt *);
679da9560cSBryan Venteicher static void	vtpci_free_interrupt(struct vtpci_common *,
6862a69c41SBryan Venteicher 		    struct vtpci_interrupt *);
6910b59a9bSPeter Grehan 
709da9560cSBryan Venteicher static void	vtpci_free_interrupts(struct vtpci_common *);
719da9560cSBryan Venteicher static void	vtpci_free_virtqueues(struct vtpci_common *);
729da9560cSBryan Venteicher static void	vtpci_cleanup_setup_intr_attempt(struct vtpci_common *);
739da9560cSBryan Venteicher static int	vtpci_alloc_intr_resources(struct vtpci_common *);
749da9560cSBryan Venteicher static int	vtpci_setup_intx_interrupt(struct vtpci_common *,
759da9560cSBryan Venteicher 		    enum intr_type);
769da9560cSBryan Venteicher static int	vtpci_setup_pervq_msix_interrupts(struct vtpci_common *,
779da9560cSBryan Venteicher 		    enum intr_type);
789da9560cSBryan Venteicher static int	vtpci_set_host_msix_vectors(struct vtpci_common *);
799da9560cSBryan Venteicher static int	vtpci_setup_msix_interrupts(struct vtpci_common *,
809da9560cSBryan Venteicher 		    enum intr_type);
819da9560cSBryan Venteicher static int	vtpci_setup_intrs(struct vtpci_common *, enum intr_type);
829da9560cSBryan Venteicher static int	vtpci_reinit_virtqueue(struct vtpci_common *, int);
839da9560cSBryan Venteicher static void	vtpci_intx_intr(void *);
846632efe4SBryan Venteicher static int	vtpci_vq_shared_intr_filter(void *);
856632efe4SBryan Venteicher static void	vtpci_vq_shared_intr(void *);
866632efe4SBryan Venteicher static int	vtpci_vq_intr_filter(void *);
876632efe4SBryan Venteicher static void	vtpci_vq_intr(void *);
886632efe4SBryan Venteicher static void	vtpci_config_intr(void *);
8910b59a9bSPeter Grehan 
90703f17d6SBryan Venteicher static void	vtpci_setup_sysctl(struct vtpci_common *);
91703f17d6SBryan Venteicher 
929da9560cSBryan Venteicher #define vtpci_setup_msi_interrupt vtpci_setup_intx_interrupt
93e026de11SBryan Venteicher 
9410b59a9bSPeter Grehan /*
959da9560cSBryan Venteicher  * This module contains two drivers:
969da9560cSBryan Venteicher  *   - virtio_pci_legacy for pre-V1 support
979da9560cSBryan Venteicher  *   - virtio_pci_modern for V1 support
9810b59a9bSPeter Grehan  */
9910b59a9bSPeter Grehan MODULE_VERSION(virtio_pci, 1);
10010b59a9bSPeter Grehan MODULE_DEPEND(virtio_pci, pci, 1, 1, 1);
10110b59a9bSPeter Grehan MODULE_DEPEND(virtio_pci, virtio, 1, 1, 1);
10210b59a9bSPeter Grehan 
1039da9560cSBryan Venteicher int vtpci_disable_msix = 0;
1049da9560cSBryan Venteicher TUNABLE_INT("hw.virtio.pci.disable_msix", &vtpci_disable_msix);
1059da9560cSBryan Venteicher 
1069da9560cSBryan Venteicher static uint8_t
1079da9560cSBryan Venteicher vtpci_read_isr(struct vtpci_common *cn)
10810b59a9bSPeter Grehan {
1099da9560cSBryan Venteicher 	return (VIRTIO_PCI_READ_ISR(cn->vtpci_dev));
1109da9560cSBryan Venteicher }
11110b59a9bSPeter Grehan 
1129da9560cSBryan Venteicher static uint16_t
1139da9560cSBryan Venteicher vtpci_get_vq_size(struct vtpci_common *cn, int idx)
1149da9560cSBryan Venteicher {
1159da9560cSBryan Venteicher 	return (VIRTIO_PCI_GET_VQ_SIZE(cn->vtpci_dev, idx));
1169da9560cSBryan Venteicher }
11710b59a9bSPeter Grehan 
1189da9560cSBryan Venteicher static bus_size_t
1199da9560cSBryan Venteicher vtpci_get_vq_notify_off(struct vtpci_common *cn, int idx)
1209da9560cSBryan Venteicher {
1219da9560cSBryan Venteicher 	return (VIRTIO_PCI_GET_VQ_NOTIFY_OFF(cn->vtpci_dev, idx));
1229da9560cSBryan Venteicher }
12310b59a9bSPeter Grehan 
1249da9560cSBryan Venteicher static void
1259da9560cSBryan Venteicher vtpci_set_vq(struct vtpci_common *cn, struct virtqueue *vq)
1269da9560cSBryan Venteicher {
1279da9560cSBryan Venteicher 	VIRTIO_PCI_SET_VQ(cn->vtpci_dev, vq);
1289da9560cSBryan Venteicher }
12910b59a9bSPeter Grehan 
1309da9560cSBryan Venteicher static void
1319da9560cSBryan Venteicher vtpci_disable_vq(struct vtpci_common *cn, int idx)
1329da9560cSBryan Venteicher {
1339da9560cSBryan Venteicher 	VIRTIO_PCI_DISABLE_VQ(cn->vtpci_dev, idx);
13410b59a9bSPeter Grehan }
13510b59a9bSPeter Grehan 
13610b59a9bSPeter Grehan static int
1379da9560cSBryan Venteicher vtpci_register_cfg_msix(struct vtpci_common *cn, struct vtpci_interrupt *intr)
13810b59a9bSPeter Grehan {
1399da9560cSBryan Venteicher 	return (VIRTIO_PCI_REGISTER_CFG_MSIX(cn->vtpci_dev, intr));
1409da9560cSBryan Venteicher }
14110b59a9bSPeter Grehan 
1429da9560cSBryan Venteicher static int
1439da9560cSBryan Venteicher vtpci_register_vq_msix(struct vtpci_common *cn, int idx,
1449da9560cSBryan Venteicher     struct vtpci_interrupt *intr)
1459da9560cSBryan Venteicher {
1469da9560cSBryan Venteicher 	return (VIRTIO_PCI_REGISTER_VQ_MSIX(cn->vtpci_dev, idx, intr));
1479da9560cSBryan Venteicher }
1489da9560cSBryan Venteicher 
1499da9560cSBryan Venteicher void
1509da9560cSBryan Venteicher vtpci_init(struct vtpci_common *cn, device_t dev, bool modern)
1519da9560cSBryan Venteicher {
1529da9560cSBryan Venteicher 
1539da9560cSBryan Venteicher 	cn->vtpci_dev = dev;
15410b59a9bSPeter Grehan 
15510b59a9bSPeter Grehan 	pci_enable_busmaster(dev);
15610b59a9bSPeter Grehan 
1579da9560cSBryan Venteicher 	if (modern)
1589da9560cSBryan Venteicher 		cn->vtpci_flags |= VTPCI_FLAG_MODERN;
159cda6c6abSJohn Baldwin 	if (pci_find_cap(dev, PCIY_MSI, NULL) != 0)
1609da9560cSBryan Venteicher 		cn->vtpci_flags |= VTPCI_FLAG_NO_MSI;
1619da9560cSBryan Venteicher 	if (pci_find_cap(dev, PCIY_MSIX, NULL) != 0)
1629da9560cSBryan Venteicher 		cn->vtpci_flags |= VTPCI_FLAG_NO_MSIX;
163703f17d6SBryan Venteicher 
164703f17d6SBryan Venteicher 	vtpci_setup_sysctl(cn);
16510b59a9bSPeter Grehan }
16610b59a9bSPeter Grehan 
1679da9560cSBryan Venteicher int
1689da9560cSBryan Venteicher vtpci_add_child(struct vtpci_common *cn)
1699da9560cSBryan Venteicher {
1709da9560cSBryan Venteicher 	device_t dev, child;
17110b59a9bSPeter Grehan 
1729da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
17310b59a9bSPeter Grehan 
1749da9560cSBryan Venteicher 	child = device_add_child(dev, NULL, -1);
1759da9560cSBryan Venteicher 	if (child == NULL) {
17610b59a9bSPeter Grehan 		device_printf(dev, "cannot create child device\n");
17710b59a9bSPeter Grehan 		return (ENOMEM);
17810b59a9bSPeter Grehan 	}
17910b59a9bSPeter Grehan 
1809da9560cSBryan Venteicher 	cn->vtpci_child_dev = child;
18110b59a9bSPeter Grehan 
18210b59a9bSPeter Grehan 	return (0);
18310b59a9bSPeter Grehan }
18410b59a9bSPeter Grehan 
1859da9560cSBryan Venteicher int
1869da9560cSBryan Venteicher vtpci_delete_child(struct vtpci_common *cn)
18710b59a9bSPeter Grehan {
1889da9560cSBryan Venteicher 	device_t dev, child;
18910b59a9bSPeter Grehan 	int error;
19010b59a9bSPeter Grehan 
1919da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
19210b59a9bSPeter Grehan 
1939da9560cSBryan Venteicher 	child = cn->vtpci_child_dev;
1949da9560cSBryan Venteicher 	if (child != NULL) {
19510b59a9bSPeter Grehan 		error = device_delete_child(dev, child);
19610b59a9bSPeter Grehan 		if (error)
19710b59a9bSPeter Grehan 			return (error);
1989da9560cSBryan Venteicher 		cn->vtpci_child_dev = NULL;
19910b59a9bSPeter Grehan 	}
20010b59a9bSPeter Grehan 
20110b59a9bSPeter Grehan 	return (0);
20210b59a9bSPeter Grehan }
20310b59a9bSPeter Grehan 
2049da9560cSBryan Venteicher void
2059da9560cSBryan Venteicher vtpci_child_detached(struct vtpci_common *cn)
20610b59a9bSPeter Grehan {
20710b59a9bSPeter Grehan 
2089da9560cSBryan Venteicher 	vtpci_release_child_resources(cn);
2099da9560cSBryan Venteicher 
2109da9560cSBryan Venteicher 	cn->vtpci_child_feat_desc = NULL;
211703f17d6SBryan Venteicher 	cn->vtpci_host_features = 0;
2129da9560cSBryan Venteicher 	cn->vtpci_features = 0;
21310b59a9bSPeter Grehan }
21410b59a9bSPeter Grehan 
2159da9560cSBryan Venteicher int
2169da9560cSBryan Venteicher vtpci_reinit(struct vtpci_common *cn)
21710b59a9bSPeter Grehan {
2189da9560cSBryan Venteicher 	int idx, error;
21910b59a9bSPeter Grehan 
2209da9560cSBryan Venteicher 	for (idx = 0; idx < cn->vtpci_nvqs; idx++) {
2219da9560cSBryan Venteicher 		error = vtpci_reinit_virtqueue(cn, idx);
2229da9560cSBryan Venteicher 		if (error)
2239da9560cSBryan Venteicher 			return (error);
22410b59a9bSPeter Grehan 	}
22510b59a9bSPeter Grehan 
2269da9560cSBryan Venteicher 	if (vtpci_is_msix_enabled(cn)) {
2279da9560cSBryan Venteicher 		error = vtpci_set_host_msix_vectors(cn);
2289da9560cSBryan Venteicher 		if (error)
2299da9560cSBryan Venteicher 			return (error);
2309da9560cSBryan Venteicher 	}
23110b59a9bSPeter Grehan 
23210b59a9bSPeter Grehan 	return (0);
23310b59a9bSPeter Grehan }
23410b59a9bSPeter Grehan 
23510b59a9bSPeter Grehan static void
2369da9560cSBryan Venteicher vtpci_describe_features(struct vtpci_common *cn, const char *msg,
2379da9560cSBryan Venteicher     uint64_t features)
23810b59a9bSPeter Grehan {
2399da9560cSBryan Venteicher 	device_t dev, child;
24010b59a9bSPeter Grehan 
2419da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
2429da9560cSBryan Venteicher 	child = cn->vtpci_child_dev;
24310b59a9bSPeter Grehan 
2449da9560cSBryan Venteicher 	if (device_is_attached(child) || bootverbose == 0)
2459da9560cSBryan Venteicher 		return;
2469da9560cSBryan Venteicher 
2479da9560cSBryan Venteicher 	virtio_describe(dev, msg, features, cn->vtpci_child_feat_desc);
24810b59a9bSPeter Grehan }
24910b59a9bSPeter Grehan 
2509da9560cSBryan Venteicher uint64_t
2519da9560cSBryan Venteicher vtpci_negotiate_features(struct vtpci_common *cn,
2529da9560cSBryan Venteicher     uint64_t child_features, uint64_t host_features)
25310b59a9bSPeter Grehan {
2549da9560cSBryan Venteicher 	uint64_t features;
25510b59a9bSPeter Grehan 
256703f17d6SBryan Venteicher 	cn->vtpci_host_features = host_features;
2579da9560cSBryan Venteicher 	vtpci_describe_features(cn, "host", host_features);
25810b59a9bSPeter Grehan 
2599da9560cSBryan Venteicher 	/*
2609da9560cSBryan Venteicher 	 * Limit negotiated features to what the driver, virtqueue, and
2619da9560cSBryan Venteicher 	 * host all support.
2629da9560cSBryan Venteicher 	 */
2639da9560cSBryan Venteicher 	features = host_features & child_features;
2649da9560cSBryan Venteicher 	features = virtio_filter_transport_features(features);
2659da9560cSBryan Venteicher 
2669da9560cSBryan Venteicher 	cn->vtpci_features = features;
267703f17d6SBryan Venteicher 	vtpci_describe_features(cn, "negotiated", features);
2689da9560cSBryan Venteicher 
2699da9560cSBryan Venteicher 	return (features);
27010b59a9bSPeter Grehan }
27110b59a9bSPeter Grehan 
2729da9560cSBryan Venteicher int
2739da9560cSBryan Venteicher vtpci_with_feature(struct vtpci_common *cn, uint64_t feature)
27410b59a9bSPeter Grehan {
2759da9560cSBryan Venteicher 	return ((cn->vtpci_features & feature) != 0);
2769da9560cSBryan Venteicher }
27710b59a9bSPeter Grehan 
2789da9560cSBryan Venteicher int
2799da9560cSBryan Venteicher vtpci_read_ivar(struct vtpci_common *cn, int index, uintptr_t *result)
2809da9560cSBryan Venteicher {
2819da9560cSBryan Venteicher 	device_t dev;
2829da9560cSBryan Venteicher 	int error;
28310b59a9bSPeter Grehan 
2849da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
2859da9560cSBryan Venteicher 	error = 0;
28610b59a9bSPeter Grehan 
28710b59a9bSPeter Grehan 	switch (index) {
288310dacd0SPeter Grehan 	case VIRTIO_IVAR_SUBDEVICE:
289310dacd0SPeter Grehan 		*result = pci_get_subdevice(dev);
290310dacd0SPeter Grehan 		break;
291310dacd0SPeter Grehan 	case VIRTIO_IVAR_VENDOR:
292310dacd0SPeter Grehan 		*result = pci_get_vendor(dev);
293310dacd0SPeter Grehan 		break;
294310dacd0SPeter Grehan 	case VIRTIO_IVAR_DEVICE:
295310dacd0SPeter Grehan 		*result = pci_get_device(dev);
296310dacd0SPeter Grehan 		break;
297310dacd0SPeter Grehan 	case VIRTIO_IVAR_SUBVENDOR:
2987cc8e55bSConrad Meyer 		*result = pci_get_subvendor(dev);
29910b59a9bSPeter Grehan 		break;
3009da9560cSBryan Venteicher 	case VIRTIO_IVAR_MODERN:
3019da9560cSBryan Venteicher 		*result = vtpci_is_modern(cn);
3029da9560cSBryan Venteicher 		break;
30310b59a9bSPeter Grehan 	default:
3049da9560cSBryan Venteicher 		error = ENOENT;
30510b59a9bSPeter Grehan 	}
30610b59a9bSPeter Grehan 
3079da9560cSBryan Venteicher 	return (error);
30810b59a9bSPeter Grehan }
30910b59a9bSPeter Grehan 
3109da9560cSBryan Venteicher int
3119da9560cSBryan Venteicher vtpci_write_ivar(struct vtpci_common *cn, int index, uintptr_t value)
31210b59a9bSPeter Grehan {
3139da9560cSBryan Venteicher 	int error;
31410b59a9bSPeter Grehan 
3159da9560cSBryan Venteicher 	error = 0;
31610b59a9bSPeter Grehan 
31710b59a9bSPeter Grehan 	switch (index) {
31810b59a9bSPeter Grehan 	case VIRTIO_IVAR_FEATURE_DESC:
3199da9560cSBryan Venteicher 		cn->vtpci_child_feat_desc = (void *) value;
32010b59a9bSPeter Grehan 		break;
32110b59a9bSPeter Grehan 	default:
3229da9560cSBryan Venteicher 		error = ENOENT;
32310b59a9bSPeter Grehan 	}
32410b59a9bSPeter Grehan 
3259da9560cSBryan Venteicher 	return (error);
32610b59a9bSPeter Grehan }
32710b59a9bSPeter Grehan 
3289da9560cSBryan Venteicher int
3299da9560cSBryan Venteicher vtpci_alloc_virtqueues(struct vtpci_common *cn, int flags, int nvqs,
33010b59a9bSPeter Grehan     struct vq_alloc_info *vq_info)
33110b59a9bSPeter Grehan {
3329da9560cSBryan Venteicher 	device_t dev;
3339da9560cSBryan Venteicher 	int idx, align, error;
33410b59a9bSPeter Grehan 
3359da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
33610b59a9bSPeter Grehan 
3379da9560cSBryan Venteicher 	/*
3389da9560cSBryan Venteicher 	 * This is VIRTIO_PCI_VRING_ALIGN from legacy VirtIO. In modern VirtIO,
3399da9560cSBryan Venteicher 	 * the tables do not have to be allocated contiguously, but we do so
3409da9560cSBryan Venteicher 	 * anyways.
3419da9560cSBryan Venteicher 	 */
3429da9560cSBryan Venteicher 	align = 4096;
3439da9560cSBryan Venteicher 
3449da9560cSBryan Venteicher 	if (cn->vtpci_nvqs != 0)
345310dacd0SPeter Grehan 		return (EALREADY);
34662a69c41SBryan Venteicher 	if (nvqs <= 0)
34710b59a9bSPeter Grehan 		return (EINVAL);
34810b59a9bSPeter Grehan 
3499da9560cSBryan Venteicher 	cn->vtpci_vqs = malloc(nvqs * sizeof(struct vtpci_virtqueue),
35062a69c41SBryan Venteicher 	    M_DEVBUF, M_NOWAIT | M_ZERO);
3519da9560cSBryan Venteicher 	if (cn->vtpci_vqs == NULL)
35262a69c41SBryan Venteicher 		return (ENOMEM);
35362a69c41SBryan Venteicher 
354310dacd0SPeter Grehan 	for (idx = 0; idx < nvqs; idx++) {
3559da9560cSBryan Venteicher 		struct vtpci_virtqueue *vqx;
3569da9560cSBryan Venteicher 		struct vq_alloc_info *info;
3579da9560cSBryan Venteicher 		struct virtqueue *vq;
3589da9560cSBryan Venteicher 		bus_size_t notify_offset;
3599da9560cSBryan Venteicher 		uint16_t size;
3609da9560cSBryan Venteicher 
3619da9560cSBryan Venteicher 		vqx = &cn->vtpci_vqs[idx];
362310dacd0SPeter Grehan 		info = &vq_info[idx];
363310dacd0SPeter Grehan 
3649da9560cSBryan Venteicher 		size = vtpci_get_vq_size(cn, idx);
3659da9560cSBryan Venteicher 		notify_offset = vtpci_get_vq_notify_off(cn, idx);
366310dacd0SPeter Grehan 
3679da9560cSBryan Venteicher 		error = virtqueue_alloc(dev, idx, size, notify_offset, align,
368776d3d59SKristof Provost 		    ~(vm_paddr_t)0, info, &vq);
36910b59a9bSPeter Grehan 		if (error) {
370310dacd0SPeter Grehan 			device_printf(dev,
371310dacd0SPeter Grehan 			    "cannot allocate virtqueue %d: %d\n", idx, error);
372310dacd0SPeter Grehan 			break;
37310b59a9bSPeter Grehan 		}
37410b59a9bSPeter Grehan 
3759da9560cSBryan Venteicher 		vtpci_set_vq(cn, vq);
37610b59a9bSPeter Grehan 
37762a69c41SBryan Venteicher 		vqx->vtv_vq = *info->vqai_vq = vq;
37862a69c41SBryan Venteicher 		vqx->vtv_no_intr = info->vqai_intr == NULL;
379310dacd0SPeter Grehan 
3809da9560cSBryan Venteicher 		cn->vtpci_nvqs++;
38110b59a9bSPeter Grehan 	}
38210b59a9bSPeter Grehan 
38362a69c41SBryan Venteicher 	if (error)
3849da9560cSBryan Venteicher 		vtpci_free_virtqueues(cn);
38562a69c41SBryan Venteicher 
386310dacd0SPeter Grehan 	return (error);
38710b59a9bSPeter Grehan }
38810b59a9bSPeter Grehan 
38910b59a9bSPeter Grehan static int
3909da9560cSBryan Venteicher vtpci_alloc_msix(struct vtpci_common *cn, int nvectors)
39110b59a9bSPeter Grehan {
392310dacd0SPeter Grehan 	device_t dev;
393310dacd0SPeter Grehan 	int nmsix, cnt, required;
39410b59a9bSPeter Grehan 
3959da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
39610b59a9bSPeter Grehan 
397310dacd0SPeter Grehan 	/* Allocate an additional vector for the config changes. */
398310dacd0SPeter Grehan 	required = nvectors + 1;
39910b59a9bSPeter Grehan 
400310dacd0SPeter Grehan 	nmsix = pci_msix_count(dev);
401310dacd0SPeter Grehan 	if (nmsix < required)
402310dacd0SPeter Grehan 		return (1);
403310dacd0SPeter Grehan 
404310dacd0SPeter Grehan 	cnt = required;
405310dacd0SPeter Grehan 	if (pci_alloc_msix(dev, &cnt) == 0 && cnt >= required) {
4069da9560cSBryan Venteicher 		cn->vtpci_nmsix_resources = required;
407310dacd0SPeter Grehan 		return (0);
40810b59a9bSPeter Grehan 	}
40910b59a9bSPeter Grehan 
410310dacd0SPeter Grehan 	pci_release_msi(dev);
41110b59a9bSPeter Grehan 
412310dacd0SPeter Grehan 	return (1);
41310b59a9bSPeter Grehan }
41410b59a9bSPeter Grehan 
41510b59a9bSPeter Grehan static int
4169da9560cSBryan Venteicher vtpci_alloc_msi(struct vtpci_common *cn)
417310dacd0SPeter Grehan {
418310dacd0SPeter Grehan 	device_t dev;
419310dacd0SPeter Grehan 	int nmsi, cnt, required;
420310dacd0SPeter Grehan 
4219da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
422310dacd0SPeter Grehan 	required = 1;
423310dacd0SPeter Grehan 
424310dacd0SPeter Grehan 	nmsi = pci_msi_count(dev);
425310dacd0SPeter Grehan 	if (nmsi < required)
426310dacd0SPeter Grehan 		return (1);
427310dacd0SPeter Grehan 
428310dacd0SPeter Grehan 	cnt = required;
42962a69c41SBryan Venteicher 	if (pci_alloc_msi(dev, &cnt) == 0 && cnt >= required)
430310dacd0SPeter Grehan 		return (0);
431310dacd0SPeter Grehan 
432310dacd0SPeter Grehan 	pci_release_msi(dev);
433310dacd0SPeter Grehan 
434310dacd0SPeter Grehan 	return (1);
435310dacd0SPeter Grehan }
436310dacd0SPeter Grehan 
437310dacd0SPeter Grehan static int
4389da9560cSBryan Venteicher vtpci_alloc_intr_msix_pervq(struct vtpci_common *cn)
439310dacd0SPeter Grehan {
440310dacd0SPeter Grehan 	int i, nvectors, error;
441310dacd0SPeter Grehan 
4429da9560cSBryan Venteicher 	if (vtpci_disable_msix != 0 || cn->vtpci_flags & VTPCI_FLAG_NO_MSIX)
443310dacd0SPeter Grehan 		return (ENOTSUP);
444310dacd0SPeter Grehan 
4459da9560cSBryan Venteicher 	for (nvectors = 0, i = 0; i < cn->vtpci_nvqs; i++) {
4469da9560cSBryan Venteicher 		if (cn->vtpci_vqs[i].vtv_no_intr == 0)
447310dacd0SPeter Grehan 			nvectors++;
448310dacd0SPeter Grehan 	}
449310dacd0SPeter Grehan 
4509da9560cSBryan Venteicher 	error = vtpci_alloc_msix(cn, nvectors);
451310dacd0SPeter Grehan 	if (error)
452310dacd0SPeter Grehan 		return (error);
453310dacd0SPeter Grehan 
4549da9560cSBryan Venteicher 	cn->vtpci_flags |= VTPCI_FLAG_MSIX;
455310dacd0SPeter Grehan 
456310dacd0SPeter Grehan 	return (0);
457310dacd0SPeter Grehan }
458310dacd0SPeter Grehan 
459310dacd0SPeter Grehan static int
4609da9560cSBryan Venteicher vtpci_alloc_intr_msix_shared(struct vtpci_common *cn)
461310dacd0SPeter Grehan {
462310dacd0SPeter Grehan 	int error;
463310dacd0SPeter Grehan 
4649da9560cSBryan Venteicher 	if (vtpci_disable_msix != 0 || cn->vtpci_flags & VTPCI_FLAG_NO_MSIX)
465310dacd0SPeter Grehan 		return (ENOTSUP);
466310dacd0SPeter Grehan 
4679da9560cSBryan Venteicher 	error = vtpci_alloc_msix(cn, 1);
468310dacd0SPeter Grehan 	if (error)
469310dacd0SPeter Grehan 		return (error);
470310dacd0SPeter Grehan 
4719da9560cSBryan Venteicher 	cn->vtpci_flags |= VTPCI_FLAG_MSIX | VTPCI_FLAG_SHARED_MSIX;
472310dacd0SPeter Grehan 
473310dacd0SPeter Grehan 	return (0);
474310dacd0SPeter Grehan }
475310dacd0SPeter Grehan 
476310dacd0SPeter Grehan static int
4779da9560cSBryan Venteicher vtpci_alloc_intr_msi(struct vtpci_common *cn)
478310dacd0SPeter Grehan {
479310dacd0SPeter Grehan 	int error;
480310dacd0SPeter Grehan 
481310dacd0SPeter Grehan 	/* Only BHyVe supports MSI. */
4829da9560cSBryan Venteicher 	if (cn->vtpci_flags & VTPCI_FLAG_NO_MSI)
483310dacd0SPeter Grehan 		return (ENOTSUP);
484310dacd0SPeter Grehan 
4859da9560cSBryan Venteicher 	error = vtpci_alloc_msi(cn);
486310dacd0SPeter Grehan 	if (error)
487310dacd0SPeter Grehan 		return (error);
488310dacd0SPeter Grehan 
4899da9560cSBryan Venteicher 	cn->vtpci_flags |= VTPCI_FLAG_MSI;
490310dacd0SPeter Grehan 
491310dacd0SPeter Grehan 	return (0);
492310dacd0SPeter Grehan }
493310dacd0SPeter Grehan 
494310dacd0SPeter Grehan static int
4959da9560cSBryan Venteicher vtpci_alloc_intr_intx(struct vtpci_common *cn)
496310dacd0SPeter Grehan {
497310dacd0SPeter Grehan 
4989da9560cSBryan Venteicher 	cn->vtpci_flags |= VTPCI_FLAG_INTX;
49962a69c41SBryan Venteicher 
50062a69c41SBryan Venteicher 	return (0);
50162a69c41SBryan Venteicher }
50262a69c41SBryan Venteicher 
50362a69c41SBryan Venteicher static int
5049da9560cSBryan Venteicher vtpci_alloc_interrupt(struct vtpci_common *cn, int rid, int flags,
50562a69c41SBryan Venteicher     struct vtpci_interrupt *intr)
50662a69c41SBryan Venteicher {
50762a69c41SBryan Venteicher 	struct resource *irq;
50862a69c41SBryan Venteicher 
5099da9560cSBryan Venteicher 	irq = bus_alloc_resource_any(cn->vtpci_dev, SYS_RES_IRQ, &rid, flags);
51062a69c41SBryan Venteicher 	if (irq == NULL)
51162a69c41SBryan Venteicher 		return (ENXIO);
51262a69c41SBryan Venteicher 
51362a69c41SBryan Venteicher 	intr->vti_irq = irq;
51462a69c41SBryan Venteicher 	intr->vti_rid = rid;
515310dacd0SPeter Grehan 
516310dacd0SPeter Grehan 	return (0);
517310dacd0SPeter Grehan }
518310dacd0SPeter Grehan 
51910b59a9bSPeter Grehan static void
5209da9560cSBryan Venteicher vtpci_free_interrupt(struct vtpci_common *cn, struct vtpci_interrupt *intr)
52110b59a9bSPeter Grehan {
52210b59a9bSPeter Grehan 	device_t dev;
52310b59a9bSPeter Grehan 
5249da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
52510b59a9bSPeter Grehan 
52662a69c41SBryan Venteicher 	if (intr->vti_handler != NULL) {
52762a69c41SBryan Venteicher 		bus_teardown_intr(dev, intr->vti_irq, intr->vti_handler);
52862a69c41SBryan Venteicher 		intr->vti_handler = NULL;
52910b59a9bSPeter Grehan 	}
53010b59a9bSPeter Grehan 
53162a69c41SBryan Venteicher 	if (intr->vti_irq != NULL) {
53262a69c41SBryan Venteicher 		bus_release_resource(dev, SYS_RES_IRQ, intr->vti_rid,
53362a69c41SBryan Venteicher 		    intr->vti_irq);
53462a69c41SBryan Venteicher 		intr->vti_irq = NULL;
53562a69c41SBryan Venteicher 		intr->vti_rid = -1;
53662a69c41SBryan Venteicher 	}
53710b59a9bSPeter Grehan }
53810b59a9bSPeter Grehan 
53962a69c41SBryan Venteicher static void
5409da9560cSBryan Venteicher vtpci_free_interrupts(struct vtpci_common *cn)
54162a69c41SBryan Venteicher {
54262a69c41SBryan Venteicher 	struct vtpci_interrupt *intr;
54362a69c41SBryan Venteicher 	int i, nvq_intrs;
54462a69c41SBryan Venteicher 
5459da9560cSBryan Venteicher 	vtpci_free_interrupt(cn, &cn->vtpci_device_interrupt);
54662a69c41SBryan Venteicher 
5479da9560cSBryan Venteicher 	if (cn->vtpci_nmsix_resources != 0) {
5489da9560cSBryan Venteicher 		nvq_intrs = cn->vtpci_nmsix_resources - 1;
5499da9560cSBryan Venteicher 		cn->vtpci_nmsix_resources = 0;
55062a69c41SBryan Venteicher 
5519da9560cSBryan Venteicher 		if ((intr = cn->vtpci_msix_vq_interrupts) != NULL) {
55262a69c41SBryan Venteicher 			for (i = 0; i < nvq_intrs; i++, intr++)
5539da9560cSBryan Venteicher 				vtpci_free_interrupt(cn, intr);
55462a69c41SBryan Venteicher 
5559da9560cSBryan Venteicher 			free(cn->vtpci_msix_vq_interrupts, M_DEVBUF);
5569da9560cSBryan Venteicher 			cn->vtpci_msix_vq_interrupts = NULL;
55762a69c41SBryan Venteicher 		}
55810b59a9bSPeter Grehan 	}
559310dacd0SPeter Grehan 
5609da9560cSBryan Venteicher 	if (cn->vtpci_flags & (VTPCI_FLAG_MSI | VTPCI_FLAG_MSIX))
5619da9560cSBryan Venteicher 		pci_release_msi(cn->vtpci_dev);
562310dacd0SPeter Grehan 
5639da9560cSBryan Venteicher 	cn->vtpci_flags &= ~VTPCI_FLAG_ITYPE_MASK;
56410b59a9bSPeter Grehan }
56510b59a9bSPeter Grehan 
56610b59a9bSPeter Grehan static void
5679da9560cSBryan Venteicher vtpci_free_virtqueues(struct vtpci_common *cn)
56810b59a9bSPeter Grehan {
56910b59a9bSPeter Grehan 	struct vtpci_virtqueue *vqx;
57062a69c41SBryan Venteicher 	int idx;
57110b59a9bSPeter Grehan 
5729da9560cSBryan Venteicher 	for (idx = 0; idx < cn->vtpci_nvqs; idx++) {
5739da9560cSBryan Venteicher 		vtpci_disable_vq(cn, idx);
57410b59a9bSPeter Grehan 
5759da9560cSBryan Venteicher 		vqx = &cn->vtpci_vqs[idx];
57662a69c41SBryan Venteicher 		virtqueue_free(vqx->vtv_vq);
57762a69c41SBryan Venteicher 		vqx->vtv_vq = NULL;
57810b59a9bSPeter Grehan 	}
579310dacd0SPeter Grehan 
5809da9560cSBryan Venteicher 	free(cn->vtpci_vqs, M_DEVBUF);
5819da9560cSBryan Venteicher 	cn->vtpci_vqs = NULL;
5829da9560cSBryan Venteicher 	cn->vtpci_nvqs = 0;
58310b59a9bSPeter Grehan }
584310dacd0SPeter Grehan 
5859da9560cSBryan Venteicher void
5869da9560cSBryan Venteicher vtpci_release_child_resources(struct vtpci_common *cn)
58762a69c41SBryan Venteicher {
58862a69c41SBryan Venteicher 
5899da9560cSBryan Venteicher 	vtpci_free_interrupts(cn);
5909da9560cSBryan Venteicher 	vtpci_free_virtqueues(cn);
59162a69c41SBryan Venteicher }
59262a69c41SBryan Venteicher 
59362a69c41SBryan Venteicher static void
5949da9560cSBryan Venteicher vtpci_cleanup_setup_intr_attempt(struct vtpci_common *cn)
595310dacd0SPeter Grehan {
596310dacd0SPeter Grehan 	int idx;
597310dacd0SPeter Grehan 
5989da9560cSBryan Venteicher 	if (cn->vtpci_flags & VTPCI_FLAG_MSIX) {
5999da9560cSBryan Venteicher 		vtpci_register_cfg_msix(cn, NULL);
600310dacd0SPeter Grehan 
6019da9560cSBryan Venteicher 		for (idx = 0; idx < cn->vtpci_nvqs; idx++)
6029da9560cSBryan Venteicher 			vtpci_register_vq_msix(cn, idx, NULL);
603310dacd0SPeter Grehan 	}
604310dacd0SPeter Grehan 
6059da9560cSBryan Venteicher 	vtpci_free_interrupts(cn);
60610b59a9bSPeter Grehan }
60710b59a9bSPeter Grehan 
6089da9560cSBryan Venteicher static int
6099da9560cSBryan Venteicher vtpci_alloc_intr_resources(struct vtpci_common *cn)
61010b59a9bSPeter Grehan {
6119da9560cSBryan Venteicher 	struct vtpci_interrupt *intr;
6129da9560cSBryan Venteicher 	int i, rid, flags, nvq_intrs, error;
6139da9560cSBryan Venteicher 
6149da9560cSBryan Venteicher 	flags = RF_ACTIVE;
6159da9560cSBryan Venteicher 
6169da9560cSBryan Venteicher 	if (cn->vtpci_flags & VTPCI_FLAG_INTX) {
6179da9560cSBryan Venteicher 		rid = 0;
6189da9560cSBryan Venteicher 		flags |= RF_SHAREABLE;
6199da9560cSBryan Venteicher 	} else
6209da9560cSBryan Venteicher 		rid = 1;
62110b59a9bSPeter Grehan 
62210b59a9bSPeter Grehan 	/*
6239da9560cSBryan Venteicher 	 * When using INTX or MSI interrupts, this resource handles all
6249da9560cSBryan Venteicher 	 * interrupts. When using MSIX, this resource handles just the
6259da9560cSBryan Venteicher 	 * configuration changed interrupt.
62610b59a9bSPeter Grehan 	 */
6279da9560cSBryan Venteicher 	intr = &cn->vtpci_device_interrupt;
6289da9560cSBryan Venteicher 
6299da9560cSBryan Venteicher 	error = vtpci_alloc_interrupt(cn, rid, flags, intr);
6309da9560cSBryan Venteicher 	if (error || cn->vtpci_flags & (VTPCI_FLAG_INTX | VTPCI_FLAG_MSI))
6319da9560cSBryan Venteicher 		return (error);
6329da9560cSBryan Venteicher 
6339da9560cSBryan Venteicher 	/*
6349da9560cSBryan Venteicher 	 * Now allocate the interrupts for the virtqueues. This may be one
6359da9560cSBryan Venteicher 	 * for all the virtqueues, or one for each virtqueue. Subtract one
6369da9560cSBryan Venteicher 	 * below for because of the configuration changed interrupt.
6379da9560cSBryan Venteicher 	 */
6389da9560cSBryan Venteicher 	nvq_intrs = cn->vtpci_nmsix_resources - 1;
6399da9560cSBryan Venteicher 
6409da9560cSBryan Venteicher 	cn->vtpci_msix_vq_interrupts = malloc(nvq_intrs *
6419da9560cSBryan Venteicher 	    sizeof(struct vtpci_interrupt), M_DEVBUF, M_NOWAIT | M_ZERO);
6429da9560cSBryan Venteicher 	if (cn->vtpci_msix_vq_interrupts == NULL)
6439da9560cSBryan Venteicher 		return (ENOMEM);
6449da9560cSBryan Venteicher 
6459da9560cSBryan Venteicher 	intr = cn->vtpci_msix_vq_interrupts;
6469da9560cSBryan Venteicher 
6479da9560cSBryan Venteicher 	for (i = 0, rid++; i < nvq_intrs; i++, rid++, intr++) {
6489da9560cSBryan Venteicher 		error = vtpci_alloc_interrupt(cn, rid, flags, intr);
6499da9560cSBryan Venteicher 		if (error)
6509da9560cSBryan Venteicher 			return (error);
6519da9560cSBryan Venteicher 	}
6529da9560cSBryan Venteicher 
6539da9560cSBryan Venteicher 	return (0);
6549da9560cSBryan Venteicher }
6559da9560cSBryan Venteicher 
6569da9560cSBryan Venteicher static int
6579da9560cSBryan Venteicher vtpci_setup_intx_interrupt(struct vtpci_common *cn, enum intr_type type)
6589da9560cSBryan Venteicher {
6599da9560cSBryan Venteicher 	struct vtpci_interrupt *intr;
6609da9560cSBryan Venteicher 	int error;
6619da9560cSBryan Venteicher 
6629da9560cSBryan Venteicher 	intr = &cn->vtpci_device_interrupt;
6639da9560cSBryan Venteicher 
6649da9560cSBryan Venteicher 	error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type, NULL,
6659da9560cSBryan Venteicher 	    vtpci_intx_intr, cn, &intr->vti_handler);
6669da9560cSBryan Venteicher 
6679da9560cSBryan Venteicher 	return (error);
6689da9560cSBryan Venteicher }
6699da9560cSBryan Venteicher 
6709da9560cSBryan Venteicher static int
6719da9560cSBryan Venteicher vtpci_setup_pervq_msix_interrupts(struct vtpci_common *cn, enum intr_type type)
6729da9560cSBryan Venteicher {
6739da9560cSBryan Venteicher 	struct vtpci_virtqueue *vqx;
6749da9560cSBryan Venteicher 	struct vtpci_interrupt *intr;
6759da9560cSBryan Venteicher 	int i, error;
6769da9560cSBryan Venteicher 
6779da9560cSBryan Venteicher 	intr = cn->vtpci_msix_vq_interrupts;
6789da9560cSBryan Venteicher 
6799da9560cSBryan Venteicher 	for (i = 0; i < cn->vtpci_nvqs; i++) {
6809da9560cSBryan Venteicher 		vqx = &cn->vtpci_vqs[i];
6819da9560cSBryan Venteicher 
6829da9560cSBryan Venteicher 		if (vqx->vtv_no_intr)
6839da9560cSBryan Venteicher 			continue;
6849da9560cSBryan Venteicher 
6859da9560cSBryan Venteicher 		error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type,
6869da9560cSBryan Venteicher 		    vtpci_vq_intr_filter, vtpci_vq_intr, vqx->vtv_vq,
6879da9560cSBryan Venteicher 		    &intr->vti_handler);
6889da9560cSBryan Venteicher 		if (error)
6899da9560cSBryan Venteicher 			return (error);
6909da9560cSBryan Venteicher 
6919da9560cSBryan Venteicher 		intr++;
6929da9560cSBryan Venteicher 	}
6939da9560cSBryan Venteicher 
6949da9560cSBryan Venteicher 	return (0);
6959da9560cSBryan Venteicher }
6969da9560cSBryan Venteicher 
6979da9560cSBryan Venteicher static int
6989da9560cSBryan Venteicher vtpci_set_host_msix_vectors(struct vtpci_common *cn)
6999da9560cSBryan Venteicher {
7009da9560cSBryan Venteicher 	struct vtpci_interrupt *intr, *tintr;
7019da9560cSBryan Venteicher 	int idx, error;
7029da9560cSBryan Venteicher 
7039da9560cSBryan Venteicher 	intr = &cn->vtpci_device_interrupt;
7049da9560cSBryan Venteicher 	error = vtpci_register_cfg_msix(cn, intr);
7059da9560cSBryan Venteicher 	if (error)
7069da9560cSBryan Venteicher 		return (error);
7079da9560cSBryan Venteicher 
7089da9560cSBryan Venteicher 	intr = cn->vtpci_msix_vq_interrupts;
7099da9560cSBryan Venteicher 	for (idx = 0; idx < cn->vtpci_nvqs; idx++) {
7109da9560cSBryan Venteicher 		if (cn->vtpci_vqs[idx].vtv_no_intr)
7119da9560cSBryan Venteicher 			tintr = NULL;
7129da9560cSBryan Venteicher 		else
7139da9560cSBryan Venteicher 			tintr = intr;
7149da9560cSBryan Venteicher 
7159da9560cSBryan Venteicher 		error = vtpci_register_vq_msix(cn, idx, tintr);
7169da9560cSBryan Venteicher 		if (error)
7179da9560cSBryan Venteicher 			break;
7189da9560cSBryan Venteicher 
7199da9560cSBryan Venteicher 		/*
7209da9560cSBryan Venteicher 		 * For shared MSIX, all the virtqueues share the first
7219da9560cSBryan Venteicher 		 * interrupt.
7229da9560cSBryan Venteicher 		 */
7239da9560cSBryan Venteicher 		if (!cn->vtpci_vqs[idx].vtv_no_intr &&
7249da9560cSBryan Venteicher 		    (cn->vtpci_flags & VTPCI_FLAG_SHARED_MSIX) == 0)
7259da9560cSBryan Venteicher 			intr++;
7269da9560cSBryan Venteicher 	}
7279da9560cSBryan Venteicher 
7289da9560cSBryan Venteicher 	return (error);
7299da9560cSBryan Venteicher }
7309da9560cSBryan Venteicher 
7319da9560cSBryan Venteicher static int
7329da9560cSBryan Venteicher vtpci_setup_msix_interrupts(struct vtpci_common *cn, enum intr_type type)
7339da9560cSBryan Venteicher {
7349da9560cSBryan Venteicher 	struct vtpci_interrupt *intr;
7359da9560cSBryan Venteicher 	int error;
7369da9560cSBryan Venteicher 
7379da9560cSBryan Venteicher 	intr = &cn->vtpci_device_interrupt;
7389da9560cSBryan Venteicher 
7399da9560cSBryan Venteicher 	error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type, NULL,
7409da9560cSBryan Venteicher 	    vtpci_config_intr, cn, &intr->vti_handler);
7419da9560cSBryan Venteicher 	if (error)
7429da9560cSBryan Venteicher 		return (error);
7439da9560cSBryan Venteicher 
7449da9560cSBryan Venteicher 	if (cn->vtpci_flags & VTPCI_FLAG_SHARED_MSIX) {
7459da9560cSBryan Venteicher 		intr = &cn->vtpci_msix_vq_interrupts[0];
7469da9560cSBryan Venteicher 
7479da9560cSBryan Venteicher 		error = bus_setup_intr(cn->vtpci_dev, intr->vti_irq, type,
7489da9560cSBryan Venteicher 		    vtpci_vq_shared_intr_filter, vtpci_vq_shared_intr, cn,
7499da9560cSBryan Venteicher 		    &intr->vti_handler);
7509da9560cSBryan Venteicher 	} else
7519da9560cSBryan Venteicher 		error = vtpci_setup_pervq_msix_interrupts(cn, type);
7529da9560cSBryan Venteicher 
7539da9560cSBryan Venteicher 	return (error ? error : vtpci_set_host_msix_vectors(cn));
7549da9560cSBryan Venteicher }
7559da9560cSBryan Venteicher 
7569da9560cSBryan Venteicher static int
7579da9560cSBryan Venteicher vtpci_setup_intrs(struct vtpci_common *cn, enum intr_type type)
7589da9560cSBryan Venteicher {
7599da9560cSBryan Venteicher 	int error;
7609da9560cSBryan Venteicher 
7619da9560cSBryan Venteicher 	type |= INTR_MPSAFE;
7629da9560cSBryan Venteicher 	KASSERT(cn->vtpci_flags & VTPCI_FLAG_ITYPE_MASK,
7639da9560cSBryan Venteicher 	    ("%s: no interrupt type selected %#x", __func__, cn->vtpci_flags));
7649da9560cSBryan Venteicher 
7659da9560cSBryan Venteicher 	error = vtpci_alloc_intr_resources(cn);
7669da9560cSBryan Venteicher 	if (error)
7679da9560cSBryan Venteicher 		return (error);
7689da9560cSBryan Venteicher 
7699da9560cSBryan Venteicher 	if (cn->vtpci_flags & VTPCI_FLAG_INTX)
7709da9560cSBryan Venteicher 		error = vtpci_setup_intx_interrupt(cn, type);
7719da9560cSBryan Venteicher 	else if (cn->vtpci_flags & VTPCI_FLAG_MSI)
7729da9560cSBryan Venteicher 		error = vtpci_setup_msi_interrupt(cn, type);
7739da9560cSBryan Venteicher 	else
7749da9560cSBryan Venteicher 		error = vtpci_setup_msix_interrupts(cn, type);
7759da9560cSBryan Venteicher 
7769da9560cSBryan Venteicher 	return (error);
7779da9560cSBryan Venteicher }
7789da9560cSBryan Venteicher 
7799da9560cSBryan Venteicher int
7809da9560cSBryan Venteicher vtpci_setup_interrupts(struct vtpci_common *cn, enum intr_type type)
7819da9560cSBryan Venteicher {
7829da9560cSBryan Venteicher 	device_t dev;
7839da9560cSBryan Venteicher 	int attempt, error;
7849da9560cSBryan Venteicher 
7859da9560cSBryan Venteicher 	dev = cn->vtpci_dev;
7869da9560cSBryan Venteicher 
7879da9560cSBryan Venteicher 	for (attempt = 0; attempt < 5; attempt++) {
7889da9560cSBryan Venteicher 		/*
7899da9560cSBryan Venteicher 		 * Start with the most desirable interrupt configuration and
7909da9560cSBryan Venteicher 		 * fallback towards less desirable ones.
7919da9560cSBryan Venteicher 		 */
7929da9560cSBryan Venteicher 		switch (attempt) {
7939da9560cSBryan Venteicher 		case 0:
7949da9560cSBryan Venteicher 			error = vtpci_alloc_intr_msix_pervq(cn);
7959da9560cSBryan Venteicher 			break;
7969da9560cSBryan Venteicher 		case 1:
7979da9560cSBryan Venteicher 			error = vtpci_alloc_intr_msix_shared(cn);
7989da9560cSBryan Venteicher 			break;
7999da9560cSBryan Venteicher 		case 2:
8009da9560cSBryan Venteicher 			error = vtpci_alloc_intr_msi(cn);
8019da9560cSBryan Venteicher 			break;
8029da9560cSBryan Venteicher 		case 3:
8039da9560cSBryan Venteicher 			error = vtpci_alloc_intr_intx(cn);
8049da9560cSBryan Venteicher 			break;
8059da9560cSBryan Venteicher 		default:
8069da9560cSBryan Venteicher 			device_printf(dev,
8079da9560cSBryan Venteicher 			    "exhausted all interrupt allocation attempts\n");
8089da9560cSBryan Venteicher 			return (ENXIO);
8099da9560cSBryan Venteicher 		}
8109da9560cSBryan Venteicher 
8119da9560cSBryan Venteicher 		if (error == 0 && vtpci_setup_intrs(cn, type) == 0)
8129da9560cSBryan Venteicher 			break;
8139da9560cSBryan Venteicher 
8149da9560cSBryan Venteicher 		vtpci_cleanup_setup_intr_attempt(cn);
8159da9560cSBryan Venteicher 	}
8169da9560cSBryan Venteicher 
8179da9560cSBryan Venteicher 	if (bootverbose) {
8189da9560cSBryan Venteicher 		if (cn->vtpci_flags & VTPCI_FLAG_INTX)
8199da9560cSBryan Venteicher 			device_printf(dev, "using legacy interrupt\n");
8209da9560cSBryan Venteicher 		else if (cn->vtpci_flags & VTPCI_FLAG_MSI)
8219da9560cSBryan Venteicher 			device_printf(dev, "using MSI interrupt\n");
8229da9560cSBryan Venteicher 		else if (cn->vtpci_flags & VTPCI_FLAG_SHARED_MSIX)
8239da9560cSBryan Venteicher 			device_printf(dev, "using shared MSIX interrupts\n");
8249da9560cSBryan Venteicher 		else
8259da9560cSBryan Venteicher 			device_printf(dev, "using per VQ MSIX interrupts\n");
8269da9560cSBryan Venteicher 	}
8279da9560cSBryan Venteicher 
8289da9560cSBryan Venteicher 	return (0);
8299da9560cSBryan Venteicher }
8309da9560cSBryan Venteicher 
8319da9560cSBryan Venteicher static int
8329da9560cSBryan Venteicher vtpci_reinit_virtqueue(struct vtpci_common *cn, int idx)
8339da9560cSBryan Venteicher {
8349da9560cSBryan Venteicher 	struct vtpci_virtqueue *vqx;
8359da9560cSBryan Venteicher 	struct virtqueue *vq;
8369da9560cSBryan Venteicher 	int error;
8379da9560cSBryan Venteicher 
8389da9560cSBryan Venteicher 	vqx = &cn->vtpci_vqs[idx];
8399da9560cSBryan Venteicher 	vq = vqx->vtv_vq;
8409da9560cSBryan Venteicher 
8419da9560cSBryan Venteicher 	KASSERT(vq != NULL, ("%s: vq %d not allocated", __func__, idx));
8429da9560cSBryan Venteicher 
8439da9560cSBryan Venteicher 	error = virtqueue_reinit(vq, vtpci_get_vq_size(cn, idx));
8449da9560cSBryan Venteicher 	if (error == 0)
8459da9560cSBryan Venteicher 		vtpci_set_vq(cn, vq);
8469da9560cSBryan Venteicher 
8479da9560cSBryan Venteicher 	return (error);
84810b59a9bSPeter Grehan }
84910b59a9bSPeter Grehan 
850310dacd0SPeter Grehan static void
8519da9560cSBryan Venteicher vtpci_intx_intr(void *xcn)
852310dacd0SPeter Grehan {
8539da9560cSBryan Venteicher 	struct vtpci_common *cn;
85410b59a9bSPeter Grehan 	struct vtpci_virtqueue *vqx;
85510b59a9bSPeter Grehan 	int i;
85610b59a9bSPeter Grehan 	uint8_t isr;
85710b59a9bSPeter Grehan 
8589da9560cSBryan Venteicher 	cn = xcn;
8599da9560cSBryan Venteicher 	isr = vtpci_read_isr(cn);
86010b59a9bSPeter Grehan 
86110b59a9bSPeter Grehan 	if (isr & VIRTIO_PCI_ISR_CONFIG)
8629da9560cSBryan Venteicher 		vtpci_config_intr(cn);
86310b59a9bSPeter Grehan 
8646632efe4SBryan Venteicher 	if (isr & VIRTIO_PCI_ISR_INTR) {
8659da9560cSBryan Venteicher 		vqx = &cn->vtpci_vqs[0];
8669da9560cSBryan Venteicher 		for (i = 0; i < cn->vtpci_nvqs; i++, vqx++) {
86762a69c41SBryan Venteicher 			if (vqx->vtv_no_intr == 0)
86862a69c41SBryan Venteicher 				virtqueue_intr(vqx->vtv_vq);
86962a69c41SBryan Venteicher 		}
8706632efe4SBryan Venteicher 	}
87110b59a9bSPeter Grehan }
87210b59a9bSPeter Grehan 
87310b59a9bSPeter Grehan static int
8749da9560cSBryan Venteicher vtpci_vq_shared_intr_filter(void *xcn)
87510b59a9bSPeter Grehan {
8769da9560cSBryan Venteicher 	struct vtpci_common *cn;
87710b59a9bSPeter Grehan 	struct vtpci_virtqueue *vqx;
87810b59a9bSPeter Grehan 	int i, rc;
87910b59a9bSPeter Grehan 
8809da9560cSBryan Venteicher 	cn = xcn;
8819da9560cSBryan Venteicher 	vqx = &cn->vtpci_vqs[0];
88210b59a9bSPeter Grehan 	rc = 0;
88310b59a9bSPeter Grehan 
8849da9560cSBryan Venteicher 	for (i = 0; i < cn->vtpci_nvqs; i++, vqx++) {
88562a69c41SBryan Venteicher 		if (vqx->vtv_no_intr == 0)
88662a69c41SBryan Venteicher 			rc |= virtqueue_intr_filter(vqx->vtv_vq);
88762a69c41SBryan Venteicher 	}
88810b59a9bSPeter Grehan 
8896632efe4SBryan Venteicher 	return (rc ? FILTER_SCHEDULE_THREAD : FILTER_STRAY);
8906632efe4SBryan Venteicher }
8916632efe4SBryan Venteicher 
8926632efe4SBryan Venteicher static void
8939da9560cSBryan Venteicher vtpci_vq_shared_intr(void *xcn)
8946632efe4SBryan Venteicher {
8959da9560cSBryan Venteicher 	struct vtpci_common *cn;
8966632efe4SBryan Venteicher 	struct vtpci_virtqueue *vqx;
8976632efe4SBryan Venteicher 	int i;
8986632efe4SBryan Venteicher 
8999da9560cSBryan Venteicher 	cn = xcn;
9009da9560cSBryan Venteicher 	vqx = &cn->vtpci_vqs[0];
9016632efe4SBryan Venteicher 
9029da9560cSBryan Venteicher 	for (i = 0; i < cn->vtpci_nvqs; i++, vqx++) {
90362a69c41SBryan Venteicher 		if (vqx->vtv_no_intr == 0)
90462a69c41SBryan Venteicher 			virtqueue_intr(vqx->vtv_vq);
90562a69c41SBryan Venteicher 	}
90610b59a9bSPeter Grehan }
90710b59a9bSPeter Grehan 
90810b59a9bSPeter Grehan static int
9096632efe4SBryan Venteicher vtpci_vq_intr_filter(void *xvq)
91010b59a9bSPeter Grehan {
91110b59a9bSPeter Grehan 	struct virtqueue *vq;
91210b59a9bSPeter Grehan 	int rc;
91310b59a9bSPeter Grehan 
91410b59a9bSPeter Grehan 	vq = xvq;
9156632efe4SBryan Venteicher 	rc = virtqueue_intr_filter(vq);
91610b59a9bSPeter Grehan 
9176632efe4SBryan Venteicher 	return (rc ? FILTER_SCHEDULE_THREAD : FILTER_STRAY);
91810b59a9bSPeter Grehan }
91910b59a9bSPeter Grehan 
9206632efe4SBryan Venteicher static void
9216632efe4SBryan Venteicher vtpci_vq_intr(void *xvq)
9226632efe4SBryan Venteicher {
9236632efe4SBryan Venteicher 	struct virtqueue *vq;
9246632efe4SBryan Venteicher 
9256632efe4SBryan Venteicher 	vq = xvq;
9266632efe4SBryan Venteicher 	virtqueue_intr(vq);
9276632efe4SBryan Venteicher }
9286632efe4SBryan Venteicher 
9296632efe4SBryan Venteicher static void
9309da9560cSBryan Venteicher vtpci_config_intr(void *xcn)
93110b59a9bSPeter Grehan {
9329da9560cSBryan Venteicher 	struct vtpci_common *cn;
93310b59a9bSPeter Grehan 	device_t child;
93410b59a9bSPeter Grehan 
9359da9560cSBryan Venteicher 	cn = xcn;
9369da9560cSBryan Venteicher 	child = cn->vtpci_child_dev;
93710b59a9bSPeter Grehan 
93810b59a9bSPeter Grehan 	if (child != NULL)
9396632efe4SBryan Venteicher 		VIRTIO_CONFIG_CHANGE(child);
94010b59a9bSPeter Grehan }
941703f17d6SBryan Venteicher 
942703f17d6SBryan Venteicher static int
943703f17d6SBryan Venteicher vtpci_feature_sysctl(struct sysctl_req *req, struct vtpci_common *cn,
944703f17d6SBryan Venteicher     uint64_t features)
945703f17d6SBryan Venteicher {
946703f17d6SBryan Venteicher 	struct sbuf *sb;
947703f17d6SBryan Venteicher 	int error;
948703f17d6SBryan Venteicher 
949703f17d6SBryan Venteicher 	sb = sbuf_new_for_sysctl(NULL, NULL, 256, req);
950703f17d6SBryan Venteicher 	if (sb == NULL)
951703f17d6SBryan Venteicher 		return (ENOMEM);
952703f17d6SBryan Venteicher 
953703f17d6SBryan Venteicher 	error = virtio_describe_sbuf(sb, features, cn->vtpci_child_feat_desc);
954703f17d6SBryan Venteicher 	sbuf_delete(sb);
955703f17d6SBryan Venteicher 
956703f17d6SBryan Venteicher 	return (error);
957703f17d6SBryan Venteicher }
958703f17d6SBryan Venteicher 
959703f17d6SBryan Venteicher static int
960703f17d6SBryan Venteicher vtpci_host_features_sysctl(SYSCTL_HANDLER_ARGS)
961703f17d6SBryan Venteicher {
962703f17d6SBryan Venteicher 	struct vtpci_common *cn;
963703f17d6SBryan Venteicher 
964703f17d6SBryan Venteicher 	cn = arg1;
965703f17d6SBryan Venteicher 
966703f17d6SBryan Venteicher 	return (vtpci_feature_sysctl(req, cn, cn->vtpci_host_features));
967703f17d6SBryan Venteicher }
968703f17d6SBryan Venteicher 
969703f17d6SBryan Venteicher static int
970703f17d6SBryan Venteicher vtpci_negotiated_features_sysctl(SYSCTL_HANDLER_ARGS)
971703f17d6SBryan Venteicher {
972703f17d6SBryan Venteicher 	struct vtpci_common *cn;
973703f17d6SBryan Venteicher 
974703f17d6SBryan Venteicher 	cn = arg1;
975703f17d6SBryan Venteicher 
976703f17d6SBryan Venteicher 	return (vtpci_feature_sysctl(req, cn, cn->vtpci_features));
977703f17d6SBryan Venteicher }
978703f17d6SBryan Venteicher 
979703f17d6SBryan Venteicher static void
980703f17d6SBryan Venteicher vtpci_setup_sysctl(struct vtpci_common *cn)
981703f17d6SBryan Venteicher {
982703f17d6SBryan Venteicher 	device_t dev;
983703f17d6SBryan Venteicher 	struct sysctl_ctx_list *ctx;
984703f17d6SBryan Venteicher 	struct sysctl_oid *tree;
985703f17d6SBryan Venteicher 	struct sysctl_oid_list *child;
986703f17d6SBryan Venteicher 
987703f17d6SBryan Venteicher 	dev = cn->vtpci_dev;
988703f17d6SBryan Venteicher 	ctx = device_get_sysctl_ctx(dev);
989703f17d6SBryan Venteicher 	tree = device_get_sysctl_tree(dev);
990703f17d6SBryan Venteicher 	child = SYSCTL_CHILDREN(tree);
991703f17d6SBryan Venteicher 
992703f17d6SBryan Venteicher 	SYSCTL_ADD_INT(ctx, child, OID_AUTO, "nvqs",
993703f17d6SBryan Venteicher 	    CTLFLAG_RD, &cn->vtpci_nvqs, 0, "Number of virtqueues");
994703f17d6SBryan Venteicher 
995703f17d6SBryan Venteicher 	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "host_features",
996703f17d6SBryan Venteicher 	    CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, cn, 0,
997703f17d6SBryan Venteicher 	    vtpci_host_features_sysctl, "A", "Features supported by the host");
998703f17d6SBryan Venteicher 	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "negotiated_features",
999703f17d6SBryan Venteicher 	    CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, cn, 0,
1000703f17d6SBryan Venteicher 	    vtpci_negotiated_features_sysctl, "A", "Features negotiated");
1001703f17d6SBryan Venteicher }
1002