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