1108a6481SCindy Lu /* 2108a6481SCindy Lu * vhost-vdpa 3108a6481SCindy Lu * 4108a6481SCindy Lu * Copyright(c) 2017-2018 Intel Corporation. 5108a6481SCindy Lu * Copyright(c) 2020 Red Hat, Inc. 6108a6481SCindy Lu * 7108a6481SCindy Lu * This work is licensed under the terms of the GNU GPL, version 2 or later. 8108a6481SCindy Lu * See the COPYING file in the top-level directory. 9108a6481SCindy Lu * 10108a6481SCindy Lu */ 11108a6481SCindy Lu 12108a6481SCindy Lu #include "qemu/osdep.h" 13108a6481SCindy Lu #include <linux/vhost.h> 14108a6481SCindy Lu #include <linux/vfio.h> 15108a6481SCindy Lu #include <sys/eventfd.h> 16108a6481SCindy Lu #include <sys/ioctl.h> 17108a6481SCindy Lu #include "hw/virtio/vhost.h" 18108a6481SCindy Lu #include "hw/virtio/vhost-backend.h" 19108a6481SCindy Lu #include "hw/virtio/virtio-net.h" 20dff4426fSEugenio Pérez #include "hw/virtio/vhost-shadow-virtqueue.h" 21108a6481SCindy Lu #include "hw/virtio/vhost-vdpa.h" 22df77d45aSXie Yongji #include "exec/address-spaces.h" 23108a6481SCindy Lu #include "qemu/main-loop.h" 244dc5acc0SCindy Lu #include "cpu.h" 25778e67deSLaurent Vivier #include "trace.h" 26778e67deSLaurent Vivier #include "qemu-common.h" 27dff4426fSEugenio Pérez #include "qapi/error.h" 28108a6481SCindy Lu 29032e4d68SEugenio Pérez /* 30032e4d68SEugenio Pérez * Return one past the end of the end of section. Be careful with uint64_t 31032e4d68SEugenio Pérez * conversions! 32032e4d68SEugenio Pérez */ 33032e4d68SEugenio Pérez static Int128 vhost_vdpa_section_end(const MemoryRegionSection *section) 34032e4d68SEugenio Pérez { 35032e4d68SEugenio Pérez Int128 llend = int128_make64(section->offset_within_address_space); 36032e4d68SEugenio Pérez llend = int128_add(llend, section->size); 37032e4d68SEugenio Pérez llend = int128_and(llend, int128_exts64(TARGET_PAGE_MASK)); 38032e4d68SEugenio Pérez 39032e4d68SEugenio Pérez return llend; 40032e4d68SEugenio Pérez } 41032e4d68SEugenio Pérez 42013108b6SEugenio Pérez static bool vhost_vdpa_listener_skipped_section(MemoryRegionSection *section, 43013108b6SEugenio Pérez uint64_t iova_min, 44013108b6SEugenio Pérez uint64_t iova_max) 45108a6481SCindy Lu { 46013108b6SEugenio Pérez Int128 llend; 47013108b6SEugenio Pérez 48013108b6SEugenio Pérez if ((!memory_region_is_ram(section->mr) && 49108a6481SCindy Lu !memory_region_is_iommu(section->mr)) || 50c64038c9SEugenio Pérez memory_region_is_protected(section->mr) || 51d60c75d2SJason Wang /* vhost-vDPA doesn't allow MMIO to be mapped */ 52013108b6SEugenio Pérez memory_region_is_ram_device(section->mr)) { 53013108b6SEugenio Pérez return true; 54013108b6SEugenio Pérez } 55013108b6SEugenio Pérez 56013108b6SEugenio Pérez if (section->offset_within_address_space < iova_min) { 57013108b6SEugenio Pérez error_report("RAM section out of device range (min=0x%" PRIx64 58013108b6SEugenio Pérez ", addr=0x%" HWADDR_PRIx ")", 59013108b6SEugenio Pérez iova_min, section->offset_within_address_space); 60013108b6SEugenio Pérez return true; 61013108b6SEugenio Pérez } 62013108b6SEugenio Pérez 63013108b6SEugenio Pérez llend = vhost_vdpa_section_end(section); 64013108b6SEugenio Pérez if (int128_gt(llend, int128_make64(iova_max))) { 65013108b6SEugenio Pérez error_report("RAM section out of device range (max=0x%" PRIx64 66013108b6SEugenio Pérez ", end addr=0x%" PRIx64 ")", 67013108b6SEugenio Pérez iova_max, int128_get64(llend)); 68013108b6SEugenio Pérez return true; 69013108b6SEugenio Pérez } 70013108b6SEugenio Pérez 71013108b6SEugenio Pérez return false; 72108a6481SCindy Lu } 73108a6481SCindy Lu 74108a6481SCindy Lu static int vhost_vdpa_dma_map(struct vhost_vdpa *v, hwaddr iova, hwaddr size, 75108a6481SCindy Lu void *vaddr, bool readonly) 76108a6481SCindy Lu { 77386494f2SCindy Lu struct vhost_msg_v2 msg = {}; 78108a6481SCindy Lu int fd = v->device_fd; 79108a6481SCindy Lu int ret = 0; 80108a6481SCindy Lu 81108a6481SCindy Lu msg.type = v->msg_type; 82108a6481SCindy Lu msg.iotlb.iova = iova; 83108a6481SCindy Lu msg.iotlb.size = size; 84108a6481SCindy Lu msg.iotlb.uaddr = (uint64_t)(uintptr_t)vaddr; 85108a6481SCindy Lu msg.iotlb.perm = readonly ? VHOST_ACCESS_RO : VHOST_ACCESS_RW; 86108a6481SCindy Lu msg.iotlb.type = VHOST_IOTLB_UPDATE; 87108a6481SCindy Lu 88778e67deSLaurent Vivier trace_vhost_vdpa_dma_map(v, fd, msg.type, msg.iotlb.iova, msg.iotlb.size, 89778e67deSLaurent Vivier msg.iotlb.uaddr, msg.iotlb.perm, msg.iotlb.type); 90778e67deSLaurent Vivier 91108a6481SCindy Lu if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 92108a6481SCindy Lu error_report("failed to write, fd=%d, errno=%d (%s)", 93108a6481SCindy Lu fd, errno, strerror(errno)); 94108a6481SCindy Lu return -EIO ; 95108a6481SCindy Lu } 96108a6481SCindy Lu 97108a6481SCindy Lu return ret; 98108a6481SCindy Lu } 99108a6481SCindy Lu 100108a6481SCindy Lu static int vhost_vdpa_dma_unmap(struct vhost_vdpa *v, hwaddr iova, 101108a6481SCindy Lu hwaddr size) 102108a6481SCindy Lu { 103386494f2SCindy Lu struct vhost_msg_v2 msg = {}; 104108a6481SCindy Lu int fd = v->device_fd; 105108a6481SCindy Lu int ret = 0; 106108a6481SCindy Lu 107108a6481SCindy Lu msg.type = v->msg_type; 108108a6481SCindy Lu msg.iotlb.iova = iova; 109108a6481SCindy Lu msg.iotlb.size = size; 110108a6481SCindy Lu msg.iotlb.type = VHOST_IOTLB_INVALIDATE; 111108a6481SCindy Lu 112778e67deSLaurent Vivier trace_vhost_vdpa_dma_unmap(v, fd, msg.type, msg.iotlb.iova, 113778e67deSLaurent Vivier msg.iotlb.size, msg.iotlb.type); 114778e67deSLaurent Vivier 115108a6481SCindy Lu if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 116108a6481SCindy Lu error_report("failed to write, fd=%d, errno=%d (%s)", 117108a6481SCindy Lu fd, errno, strerror(errno)); 118108a6481SCindy Lu return -EIO ; 119108a6481SCindy Lu } 120108a6481SCindy Lu 121108a6481SCindy Lu return ret; 122108a6481SCindy Lu } 123108a6481SCindy Lu 124e6db5df7SEugenio Pérez static void vhost_vdpa_listener_begin_batch(struct vhost_vdpa *v) 125a5bd0580SJason Wang { 126a5bd0580SJason Wang int fd = v->device_fd; 127e6db5df7SEugenio Pérez struct vhost_msg_v2 msg = { 128e6db5df7SEugenio Pérez .type = v->msg_type, 129e6db5df7SEugenio Pérez .iotlb.type = VHOST_IOTLB_BATCH_BEGIN, 130e6db5df7SEugenio Pérez }; 131a5bd0580SJason Wang 132a5bd0580SJason Wang if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 133a5bd0580SJason Wang error_report("failed to write, fd=%d, errno=%d (%s)", 134a5bd0580SJason Wang fd, errno, strerror(errno)); 135a5bd0580SJason Wang } 136a5bd0580SJason Wang } 137a5bd0580SJason Wang 138e6db5df7SEugenio Pérez static void vhost_vdpa_iotlb_batch_begin_once(struct vhost_vdpa *v) 139e6db5df7SEugenio Pérez { 140e6db5df7SEugenio Pérez if (v->dev->backend_cap & (0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH) && 141e6db5df7SEugenio Pérez !v->iotlb_batch_begin_sent) { 142e6db5df7SEugenio Pérez vhost_vdpa_listener_begin_batch(v); 143e6db5df7SEugenio Pérez } 144e6db5df7SEugenio Pérez 145e6db5df7SEugenio Pérez v->iotlb_batch_begin_sent = true; 146e6db5df7SEugenio Pérez } 147e6db5df7SEugenio Pérez 148a5bd0580SJason Wang static void vhost_vdpa_listener_commit(MemoryListener *listener) 149a5bd0580SJason Wang { 150a5bd0580SJason Wang struct vhost_vdpa *v = container_of(listener, struct vhost_vdpa, listener); 151a5bd0580SJason Wang struct vhost_dev *dev = v->dev; 1528acb3218SPhilippe Mathieu-Daudé struct vhost_msg_v2 msg = {}; 153a5bd0580SJason Wang int fd = v->device_fd; 154a5bd0580SJason Wang 155a5bd0580SJason Wang if (!(dev->backend_cap & (0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH))) { 156a5bd0580SJason Wang return; 157a5bd0580SJason Wang } 158a5bd0580SJason Wang 159e6db5df7SEugenio Pérez if (!v->iotlb_batch_begin_sent) { 160e6db5df7SEugenio Pérez return; 161e6db5df7SEugenio Pérez } 162e6db5df7SEugenio Pérez 163a5bd0580SJason Wang msg.type = v->msg_type; 164a5bd0580SJason Wang msg.iotlb.type = VHOST_IOTLB_BATCH_END; 165a5bd0580SJason Wang 166a5bd0580SJason Wang if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 167a5bd0580SJason Wang error_report("failed to write, fd=%d, errno=%d (%s)", 168a5bd0580SJason Wang fd, errno, strerror(errno)); 169a5bd0580SJason Wang } 170e6db5df7SEugenio Pérez 171e6db5df7SEugenio Pérez v->iotlb_batch_begin_sent = false; 172a5bd0580SJason Wang } 173a5bd0580SJason Wang 174108a6481SCindy Lu static void vhost_vdpa_listener_region_add(MemoryListener *listener, 175108a6481SCindy Lu MemoryRegionSection *section) 176108a6481SCindy Lu { 177108a6481SCindy Lu struct vhost_vdpa *v = container_of(listener, struct vhost_vdpa, listener); 178108a6481SCindy Lu hwaddr iova; 179108a6481SCindy Lu Int128 llend, llsize; 180108a6481SCindy Lu void *vaddr; 181108a6481SCindy Lu int ret; 182108a6481SCindy Lu 183013108b6SEugenio Pérez if (vhost_vdpa_listener_skipped_section(section, v->iova_range.first, 184013108b6SEugenio Pérez v->iova_range.last)) { 185108a6481SCindy Lu return; 186108a6481SCindy Lu } 187108a6481SCindy Lu 188108a6481SCindy Lu if (unlikely((section->offset_within_address_space & ~TARGET_PAGE_MASK) != 189108a6481SCindy Lu (section->offset_within_region & ~TARGET_PAGE_MASK))) { 190108a6481SCindy Lu error_report("%s received unaligned region", __func__); 191108a6481SCindy Lu return; 192108a6481SCindy Lu } 193108a6481SCindy Lu 194108a6481SCindy Lu iova = TARGET_PAGE_ALIGN(section->offset_within_address_space); 195032e4d68SEugenio Pérez llend = vhost_vdpa_section_end(section); 196108a6481SCindy Lu if (int128_ge(int128_make64(iova), llend)) { 197108a6481SCindy Lu return; 198108a6481SCindy Lu } 199108a6481SCindy Lu 200108a6481SCindy Lu memory_region_ref(section->mr); 201108a6481SCindy Lu 202108a6481SCindy Lu /* Here we assume that memory_region_is_ram(section->mr)==true */ 203108a6481SCindy Lu 204108a6481SCindy Lu vaddr = memory_region_get_ram_ptr(section->mr) + 205108a6481SCindy Lu section->offset_within_region + 206108a6481SCindy Lu (iova - section->offset_within_address_space); 207108a6481SCindy Lu 208778e67deSLaurent Vivier trace_vhost_vdpa_listener_region_add(v, iova, int128_get64(llend), 209778e67deSLaurent Vivier vaddr, section->readonly); 210778e67deSLaurent Vivier 211108a6481SCindy Lu llsize = int128_sub(llend, int128_make64(iova)); 212108a6481SCindy Lu 213e6db5df7SEugenio Pérez vhost_vdpa_iotlb_batch_begin_once(v); 214108a6481SCindy Lu ret = vhost_vdpa_dma_map(v, iova, int128_get64(llsize), 215108a6481SCindy Lu vaddr, section->readonly); 216108a6481SCindy Lu if (ret) { 217108a6481SCindy Lu error_report("vhost vdpa map fail!"); 218108a6481SCindy Lu goto fail; 219108a6481SCindy Lu } 220108a6481SCindy Lu 221108a6481SCindy Lu return; 222108a6481SCindy Lu 223108a6481SCindy Lu fail: 224108a6481SCindy Lu /* 225108a6481SCindy Lu * On the initfn path, store the first error in the container so we 226108a6481SCindy Lu * can gracefully fail. Runtime, there's not much we can do other 227108a6481SCindy Lu * than throw a hardware error. 228108a6481SCindy Lu */ 229108a6481SCindy Lu error_report("vhost-vdpa: DMA mapping failed, unable to continue"); 230108a6481SCindy Lu return; 231108a6481SCindy Lu 232108a6481SCindy Lu } 233108a6481SCindy Lu 234108a6481SCindy Lu static void vhost_vdpa_listener_region_del(MemoryListener *listener, 235108a6481SCindy Lu MemoryRegionSection *section) 236108a6481SCindy Lu { 237108a6481SCindy Lu struct vhost_vdpa *v = container_of(listener, struct vhost_vdpa, listener); 238108a6481SCindy Lu hwaddr iova; 239108a6481SCindy Lu Int128 llend, llsize; 240108a6481SCindy Lu int ret; 241108a6481SCindy Lu 242013108b6SEugenio Pérez if (vhost_vdpa_listener_skipped_section(section, v->iova_range.first, 243013108b6SEugenio Pérez v->iova_range.last)) { 244108a6481SCindy Lu return; 245108a6481SCindy Lu } 246108a6481SCindy Lu 247108a6481SCindy Lu if (unlikely((section->offset_within_address_space & ~TARGET_PAGE_MASK) != 248108a6481SCindy Lu (section->offset_within_region & ~TARGET_PAGE_MASK))) { 249108a6481SCindy Lu error_report("%s received unaligned region", __func__); 250108a6481SCindy Lu return; 251108a6481SCindy Lu } 252108a6481SCindy Lu 253108a6481SCindy Lu iova = TARGET_PAGE_ALIGN(section->offset_within_address_space); 254032e4d68SEugenio Pérez llend = vhost_vdpa_section_end(section); 255108a6481SCindy Lu 256778e67deSLaurent Vivier trace_vhost_vdpa_listener_region_del(v, iova, int128_get64(llend)); 257778e67deSLaurent Vivier 258108a6481SCindy Lu if (int128_ge(int128_make64(iova), llend)) { 259108a6481SCindy Lu return; 260108a6481SCindy Lu } 261108a6481SCindy Lu 262108a6481SCindy Lu llsize = int128_sub(llend, int128_make64(iova)); 263108a6481SCindy Lu 264e6db5df7SEugenio Pérez vhost_vdpa_iotlb_batch_begin_once(v); 265108a6481SCindy Lu ret = vhost_vdpa_dma_unmap(v, iova, int128_get64(llsize)); 266108a6481SCindy Lu if (ret) { 267108a6481SCindy Lu error_report("vhost_vdpa dma unmap error!"); 268108a6481SCindy Lu } 269108a6481SCindy Lu 270108a6481SCindy Lu memory_region_unref(section->mr); 271108a6481SCindy Lu } 272108a6481SCindy Lu /* 273108a6481SCindy Lu * IOTLB API is used by vhost-vpda which requires incremental updating 274108a6481SCindy Lu * of the mapping. So we can not use generic vhost memory listener which 275108a6481SCindy Lu * depends on the addnop(). 276108a6481SCindy Lu */ 277108a6481SCindy Lu static const MemoryListener vhost_vdpa_memory_listener = { 278142518bdSPeter Xu .name = "vhost-vdpa", 279a5bd0580SJason Wang .commit = vhost_vdpa_listener_commit, 280108a6481SCindy Lu .region_add = vhost_vdpa_listener_region_add, 281108a6481SCindy Lu .region_del = vhost_vdpa_listener_region_del, 282108a6481SCindy Lu }; 283108a6481SCindy Lu 284108a6481SCindy Lu static int vhost_vdpa_call(struct vhost_dev *dev, unsigned long int request, 285108a6481SCindy Lu void *arg) 286108a6481SCindy Lu { 287108a6481SCindy Lu struct vhost_vdpa *v = dev->opaque; 288108a6481SCindy Lu int fd = v->device_fd; 289f2a6e6c4SKevin Wolf int ret; 290108a6481SCindy Lu 291108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 292108a6481SCindy Lu 293f2a6e6c4SKevin Wolf ret = ioctl(fd, request, arg); 294f2a6e6c4SKevin Wolf return ret < 0 ? -errno : ret; 295108a6481SCindy Lu } 296108a6481SCindy Lu 2973631151bSRoman Kagan static int vhost_vdpa_add_status(struct vhost_dev *dev, uint8_t status) 298108a6481SCindy Lu { 299108a6481SCindy Lu uint8_t s; 3003631151bSRoman Kagan int ret; 301108a6481SCindy Lu 302778e67deSLaurent Vivier trace_vhost_vdpa_add_status(dev, status); 3033631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_STATUS, &s); 3043631151bSRoman Kagan if (ret < 0) { 3053631151bSRoman Kagan return ret; 306108a6481SCindy Lu } 307108a6481SCindy Lu 308108a6481SCindy Lu s |= status; 309108a6481SCindy Lu 3103631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_STATUS, &s); 3113631151bSRoman Kagan if (ret < 0) { 3123631151bSRoman Kagan return ret; 3133631151bSRoman Kagan } 3143631151bSRoman Kagan 3153631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_STATUS, &s); 3163631151bSRoman Kagan if (ret < 0) { 3173631151bSRoman Kagan return ret; 3183631151bSRoman Kagan } 3193631151bSRoman Kagan 3203631151bSRoman Kagan if (!(s & status)) { 3213631151bSRoman Kagan return -EIO; 3223631151bSRoman Kagan } 3233631151bSRoman Kagan 3243631151bSRoman Kagan return 0; 325108a6481SCindy Lu } 326108a6481SCindy Lu 327013108b6SEugenio Pérez static void vhost_vdpa_get_iova_range(struct vhost_vdpa *v) 328013108b6SEugenio Pérez { 329013108b6SEugenio Pérez int ret = vhost_vdpa_call(v->dev, VHOST_VDPA_GET_IOVA_RANGE, 330013108b6SEugenio Pérez &v->iova_range); 331013108b6SEugenio Pérez if (ret != 0) { 332013108b6SEugenio Pérez v->iova_range.first = 0; 333013108b6SEugenio Pérez v->iova_range.last = UINT64_MAX; 334013108b6SEugenio Pérez } 335013108b6SEugenio Pérez 336013108b6SEugenio Pérez trace_vhost_vdpa_get_iova_range(v->dev, v->iova_range.first, 337013108b6SEugenio Pérez v->iova_range.last); 338013108b6SEugenio Pérez } 339013108b6SEugenio Pérez 3404d191cfdSJason Wang static bool vhost_vdpa_one_time_request(struct vhost_dev *dev) 3414d191cfdSJason Wang { 3424d191cfdSJason Wang struct vhost_vdpa *v = dev->opaque; 3434d191cfdSJason Wang 3444d191cfdSJason Wang return v->index != 0; 3454d191cfdSJason Wang } 3464d191cfdSJason Wang 347dff4426fSEugenio Pérez static int vhost_vdpa_init_svq(struct vhost_dev *hdev, struct vhost_vdpa *v, 348dff4426fSEugenio Pérez Error **errp) 349dff4426fSEugenio Pérez { 350dff4426fSEugenio Pérez g_autoptr(GPtrArray) shadow_vqs = NULL; 3514725a418SEugenio Pérez uint64_t dev_features, svq_features; 3524725a418SEugenio Pérez int r; 3534725a418SEugenio Pérez bool ok; 354dff4426fSEugenio Pérez 355dff4426fSEugenio Pérez if (!v->shadow_vqs_enabled) { 356dff4426fSEugenio Pérez return 0; 357dff4426fSEugenio Pérez } 358dff4426fSEugenio Pérez 3594725a418SEugenio Pérez r = hdev->vhost_ops->vhost_get_features(hdev, &dev_features); 3604725a418SEugenio Pérez if (r != 0) { 3614725a418SEugenio Pérez error_setg_errno(errp, -r, "Can't get vdpa device features"); 3624725a418SEugenio Pérez return r; 3634725a418SEugenio Pérez } 3644725a418SEugenio Pérez 3654725a418SEugenio Pérez svq_features = dev_features; 3664725a418SEugenio Pérez ok = vhost_svq_valid_features(svq_features, errp); 3674725a418SEugenio Pérez if (unlikely(!ok)) { 3684725a418SEugenio Pérez return -1; 3694725a418SEugenio Pérez } 3704725a418SEugenio Pérez 371dff4426fSEugenio Pérez shadow_vqs = g_ptr_array_new_full(hdev->nvqs, vhost_svq_free); 372dff4426fSEugenio Pérez for (unsigned n = 0; n < hdev->nvqs; ++n) { 373dff4426fSEugenio Pérez g_autoptr(VhostShadowVirtqueue) svq = vhost_svq_new(); 374dff4426fSEugenio Pérez 375dff4426fSEugenio Pérez if (unlikely(!svq)) { 376dff4426fSEugenio Pérez error_setg(errp, "Cannot create svq %u", n); 377dff4426fSEugenio Pérez return -1; 378dff4426fSEugenio Pérez } 379dff4426fSEugenio Pérez g_ptr_array_add(shadow_vqs, g_steal_pointer(&svq)); 380dff4426fSEugenio Pérez } 381dff4426fSEugenio Pérez 382dff4426fSEugenio Pérez v->shadow_vqs = g_steal_pointer(&shadow_vqs); 383dff4426fSEugenio Pérez return 0; 384dff4426fSEugenio Pérez } 385dff4426fSEugenio Pérez 38628770ff9SKevin Wolf static int vhost_vdpa_init(struct vhost_dev *dev, void *opaque, Error **errp) 387108a6481SCindy Lu { 388108a6481SCindy Lu struct vhost_vdpa *v; 389108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 390778e67deSLaurent Vivier trace_vhost_vdpa_init(dev, opaque); 391e1c1915bSDavid Hildenbrand int ret; 392e1c1915bSDavid Hildenbrand 393e1c1915bSDavid Hildenbrand /* 394e1c1915bSDavid Hildenbrand * Similar to VFIO, we end up pinning all guest memory and have to 395e1c1915bSDavid Hildenbrand * disable discarding of RAM. 396e1c1915bSDavid Hildenbrand */ 397e1c1915bSDavid Hildenbrand ret = ram_block_discard_disable(true); 398e1c1915bSDavid Hildenbrand if (ret) { 399e1c1915bSDavid Hildenbrand error_report("Cannot set discarding of RAM broken"); 400e1c1915bSDavid Hildenbrand return ret; 401e1c1915bSDavid Hildenbrand } 402108a6481SCindy Lu 403108a6481SCindy Lu v = opaque; 404a5bd0580SJason Wang v->dev = dev; 405108a6481SCindy Lu dev->opaque = opaque ; 406108a6481SCindy Lu v->listener = vhost_vdpa_memory_listener; 407108a6481SCindy Lu v->msg_type = VHOST_IOTLB_MSG_V2; 408dff4426fSEugenio Pérez ret = vhost_vdpa_init_svq(dev, v, errp); 409dff4426fSEugenio Pérez if (ret) { 410dff4426fSEugenio Pérez goto err; 411dff4426fSEugenio Pérez } 412108a6481SCindy Lu 413013108b6SEugenio Pérez vhost_vdpa_get_iova_range(v); 4144d191cfdSJason Wang 4154d191cfdSJason Wang if (vhost_vdpa_one_time_request(dev)) { 4164d191cfdSJason Wang return 0; 4174d191cfdSJason Wang } 4184d191cfdSJason Wang 419108a6481SCindy Lu vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_ACKNOWLEDGE | 420108a6481SCindy Lu VIRTIO_CONFIG_S_DRIVER); 421108a6481SCindy Lu 422108a6481SCindy Lu return 0; 423dff4426fSEugenio Pérez 424dff4426fSEugenio Pérez err: 425dff4426fSEugenio Pérez ram_block_discard_disable(false); 426dff4426fSEugenio Pérez return ret; 427108a6481SCindy Lu } 428108a6481SCindy Lu 429d0416d48SJason Wang static void vhost_vdpa_host_notifier_uninit(struct vhost_dev *dev, 430d0416d48SJason Wang int queue_index) 431d0416d48SJason Wang { 432d0416d48SJason Wang size_t page_size = qemu_real_host_page_size; 433d0416d48SJason Wang struct vhost_vdpa *v = dev->opaque; 434d0416d48SJason Wang VirtIODevice *vdev = dev->vdev; 435d0416d48SJason Wang VhostVDPAHostNotifier *n; 436d0416d48SJason Wang 437d0416d48SJason Wang n = &v->notifier[queue_index]; 438d0416d48SJason Wang 439d0416d48SJason Wang if (n->addr) { 440d0416d48SJason Wang virtio_queue_set_host_notifier_mr(vdev, queue_index, &n->mr, false); 441d0416d48SJason Wang object_unparent(OBJECT(&n->mr)); 442d0416d48SJason Wang munmap(n->addr, page_size); 443d0416d48SJason Wang n->addr = NULL; 444d0416d48SJason Wang } 445d0416d48SJason Wang } 446d0416d48SJason Wang 447d0416d48SJason Wang static int vhost_vdpa_host_notifier_init(struct vhost_dev *dev, int queue_index) 448d0416d48SJason Wang { 449d0416d48SJason Wang size_t page_size = qemu_real_host_page_size; 450d0416d48SJason Wang struct vhost_vdpa *v = dev->opaque; 451d0416d48SJason Wang VirtIODevice *vdev = dev->vdev; 452d0416d48SJason Wang VhostVDPAHostNotifier *n; 453d0416d48SJason Wang int fd = v->device_fd; 454d0416d48SJason Wang void *addr; 455d0416d48SJason Wang char *name; 456d0416d48SJason Wang 457d0416d48SJason Wang vhost_vdpa_host_notifier_uninit(dev, queue_index); 458d0416d48SJason Wang 459d0416d48SJason Wang n = &v->notifier[queue_index]; 460d0416d48SJason Wang 461d0416d48SJason Wang addr = mmap(NULL, page_size, PROT_WRITE, MAP_SHARED, fd, 462d0416d48SJason Wang queue_index * page_size); 463d0416d48SJason Wang if (addr == MAP_FAILED) { 464d0416d48SJason Wang goto err; 465d0416d48SJason Wang } 466d0416d48SJason Wang 467d0416d48SJason Wang name = g_strdup_printf("vhost-vdpa/host-notifier@%p mmaps[%d]", 468d0416d48SJason Wang v, queue_index); 469d0416d48SJason Wang memory_region_init_ram_device_ptr(&n->mr, OBJECT(vdev), name, 470d0416d48SJason Wang page_size, addr); 471d0416d48SJason Wang g_free(name); 472d0416d48SJason Wang 473d0416d48SJason Wang if (virtio_queue_set_host_notifier_mr(vdev, queue_index, &n->mr, true)) { 47498f7607eSLaurent Vivier object_unparent(OBJECT(&n->mr)); 475d0416d48SJason Wang munmap(addr, page_size); 476d0416d48SJason Wang goto err; 477d0416d48SJason Wang } 478d0416d48SJason Wang n->addr = addr; 479d0416d48SJason Wang 480d0416d48SJason Wang return 0; 481d0416d48SJason Wang 482d0416d48SJason Wang err: 483d0416d48SJason Wang return -1; 484d0416d48SJason Wang } 485d0416d48SJason Wang 486b1f030a0SLaurent Vivier static void vhost_vdpa_host_notifiers_uninit(struct vhost_dev *dev, int n) 487b1f030a0SLaurent Vivier { 488b1f030a0SLaurent Vivier int i; 489b1f030a0SLaurent Vivier 490b1f030a0SLaurent Vivier for (i = dev->vq_index; i < dev->vq_index + n; i++) { 491b1f030a0SLaurent Vivier vhost_vdpa_host_notifier_uninit(dev, i); 492b1f030a0SLaurent Vivier } 493b1f030a0SLaurent Vivier } 494b1f030a0SLaurent Vivier 495d0416d48SJason Wang static void vhost_vdpa_host_notifiers_init(struct vhost_dev *dev) 496d0416d48SJason Wang { 497dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 498d0416d48SJason Wang int i; 499d0416d48SJason Wang 500dff4426fSEugenio Pérez if (v->shadow_vqs_enabled) { 501dff4426fSEugenio Pérez /* FIXME SVQ is not compatible with host notifiers mr */ 502dff4426fSEugenio Pérez return; 503dff4426fSEugenio Pérez } 504dff4426fSEugenio Pérez 505d0416d48SJason Wang for (i = dev->vq_index; i < dev->vq_index + dev->nvqs; i++) { 506d0416d48SJason Wang if (vhost_vdpa_host_notifier_init(dev, i)) { 507d0416d48SJason Wang goto err; 508d0416d48SJason Wang } 509d0416d48SJason Wang } 510d0416d48SJason Wang 511d0416d48SJason Wang return; 512d0416d48SJason Wang 513d0416d48SJason Wang err: 514b1f030a0SLaurent Vivier vhost_vdpa_host_notifiers_uninit(dev, i - dev->vq_index); 515d0416d48SJason Wang return; 516d0416d48SJason Wang } 517d0416d48SJason Wang 518dff4426fSEugenio Pérez static void vhost_vdpa_svq_cleanup(struct vhost_dev *dev) 519dff4426fSEugenio Pérez { 520dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 521dff4426fSEugenio Pérez size_t idx; 522dff4426fSEugenio Pérez 523dff4426fSEugenio Pérez if (!v->shadow_vqs) { 524dff4426fSEugenio Pérez return; 525dff4426fSEugenio Pérez } 526dff4426fSEugenio Pérez 527dff4426fSEugenio Pérez for (idx = 0; idx < v->shadow_vqs->len; ++idx) { 528dff4426fSEugenio Pérez vhost_svq_stop(g_ptr_array_index(v->shadow_vqs, idx)); 529dff4426fSEugenio Pérez } 530dff4426fSEugenio Pérez g_ptr_array_free(v->shadow_vqs, true); 531dff4426fSEugenio Pérez } 532dff4426fSEugenio Pérez 533108a6481SCindy Lu static int vhost_vdpa_cleanup(struct vhost_dev *dev) 534108a6481SCindy Lu { 535108a6481SCindy Lu struct vhost_vdpa *v; 536108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 537108a6481SCindy Lu v = dev->opaque; 538778e67deSLaurent Vivier trace_vhost_vdpa_cleanup(dev, v); 539d0416d48SJason Wang vhost_vdpa_host_notifiers_uninit(dev, dev->nvqs); 540108a6481SCindy Lu memory_listener_unregister(&v->listener); 541dff4426fSEugenio Pérez vhost_vdpa_svq_cleanup(dev); 542108a6481SCindy Lu 543108a6481SCindy Lu dev->opaque = NULL; 544e1c1915bSDavid Hildenbrand ram_block_discard_disable(false); 545e1c1915bSDavid Hildenbrand 546108a6481SCindy Lu return 0; 547108a6481SCindy Lu } 548108a6481SCindy Lu 549108a6481SCindy Lu static int vhost_vdpa_memslots_limit(struct vhost_dev *dev) 550108a6481SCindy Lu { 551778e67deSLaurent Vivier trace_vhost_vdpa_memslots_limit(dev, INT_MAX); 552108a6481SCindy Lu return INT_MAX; 553108a6481SCindy Lu } 554108a6481SCindy Lu 555108a6481SCindy Lu static int vhost_vdpa_set_mem_table(struct vhost_dev *dev, 556108a6481SCindy Lu struct vhost_memory *mem) 557108a6481SCindy Lu { 5584d191cfdSJason Wang if (vhost_vdpa_one_time_request(dev)) { 5594d191cfdSJason Wang return 0; 5604d191cfdSJason Wang } 5614d191cfdSJason Wang 562778e67deSLaurent Vivier trace_vhost_vdpa_set_mem_table(dev, mem->nregions, mem->padding); 563778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_SET_MEM_TABLE) && 564778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_REGIONS)) { 565778e67deSLaurent Vivier int i; 566778e67deSLaurent Vivier for (i = 0; i < mem->nregions; i++) { 567778e67deSLaurent Vivier trace_vhost_vdpa_dump_regions(dev, i, 568778e67deSLaurent Vivier mem->regions[i].guest_phys_addr, 569778e67deSLaurent Vivier mem->regions[i].memory_size, 570778e67deSLaurent Vivier mem->regions[i].userspace_addr, 571778e67deSLaurent Vivier mem->regions[i].flags_padding); 572778e67deSLaurent Vivier } 573778e67deSLaurent Vivier } 574108a6481SCindy Lu if (mem->padding) { 5753631151bSRoman Kagan return -EINVAL; 576108a6481SCindy Lu } 577108a6481SCindy Lu 578108a6481SCindy Lu return 0; 579108a6481SCindy Lu } 580108a6481SCindy Lu 581108a6481SCindy Lu static int vhost_vdpa_set_features(struct vhost_dev *dev, 582108a6481SCindy Lu uint64_t features) 583108a6481SCindy Lu { 584108a6481SCindy Lu int ret; 5854d191cfdSJason Wang 5864d191cfdSJason Wang if (vhost_vdpa_one_time_request(dev)) { 5874d191cfdSJason Wang return 0; 5884d191cfdSJason Wang } 5894d191cfdSJason Wang 590778e67deSLaurent Vivier trace_vhost_vdpa_set_features(dev, features); 591108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_SET_FEATURES, &features); 592108a6481SCindy Lu if (ret) { 593108a6481SCindy Lu return ret; 594108a6481SCindy Lu } 595108a6481SCindy Lu 5963631151bSRoman Kagan return vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_FEATURES_OK); 597108a6481SCindy Lu } 598108a6481SCindy Lu 599a5bd0580SJason Wang static int vhost_vdpa_set_backend_cap(struct vhost_dev *dev) 600a5bd0580SJason Wang { 601a5bd0580SJason Wang uint64_t features; 602a5bd0580SJason Wang uint64_t f = 0x1ULL << VHOST_BACKEND_F_IOTLB_MSG_V2 | 603a5bd0580SJason Wang 0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH; 604a5bd0580SJason Wang int r; 605a5bd0580SJason Wang 606a5bd0580SJason Wang if (vhost_vdpa_call(dev, VHOST_GET_BACKEND_FEATURES, &features)) { 6072a83e97eSJason Wang return -EFAULT; 608a5bd0580SJason Wang } 609a5bd0580SJason Wang 610a5bd0580SJason Wang features &= f; 6114d191cfdSJason Wang 6124d191cfdSJason Wang if (vhost_vdpa_one_time_request(dev)) { 613a5bd0580SJason Wang r = vhost_vdpa_call(dev, VHOST_SET_BACKEND_FEATURES, &features); 614a5bd0580SJason Wang if (r) { 6152a83e97eSJason Wang return -EFAULT; 616a5bd0580SJason Wang } 6174d191cfdSJason Wang } 618a5bd0580SJason Wang 619a5bd0580SJason Wang dev->backend_cap = features; 620a5bd0580SJason Wang 621a5bd0580SJason Wang return 0; 622a5bd0580SJason Wang } 623a5bd0580SJason Wang 624c232b8f4SZenghui Yu static int vhost_vdpa_get_device_id(struct vhost_dev *dev, 625108a6481SCindy Lu uint32_t *device_id) 626108a6481SCindy Lu { 627778e67deSLaurent Vivier int ret; 628778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_DEVICE_ID, device_id); 629778e67deSLaurent Vivier trace_vhost_vdpa_get_device_id(dev, *device_id); 630778e67deSLaurent Vivier return ret; 631108a6481SCindy Lu } 632108a6481SCindy Lu 633dff4426fSEugenio Pérez static void vhost_vdpa_reset_svq(struct vhost_vdpa *v) 634dff4426fSEugenio Pérez { 635dff4426fSEugenio Pérez if (!v->shadow_vqs_enabled) { 636dff4426fSEugenio Pérez return; 637dff4426fSEugenio Pérez } 638dff4426fSEugenio Pérez 639dff4426fSEugenio Pérez for (unsigned i = 0; i < v->shadow_vqs->len; ++i) { 640dff4426fSEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, i); 641dff4426fSEugenio Pérez vhost_svq_stop(svq); 642dff4426fSEugenio Pérez } 643dff4426fSEugenio Pérez } 644dff4426fSEugenio Pérez 645108a6481SCindy Lu static int vhost_vdpa_reset_device(struct vhost_dev *dev) 646108a6481SCindy Lu { 647dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 648778e67deSLaurent Vivier int ret; 649108a6481SCindy Lu uint8_t status = 0; 650108a6481SCindy Lu 651dff4426fSEugenio Pérez vhost_vdpa_reset_svq(v); 652dff4426fSEugenio Pérez 653778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_STATUS, &status); 654778e67deSLaurent Vivier trace_vhost_vdpa_reset_device(dev, status); 655778e67deSLaurent Vivier return ret; 656108a6481SCindy Lu } 657108a6481SCindy Lu 658108a6481SCindy Lu static int vhost_vdpa_get_vq_index(struct vhost_dev *dev, int idx) 659108a6481SCindy Lu { 660108a6481SCindy Lu assert(idx >= dev->vq_index && idx < dev->vq_index + dev->nvqs); 661108a6481SCindy Lu 662353244d8SJason Wang trace_vhost_vdpa_get_vq_index(dev, idx, idx); 663353244d8SJason Wang return idx; 664108a6481SCindy Lu } 665108a6481SCindy Lu 666108a6481SCindy Lu static int vhost_vdpa_set_vring_ready(struct vhost_dev *dev) 667108a6481SCindy Lu { 668108a6481SCindy Lu int i; 669778e67deSLaurent Vivier trace_vhost_vdpa_set_vring_ready(dev); 670108a6481SCindy Lu for (i = 0; i < dev->nvqs; ++i) { 671108a6481SCindy Lu struct vhost_vring_state state = { 672108a6481SCindy Lu .index = dev->vq_index + i, 673108a6481SCindy Lu .num = 1, 674108a6481SCindy Lu }; 675108a6481SCindy Lu vhost_vdpa_call(dev, VHOST_VDPA_SET_VRING_ENABLE, &state); 676108a6481SCindy Lu } 677108a6481SCindy Lu return 0; 678108a6481SCindy Lu } 679108a6481SCindy Lu 680778e67deSLaurent Vivier static void vhost_vdpa_dump_config(struct vhost_dev *dev, const uint8_t *config, 681778e67deSLaurent Vivier uint32_t config_len) 682778e67deSLaurent Vivier { 683778e67deSLaurent Vivier int b, len; 684778e67deSLaurent Vivier char line[QEMU_HEXDUMP_LINE_LEN]; 685778e67deSLaurent Vivier 686778e67deSLaurent Vivier for (b = 0; b < config_len; b += 16) { 687778e67deSLaurent Vivier len = config_len - b; 688778e67deSLaurent Vivier qemu_hexdump_line(line, b, config, len, false); 689778e67deSLaurent Vivier trace_vhost_vdpa_dump_config(dev, line); 690778e67deSLaurent Vivier } 691778e67deSLaurent Vivier } 692778e67deSLaurent Vivier 693108a6481SCindy Lu static int vhost_vdpa_set_config(struct vhost_dev *dev, const uint8_t *data, 694108a6481SCindy Lu uint32_t offset, uint32_t size, 695108a6481SCindy Lu uint32_t flags) 696108a6481SCindy Lu { 697108a6481SCindy Lu struct vhost_vdpa_config *config; 698108a6481SCindy Lu int ret; 699108a6481SCindy Lu unsigned long config_size = offsetof(struct vhost_vdpa_config, buf); 700986d4f78SLi Qiang 701778e67deSLaurent Vivier trace_vhost_vdpa_set_config(dev, offset, size, flags); 702108a6481SCindy Lu config = g_malloc(size + config_size); 703108a6481SCindy Lu config->off = offset; 704108a6481SCindy Lu config->len = size; 705108a6481SCindy Lu memcpy(config->buf, data, size); 706778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_SET_CONFIG) && 707778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_CONFIG)) { 708778e67deSLaurent Vivier vhost_vdpa_dump_config(dev, data, size); 709778e67deSLaurent Vivier } 710108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_CONFIG, config); 711108a6481SCindy Lu g_free(config); 712108a6481SCindy Lu return ret; 713108a6481SCindy Lu } 714108a6481SCindy Lu 715108a6481SCindy Lu static int vhost_vdpa_get_config(struct vhost_dev *dev, uint8_t *config, 71650de5138SKevin Wolf uint32_t config_len, Error **errp) 717108a6481SCindy Lu { 718108a6481SCindy Lu struct vhost_vdpa_config *v_config; 719108a6481SCindy Lu unsigned long config_size = offsetof(struct vhost_vdpa_config, buf); 720108a6481SCindy Lu int ret; 721108a6481SCindy Lu 722778e67deSLaurent Vivier trace_vhost_vdpa_get_config(dev, config, config_len); 723108a6481SCindy Lu v_config = g_malloc(config_len + config_size); 724108a6481SCindy Lu v_config->len = config_len; 725108a6481SCindy Lu v_config->off = 0; 726108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_CONFIG, v_config); 727108a6481SCindy Lu memcpy(config, v_config->buf, config_len); 728108a6481SCindy Lu g_free(v_config); 729778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_GET_CONFIG) && 730778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_CONFIG)) { 731778e67deSLaurent Vivier vhost_vdpa_dump_config(dev, config, config_len); 732778e67deSLaurent Vivier } 733108a6481SCindy Lu return ret; 734108a6481SCindy Lu } 735108a6481SCindy Lu 736*d96be4c8SEugenio Pérez static int vhost_vdpa_set_dev_vring_base(struct vhost_dev *dev, 737*d96be4c8SEugenio Pérez struct vhost_vring_state *ring) 738*d96be4c8SEugenio Pérez { 739*d96be4c8SEugenio Pérez trace_vhost_vdpa_set_vring_base(dev, ring->index, ring->num); 740*d96be4c8SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_BASE, ring); 741*d96be4c8SEugenio Pérez } 742*d96be4c8SEugenio Pérez 743dff4426fSEugenio Pérez static int vhost_vdpa_set_vring_dev_kick(struct vhost_dev *dev, 744dff4426fSEugenio Pérez struct vhost_vring_file *file) 745dff4426fSEugenio Pérez { 746dff4426fSEugenio Pérez trace_vhost_vdpa_set_vring_kick(dev, file->index, file->fd); 747dff4426fSEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_KICK, file); 748dff4426fSEugenio Pérez } 749dff4426fSEugenio Pérez 750a8ac8858SEugenio Pérez static int vhost_vdpa_set_vring_dev_call(struct vhost_dev *dev, 751a8ac8858SEugenio Pérez struct vhost_vring_file *file) 752a8ac8858SEugenio Pérez { 753a8ac8858SEugenio Pérez trace_vhost_vdpa_set_vring_call(dev, file->index, file->fd); 754a8ac8858SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_CALL, file); 755a8ac8858SEugenio Pérez } 756a8ac8858SEugenio Pérez 757*d96be4c8SEugenio Pérez static int vhost_vdpa_set_vring_dev_addr(struct vhost_dev *dev, 758*d96be4c8SEugenio Pérez struct vhost_vring_addr *addr) 759*d96be4c8SEugenio Pérez { 760*d96be4c8SEugenio Pérez trace_vhost_vdpa_set_vring_addr(dev, addr->index, addr->flags, 761*d96be4c8SEugenio Pérez addr->desc_user_addr, addr->used_user_addr, 762*d96be4c8SEugenio Pérez addr->avail_user_addr, 763*d96be4c8SEugenio Pérez addr->log_guest_addr); 764*d96be4c8SEugenio Pérez 765*d96be4c8SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_ADDR, addr); 766*d96be4c8SEugenio Pérez 767*d96be4c8SEugenio Pérez } 768*d96be4c8SEugenio Pérez 769dff4426fSEugenio Pérez /** 770dff4426fSEugenio Pérez * Set the shadow virtqueue descriptors to the device 771dff4426fSEugenio Pérez * 772dff4426fSEugenio Pérez * @dev: The vhost device model 773dff4426fSEugenio Pérez * @svq: The shadow virtqueue 774dff4426fSEugenio Pérez * @idx: The index of the virtqueue in the vhost device 775dff4426fSEugenio Pérez * @errp: Error 776a8ac8858SEugenio Pérez * 777a8ac8858SEugenio Pérez * Note that this function does not rewind kick file descriptor if cannot set 778a8ac8858SEugenio Pérez * call one. 779dff4426fSEugenio Pérez */ 780dff4426fSEugenio Pérez static bool vhost_vdpa_svq_setup(struct vhost_dev *dev, 781dff4426fSEugenio Pérez VhostShadowVirtqueue *svq, unsigned idx, 782dff4426fSEugenio Pérez Error **errp) 783dff4426fSEugenio Pérez { 784dff4426fSEugenio Pérez struct vhost_vring_file file = { 785dff4426fSEugenio Pérez .index = dev->vq_index + idx, 786dff4426fSEugenio Pérez }; 787dff4426fSEugenio Pérez const EventNotifier *event_notifier = &svq->hdev_kick; 788dff4426fSEugenio Pérez int r; 789dff4426fSEugenio Pérez 790dff4426fSEugenio Pérez file.fd = event_notifier_get_fd(event_notifier); 791dff4426fSEugenio Pérez r = vhost_vdpa_set_vring_dev_kick(dev, &file); 792dff4426fSEugenio Pérez if (unlikely(r != 0)) { 793dff4426fSEugenio Pérez error_setg_errno(errp, -r, "Can't set device kick fd"); 794a8ac8858SEugenio Pérez return false; 795a8ac8858SEugenio Pérez } 796a8ac8858SEugenio Pérez 797a8ac8858SEugenio Pérez event_notifier = &svq->hdev_call; 798a8ac8858SEugenio Pérez file.fd = event_notifier_get_fd(event_notifier); 799a8ac8858SEugenio Pérez r = vhost_vdpa_set_vring_dev_call(dev, &file); 800a8ac8858SEugenio Pérez if (unlikely(r != 0)) { 801a8ac8858SEugenio Pérez error_setg_errno(errp, -r, "Can't set device call fd"); 802dff4426fSEugenio Pérez } 803dff4426fSEugenio Pérez 804dff4426fSEugenio Pérez return r == 0; 805dff4426fSEugenio Pérez } 806dff4426fSEugenio Pérez 807dff4426fSEugenio Pérez static bool vhost_vdpa_svqs_start(struct vhost_dev *dev) 808dff4426fSEugenio Pérez { 809dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 810dff4426fSEugenio Pérez Error *err = NULL; 811dff4426fSEugenio Pérez unsigned i; 812dff4426fSEugenio Pérez 813dff4426fSEugenio Pérez if (!v->shadow_vqs) { 814dff4426fSEugenio Pérez return true; 815dff4426fSEugenio Pérez } 816dff4426fSEugenio Pérez 817dff4426fSEugenio Pérez for (i = 0; i < v->shadow_vqs->len; ++i) { 818dff4426fSEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, i); 819dff4426fSEugenio Pérez bool ok = vhost_vdpa_svq_setup(dev, svq, i, &err); 820dff4426fSEugenio Pérez if (unlikely(!ok)) { 821dff4426fSEugenio Pérez error_reportf_err(err, "Cannot setup SVQ %u: ", i); 822dff4426fSEugenio Pérez return false; 823dff4426fSEugenio Pérez } 824dff4426fSEugenio Pérez } 825dff4426fSEugenio Pérez 826dff4426fSEugenio Pérez return true; 827dff4426fSEugenio Pérez } 828dff4426fSEugenio Pérez 829108a6481SCindy Lu static int vhost_vdpa_dev_start(struct vhost_dev *dev, bool started) 830108a6481SCindy Lu { 831108a6481SCindy Lu struct vhost_vdpa *v = dev->opaque; 832dff4426fSEugenio Pérez bool ok; 833778e67deSLaurent Vivier trace_vhost_vdpa_dev_start(dev, started); 8344d191cfdSJason Wang 8354d191cfdSJason Wang if (started) { 8364d191cfdSJason Wang vhost_vdpa_host_notifiers_init(dev); 837dff4426fSEugenio Pérez ok = vhost_vdpa_svqs_start(dev); 838dff4426fSEugenio Pérez if (unlikely(!ok)) { 839dff4426fSEugenio Pérez return -1; 840dff4426fSEugenio Pérez } 8414d191cfdSJason Wang vhost_vdpa_set_vring_ready(dev); 8424d191cfdSJason Wang } else { 8434d191cfdSJason Wang vhost_vdpa_host_notifiers_uninit(dev, dev->nvqs); 8444d191cfdSJason Wang } 8454d191cfdSJason Wang 846245cf2c2SEugenio Pérez if (dev->vq_index + dev->nvqs != dev->vq_index_end) { 8474d191cfdSJason Wang return 0; 8484d191cfdSJason Wang } 8494d191cfdSJason Wang 850108a6481SCindy Lu if (started) { 851108a6481SCindy Lu memory_listener_register(&v->listener, &address_space_memory); 8523631151bSRoman Kagan return vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_DRIVER_OK); 853108a6481SCindy Lu } else { 854108a6481SCindy Lu vhost_vdpa_reset_device(dev); 855108a6481SCindy Lu vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_ACKNOWLEDGE | 856108a6481SCindy Lu VIRTIO_CONFIG_S_DRIVER); 857108a6481SCindy Lu memory_listener_unregister(&v->listener); 858108a6481SCindy Lu 859108a6481SCindy Lu return 0; 860108a6481SCindy Lu } 861108a6481SCindy Lu } 862108a6481SCindy Lu 863108a6481SCindy Lu static int vhost_vdpa_set_log_base(struct vhost_dev *dev, uint64_t base, 864108a6481SCindy Lu struct vhost_log *log) 865108a6481SCindy Lu { 8664d191cfdSJason Wang if (vhost_vdpa_one_time_request(dev)) { 8674d191cfdSJason Wang return 0; 8684d191cfdSJason Wang } 8694d191cfdSJason Wang 870778e67deSLaurent Vivier trace_vhost_vdpa_set_log_base(dev, base, log->size, log->refcnt, log->fd, 871778e67deSLaurent Vivier log->log); 872108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_LOG_BASE, &base); 873108a6481SCindy Lu } 874108a6481SCindy Lu 875108a6481SCindy Lu static int vhost_vdpa_set_vring_addr(struct vhost_dev *dev, 876108a6481SCindy Lu struct vhost_vring_addr *addr) 877108a6481SCindy Lu { 878*d96be4c8SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 879*d96be4c8SEugenio Pérez 880*d96be4c8SEugenio Pérez if (v->shadow_vqs_enabled) { 881*d96be4c8SEugenio Pérez /* 882*d96be4c8SEugenio Pérez * Device vring addr was set at device start. SVQ base is handled by 883*d96be4c8SEugenio Pérez * VirtQueue code. 884*d96be4c8SEugenio Pérez */ 885*d96be4c8SEugenio Pérez return 0; 886*d96be4c8SEugenio Pérez } 887*d96be4c8SEugenio Pérez 888*d96be4c8SEugenio Pérez return vhost_vdpa_set_vring_dev_addr(dev, addr); 889108a6481SCindy Lu } 890108a6481SCindy Lu 891108a6481SCindy Lu static int vhost_vdpa_set_vring_num(struct vhost_dev *dev, 892108a6481SCindy Lu struct vhost_vring_state *ring) 893108a6481SCindy Lu { 894778e67deSLaurent Vivier trace_vhost_vdpa_set_vring_num(dev, ring->index, ring->num); 895108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_VRING_NUM, ring); 896108a6481SCindy Lu } 897108a6481SCindy Lu 898108a6481SCindy Lu static int vhost_vdpa_set_vring_base(struct vhost_dev *dev, 899108a6481SCindy Lu struct vhost_vring_state *ring) 900108a6481SCindy Lu { 901*d96be4c8SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 902*d96be4c8SEugenio Pérez 903*d96be4c8SEugenio Pérez if (v->shadow_vqs_enabled) { 904*d96be4c8SEugenio Pérez /* 905*d96be4c8SEugenio Pérez * Device vring base was set at device start. SVQ base is handled by 906*d96be4c8SEugenio Pérez * VirtQueue code. 907*d96be4c8SEugenio Pérez */ 908*d96be4c8SEugenio Pérez return 0; 909*d96be4c8SEugenio Pérez } 910*d96be4c8SEugenio Pérez 911*d96be4c8SEugenio Pérez return vhost_vdpa_set_dev_vring_base(dev, ring); 912108a6481SCindy Lu } 913108a6481SCindy Lu 914108a6481SCindy Lu static int vhost_vdpa_get_vring_base(struct vhost_dev *dev, 915108a6481SCindy Lu struct vhost_vring_state *ring) 916108a6481SCindy Lu { 917778e67deSLaurent Vivier int ret; 918778e67deSLaurent Vivier 919778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_GET_VRING_BASE, ring); 920778e67deSLaurent Vivier trace_vhost_vdpa_get_vring_base(dev, ring->index, ring->num); 921778e67deSLaurent Vivier return ret; 922108a6481SCindy Lu } 923108a6481SCindy Lu 924108a6481SCindy Lu static int vhost_vdpa_set_vring_kick(struct vhost_dev *dev, 925108a6481SCindy Lu struct vhost_vring_file *file) 926108a6481SCindy Lu { 927dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 928dff4426fSEugenio Pérez int vdpa_idx = file->index - dev->vq_index; 929dff4426fSEugenio Pérez 930dff4426fSEugenio Pérez if (v->shadow_vqs_enabled) { 931dff4426fSEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, vdpa_idx); 932dff4426fSEugenio Pérez vhost_svq_set_svq_kick_fd(svq, file->fd); 933dff4426fSEugenio Pérez return 0; 934dff4426fSEugenio Pérez } else { 935dff4426fSEugenio Pérez return vhost_vdpa_set_vring_dev_kick(dev, file); 936dff4426fSEugenio Pérez } 937108a6481SCindy Lu } 938108a6481SCindy Lu 939108a6481SCindy Lu static int vhost_vdpa_set_vring_call(struct vhost_dev *dev, 940108a6481SCindy Lu struct vhost_vring_file *file) 941108a6481SCindy Lu { 942a8ac8858SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 943a8ac8858SEugenio Pérez 944a8ac8858SEugenio Pérez if (v->shadow_vqs_enabled) { 945a8ac8858SEugenio Pérez int vdpa_idx = file->index - dev->vq_index; 946a8ac8858SEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, vdpa_idx); 947a8ac8858SEugenio Pérez 948a8ac8858SEugenio Pérez vhost_svq_set_svq_call_fd(svq, file->fd); 949a8ac8858SEugenio Pérez return 0; 950a8ac8858SEugenio Pérez } else { 951a8ac8858SEugenio Pérez return vhost_vdpa_set_vring_dev_call(dev, file); 952a8ac8858SEugenio Pérez } 953108a6481SCindy Lu } 954108a6481SCindy Lu 955108a6481SCindy Lu static int vhost_vdpa_get_features(struct vhost_dev *dev, 956108a6481SCindy Lu uint64_t *features) 957108a6481SCindy Lu { 958778e67deSLaurent Vivier int ret; 959778e67deSLaurent Vivier 960778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_GET_FEATURES, features); 961778e67deSLaurent Vivier trace_vhost_vdpa_get_features(dev, *features); 962778e67deSLaurent Vivier return ret; 963108a6481SCindy Lu } 964108a6481SCindy Lu 965108a6481SCindy Lu static int vhost_vdpa_set_owner(struct vhost_dev *dev) 966108a6481SCindy Lu { 9674d191cfdSJason Wang if (vhost_vdpa_one_time_request(dev)) { 9684d191cfdSJason Wang return 0; 9694d191cfdSJason Wang } 9704d191cfdSJason Wang 971778e67deSLaurent Vivier trace_vhost_vdpa_set_owner(dev); 972108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_OWNER, NULL); 973108a6481SCindy Lu } 974108a6481SCindy Lu 975108a6481SCindy Lu static int vhost_vdpa_vq_get_addr(struct vhost_dev *dev, 976108a6481SCindy Lu struct vhost_vring_addr *addr, struct vhost_virtqueue *vq) 977108a6481SCindy Lu { 978108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 979108a6481SCindy Lu addr->desc_user_addr = (uint64_t)(unsigned long)vq->desc_phys; 980108a6481SCindy Lu addr->avail_user_addr = (uint64_t)(unsigned long)vq->avail_phys; 981108a6481SCindy Lu addr->used_user_addr = (uint64_t)(unsigned long)vq->used_phys; 982778e67deSLaurent Vivier trace_vhost_vdpa_vq_get_addr(dev, vq, addr->desc_user_addr, 983778e67deSLaurent Vivier addr->avail_user_addr, addr->used_user_addr); 984108a6481SCindy Lu return 0; 985108a6481SCindy Lu } 986108a6481SCindy Lu 987108a6481SCindy Lu static bool vhost_vdpa_force_iommu(struct vhost_dev *dev) 988108a6481SCindy Lu { 989108a6481SCindy Lu return true; 990108a6481SCindy Lu } 991108a6481SCindy Lu 992108a6481SCindy Lu const VhostOps vdpa_ops = { 993108a6481SCindy Lu .backend_type = VHOST_BACKEND_TYPE_VDPA, 994108a6481SCindy Lu .vhost_backend_init = vhost_vdpa_init, 995108a6481SCindy Lu .vhost_backend_cleanup = vhost_vdpa_cleanup, 996108a6481SCindy Lu .vhost_set_log_base = vhost_vdpa_set_log_base, 997108a6481SCindy Lu .vhost_set_vring_addr = vhost_vdpa_set_vring_addr, 998108a6481SCindy Lu .vhost_set_vring_num = vhost_vdpa_set_vring_num, 999108a6481SCindy Lu .vhost_set_vring_base = vhost_vdpa_set_vring_base, 1000108a6481SCindy Lu .vhost_get_vring_base = vhost_vdpa_get_vring_base, 1001108a6481SCindy Lu .vhost_set_vring_kick = vhost_vdpa_set_vring_kick, 1002108a6481SCindy Lu .vhost_set_vring_call = vhost_vdpa_set_vring_call, 1003108a6481SCindy Lu .vhost_get_features = vhost_vdpa_get_features, 1004a5bd0580SJason Wang .vhost_set_backend_cap = vhost_vdpa_set_backend_cap, 1005108a6481SCindy Lu .vhost_set_owner = vhost_vdpa_set_owner, 1006108a6481SCindy Lu .vhost_set_vring_endian = NULL, 1007108a6481SCindy Lu .vhost_backend_memslots_limit = vhost_vdpa_memslots_limit, 1008108a6481SCindy Lu .vhost_set_mem_table = vhost_vdpa_set_mem_table, 1009108a6481SCindy Lu .vhost_set_features = vhost_vdpa_set_features, 1010108a6481SCindy Lu .vhost_reset_device = vhost_vdpa_reset_device, 1011108a6481SCindy Lu .vhost_get_vq_index = vhost_vdpa_get_vq_index, 1012108a6481SCindy Lu .vhost_get_config = vhost_vdpa_get_config, 1013108a6481SCindy Lu .vhost_set_config = vhost_vdpa_set_config, 1014108a6481SCindy Lu .vhost_requires_shm_log = NULL, 1015108a6481SCindy Lu .vhost_migration_done = NULL, 1016108a6481SCindy Lu .vhost_backend_can_merge = NULL, 1017108a6481SCindy Lu .vhost_net_set_mtu = NULL, 1018108a6481SCindy Lu .vhost_set_iotlb_callback = NULL, 1019108a6481SCindy Lu .vhost_send_device_iotlb_msg = NULL, 1020108a6481SCindy Lu .vhost_dev_start = vhost_vdpa_dev_start, 1021108a6481SCindy Lu .vhost_get_device_id = vhost_vdpa_get_device_id, 1022108a6481SCindy Lu .vhost_vq_get_addr = vhost_vdpa_vq_get_addr, 1023108a6481SCindy Lu .vhost_force_iommu = vhost_vdpa_force_iommu, 1024108a6481SCindy Lu }; 1025