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> 1733f21860SPhilippe Mathieu-Daudé #include "exec/target_page.h" 18108a6481SCindy Lu #include "hw/virtio/vhost.h" 19108a6481SCindy Lu #include "hw/virtio/vhost-backend.h" 20108a6481SCindy Lu #include "hw/virtio/virtio-net.h" 21dff4426fSEugenio Pérez #include "hw/virtio/vhost-shadow-virtqueue.h" 22108a6481SCindy Lu #include "hw/virtio/vhost-vdpa.h" 23df77d45aSXie Yongji #include "exec/address-spaces.h" 24c156d5bfSEugenio Pérez #include "migration/blocker.h" 25415b7327SMarc-André Lureau #include "qemu/cutils.h" 26108a6481SCindy Lu #include "qemu/main-loop.h" 27778e67deSLaurent Vivier #include "trace.h" 28dff4426fSEugenio Pérez #include "qapi/error.h" 29108a6481SCindy Lu 30032e4d68SEugenio Pérez /* 31032e4d68SEugenio Pérez * Return one past the end of the end of section. Be careful with uint64_t 32032e4d68SEugenio Pérez * conversions! 33032e4d68SEugenio Pérez */ 348b1a8884SPhilippe Mathieu-Daudé static Int128 vhost_vdpa_section_end(const MemoryRegionSection *section, 358b1a8884SPhilippe Mathieu-Daudé int page_mask) 36032e4d68SEugenio Pérez { 37032e4d68SEugenio Pérez Int128 llend = int128_make64(section->offset_within_address_space); 38032e4d68SEugenio Pérez llend = int128_add(llend, section->size); 398b1a8884SPhilippe Mathieu-Daudé llend = int128_and(llend, int128_exts64(page_mask)); 40032e4d68SEugenio Pérez 41032e4d68SEugenio Pérez return llend; 42032e4d68SEugenio Pérez } 43032e4d68SEugenio Pérez 44013108b6SEugenio Pérez static bool vhost_vdpa_listener_skipped_section(MemoryRegionSection *section, 45013108b6SEugenio Pérez uint64_t iova_min, 46961d60e9SPhilippe Mathieu-Daudé uint64_t iova_max, 47961d60e9SPhilippe Mathieu-Daudé int page_mask) 48108a6481SCindy Lu { 49013108b6SEugenio Pérez Int128 llend; 50*a5583457SEugenio Pérez bool is_ram = memory_region_is_ram(section->mr); 51*a5583457SEugenio Pérez bool is_iommu = memory_region_is_iommu(section->mr); 52*a5583457SEugenio Pérez bool is_protected = memory_region_is_protected(section->mr); 53013108b6SEugenio Pérez 54d60c75d2SJason Wang /* vhost-vDPA doesn't allow MMIO to be mapped */ 55*a5583457SEugenio Pérez bool is_ram_device = memory_region_is_ram_device(section->mr); 56*a5583457SEugenio Pérez 57*a5583457SEugenio Pérez if ((!is_ram && !is_iommu) || is_protected || is_ram_device) { 58013108b6SEugenio Pérez return true; 59013108b6SEugenio Pérez } 60013108b6SEugenio Pérez 61013108b6SEugenio Pérez if (section->offset_within_address_space < iova_min) { 62013108b6SEugenio Pérez error_report("RAM section out of device range (min=0x%" PRIx64 63013108b6SEugenio Pérez ", addr=0x%" HWADDR_PRIx ")", 64013108b6SEugenio Pérez iova_min, section->offset_within_address_space); 65013108b6SEugenio Pérez return true; 66013108b6SEugenio Pérez } 67bc7b0cacSCindy Lu /* 68bc7b0cacSCindy Lu * While using vIOMMU, sometimes the section will be larger than iova_max, 69bc7b0cacSCindy Lu * but the memory that actually maps is smaller, so move the check to 70bc7b0cacSCindy Lu * function vhost_vdpa_iommu_map_notify(). That function will use the actual 71bc7b0cacSCindy Lu * size that maps to the kernel 72bc7b0cacSCindy Lu */ 73013108b6SEugenio Pérez 74*a5583457SEugenio Pérez if (!is_iommu) { 758b1a8884SPhilippe Mathieu-Daudé llend = vhost_vdpa_section_end(section, page_mask); 76013108b6SEugenio Pérez if (int128_gt(llend, int128_make64(iova_max))) { 77013108b6SEugenio Pérez error_report("RAM section out of device range (max=0x%" PRIx64 78013108b6SEugenio Pérez ", end addr=0x%" PRIx64 ")", 79013108b6SEugenio Pérez iova_max, int128_get64(llend)); 80013108b6SEugenio Pérez return true; 81013108b6SEugenio Pérez } 82bc7b0cacSCindy Lu } 83013108b6SEugenio Pérez 84013108b6SEugenio Pérez return false; 85108a6481SCindy Lu } 86108a6481SCindy Lu 87cd831ed5SEugenio Pérez /* 88cd831ed5SEugenio Pérez * The caller must set asid = 0 if the device does not support asid. 89cd831ed5SEugenio Pérez * This is not an ABI break since it is set to 0 by the initializer anyway. 90cd831ed5SEugenio Pérez */ 916f03d9efSEugenio Pérez int vhost_vdpa_dma_map(VhostVDPAShared *s, uint32_t asid, hwaddr iova, 92cd831ed5SEugenio Pérez hwaddr size, void *vaddr, bool readonly) 93108a6481SCindy Lu { 94386494f2SCindy Lu struct vhost_msg_v2 msg = {}; 956f03d9efSEugenio Pérez int fd = s->device_fd; 96108a6481SCindy Lu int ret = 0; 97108a6481SCindy Lu 9874e76c7dSEugenio Pérez msg.type = VHOST_IOTLB_MSG_V2; 99cd831ed5SEugenio Pérez msg.asid = asid; 100108a6481SCindy Lu msg.iotlb.iova = iova; 101108a6481SCindy Lu msg.iotlb.size = size; 102108a6481SCindy Lu msg.iotlb.uaddr = (uint64_t)(uintptr_t)vaddr; 103108a6481SCindy Lu msg.iotlb.perm = readonly ? VHOST_ACCESS_RO : VHOST_ACCESS_RW; 104108a6481SCindy Lu msg.iotlb.type = VHOST_IOTLB_UPDATE; 105108a6481SCindy Lu 1066f03d9efSEugenio Pérez trace_vhost_vdpa_dma_map(s, fd, msg.type, msg.asid, msg.iotlb.iova, 107cd831ed5SEugenio Pérez msg.iotlb.size, msg.iotlb.uaddr, msg.iotlb.perm, 108cd831ed5SEugenio Pérez msg.iotlb.type); 109778e67deSLaurent Vivier 110108a6481SCindy Lu if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 111108a6481SCindy Lu error_report("failed to write, fd=%d, errno=%d (%s)", 112108a6481SCindy Lu fd, errno, strerror(errno)); 113108a6481SCindy Lu return -EIO ; 114108a6481SCindy Lu } 115108a6481SCindy Lu 116108a6481SCindy Lu return ret; 117108a6481SCindy Lu } 118108a6481SCindy Lu 119cd831ed5SEugenio Pérez /* 120cd831ed5SEugenio Pérez * The caller must set asid = 0 if the device does not support asid. 121cd831ed5SEugenio Pérez * This is not an ABI break since it is set to 0 by the initializer anyway. 122cd831ed5SEugenio Pérez */ 1236f03d9efSEugenio Pérez int vhost_vdpa_dma_unmap(VhostVDPAShared *s, uint32_t asid, hwaddr iova, 124cd831ed5SEugenio Pérez hwaddr size) 125108a6481SCindy Lu { 126386494f2SCindy Lu struct vhost_msg_v2 msg = {}; 1276f03d9efSEugenio Pérez int fd = s->device_fd; 128108a6481SCindy Lu int ret = 0; 129108a6481SCindy Lu 13074e76c7dSEugenio Pérez msg.type = VHOST_IOTLB_MSG_V2; 131cd831ed5SEugenio Pérez msg.asid = asid; 132108a6481SCindy Lu msg.iotlb.iova = iova; 133108a6481SCindy Lu msg.iotlb.size = size; 134108a6481SCindy Lu msg.iotlb.type = VHOST_IOTLB_INVALIDATE; 135108a6481SCindy Lu 1366f03d9efSEugenio Pérez trace_vhost_vdpa_dma_unmap(s, fd, msg.type, msg.asid, msg.iotlb.iova, 1376f03d9efSEugenio Pérez msg.iotlb.size, msg.iotlb.type); 138778e67deSLaurent Vivier 139108a6481SCindy Lu if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 140108a6481SCindy Lu error_report("failed to write, fd=%d, errno=%d (%s)", 141108a6481SCindy Lu fd, errno, strerror(errno)); 142108a6481SCindy Lu return -EIO ; 143108a6481SCindy Lu } 144108a6481SCindy Lu 145108a6481SCindy Lu return ret; 146108a6481SCindy Lu } 147108a6481SCindy Lu 1486f03d9efSEugenio Pérez static void vhost_vdpa_listener_begin_batch(VhostVDPAShared *s) 149a5bd0580SJason Wang { 1506f03d9efSEugenio Pérez int fd = s->device_fd; 151e6db5df7SEugenio Pérez struct vhost_msg_v2 msg = { 15274e76c7dSEugenio Pérez .type = VHOST_IOTLB_MSG_V2, 153e6db5df7SEugenio Pérez .iotlb.type = VHOST_IOTLB_BATCH_BEGIN, 154e6db5df7SEugenio Pérez }; 155a5bd0580SJason Wang 1566f03d9efSEugenio Pérez trace_vhost_vdpa_listener_begin_batch(s, fd, msg.type, msg.iotlb.type); 157a5bd0580SJason Wang if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 158a5bd0580SJason Wang error_report("failed to write, fd=%d, errno=%d (%s)", 159a5bd0580SJason Wang fd, errno, strerror(errno)); 160a5bd0580SJason Wang } 161a5bd0580SJason Wang } 162a5bd0580SJason Wang 1636f03d9efSEugenio Pérez static void vhost_vdpa_iotlb_batch_begin_once(VhostVDPAShared *s) 164e6db5df7SEugenio Pérez { 1656f03d9efSEugenio Pérez if (s->backend_cap & (0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH) && 1666f03d9efSEugenio Pérez !s->iotlb_batch_begin_sent) { 1676f03d9efSEugenio Pérez vhost_vdpa_listener_begin_batch(s); 168e6db5df7SEugenio Pérez } 169e6db5df7SEugenio Pérez 1706f03d9efSEugenio Pérez s->iotlb_batch_begin_sent = true; 171e6db5df7SEugenio Pérez } 172e6db5df7SEugenio Pérez 173a5bd0580SJason Wang static void vhost_vdpa_listener_commit(MemoryListener *listener) 174a5bd0580SJason Wang { 175f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 1768acb3218SPhilippe Mathieu-Daudé struct vhost_msg_v2 msg = {}; 177f6fe3e33SEugenio Pérez int fd = s->device_fd; 178a5bd0580SJason Wang 179f6fe3e33SEugenio Pérez if (!(s->backend_cap & (0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH))) { 180a5bd0580SJason Wang return; 181a5bd0580SJason Wang } 182a5bd0580SJason Wang 183f6fe3e33SEugenio Pérez if (!s->iotlb_batch_begin_sent) { 184e6db5df7SEugenio Pérez return; 185e6db5df7SEugenio Pérez } 186e6db5df7SEugenio Pérez 18774e76c7dSEugenio Pérez msg.type = VHOST_IOTLB_MSG_V2; 188a5bd0580SJason Wang msg.iotlb.type = VHOST_IOTLB_BATCH_END; 189a5bd0580SJason Wang 190f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_commit(s, fd, msg.type, msg.iotlb.type); 191a5bd0580SJason Wang if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 192a5bd0580SJason Wang error_report("failed to write, fd=%d, errno=%d (%s)", 193a5bd0580SJason Wang fd, errno, strerror(errno)); 194a5bd0580SJason Wang } 195e6db5df7SEugenio Pérez 196f6fe3e33SEugenio Pérez s->iotlb_batch_begin_sent = false; 197a5bd0580SJason Wang } 198a5bd0580SJason Wang 199bc7b0cacSCindy Lu static void vhost_vdpa_iommu_map_notify(IOMMUNotifier *n, IOMMUTLBEntry *iotlb) 200bc7b0cacSCindy Lu { 201bc7b0cacSCindy Lu struct vdpa_iommu *iommu = container_of(n, struct vdpa_iommu, n); 202bc7b0cacSCindy Lu 203bc7b0cacSCindy Lu hwaddr iova = iotlb->iova + iommu->iommu_offset; 204b06a38f2SEugenio Pérez VhostVDPAShared *s = iommu->dev_shared; 205bc7b0cacSCindy Lu void *vaddr; 206bc7b0cacSCindy Lu int ret; 207bc7b0cacSCindy Lu Int128 llend; 208bc7b0cacSCindy Lu 209bc7b0cacSCindy Lu if (iotlb->target_as != &address_space_memory) { 210bc7b0cacSCindy Lu error_report("Wrong target AS \"%s\", only system memory is allowed", 211bc7b0cacSCindy Lu iotlb->target_as->name ? iotlb->target_as->name : "none"); 212bc7b0cacSCindy Lu return; 213bc7b0cacSCindy Lu } 214bc7b0cacSCindy Lu RCU_READ_LOCK_GUARD(); 215bc7b0cacSCindy Lu /* check if RAM section out of device range */ 216bc7b0cacSCindy Lu llend = int128_add(int128_makes64(iotlb->addr_mask), int128_makes64(iova)); 217b06a38f2SEugenio Pérez if (int128_gt(llend, int128_make64(s->iova_range.last))) { 218bc7b0cacSCindy Lu error_report("RAM section out of device range (max=0x%" PRIx64 219bc7b0cacSCindy Lu ", end addr=0x%" PRIx64 ")", 220b06a38f2SEugenio Pérez s->iova_range.last, int128_get64(llend)); 221bc7b0cacSCindy Lu return; 222bc7b0cacSCindy Lu } 223bc7b0cacSCindy Lu 224bc7b0cacSCindy Lu if ((iotlb->perm & IOMMU_RW) != IOMMU_NONE) { 225bc7b0cacSCindy Lu bool read_only; 226bc7b0cacSCindy Lu 227bc7b0cacSCindy Lu if (!memory_get_xlat_addr(iotlb, &vaddr, NULL, &read_only, NULL)) { 228bc7b0cacSCindy Lu return; 229bc7b0cacSCindy Lu } 230b06a38f2SEugenio Pérez ret = vhost_vdpa_dma_map(s, VHOST_VDPA_GUEST_PA_ASID, iova, 231bc7b0cacSCindy Lu iotlb->addr_mask + 1, vaddr, read_only); 232bc7b0cacSCindy Lu if (ret) { 233bc7b0cacSCindy Lu error_report("vhost_vdpa_dma_map(%p, 0x%" HWADDR_PRIx ", " 234bc7b0cacSCindy Lu "0x%" HWADDR_PRIx ", %p) = %d (%m)", 235b06a38f2SEugenio Pérez s, iova, iotlb->addr_mask + 1, vaddr, ret); 236bc7b0cacSCindy Lu } 237bc7b0cacSCindy Lu } else { 238b06a38f2SEugenio Pérez ret = vhost_vdpa_dma_unmap(s, VHOST_VDPA_GUEST_PA_ASID, iova, 239bc7b0cacSCindy Lu iotlb->addr_mask + 1); 240bc7b0cacSCindy Lu if (ret) { 241bc7b0cacSCindy Lu error_report("vhost_vdpa_dma_unmap(%p, 0x%" HWADDR_PRIx ", " 242bc7b0cacSCindy Lu "0x%" HWADDR_PRIx ") = %d (%m)", 243b06a38f2SEugenio Pérez s, iova, iotlb->addr_mask + 1, ret); 244bc7b0cacSCindy Lu } 245bc7b0cacSCindy Lu } 246bc7b0cacSCindy Lu } 247bc7b0cacSCindy Lu 248bc7b0cacSCindy Lu static void vhost_vdpa_iommu_region_add(MemoryListener *listener, 249bc7b0cacSCindy Lu MemoryRegionSection *section) 250bc7b0cacSCindy Lu { 251f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 252bc7b0cacSCindy Lu 253bc7b0cacSCindy Lu struct vdpa_iommu *iommu; 254bc7b0cacSCindy Lu Int128 end; 255bc7b0cacSCindy Lu int iommu_idx; 256bc7b0cacSCindy Lu IOMMUMemoryRegion *iommu_mr; 257bc7b0cacSCindy Lu int ret; 258bc7b0cacSCindy Lu 259bc7b0cacSCindy Lu iommu_mr = IOMMU_MEMORY_REGION(section->mr); 260bc7b0cacSCindy Lu 261bc7b0cacSCindy Lu iommu = g_malloc0(sizeof(*iommu)); 262bc7b0cacSCindy Lu end = int128_add(int128_make64(section->offset_within_region), 263bc7b0cacSCindy Lu section->size); 264bc7b0cacSCindy Lu end = int128_sub(end, int128_one()); 265bc7b0cacSCindy Lu iommu_idx = memory_region_iommu_attrs_to_index(iommu_mr, 266bc7b0cacSCindy Lu MEMTXATTRS_UNSPECIFIED); 267bc7b0cacSCindy Lu iommu->iommu_mr = iommu_mr; 268bc7b0cacSCindy Lu iommu_notifier_init(&iommu->n, vhost_vdpa_iommu_map_notify, 269bc7b0cacSCindy Lu IOMMU_NOTIFIER_IOTLB_EVENTS, 270bc7b0cacSCindy Lu section->offset_within_region, 271bc7b0cacSCindy Lu int128_get64(end), 272bc7b0cacSCindy Lu iommu_idx); 273bc7b0cacSCindy Lu iommu->iommu_offset = section->offset_within_address_space - 274bc7b0cacSCindy Lu section->offset_within_region; 275f6fe3e33SEugenio Pérez iommu->dev_shared = s; 276bc7b0cacSCindy Lu 277bc7b0cacSCindy Lu ret = memory_region_register_iommu_notifier(section->mr, &iommu->n, NULL); 278bc7b0cacSCindy Lu if (ret) { 279bc7b0cacSCindy Lu g_free(iommu); 280bc7b0cacSCindy Lu return; 281bc7b0cacSCindy Lu } 282bc7b0cacSCindy Lu 283f6fe3e33SEugenio Pérez QLIST_INSERT_HEAD(&s->iommu_list, iommu, iommu_next); 284bc7b0cacSCindy Lu memory_region_iommu_replay(iommu->iommu_mr, &iommu->n); 285bc7b0cacSCindy Lu 286bc7b0cacSCindy Lu return; 287bc7b0cacSCindy Lu } 288bc7b0cacSCindy Lu 289bc7b0cacSCindy Lu static void vhost_vdpa_iommu_region_del(MemoryListener *listener, 290bc7b0cacSCindy Lu MemoryRegionSection *section) 291bc7b0cacSCindy Lu { 292f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 293bc7b0cacSCindy Lu 294bc7b0cacSCindy Lu struct vdpa_iommu *iommu; 295bc7b0cacSCindy Lu 296f6fe3e33SEugenio Pérez QLIST_FOREACH(iommu, &s->iommu_list, iommu_next) 297bc7b0cacSCindy Lu { 298bc7b0cacSCindy Lu if (MEMORY_REGION(iommu->iommu_mr) == section->mr && 299bc7b0cacSCindy Lu iommu->n.start == section->offset_within_region) { 300bc7b0cacSCindy Lu memory_region_unregister_iommu_notifier(section->mr, &iommu->n); 301bc7b0cacSCindy Lu QLIST_REMOVE(iommu, iommu_next); 302bc7b0cacSCindy Lu g_free(iommu); 303bc7b0cacSCindy Lu break; 304bc7b0cacSCindy Lu } 305bc7b0cacSCindy Lu } 306bc7b0cacSCindy Lu } 307bc7b0cacSCindy Lu 308108a6481SCindy Lu static void vhost_vdpa_listener_region_add(MemoryListener *listener, 309108a6481SCindy Lu MemoryRegionSection *section) 310108a6481SCindy Lu { 3117dab70beSEugenio Pérez DMAMap mem_region = {}; 312f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 313108a6481SCindy Lu hwaddr iova; 314108a6481SCindy Lu Int128 llend, llsize; 315108a6481SCindy Lu void *vaddr; 316108a6481SCindy Lu int ret; 31733f21860SPhilippe Mathieu-Daudé int page_size = qemu_target_page_size(); 31833f21860SPhilippe Mathieu-Daudé int page_mask = -page_size; 319108a6481SCindy Lu 320f6fe3e33SEugenio Pérez if (vhost_vdpa_listener_skipped_section(section, s->iova_range.first, 321f6fe3e33SEugenio Pérez s->iova_range.last, page_mask)) { 322108a6481SCindy Lu return; 323108a6481SCindy Lu } 324bc7b0cacSCindy Lu if (memory_region_is_iommu(section->mr)) { 325bc7b0cacSCindy Lu vhost_vdpa_iommu_region_add(listener, section); 326bc7b0cacSCindy Lu return; 327bc7b0cacSCindy Lu } 328108a6481SCindy Lu 32933f21860SPhilippe Mathieu-Daudé if (unlikely((section->offset_within_address_space & ~page_mask) != 33033f21860SPhilippe Mathieu-Daudé (section->offset_within_region & ~page_mask))) { 331f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_add_unaligned(s, section->mr->name, 33233f21860SPhilippe Mathieu-Daudé section->offset_within_address_space & ~page_mask, 33333f21860SPhilippe Mathieu-Daudé section->offset_within_region & ~page_mask); 334108a6481SCindy Lu return; 335108a6481SCindy Lu } 336108a6481SCindy Lu 33733f21860SPhilippe Mathieu-Daudé iova = ROUND_UP(section->offset_within_address_space, page_size); 33833f21860SPhilippe Mathieu-Daudé llend = vhost_vdpa_section_end(section, page_mask); 339108a6481SCindy Lu if (int128_ge(int128_make64(iova), llend)) { 340108a6481SCindy Lu return; 341108a6481SCindy Lu } 342108a6481SCindy Lu 343108a6481SCindy Lu memory_region_ref(section->mr); 344108a6481SCindy Lu 345108a6481SCindy Lu /* Here we assume that memory_region_is_ram(section->mr)==true */ 346108a6481SCindy Lu 347108a6481SCindy Lu vaddr = memory_region_get_ram_ptr(section->mr) + 348108a6481SCindy Lu section->offset_within_region + 349108a6481SCindy Lu (iova - section->offset_within_address_space); 350108a6481SCindy Lu 351f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_add(s, iova, int128_get64(llend), 352778e67deSLaurent Vivier vaddr, section->readonly); 353778e67deSLaurent Vivier 354108a6481SCindy Lu llsize = int128_sub(llend, int128_make64(iova)); 355f6fe3e33SEugenio Pérez if (s->shadow_data) { 3567dab70beSEugenio Pérez int r; 35734e3c94eSEugenio Pérez 3587dab70beSEugenio Pérez mem_region.translated_addr = (hwaddr)(uintptr_t)vaddr, 3597dab70beSEugenio Pérez mem_region.size = int128_get64(llsize) - 1, 3607dab70beSEugenio Pérez mem_region.perm = IOMMU_ACCESS_FLAG(true, section->readonly), 3617dab70beSEugenio Pérez 362f6fe3e33SEugenio Pérez r = vhost_iova_tree_map_alloc(s->iova_tree, &mem_region); 36334e3c94eSEugenio Pérez if (unlikely(r != IOVA_OK)) { 36434e3c94eSEugenio Pérez error_report("Can't allocate a mapping (%d)", r); 36534e3c94eSEugenio Pérez goto fail; 36634e3c94eSEugenio Pérez } 36734e3c94eSEugenio Pérez 36834e3c94eSEugenio Pérez iova = mem_region.iova; 36934e3c94eSEugenio Pérez } 370108a6481SCindy Lu 371f6fe3e33SEugenio Pérez vhost_vdpa_iotlb_batch_begin_once(s); 372f6fe3e33SEugenio Pérez ret = vhost_vdpa_dma_map(s, VHOST_VDPA_GUEST_PA_ASID, iova, 373cd831ed5SEugenio Pérez int128_get64(llsize), vaddr, section->readonly); 374108a6481SCindy Lu if (ret) { 375108a6481SCindy Lu error_report("vhost vdpa map fail!"); 3767dab70beSEugenio Pérez goto fail_map; 377108a6481SCindy Lu } 378108a6481SCindy Lu 379108a6481SCindy Lu return; 380108a6481SCindy Lu 3817dab70beSEugenio Pérez fail_map: 382f6fe3e33SEugenio Pérez if (s->shadow_data) { 383f6fe3e33SEugenio Pérez vhost_iova_tree_remove(s->iova_tree, mem_region); 3847dab70beSEugenio Pérez } 3857dab70beSEugenio Pérez 386108a6481SCindy Lu fail: 387108a6481SCindy Lu /* 388108a6481SCindy Lu * On the initfn path, store the first error in the container so we 389108a6481SCindy Lu * can gracefully fail. Runtime, there's not much we can do other 390108a6481SCindy Lu * than throw a hardware error. 391108a6481SCindy Lu */ 392108a6481SCindy Lu error_report("vhost-vdpa: DMA mapping failed, unable to continue"); 393108a6481SCindy Lu return; 394108a6481SCindy Lu 395108a6481SCindy Lu } 396108a6481SCindy Lu 397108a6481SCindy Lu static void vhost_vdpa_listener_region_del(MemoryListener *listener, 398108a6481SCindy Lu MemoryRegionSection *section) 399108a6481SCindy Lu { 400f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 401108a6481SCindy Lu hwaddr iova; 402108a6481SCindy Lu Int128 llend, llsize; 403108a6481SCindy Lu int ret; 40433f21860SPhilippe Mathieu-Daudé int page_size = qemu_target_page_size(); 40533f21860SPhilippe Mathieu-Daudé int page_mask = -page_size; 406108a6481SCindy Lu 407f6fe3e33SEugenio Pérez if (vhost_vdpa_listener_skipped_section(section, s->iova_range.first, 408f6fe3e33SEugenio Pérez s->iova_range.last, page_mask)) { 409108a6481SCindy Lu return; 410108a6481SCindy Lu } 411bc7b0cacSCindy Lu if (memory_region_is_iommu(section->mr)) { 412bc7b0cacSCindy Lu vhost_vdpa_iommu_region_del(listener, section); 413bc7b0cacSCindy Lu } 414108a6481SCindy Lu 41533f21860SPhilippe Mathieu-Daudé if (unlikely((section->offset_within_address_space & ~page_mask) != 41633f21860SPhilippe Mathieu-Daudé (section->offset_within_region & ~page_mask))) { 417f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_del_unaligned(s, section->mr->name, 41833f21860SPhilippe Mathieu-Daudé section->offset_within_address_space & ~page_mask, 41933f21860SPhilippe Mathieu-Daudé section->offset_within_region & ~page_mask); 420108a6481SCindy Lu return; 421108a6481SCindy Lu } 422108a6481SCindy Lu 42333f21860SPhilippe Mathieu-Daudé iova = ROUND_UP(section->offset_within_address_space, page_size); 42433f21860SPhilippe Mathieu-Daudé llend = vhost_vdpa_section_end(section, page_mask); 425108a6481SCindy Lu 426f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_del(s, iova, 4273d1e4d34SCindy Lu int128_get64(int128_sub(llend, int128_one()))); 428778e67deSLaurent Vivier 429108a6481SCindy Lu if (int128_ge(int128_make64(iova), llend)) { 430108a6481SCindy Lu return; 431108a6481SCindy Lu } 432108a6481SCindy Lu 433108a6481SCindy Lu llsize = int128_sub(llend, int128_make64(iova)); 434108a6481SCindy Lu 435f6fe3e33SEugenio Pérez if (s->shadow_data) { 43634e3c94eSEugenio Pérez const DMAMap *result; 43734e3c94eSEugenio Pérez const void *vaddr = memory_region_get_ram_ptr(section->mr) + 43834e3c94eSEugenio Pérez section->offset_within_region + 43934e3c94eSEugenio Pérez (iova - section->offset_within_address_space); 44034e3c94eSEugenio Pérez DMAMap mem_region = { 44134e3c94eSEugenio Pérez .translated_addr = (hwaddr)(uintptr_t)vaddr, 44234e3c94eSEugenio Pérez .size = int128_get64(llsize) - 1, 44334e3c94eSEugenio Pérez }; 44434e3c94eSEugenio Pérez 445f6fe3e33SEugenio Pérez result = vhost_iova_tree_find_iova(s->iova_tree, &mem_region); 44610dab9f2SEugenio Pérez if (!result) { 44710dab9f2SEugenio Pérez /* The memory listener map wasn't mapped */ 44810dab9f2SEugenio Pérez return; 44910dab9f2SEugenio Pérez } 45034e3c94eSEugenio Pérez iova = result->iova; 451f6fe3e33SEugenio Pérez vhost_iova_tree_remove(s->iova_tree, *result); 45234e3c94eSEugenio Pérez } 453f6fe3e33SEugenio Pérez vhost_vdpa_iotlb_batch_begin_once(s); 4542fbef6aaSCindy Lu /* 4552fbef6aaSCindy Lu * The unmap ioctl doesn't accept a full 64-bit. need to check it 4562fbef6aaSCindy Lu */ 4572fbef6aaSCindy Lu if (int128_eq(llsize, int128_2_64())) { 4582fbef6aaSCindy Lu llsize = int128_rshift(llsize, 1); 459f6fe3e33SEugenio Pérez ret = vhost_vdpa_dma_unmap(s, VHOST_VDPA_GUEST_PA_ASID, iova, 460cd831ed5SEugenio Pérez int128_get64(llsize)); 4612fbef6aaSCindy Lu 462108a6481SCindy Lu if (ret) { 4632fbef6aaSCindy Lu error_report("vhost_vdpa_dma_unmap(%p, 0x%" HWADDR_PRIx ", " 4642fbef6aaSCindy Lu "0x%" HWADDR_PRIx ") = %d (%m)", 465f6fe3e33SEugenio Pérez s, iova, int128_get64(llsize), ret); 4662fbef6aaSCindy Lu } 4672fbef6aaSCindy Lu iova += int128_get64(llsize); 4682fbef6aaSCindy Lu } 469f6fe3e33SEugenio Pérez ret = vhost_vdpa_dma_unmap(s, VHOST_VDPA_GUEST_PA_ASID, iova, 4702fbef6aaSCindy Lu int128_get64(llsize)); 4712fbef6aaSCindy Lu 4722fbef6aaSCindy Lu if (ret) { 4732fbef6aaSCindy Lu error_report("vhost_vdpa_dma_unmap(%p, 0x%" HWADDR_PRIx ", " 4742fbef6aaSCindy Lu "0x%" HWADDR_PRIx ") = %d (%m)", 475f6fe3e33SEugenio Pérez s, iova, int128_get64(llsize), ret); 476108a6481SCindy Lu } 477108a6481SCindy Lu 478108a6481SCindy Lu memory_region_unref(section->mr); 479108a6481SCindy Lu } 480108a6481SCindy Lu /* 481ef4ff56cSStefano Garzarella * IOTLB API is used by vhost-vdpa which requires incremental updating 482108a6481SCindy Lu * of the mapping. So we can not use generic vhost memory listener which 483108a6481SCindy Lu * depends on the addnop(). 484108a6481SCindy Lu */ 485108a6481SCindy Lu static const MemoryListener vhost_vdpa_memory_listener = { 486142518bdSPeter Xu .name = "vhost-vdpa", 487a5bd0580SJason Wang .commit = vhost_vdpa_listener_commit, 488108a6481SCindy Lu .region_add = vhost_vdpa_listener_region_add, 489108a6481SCindy Lu .region_del = vhost_vdpa_listener_region_del, 490108a6481SCindy Lu }; 491108a6481SCindy Lu 492108a6481SCindy Lu static int vhost_vdpa_call(struct vhost_dev *dev, unsigned long int request, 493108a6481SCindy Lu void *arg) 494108a6481SCindy Lu { 495108a6481SCindy Lu struct vhost_vdpa *v = dev->opaque; 496f12b2498SEugenio Pérez int fd = v->shared->device_fd; 497f2a6e6c4SKevin Wolf int ret; 498108a6481SCindy Lu 499108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 500108a6481SCindy Lu 501f2a6e6c4SKevin Wolf ret = ioctl(fd, request, arg); 502f2a6e6c4SKevin Wolf return ret < 0 ? -errno : ret; 503108a6481SCindy Lu } 504108a6481SCindy Lu 5053631151bSRoman Kagan static int vhost_vdpa_add_status(struct vhost_dev *dev, uint8_t status) 506108a6481SCindy Lu { 507108a6481SCindy Lu uint8_t s; 5083631151bSRoman Kagan int ret; 509108a6481SCindy Lu 510778e67deSLaurent Vivier trace_vhost_vdpa_add_status(dev, status); 5113631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_STATUS, &s); 5123631151bSRoman Kagan if (ret < 0) { 5133631151bSRoman Kagan return ret; 514108a6481SCindy Lu } 515bc865bfeSEugenio Pérez if ((s & status) == status) { 516bc865bfeSEugenio Pérez /* Don't set bits already set */ 517bc865bfeSEugenio Pérez return 0; 518bc865bfeSEugenio Pérez } 519108a6481SCindy Lu 520108a6481SCindy Lu s |= status; 521108a6481SCindy Lu 5223631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_STATUS, &s); 5233631151bSRoman Kagan if (ret < 0) { 5243631151bSRoman Kagan return ret; 5253631151bSRoman Kagan } 5263631151bSRoman Kagan 5273631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_STATUS, &s); 5283631151bSRoman Kagan if (ret < 0) { 5293631151bSRoman Kagan return ret; 5303631151bSRoman Kagan } 5313631151bSRoman Kagan 5323631151bSRoman Kagan if (!(s & status)) { 5333631151bSRoman Kagan return -EIO; 5343631151bSRoman Kagan } 5353631151bSRoman Kagan 5363631151bSRoman Kagan return 0; 537108a6481SCindy Lu } 538108a6481SCindy Lu 539c672f348SLongpeng int vhost_vdpa_get_iova_range(int fd, struct vhost_vdpa_iova_range *iova_range) 540c672f348SLongpeng { 541c672f348SLongpeng int ret = ioctl(fd, VHOST_VDPA_GET_IOVA_RANGE, iova_range); 542c672f348SLongpeng 543c672f348SLongpeng return ret < 0 ? -errno : 0; 544c672f348SLongpeng } 545c672f348SLongpeng 546d71b0609SSi-Wei Liu /* 547d71b0609SSi-Wei Liu * The use of this function is for requests that only need to be 548d71b0609SSi-Wei Liu * applied once. Typically such request occurs at the beginning 549d71b0609SSi-Wei Liu * of operation, and before setting up queues. It should not be 550d71b0609SSi-Wei Liu * used for request that performs operation until all queues are 551d71b0609SSi-Wei Liu * set, which would need to check dev->vq_index_end instead. 552d71b0609SSi-Wei Liu */ 553d71b0609SSi-Wei Liu static bool vhost_vdpa_first_dev(struct vhost_dev *dev) 5544d191cfdSJason Wang { 5554d191cfdSJason Wang struct vhost_vdpa *v = dev->opaque; 5564d191cfdSJason Wang 557d71b0609SSi-Wei Liu return v->index == 0; 5584d191cfdSJason Wang } 5594d191cfdSJason Wang 560c812b065SSi-Wei Liu static bool vhost_vdpa_last_dev(struct vhost_dev *dev) 561c812b065SSi-Wei Liu { 562c812b065SSi-Wei Liu return dev->vq_index + dev->nvqs == dev->vq_index_end; 563c812b065SSi-Wei Liu } 564c812b065SSi-Wei Liu 56512a195faSEugenio Pérez static int vhost_vdpa_get_dev_features(struct vhost_dev *dev, 56612a195faSEugenio Pérez uint64_t *features) 56712a195faSEugenio Pérez { 56812a195faSEugenio Pérez int ret; 56912a195faSEugenio Pérez 57012a195faSEugenio Pérez ret = vhost_vdpa_call(dev, VHOST_GET_FEATURES, features); 57112a195faSEugenio Pérez trace_vhost_vdpa_get_features(dev, *features); 57212a195faSEugenio Pérez return ret; 57312a195faSEugenio Pérez } 57412a195faSEugenio Pérez 575258a0394SEugenio Pérez static void vhost_vdpa_init_svq(struct vhost_dev *hdev, struct vhost_vdpa *v) 576dff4426fSEugenio Pérez { 577dff4426fSEugenio Pérez g_autoptr(GPtrArray) shadow_vqs = NULL; 5784725a418SEugenio Pérez 579dff4426fSEugenio Pérez shadow_vqs = g_ptr_array_new_full(hdev->nvqs, vhost_svq_free); 580dff4426fSEugenio Pérez for (unsigned n = 0; n < hdev->nvqs; ++n) { 5813cfb4d06SEugenio Pérez VhostShadowVirtqueue *svq; 582dff4426fSEugenio Pérez 5835fde952bSEugenio Pérez svq = vhost_svq_new(v->shadow_vq_ops, v->shadow_vq_ops_opaque); 5843cfb4d06SEugenio Pérez g_ptr_array_add(shadow_vqs, svq); 585dff4426fSEugenio Pérez } 586dff4426fSEugenio Pérez 587dff4426fSEugenio Pérez v->shadow_vqs = g_steal_pointer(&shadow_vqs); 588dff4426fSEugenio Pérez } 589dff4426fSEugenio Pérez 59028770ff9SKevin Wolf static int vhost_vdpa_init(struct vhost_dev *dev, void *opaque, Error **errp) 591108a6481SCindy Lu { 592e36b9992SEugenio Pérez struct vhost_vdpa *v = opaque; 593108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 594e36b9992SEugenio Pérez trace_vhost_vdpa_init(dev, v->shared, opaque); 595e1c1915bSDavid Hildenbrand int ret; 596e1c1915bSDavid Hildenbrand 597a5bd0580SJason Wang v->dev = dev; 598108a6481SCindy Lu dev->opaque = opaque ; 599f6fe3e33SEugenio Pérez v->shared->listener = vhost_vdpa_memory_listener; 600258a0394SEugenio Pérez vhost_vdpa_init_svq(dev, v); 601108a6481SCindy Lu 6029c363cf6SEugenio Pérez error_propagate(&dev->migration_blocker, v->migration_blocker); 603d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 6044d191cfdSJason Wang return 0; 6054d191cfdSJason Wang } 6064d191cfdSJason Wang 607a230c471SEugenio Pérez /* 60857ac8318SEugenio Pérez * If dev->shadow_vqs_enabled at initialization that means the device has 60957ac8318SEugenio Pérez * been started with x-svq=on, so don't block migration 61057ac8318SEugenio Pérez */ 61157ac8318SEugenio Pérez if (dev->migration_blocker == NULL && !v->shadow_vqs_enabled) { 61257ac8318SEugenio Pérez /* We don't have dev->features yet */ 61357ac8318SEugenio Pérez uint64_t features; 61457ac8318SEugenio Pérez ret = vhost_vdpa_get_dev_features(dev, &features); 61557ac8318SEugenio Pérez if (unlikely(ret)) { 61657ac8318SEugenio Pérez error_setg_errno(errp, -ret, "Could not get device features"); 61757ac8318SEugenio Pérez return ret; 61857ac8318SEugenio Pérez } 61957ac8318SEugenio Pérez vhost_svq_valid_features(features, &dev->migration_blocker); 62057ac8318SEugenio Pérez } 62157ac8318SEugenio Pérez 62257ac8318SEugenio Pérez /* 623a230c471SEugenio Pérez * Similar to VFIO, we end up pinning all guest memory and have to 624a230c471SEugenio Pérez * disable discarding of RAM. 625a230c471SEugenio Pérez */ 626a230c471SEugenio Pérez ret = ram_block_discard_disable(true); 627a230c471SEugenio Pérez if (ret) { 628a230c471SEugenio Pérez error_report("Cannot set discarding of RAM broken"); 629a230c471SEugenio Pérez return ret; 630a230c471SEugenio Pérez } 631a230c471SEugenio Pérez 632108a6481SCindy Lu vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_ACKNOWLEDGE | 633108a6481SCindy Lu VIRTIO_CONFIG_S_DRIVER); 634108a6481SCindy Lu 635108a6481SCindy Lu return 0; 636108a6481SCindy Lu } 637108a6481SCindy Lu 638d0416d48SJason Wang static void vhost_vdpa_host_notifier_uninit(struct vhost_dev *dev, 639d0416d48SJason Wang int queue_index) 640d0416d48SJason Wang { 6418e3b0cbbSMarc-André Lureau size_t page_size = qemu_real_host_page_size(); 642d0416d48SJason Wang struct vhost_vdpa *v = dev->opaque; 643d0416d48SJason Wang VirtIODevice *vdev = dev->vdev; 644d0416d48SJason Wang VhostVDPAHostNotifier *n; 645d0416d48SJason Wang 646d0416d48SJason Wang n = &v->notifier[queue_index]; 647d0416d48SJason Wang 648d0416d48SJason Wang if (n->addr) { 649d0416d48SJason Wang virtio_queue_set_host_notifier_mr(vdev, queue_index, &n->mr, false); 650d0416d48SJason Wang object_unparent(OBJECT(&n->mr)); 651d0416d48SJason Wang munmap(n->addr, page_size); 652d0416d48SJason Wang n->addr = NULL; 653d0416d48SJason Wang } 654d0416d48SJason Wang } 655d0416d48SJason Wang 656d0416d48SJason Wang static int vhost_vdpa_host_notifier_init(struct vhost_dev *dev, int queue_index) 657d0416d48SJason Wang { 6588e3b0cbbSMarc-André Lureau size_t page_size = qemu_real_host_page_size(); 659d0416d48SJason Wang struct vhost_vdpa *v = dev->opaque; 660d0416d48SJason Wang VirtIODevice *vdev = dev->vdev; 661d0416d48SJason Wang VhostVDPAHostNotifier *n; 662f12b2498SEugenio Pérez int fd = v->shared->device_fd; 663d0416d48SJason Wang void *addr; 664d0416d48SJason Wang char *name; 665d0416d48SJason Wang 666d0416d48SJason Wang vhost_vdpa_host_notifier_uninit(dev, queue_index); 667d0416d48SJason Wang 668d0416d48SJason Wang n = &v->notifier[queue_index]; 669d0416d48SJason Wang 670d0416d48SJason Wang addr = mmap(NULL, page_size, PROT_WRITE, MAP_SHARED, fd, 671d0416d48SJason Wang queue_index * page_size); 672d0416d48SJason Wang if (addr == MAP_FAILED) { 673d0416d48SJason Wang goto err; 674d0416d48SJason Wang } 675d0416d48SJason Wang 676d0416d48SJason Wang name = g_strdup_printf("vhost-vdpa/host-notifier@%p mmaps[%d]", 677d0416d48SJason Wang v, queue_index); 678d0416d48SJason Wang memory_region_init_ram_device_ptr(&n->mr, OBJECT(vdev), name, 679d0416d48SJason Wang page_size, addr); 680d0416d48SJason Wang g_free(name); 681d0416d48SJason Wang 682d0416d48SJason Wang if (virtio_queue_set_host_notifier_mr(vdev, queue_index, &n->mr, true)) { 68398f7607eSLaurent Vivier object_unparent(OBJECT(&n->mr)); 684d0416d48SJason Wang munmap(addr, page_size); 685d0416d48SJason Wang goto err; 686d0416d48SJason Wang } 687d0416d48SJason Wang n->addr = addr; 688d0416d48SJason Wang 689d0416d48SJason Wang return 0; 690d0416d48SJason Wang 691d0416d48SJason Wang err: 692d0416d48SJason Wang return -1; 693d0416d48SJason Wang } 694d0416d48SJason Wang 695b1f030a0SLaurent Vivier static void vhost_vdpa_host_notifiers_uninit(struct vhost_dev *dev, int n) 696b1f030a0SLaurent Vivier { 697b1f030a0SLaurent Vivier int i; 698b1f030a0SLaurent Vivier 699e66f2311SLongpeng /* 700e66f2311SLongpeng * Pack all the changes to the memory regions in a single 701e66f2311SLongpeng * transaction to avoid a few updating of the address space 702e66f2311SLongpeng * topology. 703e66f2311SLongpeng */ 704e66f2311SLongpeng memory_region_transaction_begin(); 705e66f2311SLongpeng 706b1f030a0SLaurent Vivier for (i = dev->vq_index; i < dev->vq_index + n; i++) { 707b1f030a0SLaurent Vivier vhost_vdpa_host_notifier_uninit(dev, i); 708b1f030a0SLaurent Vivier } 709e66f2311SLongpeng 710e66f2311SLongpeng memory_region_transaction_commit(); 711b1f030a0SLaurent Vivier } 712b1f030a0SLaurent Vivier 713d0416d48SJason Wang static void vhost_vdpa_host_notifiers_init(struct vhost_dev *dev) 714d0416d48SJason Wang { 715dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 716d0416d48SJason Wang int i; 717d0416d48SJason Wang 718dff4426fSEugenio Pérez if (v->shadow_vqs_enabled) { 719dff4426fSEugenio Pérez /* FIXME SVQ is not compatible with host notifiers mr */ 720dff4426fSEugenio Pérez return; 721dff4426fSEugenio Pérez } 722dff4426fSEugenio Pérez 723e66f2311SLongpeng /* 724e66f2311SLongpeng * Pack all the changes to the memory regions in a single 725e66f2311SLongpeng * transaction to avoid a few updating of the address space 726e66f2311SLongpeng * topology. 727e66f2311SLongpeng */ 728e66f2311SLongpeng memory_region_transaction_begin(); 729e66f2311SLongpeng 730d0416d48SJason Wang for (i = dev->vq_index; i < dev->vq_index + dev->nvqs; i++) { 731d0416d48SJason Wang if (vhost_vdpa_host_notifier_init(dev, i)) { 732b1f030a0SLaurent Vivier vhost_vdpa_host_notifiers_uninit(dev, i - dev->vq_index); 733e66f2311SLongpeng break; 734e66f2311SLongpeng } 735e66f2311SLongpeng } 736e66f2311SLongpeng 737e66f2311SLongpeng memory_region_transaction_commit(); 738d0416d48SJason Wang } 739d0416d48SJason Wang 740dff4426fSEugenio Pérez static void vhost_vdpa_svq_cleanup(struct vhost_dev *dev) 741dff4426fSEugenio Pérez { 742dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 743dff4426fSEugenio Pérez size_t idx; 744dff4426fSEugenio Pérez 745dff4426fSEugenio Pérez for (idx = 0; idx < v->shadow_vqs->len; ++idx) { 746dff4426fSEugenio Pérez vhost_svq_stop(g_ptr_array_index(v->shadow_vqs, idx)); 747dff4426fSEugenio Pérez } 748dff4426fSEugenio Pérez g_ptr_array_free(v->shadow_vqs, true); 749dff4426fSEugenio Pérez } 750dff4426fSEugenio Pérez 751108a6481SCindy Lu static int vhost_vdpa_cleanup(struct vhost_dev *dev) 752108a6481SCindy Lu { 753108a6481SCindy Lu struct vhost_vdpa *v; 754108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 755108a6481SCindy Lu v = dev->opaque; 756778e67deSLaurent Vivier trace_vhost_vdpa_cleanup(dev, v); 757a230c471SEugenio Pérez if (vhost_vdpa_first_dev(dev)) { 758a230c471SEugenio Pérez ram_block_discard_disable(false); 759f6fe3e33SEugenio Pérez memory_listener_unregister(&v->shared->listener); 760a230c471SEugenio Pérez } 761a230c471SEugenio Pérez 762d0416d48SJason Wang vhost_vdpa_host_notifiers_uninit(dev, dev->nvqs); 763dff4426fSEugenio Pérez vhost_vdpa_svq_cleanup(dev); 764108a6481SCindy Lu 765108a6481SCindy Lu dev->opaque = NULL; 766e1c1915bSDavid Hildenbrand 767108a6481SCindy Lu return 0; 768108a6481SCindy Lu } 769108a6481SCindy Lu 770108a6481SCindy Lu static int vhost_vdpa_memslots_limit(struct vhost_dev *dev) 771108a6481SCindy Lu { 772778e67deSLaurent Vivier trace_vhost_vdpa_memslots_limit(dev, INT_MAX); 773108a6481SCindy Lu return INT_MAX; 774108a6481SCindy Lu } 775108a6481SCindy Lu 776108a6481SCindy Lu static int vhost_vdpa_set_mem_table(struct vhost_dev *dev, 777108a6481SCindy Lu struct vhost_memory *mem) 778108a6481SCindy Lu { 779d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 7804d191cfdSJason Wang return 0; 7814d191cfdSJason Wang } 7824d191cfdSJason Wang 783778e67deSLaurent Vivier trace_vhost_vdpa_set_mem_table(dev, mem->nregions, mem->padding); 784778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_SET_MEM_TABLE) && 785778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_REGIONS)) { 786778e67deSLaurent Vivier int i; 787778e67deSLaurent Vivier for (i = 0; i < mem->nregions; i++) { 788778e67deSLaurent Vivier trace_vhost_vdpa_dump_regions(dev, i, 789778e67deSLaurent Vivier mem->regions[i].guest_phys_addr, 790778e67deSLaurent Vivier mem->regions[i].memory_size, 791778e67deSLaurent Vivier mem->regions[i].userspace_addr, 792778e67deSLaurent Vivier mem->regions[i].flags_padding); 793778e67deSLaurent Vivier } 794778e67deSLaurent Vivier } 795108a6481SCindy Lu if (mem->padding) { 7963631151bSRoman Kagan return -EINVAL; 797108a6481SCindy Lu } 798108a6481SCindy Lu 799108a6481SCindy Lu return 0; 800108a6481SCindy Lu } 801108a6481SCindy Lu 802108a6481SCindy Lu static int vhost_vdpa_set_features(struct vhost_dev *dev, 803108a6481SCindy Lu uint64_t features) 804108a6481SCindy Lu { 80512a195faSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 806108a6481SCindy Lu int ret; 8074d191cfdSJason Wang 808d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 8094d191cfdSJason Wang return 0; 8104d191cfdSJason Wang } 8114d191cfdSJason Wang 81212a195faSEugenio Pérez if (v->shadow_vqs_enabled) { 81312a195faSEugenio Pérez if ((v->acked_features ^ features) == BIT_ULL(VHOST_F_LOG_ALL)) { 81412a195faSEugenio Pérez /* 81512a195faSEugenio Pérez * QEMU is just trying to enable or disable logging. SVQ handles 81612a195faSEugenio Pérez * this sepparately, so no need to forward this. 81712a195faSEugenio Pérez */ 81812a195faSEugenio Pérez v->acked_features = features; 81912a195faSEugenio Pérez return 0; 82012a195faSEugenio Pérez } 82112a195faSEugenio Pérez 82212a195faSEugenio Pérez v->acked_features = features; 82312a195faSEugenio Pérez 82412a195faSEugenio Pérez /* We must not ack _F_LOG if SVQ is enabled */ 82512a195faSEugenio Pérez features &= ~BIT_ULL(VHOST_F_LOG_ALL); 82612a195faSEugenio Pérez } 82712a195faSEugenio Pérez 828778e67deSLaurent Vivier trace_vhost_vdpa_set_features(dev, features); 829108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_SET_FEATURES, &features); 830108a6481SCindy Lu if (ret) { 831108a6481SCindy Lu return ret; 832108a6481SCindy Lu } 833108a6481SCindy Lu 8343631151bSRoman Kagan return vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_FEATURES_OK); 835108a6481SCindy Lu } 836108a6481SCindy Lu 837a5bd0580SJason Wang static int vhost_vdpa_set_backend_cap(struct vhost_dev *dev) 838a5bd0580SJason Wang { 8394da38d1aSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 8404da38d1aSEugenio Pérez 841a5bd0580SJason Wang uint64_t features; 842a5bd0580SJason Wang uint64_t f = 0x1ULL << VHOST_BACKEND_F_IOTLB_MSG_V2 | 843c1a10086SEugenio Pérez 0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH | 844d83b4945SEugenio Pérez 0x1ULL << VHOST_BACKEND_F_IOTLB_ASID | 845d83b4945SEugenio Pérez 0x1ULL << VHOST_BACKEND_F_SUSPEND; 846a5bd0580SJason Wang int r; 847a5bd0580SJason Wang 848a5bd0580SJason Wang if (vhost_vdpa_call(dev, VHOST_GET_BACKEND_FEATURES, &features)) { 8492a83e97eSJason Wang return -EFAULT; 850a5bd0580SJason Wang } 851a5bd0580SJason Wang 852a5bd0580SJason Wang features &= f; 8534d191cfdSJason Wang 854d71b0609SSi-Wei Liu if (vhost_vdpa_first_dev(dev)) { 855a5bd0580SJason Wang r = vhost_vdpa_call(dev, VHOST_SET_BACKEND_FEATURES, &features); 856a5bd0580SJason Wang if (r) { 8572a83e97eSJason Wang return -EFAULT; 858a5bd0580SJason Wang } 8594d191cfdSJason Wang } 860a5bd0580SJason Wang 861a5bd0580SJason Wang dev->backend_cap = features; 8624da38d1aSEugenio Pérez v->shared->backend_cap = features; 863a5bd0580SJason Wang 864a5bd0580SJason Wang return 0; 865a5bd0580SJason Wang } 866a5bd0580SJason Wang 867c232b8f4SZenghui Yu static int vhost_vdpa_get_device_id(struct vhost_dev *dev, 868108a6481SCindy Lu uint32_t *device_id) 869108a6481SCindy Lu { 870778e67deSLaurent Vivier int ret; 871778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_DEVICE_ID, device_id); 872778e67deSLaurent Vivier trace_vhost_vdpa_get_device_id(dev, *device_id); 873778e67deSLaurent Vivier return ret; 874108a6481SCindy Lu } 875108a6481SCindy Lu 876108a6481SCindy Lu static int vhost_vdpa_reset_device(struct vhost_dev *dev) 877108a6481SCindy Lu { 8780bb302a9SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 879778e67deSLaurent Vivier int ret; 880108a6481SCindy Lu uint8_t status = 0; 881108a6481SCindy Lu 882778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_STATUS, &status); 8832b5de4d7SEugenio Pérez trace_vhost_vdpa_reset_device(dev); 8840bb302a9SEugenio Pérez v->suspended = false; 885778e67deSLaurent Vivier return ret; 886108a6481SCindy Lu } 887108a6481SCindy Lu 888108a6481SCindy Lu static int vhost_vdpa_get_vq_index(struct vhost_dev *dev, int idx) 889108a6481SCindy Lu { 890108a6481SCindy Lu assert(idx >= dev->vq_index && idx < dev->vq_index + dev->nvqs); 891108a6481SCindy Lu 892353244d8SJason Wang trace_vhost_vdpa_get_vq_index(dev, idx, idx); 893353244d8SJason Wang return idx; 894108a6481SCindy Lu } 895108a6481SCindy Lu 896d7ce0841SEugenio Pérez int vhost_vdpa_set_vring_ready(struct vhost_vdpa *v, unsigned idx) 897108a6481SCindy Lu { 898d7ce0841SEugenio Pérez struct vhost_dev *dev = v->dev; 899108a6481SCindy Lu struct vhost_vring_state state = { 900d7ce0841SEugenio Pérez .index = idx, 901108a6481SCindy Lu .num = 1, 902108a6481SCindy Lu }; 903d7ce0841SEugenio Pérez int r = vhost_vdpa_call(dev, VHOST_VDPA_SET_VRING_ENABLE, &state); 904d7ce0841SEugenio Pérez 905d7ce0841SEugenio Pérez trace_vhost_vdpa_set_vring_ready(dev, idx, r); 906d7ce0841SEugenio Pérez return r; 907108a6481SCindy Lu } 908108a6481SCindy Lu 909259f3accSCindy Lu static int vhost_vdpa_set_config_call(struct vhost_dev *dev, 910259f3accSCindy Lu int fd) 911259f3accSCindy Lu { 912259f3accSCindy Lu trace_vhost_vdpa_set_config_call(dev, fd); 913259f3accSCindy Lu return vhost_vdpa_call(dev, VHOST_VDPA_SET_CONFIG_CALL, &fd); 914259f3accSCindy Lu } 915259f3accSCindy Lu 916778e67deSLaurent Vivier static void vhost_vdpa_dump_config(struct vhost_dev *dev, const uint8_t *config, 917778e67deSLaurent Vivier uint32_t config_len) 918778e67deSLaurent Vivier { 919778e67deSLaurent Vivier int b, len; 920778e67deSLaurent Vivier char line[QEMU_HEXDUMP_LINE_LEN]; 921778e67deSLaurent Vivier 922778e67deSLaurent Vivier for (b = 0; b < config_len; b += 16) { 923778e67deSLaurent Vivier len = config_len - b; 924778e67deSLaurent Vivier qemu_hexdump_line(line, b, config, len, false); 925778e67deSLaurent Vivier trace_vhost_vdpa_dump_config(dev, line); 926778e67deSLaurent Vivier } 927778e67deSLaurent Vivier } 928778e67deSLaurent Vivier 929108a6481SCindy Lu static int vhost_vdpa_set_config(struct vhost_dev *dev, const uint8_t *data, 930108a6481SCindy Lu uint32_t offset, uint32_t size, 931108a6481SCindy Lu uint32_t flags) 932108a6481SCindy Lu { 933108a6481SCindy Lu struct vhost_vdpa_config *config; 934108a6481SCindy Lu int ret; 935108a6481SCindy Lu unsigned long config_size = offsetof(struct vhost_vdpa_config, buf); 936986d4f78SLi Qiang 937778e67deSLaurent Vivier trace_vhost_vdpa_set_config(dev, offset, size, flags); 938108a6481SCindy Lu config = g_malloc(size + config_size); 939108a6481SCindy Lu config->off = offset; 940108a6481SCindy Lu config->len = size; 941108a6481SCindy Lu memcpy(config->buf, data, size); 942778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_SET_CONFIG) && 943778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_CONFIG)) { 944778e67deSLaurent Vivier vhost_vdpa_dump_config(dev, data, size); 945778e67deSLaurent Vivier } 946108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_CONFIG, config); 947108a6481SCindy Lu g_free(config); 948108a6481SCindy Lu return ret; 949108a6481SCindy Lu } 950108a6481SCindy Lu 951108a6481SCindy Lu static int vhost_vdpa_get_config(struct vhost_dev *dev, uint8_t *config, 95250de5138SKevin Wolf uint32_t config_len, Error **errp) 953108a6481SCindy Lu { 954108a6481SCindy Lu struct vhost_vdpa_config *v_config; 955108a6481SCindy Lu unsigned long config_size = offsetof(struct vhost_vdpa_config, buf); 956108a6481SCindy Lu int ret; 957108a6481SCindy Lu 958778e67deSLaurent Vivier trace_vhost_vdpa_get_config(dev, config, config_len); 959108a6481SCindy Lu v_config = g_malloc(config_len + config_size); 960108a6481SCindy Lu v_config->len = config_len; 961108a6481SCindy Lu v_config->off = 0; 962108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_CONFIG, v_config); 963108a6481SCindy Lu memcpy(config, v_config->buf, config_len); 964108a6481SCindy Lu g_free(v_config); 965778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_GET_CONFIG) && 966778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_CONFIG)) { 967778e67deSLaurent Vivier vhost_vdpa_dump_config(dev, config, config_len); 968778e67deSLaurent Vivier } 969108a6481SCindy Lu return ret; 970108a6481SCindy Lu } 971108a6481SCindy Lu 972d96be4c8SEugenio Pérez static int vhost_vdpa_set_dev_vring_base(struct vhost_dev *dev, 973d96be4c8SEugenio Pérez struct vhost_vring_state *ring) 974d96be4c8SEugenio Pérez { 97519a060bcSSi-Wei Liu struct vhost_vdpa *v = dev->opaque; 97619a060bcSSi-Wei Liu 97719a060bcSSi-Wei Liu trace_vhost_vdpa_set_dev_vring_base(dev, ring->index, ring->num, 97819a060bcSSi-Wei Liu v->shadow_vqs_enabled); 979d96be4c8SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_BASE, ring); 980d96be4c8SEugenio Pérez } 981d96be4c8SEugenio Pérez 982dff4426fSEugenio Pérez static int vhost_vdpa_set_vring_dev_kick(struct vhost_dev *dev, 983dff4426fSEugenio Pérez struct vhost_vring_file *file) 984dff4426fSEugenio Pérez { 985dff4426fSEugenio Pérez trace_vhost_vdpa_set_vring_kick(dev, file->index, file->fd); 986dff4426fSEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_KICK, file); 987dff4426fSEugenio Pérez } 988dff4426fSEugenio Pérez 989a8ac8858SEugenio Pérez static int vhost_vdpa_set_vring_dev_call(struct vhost_dev *dev, 990a8ac8858SEugenio Pérez struct vhost_vring_file *file) 991a8ac8858SEugenio Pérez { 992a8ac8858SEugenio Pérez trace_vhost_vdpa_set_vring_call(dev, file->index, file->fd); 993a8ac8858SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_CALL, file); 994a8ac8858SEugenio Pérez } 995a8ac8858SEugenio Pérez 996d96be4c8SEugenio Pérez static int vhost_vdpa_set_vring_dev_addr(struct vhost_dev *dev, 997d96be4c8SEugenio Pérez struct vhost_vring_addr *addr) 998d96be4c8SEugenio Pérez { 999d96be4c8SEugenio Pérez trace_vhost_vdpa_set_vring_addr(dev, addr->index, addr->flags, 1000d96be4c8SEugenio Pérez addr->desc_user_addr, addr->used_user_addr, 1001d96be4c8SEugenio Pérez addr->avail_user_addr, 1002d96be4c8SEugenio Pérez addr->log_guest_addr); 1003d96be4c8SEugenio Pérez 1004d96be4c8SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_ADDR, addr); 1005d96be4c8SEugenio Pérez 1006d96be4c8SEugenio Pérez } 1007d96be4c8SEugenio Pérez 1008dff4426fSEugenio Pérez /** 1009dff4426fSEugenio Pérez * Set the shadow virtqueue descriptors to the device 1010dff4426fSEugenio Pérez * 1011dff4426fSEugenio Pérez * @dev: The vhost device model 1012dff4426fSEugenio Pérez * @svq: The shadow virtqueue 1013dff4426fSEugenio Pérez * @idx: The index of the virtqueue in the vhost device 1014dff4426fSEugenio Pérez * @errp: Error 1015a8ac8858SEugenio Pérez * 1016a8ac8858SEugenio Pérez * Note that this function does not rewind kick file descriptor if cannot set 1017a8ac8858SEugenio Pérez * call one. 1018dff4426fSEugenio Pérez */ 1019100890f7SEugenio Pérez static int vhost_vdpa_svq_set_fds(struct vhost_dev *dev, 1020dff4426fSEugenio Pérez VhostShadowVirtqueue *svq, unsigned idx, 1021dff4426fSEugenio Pérez Error **errp) 1022dff4426fSEugenio Pérez { 1023dff4426fSEugenio Pérez struct vhost_vring_file file = { 1024dff4426fSEugenio Pérez .index = dev->vq_index + idx, 1025dff4426fSEugenio Pérez }; 1026dff4426fSEugenio Pérez const EventNotifier *event_notifier = &svq->hdev_kick; 1027dff4426fSEugenio Pérez int r; 1028dff4426fSEugenio Pérez 10293cfb4d06SEugenio Pérez r = event_notifier_init(&svq->hdev_kick, 0); 10303cfb4d06SEugenio Pérez if (r != 0) { 10313cfb4d06SEugenio Pérez error_setg_errno(errp, -r, "Couldn't create kick event notifier"); 10323cfb4d06SEugenio Pérez goto err_init_hdev_kick; 10333cfb4d06SEugenio Pérez } 10343cfb4d06SEugenio Pérez 10353cfb4d06SEugenio Pérez r = event_notifier_init(&svq->hdev_call, 0); 10363cfb4d06SEugenio Pérez if (r != 0) { 10373cfb4d06SEugenio Pérez error_setg_errno(errp, -r, "Couldn't create call event notifier"); 10383cfb4d06SEugenio Pérez goto err_init_hdev_call; 10393cfb4d06SEugenio Pérez } 10403cfb4d06SEugenio Pérez 1041dff4426fSEugenio Pérez file.fd = event_notifier_get_fd(event_notifier); 1042dff4426fSEugenio Pérez r = vhost_vdpa_set_vring_dev_kick(dev, &file); 1043dff4426fSEugenio Pérez if (unlikely(r != 0)) { 1044dff4426fSEugenio Pérez error_setg_errno(errp, -r, "Can't set device kick fd"); 10453cfb4d06SEugenio Pérez goto err_init_set_dev_fd; 1046a8ac8858SEugenio Pérez } 1047a8ac8858SEugenio Pérez 1048a8ac8858SEugenio Pérez event_notifier = &svq->hdev_call; 1049a8ac8858SEugenio Pérez file.fd = event_notifier_get_fd(event_notifier); 1050a8ac8858SEugenio Pérez r = vhost_vdpa_set_vring_dev_call(dev, &file); 1051a8ac8858SEugenio Pérez if (unlikely(r != 0)) { 1052a8ac8858SEugenio Pérez error_setg_errno(errp, -r, "Can't set device call fd"); 10533cfb4d06SEugenio Pérez goto err_init_set_dev_fd; 1054dff4426fSEugenio Pérez } 1055dff4426fSEugenio Pérez 10563cfb4d06SEugenio Pérez return 0; 10573cfb4d06SEugenio Pérez 10583cfb4d06SEugenio Pérez err_init_set_dev_fd: 10593cfb4d06SEugenio Pérez event_notifier_set_handler(&svq->hdev_call, NULL); 10603cfb4d06SEugenio Pérez 10613cfb4d06SEugenio Pérez err_init_hdev_call: 10623cfb4d06SEugenio Pérez event_notifier_cleanup(&svq->hdev_kick); 10633cfb4d06SEugenio Pérez 10643cfb4d06SEugenio Pérez err_init_hdev_kick: 1065100890f7SEugenio Pérez return r; 1066100890f7SEugenio Pérez } 1067100890f7SEugenio Pérez 1068100890f7SEugenio Pérez /** 1069100890f7SEugenio Pérez * Unmap a SVQ area in the device 1070100890f7SEugenio Pérez */ 10718b6d6119SEugenio Pérez static void vhost_vdpa_svq_unmap_ring(struct vhost_vdpa *v, hwaddr addr) 1072100890f7SEugenio Pérez { 10738b6d6119SEugenio Pérez const DMAMap needle = { 10748b6d6119SEugenio Pérez .translated_addr = addr, 10758b6d6119SEugenio Pérez }; 10765edb02e8SEugenio Pérez const DMAMap *result = vhost_iova_tree_find_iova(v->shared->iova_tree, 10775edb02e8SEugenio Pérez &needle); 107834e3c94eSEugenio Pérez hwaddr size; 1079100890f7SEugenio Pérez int r; 1080100890f7SEugenio Pérez 108134e3c94eSEugenio Pérez if (unlikely(!result)) { 108234e3c94eSEugenio Pérez error_report("Unable to find SVQ address to unmap"); 10835b590f51SEugenio Pérez return; 108434e3c94eSEugenio Pérez } 108534e3c94eSEugenio Pérez 10868e3b0cbbSMarc-André Lureau size = ROUND_UP(result->size, qemu_real_host_page_size()); 10876f03d9efSEugenio Pérez r = vhost_vdpa_dma_unmap(v->shared, v->address_space_id, result->iova, 10886f03d9efSEugenio Pérez size); 1089b37c12beSEugenio Pérez if (unlikely(r < 0)) { 1090b37c12beSEugenio Pérez error_report("Unable to unmap SVQ vring: %s (%d)", g_strerror(-r), -r); 10915b590f51SEugenio Pérez return; 1092b37c12beSEugenio Pérez } 1093b37c12beSEugenio Pérez 10945edb02e8SEugenio Pérez vhost_iova_tree_remove(v->shared->iova_tree, *result); 1095100890f7SEugenio Pérez } 1096100890f7SEugenio Pérez 10975b590f51SEugenio Pérez static void vhost_vdpa_svq_unmap_rings(struct vhost_dev *dev, 1098100890f7SEugenio Pérez const VhostShadowVirtqueue *svq) 1099100890f7SEugenio Pérez { 1100100890f7SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1101100890f7SEugenio Pérez struct vhost_vring_addr svq_addr; 1102100890f7SEugenio Pérez 1103100890f7SEugenio Pérez vhost_svq_get_vring_addr(svq, &svq_addr); 1104100890f7SEugenio Pérez 11058b6d6119SEugenio Pérez vhost_vdpa_svq_unmap_ring(v, svq_addr.desc_user_addr); 1106100890f7SEugenio Pérez 11078b6d6119SEugenio Pérez vhost_vdpa_svq_unmap_ring(v, svq_addr.used_user_addr); 110834e3c94eSEugenio Pérez } 110934e3c94eSEugenio Pérez 111034e3c94eSEugenio Pérez /** 111134e3c94eSEugenio Pérez * Map the SVQ area in the device 111234e3c94eSEugenio Pérez * 111334e3c94eSEugenio Pérez * @v: Vhost-vdpa device 111434e3c94eSEugenio Pérez * @needle: The area to search iova 111534e3c94eSEugenio Pérez * @errorp: Error pointer 111634e3c94eSEugenio Pérez */ 111734e3c94eSEugenio Pérez static bool vhost_vdpa_svq_map_ring(struct vhost_vdpa *v, DMAMap *needle, 111834e3c94eSEugenio Pérez Error **errp) 111934e3c94eSEugenio Pérez { 112034e3c94eSEugenio Pérez int r; 112134e3c94eSEugenio Pérez 11225edb02e8SEugenio Pérez r = vhost_iova_tree_map_alloc(v->shared->iova_tree, needle); 112334e3c94eSEugenio Pérez if (unlikely(r != IOVA_OK)) { 112434e3c94eSEugenio Pérez error_setg(errp, "Cannot allocate iova (%d)", r); 112534e3c94eSEugenio Pérez return false; 112634e3c94eSEugenio Pérez } 112734e3c94eSEugenio Pérez 11286f03d9efSEugenio Pérez r = vhost_vdpa_dma_map(v->shared, v->address_space_id, needle->iova, 1129cd831ed5SEugenio Pérez needle->size + 1, 113034e3c94eSEugenio Pérez (void *)(uintptr_t)needle->translated_addr, 113134e3c94eSEugenio Pérez needle->perm == IOMMU_RO); 113234e3c94eSEugenio Pérez if (unlikely(r != 0)) { 113334e3c94eSEugenio Pérez error_setg_errno(errp, -r, "Cannot map region to device"); 11345edb02e8SEugenio Pérez vhost_iova_tree_remove(v->shared->iova_tree, *needle); 113534e3c94eSEugenio Pérez } 113634e3c94eSEugenio Pérez 113734e3c94eSEugenio Pérez return r == 0; 1138100890f7SEugenio Pérez } 1139100890f7SEugenio Pérez 1140100890f7SEugenio Pérez /** 1141100890f7SEugenio Pérez * Map the shadow virtqueue rings in the device 1142100890f7SEugenio Pérez * 1143100890f7SEugenio Pérez * @dev: The vhost device 1144100890f7SEugenio Pérez * @svq: The shadow virtqueue 1145100890f7SEugenio Pérez * @addr: Assigned IOVA addresses 1146100890f7SEugenio Pérez * @errp: Error pointer 1147100890f7SEugenio Pérez */ 1148100890f7SEugenio Pérez static bool vhost_vdpa_svq_map_rings(struct vhost_dev *dev, 1149100890f7SEugenio Pérez const VhostShadowVirtqueue *svq, 1150100890f7SEugenio Pérez struct vhost_vring_addr *addr, 1151100890f7SEugenio Pérez Error **errp) 1152100890f7SEugenio Pérez { 115305e385d2SMarkus Armbruster ERRP_GUARD(); 115434e3c94eSEugenio Pérez DMAMap device_region, driver_region; 115534e3c94eSEugenio Pérez struct vhost_vring_addr svq_addr; 1156100890f7SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1157100890f7SEugenio Pérez size_t device_size = vhost_svq_device_area_size(svq); 1158100890f7SEugenio Pérez size_t driver_size = vhost_svq_driver_area_size(svq); 115934e3c94eSEugenio Pérez size_t avail_offset; 116034e3c94eSEugenio Pérez bool ok; 1161100890f7SEugenio Pérez 116234e3c94eSEugenio Pérez vhost_svq_get_vring_addr(svq, &svq_addr); 1163100890f7SEugenio Pérez 116434e3c94eSEugenio Pérez driver_region = (DMAMap) { 116534e3c94eSEugenio Pérez .translated_addr = svq_addr.desc_user_addr, 116634e3c94eSEugenio Pérez .size = driver_size - 1, 116734e3c94eSEugenio Pérez .perm = IOMMU_RO, 116834e3c94eSEugenio Pérez }; 116934e3c94eSEugenio Pérez ok = vhost_vdpa_svq_map_ring(v, &driver_region, errp); 117034e3c94eSEugenio Pérez if (unlikely(!ok)) { 117134e3c94eSEugenio Pérez error_prepend(errp, "Cannot create vq driver region: "); 1172100890f7SEugenio Pérez return false; 1173100890f7SEugenio Pérez } 117434e3c94eSEugenio Pérez addr->desc_user_addr = driver_region.iova; 117534e3c94eSEugenio Pérez avail_offset = svq_addr.avail_user_addr - svq_addr.desc_user_addr; 117634e3c94eSEugenio Pérez addr->avail_user_addr = driver_region.iova + avail_offset; 1177100890f7SEugenio Pérez 117834e3c94eSEugenio Pérez device_region = (DMAMap) { 117934e3c94eSEugenio Pérez .translated_addr = svq_addr.used_user_addr, 118034e3c94eSEugenio Pérez .size = device_size - 1, 118134e3c94eSEugenio Pérez .perm = IOMMU_RW, 118234e3c94eSEugenio Pérez }; 118334e3c94eSEugenio Pérez ok = vhost_vdpa_svq_map_ring(v, &device_region, errp); 118434e3c94eSEugenio Pérez if (unlikely(!ok)) { 118534e3c94eSEugenio Pérez error_prepend(errp, "Cannot create vq device region: "); 11868b6d6119SEugenio Pérez vhost_vdpa_svq_unmap_ring(v, driver_region.translated_addr); 1187100890f7SEugenio Pérez } 118834e3c94eSEugenio Pérez addr->used_user_addr = device_region.iova; 1189100890f7SEugenio Pérez 119034e3c94eSEugenio Pérez return ok; 1191100890f7SEugenio Pérez } 1192100890f7SEugenio Pérez 1193100890f7SEugenio Pérez static bool vhost_vdpa_svq_setup(struct vhost_dev *dev, 1194100890f7SEugenio Pérez VhostShadowVirtqueue *svq, unsigned idx, 1195100890f7SEugenio Pérez Error **errp) 1196100890f7SEugenio Pérez { 1197100890f7SEugenio Pérez uint16_t vq_index = dev->vq_index + idx; 1198100890f7SEugenio Pérez struct vhost_vring_state s = { 1199100890f7SEugenio Pérez .index = vq_index, 1200100890f7SEugenio Pérez }; 1201100890f7SEugenio Pérez int r; 1202100890f7SEugenio Pérez 1203100890f7SEugenio Pérez r = vhost_vdpa_set_dev_vring_base(dev, &s); 1204100890f7SEugenio Pérez if (unlikely(r)) { 1205100890f7SEugenio Pérez error_setg_errno(errp, -r, "Cannot set vring base"); 1206100890f7SEugenio Pérez return false; 1207100890f7SEugenio Pérez } 1208100890f7SEugenio Pérez 1209100890f7SEugenio Pérez r = vhost_vdpa_svq_set_fds(dev, svq, idx, errp); 1210dff4426fSEugenio Pérez return r == 0; 1211dff4426fSEugenio Pérez } 1212dff4426fSEugenio Pérez 1213dff4426fSEugenio Pérez static bool vhost_vdpa_svqs_start(struct vhost_dev *dev) 1214dff4426fSEugenio Pérez { 1215dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1216dff4426fSEugenio Pérez Error *err = NULL; 1217dff4426fSEugenio Pérez unsigned i; 1218dff4426fSEugenio Pérez 1219712c1a31SEugenio Pérez if (!v->shadow_vqs_enabled) { 1220dff4426fSEugenio Pérez return true; 1221dff4426fSEugenio Pérez } 1222dff4426fSEugenio Pérez 1223dff4426fSEugenio Pérez for (i = 0; i < v->shadow_vqs->len; ++i) { 1224100890f7SEugenio Pérez VirtQueue *vq = virtio_get_queue(dev->vdev, dev->vq_index + i); 1225dff4426fSEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, i); 1226100890f7SEugenio Pérez struct vhost_vring_addr addr = { 12271c82fdfeSEugenio Pérez .index = dev->vq_index + i, 1228100890f7SEugenio Pérez }; 1229100890f7SEugenio Pérez int r; 1230dff4426fSEugenio Pérez bool ok = vhost_vdpa_svq_setup(dev, svq, i, &err); 1231dff4426fSEugenio Pérez if (unlikely(!ok)) { 1232100890f7SEugenio Pérez goto err; 1233100890f7SEugenio Pérez } 1234100890f7SEugenio Pérez 12355edb02e8SEugenio Pérez vhost_svq_start(svq, dev->vdev, vq, v->shared->iova_tree); 1236100890f7SEugenio Pérez ok = vhost_vdpa_svq_map_rings(dev, svq, &addr, &err); 1237100890f7SEugenio Pérez if (unlikely(!ok)) { 1238100890f7SEugenio Pérez goto err_map; 1239100890f7SEugenio Pérez } 1240100890f7SEugenio Pérez 1241100890f7SEugenio Pérez /* Override vring GPA set by vhost subsystem */ 1242100890f7SEugenio Pérez r = vhost_vdpa_set_vring_dev_addr(dev, &addr); 1243100890f7SEugenio Pérez if (unlikely(r != 0)) { 1244100890f7SEugenio Pérez error_setg_errno(&err, -r, "Cannot set device address"); 1245100890f7SEugenio Pérez goto err_set_addr; 1246100890f7SEugenio Pérez } 1247100890f7SEugenio Pérez } 1248100890f7SEugenio Pérez 1249100890f7SEugenio Pérez return true; 1250100890f7SEugenio Pérez 1251100890f7SEugenio Pérez err_set_addr: 1252100890f7SEugenio Pérez vhost_vdpa_svq_unmap_rings(dev, g_ptr_array_index(v->shadow_vqs, i)); 1253100890f7SEugenio Pérez 1254100890f7SEugenio Pérez err_map: 1255100890f7SEugenio Pérez vhost_svq_stop(g_ptr_array_index(v->shadow_vqs, i)); 1256100890f7SEugenio Pérez 1257100890f7SEugenio Pérez err: 1258dff4426fSEugenio Pérez error_reportf_err(err, "Cannot setup SVQ %u: ", i); 1259100890f7SEugenio Pérez for (unsigned j = 0; j < i; ++j) { 1260100890f7SEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, j); 1261100890f7SEugenio Pérez vhost_vdpa_svq_unmap_rings(dev, svq); 1262100890f7SEugenio Pérez vhost_svq_stop(svq); 1263100890f7SEugenio Pérez } 1264100890f7SEugenio Pérez 1265100890f7SEugenio Pérez return false; 1266100890f7SEugenio Pérez } 1267100890f7SEugenio Pérez 12685b590f51SEugenio Pérez static void vhost_vdpa_svqs_stop(struct vhost_dev *dev) 1269100890f7SEugenio Pérez { 1270100890f7SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1271100890f7SEugenio Pérez 1272712c1a31SEugenio Pérez if (!v->shadow_vqs_enabled) { 12735b590f51SEugenio Pérez return; 1274100890f7SEugenio Pérez } 1275100890f7SEugenio Pérez 1276100890f7SEugenio Pérez for (unsigned i = 0; i < v->shadow_vqs->len; ++i) { 1277100890f7SEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, i); 12782e1a9de9SEugenio Pérez 12792e1a9de9SEugenio Pérez vhost_svq_stop(svq); 12805b590f51SEugenio Pérez vhost_vdpa_svq_unmap_rings(dev, svq); 12813cfb4d06SEugenio Pérez 12823cfb4d06SEugenio Pérez event_notifier_cleanup(&svq->hdev_kick); 12833cfb4d06SEugenio Pérez event_notifier_cleanup(&svq->hdev_call); 1284dff4426fSEugenio Pérez } 1285dff4426fSEugenio Pérez } 1286dff4426fSEugenio Pérez 12870bb302a9SEugenio Pérez static void vhost_vdpa_suspend(struct vhost_dev *dev) 12880bb302a9SEugenio Pérez { 12890bb302a9SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 12900bb302a9SEugenio Pérez int r; 12910bb302a9SEugenio Pérez 12920bb302a9SEugenio Pérez if (!vhost_vdpa_first_dev(dev)) { 12930bb302a9SEugenio Pérez return; 12940bb302a9SEugenio Pérez } 12950bb302a9SEugenio Pérez 12960bb302a9SEugenio Pérez if (dev->backend_cap & BIT_ULL(VHOST_BACKEND_F_SUSPEND)) { 12970bb302a9SEugenio Pérez trace_vhost_vdpa_suspend(dev); 1298f12b2498SEugenio Pérez r = ioctl(v->shared->device_fd, VHOST_VDPA_SUSPEND); 12990bb302a9SEugenio Pérez if (unlikely(r)) { 13000bb302a9SEugenio Pérez error_report("Cannot suspend: %s(%d)", g_strerror(errno), errno); 13010bb302a9SEugenio Pérez } else { 13020bb302a9SEugenio Pérez v->suspended = true; 13030bb302a9SEugenio Pérez return; 13040bb302a9SEugenio Pérez } 13050bb302a9SEugenio Pérez } 13060bb302a9SEugenio Pérez 13070bb302a9SEugenio Pérez vhost_vdpa_reset_device(dev); 13080bb302a9SEugenio Pérez } 13090bb302a9SEugenio Pérez 1310108a6481SCindy Lu static int vhost_vdpa_dev_start(struct vhost_dev *dev, bool started) 1311108a6481SCindy Lu { 1312108a6481SCindy Lu struct vhost_vdpa *v = dev->opaque; 1313dff4426fSEugenio Pérez bool ok; 1314778e67deSLaurent Vivier trace_vhost_vdpa_dev_start(dev, started); 13154d191cfdSJason Wang 13164d191cfdSJason Wang if (started) { 13174d191cfdSJason Wang vhost_vdpa_host_notifiers_init(dev); 1318dff4426fSEugenio Pérez ok = vhost_vdpa_svqs_start(dev); 1319dff4426fSEugenio Pérez if (unlikely(!ok)) { 1320dff4426fSEugenio Pérez return -1; 1321dff4426fSEugenio Pérez } 13224d191cfdSJason Wang } else { 13230bb302a9SEugenio Pérez vhost_vdpa_suspend(dev); 13245b590f51SEugenio Pérez vhost_vdpa_svqs_stop(dev); 13254d191cfdSJason Wang vhost_vdpa_host_notifiers_uninit(dev, dev->nvqs); 13264d191cfdSJason Wang } 13274d191cfdSJason Wang 1328c812b065SSi-Wei Liu if (!vhost_vdpa_last_dev(dev)) { 13294d191cfdSJason Wang return 0; 13304d191cfdSJason Wang } 13314d191cfdSJason Wang 1332108a6481SCindy Lu if (started) { 1333bc7b0cacSCindy Lu if (vhost_dev_has_iommu(dev) && (v->shadow_vqs_enabled)) { 1334bc7b0cacSCindy Lu error_report("SVQ can not work while IOMMU enable, please disable" 1335bc7b0cacSCindy Lu "IOMMU and try again"); 1336bc7b0cacSCindy Lu return -1; 1337bc7b0cacSCindy Lu } 1338f6fe3e33SEugenio Pérez memory_listener_register(&v->shared->listener, dev->vdev->dma_as); 1339bc7b0cacSCindy Lu 13403631151bSRoman Kagan return vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_DRIVER_OK); 1341c3716f26SEugenio Pérez } 1342c3716f26SEugenio Pérez 1343c3716f26SEugenio Pérez return 0; 1344c3716f26SEugenio Pérez } 1345c3716f26SEugenio Pérez 1346c3716f26SEugenio Pérez static void vhost_vdpa_reset_status(struct vhost_dev *dev) 1347c3716f26SEugenio Pérez { 1348c3716f26SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1349c3716f26SEugenio Pérez 1350c812b065SSi-Wei Liu if (!vhost_vdpa_last_dev(dev)) { 1351c3716f26SEugenio Pérez return; 1352c3716f26SEugenio Pérez } 1353c3716f26SEugenio Pérez 1354108a6481SCindy Lu vhost_vdpa_reset_device(dev); 1355108a6481SCindy Lu vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_ACKNOWLEDGE | 1356108a6481SCindy Lu VIRTIO_CONFIG_S_DRIVER); 1357f6fe3e33SEugenio Pérez memory_listener_unregister(&v->shared->listener); 1358108a6481SCindy Lu } 1359108a6481SCindy Lu 1360108a6481SCindy Lu static int vhost_vdpa_set_log_base(struct vhost_dev *dev, uint64_t base, 1361108a6481SCindy Lu struct vhost_log *log) 1362108a6481SCindy Lu { 1363773ebc95SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1364d71b0609SSi-Wei Liu if (v->shadow_vqs_enabled || !vhost_vdpa_first_dev(dev)) { 13654d191cfdSJason Wang return 0; 13664d191cfdSJason Wang } 13674d191cfdSJason Wang 1368778e67deSLaurent Vivier trace_vhost_vdpa_set_log_base(dev, base, log->size, log->refcnt, log->fd, 1369778e67deSLaurent Vivier log->log); 1370108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_LOG_BASE, &base); 1371108a6481SCindy Lu } 1372108a6481SCindy Lu 1373108a6481SCindy Lu static int vhost_vdpa_set_vring_addr(struct vhost_dev *dev, 1374108a6481SCindy Lu struct vhost_vring_addr *addr) 1375108a6481SCindy Lu { 1376d96be4c8SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1377d96be4c8SEugenio Pérez 1378d96be4c8SEugenio Pérez if (v->shadow_vqs_enabled) { 1379d96be4c8SEugenio Pérez /* 1380d96be4c8SEugenio Pérez * Device vring addr was set at device start. SVQ base is handled by 1381d96be4c8SEugenio Pérez * VirtQueue code. 1382d96be4c8SEugenio Pérez */ 1383d96be4c8SEugenio Pérez return 0; 1384d96be4c8SEugenio Pérez } 1385d96be4c8SEugenio Pérez 1386d96be4c8SEugenio Pérez return vhost_vdpa_set_vring_dev_addr(dev, addr); 1387108a6481SCindy Lu } 1388108a6481SCindy Lu 1389108a6481SCindy Lu static int vhost_vdpa_set_vring_num(struct vhost_dev *dev, 1390108a6481SCindy Lu struct vhost_vring_state *ring) 1391108a6481SCindy Lu { 1392778e67deSLaurent Vivier trace_vhost_vdpa_set_vring_num(dev, ring->index, ring->num); 1393108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_VRING_NUM, ring); 1394108a6481SCindy Lu } 1395108a6481SCindy Lu 1396108a6481SCindy Lu static int vhost_vdpa_set_vring_base(struct vhost_dev *dev, 1397108a6481SCindy Lu struct vhost_vring_state *ring) 1398108a6481SCindy Lu { 1399d96be4c8SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1400d96be4c8SEugenio Pérez 1401d96be4c8SEugenio Pérez if (v->shadow_vqs_enabled) { 1402d96be4c8SEugenio Pérez /* 1403d96be4c8SEugenio Pérez * Device vring base was set at device start. SVQ base is handled by 1404d96be4c8SEugenio Pérez * VirtQueue code. 1405d96be4c8SEugenio Pérez */ 1406d96be4c8SEugenio Pérez return 0; 1407d96be4c8SEugenio Pérez } 1408d96be4c8SEugenio Pérez 1409d96be4c8SEugenio Pérez return vhost_vdpa_set_dev_vring_base(dev, ring); 1410108a6481SCindy Lu } 1411108a6481SCindy Lu 1412108a6481SCindy Lu static int vhost_vdpa_get_vring_base(struct vhost_dev *dev, 1413108a6481SCindy Lu struct vhost_vring_state *ring) 1414108a6481SCindy Lu { 14156d0b2226SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1416778e67deSLaurent Vivier int ret; 1417778e67deSLaurent Vivier 14186d0b2226SEugenio Pérez if (v->shadow_vqs_enabled) { 14192fdac348SEugenio Pérez ring->num = virtio_queue_get_last_avail_idx(dev->vdev, ring->index); 14206ec0a746SSi-Wei Liu trace_vhost_vdpa_get_vring_base(dev, ring->index, ring->num, true); 14216d0b2226SEugenio Pérez return 0; 14226d0b2226SEugenio Pérez } 14236d0b2226SEugenio Pérez 1424b6662cb7SEugenio Pérez if (!v->suspended) { 1425b6662cb7SEugenio Pérez /* 1426b6662cb7SEugenio Pérez * Cannot trust in value returned by device, let vhost recover used 1427b6662cb7SEugenio Pérez * idx from guest. 1428b6662cb7SEugenio Pérez */ 1429b6662cb7SEugenio Pérez return -1; 1430b6662cb7SEugenio Pérez } 1431b6662cb7SEugenio Pérez 1432778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_GET_VRING_BASE, ring); 14336ec0a746SSi-Wei Liu trace_vhost_vdpa_get_vring_base(dev, ring->index, ring->num, false); 1434778e67deSLaurent Vivier return ret; 1435108a6481SCindy Lu } 1436108a6481SCindy Lu 1437108a6481SCindy Lu static int vhost_vdpa_set_vring_kick(struct vhost_dev *dev, 1438108a6481SCindy Lu struct vhost_vring_file *file) 1439108a6481SCindy Lu { 1440dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1441dff4426fSEugenio Pérez int vdpa_idx = file->index - dev->vq_index; 1442dff4426fSEugenio Pérez 1443dff4426fSEugenio Pérez if (v->shadow_vqs_enabled) { 1444dff4426fSEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, vdpa_idx); 1445dff4426fSEugenio Pérez vhost_svq_set_svq_kick_fd(svq, file->fd); 1446dff4426fSEugenio Pérez return 0; 1447dff4426fSEugenio Pérez } else { 1448dff4426fSEugenio Pérez return vhost_vdpa_set_vring_dev_kick(dev, file); 1449dff4426fSEugenio Pérez } 1450108a6481SCindy Lu } 1451108a6481SCindy Lu 1452108a6481SCindy Lu static int vhost_vdpa_set_vring_call(struct vhost_dev *dev, 1453108a6481SCindy Lu struct vhost_vring_file *file) 1454108a6481SCindy Lu { 1455a8ac8858SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1456a8ac8858SEugenio Pérez int vdpa_idx = file->index - dev->vq_index; 1457a8ac8858SEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, vdpa_idx); 1458a8ac8858SEugenio Pérez 1459b2765243SEugenio Pérez /* Remember last call fd because we can switch to SVQ anytime. */ 1460a8ac8858SEugenio Pérez vhost_svq_set_svq_call_fd(svq, file->fd); 14619ed62809SSi-Wei Liu /* 14629ed62809SSi-Wei Liu * When SVQ is transitioning to off, shadow_vqs_enabled has 14639ed62809SSi-Wei Liu * not been set back to false yet, but the underlying call fd 14649ed62809SSi-Wei Liu * will have to switch back to the guest notifier to signal the 14659ed62809SSi-Wei Liu * passthrough virtqueues. In other situations, SVQ's own call 14669ed62809SSi-Wei Liu * fd shall be used to signal the device model. 14679ed62809SSi-Wei Liu */ 14689ed62809SSi-Wei Liu if (v->shadow_vqs_enabled && 14699ed62809SSi-Wei Liu v->shared->svq_switching != SVQ_TSTATE_DISABLING) { 1470a8ac8858SEugenio Pérez return 0; 1471a8ac8858SEugenio Pérez } 1472b2765243SEugenio Pérez 1473b2765243SEugenio Pérez return vhost_vdpa_set_vring_dev_call(dev, file); 1474108a6481SCindy Lu } 1475108a6481SCindy Lu 1476108a6481SCindy Lu static int vhost_vdpa_get_features(struct vhost_dev *dev, 1477108a6481SCindy Lu uint64_t *features) 1478108a6481SCindy Lu { 147912a195faSEugenio Pérez int ret = vhost_vdpa_get_dev_features(dev, features); 1480778e67deSLaurent Vivier 1481ab7337e3SEugenio Pérez if (ret == 0) { 148212a195faSEugenio Pérez /* Add SVQ logging capabilities */ 148312a195faSEugenio Pérez *features |= BIT_ULL(VHOST_F_LOG_ALL); 148412a195faSEugenio Pérez } 148512a195faSEugenio Pérez 1486778e67deSLaurent Vivier return ret; 1487108a6481SCindy Lu } 1488108a6481SCindy Lu 1489108a6481SCindy Lu static int vhost_vdpa_set_owner(struct vhost_dev *dev) 1490108a6481SCindy Lu { 1491d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 14924d191cfdSJason Wang return 0; 14934d191cfdSJason Wang } 14944d191cfdSJason Wang 1495778e67deSLaurent Vivier trace_vhost_vdpa_set_owner(dev); 1496108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_OWNER, NULL); 1497108a6481SCindy Lu } 1498108a6481SCindy Lu 1499108a6481SCindy Lu static int vhost_vdpa_vq_get_addr(struct vhost_dev *dev, 1500108a6481SCindy Lu struct vhost_vring_addr *addr, struct vhost_virtqueue *vq) 1501108a6481SCindy Lu { 1502108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 1503108a6481SCindy Lu addr->desc_user_addr = (uint64_t)(unsigned long)vq->desc_phys; 1504108a6481SCindy Lu addr->avail_user_addr = (uint64_t)(unsigned long)vq->avail_phys; 1505108a6481SCindy Lu addr->used_user_addr = (uint64_t)(unsigned long)vq->used_phys; 1506778e67deSLaurent Vivier trace_vhost_vdpa_vq_get_addr(dev, vq, addr->desc_user_addr, 1507778e67deSLaurent Vivier addr->avail_user_addr, addr->used_user_addr); 1508108a6481SCindy Lu return 0; 1509108a6481SCindy Lu } 1510108a6481SCindy Lu 1511108a6481SCindy Lu static bool vhost_vdpa_force_iommu(struct vhost_dev *dev) 1512108a6481SCindy Lu { 1513108a6481SCindy Lu return true; 1514108a6481SCindy Lu } 1515108a6481SCindy Lu 1516108a6481SCindy Lu const VhostOps vdpa_ops = { 1517108a6481SCindy Lu .backend_type = VHOST_BACKEND_TYPE_VDPA, 1518108a6481SCindy Lu .vhost_backend_init = vhost_vdpa_init, 1519108a6481SCindy Lu .vhost_backend_cleanup = vhost_vdpa_cleanup, 1520108a6481SCindy Lu .vhost_set_log_base = vhost_vdpa_set_log_base, 1521108a6481SCindy Lu .vhost_set_vring_addr = vhost_vdpa_set_vring_addr, 1522108a6481SCindy Lu .vhost_set_vring_num = vhost_vdpa_set_vring_num, 1523108a6481SCindy Lu .vhost_set_vring_base = vhost_vdpa_set_vring_base, 1524108a6481SCindy Lu .vhost_get_vring_base = vhost_vdpa_get_vring_base, 1525108a6481SCindy Lu .vhost_set_vring_kick = vhost_vdpa_set_vring_kick, 1526108a6481SCindy Lu .vhost_set_vring_call = vhost_vdpa_set_vring_call, 1527108a6481SCindy Lu .vhost_get_features = vhost_vdpa_get_features, 1528a5bd0580SJason Wang .vhost_set_backend_cap = vhost_vdpa_set_backend_cap, 1529108a6481SCindy Lu .vhost_set_owner = vhost_vdpa_set_owner, 1530108a6481SCindy Lu .vhost_set_vring_endian = NULL, 1531108a6481SCindy Lu .vhost_backend_memslots_limit = vhost_vdpa_memslots_limit, 1532108a6481SCindy Lu .vhost_set_mem_table = vhost_vdpa_set_mem_table, 1533108a6481SCindy Lu .vhost_set_features = vhost_vdpa_set_features, 1534108a6481SCindy Lu .vhost_reset_device = vhost_vdpa_reset_device, 1535108a6481SCindy Lu .vhost_get_vq_index = vhost_vdpa_get_vq_index, 1536108a6481SCindy Lu .vhost_get_config = vhost_vdpa_get_config, 1537108a6481SCindy Lu .vhost_set_config = vhost_vdpa_set_config, 1538108a6481SCindy Lu .vhost_requires_shm_log = NULL, 1539108a6481SCindy Lu .vhost_migration_done = NULL, 1540108a6481SCindy Lu .vhost_net_set_mtu = NULL, 1541108a6481SCindy Lu .vhost_set_iotlb_callback = NULL, 1542108a6481SCindy Lu .vhost_send_device_iotlb_msg = NULL, 1543108a6481SCindy Lu .vhost_dev_start = vhost_vdpa_dev_start, 1544108a6481SCindy Lu .vhost_get_device_id = vhost_vdpa_get_device_id, 1545108a6481SCindy Lu .vhost_vq_get_addr = vhost_vdpa_vq_get_addr, 1546108a6481SCindy Lu .vhost_force_iommu = vhost_vdpa_force_iommu, 1547259f3accSCindy Lu .vhost_set_config_call = vhost_vdpa_set_config_call, 1548c3716f26SEugenio Pérez .vhost_reset_status = vhost_vdpa_reset_status, 1549108a6481SCindy Lu }; 1550