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