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