File descriptor vdpa_device_fd is not free in the case of returning
error from vhost_vdpa_get_features. Fixing it by making all errors go to
the same error path.
Resolves: Coverity CID 1490785
Fixes: 8170ab3f43 ("vdpa: Extract get features part from vhost_vdpa_get_max_queue_pairs")
Signed-off-by: Eugenio Pérez <eperezma@redhat.com>
Reviewed-by: Laurent Vivier <lvivier@redhat.com>
Reviewed-by: Michael S. Tsirkin <mst@redhat.com>
Message-Id: <20220802112447.249436-2-eperezma@redhat.com>
Signed-off-by: Laurent Vivier <laurent@vivier.eu>
		
	
			
		
			
				
	
	
		
			648 lines
		
	
	
		
			19 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			648 lines
		
	
	
		
			19 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * vhost-vdpa.c
 | 
						|
 *
 | 
						|
 * Copyright(c) 2017-2018 Intel Corporation.
 | 
						|
 * Copyright(c) 2020 Red Hat, Inc.
 | 
						|
 *
 | 
						|
 * This work is licensed under the terms of the GNU GPL, version 2 or later.
 | 
						|
 * See the COPYING file in the top-level directory.
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
#include "qemu/osdep.h"
 | 
						|
#include "clients.h"
 | 
						|
#include "hw/virtio/virtio-net.h"
 | 
						|
#include "net/vhost_net.h"
 | 
						|
#include "net/vhost-vdpa.h"
 | 
						|
#include "hw/virtio/vhost-vdpa.h"
 | 
						|
#include "qemu/config-file.h"
 | 
						|
#include "qemu/error-report.h"
 | 
						|
#include "qemu/log.h"
 | 
						|
#include "qemu/memalign.h"
 | 
						|
#include "qemu/option.h"
 | 
						|
#include "qapi/error.h"
 | 
						|
#include <linux/vhost.h>
 | 
						|
#include <sys/ioctl.h>
 | 
						|
#include <err.h>
 | 
						|
#include "standard-headers/linux/virtio_net.h"
 | 
						|
#include "monitor/monitor.h"
 | 
						|
#include "hw/virtio/vhost.h"
 | 
						|
 | 
						|
/* Todo:need to add the multiqueue support here */
 | 
						|
typedef struct VhostVDPAState {
 | 
						|
    NetClientState nc;
 | 
						|
    struct vhost_vdpa vhost_vdpa;
 | 
						|
    VHostNetState *vhost_net;
 | 
						|
 | 
						|
    /* Control commands shadow buffers */
 | 
						|
    void *cvq_cmd_out_buffer, *cvq_cmd_in_buffer;
 | 
						|
    bool started;
 | 
						|
} VhostVDPAState;
 | 
						|
 | 
						|
const int vdpa_feature_bits[] = {
 | 
						|
    VIRTIO_F_NOTIFY_ON_EMPTY,
 | 
						|
    VIRTIO_RING_F_INDIRECT_DESC,
 | 
						|
    VIRTIO_RING_F_EVENT_IDX,
 | 
						|
    VIRTIO_F_ANY_LAYOUT,
 | 
						|
    VIRTIO_F_VERSION_1,
 | 
						|
    VIRTIO_NET_F_CSUM,
 | 
						|
    VIRTIO_NET_F_GUEST_CSUM,
 | 
						|
    VIRTIO_NET_F_GSO,
 | 
						|
    VIRTIO_NET_F_GUEST_TSO4,
 | 
						|
    VIRTIO_NET_F_GUEST_TSO6,
 | 
						|
    VIRTIO_NET_F_GUEST_ECN,
 | 
						|
    VIRTIO_NET_F_GUEST_UFO,
 | 
						|
    VIRTIO_NET_F_HOST_TSO4,
 | 
						|
    VIRTIO_NET_F_HOST_TSO6,
 | 
						|
    VIRTIO_NET_F_HOST_ECN,
 | 
						|
    VIRTIO_NET_F_HOST_UFO,
 | 
						|
    VIRTIO_NET_F_MRG_RXBUF,
 | 
						|
    VIRTIO_NET_F_MTU,
 | 
						|
    VIRTIO_NET_F_CTRL_RX,
 | 
						|
    VIRTIO_NET_F_CTRL_RX_EXTRA,
 | 
						|
    VIRTIO_NET_F_CTRL_VLAN,
 | 
						|
    VIRTIO_NET_F_GUEST_ANNOUNCE,
 | 
						|
    VIRTIO_NET_F_CTRL_MAC_ADDR,
 | 
						|
    VIRTIO_NET_F_RSS,
 | 
						|
    VIRTIO_NET_F_MQ,
 | 
						|
    VIRTIO_NET_F_CTRL_VQ,
 | 
						|
    VIRTIO_F_IOMMU_PLATFORM,
 | 
						|
    VIRTIO_F_RING_PACKED,
 | 
						|
    VIRTIO_NET_F_RSS,
 | 
						|
    VIRTIO_NET_F_HASH_REPORT,
 | 
						|
    VIRTIO_NET_F_GUEST_ANNOUNCE,
 | 
						|
    VIRTIO_NET_F_STATUS,
 | 
						|
    VHOST_INVALID_FEATURE_BIT
 | 
						|
};
 | 
						|
 | 
						|
