1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * VDPA device simulator core.
4  *
5  * Copyright (c) 2020, Red Hat Inc. All rights reserved.
6  *     Author: Jason Wang <jasowang@redhat.com>
7  *
8  */
9 
10 #include <linux/init.h>
11 #include <linux/module.h>
12 #include <linux/device.h>
13 #include <linux/kernel.h>
14 #include <linux/kthread.h>
15 #include <linux/slab.h>
16 #include <linux/dma-map-ops.h>
17 #include <linux/vringh.h>
18 #include <linux/vdpa.h>
19 #include <linux/vhost_iotlb.h>
20 #include <uapi/linux/vdpa.h>
21 #include <uapi/linux/vhost_types.h>
22 
23 #include "vdpa_sim.h"
24 
25 #define DRV_VERSION  "0.1"
26 #define DRV_AUTHOR   "Jason Wang <jasowang@redhat.com>"
27 #define DRV_DESC     "vDPA Device Simulator core"
28 #define DRV_LICENSE  "GPL v2"
29 
30 static int batch_mapping = 1;
31 module_param(batch_mapping, int, 0444);
32 MODULE_PARM_DESC(batch_mapping, "Batched mapping 1 -Enable; 0 - Disable");
33 
34 static int max_iotlb_entries = 2048;
35 module_param(max_iotlb_entries, int, 0444);
36 MODULE_PARM_DESC(max_iotlb_entries,
37 		 "Maximum number of iotlb entries for each address space. 0 means unlimited. (default: 2048)");
38 
39 static bool use_va = true;
40 module_param(use_va, bool, 0444);
41 MODULE_PARM_DESC(use_va, "Enable/disable the device's ability to use VA");
42 
43 #define VDPASIM_QUEUE_ALIGN PAGE_SIZE
44 #define VDPASIM_QUEUE_MAX 256
45 #define VDPASIM_VENDOR_ID 0
46 
47 struct vdpasim_mm_work {
48 	struct kthread_work work;
49 	struct vdpasim *vdpasim;
50 	struct mm_struct *mm_to_bind;
51 	int ret;
52 };
53 
vdpasim_mm_work_fn(struct kthread_work * work)54 static void vdpasim_mm_work_fn(struct kthread_work *work)
55 {
56 	struct vdpasim_mm_work *mm_work =
57 		container_of(work, struct vdpasim_mm_work, work);
58 	struct vdpasim *vdpasim = mm_work->vdpasim;
59 
60 	mm_work->ret = 0;
61 
62 	//TODO: should we attach the cgroup of the mm owner?
63 	vdpasim->mm_bound = mm_work->mm_to_bind;
64 }
65 
vdpasim_worker_change_mm_sync(struct vdpasim * vdpasim,struct vdpasim_mm_work * mm_work)66 static void vdpasim_worker_change_mm_sync(struct vdpasim *vdpasim,
67 					  struct vdpasim_mm_work *mm_work)
68 {
69 	struct kthread_work *work = &mm_work->work;
70 
71 	kthread_init_work(work, vdpasim_mm_work_fn);
72 	kthread_queue_work(vdpasim->worker, work);
73 
74 	kthread_flush_work(work);
75 }
76 
vdpa_to_sim(struct vdpa_device * vdpa)77 static struct vdpasim *vdpa_to_sim(struct vdpa_device *vdpa)
78 {
79 	return container_of(vdpa, struct vdpasim, vdpa);
80 }
81 
vdpasim_vq_notify(struct vringh * vring)82 static void vdpasim_vq_notify(struct vringh *vring)
83 {
84 	struct vdpasim_virtqueue *vq =
85 		container_of(vring, struct vdpasim_virtqueue, vring);
86 
87 	if (!vq->cb)
88 		return;
89 
90 	vq->cb(vq->private);
91 }
92 
vdpasim_queue_ready(struct vdpasim * vdpasim,unsigned int idx)93 static void vdpasim_queue_ready(struct vdpasim *vdpasim, unsigned int idx)
94 {
95 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
96 	uint16_t last_avail_idx = vq->vring.last_avail_idx;
97 	struct vring_desc *desc = (struct vring_desc *)
98 				  (uintptr_t)vq->desc_addr;
99 	struct vring_avail *avail = (struct vring_avail *)
100 				    (uintptr_t)vq->driver_addr;
101 	struct vring_used *used = (struct vring_used *)
102 				  (uintptr_t)vq->device_addr;
103 
104 	if (use_va && vdpasim->mm_bound) {
105 		vringh_init_iotlb_va(&vq->vring, vdpasim->features, vq->num,
106 				     true, desc, avail, used);
107 	} else {
108 		vringh_init_iotlb(&vq->vring, vdpasim->features, vq->num,
109 				  true, desc, avail, used);
110 	}
111 
112 	vq->vring.last_avail_idx = last_avail_idx;
113 
114 	/*
115 	 * Since vdpa_sim does not support receive inflight descriptors as a
116 	 * destination of a migration, let's set both avail_idx and used_idx
117 	 * the same at vq start.  This is how vhost-user works in a
118 	 * VHOST_SET_VRING_BASE call.
119 	 *
120 	 * Although the simple fix is to set last_used_idx at
121 	 * vdpasim_set_vq_state, it would be reset at vdpasim_queue_ready.
122 	 */
123 	vq->vring.last_used_idx = last_avail_idx;
124 	vq->vring.notify = vdpasim_vq_notify;
125 }
126 
vdpasim_vq_reset(struct vdpasim * vdpasim,struct vdpasim_virtqueue * vq)127 static void vdpasim_vq_reset(struct vdpasim *vdpasim,
128 			     struct vdpasim_virtqueue *vq)
129 {
130 	vq->ready = false;
131 	vq->desc_addr = 0;
132 	vq->driver_addr = 0;
133 	vq->device_addr = 0;
134 	vq->cb = NULL;
135 	vq->private = NULL;
136 	vringh_init_iotlb(&vq->vring, vdpasim->dev_attr.supported_features,
137 			  VDPASIM_QUEUE_MAX, false, NULL, NULL, NULL);
138 
139 	vq->vring.notify = NULL;
140 }
141 
vdpasim_do_reset(struct vdpasim * vdpasim)142 static void vdpasim_do_reset(struct vdpasim *vdpasim)
143 {
144 	int i;
145 
146 	spin_lock(&vdpasim->iommu_lock);
147 
148 	for (i = 0; i < vdpasim->dev_attr.nvqs; i++) {
149 		vdpasim_vq_reset(vdpasim, &vdpasim->vqs[i]);
150 		vringh_set_iotlb(&vdpasim->vqs[i].vring, &vdpasim->iommu[0],
151 				 &vdpasim->iommu_lock);
152 	}
153 
154 	for (i = 0; i < vdpasim->dev_attr.nas; i++) {
155 		vhost_iotlb_reset(&vdpasim->iommu[i]);
156 		vhost_iotlb_add_range(&vdpasim->iommu[i], 0, ULONG_MAX,
157 				      0, VHOST_MAP_RW);
158 		vdpasim->iommu_pt[i] = true;
159 	}
160 
161 	vdpasim->running = true;
162 	spin_unlock(&vdpasim->iommu_lock);
163 
164 	vdpasim->features = 0;
165 	vdpasim->status = 0;
166 	++vdpasim->generation;
167 }
168 
169 static const struct vdpa_config_ops vdpasim_config_ops;
170 static const struct vdpa_config_ops vdpasim_batch_config_ops;
171 
vdpasim_work_fn(struct kthread_work * work)172 static void vdpasim_work_fn(struct kthread_work *work)
173 {
174 	struct vdpasim *vdpasim = container_of(work, struct vdpasim, work);
175 	struct mm_struct *mm = vdpasim->mm_bound;
176 
177 	if (use_va && mm) {
178 		if (!mmget_not_zero(mm))
179 			return;
180 		kthread_use_mm(mm);
181 	}
182 
183 	vdpasim->dev_attr.work_fn(vdpasim);
184 
185 	if (use_va && mm) {
186 		kthread_unuse_mm(mm);
187 		mmput(mm);
188 	}
189 }
190 
vdpasim_create(struct vdpasim_dev_attr * dev_attr,const struct vdpa_dev_set_config * config)191 struct vdpasim *vdpasim_create(struct vdpasim_dev_attr *dev_attr,
192 			       const struct vdpa_dev_set_config *config)
193 {
194 	const struct vdpa_config_ops *ops;
195 	struct vdpa_device *vdpa;
196 	struct vdpasim *vdpasim;
197 	struct device *dev;
198 	int i, ret = -ENOMEM;
199 
200 	if (!dev_attr->alloc_size)
201 		return ERR_PTR(-EINVAL);
202 
203 	if (config->mask & BIT_ULL(VDPA_ATTR_DEV_FEATURES)) {
204 		if (config->device_features &
205 		    ~dev_attr->supported_features)
206 			return ERR_PTR(-EINVAL);
207 		dev_attr->supported_features =
208 			config->device_features;
209 	}
210 
211 	if (batch_mapping)
212 		ops = &vdpasim_batch_config_ops;
213 	else
214 		ops = &vdpasim_config_ops;
215 
216 	vdpa = __vdpa_alloc_device(NULL, ops,
217 				   dev_attr->ngroups, dev_attr->nas,
218 				   dev_attr->alloc_size,
219 				   dev_attr->name, use_va);
220 	if (IS_ERR(vdpa)) {
221 		ret = PTR_ERR(vdpa);
222 		goto err_alloc;
223 	}
224 
225 	vdpasim = vdpa_to_sim(vdpa);
226 	vdpasim->dev_attr = *dev_attr;
227 	dev = &vdpasim->vdpa.dev;
228 
229 	kthread_init_work(&vdpasim->work, vdpasim_work_fn);
230 	vdpasim->worker = kthread_create_worker(0, "vDPA sim worker: %s",
231 						dev_attr->name);
232 	if (IS_ERR(vdpasim->worker))
233 		goto err_iommu;
234 
235 	mutex_init(&vdpasim->mutex);
236 	spin_lock_init(&vdpasim->iommu_lock);
237 
238 	dev->dma_mask = &dev->coherent_dma_mask;
239 	if (dma_set_mask_and_coherent(dev, DMA_BIT_MASK(64)))
240 		goto err_iommu;
241 	vdpasim->vdpa.mdev = dev_attr->mgmt_dev;
242 
243 	vdpasim->config = kzalloc(dev_attr->config_size, GFP_KERNEL);
244 	if (!vdpasim->config)
245 		goto err_iommu;
246 
247 	vdpasim->vqs = kcalloc(dev_attr->nvqs, sizeof(struct vdpasim_virtqueue),
248 			       GFP_KERNEL);
249 	if (!vdpasim->vqs)
250 		goto err_iommu;
251 
252 	vdpasim->iommu = kmalloc_array(vdpasim->dev_attr.nas,
253 				       sizeof(*vdpasim->iommu), GFP_KERNEL);
254 	if (!vdpasim->iommu)
255 		goto err_iommu;
256 
257 	vdpasim->iommu_pt = kmalloc_array(vdpasim->dev_attr.nas,
258 					  sizeof(*vdpasim->iommu_pt), GFP_KERNEL);
259 	if (!vdpasim->iommu_pt)
260 		goto err_iommu;
261 
262 	for (i = 0; i < vdpasim->dev_attr.nas; i++)
263 		vhost_iotlb_init(&vdpasim->iommu[i], max_iotlb_entries, 0);
264 
265 	for (i = 0; i < dev_attr->nvqs; i++)
266 		vringh_set_iotlb(&vdpasim->vqs[i].vring, &vdpasim->iommu[0],
267 				 &vdpasim->iommu_lock);
268 
269 	vdpasim->vdpa.dma_dev = dev;
270 
271 	return vdpasim;
272 
273 err_iommu:
274 	put_device(dev);
275 err_alloc:
276 	return ERR_PTR(ret);
277 }
278 EXPORT_SYMBOL_GPL(vdpasim_create);
279 
vdpasim_schedule_work(struct vdpasim * vdpasim)280 void vdpasim_schedule_work(struct vdpasim *vdpasim)
281 {
282 	kthread_queue_work(vdpasim->worker, &vdpasim->work);
283 }
284 EXPORT_SYMBOL_GPL(vdpasim_schedule_work);
285 
vdpasim_set_vq_address(struct vdpa_device * vdpa,u16 idx,u64 desc_area,u64 driver_area,u64 device_area)286 static int vdpasim_set_vq_address(struct vdpa_device *vdpa, u16 idx,
287 				  u64 desc_area, u64 driver_area,
288 				  u64 device_area)
289 {
290 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
291 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
292 
293 	vq->desc_addr = desc_area;
294 	vq->driver_addr = driver_area;
295 	vq->device_addr = device_area;
296 
297 	return 0;
298 }
299 
vdpasim_set_vq_num(struct vdpa_device * vdpa,u16 idx,u32 num)300 static void vdpasim_set_vq_num(struct vdpa_device *vdpa, u16 idx, u32 num)
301 {
302 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
303 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
304 
305 	vq->num = num;
306 }
307 
vdpasim_kick_vq(struct vdpa_device * vdpa,u16 idx)308 static void vdpasim_kick_vq(struct vdpa_device *vdpa, u16 idx)
309 {
310 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
311 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
312 
313 	if (!vdpasim->running &&
314 	    (vdpasim->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
315 		vdpasim->pending_kick = true;
316 		return;
317 	}
318 
319 	if (vq->ready)
320 		vdpasim_schedule_work(vdpasim);
321 }
322 
vdpasim_set_vq_cb(struct vdpa_device * vdpa,u16 idx,struct vdpa_callback * cb)323 static void vdpasim_set_vq_cb(struct vdpa_device *vdpa, u16 idx,
324 			      struct vdpa_callback *cb)
325 {
326 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
327 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
328 
329 	vq->cb = cb->callback;
330 	vq->private = cb->private;
331 }
332 
vdpasim_set_vq_ready(struct vdpa_device * vdpa,u16 idx,bool ready)333 static void vdpasim_set_vq_ready(struct vdpa_device *vdpa, u16 idx, bool ready)
334 {
335 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
336 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
337 	bool old_ready;
338 
339 	mutex_lock(&vdpasim->mutex);
340 	old_ready = vq->ready;
341 	vq->ready = ready;
342 	if (vq->ready && !old_ready) {
343 		vdpasim_queue_ready(vdpasim, idx);
344 	}
345 	mutex_unlock(&vdpasim->mutex);
346 }
347 
vdpasim_get_vq_ready(struct vdpa_device * vdpa,u16 idx)348 static bool vdpasim_get_vq_ready(struct vdpa_device *vdpa, u16 idx)
349 {
350 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
351 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
352 
353 	return vq->ready;
354 }
355 
vdpasim_set_vq_state(struct vdpa_device * vdpa,u16 idx,const struct vdpa_vq_state * state)356 static int vdpasim_set_vq_state(struct vdpa_device *vdpa, u16 idx,
357 				const struct vdpa_vq_state *state)
358 {
359 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
360 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
361 	struct vringh *vrh = &vq->vring;
362 
363 	mutex_lock(&vdpasim->mutex);
364 	vrh->last_avail_idx = state->split.avail_index;
365 	mutex_unlock(&vdpasim->mutex);
366 
367 	return 0;
368 }
369 
vdpasim_get_vq_state(struct vdpa_device * vdpa,u16 idx,struct vdpa_vq_state * state)370 static int vdpasim_get_vq_state(struct vdpa_device *vdpa, u16 idx,
371 				struct vdpa_vq_state *state)
372 {
373 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
374 	struct vdpasim_virtqueue *vq = &vdpasim->vqs[idx];
375 	struct vringh *vrh = &vq->vring;
376 
377 	state->split.avail_index = vrh->last_avail_idx;
378 	return 0;
379 }
380 
vdpasim_get_vq_stats(struct vdpa_device * vdpa,u16 idx,struct sk_buff * msg,struct netlink_ext_ack * extack)381 static int vdpasim_get_vq_stats(struct vdpa_device *vdpa, u16 idx,
382 				struct sk_buff *msg,
383 				struct netlink_ext_ack *extack)
384 {
385 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
386 
387 	if (vdpasim->dev_attr.get_stats)
388 		return vdpasim->dev_attr.get_stats(vdpasim, idx,
389 						   msg, extack);
390 	return -EOPNOTSUPP;
391 }
392 
vdpasim_get_vq_align(struct vdpa_device * vdpa)393 static u32 vdpasim_get_vq_align(struct vdpa_device *vdpa)
394 {
395 	return VDPASIM_QUEUE_ALIGN;
396 }
397 
vdpasim_get_vq_group(struct vdpa_device * vdpa,u16 idx)398 static u32 vdpasim_get_vq_group(struct vdpa_device *vdpa, u16 idx)
399 {
400 	/* RX and TX belongs to group 0, CVQ belongs to group 1 */
401 	if (idx == 2)
402 		return 1;
403 	else
404 		return 0;
405 }
406 
vdpasim_get_device_features(struct vdpa_device * vdpa)407 static u64 vdpasim_get_device_features(struct vdpa_device *vdpa)
408 {
409 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
410 
411 	return vdpasim->dev_attr.supported_features;
412 }
413 
vdpasim_get_backend_features(const struct vdpa_device * vdpa)414 static u64 vdpasim_get_backend_features(const struct vdpa_device *vdpa)
415 {
416 	return BIT_ULL(VHOST_BACKEND_F_ENABLE_AFTER_DRIVER_OK);
417 }
418 
vdpasim_set_driver_features(struct vdpa_device * vdpa,u64 features)419 static int vdpasim_set_driver_features(struct vdpa_device *vdpa, u64 features)
420 {
421 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
422 
423 	/* DMA mapping must be done by driver */
424 	if (!(features & (1ULL << VIRTIO_F_ACCESS_PLATFORM)))
425 		return -EINVAL;
426 
427 	vdpasim->features = features & vdpasim->dev_attr.supported_features;
428 
429 	return 0;
430 }
431 
vdpasim_get_driver_features(struct vdpa_device * vdpa)432 static u64 vdpasim_get_driver_features(struct vdpa_device *vdpa)
433 {
434 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
435 
436 	return vdpasim->features;
437 }
438 
vdpasim_set_config_cb(struct vdpa_device * vdpa,struct vdpa_callback * cb)439 static void vdpasim_set_config_cb(struct vdpa_device *vdpa,
440 				  struct vdpa_callback *cb)
441 {
442 	/* We don't support config interrupt */
443 }
444 
vdpasim_get_vq_num_max(struct vdpa_device * vdpa)445 static u16 vdpasim_get_vq_num_max(struct vdpa_device *vdpa)
446 {
447 	return VDPASIM_QUEUE_MAX;
448 }
449 
vdpasim_get_device_id(struct vdpa_device * vdpa)450 static u32 vdpasim_get_device_id(struct vdpa_device *vdpa)
451 {
452 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
453 
454 	return vdpasim->dev_attr.id;
455 }
456 
vdpasim_get_vendor_id(struct vdpa_device * vdpa)457 static u32 vdpasim_get_vendor_id(struct vdpa_device *vdpa)
458 {
459 	return VDPASIM_VENDOR_ID;
460 }
461 
vdpasim_get_status(struct vdpa_device * vdpa)462 static u8 vdpasim_get_status(struct vdpa_device *vdpa)
463 {
464 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
465 	u8 status;
466 
467 	mutex_lock(&vdpasim->mutex);
468 	status = vdpasim->status;
469 	mutex_unlock(&vdpasim->mutex);
470 
471 	return status;
472 }
473 
vdpasim_set_status(struct vdpa_device * vdpa,u8 status)474 static void vdpasim_set_status(struct vdpa_device *vdpa, u8 status)
475 {
476 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
477 
478 	mutex_lock(&vdpasim->mutex);
479 	vdpasim->status = status;
480 	mutex_unlock(&vdpasim->mutex);
481 }
482 
vdpasim_reset(struct vdpa_device * vdpa)483 static int vdpasim_reset(struct vdpa_device *vdpa)
484 {
485 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
486 
487 	mutex_lock(&vdpasim->mutex);
488 	vdpasim->status = 0;
489 	vdpasim_do_reset(vdpasim);
490 	mutex_unlock(&vdpasim->mutex);
491 
492 	return 0;
493 }
494 
vdpasim_suspend(struct vdpa_device * vdpa)495 static int vdpasim_suspend(struct vdpa_device *vdpa)
496 {
497 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
498 
499 	mutex_lock(&vdpasim->mutex);
500 	vdpasim->running = false;
501 	mutex_unlock(&vdpasim->mutex);
502 
503 	return 0;
504 }
505 
vdpasim_resume(struct vdpa_device * vdpa)506 static int vdpasim_resume(struct vdpa_device *vdpa)
507 {
508 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
509 	int i;
510 
511 	mutex_lock(&vdpasim->mutex);
512 	vdpasim->running = true;
513 
514 	if (vdpasim->pending_kick) {
515 		/* Process pending descriptors */
516 		for (i = 0; i < vdpasim->dev_attr.nvqs; ++i)
517 			vdpasim_kick_vq(vdpa, i);
518 
519 		vdpasim->pending_kick = false;
520 	}
521 
522 	mutex_unlock(&vdpasim->mutex);
523 
524 	return 0;
525 }
526 
vdpasim_get_config_size(struct vdpa_device * vdpa)527 static size_t vdpasim_get_config_size(struct vdpa_device *vdpa)
528 {
529 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
530 
531 	return vdpasim->dev_attr.config_size;
532 }
533 
vdpasim_get_config(struct vdpa_device * vdpa,unsigned int offset,void * buf,unsigned int len)534 static void vdpasim_get_config(struct vdpa_device *vdpa, unsigned int offset,
535 			     void *buf, unsigned int len)
536 {
537 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
538 
539 	if (offset + len > vdpasim->dev_attr.config_size)
540 		return;
541 
542 	if (vdpasim->dev_attr.get_config)
543 		vdpasim->dev_attr.get_config(vdpasim, vdpasim->config);
544 
545 	memcpy(buf, vdpasim->config + offset, len);
546 }
547 
vdpasim_set_config(struct vdpa_device * vdpa,unsigned int offset,const void * buf,unsigned int len)548 static void vdpasim_set_config(struct vdpa_device *vdpa, unsigned int offset,
549 			     const void *buf, unsigned int len)
550 {
551 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
552 
553 	if (offset + len > vdpasim->dev_attr.config_size)
554 		return;
555 
556 	memcpy(vdpasim->config + offset, buf, len);
557 
558 	if (vdpasim->dev_attr.set_config)
559 		vdpasim->dev_attr.set_config(vdpasim, vdpasim->config);
560 }
561 
vdpasim_get_generation(struct vdpa_device * vdpa)562 static u32 vdpasim_get_generation(struct vdpa_device *vdpa)
563 {
564 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
565 
566 	return vdpasim->generation;
567 }
568 
vdpasim_get_iova_range(struct vdpa_device * vdpa)569 static struct vdpa_iova_range vdpasim_get_iova_range(struct vdpa_device *vdpa)
570 {
571 	struct vdpa_iova_range range = {
572 		.first = 0ULL,
573 		.last = ULLONG_MAX,
574 	};
575 
576 	return range;
577 }
578 
vdpasim_set_group_asid(struct vdpa_device * vdpa,unsigned int group,unsigned int asid)579 static int vdpasim_set_group_asid(struct vdpa_device *vdpa, unsigned int group,
580 				  unsigned int asid)
581 {
582 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
583 	struct vhost_iotlb *iommu;
584 	int i;
585 
586 	if (group > vdpasim->dev_attr.ngroups)
587 		return -EINVAL;
588 
589 	if (asid >= vdpasim->dev_attr.nas)
590 		return -EINVAL;
591 
592 	iommu = &vdpasim->iommu[asid];
593 
594 	mutex_lock(&vdpasim->mutex);
595 
596 	for (i = 0; i < vdpasim->dev_attr.nvqs; i++)
597 		if (vdpasim_get_vq_group(vdpa, i) == group)
598 			vringh_set_iotlb(&vdpasim->vqs[i].vring, iommu,
599 					 &vdpasim->iommu_lock);
600 
601 	mutex_unlock(&vdpasim->mutex);
602 
603 	return 0;
604 }
605 
vdpasim_set_map(struct vdpa_device * vdpa,unsigned int asid,struct vhost_iotlb * iotlb)606 static int vdpasim_set_map(struct vdpa_device *vdpa, unsigned int asid,
607 			   struct vhost_iotlb *iotlb)
608 {
609 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
610 	struct vhost_iotlb_map *map;
611 	struct vhost_iotlb *iommu;
612 	u64 start = 0ULL, last = 0ULL - 1;
613 	int ret;
614 
615 	if (asid >= vdpasim->dev_attr.nas)
616 		return -EINVAL;
617 
618 	spin_lock(&vdpasim->iommu_lock);
619 
620 	iommu = &vdpasim->iommu[asid];
621 	vhost_iotlb_reset(iommu);
622 	vdpasim->iommu_pt[asid] = false;
623 
624 	for (map = vhost_iotlb_itree_first(iotlb, start, last); map;
625 	     map = vhost_iotlb_itree_next(map, start, last)) {
626 		ret = vhost_iotlb_add_range(iommu, map->start,
627 					    map->last, map->addr, map->perm);
628 		if (ret)
629 			goto err;
630 	}
631 	spin_unlock(&vdpasim->iommu_lock);
632 	return 0;
633 
634 err:
635 	vhost_iotlb_reset(iommu);
636 	spin_unlock(&vdpasim->iommu_lock);
637 	return ret;
638 }
639 
vdpasim_bind_mm(struct vdpa_device * vdpa,struct mm_struct * mm)640 static int vdpasim_bind_mm(struct vdpa_device *vdpa, struct mm_struct *mm)
641 {
642 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
643 	struct vdpasim_mm_work mm_work;
644 
645 	mm_work.vdpasim = vdpasim;
646 	mm_work.mm_to_bind = mm;
647 
648 	vdpasim_worker_change_mm_sync(vdpasim, &mm_work);
649 
650 	return mm_work.ret;
651 }
652 
vdpasim_unbind_mm(struct vdpa_device * vdpa)653 static void vdpasim_unbind_mm(struct vdpa_device *vdpa)
654 {
655 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
656 	struct vdpasim_mm_work mm_work;
657 
658 	mm_work.vdpasim = vdpasim;
659 	mm_work.mm_to_bind = NULL;
660 
661 	vdpasim_worker_change_mm_sync(vdpasim, &mm_work);
662 }
663 
vdpasim_dma_map(struct vdpa_device * vdpa,unsigned int asid,u64 iova,u64 size,u64 pa,u32 perm,void * opaque)664 static int vdpasim_dma_map(struct vdpa_device *vdpa, unsigned int asid,
665 			   u64 iova, u64 size,
666 			   u64 pa, u32 perm, void *opaque)
667 {
668 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
669 	int ret;
670 
671 	if (asid >= vdpasim->dev_attr.nas)
672 		return -EINVAL;
673 
674 	spin_lock(&vdpasim->iommu_lock);
675 	if (vdpasim->iommu_pt[asid]) {
676 		vhost_iotlb_reset(&vdpasim->iommu[asid]);
677 		vdpasim->iommu_pt[asid] = false;
678 	}
679 	ret = vhost_iotlb_add_range_ctx(&vdpasim->iommu[asid], iova,
680 					iova + size - 1, pa, perm, opaque);
681 	spin_unlock(&vdpasim->iommu_lock);
682 
683 	return ret;
684 }
685 
vdpasim_dma_unmap(struct vdpa_device * vdpa,unsigned int asid,u64 iova,u64 size)686 static int vdpasim_dma_unmap(struct vdpa_device *vdpa, unsigned int asid,
687 			     u64 iova, u64 size)
688 {
689 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
690 
691 	if (asid >= vdpasim->dev_attr.nas)
692 		return -EINVAL;
693 
694 	if (vdpasim->iommu_pt[asid]) {
695 		vhost_iotlb_reset(&vdpasim->iommu[asid]);
696 		vdpasim->iommu_pt[asid] = false;
697 	}
698 
699 	spin_lock(&vdpasim->iommu_lock);
700 	vhost_iotlb_del_range(&vdpasim->iommu[asid], iova, iova + size - 1);
701 	spin_unlock(&vdpasim->iommu_lock);
702 
703 	return 0;
704 }
705 
vdpasim_free(struct vdpa_device * vdpa)706 static void vdpasim_free(struct vdpa_device *vdpa)
707 {
708 	struct vdpasim *vdpasim = vdpa_to_sim(vdpa);
709 	int i;
710 
711 	kthread_cancel_work_sync(&vdpasim->work);
712 	kthread_destroy_worker(vdpasim->worker);
713 
714 	for (i = 0; i < vdpasim->dev_attr.nvqs; i++) {
715 		vringh_kiov_cleanup(&vdpasim->vqs[i].out_iov);
716 		vringh_kiov_cleanup(&vdpasim->vqs[i].in_iov);
717 	}
718 
719 	vdpasim->dev_attr.free(vdpasim);
720 
721 	for (i = 0; i < vdpasim->dev_attr.nas; i++)
722 		vhost_iotlb_reset(&vdpasim->iommu[i]);
723 	kfree(vdpasim->iommu);
724 	kfree(vdpasim->iommu_pt);
725 	kfree(vdpasim->vqs);
726 	kfree(vdpasim->config);
727 }
728 
729 static const struct vdpa_config_ops vdpasim_config_ops = {
730 	.set_vq_address         = vdpasim_set_vq_address,
731 	.set_vq_num             = vdpasim_set_vq_num,
732 	.kick_vq                = vdpasim_kick_vq,
733 	.set_vq_cb              = vdpasim_set_vq_cb,
734 	.set_vq_ready           = vdpasim_set_vq_ready,
735 	.get_vq_ready           = vdpasim_get_vq_ready,
736 	.set_vq_state           = vdpasim_set_vq_state,
737 	.get_vendor_vq_stats    = vdpasim_get_vq_stats,
738 	.get_vq_state           = vdpasim_get_vq_state,
739 	.get_vq_align           = vdpasim_get_vq_align,
740 	.get_vq_group           = vdpasim_get_vq_group,
741 	.get_device_features    = vdpasim_get_device_features,
742 	.get_backend_features   = vdpasim_get_backend_features,
743 	.set_driver_features    = vdpasim_set_driver_features,
744 	.get_driver_features    = vdpasim_get_driver_features,
745 	.set_config_cb          = vdpasim_set_config_cb,
746 	.get_vq_num_max         = vdpasim_get_vq_num_max,
747 	.get_device_id          = vdpasim_get_device_id,
748 	.get_vendor_id          = vdpasim_get_vendor_id,
749 	.get_status             = vdpasim_get_status,
750 	.set_status             = vdpasim_set_status,
751 	.reset			= vdpasim_reset,
752 	.suspend		= vdpasim_suspend,
753 	.resume			= vdpasim_resume,
754 	.get_config_size        = vdpasim_get_config_size,
755 	.get_config             = vdpasim_get_config,
756 	.set_config             = vdpasim_set_config,
757 	.get_generation         = vdpasim_get_generation,
758 	.get_iova_range         = vdpasim_get_iova_range,
759 	.set_group_asid         = vdpasim_set_group_asid,
760 	.dma_map                = vdpasim_dma_map,
761 	.dma_unmap              = vdpasim_dma_unmap,
762 	.bind_mm		= vdpasim_bind_mm,
763 	.unbind_mm		= vdpasim_unbind_mm,
764 	.free                   = vdpasim_free,
765 };
766 
767 static const struct vdpa_config_ops vdpasim_batch_config_ops = {
768 	.set_vq_address         = vdpasim_set_vq_address,
769 	.set_vq_num             = vdpasim_set_vq_num,
770 	.kick_vq                = vdpasim_kick_vq,
771 	.set_vq_cb              = vdpasim_set_vq_cb,
772 	.set_vq_ready           = vdpasim_set_vq_ready,
773 	.get_vq_ready           = vdpasim_get_vq_ready,
774 	.set_vq_state           = vdpasim_set_vq_state,
775 	.get_vendor_vq_stats    = vdpasim_get_vq_stats,
776 	.get_vq_state           = vdpasim_get_vq_state,
777 	.get_vq_align           = vdpasim_get_vq_align,
778 	.get_vq_group           = vdpasim_get_vq_group,
779 	.get_device_features    = vdpasim_get_device_features,
780 	.get_backend_features   = vdpasim_get_backend_features,
781 	.set_driver_features    = vdpasim_set_driver_features,
782 	.get_driver_features    = vdpasim_get_driver_features,
783 	.set_config_cb          = vdpasim_set_config_cb,
784 	.get_vq_num_max         = vdpasim_get_vq_num_max,
785 	.get_device_id          = vdpasim_get_device_id,
786 	.get_vendor_id          = vdpasim_get_vendor_id,
787 	.get_status             = vdpasim_get_status,
788 	.set_status             = vdpasim_set_status,
789 	.reset			= vdpasim_reset,
790 	.suspend		= vdpasim_suspend,
791 	.resume			= vdpasim_resume,
792 	.get_config_size        = vdpasim_get_config_size,
793 	.get_config             = vdpasim_get_config,
794 	.set_config             = vdpasim_set_config,
795 	.get_generation         = vdpasim_get_generation,
796 	.get_iova_range         = vdpasim_get_iova_range,
797 	.set_group_asid         = vdpasim_set_group_asid,
798 	.set_map                = vdpasim_set_map,
799 	.bind_mm		= vdpasim_bind_mm,
800 	.unbind_mm		= vdpasim_unbind_mm,
801 	.free                   = vdpasim_free,
802 };
803 
804 MODULE_VERSION(DRV_VERSION);
805 MODULE_LICENSE(DRV_LICENSE);
806 MODULE_AUTHOR(DRV_AUTHOR);
807 MODULE_DESCRIPTION(DRV_DESC);
808