xref: /linux/drivers/gpu/drm/virtio/virtgpu_vq.c (revision 490599ab23134962a6d18a024e84541d77bdb999)
1 /*
2  * Copyright (C) 2015 Red Hat, Inc.
3  * All Rights Reserved.
4  *
5  * Authors:
6  *    Dave Airlie <airlied@redhat.com>
7  *    Gerd Hoffmann <kraxel@redhat.com>
8  *
9  * Permission is hereby granted, free of charge, to any person obtaining a
10  * copy of this software and associated documentation files (the "Software"),
11  * to deal in the Software without restriction, including without limitation
12  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
13  * and/or sell copies of the Software, and to permit persons to whom the
14  * Software is furnished to do so, subject to the following conditions:
15  *
16  * The above copyright notice and this permission notice (including the next
17  * paragraph) shall be included in all copies or substantial portions of the
18  * Software.
19  *
20  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
21  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
22  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
23  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
24  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
25  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
26  * OTHER DEALINGS IN THE SOFTWARE.
27  */
28 
29 #include <linux/dma-mapping.h>
30 #include <linux/virtio.h>
31 #include <linux/virtio_config.h>
32 #include <linux/virtio_ring.h>
33 
34 #include <drm/drm_edid.h>
35 #include <drm/drm_print.h>
36 
37 #include "virtgpu_drv.h"
38 #include "virtgpu_trace.h"
39 
40 #define MAX_INLINE_CMD_SIZE   96
41 #define MAX_INLINE_RESP_SIZE  24
42 #define VBUFFER_SIZE          (sizeof(struct virtio_gpu_vbuffer) \
43 			       + MAX_INLINE_CMD_SIZE		 \
44 			       + MAX_INLINE_RESP_SIZE)
45 
46 static void convert_to_hw_box(struct virtio_gpu_box *dst,
47 			      const struct drm_virtgpu_3d_box *src)
48 {
49 	dst->x = cpu_to_le32(src->x);
50 	dst->y = cpu_to_le32(src->y);
51 	dst->z = cpu_to_le32(src->z);
52 	dst->w = cpu_to_le32(src->w);
53 	dst->h = cpu_to_le32(src->h);
54 	dst->d = cpu_to_le32(src->d);
55 }
56 
57 void virtio_gpu_ctrl_ack(struct virtqueue *vq)
58 {
59 	struct drm_device *dev = vq->vdev->priv;
60 	struct virtio_gpu_device *vgdev = dev->dev_private;
61 
62 	schedule_work(&vgdev->ctrlq.dequeue_work);
63 }
64 
65 void virtio_gpu_cursor_ack(struct virtqueue *vq)
66 {
67 	struct drm_device *dev = vq->vdev->priv;
68 	struct virtio_gpu_device *vgdev = dev->dev_private;
69 
70 	schedule_work(&vgdev->cursorq.dequeue_work);
71 }
72 
73 int virtio_gpu_alloc_vbufs(struct virtio_gpu_device *vgdev)
74 {
75 	vgdev->vbufs = kmem_cache_create("virtio-gpu-vbufs",
76 					 VBUFFER_SIZE,
77 					 __alignof__(struct virtio_gpu_vbuffer),
78 					 0, NULL);
79 	if (!vgdev->vbufs)
80 		return -ENOMEM;
81 	return 0;
82 }
83 
84 void virtio_gpu_free_vbufs(struct virtio_gpu_device *vgdev)
85 {
86 	kmem_cache_destroy(vgdev->vbufs);
87 	vgdev->vbufs = NULL;
88 }
89 
90 /* For drm_panic */
91 static struct virtio_gpu_vbuffer*
92 virtio_gpu_panic_get_vbuf(struct virtio_gpu_device *vgdev, int size)
93 {
94 	struct virtio_gpu_vbuffer *vbuf;
95 
96 	vbuf = kmem_cache_zalloc(vgdev->vbufs, GFP_ATOMIC);
97 
98 	vbuf->buf = (void *)vbuf + sizeof(*vbuf);
99 	vbuf->size = size;
100 	vbuf->resp_cb = NULL;
101 	vbuf->resp_size = sizeof(struct virtio_gpu_ctrl_hdr);
102 	vbuf->resp_buf = (void *)vbuf->buf + size;
103 	return vbuf;
104 }
105 
106 static struct virtio_gpu_vbuffer*
107 virtio_gpu_get_vbuf(struct virtio_gpu_device *vgdev,
108 		    int size, int resp_size, void *resp_buf,
109 		    virtio_gpu_resp_cb resp_cb)
110 {
111 	struct virtio_gpu_vbuffer *vbuf;
112 
113 	vbuf = kmem_cache_zalloc(vgdev->vbufs, GFP_KERNEL | __GFP_NOFAIL);
114 
115 	BUG_ON(size > MAX_INLINE_CMD_SIZE ||
116 	       size < sizeof(struct virtio_gpu_ctrl_hdr));
117 	vbuf->buf = (void *)vbuf + sizeof(*vbuf);
118 	vbuf->size = size;
119 
120 	vbuf->resp_cb = resp_cb;
121 	vbuf->resp_size = resp_size;
122 	if (resp_size <= MAX_INLINE_RESP_SIZE)
123 		vbuf->resp_buf = (void *)vbuf->buf + size;
124 	else
125 		vbuf->resp_buf = resp_buf;
126 	BUG_ON(!vbuf->resp_buf);
127 	return vbuf;
128 }
129 
130 static struct virtio_gpu_ctrl_hdr *
131 virtio_gpu_vbuf_ctrl_hdr(struct virtio_gpu_vbuffer *vbuf)
132 {
133 	/* this assumes a vbuf contains a command that starts with a
134 	 * virtio_gpu_ctrl_hdr, which is true for both ctrl and cursor
135 	 * virtqueues.
136 	 */
137 	return (struct virtio_gpu_ctrl_hdr *)vbuf->buf;
138 }
139 
140 static struct virtio_gpu_update_cursor*
141 virtio_gpu_alloc_cursor(struct virtio_gpu_device *vgdev,
142 			struct virtio_gpu_vbuffer **vbuffer_p)
143 {
144 	struct virtio_gpu_vbuffer *vbuf;
145 
146 	vbuf = virtio_gpu_get_vbuf
147 		(vgdev, sizeof(struct virtio_gpu_update_cursor),
148 		 0, NULL, NULL);
149 	if (IS_ERR(vbuf)) {
150 		*vbuffer_p = NULL;
151 		return ERR_CAST(vbuf);
152 	}
153 	*vbuffer_p = vbuf;
154 	return (struct virtio_gpu_update_cursor *)vbuf->buf;
155 }
156 
157 /* For drm_panic */
158 static void *virtio_gpu_panic_alloc_cmd_resp(struct virtio_gpu_device *vgdev,
159 					     struct virtio_gpu_vbuffer **vbuffer_p,
160 					     int cmd_size)
161 {
162 	struct virtio_gpu_vbuffer *vbuf;
163 
164 	vbuf = virtio_gpu_panic_get_vbuf(vgdev, cmd_size);
165 	*vbuffer_p = vbuf;
166 	return (struct virtio_gpu_command *)vbuf->buf;
167 }
168 
169 static void *virtio_gpu_alloc_cmd_resp(struct virtio_gpu_device *vgdev,
170 				       virtio_gpu_resp_cb cb,
171 				       struct virtio_gpu_vbuffer **vbuffer_p,
172 				       int cmd_size, int resp_size,
173 				       void *resp_buf)
174 {
175 	struct virtio_gpu_vbuffer *vbuf;
176 
177 	vbuf = virtio_gpu_get_vbuf(vgdev, cmd_size,
178 				   resp_size, resp_buf, cb);
179 	*vbuffer_p = vbuf;
180 	return (struct virtio_gpu_command *)vbuf->buf;
181 }
182 
183 static void *virtio_gpu_alloc_cmd(struct virtio_gpu_device *vgdev,
184 				  struct virtio_gpu_vbuffer **vbuffer_p,
185 				  int size)
186 {
187 	return virtio_gpu_alloc_cmd_resp(vgdev, NULL, vbuffer_p, size,
188 					 sizeof(struct virtio_gpu_ctrl_hdr),
189 					 NULL);
190 }
191 
192 static void *virtio_gpu_alloc_cmd_cb(struct virtio_gpu_device *vgdev,
193 				     struct virtio_gpu_vbuffer **vbuffer_p,
194 				     int size,
195 				     virtio_gpu_resp_cb cb)
196 {
197 	return virtio_gpu_alloc_cmd_resp(vgdev, cb, vbuffer_p, size,
198 					 sizeof(struct virtio_gpu_ctrl_hdr),
199 					 NULL);
200 }
201 
202 static void free_vbuf(struct virtio_gpu_device *vgdev,
203 		      struct virtio_gpu_vbuffer *vbuf)
204 {
205 	if (vbuf->resp_size > MAX_INLINE_RESP_SIZE)
206 		kfree(vbuf->resp_buf);
207 	kvfree(vbuf->data_buf);
208 	kmem_cache_free(vgdev->vbufs, vbuf);
209 }
210 
211 void virtio_gpu_reclaim_vbufs(struct virtio_gpu_device *vgdev)
212 {
213 	struct virtio_gpu_vbuffer *vbuf;
214 
215 	while ((vbuf = virtqueue_detach_unused_buf(vgdev->ctrlq.vq))) {
216 		if (vbuf->objs)
217 			virtio_gpu_array_put_free(vbuf->objs);
218 		if (vbuf->resp_cb_data)
219 			virtio_gpu_cleanup_object(vbuf->resp_cb_data);
220 		free_vbuf(vgdev, vbuf);
221 	}
222 	while ((vbuf = virtqueue_detach_unused_buf(vgdev->cursorq.vq)))
223 		free_vbuf(vgdev, vbuf);
224 }
225 
226 static void reclaim_vbufs(struct virtqueue *vq, struct list_head *reclaim_list)
227 {
228 	struct virtio_gpu_vbuffer *vbuf;
229 	unsigned int len;
230 	int freed = 0;
231 
232 	while ((vbuf = virtqueue_get_buf(vq, &len))) {
233 		list_add_tail(&vbuf->list, reclaim_list);
234 		freed++;
235 	}
236 	if (freed == 0)
237 		DRM_DEBUG("Huh? zero vbufs reclaimed");
238 }
239 
240 void virtio_gpu_dequeue_ctrl_func(struct work_struct *work)
241 {
242 	struct virtio_gpu_device *vgdev =
243 		container_of(work, struct virtio_gpu_device,
244 			     ctrlq.dequeue_work);
245 	struct list_head reclaim_list;
246 	struct virtio_gpu_vbuffer *entry, *tmp;
247 	struct virtio_gpu_ctrl_hdr *resp;
248 	u64 fence_id;
249 
250 	INIT_LIST_HEAD(&reclaim_list);
251 	spin_lock(&vgdev->ctrlq.qlock);
252 	do {
253 		virtqueue_disable_cb(vgdev->ctrlq.vq);
254 		reclaim_vbufs(vgdev->ctrlq.vq, &reclaim_list);
255 
256 	} while (!virtqueue_enable_cb(vgdev->ctrlq.vq));
257 	spin_unlock(&vgdev->ctrlq.qlock);
258 
259 	list_for_each_entry(entry, &reclaim_list, list) {
260 		resp = (struct virtio_gpu_ctrl_hdr *)entry->resp_buf;
261 
262 		trace_virtio_gpu_cmd_response(vgdev->ctrlq.vq, resp, entry->seqno);
263 
264 		if (resp->type != cpu_to_le32(VIRTIO_GPU_RESP_OK_NODATA)) {
265 			if (le32_to_cpu(resp->type) >= VIRTIO_GPU_RESP_ERR_UNSPEC) {
266 				struct virtio_gpu_ctrl_hdr *cmd;
267 
268 				cmd = virtio_gpu_vbuf_ctrl_hdr(entry);
269 				DRM_ERROR_RATELIMITED("response 0x%x (command 0x%x)\n",
270 						      le32_to_cpu(resp->type),
271 						      le32_to_cpu(cmd->type));
272 			} else
273 				DRM_DEBUG("response 0x%x\n", le32_to_cpu(resp->type));
274 		}
275 		if (resp->flags & cpu_to_le32(VIRTIO_GPU_FLAG_FENCE)) {
276 			fence_id = le64_to_cpu(resp->fence_id);
277 			virtio_gpu_fence_event_process(vgdev, fence_id);
278 		}
279 		if (entry->resp_cb)
280 			entry->resp_cb(vgdev, entry);
281 	}
282 	wake_up(&vgdev->ctrlq.ack_queue);
283 
284 	list_for_each_entry_safe(entry, tmp, &reclaim_list, list) {
285 		if (entry->objs)
286 			virtio_gpu_array_put_free_delayed(vgdev, entry->objs);
287 		list_del(&entry->list);
288 		free_vbuf(vgdev, entry);
289 	}
290 }
291 
292 void virtio_gpu_dequeue_cursor_func(struct work_struct *work)
293 {
294 	struct virtio_gpu_device *vgdev =
295 		container_of(work, struct virtio_gpu_device,
296 			     cursorq.dequeue_work);
297 	struct list_head reclaim_list;
298 	struct virtio_gpu_vbuffer *entry, *tmp;
299 
300 	INIT_LIST_HEAD(&reclaim_list);
301 	spin_lock(&vgdev->cursorq.qlock);
302 	do {
303 		virtqueue_disable_cb(vgdev->cursorq.vq);
304 		reclaim_vbufs(vgdev->cursorq.vq, &reclaim_list);
305 	} while (!virtqueue_enable_cb(vgdev->cursorq.vq));
306 	spin_unlock(&vgdev->cursorq.qlock);
307 
308 	list_for_each_entry_safe(entry, tmp, &reclaim_list, list) {
309 		struct virtio_gpu_ctrl_hdr *resp =
310 			(struct virtio_gpu_ctrl_hdr *)entry->resp_buf;
311 
312 		trace_virtio_gpu_cmd_response(vgdev->cursorq.vq, resp, entry->seqno);
313 		list_del(&entry->list);
314 		free_vbuf(vgdev, entry);
315 	}
316 	wake_up(&vgdev->cursorq.ack_queue);
317 }
318 
319 /* Create sg_table from a vmalloc'd buffer. */
320 static struct sg_table *vmalloc_to_sgt(char *data, uint32_t size, int *sg_ents)
321 {
322 	int ret, s, i;
323 	struct sg_table *sgt;
324 	struct scatterlist *sg;
325 	struct page *pg;
326 
327 	if (WARN_ON(!PAGE_ALIGNED(data)))
328 		return NULL;
329 
330 	sgt = kmalloc_obj(*sgt);
331 	if (!sgt)
332 		return NULL;
333 
334 	*sg_ents = DIV_ROUND_UP(size, PAGE_SIZE);
335 	ret = sg_alloc_table(sgt, *sg_ents, GFP_KERNEL);
336 	if (ret) {
337 		kfree(sgt);
338 		return NULL;
339 	}
340 
341 	for_each_sgtable_sg(sgt, sg, i) {
342 		pg = vmalloc_to_page(data);
343 		if (!pg) {
344 			sg_free_table(sgt);
345 			kfree(sgt);
346 			return NULL;
347 		}
348 
349 		s = min_t(int, PAGE_SIZE, size);
350 		sg_set_page(sg, pg, s, 0);
351 
352 		size -= s;
353 		data += s;
354 	}
355 
356 	return sgt;
357 }
358 
359 /* For drm_panic */
360 static int virtio_gpu_panic_queue_ctrl_sgs(struct virtio_gpu_device *vgdev,
361 					   struct virtio_gpu_vbuffer *vbuf,
362 					   int elemcnt,
363 					   struct scatterlist **sgs,
364 					   int outcnt,
365 					   int incnt)
366 {
367 	struct virtqueue *vq = vgdev->ctrlq.vq;
368 	int ret;
369 
370 	if (vgdev->has_indirect)
371 		elemcnt = 1;
372 
373 	if (vq->num_free < elemcnt)
374 		return -ENOMEM;
375 
376 	ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC);
377 	WARN_ON(ret);
378 
379 	vbuf->seqno = ++vgdev->ctrlq.seqno;
380 	trace_virtio_gpu_cmd_queue(vq, virtio_gpu_vbuf_ctrl_hdr(vbuf), vbuf->seqno);
381 
382 	atomic_inc(&vgdev->pending_commands);
383 
384 	return 0;
385 }
386 
387 int virtio_gpu_wait_queue(struct virtio_gpu_queue *vgvq, unsigned int num_elem)
388 {
389 	int ret;
390 
391 	/* Wait up to 5 seconds for enough free slots to become available */
392 	ret = wait_event_timeout(vgvq->ack_queue,
393 				 vgvq->vq->num_free >= num_elem,
394 				 5 * HZ);
395 	if (ret == 0)
396 		return -ETIMEDOUT;
397 
398 	return 0;
399 }
400 
401 static int virtio_gpu_queue_ctrl_sgs(struct virtio_gpu_device *vgdev,
402 				     struct virtio_gpu_vbuffer *vbuf,
403 				     struct virtio_gpu_fence *fence,
404 				     int elemcnt,
405 				     struct scatterlist **sgs,
406 				     int outcnt,
407 				     int incnt)
408 {
409 	struct virtqueue *vq = vgdev->ctrlq.vq;
410 	int ret, idx;
411 
412 	if (!drm_dev_enter(vgdev->ddev, &idx)) {
413 		if (fence && vbuf->objs)
414 			virtio_gpu_array_unlock_resv(vbuf->objs);
415 		free_vbuf(vgdev, vbuf);
416 		return -ENODEV;
417 	}
418 
419 	if (vgdev->has_indirect)
420 		elemcnt = 1;
421 
422 again:
423 	spin_lock(&vgdev->ctrlq.qlock);
424 
425 	if (vq->num_free < elemcnt) {
426 		spin_unlock(&vgdev->ctrlq.qlock);
427 		virtio_gpu_notify(vgdev);
428 		wait_event(vgdev->ctrlq.ack_queue,
429 			   vq->num_free >= elemcnt || vgdev->vqs_released);
430 		/*
431 		 * Set by virtio_gpu_release_vqs() to unblock
432 		 * synchronize_srcu() wait in drm_dev_unplug().
433 		 */
434 		if (vgdev->vqs_released) {
435 			if (fence && vbuf->objs)
436 				virtio_gpu_array_unlock_resv(vbuf->objs);
437 			free_vbuf(vgdev, vbuf);
438 			drm_dev_exit(idx);
439 			return -ENODEV;
440 		}
441 		goto again;
442 	}
443 
444 	/* now that the position of the vbuf in the virtqueue is known, we can
445 	 * finally set the fence id
446 	 */
447 	if (fence) {
448 		virtio_gpu_fence_emit(vgdev, virtio_gpu_vbuf_ctrl_hdr(vbuf),
449 				      fence);
450 		if (vbuf->objs) {
451 			virtio_gpu_array_add_fence(vbuf->objs, &fence->f);
452 			virtio_gpu_array_unlock_resv(vbuf->objs);
453 		}
454 	}
455 
456 	ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC);
457 	WARN_ON(ret);
458 
459 	vbuf->seqno = ++vgdev->ctrlq.seqno;
460 	trace_virtio_gpu_cmd_queue(vq, virtio_gpu_vbuf_ctrl_hdr(vbuf), vbuf->seqno);
461 
462 	atomic_inc(&vgdev->pending_commands);
463 
464 	spin_unlock(&vgdev->ctrlq.qlock);
465 
466 	drm_dev_exit(idx);
467 	return 0;
468 }
469 
470 /* For drm_panic */
471 static int virtio_gpu_panic_queue_ctrl_buffer(struct virtio_gpu_device *vgdev,
472 					      struct virtio_gpu_vbuffer *vbuf)
473 {
474 	struct scatterlist *sgs[3], vcmd, vresp;
475 	int elemcnt = 0, outcnt = 0, incnt = 0;
476 
477 	/* set up vcmd */
478 	sg_init_one(&vcmd, vbuf->buf, vbuf->size);
479 	elemcnt++;
480 	sgs[outcnt] = &vcmd;
481 	outcnt++;
482 
483 	/* set up vresp */
484 	if (vbuf->resp_size) {
485 		sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size);
486 		elemcnt++;
487 		sgs[outcnt + incnt] = &vresp;
488 		incnt++;
489 	}
490 
491 	return virtio_gpu_panic_queue_ctrl_sgs(vgdev, vbuf,
492 					       elemcnt, sgs,
493 					       outcnt, incnt);
494 }
495 
496 static int virtio_gpu_queue_fenced_ctrl_buffer(struct virtio_gpu_device *vgdev,
497 					       struct virtio_gpu_vbuffer *vbuf,
498 					       struct virtio_gpu_fence *fence)
499 {
500 	struct scatterlist *sgs[3], vcmd, vout, vresp;
501 	struct sg_table *sgt = NULL;
502 	int elemcnt = 0, outcnt = 0, incnt = 0, ret;
503 
504 	/* set up vcmd */
505 	sg_init_one(&vcmd, vbuf->buf, vbuf->size);
506 	elemcnt++;
507 	sgs[outcnt] = &vcmd;
508 	outcnt++;
509 
510 	/* set up vout */
511 	if (vbuf->data_size) {
512 		if (is_vmalloc_addr(vbuf->data_buf)) {
513 			int sg_ents;
514 
515 			sgt = vmalloc_to_sgt(vbuf->data_buf, vbuf->data_size,
516 					     &sg_ents);
517 			if (!sgt) {
518 				if (fence && vbuf->objs)
519 					virtio_gpu_array_unlock_resv(vbuf->objs);
520 				return -ENOMEM;
521 			}
522 
523 			elemcnt += sg_ents;
524 			sgs[outcnt] = sgt->sgl;
525 		} else {
526 			sg_init_one(&vout, vbuf->data_buf, vbuf->data_size);
527 			elemcnt++;
528 			sgs[outcnt] = &vout;
529 		}
530 		outcnt++;
531 	}
532 
533 	/* set up vresp */
534 	if (vbuf->resp_size) {
535 		sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size);
536 		elemcnt++;
537 		sgs[outcnt + incnt] = &vresp;
538 		incnt++;
539 	}
540 
541 	ret = virtio_gpu_queue_ctrl_sgs(vgdev, vbuf, fence, elemcnt, sgs, outcnt,
542 					incnt);
543 
544 	if (sgt) {
545 		sg_free_table(sgt);
546 		kfree(sgt);
547 	}
548 	return ret;
549 }
550 
551 /* For drm_panic */
552 void virtio_gpu_panic_notify(struct virtio_gpu_device *vgdev)
553 {
554 	bool notify;
555 
556 	if (!atomic_read(&vgdev->pending_commands))
557 		return;
558 
559 	atomic_set(&vgdev->pending_commands, 0);
560 	notify = virtqueue_kick_prepare(vgdev->ctrlq.vq);
561 
562 	if (notify)
563 		virtqueue_notify(vgdev->ctrlq.vq);
564 }
565 
566 void virtio_gpu_notify(struct virtio_gpu_device *vgdev)
567 {
568 	bool notify;
569 
570 	if (!atomic_read(&vgdev->pending_commands))
571 		return;
572 
573 	spin_lock(&vgdev->ctrlq.qlock);
574 	atomic_set(&vgdev->pending_commands, 0);
575 	notify = virtqueue_kick_prepare(vgdev->ctrlq.vq);
576 	spin_unlock(&vgdev->ctrlq.qlock);
577 
578 	if (notify)
579 		virtqueue_notify(vgdev->ctrlq.vq);
580 }
581 
582 static int virtio_gpu_queue_ctrl_buffer(struct virtio_gpu_device *vgdev,
583 					struct virtio_gpu_vbuffer *vbuf)
584 {
585 	return virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, NULL);
586 }
587 
588 static void virtio_gpu_queue_cursor(struct virtio_gpu_device *vgdev,
589 				    struct virtio_gpu_vbuffer *vbuf)
590 {
591 	struct virtqueue *vq = vgdev->cursorq.vq;
592 	struct scatterlist *sgs[1], ccmd;
593 	int idx, ret, outcnt;
594 	bool notify;
595 
596 	if (!drm_dev_enter(vgdev->ddev, &idx)) {
597 		free_vbuf(vgdev, vbuf);
598 		return;
599 	}
600 
601 	sg_init_one(&ccmd, vbuf->buf, vbuf->size);
602 	sgs[0] = &ccmd;
603 	outcnt = 1;
604 
605 	spin_lock(&vgdev->cursorq.qlock);
606 retry:
607 	ret = virtqueue_add_sgs(vq, sgs, outcnt, 0, vbuf, GFP_ATOMIC);
608 	if (ret == -ENOSPC) {
609 		spin_unlock(&vgdev->cursorq.qlock);
610 		wait_event(vgdev->cursorq.ack_queue,
611 			   vq->num_free >= outcnt || vgdev->vqs_released);
612 		/* See comment in virtio_gpu_queue_ctrl_sgs(). */
613 		if (vgdev->vqs_released) {
614 			free_vbuf(vgdev, vbuf);
615 			drm_dev_exit(idx);
616 			return;
617 		}
618 		spin_lock(&vgdev->cursorq.qlock);
619 		goto retry;
620 	} else {
621 		vbuf->seqno = ++vgdev->cursorq.seqno;
622 		trace_virtio_gpu_cmd_queue(vq,
623 			virtio_gpu_vbuf_ctrl_hdr(vbuf),
624 			vbuf->seqno);
625 
626 		notify = virtqueue_kick_prepare(vq);
627 	}
628 
629 	spin_unlock(&vgdev->cursorq.qlock);
630 
631 	if (notify)
632 		virtqueue_notify(vq);
633 
634 	drm_dev_exit(idx);
635 }
636 
637 /* just create gem objects for userspace and long lived objects,
638  * just use dma_alloced pages for the queue objects?
639  */
640 
641 /* create a basic resource */
642 void virtio_gpu_cmd_create_resource(struct virtio_gpu_device *vgdev,
643 				    struct virtio_gpu_object *bo,
644 				    struct virtio_gpu_object_params *params,
645 				    struct virtio_gpu_object_array *objs,
646 				    struct virtio_gpu_fence *fence)
647 {
648 	struct virtio_gpu_resource_create_2d *cmd_p;
649 	struct virtio_gpu_vbuffer *vbuf;
650 
651 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
652 	memset(cmd_p, 0, sizeof(*cmd_p));
653 	vbuf->objs = objs;
654 
655 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_2D);
656 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
657 	cmd_p->format = cpu_to_le32(params->format);
658 	cmd_p->width = cpu_to_le32(params->width);
659 	cmd_p->height = cpu_to_le32(params->height);
660 
661 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
662 	bo->created = true;
663 }
664 
665 static void virtio_gpu_cmd_unref_cb(struct virtio_gpu_device *vgdev,
666 				    struct virtio_gpu_vbuffer *vbuf)
667 {
668 	struct virtio_gpu_object *bo;
669 
670 	bo = vbuf->resp_cb_data;
671 	vbuf->resp_cb_data = NULL;
672 
673 	virtio_gpu_cleanup_object(bo);
674 }
675 
676 void virtio_gpu_cmd_unref_resource(struct virtio_gpu_device *vgdev,
677 				   struct virtio_gpu_object *bo,
678 				   bool no_cb)
679 {
680 	struct virtio_gpu_resource_unref *cmd_p;
681 	struct virtio_gpu_vbuffer *vbuf;
682 	int ret;
683 
684 	if (no_cb) {
685 		cmd_p = virtio_gpu_alloc_cmd_cb(vgdev, &vbuf, sizeof(*cmd_p),
686 						NULL);
687 	} else {
688 		cmd_p = virtio_gpu_alloc_cmd_cb(vgdev, &vbuf, sizeof(*cmd_p),
689 						virtio_gpu_cmd_unref_cb);
690 	}
691 
692 	memset(cmd_p, 0, sizeof(*cmd_p));
693 
694 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNREF);
695 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
696 
697 	vbuf->resp_cb_data = bo;
698 	ret = virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
699 	if (ret < 0)
700 		virtio_gpu_cleanup_object(bo);
701 }
702 
703 void virtio_gpu_cmd_set_scanout(struct virtio_gpu_device *vgdev,
704 				uint32_t scanout_id, uint32_t resource_id,
705 				uint32_t width, uint32_t height,
706 				uint32_t x, uint32_t y)
707 {
708 	struct virtio_gpu_set_scanout *cmd_p;
709 	struct virtio_gpu_vbuffer *vbuf;
710 
711 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
712 	memset(cmd_p, 0, sizeof(*cmd_p));
713 
714 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT);
715 	cmd_p->resource_id = cpu_to_le32(resource_id);
716 	cmd_p->scanout_id = cpu_to_le32(scanout_id);
717 	cmd_p->r.width = cpu_to_le32(width);
718 	cmd_p->r.height = cpu_to_le32(height);
719 	cmd_p->r.x = cpu_to_le32(x);
720 	cmd_p->r.y = cpu_to_le32(y);
721 
722 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
723 }
724 
725 /* For drm_panic */
726 void virtio_gpu_panic_cmd_resource_flush(struct virtio_gpu_device *vgdev,
727 					  uint32_t resource_id,
728 					  uint32_t x, uint32_t y,
729 					  uint32_t width, uint32_t height)
730 {
731 	struct virtio_gpu_resource_flush *cmd_p;
732 	struct virtio_gpu_vbuffer *vbuf;
733 
734 	cmd_p = virtio_gpu_panic_alloc_cmd_resp(vgdev, &vbuf, sizeof(*cmd_p));
735 	memset(cmd_p, 0, sizeof(*cmd_p));
736 	vbuf->objs = NULL;
737 
738 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_FLUSH);
739 	cmd_p->resource_id = cpu_to_le32(resource_id);
740 	cmd_p->r.width = cpu_to_le32(width);
741 	cmd_p->r.height = cpu_to_le32(height);
742 	cmd_p->r.x = cpu_to_le32(x);
743 	cmd_p->r.y = cpu_to_le32(y);
744 
745 	virtio_gpu_panic_queue_ctrl_buffer(vgdev, vbuf);
746 }
747 
748 void virtio_gpu_cmd_resource_flush(struct virtio_gpu_device *vgdev,
749 				   uint32_t resource_id,
750 				   uint32_t x, uint32_t y,
751 				   uint32_t width, uint32_t height,
752 				   struct virtio_gpu_object_array *objs,
753 				   struct virtio_gpu_fence *fence)
754 {
755 	struct virtio_gpu_resource_flush *cmd_p;
756 	struct virtio_gpu_vbuffer *vbuf;
757 
758 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
759 	memset(cmd_p, 0, sizeof(*cmd_p));
760 	vbuf->objs = objs;
761 
762 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_FLUSH);
763 	cmd_p->resource_id = cpu_to_le32(resource_id);
764 	cmd_p->r.width = cpu_to_le32(width);
765 	cmd_p->r.height = cpu_to_le32(height);
766 	cmd_p->r.x = cpu_to_le32(x);
767 	cmd_p->r.y = cpu_to_le32(y);
768 
769 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
770 }
771 
772 /* For drm_panic */
773 int virtio_gpu_panic_cmd_transfer_to_host_2d(struct virtio_gpu_device *vgdev,
774 					     uint64_t offset,
775 					     uint32_t width, uint32_t height,
776 					     uint32_t x, uint32_t y,
777 					     struct virtio_gpu_object_array *objs)
778 {
779 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
780 	struct virtio_gpu_transfer_to_host_2d *cmd_p;
781 	struct virtio_gpu_vbuffer *vbuf;
782 	bool use_dma_api = virtio_gpu_use_dma_api(vgdev->vdev);
783 
784 	if (virtio_gpu_is_shmem(bo) && use_dma_api)
785 		dma_sync_sgtable_for_device(vgdev->vdev->dev.parent,
786 					    bo->base.sgt, DMA_TO_DEVICE);
787 
788 	cmd_p = virtio_gpu_panic_alloc_cmd_resp(vgdev, &vbuf, sizeof(*cmd_p));
789 	memset(cmd_p, 0, sizeof(*cmd_p));
790 	vbuf->objs = objs;
791 
792 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D);
793 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
794 	cmd_p->offset = cpu_to_le64(offset);
795 	cmd_p->r.width = cpu_to_le32(width);
796 	cmd_p->r.height = cpu_to_le32(height);
797 	cmd_p->r.x = cpu_to_le32(x);
798 	cmd_p->r.y = cpu_to_le32(y);
799 
800 	return virtio_gpu_panic_queue_ctrl_buffer(vgdev, vbuf);
801 }
802 
803 void virtio_gpu_cmd_transfer_to_host_2d(struct virtio_gpu_device *vgdev,
804 					uint64_t offset,
805 					uint32_t width, uint32_t height,
806 					uint32_t x, uint32_t y,
807 					struct virtio_gpu_object_array *objs,
808 					struct virtio_gpu_fence *fence)
809 {
810 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
811 	struct virtio_gpu_transfer_to_host_2d *cmd_p;
812 	struct virtio_gpu_vbuffer *vbuf;
813 	bool use_dma_api = virtio_gpu_use_dma_api(vgdev->vdev);
814 
815 	if (virtio_gpu_is_shmem(bo) && use_dma_api)
816 		dma_sync_sgtable_for_device(vgdev->vdev->dev.parent,
817 					    bo->base.sgt, DMA_TO_DEVICE);
818 
819 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
820 	memset(cmd_p, 0, sizeof(*cmd_p));
821 	vbuf->objs = objs;
822 
823 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D);
824 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
825 	cmd_p->offset = cpu_to_le64(offset);
826 	cmd_p->r.width = cpu_to_le32(width);
827 	cmd_p->r.height = cpu_to_le32(height);
828 	cmd_p->r.x = cpu_to_le32(x);
829 	cmd_p->r.y = cpu_to_le32(y);
830 
831 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
832 }
833 
834 static void
835 virtio_gpu_cmd_resource_attach_backing(struct virtio_gpu_device *vgdev,
836 				       uint32_t resource_id,
837 				       struct virtio_gpu_mem_entry *ents,
838 				       uint32_t nents,
839 				       struct virtio_gpu_fence *fence)
840 {
841 	struct virtio_gpu_resource_attach_backing *cmd_p;
842 	struct virtio_gpu_vbuffer *vbuf;
843 
844 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
845 	memset(cmd_p, 0, sizeof(*cmd_p));
846 
847 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ATTACH_BACKING);
848 	cmd_p->resource_id = cpu_to_le32(resource_id);
849 	cmd_p->nr_entries = cpu_to_le32(nents);
850 
851 	vbuf->data_buf = ents;
852 	vbuf->data_size = sizeof(*ents) * nents;
853 
854 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
855 }
856 
857 static void
858 virtio_gpu_cmd_resource_detach_backing(struct virtio_gpu_device *vgdev,
859 				       uint32_t resource_id,
860 				       struct virtio_gpu_fence *fence)
861 {
862 	struct virtio_gpu_resource_detach_backing *cmd_p;
863 	struct virtio_gpu_vbuffer *vbuf;
864 
865 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
866 	memset(cmd_p, 0, sizeof(*cmd_p));
867 
868 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_DETACH_BACKING);
869 	cmd_p->resource_id = cpu_to_le32(resource_id);
870 
871 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
872 }
873 
874 static void virtio_gpu_cmd_get_display_info_cb(struct virtio_gpu_device *vgdev,
875 					       struct virtio_gpu_vbuffer *vbuf)
876 {
877 	struct virtio_gpu_resp_display_info *resp =
878 		(struct virtio_gpu_resp_display_info *)vbuf->resp_buf;
879 	int i;
880 
881 	spin_lock(&vgdev->display_info_lock);
882 	for (i = 0; i < vgdev->num_scanouts; i++) {
883 		vgdev->outputs[i].info = resp->pmodes[i];
884 		if (resp->pmodes[i].enabled) {
885 			DRM_DEBUG("output %d: %dx%d+%d+%d", i,
886 				  le32_to_cpu(resp->pmodes[i].r.width),
887 				  le32_to_cpu(resp->pmodes[i].r.height),
888 				  le32_to_cpu(resp->pmodes[i].r.x),
889 				  le32_to_cpu(resp->pmodes[i].r.y));
890 		} else {
891 			DRM_DEBUG("output %d: disabled", i);
892 		}
893 	}
894 
895 	vgdev->display_info_pending = false;
896 	spin_unlock(&vgdev->display_info_lock);
897 	wake_up(&vgdev->resp_wq);
898 }
899 
900 static void virtio_gpu_cmd_get_capset_info_cb(struct virtio_gpu_device *vgdev,
901 					      struct virtio_gpu_vbuffer *vbuf)
902 {
903 	struct virtio_gpu_get_capset_info *cmd =
904 		(struct virtio_gpu_get_capset_info *)vbuf->buf;
905 	struct virtio_gpu_resp_capset_info *resp =
906 		(struct virtio_gpu_resp_capset_info *)vbuf->resp_buf;
907 	int i = le32_to_cpu(cmd->capset_index);
908 
909 	spin_lock(&vgdev->display_info_lock);
910 	if (vgdev->capsets) {
911 		vgdev->capsets[i].id = le32_to_cpu(resp->capset_id);
912 		vgdev->capsets[i].max_version = le32_to_cpu(resp->capset_max_version);
913 		vgdev->capsets[i].max_size = le32_to_cpu(resp->capset_max_size);
914 	} else {
915 		DRM_ERROR("invalid capset memory.");
916 	}
917 	spin_unlock(&vgdev->display_info_lock);
918 	wake_up(&vgdev->resp_wq);
919 }
920 
921 static void virtio_gpu_cmd_capset_cb(struct virtio_gpu_device *vgdev,
922 				     struct virtio_gpu_vbuffer *vbuf)
923 {
924 	struct virtio_gpu_get_capset *cmd =
925 		(struct virtio_gpu_get_capset *)vbuf->buf;
926 	struct virtio_gpu_resp_capset *resp =
927 		(struct virtio_gpu_resp_capset *)vbuf->resp_buf;
928 	struct virtio_gpu_drv_cap_cache *cache_ent;
929 
930 	spin_lock(&vgdev->display_info_lock);
931 	list_for_each_entry(cache_ent, &vgdev->cap_cache, head) {
932 		if (cache_ent->version == le32_to_cpu(cmd->capset_version) &&
933 		    cache_ent->id == le32_to_cpu(cmd->capset_id)) {
934 			memcpy(cache_ent->caps_cache, resp->capset_data,
935 			       cache_ent->size);
936 			/* Copy must occur before is_valid is signalled. */
937 			smp_wmb();
938 			atomic_set(&cache_ent->is_valid, 1);
939 			break;
940 		}
941 	}
942 	spin_unlock(&vgdev->display_info_lock);
943 	wake_up_all(&vgdev->resp_wq);
944 }
945 
946 static int virtio_get_edid_block(void *data, u8 *buf,
947 				 unsigned int block, size_t len)
948 {
949 	struct virtio_gpu_resp_edid *resp = data;
950 	size_t start = block * EDID_LENGTH;
951 
952 	if (start + len > le32_to_cpu(resp->size) ||
953 	    start + len > sizeof(resp->edid))
954 		return -EINVAL;
955 	memcpy(buf, resp->edid + start, len);
956 	return 0;
957 }
958 
959 static void virtio_gpu_cmd_get_edid_cb(struct virtio_gpu_device *vgdev,
960 				       struct virtio_gpu_vbuffer *vbuf)
961 {
962 	struct virtio_gpu_cmd_get_edid *cmd =
963 		(struct virtio_gpu_cmd_get_edid *)vbuf->buf;
964 	struct virtio_gpu_resp_edid *resp =
965 		(struct virtio_gpu_resp_edid *)vbuf->resp_buf;
966 	uint32_t scanout = le32_to_cpu(cmd->scanout);
967 	struct virtio_gpu_output *output;
968 	const struct drm_edid *new_edid, *old_edid;
969 
970 	if (scanout >= vgdev->num_scanouts)
971 		return;
972 	output = vgdev->outputs + scanout;
973 
974 	new_edid = drm_edid_read_custom(&output->conn, virtio_get_edid_block, resp);
975 	drm_edid_connector_update(&output->conn, new_edid);
976 
977 	spin_lock(&vgdev->display_info_lock);
978 	old_edid = output->drm_edid;
979 	output->drm_edid = new_edid;
980 	spin_unlock(&vgdev->display_info_lock);
981 
982 	drm_edid_free(old_edid);
983 	wake_up(&vgdev->resp_wq);
984 }
985 
986 int virtio_gpu_cmd_get_display_info(struct virtio_gpu_device *vgdev)
987 {
988 	struct virtio_gpu_ctrl_hdr *cmd_p;
989 	struct virtio_gpu_vbuffer *vbuf;
990 	void *resp_buf;
991 
992 	resp_buf = kzalloc_obj(struct virtio_gpu_resp_display_info);
993 	if (!resp_buf)
994 		return -ENOMEM;
995 
996 	cmd_p = virtio_gpu_alloc_cmd_resp
997 		(vgdev, &virtio_gpu_cmd_get_display_info_cb, &vbuf,
998 		 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_display_info),
999 		 resp_buf);
1000 	memset(cmd_p, 0, sizeof(*cmd_p));
1001 
1002 	vgdev->display_info_pending = true;
1003 	cmd_p->type = cpu_to_le32(VIRTIO_GPU_CMD_GET_DISPLAY_INFO);
1004 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1005 	return 0;
1006 }
1007 
1008 int virtio_gpu_cmd_get_capset_info(struct virtio_gpu_device *vgdev, int idx)
1009 {
1010 	struct virtio_gpu_get_capset_info *cmd_p;
1011 	struct virtio_gpu_vbuffer *vbuf;
1012 	void *resp_buf;
1013 
1014 	resp_buf = kzalloc_obj(struct virtio_gpu_resp_capset_info);
1015 	if (!resp_buf)
1016 		return -ENOMEM;
1017 
1018 	cmd_p = virtio_gpu_alloc_cmd_resp
1019 		(vgdev, &virtio_gpu_cmd_get_capset_info_cb, &vbuf,
1020 		 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_capset_info),
1021 		 resp_buf);
1022 	memset(cmd_p, 0, sizeof(*cmd_p));
1023 
1024 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET_INFO);
1025 	cmd_p->capset_index = cpu_to_le32(idx);
1026 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1027 	return 0;
1028 }
1029 
1030 int virtio_gpu_cmd_get_capset(struct virtio_gpu_device *vgdev,
1031 			      int idx, int version,
1032 			      struct virtio_gpu_drv_cap_cache **cache_p)
1033 {
1034 	struct virtio_gpu_get_capset *cmd_p;
1035 	struct virtio_gpu_vbuffer *vbuf;
1036 	int max_size;
1037 	struct virtio_gpu_drv_cap_cache *cache_ent;
1038 	struct virtio_gpu_drv_cap_cache *search_ent;
1039 	void *resp_buf;
1040 
1041 	*cache_p = NULL;
1042 
1043 	if (idx >= vgdev->num_capsets)
1044 		return -EINVAL;
1045 
1046 	if (version > vgdev->capsets[idx].max_version)
1047 		return -EINVAL;
1048 
1049 	cache_ent = kzalloc_obj(*cache_ent);
1050 	if (!cache_ent)
1051 		return -ENOMEM;
1052 
1053 	max_size = vgdev->capsets[idx].max_size;
1054 	cache_ent->caps_cache = kmalloc(max_size, GFP_KERNEL);
1055 	if (!cache_ent->caps_cache) {
1056 		kfree(cache_ent);
1057 		return -ENOMEM;
1058 	}
1059 
1060 	resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset) + max_size,
1061 			   GFP_KERNEL);
1062 	if (!resp_buf) {
1063 		kfree(cache_ent->caps_cache);
1064 		kfree(cache_ent);
1065 		return -ENOMEM;
1066 	}
1067 
1068 	cache_ent->version = version;
1069 	cache_ent->id = vgdev->capsets[idx].id;
1070 	atomic_set(&cache_ent->is_valid, 0);
1071 	cache_ent->size = max_size;
1072 	spin_lock(&vgdev->display_info_lock);
1073 	/* Search while under lock in case it was added by another task. */
1074 	list_for_each_entry(search_ent, &vgdev->cap_cache, head) {
1075 		if (search_ent->id == vgdev->capsets[idx].id &&
1076 		    search_ent->version == version) {
1077 			*cache_p = search_ent;
1078 			break;
1079 		}
1080 	}
1081 	if (!*cache_p)
1082 		list_add_tail(&cache_ent->head, &vgdev->cap_cache);
1083 	spin_unlock(&vgdev->display_info_lock);
1084 
1085 	if (*cache_p) {
1086 		/* Entry was found, so free everything that was just created. */
1087 		kfree(resp_buf);
1088 		kfree(cache_ent->caps_cache);
1089 		kfree(cache_ent);
1090 		return 0;
1091 	}
1092 
1093 	cmd_p = virtio_gpu_alloc_cmd_resp
1094 		(vgdev, &virtio_gpu_cmd_capset_cb, &vbuf, sizeof(*cmd_p),
1095 		 sizeof(struct virtio_gpu_resp_capset) + max_size,
1096 		 resp_buf);
1097 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET);
1098 	cmd_p->capset_id = cpu_to_le32(vgdev->capsets[idx].id);
1099 	cmd_p->capset_version = cpu_to_le32(version);
1100 	*cache_p = cache_ent;
1101 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1102 
1103 	return 0;
1104 }
1105 
1106 int virtio_gpu_cmd_get_edids(struct virtio_gpu_device *vgdev)
1107 {
1108 	struct virtio_gpu_cmd_get_edid *cmd_p;
1109 	struct virtio_gpu_vbuffer *vbuf;
1110 	void *resp_buf;
1111 	int scanout;
1112 
1113 	if (WARN_ON(!vgdev->has_edid))
1114 		return -EINVAL;
1115 
1116 	for (scanout = 0; scanout < vgdev->num_scanouts; scanout++) {
1117 		resp_buf = kzalloc_obj(struct virtio_gpu_resp_edid);
1118 		if (!resp_buf)
1119 			return -ENOMEM;
1120 
1121 		cmd_p = virtio_gpu_alloc_cmd_resp
1122 			(vgdev, &virtio_gpu_cmd_get_edid_cb, &vbuf,
1123 			 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_edid),
1124 			 resp_buf);
1125 		cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_EDID);
1126 		cmd_p->scanout = cpu_to_le32(scanout);
1127 		virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1128 	}
1129 
1130 	return 0;
1131 }
1132 
1133 void virtio_gpu_cmd_context_create(struct virtio_gpu_device *vgdev, uint32_t id,
1134 				   uint32_t context_init, uint32_t nlen,
1135 				   const char *name)
1136 {
1137 	struct virtio_gpu_ctx_create *cmd_p;
1138 	struct virtio_gpu_vbuffer *vbuf;
1139 
1140 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1141 	memset(cmd_p, 0, sizeof(*cmd_p));
1142 
1143 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_CREATE);
1144 	cmd_p->hdr.ctx_id = cpu_to_le32(id);
1145 	cmd_p->nlen = cpu_to_le32(nlen);
1146 	cmd_p->context_init = cpu_to_le32(context_init);
1147 	strscpy(cmd_p->debug_name, name, sizeof(cmd_p->debug_name));
1148 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1149 }
1150 
1151 void virtio_gpu_cmd_context_destroy(struct virtio_gpu_device *vgdev,
1152 				    uint32_t id)
1153 {
1154 	struct virtio_gpu_ctx_destroy *cmd_p;
1155 	struct virtio_gpu_vbuffer *vbuf;
1156 
1157 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1158 	memset(cmd_p, 0, sizeof(*cmd_p));
1159 
1160 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DESTROY);
1161 	cmd_p->hdr.ctx_id = cpu_to_le32(id);
1162 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1163 }
1164 
1165 void virtio_gpu_cmd_context_attach_resource(struct virtio_gpu_device *vgdev,
1166 					    uint32_t ctx_id,
1167 					    struct virtio_gpu_object_array *objs)
1168 {
1169 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1170 	struct virtio_gpu_ctx_resource *cmd_p;
1171 	struct virtio_gpu_vbuffer *vbuf;
1172 
1173 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1174 	memset(cmd_p, 0, sizeof(*cmd_p));
1175 	vbuf->objs = objs;
1176 
1177 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_ATTACH_RESOURCE);
1178 	cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1179 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1180 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1181 }
1182 
1183 void virtio_gpu_cmd_context_detach_resource(struct virtio_gpu_device *vgdev,
1184 					    uint32_t ctx_id,
1185 					    struct virtio_gpu_object_array *objs)
1186 {
1187 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1188 	struct virtio_gpu_ctx_resource *cmd_p;
1189 	struct virtio_gpu_vbuffer *vbuf;
1190 
1191 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1192 	memset(cmd_p, 0, sizeof(*cmd_p));
1193 	vbuf->objs = objs;
1194 
1195 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DETACH_RESOURCE);
1196 	cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1197 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1198 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1199 }
1200 
1201 void
1202 virtio_gpu_cmd_resource_create_3d(struct virtio_gpu_device *vgdev,
1203 				  struct virtio_gpu_object *bo,
1204 				  struct virtio_gpu_object_params *params,
1205 				  struct virtio_gpu_object_array *objs,
1206 				  struct virtio_gpu_fence *fence)
1207 {
1208 	struct virtio_gpu_resource_create_3d *cmd_p;
1209 	struct virtio_gpu_vbuffer *vbuf;
1210 
1211 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1212 	memset(cmd_p, 0, sizeof(*cmd_p));
1213 	vbuf->objs = objs;
1214 
1215 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_3D);
1216 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1217 	cmd_p->format = cpu_to_le32(params->format);
1218 	cmd_p->width = cpu_to_le32(params->width);
1219 	cmd_p->height = cpu_to_le32(params->height);
1220 
1221 	cmd_p->target = cpu_to_le32(params->target);
1222 	cmd_p->bind = cpu_to_le32(params->bind);
1223 	cmd_p->depth = cpu_to_le32(params->depth);
1224 	cmd_p->array_size = cpu_to_le32(params->array_size);
1225 	cmd_p->last_level = cpu_to_le32(params->last_level);
1226 	cmd_p->nr_samples = cpu_to_le32(params->nr_samples);
1227 	cmd_p->flags = cpu_to_le32(params->flags);
1228 
1229 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1230 
1231 	bo->created = true;
1232 }
1233 
1234 void virtio_gpu_cmd_transfer_to_host_3d(struct virtio_gpu_device *vgdev,
1235 					uint32_t ctx_id,
1236 					uint64_t offset, uint32_t level,
1237 					uint32_t stride,
1238 					uint32_t layer_stride,
1239 					struct drm_virtgpu_3d_box *box,
1240 					struct virtio_gpu_object_array *objs,
1241 					struct virtio_gpu_fence *fence)
1242 {
1243 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1244 	struct virtio_gpu_transfer_host_3d *cmd_p;
1245 	struct virtio_gpu_vbuffer *vbuf;
1246 	bool use_dma_api = virtio_gpu_use_dma_api(vgdev->vdev);
1247 
1248 	if (virtio_gpu_is_shmem(bo) && use_dma_api)
1249 		dma_sync_sgtable_for_device(vgdev->vdev->dev.parent,
1250 					    bo->base.sgt, DMA_TO_DEVICE);
1251 
1252 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1253 	memset(cmd_p, 0, sizeof(*cmd_p));
1254 
1255 	vbuf->objs = objs;
1256 
1257 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_3D);
1258 	cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1259 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1260 	convert_to_hw_box(&cmd_p->box, box);
1261 	cmd_p->offset = cpu_to_le64(offset);
1262 	cmd_p->level = cpu_to_le32(level);
1263 	cmd_p->stride = cpu_to_le32(stride);
1264 	cmd_p->layer_stride = cpu_to_le32(layer_stride);
1265 
1266 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1267 }
1268 
1269 void virtio_gpu_cmd_transfer_from_host_3d(struct virtio_gpu_device *vgdev,
1270 					  uint32_t ctx_id,
1271 					  uint64_t offset, uint32_t level,
1272 					  uint32_t stride,
1273 					  uint32_t layer_stride,
1274 					  struct drm_virtgpu_3d_box *box,
1275 					  struct virtio_gpu_object_array *objs,
1276 					  struct virtio_gpu_fence *fence)
1277 {
1278 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1279 	struct virtio_gpu_transfer_host_3d *cmd_p;
1280 	struct virtio_gpu_vbuffer *vbuf;
1281 
1282 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1283 	memset(cmd_p, 0, sizeof(*cmd_p));
1284 
1285 	vbuf->objs = objs;
1286 
1287 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_FROM_HOST_3D);
1288 	cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1289 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1290 	convert_to_hw_box(&cmd_p->box, box);
1291 	cmd_p->offset = cpu_to_le64(offset);
1292 	cmd_p->level = cpu_to_le32(level);
1293 	cmd_p->stride = cpu_to_le32(stride);
1294 	cmd_p->layer_stride = cpu_to_le32(layer_stride);
1295 
1296 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1297 }
1298 
1299 void virtio_gpu_cmd_submit(struct virtio_gpu_device *vgdev,
1300 			   void *data, uint32_t data_size,
1301 			   uint32_t ctx_id,
1302 			   struct virtio_gpu_object_array *objs,
1303 			   struct virtio_gpu_fence *fence)
1304 {
1305 	struct virtio_gpu_cmd_submit *cmd_p;
1306 	struct virtio_gpu_vbuffer *vbuf;
1307 
1308 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1309 	memset(cmd_p, 0, sizeof(*cmd_p));
1310 
1311 	vbuf->data_buf = data;
1312 	vbuf->data_size = data_size;
1313 	vbuf->objs = objs;
1314 
1315 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SUBMIT_3D);
1316 	cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1317 	cmd_p->size = cpu_to_le32(data_size);
1318 
1319 	virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1320 }
1321 
1322 void virtio_gpu_object_attach(struct virtio_gpu_device *vgdev,
1323 			      struct virtio_gpu_object *obj,
1324 			      struct virtio_gpu_mem_entry *ents,
1325 			      unsigned int nents)
1326 {
1327 	if (obj->attached)
1328 		return;
1329 
1330 	virtio_gpu_cmd_resource_attach_backing(vgdev, obj->hw_res_handle,
1331 					       ents, nents, NULL);
1332 
1333 	obj->attached = true;
1334 }
1335 
1336 void virtio_gpu_object_detach(struct virtio_gpu_device *vgdev,
1337 			      struct virtio_gpu_object *obj,
1338 			      struct virtio_gpu_fence *fence)
1339 {
1340 	if (!obj->attached)
1341 		return;
1342 
1343 	virtio_gpu_cmd_resource_detach_backing(vgdev, obj->hw_res_handle,
1344 					       fence);
1345 
1346 	obj->attached = false;
1347 }
1348 
1349 void virtio_gpu_cursor_ping(struct virtio_gpu_device *vgdev,
1350 			    struct virtio_gpu_output *output)
1351 {
1352 	struct virtio_gpu_vbuffer *vbuf;
1353 	struct virtio_gpu_update_cursor *cur_p;
1354 
1355 	output->cursor.pos.scanout_id = cpu_to_le32(output->index);
1356 	cur_p = virtio_gpu_alloc_cursor(vgdev, &vbuf);
1357 	memcpy(cur_p, &output->cursor, sizeof(output->cursor));
1358 	virtio_gpu_queue_cursor(vgdev, vbuf);
1359 }
1360 
1361 static void virtio_gpu_cmd_resource_uuid_cb(struct virtio_gpu_device *vgdev,
1362 					    struct virtio_gpu_vbuffer *vbuf)
1363 {
1364 	struct virtio_gpu_object *obj =
1365 		gem_to_virtio_gpu_obj(vbuf->objs->objs[0]);
1366 	struct virtio_gpu_resp_resource_uuid *resp =
1367 		(struct virtio_gpu_resp_resource_uuid *)vbuf->resp_buf;
1368 	uint32_t resp_type = le32_to_cpu(resp->hdr.type);
1369 
1370 	spin_lock(&vgdev->resource_export_lock);
1371 	WARN_ON(obj->uuid_state != STATE_INITIALIZING);
1372 
1373 	if (resp_type == VIRTIO_GPU_RESP_OK_RESOURCE_UUID &&
1374 	    obj->uuid_state == STATE_INITIALIZING) {
1375 		import_uuid(&obj->uuid, resp->uuid);
1376 		obj->uuid_state = STATE_OK;
1377 	} else {
1378 		obj->uuid_state = STATE_ERR;
1379 	}
1380 	spin_unlock(&vgdev->resource_export_lock);
1381 
1382 	wake_up_all(&vgdev->resp_wq);
1383 }
1384 
1385 int
1386 virtio_gpu_cmd_resource_assign_uuid(struct virtio_gpu_device *vgdev,
1387 				    struct virtio_gpu_object_array *objs)
1388 {
1389 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1390 	struct virtio_gpu_resource_assign_uuid *cmd_p;
1391 	struct virtio_gpu_vbuffer *vbuf;
1392 	struct virtio_gpu_resp_resource_uuid *resp_buf;
1393 
1394 	resp_buf = kzalloc_obj(*resp_buf);
1395 	if (!resp_buf) {
1396 		spin_lock(&vgdev->resource_export_lock);
1397 		bo->uuid_state = STATE_ERR;
1398 		spin_unlock(&vgdev->resource_export_lock);
1399 		virtio_gpu_array_put_free(objs);
1400 		return -ENOMEM;
1401 	}
1402 
1403 	cmd_p = virtio_gpu_alloc_cmd_resp
1404 		(vgdev, virtio_gpu_cmd_resource_uuid_cb, &vbuf, sizeof(*cmd_p),
1405 		 sizeof(struct virtio_gpu_resp_resource_uuid), resp_buf);
1406 	memset(cmd_p, 0, sizeof(*cmd_p));
1407 
1408 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ASSIGN_UUID);
1409 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1410 
1411 	vbuf->objs = objs;
1412 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1413 	return 0;
1414 }
1415 
1416 static void virtio_gpu_cmd_resource_map_cb(struct virtio_gpu_device *vgdev,
1417 					   struct virtio_gpu_vbuffer *vbuf)
1418 {
1419 	struct virtio_gpu_object *bo =
1420 		gem_to_virtio_gpu_obj(vbuf->objs->objs[0]);
1421 	struct virtio_gpu_resp_map_info *resp =
1422 		(struct virtio_gpu_resp_map_info *)vbuf->resp_buf;
1423 	struct virtio_gpu_object_vram *vram = to_virtio_gpu_vram(bo);
1424 	uint32_t resp_type = le32_to_cpu(resp->hdr.type);
1425 
1426 	spin_lock(&vgdev->host_visible_lock);
1427 
1428 	if (resp_type == VIRTIO_GPU_RESP_OK_MAP_INFO) {
1429 		vram->map_info = resp->map_info;
1430 		vram->map_state = STATE_OK;
1431 	} else {
1432 		vram->map_state = STATE_ERR;
1433 	}
1434 
1435 	spin_unlock(&vgdev->host_visible_lock);
1436 	wake_up_all(&vgdev->resp_wq);
1437 }
1438 
1439 int virtio_gpu_cmd_map(struct virtio_gpu_device *vgdev,
1440 		       struct virtio_gpu_object_array *objs, uint64_t offset)
1441 {
1442 	struct virtio_gpu_resource_map_blob *cmd_p;
1443 	struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1444 	struct virtio_gpu_vbuffer *vbuf;
1445 	struct virtio_gpu_resp_map_info *resp_buf;
1446 
1447 	resp_buf = kzalloc_obj(*resp_buf);
1448 	if (!resp_buf)
1449 		return -ENOMEM;
1450 
1451 	cmd_p = virtio_gpu_alloc_cmd_resp
1452 		(vgdev, virtio_gpu_cmd_resource_map_cb, &vbuf, sizeof(*cmd_p),
1453 		 sizeof(struct virtio_gpu_resp_map_info), resp_buf);
1454 	memset(cmd_p, 0, sizeof(*cmd_p));
1455 
1456 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_MAP_BLOB);
1457 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1458 	cmd_p->offset = cpu_to_le64(offset);
1459 	vbuf->objs = objs;
1460 
1461 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1462 	return 0;
1463 }
1464 
1465 void virtio_gpu_cmd_unmap(struct virtio_gpu_device *vgdev,
1466 			  struct virtio_gpu_object *bo)
1467 {
1468 	struct virtio_gpu_resource_unmap_blob *cmd_p;
1469 	struct virtio_gpu_vbuffer *vbuf;
1470 
1471 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1472 	memset(cmd_p, 0, sizeof(*cmd_p));
1473 
1474 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNMAP_BLOB);
1475 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1476 
1477 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1478 }
1479 
1480 void
1481 virtio_gpu_cmd_resource_create_blob(struct virtio_gpu_device *vgdev,
1482 				    struct virtio_gpu_object *bo,
1483 				    struct virtio_gpu_object_params *params,
1484 				    struct virtio_gpu_mem_entry *ents,
1485 				    uint32_t nents)
1486 {
1487 	struct virtio_gpu_resource_create_blob *cmd_p;
1488 	struct virtio_gpu_vbuffer *vbuf;
1489 
1490 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1491 	memset(cmd_p, 0, sizeof(*cmd_p));
1492 
1493 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_BLOB);
1494 	cmd_p->hdr.ctx_id = cpu_to_le32(params->ctx_id);
1495 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1496 	cmd_p->blob_mem = cpu_to_le32(params->blob_mem);
1497 	cmd_p->blob_flags = cpu_to_le32(params->blob_flags);
1498 	cmd_p->blob_id = cpu_to_le64(params->blob_id);
1499 	cmd_p->size = cpu_to_le64(params->size);
1500 	cmd_p->nr_entries = cpu_to_le32(nents);
1501 
1502 	vbuf->data_buf = ents;
1503 	vbuf->data_size = sizeof(*ents) * nents;
1504 
1505 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1506 	bo->created = true;
1507 
1508 	if (nents)
1509 		bo->attached = true;
1510 }
1511 
1512 void virtio_gpu_cmd_set_scanout_blob(struct virtio_gpu_device *vgdev,
1513 				     uint32_t scanout_id,
1514 				     struct virtio_gpu_object *bo,
1515 				     struct drm_framebuffer *fb,
1516 				     uint32_t width, uint32_t height,
1517 				     uint32_t x, uint32_t y)
1518 {
1519 	uint32_t i;
1520 	struct virtio_gpu_set_scanout_blob *cmd_p;
1521 	struct virtio_gpu_vbuffer *vbuf;
1522 	uint32_t format = virtio_gpu_translate_format(fb->format->format);
1523 
1524 	cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1525 	memset(cmd_p, 0, sizeof(*cmd_p));
1526 
1527 	cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT_BLOB);
1528 	cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1529 	cmd_p->scanout_id = cpu_to_le32(scanout_id);
1530 
1531 	cmd_p->format = cpu_to_le32(format);
1532 	cmd_p->width  = cpu_to_le32(fb->width);
1533 	cmd_p->height = cpu_to_le32(fb->height);
1534 
1535 	for (i = 0; i < 4; i++) {
1536 		cmd_p->strides[i] = cpu_to_le32(fb->pitches[i]);
1537 		cmd_p->offsets[i] = cpu_to_le32(fb->offsets[i]);
1538 	}
1539 
1540 	cmd_p->r.width = cpu_to_le32(width);
1541 	cmd_p->r.height = cpu_to_le32(height);
1542 	cmd_p->r.x = cpu_to_le32(x);
1543 	cmd_p->r.y = cpu_to_le32(y);
1544 
1545 	virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1546 }
1547