/** Supported device specific feature bits with SVQ */
 | 
						|
static const uint64_t vdpa_svq_device_features =
 | 
						|
    BIT_ULL(VIRTIO_NET_F_CSUM) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_GUEST_CSUM) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_MTU) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_MAC) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_GUEST_TSO4) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_GUEST_TSO6) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_GUEST_ECN) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_GUEST_UFO) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_HOST_TSO4) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_HOST_TSO6) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_HOST_ECN) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_HOST_UFO) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_MRG_RXBUF) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_STATUS) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_CTRL_VQ) |
 | 
						|
    BIT_ULL(VIRTIO_F_ANY_LAYOUT) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_CTRL_MAC_ADDR) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_RSC_EXT) |
 | 
						|
    BIT_ULL(VIRTIO_NET_F_STANDBY);
 | 
						|
 | 
						|
VHostNetState *vhost_vdpa_get_vhost_net(NetClientState *nc)
 | 
						|
{
 | 
						|
    VhostVDPAState *s = DO_UPCAST(VhostVDPAState, nc, nc);
 | 
						|
    assert(nc->info->type == NET_CLIENT_DRIVER_VHOST_VDPA);
 | 
						|
    return s->vhost_net;
 | 
						|
}
 | 
						|
 | 
						|
static int vhost_vdpa_net_check_device_id(struct vhost_net *net)
 | 
						|
{
 | 
						|
    uint32_t device_id;
 | 
						|
    int ret;
 | 
						|
    struct vhost_dev *hdev;
 | 
						|
 | 
						|
    hdev = (struct vhost_dev *)&net->dev;
 | 
						|
    ret = hdev->vhost_ops->vhost_get_device_id(hdev, &device_id);
 | 
						|
    if (device_id != VIRTIO_ID_NET) {
 | 
						|
        return -ENOTSUP;
 | 
						|
    }
 | 
						|
    return ret;
 | 
						|
}
 | 
						|
 | 
						|
static int vhost_vdpa_add(NetClientState *ncs, void *be,
 | 
						|
                          int queue_pair_index, int nvqs)
 | 
						|
{
 | 
						|
    VhostNetOptions options;
 | 
						|
    struct vhost_net *net = NULL;
 | 
						|
    VhostVDPAState *s;
 | 
						|
    int ret;
 | 
						|
 | 
						|
    options.backend_type = VHOST_BACKEND_TYPE_VDPA;
 | 
						|
    assert(ncs->info->type == NET_CLIENT_DRIVER_VHOST_VDPA);
 | 
						|
    s = DO_UPCAST(VhostVDPAState, nc, ncs);
 | 
						|
    options.net_backend = ncs;
 | 
						|
    options.opaque      = be;
 | 
						|
    options.busyloop_timeout = 0;
 | 
						|
    options.nvqs = nvqs;
 | 
						|
 | 
						|
    net = vhost_net_init(&options);
 | 
						|
    if (!net) {
 | 
						|
        error_report("failed to init vhost_net for queue");
 | 
						|
        goto err_init;
 | 
						|
    }
 | 
						|
    s->vhost_net = net;
 | 
						|
    ret = vhost_vdpa_net_check_device_id(net);
 | 
						|
    if (ret) {
 | 
						|
        goto err_check;
 | 
						|
    }
 | 
						|
    return 0;
 | 
						|
err_check:
 | 
						|
    vhost_net_cleanup(net);
 | 
						|
    g_free(net);
 | 
						|
err_init:
 | 
						|
    return -1;
 | 
						|
}
 | 
						|
 | 
						|
