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" 23dfc56946SRichard Henderson #include "system/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; 50a5583457SEugenio Pérez bool is_ram = memory_region_is_ram(section->mr); 51a5583457SEugenio Pérez bool is_iommu = memory_region_is_iommu(section->mr); 52a5583457SEugenio 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 */ 55a5583457SEugenio Pérez bool is_ram_device = memory_region_is_ram_device(section->mr); 56a5583457SEugenio Pérez 57a5583457SEugenio Pérez if ((!is_ram && !is_iommu) || is_protected || is_ram_device) { 58a8516e5cSEugenio Pérez trace_vhost_vdpa_skipped_memory_section(is_ram, is_iommu, is_protected, 59a8516e5cSEugenio Pérez is_ram_device, iova_min, 60a8516e5cSEugenio Pérez iova_max, page_mask); 61013108b6SEugenio Pérez return true; 62013108b6SEugenio Pérez } 63013108b6SEugenio Pérez 64013108b6SEugenio Pérez if (section->offset_within_address_space < iova_min) { 65013108b6SEugenio Pérez error_report("RAM section out of device range (min=0x%" PRIx64 66013108b6SEugenio Pérez ", addr=0x%" HWADDR_PRIx ")", 67013108b6SEugenio Pérez iova_min, section->offset_within_address_space); 68013108b6SEugenio Pérez return true; 69013108b6SEugenio Pérez } 70bc7b0cacSCindy Lu /* 71bc7b0cacSCindy Lu * While using vIOMMU, sometimes the section will be larger than iova_max, 72bc7b0cacSCindy Lu * but the memory that actually maps is smaller, so move the check to 73bc7b0cacSCindy Lu * function vhost_vdpa_iommu_map_notify(). That function will use the actual 74bc7b0cacSCindy Lu * size that maps to the kernel 75bc7b0cacSCindy Lu */ 76013108b6SEugenio Pérez 77a5583457SEugenio Pérez if (!is_iommu) { 788b1a8884SPhilippe Mathieu-Daudé llend = vhost_vdpa_section_end(section, page_mask); 79013108b6SEugenio Pérez if (int128_gt(llend, int128_make64(iova_max))) { 80013108b6SEugenio Pérez error_report("RAM section out of device range (max=0x%" PRIx64 81013108b6SEugenio Pérez ", end addr=0x%" PRIx64 ")", 82013108b6SEugenio Pérez iova_max, int128_get64(llend)); 83013108b6SEugenio Pérez return true; 84013108b6SEugenio Pérez } 85bc7b0cacSCindy Lu } 86013108b6SEugenio Pérez 87013108b6SEugenio Pérez return false; 88108a6481SCindy Lu } 89108a6481SCindy Lu 90cd831ed5SEugenio Pérez /* 91cd831ed5SEugenio Pérez * The caller must set asid = 0 if the device does not support asid. 92cd831ed5SEugenio Pérez * This is not an ABI break since it is set to 0 by the initializer anyway. 93cd831ed5SEugenio Pérez */ 946f03d9efSEugenio Pérez int vhost_vdpa_dma_map(VhostVDPAShared *s, uint32_t asid, hwaddr iova, 95cd831ed5SEugenio Pérez hwaddr size, void *vaddr, bool readonly) 96108a6481SCindy Lu { 97386494f2SCindy Lu struct vhost_msg_v2 msg = {}; 986f03d9efSEugenio Pérez int fd = s->device_fd; 99108a6481SCindy Lu int ret = 0; 100108a6481SCindy Lu 10174e76c7dSEugenio Pérez msg.type = VHOST_IOTLB_MSG_V2; 102cd831ed5SEugenio Pérez msg.asid = asid; 103108a6481SCindy Lu msg.iotlb.iova = iova; 104108a6481SCindy Lu msg.iotlb.size = size; 105108a6481SCindy Lu msg.iotlb.uaddr = (uint64_t)(uintptr_t)vaddr; 106108a6481SCindy Lu msg.iotlb.perm = readonly ? VHOST_ACCESS_RO : VHOST_ACCESS_RW; 107108a6481SCindy Lu msg.iotlb.type = VHOST_IOTLB_UPDATE; 108108a6481SCindy Lu 1096f03d9efSEugenio Pérez trace_vhost_vdpa_dma_map(s, fd, msg.type, msg.asid, msg.iotlb.iova, 110cd831ed5SEugenio Pérez msg.iotlb.size, msg.iotlb.uaddr, msg.iotlb.perm, 111cd831ed5SEugenio Pérez msg.iotlb.type); 112778e67deSLaurent Vivier 113108a6481SCindy Lu if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 114108a6481SCindy Lu error_report("failed to write, fd=%d, errno=%d (%s)", 115108a6481SCindy Lu fd, errno, strerror(errno)); 116108a6481SCindy Lu return -EIO ; 117108a6481SCindy Lu } 118108a6481SCindy Lu 119108a6481SCindy Lu return ret; 120108a6481SCindy Lu } 121108a6481SCindy Lu 122cd831ed5SEugenio Pérez /* 123cd831ed5SEugenio Pérez * The caller must set asid = 0 if the device does not support asid. 124cd831ed5SEugenio Pérez * This is not an ABI break since it is set to 0 by the initializer anyway. 125cd831ed5SEugenio Pérez */ 1266f03d9efSEugenio Pérez int vhost_vdpa_dma_unmap(VhostVDPAShared *s, uint32_t asid, hwaddr iova, 127cd831ed5SEugenio Pérez hwaddr size) 128108a6481SCindy Lu { 129386494f2SCindy Lu struct vhost_msg_v2 msg = {}; 1306f03d9efSEugenio Pérez int fd = s->device_fd; 131108a6481SCindy Lu int ret = 0; 132108a6481SCindy Lu 13374e76c7dSEugenio Pérez msg.type = VHOST_IOTLB_MSG_V2; 134cd831ed5SEugenio Pérez msg.asid = asid; 135108a6481SCindy Lu msg.iotlb.iova = iova; 136108a6481SCindy Lu msg.iotlb.size = size; 137108a6481SCindy Lu msg.iotlb.type = VHOST_IOTLB_INVALIDATE; 138108a6481SCindy Lu 1396f03d9efSEugenio Pérez trace_vhost_vdpa_dma_unmap(s, fd, msg.type, msg.asid, msg.iotlb.iova, 1406f03d9efSEugenio Pérez msg.iotlb.size, msg.iotlb.type); 141778e67deSLaurent Vivier 142108a6481SCindy Lu if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 143108a6481SCindy Lu error_report("failed to write, fd=%d, errno=%d (%s)", 144108a6481SCindy Lu fd, errno, strerror(errno)); 145108a6481SCindy Lu return -EIO ; 146108a6481SCindy Lu } 147108a6481SCindy Lu 148108a6481SCindy Lu return ret; 149108a6481SCindy Lu } 150108a6481SCindy Lu 1516f03d9efSEugenio Pérez static void vhost_vdpa_listener_begin_batch(VhostVDPAShared *s) 152a5bd0580SJason Wang { 1536f03d9efSEugenio Pérez int fd = s->device_fd; 154e6db5df7SEugenio Pérez struct vhost_msg_v2 msg = { 15574e76c7dSEugenio Pérez .type = VHOST_IOTLB_MSG_V2, 156e6db5df7SEugenio Pérez .iotlb.type = VHOST_IOTLB_BATCH_BEGIN, 157e6db5df7SEugenio Pérez }; 158a5bd0580SJason Wang 1596f03d9efSEugenio Pérez trace_vhost_vdpa_listener_begin_batch(s, fd, msg.type, msg.iotlb.type); 160a5bd0580SJason Wang if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 161a5bd0580SJason Wang error_report("failed to write, fd=%d, errno=%d (%s)", 162a5bd0580SJason Wang fd, errno, strerror(errno)); 163a5bd0580SJason Wang } 164a5bd0580SJason Wang } 165a5bd0580SJason Wang 1666f03d9efSEugenio Pérez static void vhost_vdpa_iotlb_batch_begin_once(VhostVDPAShared *s) 167e6db5df7SEugenio Pérez { 1686f03d9efSEugenio Pérez if (s->backend_cap & (0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH) && 1696f03d9efSEugenio Pérez !s->iotlb_batch_begin_sent) { 1706f03d9efSEugenio Pérez vhost_vdpa_listener_begin_batch(s); 171e6db5df7SEugenio Pérez } 172e6db5df7SEugenio Pérez 1736f03d9efSEugenio Pérez s->iotlb_batch_begin_sent = true; 174e6db5df7SEugenio Pérez } 175e6db5df7SEugenio Pérez 176a5bd0580SJason Wang static void vhost_vdpa_listener_commit(MemoryListener *listener) 177a5bd0580SJason Wang { 178f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 1798acb3218SPhilippe Mathieu-Daudé struct vhost_msg_v2 msg = {}; 180f6fe3e33SEugenio Pérez int fd = s->device_fd; 181a5bd0580SJason Wang 182f6fe3e33SEugenio Pérez if (!(s->backend_cap & (0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH))) { 183a5bd0580SJason Wang return; 184a5bd0580SJason Wang } 185a5bd0580SJason Wang 186f6fe3e33SEugenio Pérez if (!s->iotlb_batch_begin_sent) { 187e6db5df7SEugenio Pérez return; 188e6db5df7SEugenio Pérez } 189e6db5df7SEugenio Pérez 19074e76c7dSEugenio Pérez msg.type = VHOST_IOTLB_MSG_V2; 191a5bd0580SJason Wang msg.iotlb.type = VHOST_IOTLB_BATCH_END; 192a5bd0580SJason Wang 193f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_commit(s, fd, msg.type, msg.iotlb.type); 194a5bd0580SJason Wang if (write(fd, &msg, sizeof(msg)) != sizeof(msg)) { 195a5bd0580SJason Wang error_report("failed to write, fd=%d, errno=%d (%s)", 196a5bd0580SJason Wang fd, errno, strerror(errno)); 197a5bd0580SJason Wang } 198e6db5df7SEugenio Pérez 199f6fe3e33SEugenio Pérez s->iotlb_batch_begin_sent = false; 200a5bd0580SJason Wang } 201a5bd0580SJason Wang 202bc7b0cacSCindy Lu static void vhost_vdpa_iommu_map_notify(IOMMUNotifier *n, IOMMUTLBEntry *iotlb) 203bc7b0cacSCindy Lu { 204bc7b0cacSCindy Lu struct vdpa_iommu *iommu = container_of(n, struct vdpa_iommu, n); 205bc7b0cacSCindy Lu 206bc7b0cacSCindy Lu hwaddr iova = iotlb->iova + iommu->iommu_offset; 207b06a38f2SEugenio Pérez VhostVDPAShared *s = iommu->dev_shared; 208bc7b0cacSCindy Lu void *vaddr; 209bc7b0cacSCindy Lu int ret; 210bc7b0cacSCindy Lu Int128 llend; 211ebb481c0SCédric Le Goater Error *local_err = NULL; 212*e3353d63SSteve Sistare MemoryRegion *mr; 213*e3353d63SSteve Sistare hwaddr xlat; 214bc7b0cacSCindy Lu 215bc7b0cacSCindy Lu if (iotlb->target_as != &address_space_memory) { 216bc7b0cacSCindy Lu error_report("Wrong target AS \"%s\", only system memory is allowed", 217bc7b0cacSCindy Lu iotlb->target_as->name ? iotlb->target_as->name : "none"); 218bc7b0cacSCindy Lu return; 219bc7b0cacSCindy Lu } 220bc7b0cacSCindy Lu RCU_READ_LOCK_GUARD(); 221bc7b0cacSCindy Lu /* check if RAM section out of device range */ 222bc7b0cacSCindy Lu llend = int128_add(int128_makes64(iotlb->addr_mask), int128_makes64(iova)); 223b06a38f2SEugenio Pérez if (int128_gt(llend, int128_make64(s->iova_range.last))) { 224bc7b0cacSCindy Lu error_report("RAM section out of device range (max=0x%" PRIx64 225bc7b0cacSCindy Lu ", end addr=0x%" PRIx64 ")", 226b06a38f2SEugenio Pérez s->iova_range.last, int128_get64(llend)); 227bc7b0cacSCindy Lu return; 228bc7b0cacSCindy Lu } 229bc7b0cacSCindy Lu 230bc7b0cacSCindy Lu if ((iotlb->perm & IOMMU_RW) != IOMMU_NONE) { 231bc7b0cacSCindy Lu bool read_only; 232bc7b0cacSCindy Lu 233*e3353d63SSteve Sistare mr = memory_translate_iotlb(iotlb, &xlat, &local_err); 234*e3353d63SSteve Sistare if (!mr) { 235ebb481c0SCédric Le Goater error_report_err(local_err); 236bc7b0cacSCindy Lu return; 237bc7b0cacSCindy Lu } 238*e3353d63SSteve Sistare vaddr = memory_region_get_ram_ptr(mr) + xlat; 239*e3353d63SSteve Sistare read_only = !(iotlb->perm & IOMMU_WO) || mr->readonly; 240*e3353d63SSteve Sistare 241b06a38f2SEugenio Pérez ret = vhost_vdpa_dma_map(s, VHOST_VDPA_GUEST_PA_ASID, iova, 242bc7b0cacSCindy Lu iotlb->addr_mask + 1, vaddr, read_only); 243bc7b0cacSCindy Lu if (ret) { 244bc7b0cacSCindy Lu error_report("vhost_vdpa_dma_map(%p, 0x%" HWADDR_PRIx ", " 245bc7b0cacSCindy Lu "0x%" HWADDR_PRIx ", %p) = %d (%m)", 246b06a38f2SEugenio Pérez s, iova, iotlb->addr_mask + 1, vaddr, ret); 247bc7b0cacSCindy Lu } 248bc7b0cacSCindy Lu } else { 249b06a38f2SEugenio Pérez ret = vhost_vdpa_dma_unmap(s, VHOST_VDPA_GUEST_PA_ASID, iova, 250bc7b0cacSCindy Lu iotlb->addr_mask + 1); 251bc7b0cacSCindy Lu if (ret) { 252bc7b0cacSCindy Lu error_report("vhost_vdpa_dma_unmap(%p, 0x%" HWADDR_PRIx ", " 253bc7b0cacSCindy Lu "0x%" HWADDR_PRIx ") = %d (%m)", 254b06a38f2SEugenio Pérez s, iova, iotlb->addr_mask + 1, ret); 255bc7b0cacSCindy Lu } 256bc7b0cacSCindy Lu } 257bc7b0cacSCindy Lu } 258bc7b0cacSCindy Lu 259bc7b0cacSCindy Lu static void vhost_vdpa_iommu_region_add(MemoryListener *listener, 260bc7b0cacSCindy Lu MemoryRegionSection *section) 261bc7b0cacSCindy Lu { 262f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 263bc7b0cacSCindy Lu 264bc7b0cacSCindy Lu struct vdpa_iommu *iommu; 265bc7b0cacSCindy Lu Int128 end; 266bc7b0cacSCindy Lu int iommu_idx; 267bc7b0cacSCindy Lu IOMMUMemoryRegion *iommu_mr; 268bc7b0cacSCindy Lu int ret; 269bc7b0cacSCindy Lu 270bc7b0cacSCindy Lu iommu_mr = IOMMU_MEMORY_REGION(section->mr); 271bc7b0cacSCindy Lu 272bc7b0cacSCindy Lu iommu = g_malloc0(sizeof(*iommu)); 273bc7b0cacSCindy Lu end = int128_add(int128_make64(section->offset_within_region), 274bc7b0cacSCindy Lu section->size); 275bc7b0cacSCindy Lu end = int128_sub(end, int128_one()); 276bc7b0cacSCindy Lu iommu_idx = memory_region_iommu_attrs_to_index(iommu_mr, 277bc7b0cacSCindy Lu MEMTXATTRS_UNSPECIFIED); 278bc7b0cacSCindy Lu iommu->iommu_mr = iommu_mr; 279bc7b0cacSCindy Lu iommu_notifier_init(&iommu->n, vhost_vdpa_iommu_map_notify, 280bc7b0cacSCindy Lu IOMMU_NOTIFIER_IOTLB_EVENTS, 281bc7b0cacSCindy Lu section->offset_within_region, 282bc7b0cacSCindy Lu int128_get64(end), 283bc7b0cacSCindy Lu iommu_idx); 284bc7b0cacSCindy Lu iommu->iommu_offset = section->offset_within_address_space - 285bc7b0cacSCindy Lu section->offset_within_region; 286f6fe3e33SEugenio Pérez iommu->dev_shared = s; 287bc7b0cacSCindy Lu 288bc7b0cacSCindy Lu ret = memory_region_register_iommu_notifier(section->mr, &iommu->n, NULL); 289bc7b0cacSCindy Lu if (ret) { 290bc7b0cacSCindy Lu g_free(iommu); 291bc7b0cacSCindy Lu return; 292bc7b0cacSCindy Lu } 293bc7b0cacSCindy Lu 294f6fe3e33SEugenio Pérez QLIST_INSERT_HEAD(&s->iommu_list, iommu, iommu_next); 295bc7b0cacSCindy Lu memory_region_iommu_replay(iommu->iommu_mr, &iommu->n); 296bc7b0cacSCindy Lu } 297bc7b0cacSCindy Lu 298bc7b0cacSCindy Lu static void vhost_vdpa_iommu_region_del(MemoryListener *listener, 299bc7b0cacSCindy Lu MemoryRegionSection *section) 300bc7b0cacSCindy Lu { 301f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 302bc7b0cacSCindy Lu 303bc7b0cacSCindy Lu struct vdpa_iommu *iommu; 304bc7b0cacSCindy Lu 305f6fe3e33SEugenio Pérez QLIST_FOREACH(iommu, &s->iommu_list, iommu_next) 306bc7b0cacSCindy Lu { 307bc7b0cacSCindy Lu if (MEMORY_REGION(iommu->iommu_mr) == section->mr && 308bc7b0cacSCindy Lu iommu->n.start == section->offset_within_region) { 309bc7b0cacSCindy Lu memory_region_unregister_iommu_notifier(section->mr, &iommu->n); 310bc7b0cacSCindy Lu QLIST_REMOVE(iommu, iommu_next); 311bc7b0cacSCindy Lu g_free(iommu); 312bc7b0cacSCindy Lu break; 313bc7b0cacSCindy Lu } 314bc7b0cacSCindy Lu } 315bc7b0cacSCindy Lu } 316bc7b0cacSCindy Lu 317108a6481SCindy Lu static void vhost_vdpa_listener_region_add(MemoryListener *listener, 318108a6481SCindy Lu MemoryRegionSection *section) 319108a6481SCindy Lu { 3207dab70beSEugenio Pérez DMAMap mem_region = {}; 321f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 322108a6481SCindy Lu hwaddr iova; 323108a6481SCindy Lu Int128 llend, llsize; 324108a6481SCindy Lu void *vaddr; 325108a6481SCindy Lu int ret; 32633f21860SPhilippe Mathieu-Daudé int page_size = qemu_target_page_size(); 32733f21860SPhilippe Mathieu-Daudé int page_mask = -page_size; 328108a6481SCindy Lu 329f6fe3e33SEugenio Pérez if (vhost_vdpa_listener_skipped_section(section, s->iova_range.first, 330f6fe3e33SEugenio Pérez s->iova_range.last, page_mask)) { 331108a6481SCindy Lu return; 332108a6481SCindy Lu } 333bc7b0cacSCindy Lu if (memory_region_is_iommu(section->mr)) { 334bc7b0cacSCindy Lu vhost_vdpa_iommu_region_add(listener, section); 335bc7b0cacSCindy Lu return; 336bc7b0cacSCindy Lu } 337108a6481SCindy Lu 33833f21860SPhilippe Mathieu-Daudé if (unlikely((section->offset_within_address_space & ~page_mask) != 33933f21860SPhilippe Mathieu-Daudé (section->offset_within_region & ~page_mask))) { 340f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_add_unaligned(s, section->mr->name, 34133f21860SPhilippe Mathieu-Daudé section->offset_within_address_space & ~page_mask, 34233f21860SPhilippe Mathieu-Daudé section->offset_within_region & ~page_mask); 343108a6481SCindy Lu return; 344108a6481SCindy Lu } 345108a6481SCindy Lu 34633f21860SPhilippe Mathieu-Daudé iova = ROUND_UP(section->offset_within_address_space, page_size); 34733f21860SPhilippe Mathieu-Daudé llend = vhost_vdpa_section_end(section, page_mask); 348108a6481SCindy Lu if (int128_ge(int128_make64(iova), llend)) { 349108a6481SCindy Lu return; 350108a6481SCindy Lu } 351108a6481SCindy Lu 352108a6481SCindy Lu memory_region_ref(section->mr); 353108a6481SCindy Lu 354108a6481SCindy Lu /* Here we assume that memory_region_is_ram(section->mr)==true */ 355108a6481SCindy Lu 356108a6481SCindy Lu vaddr = memory_region_get_ram_ptr(section->mr) + 357108a6481SCindy Lu section->offset_within_region + 358108a6481SCindy Lu (iova - section->offset_within_address_space); 359108a6481SCindy Lu 360f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_add(s, iova, int128_get64(llend), 361778e67deSLaurent Vivier vaddr, section->readonly); 362778e67deSLaurent Vivier 363108a6481SCindy Lu llsize = int128_sub(llend, int128_make64(iova)); 364f6fe3e33SEugenio Pérez if (s->shadow_data) { 3657dab70beSEugenio Pérez int r; 36605063f55SJonah Palmer hwaddr gpa = section->offset_within_address_space; 36734e3c94eSEugenio Pérez 3687dab70beSEugenio Pérez mem_region.size = int128_get64(llsize) - 1, 3697dab70beSEugenio Pérez mem_region.perm = IOMMU_ACCESS_FLAG(true, section->readonly), 3707dab70beSEugenio Pérez 37105063f55SJonah Palmer r = vhost_iova_tree_map_alloc_gpa(s->iova_tree, &mem_region, gpa); 37234e3c94eSEugenio Pérez if (unlikely(r != IOVA_OK)) { 37334e3c94eSEugenio Pérez error_report("Can't allocate a mapping (%d)", r); 37492cf61e7SJonah Palmer 37505063f55SJonah Palmer if (mem_region.translated_addr == gpa) { 37605063f55SJonah Palmer error_report("Insertion to GPA->IOVA tree failed"); 37792cf61e7SJonah Palmer /* Remove the mapping from the IOVA-only tree */ 37892cf61e7SJonah Palmer goto fail_map; 37992cf61e7SJonah Palmer } 38034e3c94eSEugenio Pérez goto fail; 38134e3c94eSEugenio Pérez } 38234e3c94eSEugenio Pérez 38334e3c94eSEugenio Pérez iova = mem_region.iova; 38434e3c94eSEugenio Pérez } 385108a6481SCindy Lu 386f6fe3e33SEugenio Pérez vhost_vdpa_iotlb_batch_begin_once(s); 387f6fe3e33SEugenio Pérez ret = vhost_vdpa_dma_map(s, VHOST_VDPA_GUEST_PA_ASID, iova, 388cd831ed5SEugenio Pérez int128_get64(llsize), vaddr, section->readonly); 389108a6481SCindy Lu if (ret) { 390108a6481SCindy Lu error_report("vhost vdpa map fail!"); 3917dab70beSEugenio Pérez goto fail_map; 392108a6481SCindy Lu } 393108a6481SCindy Lu 394108a6481SCindy Lu return; 395108a6481SCindy Lu 3967dab70beSEugenio Pérez fail_map: 397f6fe3e33SEugenio Pérez if (s->shadow_data) { 39805063f55SJonah Palmer vhost_iova_tree_remove_gpa(s->iova_tree, mem_region); 3997dab70beSEugenio Pérez } 4007dab70beSEugenio Pérez 401108a6481SCindy Lu fail: 402108a6481SCindy Lu /* 403108a6481SCindy Lu * On the initfn path, store the first error in the container so we 404108a6481SCindy Lu * can gracefully fail. Runtime, there's not much we can do other 405108a6481SCindy Lu * than throw a hardware error. 406108a6481SCindy Lu */ 407108a6481SCindy Lu error_report("vhost-vdpa: DMA mapping failed, unable to continue"); 408108a6481SCindy Lu return; 409108a6481SCindy Lu 410108a6481SCindy Lu } 411108a6481SCindy Lu 412108a6481SCindy Lu static void vhost_vdpa_listener_region_del(MemoryListener *listener, 413108a6481SCindy Lu MemoryRegionSection *section) 414108a6481SCindy Lu { 415f6fe3e33SEugenio Pérez VhostVDPAShared *s = container_of(listener, VhostVDPAShared, listener); 416108a6481SCindy Lu hwaddr iova; 417108a6481SCindy Lu Int128 llend, llsize; 418108a6481SCindy Lu int ret; 41933f21860SPhilippe Mathieu-Daudé int page_size = qemu_target_page_size(); 42033f21860SPhilippe Mathieu-Daudé int page_mask = -page_size; 421108a6481SCindy Lu 422f6fe3e33SEugenio Pérez if (vhost_vdpa_listener_skipped_section(section, s->iova_range.first, 423f6fe3e33SEugenio Pérez s->iova_range.last, page_mask)) { 424108a6481SCindy Lu return; 425108a6481SCindy Lu } 426bc7b0cacSCindy Lu if (memory_region_is_iommu(section->mr)) { 427bc7b0cacSCindy Lu vhost_vdpa_iommu_region_del(listener, section); 428bc7b0cacSCindy Lu } 429108a6481SCindy Lu 43033f21860SPhilippe Mathieu-Daudé if (unlikely((section->offset_within_address_space & ~page_mask) != 43133f21860SPhilippe Mathieu-Daudé (section->offset_within_region & ~page_mask))) { 432f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_del_unaligned(s, section->mr->name, 43333f21860SPhilippe Mathieu-Daudé section->offset_within_address_space & ~page_mask, 43433f21860SPhilippe Mathieu-Daudé section->offset_within_region & ~page_mask); 435108a6481SCindy Lu return; 436108a6481SCindy Lu } 437108a6481SCindy Lu 43833f21860SPhilippe Mathieu-Daudé iova = ROUND_UP(section->offset_within_address_space, page_size); 43933f21860SPhilippe Mathieu-Daudé llend = vhost_vdpa_section_end(section, page_mask); 440108a6481SCindy Lu 441f6fe3e33SEugenio Pérez trace_vhost_vdpa_listener_region_del(s, iova, 4423d1e4d34SCindy Lu int128_get64(int128_sub(llend, int128_one()))); 443778e67deSLaurent Vivier 444108a6481SCindy Lu if (int128_ge(int128_make64(iova), llend)) { 445108a6481SCindy Lu return; 446108a6481SCindy Lu } 447108a6481SCindy Lu 448108a6481SCindy Lu llsize = int128_sub(llend, int128_make64(iova)); 449108a6481SCindy Lu 450f6fe3e33SEugenio Pérez if (s->shadow_data) { 45134e3c94eSEugenio Pérez const DMAMap *result; 45234e3c94eSEugenio Pérez DMAMap mem_region = { 45305063f55SJonah Palmer .translated_addr = section->offset_within_address_space, 45434e3c94eSEugenio Pérez .size = int128_get64(llsize) - 1, 45534e3c94eSEugenio Pérez }; 45634e3c94eSEugenio Pérez 45705063f55SJonah Palmer result = vhost_iova_tree_find_gpa(s->iova_tree, &mem_region); 45810dab9f2SEugenio Pérez if (!result) { 45910dab9f2SEugenio Pérez /* The memory listener map wasn't mapped */ 46010dab9f2SEugenio Pérez return; 46110dab9f2SEugenio Pérez } 46234e3c94eSEugenio Pérez iova = result->iova; 46305063f55SJonah Palmer vhost_iova_tree_remove_gpa(s->iova_tree, *result); 46434e3c94eSEugenio Pérez } 465f6fe3e33SEugenio Pérez vhost_vdpa_iotlb_batch_begin_once(s); 4662fbef6aaSCindy Lu /* 4672fbef6aaSCindy Lu * The unmap ioctl doesn't accept a full 64-bit. need to check it 4682fbef6aaSCindy Lu */ 4692fbef6aaSCindy Lu if (int128_eq(llsize, int128_2_64())) { 4702fbef6aaSCindy Lu llsize = int128_rshift(llsize, 1); 471f6fe3e33SEugenio Pérez ret = vhost_vdpa_dma_unmap(s, VHOST_VDPA_GUEST_PA_ASID, iova, 472cd831ed5SEugenio Pérez int128_get64(llsize)); 4732fbef6aaSCindy Lu 474108a6481SCindy Lu if (ret) { 4752fbef6aaSCindy Lu error_report("vhost_vdpa_dma_unmap(%p, 0x%" HWADDR_PRIx ", " 4762fbef6aaSCindy Lu "0x%" HWADDR_PRIx ") = %d (%m)", 477f6fe3e33SEugenio Pérez s, iova, int128_get64(llsize), ret); 4782fbef6aaSCindy Lu } 4792fbef6aaSCindy Lu iova += int128_get64(llsize); 4802fbef6aaSCindy Lu } 481f6fe3e33SEugenio Pérez ret = vhost_vdpa_dma_unmap(s, VHOST_VDPA_GUEST_PA_ASID, iova, 4822fbef6aaSCindy Lu int128_get64(llsize)); 4832fbef6aaSCindy Lu 4842fbef6aaSCindy Lu if (ret) { 4852fbef6aaSCindy Lu error_report("vhost_vdpa_dma_unmap(%p, 0x%" HWADDR_PRIx ", " 4862fbef6aaSCindy Lu "0x%" HWADDR_PRIx ") = %d (%m)", 487f6fe3e33SEugenio Pérez s, iova, int128_get64(llsize), ret); 488108a6481SCindy Lu } 489108a6481SCindy Lu 490108a6481SCindy Lu memory_region_unref(section->mr); 491108a6481SCindy Lu } 492108a6481SCindy Lu /* 493ef4ff56cSStefano Garzarella * IOTLB API is used by vhost-vdpa which requires incremental updating 494108a6481SCindy Lu * of the mapping. So we can not use generic vhost memory listener which 495108a6481SCindy Lu * depends on the addnop(). 496108a6481SCindy Lu */ 497108a6481SCindy Lu static const MemoryListener vhost_vdpa_memory_listener = { 498142518bdSPeter Xu .name = "vhost-vdpa", 499a5bd0580SJason Wang .commit = vhost_vdpa_listener_commit, 500108a6481SCindy Lu .region_add = vhost_vdpa_listener_region_add, 501108a6481SCindy Lu .region_del = vhost_vdpa_listener_region_del, 502108a6481SCindy Lu }; 503108a6481SCindy Lu 504108a6481SCindy Lu static int vhost_vdpa_call(struct vhost_dev *dev, unsigned long int request, 505108a6481SCindy Lu void *arg) 506108a6481SCindy Lu { 507108a6481SCindy Lu struct vhost_vdpa *v = dev->opaque; 508f12b2498SEugenio Pérez int fd = v->shared->device_fd; 509f2a6e6c4SKevin Wolf int ret; 510108a6481SCindy Lu 511108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 512108a6481SCindy Lu 513f2a6e6c4SKevin Wolf ret = ioctl(fd, request, arg); 514f2a6e6c4SKevin Wolf return ret < 0 ? -errno : ret; 515108a6481SCindy Lu } 516108a6481SCindy Lu 5173631151bSRoman Kagan static int vhost_vdpa_add_status(struct vhost_dev *dev, uint8_t status) 518108a6481SCindy Lu { 519108a6481SCindy Lu uint8_t s; 5203631151bSRoman Kagan int ret; 521108a6481SCindy Lu 522778e67deSLaurent Vivier trace_vhost_vdpa_add_status(dev, status); 5233631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_STATUS, &s); 5243631151bSRoman Kagan if (ret < 0) { 5253631151bSRoman Kagan return ret; 526108a6481SCindy Lu } 527bc865bfeSEugenio Pérez if ((s & status) == status) { 528bc865bfeSEugenio Pérez /* Don't set bits already set */ 529bc865bfeSEugenio Pérez return 0; 530bc865bfeSEugenio Pérez } 531108a6481SCindy Lu 532108a6481SCindy Lu s |= status; 533108a6481SCindy Lu 5343631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_STATUS, &s); 5353631151bSRoman Kagan if (ret < 0) { 5363631151bSRoman Kagan return ret; 5373631151bSRoman Kagan } 5383631151bSRoman Kagan 5393631151bSRoman Kagan ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_STATUS, &s); 5403631151bSRoman Kagan if (ret < 0) { 5413631151bSRoman Kagan return ret; 5423631151bSRoman Kagan } 5433631151bSRoman Kagan 5443631151bSRoman Kagan if (!(s & status)) { 5453631151bSRoman Kagan return -EIO; 5463631151bSRoman Kagan } 5473631151bSRoman Kagan 5483631151bSRoman Kagan return 0; 549108a6481SCindy Lu } 550108a6481SCindy Lu 551c672f348SLongpeng int vhost_vdpa_get_iova_range(int fd, struct vhost_vdpa_iova_range *iova_range) 552c672f348SLongpeng { 553c672f348SLongpeng int ret = ioctl(fd, VHOST_VDPA_GET_IOVA_RANGE, iova_range); 554c672f348SLongpeng 555c672f348SLongpeng return ret < 0 ? -errno : 0; 556c672f348SLongpeng } 557c672f348SLongpeng 558d71b0609SSi-Wei Liu /* 559d71b0609SSi-Wei Liu * The use of this function is for requests that only need to be 560d71b0609SSi-Wei Liu * applied once. Typically such request occurs at the beginning 561d71b0609SSi-Wei Liu * of operation, and before setting up queues. It should not be 562d71b0609SSi-Wei Liu * used for request that performs operation until all queues are 563d71b0609SSi-Wei Liu * set, which would need to check dev->vq_index_end instead. 564d71b0609SSi-Wei Liu */ 565d71b0609SSi-Wei Liu static bool vhost_vdpa_first_dev(struct vhost_dev *dev) 5664d191cfdSJason Wang { 5674d191cfdSJason Wang struct vhost_vdpa *v = dev->opaque; 5684d191cfdSJason Wang 569d71b0609SSi-Wei Liu return v->index == 0; 5704d191cfdSJason Wang } 5714d191cfdSJason Wang 572c812b065SSi-Wei Liu static bool vhost_vdpa_last_dev(struct vhost_dev *dev) 573c812b065SSi-Wei Liu { 574c812b065SSi-Wei Liu return dev->vq_index + dev->nvqs == dev->vq_index_end; 575c812b065SSi-Wei Liu } 576c812b065SSi-Wei Liu 57712a195faSEugenio Pérez static int vhost_vdpa_get_dev_features(struct vhost_dev *dev, 57812a195faSEugenio Pérez uint64_t *features) 57912a195faSEugenio Pérez { 58012a195faSEugenio Pérez int ret; 58112a195faSEugenio Pérez 58212a195faSEugenio Pérez ret = vhost_vdpa_call(dev, VHOST_GET_FEATURES, features); 58312a195faSEugenio Pérez trace_vhost_vdpa_get_features(dev, *features); 58412a195faSEugenio Pérez return ret; 58512a195faSEugenio Pérez } 58612a195faSEugenio Pérez 587258a0394SEugenio Pérez static void vhost_vdpa_init_svq(struct vhost_dev *hdev, struct vhost_vdpa *v) 588dff4426fSEugenio Pérez { 589dff4426fSEugenio Pérez g_autoptr(GPtrArray) shadow_vqs = NULL; 5904725a418SEugenio Pérez 591dff4426fSEugenio Pérez shadow_vqs = g_ptr_array_new_full(hdev->nvqs, vhost_svq_free); 592dff4426fSEugenio Pérez for (unsigned n = 0; n < hdev->nvqs; ++n) { 5933cfb4d06SEugenio Pérez VhostShadowVirtqueue *svq; 594dff4426fSEugenio Pérez 5955fde952bSEugenio Pérez svq = vhost_svq_new(v->shadow_vq_ops, v->shadow_vq_ops_opaque); 5963cfb4d06SEugenio Pérez g_ptr_array_add(shadow_vqs, svq); 597dff4426fSEugenio Pérez } 598dff4426fSEugenio Pérez 599dff4426fSEugenio Pérez v->shadow_vqs = g_steal_pointer(&shadow_vqs); 600dff4426fSEugenio Pérez } 601dff4426fSEugenio Pérez 6023312e6c8SEugenio Pérez static int vhost_vdpa_set_backend_cap(struct vhost_dev *dev) 6033312e6c8SEugenio Pérez { 6043312e6c8SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 6053312e6c8SEugenio Pérez 6063312e6c8SEugenio Pérez uint64_t features; 6073312e6c8SEugenio Pérez uint64_t f = 0x1ULL << VHOST_BACKEND_F_IOTLB_MSG_V2 | 6083312e6c8SEugenio Pérez 0x1ULL << VHOST_BACKEND_F_IOTLB_BATCH | 6093312e6c8SEugenio Pérez 0x1ULL << VHOST_BACKEND_F_IOTLB_ASID | 6103312e6c8SEugenio Pérez 0x1ULL << VHOST_BACKEND_F_SUSPEND; 6113312e6c8SEugenio Pérez int r; 6123312e6c8SEugenio Pérez 6133312e6c8SEugenio Pérez if (vhost_vdpa_call(dev, VHOST_GET_BACKEND_FEATURES, &features)) { 6143312e6c8SEugenio Pérez return -EFAULT; 6153312e6c8SEugenio Pérez } 6163312e6c8SEugenio Pérez 6173312e6c8SEugenio Pérez features &= f; 6183312e6c8SEugenio Pérez 6193312e6c8SEugenio Pérez if (vhost_vdpa_first_dev(dev)) { 6203312e6c8SEugenio Pérez r = vhost_vdpa_call(dev, VHOST_SET_BACKEND_FEATURES, &features); 6213312e6c8SEugenio Pérez if (r) { 6223312e6c8SEugenio Pérez return -EFAULT; 6233312e6c8SEugenio Pérez } 6243312e6c8SEugenio Pérez } 6253312e6c8SEugenio Pérez 6263312e6c8SEugenio Pérez dev->backend_cap = features; 6273312e6c8SEugenio Pérez v->shared->backend_cap = features; 6283312e6c8SEugenio Pérez 6293312e6c8SEugenio Pérez return 0; 6303312e6c8SEugenio Pérez } 6313312e6c8SEugenio Pérez 63228770ff9SKevin Wolf static int vhost_vdpa_init(struct vhost_dev *dev, void *opaque, Error **errp) 633108a6481SCindy Lu { 634e36b9992SEugenio Pérez struct vhost_vdpa *v = opaque; 635108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 636e36b9992SEugenio Pérez trace_vhost_vdpa_init(dev, v->shared, opaque); 637e1c1915bSDavid Hildenbrand int ret; 638e1c1915bSDavid Hildenbrand 639a5bd0580SJason Wang v->dev = dev; 640108a6481SCindy Lu dev->opaque = opaque ; 64132f0c7ceSEugenio Pérez 64232f0c7ceSEugenio Pérez ret = vhost_vdpa_set_backend_cap(dev); 64332f0c7ceSEugenio Pérez if (unlikely(ret != 0)) { 64432f0c7ceSEugenio Pérez return ret; 64532f0c7ceSEugenio Pérez } 64632f0c7ceSEugenio Pérez 647258a0394SEugenio Pérez vhost_vdpa_init_svq(dev, v); 648108a6481SCindy Lu 6499c363cf6SEugenio Pérez error_propagate(&dev->migration_blocker, v->migration_blocker); 650d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 6514d191cfdSJason Wang return 0; 6524d191cfdSJason Wang } 6534d191cfdSJason Wang 654a230c471SEugenio Pérez /* 65557ac8318SEugenio Pérez * If dev->shadow_vqs_enabled at initialization that means the device has 65657ac8318SEugenio Pérez * been started with x-svq=on, so don't block migration 65757ac8318SEugenio Pérez */ 65857ac8318SEugenio Pérez if (dev->migration_blocker == NULL && !v->shadow_vqs_enabled) { 65957ac8318SEugenio Pérez /* We don't have dev->features yet */ 66057ac8318SEugenio Pérez uint64_t features; 66157ac8318SEugenio Pérez ret = vhost_vdpa_get_dev_features(dev, &features); 66257ac8318SEugenio Pérez if (unlikely(ret)) { 66357ac8318SEugenio Pérez error_setg_errno(errp, -ret, "Could not get device features"); 66457ac8318SEugenio Pérez return ret; 66557ac8318SEugenio Pérez } 66657ac8318SEugenio Pérez vhost_svq_valid_features(features, &dev->migration_blocker); 66757ac8318SEugenio Pérez } 66857ac8318SEugenio Pérez 66957ac8318SEugenio Pérez /* 670a230c471SEugenio Pérez * Similar to VFIO, we end up pinning all guest memory and have to 671a230c471SEugenio Pérez * disable discarding of RAM. 672a230c471SEugenio Pérez */ 673a230c471SEugenio Pérez ret = ram_block_discard_disable(true); 674a230c471SEugenio Pérez if (ret) { 675a230c471SEugenio Pérez error_report("Cannot set discarding of RAM broken"); 676a230c471SEugenio Pérez return ret; 677a230c471SEugenio Pérez } 678a230c471SEugenio Pérez 679108a6481SCindy Lu vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_ACKNOWLEDGE | 680108a6481SCindy Lu VIRTIO_CONFIG_S_DRIVER); 681108a6481SCindy Lu 6829344dcbdSEugenio Pérez v->shared->listener = vhost_vdpa_memory_listener; 683108a6481SCindy Lu return 0; 684108a6481SCindy Lu } 685108a6481SCindy Lu 686d0416d48SJason Wang static void vhost_vdpa_host_notifier_uninit(struct vhost_dev *dev, 687d0416d48SJason Wang int queue_index) 688d0416d48SJason Wang { 6898e3b0cbbSMarc-André Lureau size_t page_size = qemu_real_host_page_size(); 690d0416d48SJason Wang struct vhost_vdpa *v = dev->opaque; 691d0416d48SJason Wang VirtIODevice *vdev = dev->vdev; 692d0416d48SJason Wang VhostVDPAHostNotifier *n; 693d0416d48SJason Wang 694d0416d48SJason Wang n = &v->notifier[queue_index]; 695d0416d48SJason Wang 696d0416d48SJason Wang if (n->addr) { 697d0416d48SJason Wang virtio_queue_set_host_notifier_mr(vdev, queue_index, &n->mr, false); 698d0416d48SJason Wang object_unparent(OBJECT(&n->mr)); 699d0416d48SJason Wang munmap(n->addr, page_size); 700d0416d48SJason Wang n->addr = NULL; 701d0416d48SJason Wang } 702d0416d48SJason Wang } 703d0416d48SJason Wang 704d0416d48SJason Wang static int vhost_vdpa_host_notifier_init(struct vhost_dev *dev, int queue_index) 705d0416d48SJason Wang { 7068e3b0cbbSMarc-André Lureau size_t page_size = qemu_real_host_page_size(); 707d0416d48SJason Wang struct vhost_vdpa *v = dev->opaque; 708d0416d48SJason Wang VirtIODevice *vdev = dev->vdev; 709d0416d48SJason Wang VhostVDPAHostNotifier *n; 710f12b2498SEugenio Pérez int fd = v->shared->device_fd; 711d0416d48SJason Wang void *addr; 712d0416d48SJason Wang char *name; 713d0416d48SJason Wang 714d0416d48SJason Wang vhost_vdpa_host_notifier_uninit(dev, queue_index); 715d0416d48SJason Wang 716d0416d48SJason Wang n = &v->notifier[queue_index]; 717d0416d48SJason Wang 718d0416d48SJason Wang addr = mmap(NULL, page_size, PROT_WRITE, MAP_SHARED, fd, 719d0416d48SJason Wang queue_index * page_size); 720d0416d48SJason Wang if (addr == MAP_FAILED) { 721d0416d48SJason Wang goto err; 722d0416d48SJason Wang } 723d0416d48SJason Wang 724d0416d48SJason Wang name = g_strdup_printf("vhost-vdpa/host-notifier@%p mmaps[%d]", 725d0416d48SJason Wang v, queue_index); 726d0416d48SJason Wang memory_region_init_ram_device_ptr(&n->mr, OBJECT(vdev), name, 727d0416d48SJason Wang page_size, addr); 728d0416d48SJason Wang g_free(name); 729d0416d48SJason Wang 730d0416d48SJason Wang if (virtio_queue_set_host_notifier_mr(vdev, queue_index, &n->mr, true)) { 73198f7607eSLaurent Vivier object_unparent(OBJECT(&n->mr)); 732d0416d48SJason Wang munmap(addr, page_size); 733d0416d48SJason Wang goto err; 734d0416d48SJason Wang } 735d0416d48SJason Wang n->addr = addr; 736d0416d48SJason Wang 737d0416d48SJason Wang return 0; 738d0416d48SJason Wang 739d0416d48SJason Wang err: 740d0416d48SJason Wang return -1; 741d0416d48SJason Wang } 742d0416d48SJason Wang 743b1f030a0SLaurent Vivier static void vhost_vdpa_host_notifiers_uninit(struct vhost_dev *dev, int n) 744b1f030a0SLaurent Vivier { 745b1f030a0SLaurent Vivier int i; 746b1f030a0SLaurent Vivier 747e66f2311SLongpeng /* 748e66f2311SLongpeng * Pack all the changes to the memory regions in a single 749e66f2311SLongpeng * transaction to avoid a few updating of the address space 750e66f2311SLongpeng * topology. 751e66f2311SLongpeng */ 752e66f2311SLongpeng memory_region_transaction_begin(); 753e66f2311SLongpeng 754b1f030a0SLaurent Vivier for (i = dev->vq_index; i < dev->vq_index + n; i++) { 755b1f030a0SLaurent Vivier vhost_vdpa_host_notifier_uninit(dev, i); 756b1f030a0SLaurent Vivier } 757e66f2311SLongpeng 758e66f2311SLongpeng memory_region_transaction_commit(); 759b1f030a0SLaurent Vivier } 760b1f030a0SLaurent Vivier 761d0416d48SJason Wang static void vhost_vdpa_host_notifiers_init(struct vhost_dev *dev) 762d0416d48SJason Wang { 763dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 764d0416d48SJason Wang int i; 765d0416d48SJason Wang 766dff4426fSEugenio Pérez if (v->shadow_vqs_enabled) { 767dff4426fSEugenio Pérez /* FIXME SVQ is not compatible with host notifiers mr */ 768dff4426fSEugenio Pérez return; 769dff4426fSEugenio Pérez } 770dff4426fSEugenio Pérez 771e66f2311SLongpeng /* 772e66f2311SLongpeng * Pack all the changes to the memory regions in a single 773e66f2311SLongpeng * transaction to avoid a few updating of the address space 774e66f2311SLongpeng * topology. 775e66f2311SLongpeng */ 776e66f2311SLongpeng memory_region_transaction_begin(); 777e66f2311SLongpeng 778d0416d48SJason Wang for (i = dev->vq_index; i < dev->vq_index + dev->nvqs; i++) { 779d0416d48SJason Wang if (vhost_vdpa_host_notifier_init(dev, i)) { 780b1f030a0SLaurent Vivier vhost_vdpa_host_notifiers_uninit(dev, i - dev->vq_index); 781e66f2311SLongpeng break; 782e66f2311SLongpeng } 783e66f2311SLongpeng } 784e66f2311SLongpeng 785e66f2311SLongpeng memory_region_transaction_commit(); 786d0416d48SJason Wang } 787d0416d48SJason Wang 788dff4426fSEugenio Pérez static void vhost_vdpa_svq_cleanup(struct vhost_dev *dev) 789dff4426fSEugenio Pérez { 790dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 791dff4426fSEugenio Pérez size_t idx; 792dff4426fSEugenio Pérez 793dff4426fSEugenio Pérez for (idx = 0; idx < v->shadow_vqs->len; ++idx) { 794dff4426fSEugenio Pérez vhost_svq_stop(g_ptr_array_index(v->shadow_vqs, idx)); 795dff4426fSEugenio Pérez } 796dff4426fSEugenio Pérez g_ptr_array_free(v->shadow_vqs, true); 797dff4426fSEugenio Pérez } 798dff4426fSEugenio Pérez 799108a6481SCindy Lu static int vhost_vdpa_cleanup(struct vhost_dev *dev) 800108a6481SCindy Lu { 801108a6481SCindy Lu struct vhost_vdpa *v; 802108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 803108a6481SCindy Lu v = dev->opaque; 804778e67deSLaurent Vivier trace_vhost_vdpa_cleanup(dev, v); 805a230c471SEugenio Pérez if (vhost_vdpa_first_dev(dev)) { 806a230c471SEugenio Pérez ram_block_discard_disable(false); 807f6fe3e33SEugenio Pérez memory_listener_unregister(&v->shared->listener); 808a230c471SEugenio Pérez } 809a230c471SEugenio Pérez 810d0416d48SJason Wang vhost_vdpa_host_notifiers_uninit(dev, dev->nvqs); 811dff4426fSEugenio Pérez vhost_vdpa_svq_cleanup(dev); 812108a6481SCindy Lu 813108a6481SCindy Lu dev->opaque = NULL; 814e1c1915bSDavid Hildenbrand 815108a6481SCindy Lu return 0; 816108a6481SCindy Lu } 817108a6481SCindy Lu 818108a6481SCindy Lu static int vhost_vdpa_memslots_limit(struct vhost_dev *dev) 819108a6481SCindy Lu { 820778e67deSLaurent Vivier trace_vhost_vdpa_memslots_limit(dev, INT_MAX); 821108a6481SCindy Lu return INT_MAX; 822108a6481SCindy Lu } 823108a6481SCindy Lu 824108a6481SCindy Lu static int vhost_vdpa_set_mem_table(struct vhost_dev *dev, 825108a6481SCindy Lu struct vhost_memory *mem) 826108a6481SCindy Lu { 827d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 8284d191cfdSJason Wang return 0; 8294d191cfdSJason Wang } 8304d191cfdSJason Wang 831778e67deSLaurent Vivier trace_vhost_vdpa_set_mem_table(dev, mem->nregions, mem->padding); 832778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_SET_MEM_TABLE) && 833778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_REGIONS)) { 834778e67deSLaurent Vivier int i; 835778e67deSLaurent Vivier for (i = 0; i < mem->nregions; i++) { 836778e67deSLaurent Vivier trace_vhost_vdpa_dump_regions(dev, i, 837778e67deSLaurent Vivier mem->regions[i].guest_phys_addr, 838778e67deSLaurent Vivier mem->regions[i].memory_size, 839778e67deSLaurent Vivier mem->regions[i].userspace_addr, 840778e67deSLaurent Vivier mem->regions[i].flags_padding); 841778e67deSLaurent Vivier } 842778e67deSLaurent Vivier } 843108a6481SCindy Lu if (mem->padding) { 8443631151bSRoman Kagan return -EINVAL; 845108a6481SCindy Lu } 846108a6481SCindy Lu 847108a6481SCindy Lu return 0; 848108a6481SCindy Lu } 849108a6481SCindy Lu 850108a6481SCindy Lu static int vhost_vdpa_set_features(struct vhost_dev *dev, 851108a6481SCindy Lu uint64_t features) 852108a6481SCindy Lu { 85312a195faSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 854108a6481SCindy Lu int ret; 8554d191cfdSJason Wang 856d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 8574d191cfdSJason Wang return 0; 8584d191cfdSJason Wang } 8594d191cfdSJason Wang 86012a195faSEugenio Pérez if (v->shadow_vqs_enabled) { 86112a195faSEugenio Pérez if ((v->acked_features ^ features) == BIT_ULL(VHOST_F_LOG_ALL)) { 86212a195faSEugenio Pérez /* 86312a195faSEugenio Pérez * QEMU is just trying to enable or disable logging. SVQ handles 86412a195faSEugenio Pérez * this sepparately, so no need to forward this. 86512a195faSEugenio Pérez */ 86612a195faSEugenio Pérez v->acked_features = features; 86712a195faSEugenio Pérez return 0; 86812a195faSEugenio Pérez } 86912a195faSEugenio Pérez 87012a195faSEugenio Pérez v->acked_features = features; 87112a195faSEugenio Pérez 87212a195faSEugenio Pérez /* We must not ack _F_LOG if SVQ is enabled */ 87312a195faSEugenio Pérez features &= ~BIT_ULL(VHOST_F_LOG_ALL); 87412a195faSEugenio Pérez } 87512a195faSEugenio Pérez 876778e67deSLaurent Vivier trace_vhost_vdpa_set_features(dev, features); 877108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_SET_FEATURES, &features); 878108a6481SCindy Lu if (ret) { 879108a6481SCindy Lu return ret; 880108a6481SCindy Lu } 881108a6481SCindy Lu 8823631151bSRoman Kagan return vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_FEATURES_OK); 883108a6481SCindy Lu } 884108a6481SCindy Lu 885c232b8f4SZenghui Yu static int vhost_vdpa_get_device_id(struct vhost_dev *dev, 886108a6481SCindy Lu uint32_t *device_id) 887108a6481SCindy Lu { 888778e67deSLaurent Vivier int ret; 889778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_DEVICE_ID, device_id); 890778e67deSLaurent Vivier trace_vhost_vdpa_get_device_id(dev, *device_id); 891778e67deSLaurent Vivier return ret; 892108a6481SCindy Lu } 893108a6481SCindy Lu 894108a6481SCindy Lu static int vhost_vdpa_reset_device(struct vhost_dev *dev) 895108a6481SCindy Lu { 8960bb302a9SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 897778e67deSLaurent Vivier int ret; 898108a6481SCindy Lu uint8_t status = 0; 899108a6481SCindy Lu 900778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_STATUS, &status); 9012b5de4d7SEugenio Pérez trace_vhost_vdpa_reset_device(dev); 902494c50dcSEugenio Pérez if (ret) { 903778e67deSLaurent Vivier return ret; 904108a6481SCindy Lu } 905108a6481SCindy Lu 906494c50dcSEugenio Pérez memory_listener_unregister(&v->shared->listener); 907494c50dcSEugenio Pérez v->shared->listener_registered = false; 908494c50dcSEugenio Pérez v->suspended = false; 909494c50dcSEugenio Pérez return 0; 910494c50dcSEugenio Pérez } 911494c50dcSEugenio Pérez 912108a6481SCindy Lu static int vhost_vdpa_get_vq_index(struct vhost_dev *dev, int idx) 913108a6481SCindy Lu { 914108a6481SCindy Lu assert(idx >= dev->vq_index && idx < dev->vq_index + dev->nvqs); 915108a6481SCindy Lu 916353244d8SJason Wang trace_vhost_vdpa_get_vq_index(dev, idx, idx); 917353244d8SJason Wang return idx; 918108a6481SCindy Lu } 919108a6481SCindy Lu 9202c66de61SKevin Wolf static int vhost_vdpa_set_vring_enable_one(struct vhost_vdpa *v, unsigned idx, 9212c66de61SKevin Wolf int enable) 922108a6481SCindy Lu { 923d7ce0841SEugenio Pérez struct vhost_dev *dev = v->dev; 924108a6481SCindy Lu struct vhost_vring_state state = { 925d7ce0841SEugenio Pérez .index = idx, 9262c66de61SKevin Wolf .num = enable, 927108a6481SCindy Lu }; 928d7ce0841SEugenio Pérez int r = vhost_vdpa_call(dev, VHOST_VDPA_SET_VRING_ENABLE, &state); 929d7ce0841SEugenio Pérez 9302c66de61SKevin Wolf trace_vhost_vdpa_set_vring_enable_one(dev, idx, enable, r); 931d7ce0841SEugenio Pérez return r; 932108a6481SCindy Lu } 933108a6481SCindy Lu 9342c66de61SKevin Wolf static int vhost_vdpa_set_vring_enable(struct vhost_dev *dev, int enable) 9352c66de61SKevin Wolf { 9362c66de61SKevin Wolf struct vhost_vdpa *v = dev->opaque; 9372c66de61SKevin Wolf unsigned int i; 9382c66de61SKevin Wolf int ret; 9392c66de61SKevin Wolf 9402c66de61SKevin Wolf for (i = 0; i < dev->nvqs; ++i) { 9412c66de61SKevin Wolf ret = vhost_vdpa_set_vring_enable_one(v, i, enable); 9422c66de61SKevin Wolf if (ret < 0) { 9432c66de61SKevin Wolf return ret; 9442c66de61SKevin Wolf } 9452c66de61SKevin Wolf } 9462c66de61SKevin Wolf 9472c66de61SKevin Wolf return 0; 9482c66de61SKevin Wolf } 9492c66de61SKevin Wolf 9502c66de61SKevin Wolf int vhost_vdpa_set_vring_ready(struct vhost_vdpa *v, unsigned idx) 9512c66de61SKevin Wolf { 9522c66de61SKevin Wolf return vhost_vdpa_set_vring_enable_one(v, idx, 1); 9532c66de61SKevin Wolf } 9542c66de61SKevin Wolf 955259f3accSCindy Lu static int vhost_vdpa_set_config_call(struct vhost_dev *dev, 956259f3accSCindy Lu int fd) 957259f3accSCindy Lu { 958259f3accSCindy Lu trace_vhost_vdpa_set_config_call(dev, fd); 959259f3accSCindy Lu return vhost_vdpa_call(dev, VHOST_VDPA_SET_CONFIG_CALL, &fd); 960259f3accSCindy Lu } 961259f3accSCindy Lu 962778e67deSLaurent Vivier static void vhost_vdpa_dump_config(struct vhost_dev *dev, const uint8_t *config, 963778e67deSLaurent Vivier uint32_t config_len) 964778e67deSLaurent Vivier { 96553ee5f55SRichard Henderson g_autoptr(GString) str = g_string_sized_new(4 * 16); 96653ee5f55SRichard Henderson size_t b, len; 967778e67deSLaurent Vivier 96853ee5f55SRichard Henderson for (b = 0; b < config_len; b += len) { 96953ee5f55SRichard Henderson len = MIN(config_len - b, 16); 97053ee5f55SRichard Henderson 97153ee5f55SRichard Henderson g_string_truncate(str, 0); 972c49d1c37SRichard Henderson qemu_hexdump_line(str, config + b, len, 1, 4); 97353ee5f55SRichard Henderson trace_vhost_vdpa_dump_config(dev, b, str->str); 974778e67deSLaurent Vivier } 975778e67deSLaurent Vivier } 976778e67deSLaurent Vivier 977108a6481SCindy Lu static int vhost_vdpa_set_config(struct vhost_dev *dev, const uint8_t *data, 978108a6481SCindy Lu uint32_t offset, uint32_t size, 979108a6481SCindy Lu uint32_t flags) 980108a6481SCindy Lu { 981108a6481SCindy Lu struct vhost_vdpa_config *config; 982108a6481SCindy Lu int ret; 983108a6481SCindy Lu unsigned long config_size = offsetof(struct vhost_vdpa_config, buf); 984986d4f78SLi Qiang 985778e67deSLaurent Vivier trace_vhost_vdpa_set_config(dev, offset, size, flags); 986108a6481SCindy Lu config = g_malloc(size + config_size); 987108a6481SCindy Lu config->off = offset; 988108a6481SCindy Lu config->len = size; 989108a6481SCindy Lu memcpy(config->buf, data, size); 990778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_SET_CONFIG) && 991778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_CONFIG)) { 992778e67deSLaurent Vivier vhost_vdpa_dump_config(dev, data, size); 993778e67deSLaurent Vivier } 994108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_VDPA_SET_CONFIG, config); 995108a6481SCindy Lu g_free(config); 996108a6481SCindy Lu return ret; 997108a6481SCindy Lu } 998108a6481SCindy Lu 999108a6481SCindy Lu static int vhost_vdpa_get_config(struct vhost_dev *dev, uint8_t *config, 100050de5138SKevin Wolf uint32_t config_len, Error **errp) 1001108a6481SCindy Lu { 1002108a6481SCindy Lu struct vhost_vdpa_config *v_config; 1003108a6481SCindy Lu unsigned long config_size = offsetof(struct vhost_vdpa_config, buf); 1004108a6481SCindy Lu int ret; 1005108a6481SCindy Lu 1006778e67deSLaurent Vivier trace_vhost_vdpa_get_config(dev, config, config_len); 1007108a6481SCindy Lu v_config = g_malloc(config_len + config_size); 1008108a6481SCindy Lu v_config->len = config_len; 1009108a6481SCindy Lu v_config->off = 0; 1010108a6481SCindy Lu ret = vhost_vdpa_call(dev, VHOST_VDPA_GET_CONFIG, v_config); 1011108a6481SCindy Lu memcpy(config, v_config->buf, config_len); 1012108a6481SCindy Lu g_free(v_config); 1013778e67deSLaurent Vivier if (trace_event_get_state_backends(TRACE_VHOST_VDPA_GET_CONFIG) && 1014778e67deSLaurent Vivier trace_event_get_state_backends(TRACE_VHOST_VDPA_DUMP_CONFIG)) { 1015778e67deSLaurent Vivier vhost_vdpa_dump_config(dev, config, config_len); 1016778e67deSLaurent Vivier } 1017108a6481SCindy Lu return ret; 1018108a6481SCindy Lu } 1019108a6481SCindy Lu 1020d96be4c8SEugenio Pérez static int vhost_vdpa_set_dev_vring_base(struct vhost_dev *dev, 1021d96be4c8SEugenio Pérez struct vhost_vring_state *ring) 1022d96be4c8SEugenio Pérez { 102319a060bcSSi-Wei Liu struct vhost_vdpa *v = dev->opaque; 102419a060bcSSi-Wei Liu 102519a060bcSSi-Wei Liu trace_vhost_vdpa_set_dev_vring_base(dev, ring->index, ring->num, 102619a060bcSSi-Wei Liu v->shadow_vqs_enabled); 1027d96be4c8SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_BASE, ring); 1028d96be4c8SEugenio Pérez } 1029d96be4c8SEugenio Pérez 1030dff4426fSEugenio Pérez static int vhost_vdpa_set_vring_dev_kick(struct vhost_dev *dev, 1031dff4426fSEugenio Pérez struct vhost_vring_file *file) 1032dff4426fSEugenio Pérez { 1033dff4426fSEugenio Pérez trace_vhost_vdpa_set_vring_kick(dev, file->index, file->fd); 1034dff4426fSEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_KICK, file); 1035dff4426fSEugenio Pérez } 1036dff4426fSEugenio Pérez 1037a8ac8858SEugenio Pérez static int vhost_vdpa_set_vring_dev_call(struct vhost_dev *dev, 1038a8ac8858SEugenio Pérez struct vhost_vring_file *file) 1039a8ac8858SEugenio Pérez { 1040a8ac8858SEugenio Pérez trace_vhost_vdpa_set_vring_call(dev, file->index, file->fd); 1041a8ac8858SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_CALL, file); 1042a8ac8858SEugenio Pérez } 1043a8ac8858SEugenio Pérez 1044d96be4c8SEugenio Pérez static int vhost_vdpa_set_vring_dev_addr(struct vhost_dev *dev, 1045d96be4c8SEugenio Pérez struct vhost_vring_addr *addr) 1046d96be4c8SEugenio Pérez { 1047d96be4c8SEugenio Pérez trace_vhost_vdpa_set_vring_addr(dev, addr->index, addr->flags, 1048d96be4c8SEugenio Pérez addr->desc_user_addr, addr->used_user_addr, 1049d96be4c8SEugenio Pérez addr->avail_user_addr, 1050d96be4c8SEugenio Pérez addr->log_guest_addr); 1051d96be4c8SEugenio Pérez 1052d96be4c8SEugenio Pérez return vhost_vdpa_call(dev, VHOST_SET_VRING_ADDR, addr); 1053d96be4c8SEugenio Pérez 1054d96be4c8SEugenio Pérez } 1055d96be4c8SEugenio Pérez 1056dff4426fSEugenio Pérez /** 1057dff4426fSEugenio Pérez * Set the shadow virtqueue descriptors to the device 1058dff4426fSEugenio Pérez * 1059dff4426fSEugenio Pérez * @dev: The vhost device model 1060dff4426fSEugenio Pérez * @svq: The shadow virtqueue 1061dff4426fSEugenio Pérez * @idx: The index of the virtqueue in the vhost device 1062dff4426fSEugenio Pérez * @errp: Error 1063a8ac8858SEugenio Pérez * 1064a8ac8858SEugenio Pérez * Note that this function does not rewind kick file descriptor if cannot set 1065a8ac8858SEugenio Pérez * call one. 1066dff4426fSEugenio Pérez */ 1067100890f7SEugenio Pérez static int vhost_vdpa_svq_set_fds(struct vhost_dev *dev, 1068dff4426fSEugenio Pérez VhostShadowVirtqueue *svq, unsigned idx, 1069dff4426fSEugenio Pérez Error **errp) 1070dff4426fSEugenio Pérez { 1071dff4426fSEugenio Pérez struct vhost_vring_file file = { 1072dff4426fSEugenio Pérez .index = dev->vq_index + idx, 1073dff4426fSEugenio Pérez }; 1074dff4426fSEugenio Pérez const EventNotifier *event_notifier = &svq->hdev_kick; 1075dff4426fSEugenio Pérez int r; 1076dff4426fSEugenio Pérez 10773cfb4d06SEugenio Pérez r = event_notifier_init(&svq->hdev_kick, 0); 10783cfb4d06SEugenio Pérez if (r != 0) { 10793cfb4d06SEugenio Pérez error_setg_errno(errp, -r, "Couldn't create kick event notifier"); 10803cfb4d06SEugenio Pérez goto err_init_hdev_kick; 10813cfb4d06SEugenio Pérez } 10823cfb4d06SEugenio Pérez 10833cfb4d06SEugenio Pérez r = event_notifier_init(&svq->hdev_call, 0); 10843cfb4d06SEugenio Pérez if (r != 0) { 10853cfb4d06SEugenio Pérez error_setg_errno(errp, -r, "Couldn't create call event notifier"); 10863cfb4d06SEugenio Pérez goto err_init_hdev_call; 10873cfb4d06SEugenio Pérez } 10883cfb4d06SEugenio Pérez 1089dff4426fSEugenio Pérez file.fd = event_notifier_get_fd(event_notifier); 1090dff4426fSEugenio Pérez r = vhost_vdpa_set_vring_dev_kick(dev, &file); 1091dff4426fSEugenio Pérez if (unlikely(r != 0)) { 1092dff4426fSEugenio Pérez error_setg_errno(errp, -r, "Can't set device kick fd"); 10933cfb4d06SEugenio Pérez goto err_init_set_dev_fd; 1094a8ac8858SEugenio Pérez } 1095a8ac8858SEugenio Pérez 1096a8ac8858SEugenio Pérez event_notifier = &svq->hdev_call; 1097a8ac8858SEugenio Pérez file.fd = event_notifier_get_fd(event_notifier); 1098a8ac8858SEugenio Pérez r = vhost_vdpa_set_vring_dev_call(dev, &file); 1099a8ac8858SEugenio Pérez if (unlikely(r != 0)) { 1100a8ac8858SEugenio Pérez error_setg_errno(errp, -r, "Can't set device call fd"); 11013cfb4d06SEugenio Pérez goto err_init_set_dev_fd; 1102dff4426fSEugenio Pérez } 1103dff4426fSEugenio Pérez 11043cfb4d06SEugenio Pérez return 0; 11053cfb4d06SEugenio Pérez 11063cfb4d06SEugenio Pérez err_init_set_dev_fd: 11073cfb4d06SEugenio Pérez event_notifier_set_handler(&svq->hdev_call, NULL); 11083cfb4d06SEugenio Pérez 11093cfb4d06SEugenio Pérez err_init_hdev_call: 11103cfb4d06SEugenio Pérez event_notifier_cleanup(&svq->hdev_kick); 11113cfb4d06SEugenio Pérez 11123cfb4d06SEugenio Pérez err_init_hdev_kick: 1113100890f7SEugenio Pérez return r; 1114100890f7SEugenio Pérez } 1115100890f7SEugenio Pérez 1116100890f7SEugenio Pérez /** 1117100890f7SEugenio Pérez * Unmap a SVQ area in the device 1118100890f7SEugenio Pérez */ 11198b6d6119SEugenio Pérez static void vhost_vdpa_svq_unmap_ring(struct vhost_vdpa *v, hwaddr addr) 1120100890f7SEugenio Pérez { 11218b6d6119SEugenio Pérez const DMAMap needle = { 11228b6d6119SEugenio Pérez .translated_addr = addr, 11238b6d6119SEugenio Pérez }; 11245edb02e8SEugenio Pérez const DMAMap *result = vhost_iova_tree_find_iova(v->shared->iova_tree, 11255edb02e8SEugenio Pérez &needle); 112634e3c94eSEugenio Pérez hwaddr size; 1127100890f7SEugenio Pérez int r; 1128100890f7SEugenio Pérez 112934e3c94eSEugenio Pérez if (unlikely(!result)) { 113034e3c94eSEugenio Pérez error_report("Unable to find SVQ address to unmap"); 11315b590f51SEugenio Pérez return; 113234e3c94eSEugenio Pérez } 113334e3c94eSEugenio Pérez 11348e3b0cbbSMarc-André Lureau size = ROUND_UP(result->size, qemu_real_host_page_size()); 11356f03d9efSEugenio Pérez r = vhost_vdpa_dma_unmap(v->shared, v->address_space_id, result->iova, 11366f03d9efSEugenio Pérez size); 1137b37c12beSEugenio Pérez if (unlikely(r < 0)) { 1138b37c12beSEugenio Pérez error_report("Unable to unmap SVQ vring: %s (%d)", g_strerror(-r), -r); 11395b590f51SEugenio Pérez return; 1140b37c12beSEugenio Pérez } 1141b37c12beSEugenio Pérez 11425edb02e8SEugenio Pérez vhost_iova_tree_remove(v->shared->iova_tree, *result); 1143100890f7SEugenio Pérez } 1144100890f7SEugenio Pérez 11455b590f51SEugenio Pérez static void vhost_vdpa_svq_unmap_rings(struct vhost_dev *dev, 1146100890f7SEugenio Pérez const VhostShadowVirtqueue *svq) 1147100890f7SEugenio Pérez { 1148100890f7SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1149100890f7SEugenio Pérez struct vhost_vring_addr svq_addr; 1150100890f7SEugenio Pérez 1151100890f7SEugenio Pérez vhost_svq_get_vring_addr(svq, &svq_addr); 1152100890f7SEugenio Pérez 11538b6d6119SEugenio Pérez vhost_vdpa_svq_unmap_ring(v, svq_addr.desc_user_addr); 1154100890f7SEugenio Pérez 11558b6d6119SEugenio Pérez vhost_vdpa_svq_unmap_ring(v, svq_addr.used_user_addr); 115634e3c94eSEugenio Pérez } 115734e3c94eSEugenio Pérez 115834e3c94eSEugenio Pérez /** 115934e3c94eSEugenio Pérez * Map the SVQ area in the device 116034e3c94eSEugenio Pérez * 116134e3c94eSEugenio Pérez * @v: Vhost-vdpa device 116234e3c94eSEugenio Pérez * @needle: The area to search iova 116392cf61e7SJonah Palmer * @taddr: The translated address (HVA) 116434e3c94eSEugenio Pérez * @errorp: Error pointer 116534e3c94eSEugenio Pérez */ 116634e3c94eSEugenio Pérez static bool vhost_vdpa_svq_map_ring(struct vhost_vdpa *v, DMAMap *needle, 116792cf61e7SJonah Palmer hwaddr taddr, Error **errp) 116834e3c94eSEugenio Pérez { 116934e3c94eSEugenio Pérez int r; 117034e3c94eSEugenio Pérez 117192cf61e7SJonah Palmer r = vhost_iova_tree_map_alloc(v->shared->iova_tree, needle, taddr); 117234e3c94eSEugenio Pérez if (unlikely(r != IOVA_OK)) { 117334e3c94eSEugenio Pérez error_setg(errp, "Cannot allocate iova (%d)", r); 117492cf61e7SJonah Palmer 117592cf61e7SJonah Palmer if (needle->translated_addr == taddr) { 117692cf61e7SJonah Palmer error_append_hint(errp, "Insertion to IOVA->HVA tree failed"); 117792cf61e7SJonah Palmer /* Remove the mapping from the IOVA-only tree */ 117892cf61e7SJonah Palmer vhost_iova_tree_remove(v->shared->iova_tree, *needle); 117992cf61e7SJonah Palmer } 118034e3c94eSEugenio Pérez return false; 118134e3c94eSEugenio Pérez } 118234e3c94eSEugenio Pérez 11836f03d9efSEugenio Pérez r = vhost_vdpa_dma_map(v->shared, v->address_space_id, needle->iova, 1184cd831ed5SEugenio Pérez needle->size + 1, 118534e3c94eSEugenio Pérez (void *)(uintptr_t)needle->translated_addr, 118634e3c94eSEugenio Pérez needle->perm == IOMMU_RO); 118734e3c94eSEugenio Pérez if (unlikely(r != 0)) { 118834e3c94eSEugenio Pérez error_setg_errno(errp, -r, "Cannot map region to device"); 11895edb02e8SEugenio Pérez vhost_iova_tree_remove(v->shared->iova_tree, *needle); 119034e3c94eSEugenio Pérez } 119134e3c94eSEugenio Pérez 119234e3c94eSEugenio Pérez return r == 0; 1193100890f7SEugenio Pérez } 1194100890f7SEugenio Pérez 1195100890f7SEugenio Pérez /** 1196100890f7SEugenio Pérez * Map the shadow virtqueue rings in the device 1197100890f7SEugenio Pérez * 1198100890f7SEugenio Pérez * @dev: The vhost device 1199100890f7SEugenio Pérez * @svq: The shadow virtqueue 1200100890f7SEugenio Pérez * @addr: Assigned IOVA addresses 1201100890f7SEugenio Pérez * @errp: Error pointer 1202100890f7SEugenio Pérez */ 1203100890f7SEugenio Pérez static bool vhost_vdpa_svq_map_rings(struct vhost_dev *dev, 1204100890f7SEugenio Pérez const VhostShadowVirtqueue *svq, 1205100890f7SEugenio Pérez struct vhost_vring_addr *addr, 1206100890f7SEugenio Pérez Error **errp) 1207100890f7SEugenio Pérez { 120805e385d2SMarkus Armbruster ERRP_GUARD(); 120934e3c94eSEugenio Pérez DMAMap device_region, driver_region; 121034e3c94eSEugenio Pérez struct vhost_vring_addr svq_addr; 1211100890f7SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1212100890f7SEugenio Pérez size_t device_size = vhost_svq_device_area_size(svq); 1213100890f7SEugenio Pérez size_t driver_size = vhost_svq_driver_area_size(svq); 121434e3c94eSEugenio Pérez size_t avail_offset; 121534e3c94eSEugenio Pérez bool ok; 1216100890f7SEugenio Pérez 121734e3c94eSEugenio Pérez vhost_svq_get_vring_addr(svq, &svq_addr); 1218100890f7SEugenio Pérez 121934e3c94eSEugenio Pérez driver_region = (DMAMap) { 122034e3c94eSEugenio Pérez .size = driver_size - 1, 122134e3c94eSEugenio Pérez .perm = IOMMU_RO, 122234e3c94eSEugenio Pérez }; 122392cf61e7SJonah Palmer ok = vhost_vdpa_svq_map_ring(v, &driver_region, svq_addr.desc_user_addr, 122492cf61e7SJonah Palmer errp); 122534e3c94eSEugenio Pérez if (unlikely(!ok)) { 122634e3c94eSEugenio Pérez error_prepend(errp, "Cannot create vq driver region: "); 1227100890f7SEugenio Pérez return false; 1228100890f7SEugenio Pérez } 122934e3c94eSEugenio Pérez addr->desc_user_addr = driver_region.iova; 123034e3c94eSEugenio Pérez avail_offset = svq_addr.avail_user_addr - svq_addr.desc_user_addr; 123134e3c94eSEugenio Pérez addr->avail_user_addr = driver_region.iova + avail_offset; 1232100890f7SEugenio Pérez 123334e3c94eSEugenio Pérez device_region = (DMAMap) { 123434e3c94eSEugenio Pérez .size = device_size - 1, 123534e3c94eSEugenio Pérez .perm = IOMMU_RW, 123634e3c94eSEugenio Pérez }; 123792cf61e7SJonah Palmer ok = vhost_vdpa_svq_map_ring(v, &device_region, svq_addr.used_user_addr, 123892cf61e7SJonah Palmer errp); 123934e3c94eSEugenio Pérez if (unlikely(!ok)) { 124034e3c94eSEugenio Pérez error_prepend(errp, "Cannot create vq device region: "); 12418b6d6119SEugenio Pérez vhost_vdpa_svq_unmap_ring(v, driver_region.translated_addr); 1242100890f7SEugenio Pérez } 124334e3c94eSEugenio Pérez addr->used_user_addr = device_region.iova; 1244100890f7SEugenio Pérez 124534e3c94eSEugenio Pérez return ok; 1246100890f7SEugenio Pérez } 1247100890f7SEugenio Pérez 1248100890f7SEugenio Pérez static bool vhost_vdpa_svq_setup(struct vhost_dev *dev, 1249100890f7SEugenio Pérez VhostShadowVirtqueue *svq, unsigned idx, 1250100890f7SEugenio Pérez Error **errp) 1251100890f7SEugenio Pérez { 1252100890f7SEugenio Pérez uint16_t vq_index = dev->vq_index + idx; 1253100890f7SEugenio Pérez struct vhost_vring_state s = { 1254100890f7SEugenio Pérez .index = vq_index, 1255100890f7SEugenio Pérez }; 1256100890f7SEugenio Pérez int r; 1257100890f7SEugenio Pérez 1258100890f7SEugenio Pérez r = vhost_vdpa_set_dev_vring_base(dev, &s); 1259100890f7SEugenio Pérez if (unlikely(r)) { 1260100890f7SEugenio Pérez error_setg_errno(errp, -r, "Cannot set vring base"); 1261100890f7SEugenio Pérez return false; 1262100890f7SEugenio Pérez } 1263100890f7SEugenio Pérez 1264100890f7SEugenio Pérez r = vhost_vdpa_svq_set_fds(dev, svq, idx, errp); 1265dff4426fSEugenio Pérez return r == 0; 1266dff4426fSEugenio Pérez } 1267dff4426fSEugenio Pérez 1268dff4426fSEugenio Pérez static bool vhost_vdpa_svqs_start(struct vhost_dev *dev) 1269dff4426fSEugenio Pérez { 1270dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1271dff4426fSEugenio Pérez Error *err = NULL; 1272dff4426fSEugenio Pérez unsigned i; 1273dff4426fSEugenio Pérez 1274712c1a31SEugenio Pérez if (!v->shadow_vqs_enabled) { 1275dff4426fSEugenio Pérez return true; 1276dff4426fSEugenio Pérez } 1277dff4426fSEugenio Pérez 1278dff4426fSEugenio Pérez for (i = 0; i < v->shadow_vqs->len; ++i) { 1279100890f7SEugenio Pérez VirtQueue *vq = virtio_get_queue(dev->vdev, dev->vq_index + i); 1280dff4426fSEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, i); 1281100890f7SEugenio Pérez struct vhost_vring_addr addr = { 12821c82fdfeSEugenio Pérez .index = dev->vq_index + i, 1283100890f7SEugenio Pérez }; 1284100890f7SEugenio Pérez int r; 1285dff4426fSEugenio Pérez bool ok = vhost_vdpa_svq_setup(dev, svq, i, &err); 1286dff4426fSEugenio Pérez if (unlikely(!ok)) { 1287100890f7SEugenio Pérez goto err; 1288100890f7SEugenio Pérez } 1289100890f7SEugenio Pérez 12905edb02e8SEugenio Pérez vhost_svq_start(svq, dev->vdev, vq, v->shared->iova_tree); 1291100890f7SEugenio Pérez ok = vhost_vdpa_svq_map_rings(dev, svq, &addr, &err); 1292100890f7SEugenio Pérez if (unlikely(!ok)) { 1293100890f7SEugenio Pérez goto err_map; 1294100890f7SEugenio Pérez } 1295100890f7SEugenio Pérez 1296100890f7SEugenio Pérez /* Override vring GPA set by vhost subsystem */ 1297100890f7SEugenio Pérez r = vhost_vdpa_set_vring_dev_addr(dev, &addr); 1298100890f7SEugenio Pérez if (unlikely(r != 0)) { 1299100890f7SEugenio Pérez error_setg_errno(&err, -r, "Cannot set device address"); 1300100890f7SEugenio Pérez goto err_set_addr; 1301100890f7SEugenio Pérez } 1302100890f7SEugenio Pérez } 1303100890f7SEugenio Pérez 1304100890f7SEugenio Pérez return true; 1305100890f7SEugenio Pérez 1306100890f7SEugenio Pérez err_set_addr: 1307100890f7SEugenio Pérez vhost_vdpa_svq_unmap_rings(dev, g_ptr_array_index(v->shadow_vqs, i)); 1308100890f7SEugenio Pérez 1309100890f7SEugenio Pérez err_map: 1310100890f7SEugenio Pérez vhost_svq_stop(g_ptr_array_index(v->shadow_vqs, i)); 1311100890f7SEugenio Pérez 1312100890f7SEugenio Pérez err: 1313dff4426fSEugenio Pérez error_reportf_err(err, "Cannot setup SVQ %u: ", i); 1314100890f7SEugenio Pérez for (unsigned j = 0; j < i; ++j) { 1315100890f7SEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, j); 1316100890f7SEugenio Pérez vhost_vdpa_svq_unmap_rings(dev, svq); 1317100890f7SEugenio Pérez vhost_svq_stop(svq); 1318100890f7SEugenio Pérez } 1319100890f7SEugenio Pérez 1320100890f7SEugenio Pérez return false; 1321100890f7SEugenio Pérez } 1322100890f7SEugenio Pérez 13235b590f51SEugenio Pérez static void vhost_vdpa_svqs_stop(struct vhost_dev *dev) 1324100890f7SEugenio Pérez { 1325100890f7SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1326100890f7SEugenio Pérez 1327712c1a31SEugenio Pérez if (!v->shadow_vqs_enabled) { 13285b590f51SEugenio Pérez return; 1329100890f7SEugenio Pérez } 1330100890f7SEugenio Pérez 1331100890f7SEugenio Pérez for (unsigned i = 0; i < v->shadow_vqs->len; ++i) { 1332100890f7SEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, i); 13332e1a9de9SEugenio Pérez 13342e1a9de9SEugenio Pérez vhost_svq_stop(svq); 13355b590f51SEugenio Pérez vhost_vdpa_svq_unmap_rings(dev, svq); 13363cfb4d06SEugenio Pérez 13373cfb4d06SEugenio Pérez event_notifier_cleanup(&svq->hdev_kick); 13383cfb4d06SEugenio Pérez event_notifier_cleanup(&svq->hdev_call); 1339dff4426fSEugenio Pérez } 1340dff4426fSEugenio Pérez } 1341dff4426fSEugenio Pérez 13420bb302a9SEugenio Pérez static void vhost_vdpa_suspend(struct vhost_dev *dev) 13430bb302a9SEugenio Pérez { 13440bb302a9SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 13450bb302a9SEugenio Pérez int r; 13460bb302a9SEugenio Pérez 13470bb302a9SEugenio Pérez if (!vhost_vdpa_first_dev(dev)) { 13480bb302a9SEugenio Pérez return; 13490bb302a9SEugenio Pérez } 13500bb302a9SEugenio Pérez 13510bb302a9SEugenio Pérez if (dev->backend_cap & BIT_ULL(VHOST_BACKEND_F_SUSPEND)) { 13520bb302a9SEugenio Pérez trace_vhost_vdpa_suspend(dev); 1353f12b2498SEugenio Pérez r = ioctl(v->shared->device_fd, VHOST_VDPA_SUSPEND); 13540bb302a9SEugenio Pérez if (unlikely(r)) { 13550bb302a9SEugenio Pérez error_report("Cannot suspend: %s(%d)", g_strerror(errno), errno); 13560bb302a9SEugenio Pérez } else { 13570bb302a9SEugenio Pérez v->suspended = true; 13580bb302a9SEugenio Pérez return; 13590bb302a9SEugenio Pérez } 13600bb302a9SEugenio Pérez } 13610bb302a9SEugenio Pérez 13620bb302a9SEugenio Pérez vhost_vdpa_reset_device(dev); 13630bb302a9SEugenio Pérez } 13640bb302a9SEugenio Pérez 1365108a6481SCindy Lu static int vhost_vdpa_dev_start(struct vhost_dev *dev, bool started) 1366108a6481SCindy Lu { 1367108a6481SCindy Lu struct vhost_vdpa *v = dev->opaque; 1368dff4426fSEugenio Pérez bool ok; 1369778e67deSLaurent Vivier trace_vhost_vdpa_dev_start(dev, started); 13704d191cfdSJason Wang 13714d191cfdSJason Wang if (started) { 13724d191cfdSJason Wang vhost_vdpa_host_notifiers_init(dev); 1373dff4426fSEugenio Pérez ok = vhost_vdpa_svqs_start(dev); 1374dff4426fSEugenio Pérez if (unlikely(!ok)) { 1375dff4426fSEugenio Pérez return -1; 1376dff4426fSEugenio Pérez } 13774d191cfdSJason Wang } else { 13780bb302a9SEugenio Pérez vhost_vdpa_suspend(dev); 13795b590f51SEugenio Pérez vhost_vdpa_svqs_stop(dev); 13804d191cfdSJason Wang vhost_vdpa_host_notifiers_uninit(dev, dev->nvqs); 13814d191cfdSJason Wang } 13824d191cfdSJason Wang 1383c812b065SSi-Wei Liu if (!vhost_vdpa_last_dev(dev)) { 13844d191cfdSJason Wang return 0; 13854d191cfdSJason Wang } 13864d191cfdSJason Wang 1387108a6481SCindy Lu if (started) { 1388bc7b0cacSCindy Lu if (vhost_dev_has_iommu(dev) && (v->shadow_vqs_enabled)) { 1389bc7b0cacSCindy Lu error_report("SVQ can not work while IOMMU enable, please disable" 1390bc7b0cacSCindy Lu "IOMMU and try again"); 1391bc7b0cacSCindy Lu return -1; 1392bc7b0cacSCindy Lu } 1393494c50dcSEugenio Pérez if (v->shared->listener_registered && 1394494c50dcSEugenio Pérez dev->vdev->dma_as != v->shared->listener.address_space) { 1395494c50dcSEugenio Pérez memory_listener_unregister(&v->shared->listener); 1396494c50dcSEugenio Pérez v->shared->listener_registered = false; 1397494c50dcSEugenio Pérez } 1398be2e5fbeSEugenio Pérez if (!v->shared->listener_registered) { 1399f6fe3e33SEugenio Pérez memory_listener_register(&v->shared->listener, dev->vdev->dma_as); 1400be2e5fbeSEugenio Pérez v->shared->listener_registered = true; 1401be2e5fbeSEugenio Pérez } 1402bc7b0cacSCindy Lu 14033631151bSRoman Kagan return vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_DRIVER_OK); 1404c3716f26SEugenio Pérez } 1405c3716f26SEugenio Pérez 1406c3716f26SEugenio Pérez return 0; 1407c3716f26SEugenio Pérez } 1408c3716f26SEugenio Pérez 1409c3716f26SEugenio Pérez static void vhost_vdpa_reset_status(struct vhost_dev *dev) 1410c3716f26SEugenio Pérez { 1411c812b065SSi-Wei Liu if (!vhost_vdpa_last_dev(dev)) { 1412c3716f26SEugenio Pérez return; 1413c3716f26SEugenio Pérez } 1414c3716f26SEugenio Pérez 1415108a6481SCindy Lu vhost_vdpa_reset_device(dev); 1416108a6481SCindy Lu vhost_vdpa_add_status(dev, VIRTIO_CONFIG_S_ACKNOWLEDGE | 1417108a6481SCindy Lu VIRTIO_CONFIG_S_DRIVER); 1418108a6481SCindy Lu } 1419108a6481SCindy Lu 1420108a6481SCindy Lu static int vhost_vdpa_set_log_base(struct vhost_dev *dev, uint64_t base, 1421108a6481SCindy Lu struct vhost_log *log) 1422108a6481SCindy Lu { 1423773ebc95SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1424d71b0609SSi-Wei Liu if (v->shadow_vqs_enabled || !vhost_vdpa_first_dev(dev)) { 14254d191cfdSJason Wang return 0; 14264d191cfdSJason Wang } 14274d191cfdSJason Wang 1428778e67deSLaurent Vivier trace_vhost_vdpa_set_log_base(dev, base, log->size, log->refcnt, log->fd, 1429778e67deSLaurent Vivier log->log); 1430108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_LOG_BASE, &base); 1431108a6481SCindy Lu } 1432108a6481SCindy Lu 1433108a6481SCindy Lu static int vhost_vdpa_set_vring_addr(struct vhost_dev *dev, 1434108a6481SCindy Lu struct vhost_vring_addr *addr) 1435108a6481SCindy Lu { 1436d96be4c8SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1437d96be4c8SEugenio Pérez 1438d96be4c8SEugenio Pérez if (v->shadow_vqs_enabled) { 1439d96be4c8SEugenio Pérez /* 1440d96be4c8SEugenio Pérez * Device vring addr was set at device start. SVQ base is handled by 1441d96be4c8SEugenio Pérez * VirtQueue code. 1442d96be4c8SEugenio Pérez */ 1443d96be4c8SEugenio Pérez return 0; 1444d96be4c8SEugenio Pérez } 1445d96be4c8SEugenio Pérez 1446d96be4c8SEugenio Pérez return vhost_vdpa_set_vring_dev_addr(dev, addr); 1447108a6481SCindy Lu } 1448108a6481SCindy Lu 1449108a6481SCindy Lu static int vhost_vdpa_set_vring_num(struct vhost_dev *dev, 1450108a6481SCindy Lu struct vhost_vring_state *ring) 1451108a6481SCindy Lu { 1452778e67deSLaurent Vivier trace_vhost_vdpa_set_vring_num(dev, ring->index, ring->num); 1453108a6481SCindy Lu return vhost_vdpa_call(dev, VHOST_SET_VRING_NUM, ring); 1454108a6481SCindy Lu } 1455108a6481SCindy Lu 1456108a6481SCindy Lu static int vhost_vdpa_set_vring_base(struct vhost_dev *dev, 1457108a6481SCindy Lu struct vhost_vring_state *ring) 1458108a6481SCindy Lu { 1459d96be4c8SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1460d96be4c8SEugenio Pérez 1461d96be4c8SEugenio Pérez if (v->shadow_vqs_enabled) { 1462d96be4c8SEugenio Pérez /* 1463d96be4c8SEugenio Pérez * Device vring base was set at device start. SVQ base is handled by 1464d96be4c8SEugenio Pérez * VirtQueue code. 1465d96be4c8SEugenio Pérez */ 1466d96be4c8SEugenio Pérez return 0; 1467d96be4c8SEugenio Pérez } 1468d96be4c8SEugenio Pérez 1469d96be4c8SEugenio Pérez return vhost_vdpa_set_dev_vring_base(dev, ring); 1470108a6481SCindy Lu } 1471108a6481SCindy Lu 1472108a6481SCindy Lu static int vhost_vdpa_get_vring_base(struct vhost_dev *dev, 1473108a6481SCindy Lu struct vhost_vring_state *ring) 1474108a6481SCindy Lu { 14756d0b2226SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1476778e67deSLaurent Vivier int ret; 1477778e67deSLaurent Vivier 14786d0b2226SEugenio Pérez if (v->shadow_vqs_enabled) { 14792fdac348SEugenio Pérez ring->num = virtio_queue_get_last_avail_idx(dev->vdev, ring->index); 14806ec0a746SSi-Wei Liu trace_vhost_vdpa_get_vring_base(dev, ring->index, ring->num, true); 14816d0b2226SEugenio Pérez return 0; 14826d0b2226SEugenio Pérez } 14836d0b2226SEugenio Pérez 1484b6662cb7SEugenio Pérez if (!v->suspended) { 1485b6662cb7SEugenio Pérez /* 1486b6662cb7SEugenio Pérez * Cannot trust in value returned by device, let vhost recover used 1487b6662cb7SEugenio Pérez * idx from guest. 1488b6662cb7SEugenio Pérez */ 1489b6662cb7SEugenio Pérez return -1; 1490b6662cb7SEugenio Pérez } 1491b6662cb7SEugenio Pérez 1492778e67deSLaurent Vivier ret = vhost_vdpa_call(dev, VHOST_GET_VRING_BASE, ring); 14936ec0a746SSi-Wei Liu trace_vhost_vdpa_get_vring_base(dev, ring->index, ring->num, false); 1494778e67deSLaurent Vivier return ret; 1495108a6481SCindy Lu } 1496108a6481SCindy Lu 1497108a6481SCindy Lu static int vhost_vdpa_set_vring_kick(struct vhost_dev *dev, 1498108a6481SCindy Lu struct vhost_vring_file *file) 1499108a6481SCindy Lu { 1500dff4426fSEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1501dff4426fSEugenio Pérez int vdpa_idx = file->index - dev->vq_index; 1502dff4426fSEugenio Pérez 1503dff4426fSEugenio Pérez if (v->shadow_vqs_enabled) { 1504dff4426fSEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, vdpa_idx); 1505dff4426fSEugenio Pérez vhost_svq_set_svq_kick_fd(svq, file->fd); 1506dff4426fSEugenio Pérez return 0; 1507dff4426fSEugenio Pérez } else { 1508dff4426fSEugenio Pérez return vhost_vdpa_set_vring_dev_kick(dev, file); 1509dff4426fSEugenio Pérez } 1510108a6481SCindy Lu } 1511108a6481SCindy Lu 1512108a6481SCindy Lu static int vhost_vdpa_set_vring_call(struct vhost_dev *dev, 1513108a6481SCindy Lu struct vhost_vring_file *file) 1514108a6481SCindy Lu { 1515a8ac8858SEugenio Pérez struct vhost_vdpa *v = dev->opaque; 1516a8ac8858SEugenio Pérez int vdpa_idx = file->index - dev->vq_index; 1517a8ac8858SEugenio Pérez VhostShadowVirtqueue *svq = g_ptr_array_index(v->shadow_vqs, vdpa_idx); 1518a8ac8858SEugenio Pérez 1519b2765243SEugenio Pérez /* Remember last call fd because we can switch to SVQ anytime. */ 1520a8ac8858SEugenio Pérez vhost_svq_set_svq_call_fd(svq, file->fd); 15219ed62809SSi-Wei Liu /* 15229ed62809SSi-Wei Liu * When SVQ is transitioning to off, shadow_vqs_enabled has 15239ed62809SSi-Wei Liu * not been set back to false yet, but the underlying call fd 15249ed62809SSi-Wei Liu * will have to switch back to the guest notifier to signal the 15259ed62809SSi-Wei Liu * passthrough virtqueues. In other situations, SVQ's own call 15269ed62809SSi-Wei Liu * fd shall be used to signal the device model. 15279ed62809SSi-Wei Liu */ 15289ed62809SSi-Wei Liu if (v->shadow_vqs_enabled && 15299ed62809SSi-Wei Liu v->shared->svq_switching != SVQ_TSTATE_DISABLING) { 1530a8ac8858SEugenio Pérez return 0; 1531a8ac8858SEugenio Pérez } 1532b2765243SEugenio Pérez 1533b2765243SEugenio Pérez return vhost_vdpa_set_vring_dev_call(dev, file); 1534108a6481SCindy Lu } 1535108a6481SCindy Lu 1536108a6481SCindy Lu static int vhost_vdpa_get_features(struct vhost_dev *dev, 1537108a6481SCindy Lu uint64_t *features) 1538108a6481SCindy Lu { 153912a195faSEugenio Pérez int ret = vhost_vdpa_get_dev_features(dev, features); 1540778e67deSLaurent Vivier 1541ab7337e3SEugenio Pérez if (ret == 0) { 154212a195faSEugenio Pérez /* Add SVQ logging capabilities */ 154312a195faSEugenio Pérez *features |= BIT_ULL(VHOST_F_LOG_ALL); 154412a195faSEugenio Pérez } 154512a195faSEugenio Pérez 1546778e67deSLaurent Vivier return ret; 1547108a6481SCindy Lu } 1548108a6481SCindy Lu 1549108a6481SCindy Lu static int vhost_vdpa_set_owner(struct vhost_dev *dev) 1550108a6481SCindy Lu { 1551494c50dcSEugenio Pérez int r; 1552494c50dcSEugenio Pérez struct vhost_vdpa *v; 1553494c50dcSEugenio Pérez 1554d71b0609SSi-Wei Liu if (!vhost_vdpa_first_dev(dev)) { 15554d191cfdSJason Wang return 0; 15564d191cfdSJason Wang } 15574d191cfdSJason Wang 1558778e67deSLaurent Vivier trace_vhost_vdpa_set_owner(dev); 1559494c50dcSEugenio Pérez r = vhost_vdpa_call(dev, VHOST_SET_OWNER, NULL); 1560494c50dcSEugenio Pérez if (unlikely(r < 0)) { 1561494c50dcSEugenio Pérez return r; 1562494c50dcSEugenio Pérez } 1563494c50dcSEugenio Pérez 1564494c50dcSEugenio Pérez /* 1565494c50dcSEugenio Pérez * Being optimistic and listening address space memory. If the device 1566494c50dcSEugenio Pérez * uses vIOMMU, it is changed at vhost_vdpa_dev_start. 1567494c50dcSEugenio Pérez */ 1568494c50dcSEugenio Pérez v = dev->opaque; 1569494c50dcSEugenio Pérez memory_listener_register(&v->shared->listener, &address_space_memory); 1570494c50dcSEugenio Pérez v->shared->listener_registered = true; 1571494c50dcSEugenio Pérez return 0; 1572108a6481SCindy Lu } 1573108a6481SCindy Lu 1574108a6481SCindy Lu static int vhost_vdpa_vq_get_addr(struct vhost_dev *dev, 1575108a6481SCindy Lu struct vhost_vring_addr *addr, struct vhost_virtqueue *vq) 1576108a6481SCindy Lu { 1577108a6481SCindy Lu assert(dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_VDPA); 1578108a6481SCindy Lu addr->desc_user_addr = (uint64_t)(unsigned long)vq->desc_phys; 1579108a6481SCindy Lu addr->avail_user_addr = (uint64_t)(unsigned long)vq->avail_phys; 1580108a6481SCindy Lu addr->used_user_addr = (uint64_t)(unsigned long)vq->used_phys; 1581778e67deSLaurent Vivier trace_vhost_vdpa_vq_get_addr(dev, vq, addr->desc_user_addr, 1582778e67deSLaurent Vivier addr->avail_user_addr, addr->used_user_addr); 1583108a6481SCindy Lu return 0; 1584108a6481SCindy Lu } 1585108a6481SCindy Lu 1586108a6481SCindy Lu static bool vhost_vdpa_force_iommu(struct vhost_dev *dev) 1587108a6481SCindy Lu { 1588108a6481SCindy Lu return true; 1589108a6481SCindy Lu } 1590108a6481SCindy Lu 1591108a6481SCindy Lu const VhostOps vdpa_ops = { 1592108a6481SCindy Lu .backend_type = VHOST_BACKEND_TYPE_VDPA, 1593108a6481SCindy Lu .vhost_backend_init = vhost_vdpa_init, 1594108a6481SCindy Lu .vhost_backend_cleanup = vhost_vdpa_cleanup, 1595108a6481SCindy Lu .vhost_set_log_base = vhost_vdpa_set_log_base, 1596108a6481SCindy Lu .vhost_set_vring_addr = vhost_vdpa_set_vring_addr, 1597108a6481SCindy Lu .vhost_set_vring_num = vhost_vdpa_set_vring_num, 1598108a6481SCindy Lu .vhost_set_vring_base = vhost_vdpa_set_vring_base, 1599108a6481SCindy Lu .vhost_get_vring_base = vhost_vdpa_get_vring_base, 1600108a6481SCindy Lu .vhost_set_vring_kick = vhost_vdpa_set_vring_kick, 1601108a6481SCindy Lu .vhost_set_vring_call = vhost_vdpa_set_vring_call, 1602108a6481SCindy Lu .vhost_get_features = vhost_vdpa_get_features, 1603108a6481SCindy Lu .vhost_set_owner = vhost_vdpa_set_owner, 1604108a6481SCindy Lu .vhost_set_vring_endian = NULL, 1605108a6481SCindy Lu .vhost_backend_memslots_limit = vhost_vdpa_memslots_limit, 1606108a6481SCindy Lu .vhost_set_mem_table = vhost_vdpa_set_mem_table, 1607108a6481SCindy Lu .vhost_set_features = vhost_vdpa_set_features, 1608108a6481SCindy Lu .vhost_reset_device = vhost_vdpa_reset_device, 1609108a6481SCindy Lu .vhost_get_vq_index = vhost_vdpa_get_vq_index, 16102c66de61SKevin Wolf .vhost_set_vring_enable = vhost_vdpa_set_vring_enable, 1611108a6481SCindy Lu .vhost_get_config = vhost_vdpa_get_config, 1612108a6481SCindy Lu .vhost_set_config = vhost_vdpa_set_config, 1613108a6481SCindy Lu .vhost_requires_shm_log = NULL, 1614108a6481SCindy Lu .vhost_migration_done = NULL, 1615108a6481SCindy Lu .vhost_net_set_mtu = NULL, 1616108a6481SCindy Lu .vhost_set_iotlb_callback = NULL, 1617108a6481SCindy Lu .vhost_send_device_iotlb_msg = NULL, 1618108a6481SCindy Lu .vhost_dev_start = vhost_vdpa_dev_start, 1619108a6481SCindy Lu .vhost_get_device_id = vhost_vdpa_get_device_id, 1620108a6481SCindy Lu .vhost_vq_get_addr = vhost_vdpa_vq_get_addr, 1621108a6481SCindy Lu .vhost_force_iommu = vhost_vdpa_force_iommu, 1622259f3accSCindy Lu .vhost_set_config_call = vhost_vdpa_set_config_call, 1623c3716f26SEugenio Pérez .vhost_reset_status = vhost_vdpa_reset_status, 1624108a6481SCindy Lu }; 1625