static void vhost_vdpa_cleanup(NetClientState *nc)
 | 
						|
{
 | 
						|
    VhostVDPAState *s = DO_UPCAST(VhostVDPAState, nc, nc);
 | 
						|
    struct vhost_dev *dev = &s->vhost_net->dev;
 | 
						|
 | 
						|
    qemu_vfree(s->cvq_cmd_out_buffer);
 | 
						|
    qemu_vfree(s->cvq_cmd_in_buffer);
 | 
						|
    if (dev->vq_index + dev->nvqs == dev->vq_index_end) {
 | 
						|
        g_clear_pointer(&s->vhost_vdpa.iova_tree, vhost_iova_tree_delete);
 | 
						|
    }
 | 
						|
    if (s->vhost_net) {
 | 
						|
        vhost_net_cleanup(s->vhost_net);
 | 
						|
        g_free(s->vhost_net);
 | 
						|
        s->vhost_net = NULL;
 | 
						|
    }
 | 
						|
     if (s->vhost_vdpa.device_fd >= 0) {
 | 
						|
        qemu_close(s->vhost_vdpa.device_fd);
 | 
						|
        s->vhost_vdpa.device_fd = -1;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static bool vhost_vdpa_has_vnet_hdr(NetClientState *nc)
 | 
						|
{
 | 
						|
    assert(nc->info->type == NET_CLIENT_DRIVER_VHOST_VDPA);
 | 
						|
 | 
						|
    return true;
 | 
						|
}
 | 
						|
 | 
						|
static bool vhost_vdpa_has_ufo(NetClientState *nc)
 | 
						|
{
 | 
						|
    assert(nc->info->type == NET_CLIENT_DRIVER_VHOST_VDPA);
 | 
						|
    VhostVDPAState *s = DO_UPCAST(VhostVDPAState, nc, nc);
 | 
						|
    uint64_t features = 0;
 | 
						|
    features |= (1ULL << VIRTIO_NET_F_HOST_UFO);
 | 
						|
    features = vhost_net_get_features(s->vhost_net, features);
 | 
						|
    return !!(features & (1ULL << VIRTIO_NET_F_HOST_UFO));
 | 
						|
 | 
						|
}
 | 
						|
 | 
						|
static bool vhost_vdpa_check_peer_type(NetClientState *nc, ObjectClass *oc,
 | 
						|
                                       Error **errp)
 | 
						|
{
 | 
						|
    const char *driver = object_class_get_name(oc);
 | 
						|
 | 
						|
    if (!g_str_has_prefix(driver, "virtio-net-")) {
 | 
						|
        error_setg(errp, "vhost-vdpa requires frontend driver virtio-net-*");
 | 
						|
        return false;
 | 
						|
    }
 | 
						|
 | 
						|
    return true;
 | 
						|
}
 | 
						|
 | 
						|
/** Dummy receive in case qemu falls back to userland tap networking */
 | 
						|
static ssize_t vhost_vdpa_receive(NetClientState *nc, const uint8_t *buf,
 | 
						|
                                  size_t size)
 | 
						|
{
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static NetClientInfo net_vhost_vdpa_info = {
 | 
						|
        .type = NET_CLIENT_DRIVER_VHOST_VDPA,
 | 
						|
        .size = sizeof(VhostVDPAState),
 | 
						|
        .receive = vhost_vdpa_receive,
 | 
						|
        .cleanup = vhost_vdpa_cleanup,
 | 
						|
        .has_vnet_hdr = vhost_vdpa_has_vnet_hdr,
 | 
						|
        .has_ufo = vhost_vdpa_has_ufo,
 | 
						|
        .check_peer_type = vhost_vdpa_check_peer_type,
 | 
						|
};
 | 
						|
 | 
						|
static void vhost_vdpa_cvq_unmap_buf(struct vhost_vdpa *v, void *addr)
 | 
						|
{
 | 
						|
    VhostIOVATree *tree = v->iova_tree;
 | 
						|
    DMAMap needle = {
 | 
						|
        /*
 | 
						|
         * No need to specify size or to look for more translations since
 | 
						|
         * this contiguous chunk was allocated by us.
 | 
						|
         */
 | 
						|
        .translated_addr = (hwaddr)(uintptr_t)addr,
 | 
						|
    };
 | 
						|
    const DMAMap *map = vhost_iova_tree_find_iova(tree, &needle);
 | 
						|
    int r;
 | 
						|
 | 
						|
    if (unlikely(!map)) {
 | 
						|
        error_report("Cannot locate expected map");
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    r = vhost_vdpa_dma_unmap(v, map->iova, map->size + 1);
 | 
						|
    if (unlikely(r != 0)) {
 | 
						|
        error_report("Device cannot unmap: %s(%d)", g_strerror(r), r);
 | 
						|
    }
 | 
						|
 | 
						|
    vhost_iova_tree_remove(tree, map);
 | 
						|
}
 | 
						|
 | 
						|
static size_t vhost_vdpa_net_cvq_cmd_len(void)
 | 
						|
{
 | 
						|
    /*
 | 
						|
     * MAC_TABLE_SET is the ctrl command that produces the longer out buffer.
 | 
						|
     * In buffer is always 1 byte, so it should fit here
 | 
						|
     */
 | 
						|
    return sizeof(struct virtio_net_ctrl_hdr) +
 | 
						|
           2 * sizeof(struct virtio_net_ctrl_mac) +
 | 
						|
           MAC_TABLE_ENTRIES * ETH_ALEN;
 | 
						|
}
 | 
						|
 | 
						|
static size_t vhost_vdpa_net_cvq_cmd_page_len(void)
 | 
						|
{
 | 
						|
    return ROUND_UP(vhost_vdpa_net_cvq_cmd_len(), qemu_real_host_page_size());
 | 
						|
}
 | 
						|
 | 
						|
/** Copy and map a guest buffer. */
 | 
						|
static bool vhost_vdpa_cvq_map_buf(struct vhost_vdpa *v,
 | 
						|
                                   const struct iovec *out_data,
 | 
						|
                                   size_t out_num, size_t data_len, void *buf,
 | 
						|
                                   size_t *written, bool write)
 | 
						|
{
 | 
						|
    DMAMap map = {};
 | 
						|
    int r;
 | 
						|
 | 
						|
    if (unlikely(!data_len)) {
 | 
						|
        qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid legnth of %s buffer\n",
 | 
						|
                      __func__, write ? "in" : "out");
 | 
						|
        return false;
 | 
						|
    }
 | 
						|
 | 
						|
    *written = iov_to_buf(out_data, out_num, 0, buf, data_len);
 | 
						|
    map.translated_addr = (hwaddr)(uintptr_t)buf;
 | 
						|
    map.size = vhost_vdpa_net_cvq_cmd_page_len() - 1;
 | 
						|
    map.perm = write ? IOMMU_RW : IOMMU_RO,
 | 
						|
    r = vhost_iova_tree_map_alloc(v->iova_tree, &map);
 | 
						|
    if (unlikely(r != IOVA_OK)) {
 | 
						|
        error_report("Cannot map injected element");
 | 
						|
        return false;
 | 
						|
    }
 | 
						|
 | 
						|
    r = vhost_vdpa_dma_map(v, map.iova, vhost_vdpa_net_cvq_cmd_page_len(), buf,
 | 
						|
                           !write);
 | 
						|
    if (unlikely(r < 0)) {
 | 
						|
        goto dma_map_err;
 | 
						|
    }
 | 
						|
 | 
						|
    return true;
 | 
						|
 | 
						|
dma_map_err:
 | 
						|
    vhost_iova_tree_remove(v->iova_tree, &map);
 | 
						|
    return false;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * Copy the guest element into a dedicated buffer suitable to be sent to NIC
 | 
						|
 *
 | 
						|
 * @iov: [0] is the out buffer, [1] is the in one
 | 
						|
 */
 | 
						|
static bool vhost_vdpa_net_cvq_map_elem(VhostVDPAState *s,
 | 
						|
                                        VirtQueueElement *elem,
 | 
						|
                                        struct iovec *iov)
 | 
						|
{
 | 
						|
    size_t in_copied;
 | 
						|
    bool ok;
 | 
						|
 | 
						|
    iov[0].iov_base = s->cvq_cmd_out_buffer;
 | 
						|
    ok = vhost_vdpa_cvq_map_buf(&s->vhost_vdpa, elem->out_sg, elem->out_num,
 | 
						|
                                vhost_vdpa_net_cvq_cmd_len(), iov[0].iov_base,
 | 
						|
                                &iov[0].iov_len, false);
 | 
						|
    if (unlikely(!ok)) {
 | 
						|
        return false;
 | 
						|
    }
 | 
						|
 | 
						|
    iov[1].iov_base = s->cvq_cmd_in_buffer;
 | 
						|
    ok = vhost_vdpa_cvq_map_buf(&s->vhost_vdpa, NULL, 0,
 | 
						|
                                sizeof(virtio_net_ctrl_ack), iov[1].iov_base,
 | 
						|
                                &in_copied, true);
 | 
						|
    if (unlikely(!ok)) {
 | 
						|
        vhost_vdpa_cvq_unmap_buf(&s->vhost_vdpa, s->cvq_cmd_out_buffer);
 | 
						|
        return false;
 | 
						|
    }
 | 
						|
 | 
						|
    iov[1].iov_len = sizeof(virtio_net_ctrl_ack);
 | 
						|
    return true;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * Do not forward commands not supported by SVQ. Otherwise, the device could
 | 
						|
 * accept it and qemu would not know how to update the device model.
 | 
						|
 */
 | 
						|
static bool vhost_vdpa_net_cvq_validate_cmd(const struct iovec *out,
 | 
						|
                                            size_t out_num)
 | 
						|
{
 | 
						|
    struct virtio_net_ctrl_hdr ctrl;
 | 
						|
    size_t n;
 | 
						|
 | 
						|
    n = iov_to_buf(out, out_num, 0, &ctrl, sizeof(ctrl));
 | 
						|
    if (unlikely(n < sizeof(ctrl))) {
 | 
						|
        qemu_log_mask(LOG_GUEST_ERROR,
 | 
						|
                      "%s: invalid legnth of out buffer %zu\n", __func__, n);
 | 
						|
        return false;
 | 
						|
    }
 | 
						|
 | 
						|
    switch (ctrl.class) {
 | 
						|
    case VIRTIO_NET_CTRL_MAC:
 | 
						|
        switch (ctrl.cmd) {
 | 
						|
        case VIRTIO_NET_CTRL_MAC_ADDR_SET:
 | 
						|
            return true;
 | 
						|
        default:
 | 
						|
            qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid mac cmd %u\n",
 | 
						|
                          __func__, ctrl.cmd);
 | 
						|
        };
 | 
						|
        break;
 | 
						|
    default:
 | 
						|
        qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid control class %u\n",
 | 
						|
                      __func__, ctrl.class);
 | 
						|
    };
 | 
						|
 | 
						|
    return false;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * Validate and copy control virtqueue commands.
 | 
						|
 *
 | 
						|
 * Following QEMU guidelines, we offer a copy of the buffers to the device to
 | 
						|
 * prevent TOCTOU bugs.
 | 
						|
 */
 | 
						|
static int vhost_vdpa_net_handle_ctrl_avail(VhostShadowVirtqueue *svq,
 | 
						|
                                            VirtQueueElement *elem,
 | 
						|
                                            void *opaque)
 | 
						|
{
 | 
						|
    VhostVDPAState *s = opaque;
 | 
						|
    size_t in_len, dev_written;
 | 
						|
    virtio_net_ctrl_ack status = VIRTIO_NET_ERR;
 | 
						|
    /* out and in buffers sent to the device */
 | 
						|
    struct iovec dev_buffers[2] = {
 | 
						|
        { .iov_base = s->cvq_cmd_out_buffer },
 | 
						|
        { .iov_base = s->cvq_cmd_in_buffer },
 | 
						|
    };
 | 
						|
    /* in buffer used for device model */
 | 
						|
    const struct iovec in = {
 | 
						|
        .iov_base = &status,
 | 
						|
        .iov_len = sizeof(status),
 | 
						|
    };
 | 
						|
    int r = -EINVAL;
 | 
						|
    bool ok;
 | 
						|
 | 
						|
    ok = vhost_vdpa_net_cvq_map_elem(s, elem, dev_buffers);
 | 
						|
    if (unlikely(!ok)) {
 | 
						|
        goto out;
 | 
						|
    }
 | 
						|
 | 
						|
    ok = vhost_vdpa_net_cvq_validate_cmd(&dev_buffers[0], 1);
 | 
						|
    if (unlikely(!ok)) {
 | 
						|
        goto out;
 | 
						|
    }
 | 
						|
 | 
						|
    r = vhost_svq_add(svq, &dev_buffers[0], 1, &dev_buffers[1], 1, elem);
 | 
						|
    if (unlikely(r != 0)) {
 | 
						|
        if (unlikely(r == -ENOSPC)) {
 | 
						|
            qemu_log_mask(LOG_GUEST_ERROR, "%s: No space on device queue\n",
 | 
						|
                          __func__);
 | 
						|
        }
 | 
						|
        goto out;
 | 
						|
    }
 | 
						|
 | 
						|
    /*
 | 
						|
     * We can poll here since we've had BQL from the time we sent the
 | 
						|
     * descriptor. Also, we need to take the answer before SVQ pulls by itself,
 | 
						|
     * when BQL is released
 | 
						|
     */
 | 
						|
    dev_written = vhost_svq_poll(svq);
 | 
						|
    if (unlikely(dev_written < sizeof(status))) {
 | 
						|
        error_report("Insufficient written data (%zu)", dev_written);
 | 
						|
        goto out;
 | 
						|
    }
 | 
						|
 | 
						|
    memcpy(&status, dev_buffers[1].iov_base, sizeof(status));
 | 
						|
    if (status != VIRTIO_NET_OK) {
 | 
						|
        goto out;
 | 
						|
    }
 | 
						|
 | 
						|
    status = VIRTIO_NET_ERR;
 | 
						|
    virtio_net_handle_ctrl_iov(svq->vdev, &in, 1, dev_buffers, 1);
 | 
						|
    if (status != VIRTIO_NET_OK) {
 | 
						|
        error_report("Bad CVQ processing in model");
 | 
						|
    }
 | 
						|
 | 
						|
out:
 | 
						|
    in_len = iov_from_buf(elem->in_sg, elem->in_num, 0, &status,
 | 
						|
                          sizeof(status));
 | 
						|
    if (unlikely(in_len < sizeof(status))) {
 | 
						|
        error_report("Bad device CVQ written length");
 | 
						|
    }
 | 
						|
    vhost_svq_push_elem(svq, elem, MIN(in_len, sizeof(status)));
 | 
						|
    g_free(elem);
 | 
						|
    if (dev_buffers[0].iov_base) {
 | 
						|
        vhost_vdpa_cvq_unmap_buf(&s->vhost_vdpa, dev_buffers[0].iov_base);
 | 
						|
    }
 | 
						|
    if (dev_buffers[1].iov_base) {
 | 
						|
        vhost_vdpa_cvq_unmap_buf(&s->vhost_vdpa, dev_buffers[1].iov_base);
 | 
						|
    }
 | 
						|
    return r;
 | 
						|
}
 | 
						|
 | 
						|
static const VhostShadowVirtqueueOps vhost_vdpa_net_svq_ops = {
 | 
						|
    .avail_handler = vhost_vdpa_net_handle_ctrl_avail,
 | 
						|
};
 | 
						|
 | 
						|
static NetClientState *net_vhost_vdpa_init(NetClientState *peer,
 | 
						|
                                           const char *device,
 | 
						|
                                           const char *name,
 | 
						|
                                           int vdpa_device_fd,
 | 
						|
                                           int queue_pair_index,
 | 
						|
                                           int nvqs,
 | 
						|
                                           bool is_datapath,
 | 
						|
                                           bool svq,
 | 
						|
                                           VhostIOVATree *iova_tree)
 | 
						|
{
 | 
						|
    NetClientState *nc = NULL;
 | 
						|
    VhostVDPAState *s;
 | 
						|
    int ret = 0;
 | 
						|
    assert(name);
 | 
						|
    if (is_datapath) {
 | 
						|
        nc = qemu_new_net_client(&net_vhost_vdpa_info, peer, device,
 | 
						|
                                 name);
 | 
						|
    } else {
 | 
						|
        nc = qemu_new_net_control_client(&net_vhost_vdpa_info, peer,
 | 
						|
                                         device, name);
 | 
						|
    }
 | 
						|
    snprintf(nc->info_str, sizeof(nc->info_str), TYPE_VHOST_VDPA);
 | 
						|
    s = DO_UPCAST(VhostVDPAState, nc, nc);
 | 
						|
 | 
						|
    s->vhost_vdpa.device_fd = vdpa_device_fd;
 | 
						|
    s->vhost_vdpa.index = queue_pair_index;
 | 
						|
    s->vhost_vdpa.shadow_vqs_enabled = svq;
 | 
						|
    s->vhost_vdpa.iova_tree = iova_tree;
 | 
						|
    if (!is_datapath) {
 | 
						|
        s->cvq_cmd_out_buffer = qemu_memalign(qemu_real_host_page_size(),
 | 
						|
                                            vhost_vdpa_net_cvq_cmd_page_len());
 | 
						|
        memset(s->cvq_cmd_out_buffer, 0, vhost_vdpa_net_cvq_cmd_page_len());
 | 
						|
        s->cvq_cmd_in_buffer = qemu_memalign(qemu_real_host_page_size(),
 | 
						|
                                            vhost_vdpa_net_cvq_cmd_page_len());
 | 
						|
        memset(s->cvq_cmd_in_buffer, 0, vhost_vdpa_net_cvq_cmd_page_len());
 | 
						|
 | 
						|
        s->vhost_vdpa.shadow_vq_ops = &vhost_vdpa_net_svq_ops;
 | 
						|
        s->vhost_vdpa.shadow_vq_ops_opaque = s;
 | 
						|
        error_setg(&s->vhost_vdpa.migration_blocker,
 | 
						|
                   "Migration disabled: vhost-vdpa uses CVQ.");
 | 
						|
    }
 | 
						|
    ret = vhost_vdpa_add(nc, (void *)&s->vhost_vdpa, queue_pair_index, nvqs);
 | 
						|
    if (ret) {
 | 
						|
        qemu_del_net_client(nc);
 | 
						|
        return NULL;
 | 
						|
    }
 | 
						|
    return nc;
 | 
						|
}
 | 
						|
 | 
						|
static int vhost_vdpa_get_iova_range(int fd,
 | 
						|
                                     struct vhost_vdpa_iova_range *iova_range)
 | 
						|
{
 | 
						|
    int ret = ioctl(fd, VHOST_VDPA_GET_IOVA_RANGE, iova_range);
 | 
						|
 | 
						|
    return ret < 0 ? -errno : 0;
 | 
						|
}
 | 
						|
 | 
						|
static int vhost_vdpa_get_features(int fd, uint64_t *features, Error **errp)
 | 
						|
{
 | 
						|
    int ret = ioctl(fd, VHOST_GET_FEATURES, features);
 | 
						|
    if (unlikely(ret < 0)) {
 | 
						|
        error_setg_errno(errp, errno,
 | 
						|
                         "Fail to query features from vhost-vDPA device");
 | 
						|
    }
 | 
						|
    return ret;
 | 
						|
}
 | 
						|
 | 
						|
static int vhost_vdpa_get_max_queue_pairs(int fd, uint64_t features,
 | 
						|
                                          int *has_cvq, Error **errp)
 | 
						|
{
 | 
						|
    unsigned long config_size = offsetof(struct vhost_vdpa_config, buf);
 | 
						|
    g_autofree struct vhost_vdpa_config *config = NULL;
 | 
						|
    __virtio16 *max_queue_pairs;
 | 
						|
    int ret;
 | 
						|
 | 
						|
    if (features & (1 << VIRTIO_NET_F_CTRL_VQ)) {
 | 
						|
        *has_cvq = 1;
 | 
						|
    } else {
 | 
						|
        *has_cvq = 0;
 | 
						|
    }
 | 
						|
 | 
						|
    if (features & (1 << VIRTIO_NET_F_MQ)) {
 | 
						|
        config = g_malloc0(config_size + sizeof(*max_queue_pairs));
 | 
						|
        config->off = offsetof(struct virtio_net_config, max_virtqueue_pairs);
 | 
						|
        config->len = sizeof(*max_queue_pairs);
 | 
						|
 | 
						|
        ret = ioctl(fd, VHOST_VDPA_GET_CONFIG, config);
 | 
						|
        if (ret) {
 | 
						|
            error_setg(errp, "Fail to get config from vhost-vDPA device");
 | 
						|
            return -ret;
 | 
						|
        }
 | 
						|
 | 
						|
        max_queue_pairs = (__virtio16 *)&config->buf;
 | 
						|
 | 
						|
        return lduw_le_p(max_queue_pairs);
 | 
						|
    }
 | 
						|
 | 
						|
    return 1;
 | 
						|
}
 | 
						|
 | 
						|
int net_init_vhost_vdpa(const Netdev *netdev, const char *name,
 | 
						|
                        NetClientState *peer, Error **errp)
 | 
						|
{
 | 
						|
    const NetdevVhostVDPAOptions *opts;
 | 
						|
    uint64_t features;
 | 
						|
    int vdpa_device_fd;
 | 
						|
    g_autofree NetClientState **ncs = NULL;
 | 
						|
    g_autoptr(VhostIOVATree) iova_tree = NULL;
 | 
						|
    NetClientState *nc;
 | 
						|
    int queue_pairs, r, i = 0, has_cvq = 0;
 | 
						|
 | 
						|
    assert(netdev->type == NET_CLIENT_DRIVER_VHOST_VDPA);
 | 
						|
    opts = &netdev->u.vhost_vdpa;
 | 
						|
    if (!opts->vhostdev) {
 | 
						|
        error_setg(errp, "vdpa character device not specified with vhostdev");
 | 
						|
        return -1;
 | 
						|
    }
 | 
						|
 | 
						|
    vdpa_device_fd = qemu_open(opts->vhostdev, O_RDWR, errp);
 | 
						|
    if (vdpa_device_fd == -1) {
 | 
						|
        return -errno;
 | 
						|
    }
 | 
						|
 | 
						|
    r = vhost_vdpa_get_features(vdpa_device_fd, &features, errp);
 | 
						|
    if (unlikely(r < 0)) {
 | 
						|
        goto err;
 | 
						|
    }
 | 
						|
 | 
						|
    queue_pairs = vhost_vdpa_get_max_queue_pairs(vdpa_device_fd, features,
 | 
						|
                                                 &has_cvq, errp);
 | 
						|
    if (queue_pairs < 0) {
 | 
						|
        qemu_close(vdpa_device_fd);
 | 
						|
        return queue_pairs;
 | 
						|
    }
 | 
						|
 | 
						|
    if (opts->x_svq) {
 | 
						|
        struct vhost_vdpa_iova_range iova_range;
 | 
						|
 | 
						|
        uint64_t invalid_dev_features =
 | 
						|
            features & ~vdpa_svq_device_features &
 | 
						|
            /* Transport are all accepted at this point */
 | 
						|
            ~MAKE_64BIT_MASK(VIRTIO_TRANSPORT_F_START,
 | 
						|
                             VIRTIO_TRANSPORT_F_END - VIRTIO_TRANSPORT_F_START);
 | 
						|
 | 
						|
        if (invalid_dev_features) {
 | 
						|
            error_setg(errp, "vdpa svq does not work with features 0x%" PRIx64,
 | 
						|
                       invalid_dev_features);
 | 
						|
            goto err_svq;
 | 
						|
        }
 | 
						|
 | 
						|
        vhost_vdpa_get_iova_range(vdpa_device_fd, &iova_range);
 | 
						|
        iova_tree = vhost_iova_tree_new(iova_range.first, iova_range.last);
 | 
						|
    }
 | 
						|
 | 
						|
    ncs = g_malloc0(sizeof(*ncs) * queue_pairs);
 | 
						|
 | 
						|
    for (i = 0; i < queue_pairs; i++) {
 | 
						|
        ncs[i] = net_vhost_vdpa_init(peer, TYPE_VHOST_VDPA, name,
 | 
						|
                                     vdpa_device_fd, i, 2, true, opts->x_svq,
 | 
						|
                                     iova_tree);
 | 
						|
        if (!ncs[i])
 | 
						|
            goto err;
 | 
						|
    }
 | 
						|
 | 
						|
    if (has_cvq) {
 | 
						|
        nc = net_vhost_vdpa_init(peer, TYPE_VHOST_VDPA, name,
 | 
						|
                                 vdpa_device_fd, i, 1, false,
 | 
						|
                                 opts->x_svq, iova_tree);
 | 
						|
        if (!nc)
 | 
						|
            goto err;
 | 
						|
    }
 | 
						|
 | 
						|
    /* iova_tree ownership belongs to last NetClientState */
 | 
						|
    g_steal_pointer(&iova_tree);
 | 
						|
    return 0;
 | 
						|
 | 
						|
err:
 | 
						|
    if (i) {
 | 
						|
        for (i--; i >= 0; i--) {
 | 
						|
            qemu_del_net_client(ncs[i]);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
err_svq:
 | 
						|
    qemu_close(vdpa_device_fd);
 | 
						|
 | 
						|
    return -1;
 | 
						|
}
 |