Loading...
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 <drm/drmP.h>
30#include "virtgpu_drv.h"
31#include <linux/virtio.h>
32#include <linux/virtio_config.h>
33#include <linux/virtio_ring.h>
34
35#define MAX_INLINE_CMD_SIZE 96
36#define MAX_INLINE_RESP_SIZE 24
37#define VBUFFER_SIZE (sizeof(struct virtio_gpu_vbuffer) \
38 + MAX_INLINE_CMD_SIZE \
39 + MAX_INLINE_RESP_SIZE)
40
41void virtio_gpu_resource_id_get(struct virtio_gpu_device *vgdev,
42 uint32_t *resid)
43{
44 int handle;
45
46 idr_preload(GFP_KERNEL);
47 spin_lock(&vgdev->resource_idr_lock);
48 handle = idr_alloc(&vgdev->resource_idr, NULL, 1, 0, GFP_NOWAIT);
49 spin_unlock(&vgdev->resource_idr_lock);
50 idr_preload_end();
51 *resid = handle;
52}
53
54void virtio_gpu_resource_id_put(struct virtio_gpu_device *vgdev, uint32_t id)
55{
56 spin_lock(&vgdev->resource_idr_lock);
57 idr_remove(&vgdev->resource_idr, id);
58 spin_unlock(&vgdev->resource_idr_lock);
59}
60
61void virtio_gpu_ctrl_ack(struct virtqueue *vq)
62{
63 struct drm_device *dev = vq->vdev->priv;
64 struct virtio_gpu_device *vgdev = dev->dev_private;
65 schedule_work(&vgdev->ctrlq.dequeue_work);
66}
67
68void virtio_gpu_cursor_ack(struct virtqueue *vq)
69{
70 struct drm_device *dev = vq->vdev->priv;
71 struct virtio_gpu_device *vgdev = dev->dev_private;
72 schedule_work(&vgdev->cursorq.dequeue_work);
73}
74
75int virtio_gpu_alloc_vbufs(struct virtio_gpu_device *vgdev)
76{
77 struct virtio_gpu_vbuffer *vbuf;
78 int i, size, count = 0;
79 void *ptr;
80
81 INIT_LIST_HEAD(&vgdev->free_vbufs);
82 spin_lock_init(&vgdev->free_vbufs_lock);
83 count += virtqueue_get_vring_size(vgdev->ctrlq.vq);
84 count += virtqueue_get_vring_size(vgdev->cursorq.vq);
85 size = count * VBUFFER_SIZE;
86 DRM_INFO("virtio vbuffers: %d bufs, %zdB each, %dkB total.\n",
87 count, VBUFFER_SIZE, size / 1024);
88
89 vgdev->vbufs = kzalloc(size, GFP_KERNEL);
90 if (!vgdev->vbufs)
91 return -ENOMEM;
92
93 for (i = 0, ptr = vgdev->vbufs;
94 i < count;
95 i++, ptr += VBUFFER_SIZE) {
96 vbuf = ptr;
97 list_add(&vbuf->list, &vgdev->free_vbufs);
98 }
99 return 0;
100}
101
102void virtio_gpu_free_vbufs(struct virtio_gpu_device *vgdev)
103{
104 struct virtio_gpu_vbuffer *vbuf;
105 int i, count = 0;
106
107 count += virtqueue_get_vring_size(vgdev->ctrlq.vq);
108 count += virtqueue_get_vring_size(vgdev->cursorq.vq);
109
110 spin_lock(&vgdev->free_vbufs_lock);
111 for (i = 0; i < count; i++) {
112 if (WARN_ON(list_empty(&vgdev->free_vbufs)))
113 return;
114 vbuf = list_first_entry(&vgdev->free_vbufs,
115 struct virtio_gpu_vbuffer, list);
116 list_del(&vbuf->list);
117 }
118 spin_unlock(&vgdev->free_vbufs_lock);
119 kfree(vgdev->vbufs);
120}
121
122static struct virtio_gpu_vbuffer*
123virtio_gpu_get_vbuf(struct virtio_gpu_device *vgdev,
124 int size, int resp_size, void *resp_buf,
125 virtio_gpu_resp_cb resp_cb)
126{
127 struct virtio_gpu_vbuffer *vbuf;
128
129 spin_lock(&vgdev->free_vbufs_lock);
130 BUG_ON(list_empty(&vgdev->free_vbufs));
131 vbuf = list_first_entry(&vgdev->free_vbufs,
132 struct virtio_gpu_vbuffer, list);
133 list_del(&vbuf->list);
134 spin_unlock(&vgdev->free_vbufs_lock);
135 memset(vbuf, 0, VBUFFER_SIZE);
136
137 BUG_ON(size > MAX_INLINE_CMD_SIZE);
138 vbuf->buf = (void *)vbuf + sizeof(*vbuf);
139 vbuf->size = size;
140
141 vbuf->resp_cb = resp_cb;
142 vbuf->resp_size = resp_size;
143 if (resp_size <= MAX_INLINE_RESP_SIZE)
144 vbuf->resp_buf = (void *)vbuf->buf + size;
145 else
146 vbuf->resp_buf = resp_buf;
147 BUG_ON(!vbuf->resp_buf);
148 return vbuf;
149}
150
151static void *virtio_gpu_alloc_cmd(struct virtio_gpu_device *vgdev,
152 struct virtio_gpu_vbuffer **vbuffer_p,
153 int size)
154{
155 struct virtio_gpu_vbuffer *vbuf;
156
157 vbuf = virtio_gpu_get_vbuf(vgdev, size,
158 sizeof(struct virtio_gpu_ctrl_hdr),
159 NULL, NULL);
160 if (IS_ERR(vbuf)) {
161 *vbuffer_p = NULL;
162 return ERR_CAST(vbuf);
163 }
164 *vbuffer_p = vbuf;
165 return vbuf->buf;
166}
167
168static struct virtio_gpu_update_cursor*
169virtio_gpu_alloc_cursor(struct virtio_gpu_device *vgdev,
170 struct virtio_gpu_vbuffer **vbuffer_p)
171{
172 struct virtio_gpu_vbuffer *vbuf;
173
174 vbuf = virtio_gpu_get_vbuf
175 (vgdev, sizeof(struct virtio_gpu_update_cursor),
176 0, NULL, NULL);
177 if (IS_ERR(vbuf)) {
178 *vbuffer_p = NULL;
179 return ERR_CAST(vbuf);
180 }
181 *vbuffer_p = vbuf;
182 return (struct virtio_gpu_update_cursor *)vbuf->buf;
183}
184
185static void *virtio_gpu_alloc_cmd_resp(struct virtio_gpu_device *vgdev,
186 virtio_gpu_resp_cb cb,
187 struct virtio_gpu_vbuffer **vbuffer_p,
188 int cmd_size, int resp_size,
189 void *resp_buf)
190{
191 struct virtio_gpu_vbuffer *vbuf;
192
193 vbuf = virtio_gpu_get_vbuf(vgdev, cmd_size,
194 resp_size, resp_buf, cb);
195 if (IS_ERR(vbuf)) {
196 *vbuffer_p = NULL;
197 return ERR_CAST(vbuf);
198 }
199 *vbuffer_p = vbuf;
200 return (struct virtio_gpu_command *)vbuf->buf;
201}
202
203static void free_vbuf(struct virtio_gpu_device *vgdev,
204 struct virtio_gpu_vbuffer *vbuf)
205{
206 if (vbuf->resp_size > MAX_INLINE_RESP_SIZE)
207 kfree(vbuf->resp_buf);
208 kfree(vbuf->data_buf);
209 spin_lock(&vgdev->free_vbufs_lock);
210 list_add(&vbuf->list, &vgdev->free_vbufs);
211 spin_unlock(&vgdev->free_vbufs_lock);
212}
213
214static void reclaim_vbufs(struct virtqueue *vq, struct list_head *reclaim_list)
215{
216 struct virtio_gpu_vbuffer *vbuf;
217 unsigned int len;
218 int freed = 0;
219
220 while ((vbuf = virtqueue_get_buf(vq, &len))) {
221 list_add_tail(&vbuf->list, reclaim_list);
222 freed++;
223 }
224 if (freed == 0)
225 DRM_DEBUG("Huh? zero vbufs reclaimed");
226}
227
228void virtio_gpu_dequeue_ctrl_func(struct work_struct *work)
229{
230 struct virtio_gpu_device *vgdev =
231 container_of(work, struct virtio_gpu_device,
232 ctrlq.dequeue_work);
233 struct list_head reclaim_list;
234 struct virtio_gpu_vbuffer *entry, *tmp;
235 struct virtio_gpu_ctrl_hdr *resp;
236 u64 fence_id = 0;
237
238 INIT_LIST_HEAD(&reclaim_list);
239 spin_lock(&vgdev->ctrlq.qlock);
240 do {
241 virtqueue_disable_cb(vgdev->ctrlq.vq);
242 reclaim_vbufs(vgdev->ctrlq.vq, &reclaim_list);
243
244 } while (!virtqueue_enable_cb(vgdev->ctrlq.vq));
245 spin_unlock(&vgdev->ctrlq.qlock);
246
247 list_for_each_entry_safe(entry, tmp, &reclaim_list, list) {
248 resp = (struct virtio_gpu_ctrl_hdr *)entry->resp_buf;
249 if (resp->type != cpu_to_le32(VIRTIO_GPU_RESP_OK_NODATA))
250 DRM_DEBUG("response 0x%x\n", le32_to_cpu(resp->type));
251 if (resp->flags & cpu_to_le32(VIRTIO_GPU_FLAG_FENCE)) {
252 u64 f = le64_to_cpu(resp->fence_id);
253
254 if (fence_id > f) {
255 DRM_ERROR("%s: Oops: fence %llx -> %llx\n",
256 __func__, fence_id, f);
257 } else {
258 fence_id = f;
259 }
260 }
261 if (entry->resp_cb)
262 entry->resp_cb(vgdev, entry);
263
264 list_del(&entry->list);
265 free_vbuf(vgdev, entry);
266 }
267 wake_up(&vgdev->ctrlq.ack_queue);
268
269 if (fence_id)
270 virtio_gpu_fence_event_process(vgdev, fence_id);
271}
272
273void virtio_gpu_dequeue_cursor_func(struct work_struct *work)
274{
275 struct virtio_gpu_device *vgdev =
276 container_of(work, struct virtio_gpu_device,
277 cursorq.dequeue_work);
278 struct list_head reclaim_list;
279 struct virtio_gpu_vbuffer *entry, *tmp;
280
281 INIT_LIST_HEAD(&reclaim_list);
282 spin_lock(&vgdev->cursorq.qlock);
283 do {
284 virtqueue_disable_cb(vgdev->cursorq.vq);
285 reclaim_vbufs(vgdev->cursorq.vq, &reclaim_list);
286 } while (!virtqueue_enable_cb(vgdev->cursorq.vq));
287 spin_unlock(&vgdev->cursorq.qlock);
288
289 list_for_each_entry_safe(entry, tmp, &reclaim_list, list) {
290 list_del(&entry->list);
291 free_vbuf(vgdev, entry);
292 }
293 wake_up(&vgdev->cursorq.ack_queue);
294}
295
296static int virtio_gpu_queue_ctrl_buffer_locked(struct virtio_gpu_device *vgdev,
297 struct virtio_gpu_vbuffer *vbuf)
298{
299 struct virtqueue *vq = vgdev->ctrlq.vq;
300 struct scatterlist *sgs[3], vcmd, vout, vresp;
301 int outcnt = 0, incnt = 0;
302 int ret;
303
304 if (!vgdev->vqs_ready)
305 return -ENODEV;
306
307 sg_init_one(&vcmd, vbuf->buf, vbuf->size);
308 sgs[outcnt+incnt] = &vcmd;
309 outcnt++;
310
311 if (vbuf->data_size) {
312 sg_init_one(&vout, vbuf->data_buf, vbuf->data_size);
313 sgs[outcnt + incnt] = &vout;
314 outcnt++;
315 }
316
317 if (vbuf->resp_size) {
318 sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size);
319 sgs[outcnt + incnt] = &vresp;
320 incnt++;
321 }
322
323retry:
324 ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC);
325 if (ret == -ENOSPC) {
326 spin_unlock(&vgdev->ctrlq.qlock);
327 wait_event(vgdev->ctrlq.ack_queue, vq->num_free);
328 spin_lock(&vgdev->ctrlq.qlock);
329 goto retry;
330 } else {
331 virtqueue_kick(vq);
332 }
333
334 if (!ret)
335 ret = vq->num_free;
336 return ret;
337}
338
339static int virtio_gpu_queue_ctrl_buffer(struct virtio_gpu_device *vgdev,
340 struct virtio_gpu_vbuffer *vbuf)
341{
342 int rc;
343
344 spin_lock(&vgdev->ctrlq.qlock);
345 rc = virtio_gpu_queue_ctrl_buffer_locked(vgdev, vbuf);
346 spin_unlock(&vgdev->ctrlq.qlock);
347 return rc;
348}
349
350static int virtio_gpu_queue_fenced_ctrl_buffer(struct virtio_gpu_device *vgdev,
351 struct virtio_gpu_vbuffer *vbuf,
352 struct virtio_gpu_ctrl_hdr *hdr,
353 struct virtio_gpu_fence **fence)
354{
355 struct virtqueue *vq = vgdev->ctrlq.vq;
356 int rc;
357
358again:
359 spin_lock(&vgdev->ctrlq.qlock);
360
361 /*
362 * Make sure we have enouth space in the virtqueue. If not
363 * wait here until we have.
364 *
365 * Without that virtio_gpu_queue_ctrl_buffer_nolock might have
366 * to wait for free space, which can result in fence ids being
367 * submitted out-of-order.
368 */
369 if (vq->num_free < 3) {
370 spin_unlock(&vgdev->ctrlq.qlock);
371 wait_event(vgdev->ctrlq.ack_queue, vq->num_free >= 3);
372 goto again;
373 }
374
375 if (fence)
376 virtio_gpu_fence_emit(vgdev, hdr, fence);
377 rc = virtio_gpu_queue_ctrl_buffer_locked(vgdev, vbuf);
378 spin_unlock(&vgdev->ctrlq.qlock);
379 return rc;
380}
381
382static int virtio_gpu_queue_cursor(struct virtio_gpu_device *vgdev,
383 struct virtio_gpu_vbuffer *vbuf)
384{
385 struct virtqueue *vq = vgdev->cursorq.vq;
386 struct scatterlist *sgs[1], ccmd;
387 int ret;
388 int outcnt;
389
390 if (!vgdev->vqs_ready)
391 return -ENODEV;
392
393 sg_init_one(&ccmd, vbuf->buf, vbuf->size);
394 sgs[0] = &ccmd;
395 outcnt = 1;
396
397 spin_lock(&vgdev->cursorq.qlock);
398retry:
399 ret = virtqueue_add_sgs(vq, sgs, outcnt, 0, vbuf, GFP_ATOMIC);
400 if (ret == -ENOSPC) {
401 spin_unlock(&vgdev->cursorq.qlock);
402 wait_event(vgdev->cursorq.ack_queue, vq->num_free);
403 spin_lock(&vgdev->cursorq.qlock);
404 goto retry;
405 } else {
406 virtqueue_kick(vq);
407 }
408
409 spin_unlock(&vgdev->cursorq.qlock);
410
411 if (!ret)
412 ret = vq->num_free;
413 return ret;
414}
415
416/* just create gem objects for userspace and long lived objects,
417 just use dma_alloced pages for the queue objects? */
418
419/* create a basic resource */
420void virtio_gpu_cmd_create_resource(struct virtio_gpu_device *vgdev,
421 uint32_t resource_id,
422 uint32_t format,
423 uint32_t width,
424 uint32_t height)
425{
426 struct virtio_gpu_resource_create_2d *cmd_p;
427 struct virtio_gpu_vbuffer *vbuf;
428
429 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
430 memset(cmd_p, 0, sizeof(*cmd_p));
431
432 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_2D);
433 cmd_p->resource_id = cpu_to_le32(resource_id);
434 cmd_p->format = cpu_to_le32(format);
435 cmd_p->width = cpu_to_le32(width);
436 cmd_p->height = cpu_to_le32(height);
437
438 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
439}
440
441void virtio_gpu_cmd_unref_resource(struct virtio_gpu_device *vgdev,
442 uint32_t resource_id)
443{
444 struct virtio_gpu_resource_unref *cmd_p;
445 struct virtio_gpu_vbuffer *vbuf;
446
447 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
448 memset(cmd_p, 0, sizeof(*cmd_p));
449
450 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNREF);
451 cmd_p->resource_id = cpu_to_le32(resource_id);
452
453 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
454}
455
456void virtio_gpu_cmd_resource_inval_backing(struct virtio_gpu_device *vgdev,
457 uint32_t resource_id)
458{
459 struct virtio_gpu_resource_detach_backing *cmd_p;
460 struct virtio_gpu_vbuffer *vbuf;
461
462 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
463 memset(cmd_p, 0, sizeof(*cmd_p));
464
465 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_DETACH_BACKING);
466 cmd_p->resource_id = cpu_to_le32(resource_id);
467
468 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
469}
470
471void virtio_gpu_cmd_set_scanout(struct virtio_gpu_device *vgdev,
472 uint32_t scanout_id, uint32_t resource_id,
473 uint32_t width, uint32_t height,
474 uint32_t x, uint32_t y)
475{
476 struct virtio_gpu_set_scanout *cmd_p;
477 struct virtio_gpu_vbuffer *vbuf;
478
479 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
480 memset(cmd_p, 0, sizeof(*cmd_p));
481
482 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT);
483 cmd_p->resource_id = cpu_to_le32(resource_id);
484 cmd_p->scanout_id = cpu_to_le32(scanout_id);
485 cmd_p->r.width = cpu_to_le32(width);
486 cmd_p->r.height = cpu_to_le32(height);
487 cmd_p->r.x = cpu_to_le32(x);
488 cmd_p->r.y = cpu_to_le32(y);
489
490 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
491}
492
493void virtio_gpu_cmd_resource_flush(struct virtio_gpu_device *vgdev,
494 uint32_t resource_id,
495 uint32_t x, uint32_t y,
496 uint32_t width, uint32_t height)
497{
498 struct virtio_gpu_resource_flush *cmd_p;
499 struct virtio_gpu_vbuffer *vbuf;
500
501 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
502 memset(cmd_p, 0, sizeof(*cmd_p));
503
504 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_FLUSH);
505 cmd_p->resource_id = cpu_to_le32(resource_id);
506 cmd_p->r.width = cpu_to_le32(width);
507 cmd_p->r.height = cpu_to_le32(height);
508 cmd_p->r.x = cpu_to_le32(x);
509 cmd_p->r.y = cpu_to_le32(y);
510
511 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
512}
513
514void virtio_gpu_cmd_transfer_to_host_2d(struct virtio_gpu_device *vgdev,
515 uint32_t resource_id, uint64_t offset,
516 __le32 width, __le32 height,
517 __le32 x, __le32 y,
518 struct virtio_gpu_fence **fence)
519{
520 struct virtio_gpu_transfer_to_host_2d *cmd_p;
521 struct virtio_gpu_vbuffer *vbuf;
522
523 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
524 memset(cmd_p, 0, sizeof(*cmd_p));
525
526 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D);
527 cmd_p->resource_id = cpu_to_le32(resource_id);
528 cmd_p->offset = cpu_to_le64(offset);
529 cmd_p->r.width = width;
530 cmd_p->r.height = height;
531 cmd_p->r.x = x;
532 cmd_p->r.y = y;
533
534 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
535}
536
537static void
538virtio_gpu_cmd_resource_attach_backing(struct virtio_gpu_device *vgdev,
539 uint32_t resource_id,
540 struct virtio_gpu_mem_entry *ents,
541 uint32_t nents,
542 struct virtio_gpu_fence **fence)
543{
544 struct virtio_gpu_resource_attach_backing *cmd_p;
545 struct virtio_gpu_vbuffer *vbuf;
546
547 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
548 memset(cmd_p, 0, sizeof(*cmd_p));
549
550 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ATTACH_BACKING);
551 cmd_p->resource_id = cpu_to_le32(resource_id);
552 cmd_p->nr_entries = cpu_to_le32(nents);
553
554 vbuf->data_buf = ents;
555 vbuf->data_size = sizeof(*ents) * nents;
556
557 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
558}
559
560static void virtio_gpu_cmd_get_display_info_cb(struct virtio_gpu_device *vgdev,
561 struct virtio_gpu_vbuffer *vbuf)
562{
563 struct virtio_gpu_resp_display_info *resp =
564 (struct virtio_gpu_resp_display_info *)vbuf->resp_buf;
565 int i;
566
567 spin_lock(&vgdev->display_info_lock);
568 for (i = 0; i < vgdev->num_scanouts; i++) {
569 vgdev->outputs[i].info = resp->pmodes[i];
570 if (resp->pmodes[i].enabled) {
571 DRM_DEBUG("output %d: %dx%d+%d+%d", i,
572 le32_to_cpu(resp->pmodes[i].r.width),
573 le32_to_cpu(resp->pmodes[i].r.height),
574 le32_to_cpu(resp->pmodes[i].r.x),
575 le32_to_cpu(resp->pmodes[i].r.y));
576 } else {
577 DRM_DEBUG("output %d: disabled", i);
578 }
579 }
580
581 vgdev->display_info_pending = false;
582 spin_unlock(&vgdev->display_info_lock);
583 wake_up(&vgdev->resp_wq);
584
585 if (!drm_helper_hpd_irq_event(vgdev->ddev))
586 drm_kms_helper_hotplug_event(vgdev->ddev);
587}
588
589static void virtio_gpu_cmd_get_capset_info_cb(struct virtio_gpu_device *vgdev,
590 struct virtio_gpu_vbuffer *vbuf)
591{
592 struct virtio_gpu_get_capset_info *cmd =
593 (struct virtio_gpu_get_capset_info *)vbuf->buf;
594 struct virtio_gpu_resp_capset_info *resp =
595 (struct virtio_gpu_resp_capset_info *)vbuf->resp_buf;
596 int i = le32_to_cpu(cmd->capset_index);
597
598 spin_lock(&vgdev->display_info_lock);
599 vgdev->capsets[i].id = le32_to_cpu(resp->capset_id);
600 vgdev->capsets[i].max_version = le32_to_cpu(resp->capset_max_version);
601 vgdev->capsets[i].max_size = le32_to_cpu(resp->capset_max_size);
602 spin_unlock(&vgdev->display_info_lock);
603 wake_up(&vgdev->resp_wq);
604}
605
606static void virtio_gpu_cmd_capset_cb(struct virtio_gpu_device *vgdev,
607 struct virtio_gpu_vbuffer *vbuf)
608{
609 struct virtio_gpu_get_capset *cmd =
610 (struct virtio_gpu_get_capset *)vbuf->buf;
611 struct virtio_gpu_resp_capset *resp =
612 (struct virtio_gpu_resp_capset *)vbuf->resp_buf;
613 struct virtio_gpu_drv_cap_cache *cache_ent;
614
615 spin_lock(&vgdev->display_info_lock);
616 list_for_each_entry(cache_ent, &vgdev->cap_cache, head) {
617 if (cache_ent->version == le32_to_cpu(cmd->capset_version) &&
618 cache_ent->id == le32_to_cpu(cmd->capset_id)) {
619 memcpy(cache_ent->caps_cache, resp->capset_data,
620 cache_ent->size);
621 atomic_set(&cache_ent->is_valid, 1);
622 break;
623 }
624 }
625 spin_unlock(&vgdev->display_info_lock);
626 wake_up(&vgdev->resp_wq);
627}
628
629
630int virtio_gpu_cmd_get_display_info(struct virtio_gpu_device *vgdev)
631{
632 struct virtio_gpu_ctrl_hdr *cmd_p;
633 struct virtio_gpu_vbuffer *vbuf;
634 void *resp_buf;
635
636 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_display_info),
637 GFP_KERNEL);
638 if (!resp_buf)
639 return -ENOMEM;
640
641 cmd_p = virtio_gpu_alloc_cmd_resp
642 (vgdev, &virtio_gpu_cmd_get_display_info_cb, &vbuf,
643 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_display_info),
644 resp_buf);
645 memset(cmd_p, 0, sizeof(*cmd_p));
646
647 vgdev->display_info_pending = true;
648 cmd_p->type = cpu_to_le32(VIRTIO_GPU_CMD_GET_DISPLAY_INFO);
649 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
650 return 0;
651}
652
653int virtio_gpu_cmd_get_capset_info(struct virtio_gpu_device *vgdev, int idx)
654{
655 struct virtio_gpu_get_capset_info *cmd_p;
656 struct virtio_gpu_vbuffer *vbuf;
657 void *resp_buf;
658
659 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset_info),
660 GFP_KERNEL);
661 if (!resp_buf)
662 return -ENOMEM;
663
664 cmd_p = virtio_gpu_alloc_cmd_resp
665 (vgdev, &virtio_gpu_cmd_get_capset_info_cb, &vbuf,
666 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_capset_info),
667 resp_buf);
668 memset(cmd_p, 0, sizeof(*cmd_p));
669
670 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET_INFO);
671 cmd_p->capset_index = cpu_to_le32(idx);
672 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
673 return 0;
674}
675
676int virtio_gpu_cmd_get_capset(struct virtio_gpu_device *vgdev,
677 int idx, int version,
678 struct virtio_gpu_drv_cap_cache **cache_p)
679{
680 struct virtio_gpu_get_capset *cmd_p;
681 struct virtio_gpu_vbuffer *vbuf;
682 int max_size = vgdev->capsets[idx].max_size;
683 struct virtio_gpu_drv_cap_cache *cache_ent;
684 void *resp_buf;
685
686 if (idx > vgdev->num_capsets)
687 return -EINVAL;
688
689 if (version > vgdev->capsets[idx].max_version)
690 return -EINVAL;
691
692 cache_ent = kzalloc(sizeof(*cache_ent), GFP_KERNEL);
693 if (!cache_ent)
694 return -ENOMEM;
695
696 cache_ent->caps_cache = kmalloc(max_size, GFP_KERNEL);
697 if (!cache_ent->caps_cache) {
698 kfree(cache_ent);
699 return -ENOMEM;
700 }
701
702 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset) + max_size,
703 GFP_KERNEL);
704 if (!resp_buf) {
705 kfree(cache_ent->caps_cache);
706 kfree(cache_ent);
707 return -ENOMEM;
708 }
709
710 cache_ent->version = version;
711 cache_ent->id = vgdev->capsets[idx].id;
712 atomic_set(&cache_ent->is_valid, 0);
713 cache_ent->size = max_size;
714 spin_lock(&vgdev->display_info_lock);
715 list_add_tail(&cache_ent->head, &vgdev->cap_cache);
716 spin_unlock(&vgdev->display_info_lock);
717
718 cmd_p = virtio_gpu_alloc_cmd_resp
719 (vgdev, &virtio_gpu_cmd_capset_cb, &vbuf, sizeof(*cmd_p),
720 sizeof(struct virtio_gpu_resp_capset) + max_size,
721 resp_buf);
722 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET);
723 cmd_p->capset_id = cpu_to_le32(vgdev->capsets[idx].id);
724 cmd_p->capset_version = cpu_to_le32(version);
725 *cache_p = cache_ent;
726 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
727
728 return 0;
729}
730
731void virtio_gpu_cmd_context_create(struct virtio_gpu_device *vgdev, uint32_t id,
732 uint32_t nlen, const char *name)
733{
734 struct virtio_gpu_ctx_create *cmd_p;
735 struct virtio_gpu_vbuffer *vbuf;
736
737 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
738 memset(cmd_p, 0, sizeof(*cmd_p));
739
740 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_CREATE);
741 cmd_p->hdr.ctx_id = cpu_to_le32(id);
742 cmd_p->nlen = cpu_to_le32(nlen);
743 strncpy(cmd_p->debug_name, name, sizeof(cmd_p->debug_name)-1);
744 cmd_p->debug_name[sizeof(cmd_p->debug_name)-1] = 0;
745 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
746}
747
748void virtio_gpu_cmd_context_destroy(struct virtio_gpu_device *vgdev,
749 uint32_t id)
750{
751 struct virtio_gpu_ctx_destroy *cmd_p;
752 struct virtio_gpu_vbuffer *vbuf;
753
754 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
755 memset(cmd_p, 0, sizeof(*cmd_p));
756
757 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DESTROY);
758 cmd_p->hdr.ctx_id = cpu_to_le32(id);
759 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
760}
761
762void virtio_gpu_cmd_context_attach_resource(struct virtio_gpu_device *vgdev,
763 uint32_t ctx_id,
764 uint32_t resource_id)
765{
766 struct virtio_gpu_ctx_resource *cmd_p;
767 struct virtio_gpu_vbuffer *vbuf;
768
769 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
770 memset(cmd_p, 0, sizeof(*cmd_p));
771
772 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_ATTACH_RESOURCE);
773 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
774 cmd_p->resource_id = cpu_to_le32(resource_id);
775 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
776
777}
778
779void virtio_gpu_cmd_context_detach_resource(struct virtio_gpu_device *vgdev,
780 uint32_t ctx_id,
781 uint32_t resource_id)
782{
783 struct virtio_gpu_ctx_resource *cmd_p;
784 struct virtio_gpu_vbuffer *vbuf;
785
786 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
787 memset(cmd_p, 0, sizeof(*cmd_p));
788
789 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DETACH_RESOURCE);
790 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
791 cmd_p->resource_id = cpu_to_le32(resource_id);
792 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
793}
794
795void
796virtio_gpu_cmd_resource_create_3d(struct virtio_gpu_device *vgdev,
797 struct virtio_gpu_resource_create_3d *rc_3d,
798 struct virtio_gpu_fence **fence)
799{
800 struct virtio_gpu_resource_create_3d *cmd_p;
801 struct virtio_gpu_vbuffer *vbuf;
802
803 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
804 memset(cmd_p, 0, sizeof(*cmd_p));
805
806 *cmd_p = *rc_3d;
807 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_3D);
808 cmd_p->hdr.flags = 0;
809
810 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
811}
812
813void virtio_gpu_cmd_transfer_to_host_3d(struct virtio_gpu_device *vgdev,
814 uint32_t resource_id, uint32_t ctx_id,
815 uint64_t offset, uint32_t level,
816 struct virtio_gpu_box *box,
817 struct virtio_gpu_fence **fence)
818{
819 struct virtio_gpu_transfer_host_3d *cmd_p;
820 struct virtio_gpu_vbuffer *vbuf;
821
822 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
823 memset(cmd_p, 0, sizeof(*cmd_p));
824
825 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_3D);
826 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
827 cmd_p->resource_id = cpu_to_le32(resource_id);
828 cmd_p->box = *box;
829 cmd_p->offset = cpu_to_le64(offset);
830 cmd_p->level = cpu_to_le32(level);
831
832 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
833}
834
835void virtio_gpu_cmd_transfer_from_host_3d(struct virtio_gpu_device *vgdev,
836 uint32_t resource_id, uint32_t ctx_id,
837 uint64_t offset, uint32_t level,
838 struct virtio_gpu_box *box,
839 struct virtio_gpu_fence **fence)
840{
841 struct virtio_gpu_transfer_host_3d *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_TRANSFER_FROM_HOST_3D);
848 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
849 cmd_p->resource_id = cpu_to_le32(resource_id);
850 cmd_p->box = *box;
851 cmd_p->offset = cpu_to_le64(offset);
852 cmd_p->level = cpu_to_le32(level);
853
854 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
855}
856
857void virtio_gpu_cmd_submit(struct virtio_gpu_device *vgdev,
858 void *data, uint32_t data_size,
859 uint32_t ctx_id, struct virtio_gpu_fence **fence)
860{
861 struct virtio_gpu_cmd_submit *cmd_p;
862 struct virtio_gpu_vbuffer *vbuf;
863
864 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
865 memset(cmd_p, 0, sizeof(*cmd_p));
866
867 vbuf->data_buf = data;
868 vbuf->data_size = data_size;
869
870 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SUBMIT_3D);
871 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
872 cmd_p->size = cpu_to_le32(data_size);
873
874 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
875}
876
877int virtio_gpu_object_attach(struct virtio_gpu_device *vgdev,
878 struct virtio_gpu_object *obj,
879 uint32_t resource_id,
880 struct virtio_gpu_fence **fence)
881{
882 struct virtio_gpu_mem_entry *ents;
883 struct scatterlist *sg;
884 int si;
885
886 if (!obj->pages) {
887 int ret;
888 ret = virtio_gpu_object_get_sg_table(vgdev, obj);
889 if (ret)
890 return ret;
891 }
892
893 /* gets freed when the ring has consumed it */
894 ents = kmalloc_array(obj->pages->nents,
895 sizeof(struct virtio_gpu_mem_entry),
896 GFP_KERNEL);
897 if (!ents) {
898 DRM_ERROR("failed to allocate ent list\n");
899 return -ENOMEM;
900 }
901
902 for_each_sg(obj->pages->sgl, sg, obj->pages->nents, si) {
903 ents[si].addr = cpu_to_le64(sg_phys(sg));
904 ents[si].length = cpu_to_le32(sg->length);
905 ents[si].padding = 0;
906 }
907
908 virtio_gpu_cmd_resource_attach_backing(vgdev, resource_id,
909 ents, obj->pages->nents,
910 fence);
911 obj->hw_res_handle = resource_id;
912 return 0;
913}
914
915void virtio_gpu_cursor_ping(struct virtio_gpu_device *vgdev,
916 struct virtio_gpu_output *output)
917{
918 struct virtio_gpu_vbuffer *vbuf;
919 struct virtio_gpu_update_cursor *cur_p;
920
921 output->cursor.pos.scanout_id = cpu_to_le32(output->index);
922 cur_p = virtio_gpu_alloc_cursor(vgdev, &vbuf);
923 memcpy(cur_p, &output->cursor, sizeof(output->cursor));
924 virtio_gpu_queue_cursor(vgdev, vbuf);
925}
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
36#include "virtgpu_drv.h"
37#include "virtgpu_trace.h"
38
39#define MAX_INLINE_CMD_SIZE 96
40#define MAX_INLINE_RESP_SIZE 24
41#define VBUFFER_SIZE (sizeof(struct virtio_gpu_vbuffer) \
42 + MAX_INLINE_CMD_SIZE \
43 + MAX_INLINE_RESP_SIZE)
44
45static void convert_to_hw_box(struct virtio_gpu_box *dst,
46 const struct drm_virtgpu_3d_box *src)
47{
48 dst->x = cpu_to_le32(src->x);
49 dst->y = cpu_to_le32(src->y);
50 dst->z = cpu_to_le32(src->z);
51 dst->w = cpu_to_le32(src->w);
52 dst->h = cpu_to_le32(src->h);
53 dst->d = cpu_to_le32(src->d);
54}
55
56void virtio_gpu_ctrl_ack(struct virtqueue *vq)
57{
58 struct drm_device *dev = vq->vdev->priv;
59 struct virtio_gpu_device *vgdev = dev->dev_private;
60
61 schedule_work(&vgdev->ctrlq.dequeue_work);
62}
63
64void virtio_gpu_cursor_ack(struct virtqueue *vq)
65{
66 struct drm_device *dev = vq->vdev->priv;
67 struct virtio_gpu_device *vgdev = dev->dev_private;
68
69 schedule_work(&vgdev->cursorq.dequeue_work);
70}
71
72int virtio_gpu_alloc_vbufs(struct virtio_gpu_device *vgdev)
73{
74 vgdev->vbufs = kmem_cache_create("virtio-gpu-vbufs",
75 VBUFFER_SIZE,
76 __alignof__(struct virtio_gpu_vbuffer),
77 0, NULL);
78 if (!vgdev->vbufs)
79 return -ENOMEM;
80 return 0;
81}
82
83void virtio_gpu_free_vbufs(struct virtio_gpu_device *vgdev)
84{
85 kmem_cache_destroy(vgdev->vbufs);
86 vgdev->vbufs = NULL;
87}
88
89static struct virtio_gpu_vbuffer*
90virtio_gpu_get_vbuf(struct virtio_gpu_device *vgdev,
91 int size, int resp_size, void *resp_buf,
92 virtio_gpu_resp_cb resp_cb)
93{
94 struct virtio_gpu_vbuffer *vbuf;
95
96 vbuf = kmem_cache_zalloc(vgdev->vbufs, GFP_KERNEL | __GFP_NOFAIL);
97
98 BUG_ON(size > MAX_INLINE_CMD_SIZE ||
99 size < sizeof(struct virtio_gpu_ctrl_hdr));
100 vbuf->buf = (void *)vbuf + sizeof(*vbuf);
101 vbuf->size = size;
102
103 vbuf->resp_cb = resp_cb;
104 vbuf->resp_size = resp_size;
105 if (resp_size <= MAX_INLINE_RESP_SIZE)
106 vbuf->resp_buf = (void *)vbuf->buf + size;
107 else
108 vbuf->resp_buf = resp_buf;
109 BUG_ON(!vbuf->resp_buf);
110 return vbuf;
111}
112
113static struct virtio_gpu_ctrl_hdr *
114virtio_gpu_vbuf_ctrl_hdr(struct virtio_gpu_vbuffer *vbuf)
115{
116 /* this assumes a vbuf contains a command that starts with a
117 * virtio_gpu_ctrl_hdr, which is true for both ctrl and cursor
118 * virtqueues.
119 */
120 return (struct virtio_gpu_ctrl_hdr *)vbuf->buf;
121}
122
123static struct virtio_gpu_update_cursor*
124virtio_gpu_alloc_cursor(struct virtio_gpu_device *vgdev,
125 struct virtio_gpu_vbuffer **vbuffer_p)
126{
127 struct virtio_gpu_vbuffer *vbuf;
128
129 vbuf = virtio_gpu_get_vbuf
130 (vgdev, sizeof(struct virtio_gpu_update_cursor),
131 0, NULL, NULL);
132 if (IS_ERR(vbuf)) {
133 *vbuffer_p = NULL;
134 return ERR_CAST(vbuf);
135 }
136 *vbuffer_p = vbuf;
137 return (struct virtio_gpu_update_cursor *)vbuf->buf;
138}
139
140static void *virtio_gpu_alloc_cmd_resp(struct virtio_gpu_device *vgdev,
141 virtio_gpu_resp_cb cb,
142 struct virtio_gpu_vbuffer **vbuffer_p,
143 int cmd_size, int resp_size,
144 void *resp_buf)
145{
146 struct virtio_gpu_vbuffer *vbuf;
147
148 vbuf = virtio_gpu_get_vbuf(vgdev, cmd_size,
149 resp_size, resp_buf, cb);
150 *vbuffer_p = vbuf;
151 return (struct virtio_gpu_command *)vbuf->buf;
152}
153
154static void *virtio_gpu_alloc_cmd(struct virtio_gpu_device *vgdev,
155 struct virtio_gpu_vbuffer **vbuffer_p,
156 int size)
157{
158 return virtio_gpu_alloc_cmd_resp(vgdev, NULL, vbuffer_p, size,
159 sizeof(struct virtio_gpu_ctrl_hdr),
160 NULL);
161}
162
163static void *virtio_gpu_alloc_cmd_cb(struct virtio_gpu_device *vgdev,
164 struct virtio_gpu_vbuffer **vbuffer_p,
165 int size,
166 virtio_gpu_resp_cb cb)
167{
168 return virtio_gpu_alloc_cmd_resp(vgdev, cb, vbuffer_p, size,
169 sizeof(struct virtio_gpu_ctrl_hdr),
170 NULL);
171}
172
173static void free_vbuf(struct virtio_gpu_device *vgdev,
174 struct virtio_gpu_vbuffer *vbuf)
175{
176 if (vbuf->resp_size > MAX_INLINE_RESP_SIZE)
177 kfree(vbuf->resp_buf);
178 kvfree(vbuf->data_buf);
179 kmem_cache_free(vgdev->vbufs, vbuf);
180}
181
182static void reclaim_vbufs(struct virtqueue *vq, struct list_head *reclaim_list)
183{
184 struct virtio_gpu_vbuffer *vbuf;
185 unsigned int len;
186 int freed = 0;
187
188 while ((vbuf = virtqueue_get_buf(vq, &len))) {
189 list_add_tail(&vbuf->list, reclaim_list);
190 freed++;
191 }
192 if (freed == 0)
193 DRM_DEBUG("Huh? zero vbufs reclaimed");
194}
195
196void virtio_gpu_dequeue_ctrl_func(struct work_struct *work)
197{
198 struct virtio_gpu_device *vgdev =
199 container_of(work, struct virtio_gpu_device,
200 ctrlq.dequeue_work);
201 struct list_head reclaim_list;
202 struct virtio_gpu_vbuffer *entry, *tmp;
203 struct virtio_gpu_ctrl_hdr *resp;
204 u64 fence_id;
205
206 INIT_LIST_HEAD(&reclaim_list);
207 spin_lock(&vgdev->ctrlq.qlock);
208 do {
209 virtqueue_disable_cb(vgdev->ctrlq.vq);
210 reclaim_vbufs(vgdev->ctrlq.vq, &reclaim_list);
211
212 } while (!virtqueue_enable_cb(vgdev->ctrlq.vq));
213 spin_unlock(&vgdev->ctrlq.qlock);
214
215 list_for_each_entry(entry, &reclaim_list, list) {
216 resp = (struct virtio_gpu_ctrl_hdr *)entry->resp_buf;
217
218 trace_virtio_gpu_cmd_response(vgdev->ctrlq.vq, resp, entry->seqno);
219
220 if (resp->type != cpu_to_le32(VIRTIO_GPU_RESP_OK_NODATA)) {
221 if (le32_to_cpu(resp->type) >= VIRTIO_GPU_RESP_ERR_UNSPEC) {
222 struct virtio_gpu_ctrl_hdr *cmd;
223 cmd = virtio_gpu_vbuf_ctrl_hdr(entry);
224 DRM_ERROR_RATELIMITED("response 0x%x (command 0x%x)\n",
225 le32_to_cpu(resp->type),
226 le32_to_cpu(cmd->type));
227 } else
228 DRM_DEBUG("response 0x%x\n", le32_to_cpu(resp->type));
229 }
230 if (resp->flags & cpu_to_le32(VIRTIO_GPU_FLAG_FENCE)) {
231 fence_id = le64_to_cpu(resp->fence_id);
232 virtio_gpu_fence_event_process(vgdev, fence_id);
233 }
234 if (entry->resp_cb)
235 entry->resp_cb(vgdev, entry);
236 }
237 wake_up(&vgdev->ctrlq.ack_queue);
238
239 list_for_each_entry_safe(entry, tmp, &reclaim_list, list) {
240 if (entry->objs)
241 virtio_gpu_array_put_free_delayed(vgdev, entry->objs);
242 list_del(&entry->list);
243 free_vbuf(vgdev, entry);
244 }
245}
246
247void virtio_gpu_dequeue_cursor_func(struct work_struct *work)
248{
249 struct virtio_gpu_device *vgdev =
250 container_of(work, struct virtio_gpu_device,
251 cursorq.dequeue_work);
252 struct list_head reclaim_list;
253 struct virtio_gpu_vbuffer *entry, *tmp;
254
255 INIT_LIST_HEAD(&reclaim_list);
256 spin_lock(&vgdev->cursorq.qlock);
257 do {
258 virtqueue_disable_cb(vgdev->cursorq.vq);
259 reclaim_vbufs(vgdev->cursorq.vq, &reclaim_list);
260 } while (!virtqueue_enable_cb(vgdev->cursorq.vq));
261 spin_unlock(&vgdev->cursorq.qlock);
262
263 list_for_each_entry_safe(entry, tmp, &reclaim_list, list) {
264 struct virtio_gpu_ctrl_hdr *resp =
265 (struct virtio_gpu_ctrl_hdr *)entry->resp_buf;
266
267 trace_virtio_gpu_cmd_response(vgdev->cursorq.vq, resp, entry->seqno);
268 list_del(&entry->list);
269 free_vbuf(vgdev, entry);
270 }
271 wake_up(&vgdev->cursorq.ack_queue);
272}
273
274/* Create sg_table from a vmalloc'd buffer. */
275static struct sg_table *vmalloc_to_sgt(char *data, uint32_t size, int *sg_ents)
276{
277 int ret, s, i;
278 struct sg_table *sgt;
279 struct scatterlist *sg;
280 struct page *pg;
281
282 if (WARN_ON(!PAGE_ALIGNED(data)))
283 return NULL;
284
285 sgt = kmalloc(sizeof(*sgt), GFP_KERNEL);
286 if (!sgt)
287 return NULL;
288
289 *sg_ents = DIV_ROUND_UP(size, PAGE_SIZE);
290 ret = sg_alloc_table(sgt, *sg_ents, GFP_KERNEL);
291 if (ret) {
292 kfree(sgt);
293 return NULL;
294 }
295
296 for_each_sgtable_sg(sgt, sg, i) {
297 pg = vmalloc_to_page(data);
298 if (!pg) {
299 sg_free_table(sgt);
300 kfree(sgt);
301 return NULL;
302 }
303
304 s = min_t(int, PAGE_SIZE, size);
305 sg_set_page(sg, pg, s, 0);
306
307 size -= s;
308 data += s;
309 }
310
311 return sgt;
312}
313
314static int virtio_gpu_queue_ctrl_sgs(struct virtio_gpu_device *vgdev,
315 struct virtio_gpu_vbuffer *vbuf,
316 struct virtio_gpu_fence *fence,
317 int elemcnt,
318 struct scatterlist **sgs,
319 int outcnt,
320 int incnt)
321{
322 struct virtqueue *vq = vgdev->ctrlq.vq;
323 int ret, idx;
324
325 if (!drm_dev_enter(vgdev->ddev, &idx)) {
326 if (fence && vbuf->objs)
327 virtio_gpu_array_unlock_resv(vbuf->objs);
328 free_vbuf(vgdev, vbuf);
329 return -ENODEV;
330 }
331
332 if (vgdev->has_indirect)
333 elemcnt = 1;
334
335again:
336 spin_lock(&vgdev->ctrlq.qlock);
337
338 if (vq->num_free < elemcnt) {
339 spin_unlock(&vgdev->ctrlq.qlock);
340 virtio_gpu_notify(vgdev);
341 wait_event(vgdev->ctrlq.ack_queue, vq->num_free >= elemcnt);
342 goto again;
343 }
344
345 /* now that the position of the vbuf in the virtqueue is known, we can
346 * finally set the fence id
347 */
348 if (fence) {
349 virtio_gpu_fence_emit(vgdev, virtio_gpu_vbuf_ctrl_hdr(vbuf),
350 fence);
351 if (vbuf->objs) {
352 virtio_gpu_array_add_fence(vbuf->objs, &fence->f);
353 virtio_gpu_array_unlock_resv(vbuf->objs);
354 }
355 }
356
357 ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC);
358 WARN_ON(ret);
359
360 vbuf->seqno = ++vgdev->ctrlq.seqno;
361 trace_virtio_gpu_cmd_queue(vq, virtio_gpu_vbuf_ctrl_hdr(vbuf), vbuf->seqno);
362
363 atomic_inc(&vgdev->pending_commands);
364
365 spin_unlock(&vgdev->ctrlq.qlock);
366
367 drm_dev_exit(idx);
368 return 0;
369}
370
371static int virtio_gpu_queue_fenced_ctrl_buffer(struct virtio_gpu_device *vgdev,
372 struct virtio_gpu_vbuffer *vbuf,
373 struct virtio_gpu_fence *fence)
374{
375 struct scatterlist *sgs[3], vcmd, vout, vresp;
376 struct sg_table *sgt = NULL;
377 int elemcnt = 0, outcnt = 0, incnt = 0, ret;
378
379 /* set up vcmd */
380 sg_init_one(&vcmd, vbuf->buf, vbuf->size);
381 elemcnt++;
382 sgs[outcnt] = &vcmd;
383 outcnt++;
384
385 /* set up vout */
386 if (vbuf->data_size) {
387 if (is_vmalloc_addr(vbuf->data_buf)) {
388 int sg_ents;
389 sgt = vmalloc_to_sgt(vbuf->data_buf, vbuf->data_size,
390 &sg_ents);
391 if (!sgt) {
392 if (fence && vbuf->objs)
393 virtio_gpu_array_unlock_resv(vbuf->objs);
394 return -ENOMEM;
395 }
396
397 elemcnt += sg_ents;
398 sgs[outcnt] = sgt->sgl;
399 } else {
400 sg_init_one(&vout, vbuf->data_buf, vbuf->data_size);
401 elemcnt++;
402 sgs[outcnt] = &vout;
403 }
404 outcnt++;
405 }
406
407 /* set up vresp */
408 if (vbuf->resp_size) {
409 sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size);
410 elemcnt++;
411 sgs[outcnt + incnt] = &vresp;
412 incnt++;
413 }
414
415 ret = virtio_gpu_queue_ctrl_sgs(vgdev, vbuf, fence, elemcnt, sgs, outcnt,
416 incnt);
417
418 if (sgt) {
419 sg_free_table(sgt);
420 kfree(sgt);
421 }
422 return ret;
423}
424
425void virtio_gpu_notify(struct virtio_gpu_device *vgdev)
426{
427 bool notify;
428
429 if (!atomic_read(&vgdev->pending_commands))
430 return;
431
432 spin_lock(&vgdev->ctrlq.qlock);
433 atomic_set(&vgdev->pending_commands, 0);
434 notify = virtqueue_kick_prepare(vgdev->ctrlq.vq);
435 spin_unlock(&vgdev->ctrlq.qlock);
436
437 if (notify)
438 virtqueue_notify(vgdev->ctrlq.vq);
439}
440
441static int virtio_gpu_queue_ctrl_buffer(struct virtio_gpu_device *vgdev,
442 struct virtio_gpu_vbuffer *vbuf)
443{
444 return virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, NULL);
445}
446
447static void virtio_gpu_queue_cursor(struct virtio_gpu_device *vgdev,
448 struct virtio_gpu_vbuffer *vbuf)
449{
450 struct virtqueue *vq = vgdev->cursorq.vq;
451 struct scatterlist *sgs[1], ccmd;
452 int idx, ret, outcnt;
453 bool notify;
454
455 if (!drm_dev_enter(vgdev->ddev, &idx)) {
456 free_vbuf(vgdev, vbuf);
457 return;
458 }
459
460 sg_init_one(&ccmd, vbuf->buf, vbuf->size);
461 sgs[0] = &ccmd;
462 outcnt = 1;
463
464 spin_lock(&vgdev->cursorq.qlock);
465retry:
466 ret = virtqueue_add_sgs(vq, sgs, outcnt, 0, vbuf, GFP_ATOMIC);
467 if (ret == -ENOSPC) {
468 spin_unlock(&vgdev->cursorq.qlock);
469 wait_event(vgdev->cursorq.ack_queue, vq->num_free >= outcnt);
470 spin_lock(&vgdev->cursorq.qlock);
471 goto retry;
472 } else {
473 vbuf->seqno = ++vgdev->cursorq.seqno;
474 trace_virtio_gpu_cmd_queue(vq,
475 virtio_gpu_vbuf_ctrl_hdr(vbuf),
476 vbuf->seqno);
477
478 notify = virtqueue_kick_prepare(vq);
479 }
480
481 spin_unlock(&vgdev->cursorq.qlock);
482
483 if (notify)
484 virtqueue_notify(vq);
485
486 drm_dev_exit(idx);
487}
488
489/* just create gem objects for userspace and long lived objects,
490 * just use dma_alloced pages for the queue objects?
491 */
492
493/* create a basic resource */
494void virtio_gpu_cmd_create_resource(struct virtio_gpu_device *vgdev,
495 struct virtio_gpu_object *bo,
496 struct virtio_gpu_object_params *params,
497 struct virtio_gpu_object_array *objs,
498 struct virtio_gpu_fence *fence)
499{
500 struct virtio_gpu_resource_create_2d *cmd_p;
501 struct virtio_gpu_vbuffer *vbuf;
502
503 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
504 memset(cmd_p, 0, sizeof(*cmd_p));
505 vbuf->objs = objs;
506
507 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_2D);
508 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
509 cmd_p->format = cpu_to_le32(params->format);
510 cmd_p->width = cpu_to_le32(params->width);
511 cmd_p->height = cpu_to_le32(params->height);
512
513 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
514 bo->created = true;
515}
516
517static void virtio_gpu_cmd_unref_cb(struct virtio_gpu_device *vgdev,
518 struct virtio_gpu_vbuffer *vbuf)
519{
520 struct virtio_gpu_object *bo;
521
522 bo = vbuf->resp_cb_data;
523 vbuf->resp_cb_data = NULL;
524
525 virtio_gpu_cleanup_object(bo);
526}
527
528void virtio_gpu_cmd_unref_resource(struct virtio_gpu_device *vgdev,
529 struct virtio_gpu_object *bo)
530{
531 struct virtio_gpu_resource_unref *cmd_p;
532 struct virtio_gpu_vbuffer *vbuf;
533 int ret;
534
535 cmd_p = virtio_gpu_alloc_cmd_cb(vgdev, &vbuf, sizeof(*cmd_p),
536 virtio_gpu_cmd_unref_cb);
537 memset(cmd_p, 0, sizeof(*cmd_p));
538
539 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNREF);
540 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
541
542 vbuf->resp_cb_data = bo;
543 ret = virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
544 if (ret < 0)
545 virtio_gpu_cleanup_object(bo);
546}
547
548void virtio_gpu_cmd_set_scanout(struct virtio_gpu_device *vgdev,
549 uint32_t scanout_id, uint32_t resource_id,
550 uint32_t width, uint32_t height,
551 uint32_t x, uint32_t y)
552{
553 struct virtio_gpu_set_scanout *cmd_p;
554 struct virtio_gpu_vbuffer *vbuf;
555
556 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
557 memset(cmd_p, 0, sizeof(*cmd_p));
558
559 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT);
560 cmd_p->resource_id = cpu_to_le32(resource_id);
561 cmd_p->scanout_id = cpu_to_le32(scanout_id);
562 cmd_p->r.width = cpu_to_le32(width);
563 cmd_p->r.height = cpu_to_le32(height);
564 cmd_p->r.x = cpu_to_le32(x);
565 cmd_p->r.y = cpu_to_le32(y);
566
567 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
568}
569
570void virtio_gpu_cmd_resource_flush(struct virtio_gpu_device *vgdev,
571 uint32_t resource_id,
572 uint32_t x, uint32_t y,
573 uint32_t width, uint32_t height,
574 struct virtio_gpu_object_array *objs,
575 struct virtio_gpu_fence *fence)
576{
577 struct virtio_gpu_resource_flush *cmd_p;
578 struct virtio_gpu_vbuffer *vbuf;
579
580 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
581 memset(cmd_p, 0, sizeof(*cmd_p));
582 vbuf->objs = objs;
583
584 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_FLUSH);
585 cmd_p->resource_id = cpu_to_le32(resource_id);
586 cmd_p->r.width = cpu_to_le32(width);
587 cmd_p->r.height = cpu_to_le32(height);
588 cmd_p->r.x = cpu_to_le32(x);
589 cmd_p->r.y = cpu_to_le32(y);
590
591 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
592}
593
594void virtio_gpu_cmd_transfer_to_host_2d(struct virtio_gpu_device *vgdev,
595 uint64_t offset,
596 uint32_t width, uint32_t height,
597 uint32_t x, uint32_t y,
598 struct virtio_gpu_object_array *objs,
599 struct virtio_gpu_fence *fence)
600{
601 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
602 struct virtio_gpu_transfer_to_host_2d *cmd_p;
603 struct virtio_gpu_vbuffer *vbuf;
604 bool use_dma_api = !virtio_has_dma_quirk(vgdev->vdev);
605
606 if (virtio_gpu_is_shmem(bo) && use_dma_api)
607 dma_sync_sgtable_for_device(vgdev->vdev->dev.parent,
608 bo->base.sgt, DMA_TO_DEVICE);
609
610 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
611 memset(cmd_p, 0, sizeof(*cmd_p));
612 vbuf->objs = objs;
613
614 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D);
615 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
616 cmd_p->offset = cpu_to_le64(offset);
617 cmd_p->r.width = cpu_to_le32(width);
618 cmd_p->r.height = cpu_to_le32(height);
619 cmd_p->r.x = cpu_to_le32(x);
620 cmd_p->r.y = cpu_to_le32(y);
621
622 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
623}
624
625static void
626virtio_gpu_cmd_resource_attach_backing(struct virtio_gpu_device *vgdev,
627 uint32_t resource_id,
628 struct virtio_gpu_mem_entry *ents,
629 uint32_t nents,
630 struct virtio_gpu_fence *fence)
631{
632 struct virtio_gpu_resource_attach_backing *cmd_p;
633 struct virtio_gpu_vbuffer *vbuf;
634
635 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
636 memset(cmd_p, 0, sizeof(*cmd_p));
637
638 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ATTACH_BACKING);
639 cmd_p->resource_id = cpu_to_le32(resource_id);
640 cmd_p->nr_entries = cpu_to_le32(nents);
641
642 vbuf->data_buf = ents;
643 vbuf->data_size = sizeof(*ents) * nents;
644
645 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
646}
647
648static void virtio_gpu_cmd_get_display_info_cb(struct virtio_gpu_device *vgdev,
649 struct virtio_gpu_vbuffer *vbuf)
650{
651 struct virtio_gpu_resp_display_info *resp =
652 (struct virtio_gpu_resp_display_info *)vbuf->resp_buf;
653 int i;
654
655 spin_lock(&vgdev->display_info_lock);
656 for (i = 0; i < vgdev->num_scanouts; i++) {
657 vgdev->outputs[i].info = resp->pmodes[i];
658 if (resp->pmodes[i].enabled) {
659 DRM_DEBUG("output %d: %dx%d+%d+%d", i,
660 le32_to_cpu(resp->pmodes[i].r.width),
661 le32_to_cpu(resp->pmodes[i].r.height),
662 le32_to_cpu(resp->pmodes[i].r.x),
663 le32_to_cpu(resp->pmodes[i].r.y));
664 } else {
665 DRM_DEBUG("output %d: disabled", i);
666 }
667 }
668
669 vgdev->display_info_pending = false;
670 spin_unlock(&vgdev->display_info_lock);
671 wake_up(&vgdev->resp_wq);
672
673 if (!drm_helper_hpd_irq_event(vgdev->ddev))
674 drm_kms_helper_hotplug_event(vgdev->ddev);
675}
676
677static void virtio_gpu_cmd_get_capset_info_cb(struct virtio_gpu_device *vgdev,
678 struct virtio_gpu_vbuffer *vbuf)
679{
680 struct virtio_gpu_get_capset_info *cmd =
681 (struct virtio_gpu_get_capset_info *)vbuf->buf;
682 struct virtio_gpu_resp_capset_info *resp =
683 (struct virtio_gpu_resp_capset_info *)vbuf->resp_buf;
684 int i = le32_to_cpu(cmd->capset_index);
685
686 spin_lock(&vgdev->display_info_lock);
687 if (vgdev->capsets) {
688 vgdev->capsets[i].id = le32_to_cpu(resp->capset_id);
689 vgdev->capsets[i].max_version = le32_to_cpu(resp->capset_max_version);
690 vgdev->capsets[i].max_size = le32_to_cpu(resp->capset_max_size);
691 } else {
692 DRM_ERROR("invalid capset memory.");
693 }
694 spin_unlock(&vgdev->display_info_lock);
695 wake_up(&vgdev->resp_wq);
696}
697
698static void virtio_gpu_cmd_capset_cb(struct virtio_gpu_device *vgdev,
699 struct virtio_gpu_vbuffer *vbuf)
700{
701 struct virtio_gpu_get_capset *cmd =
702 (struct virtio_gpu_get_capset *)vbuf->buf;
703 struct virtio_gpu_resp_capset *resp =
704 (struct virtio_gpu_resp_capset *)vbuf->resp_buf;
705 struct virtio_gpu_drv_cap_cache *cache_ent;
706
707 spin_lock(&vgdev->display_info_lock);
708 list_for_each_entry(cache_ent, &vgdev->cap_cache, head) {
709 if (cache_ent->version == le32_to_cpu(cmd->capset_version) &&
710 cache_ent->id == le32_to_cpu(cmd->capset_id)) {
711 memcpy(cache_ent->caps_cache, resp->capset_data,
712 cache_ent->size);
713 /* Copy must occur before is_valid is signalled. */
714 smp_wmb();
715 atomic_set(&cache_ent->is_valid, 1);
716 break;
717 }
718 }
719 spin_unlock(&vgdev->display_info_lock);
720 wake_up_all(&vgdev->resp_wq);
721}
722
723static int virtio_get_edid_block(void *data, u8 *buf,
724 unsigned int block, size_t len)
725{
726 struct virtio_gpu_resp_edid *resp = data;
727 size_t start = block * EDID_LENGTH;
728
729 if (start + len > le32_to_cpu(resp->size))
730 return -EINVAL;
731 memcpy(buf, resp->edid + start, len);
732 return 0;
733}
734
735static void virtio_gpu_cmd_get_edid_cb(struct virtio_gpu_device *vgdev,
736 struct virtio_gpu_vbuffer *vbuf)
737{
738 struct virtio_gpu_cmd_get_edid *cmd =
739 (struct virtio_gpu_cmd_get_edid *)vbuf->buf;
740 struct virtio_gpu_resp_edid *resp =
741 (struct virtio_gpu_resp_edid *)vbuf->resp_buf;
742 uint32_t scanout = le32_to_cpu(cmd->scanout);
743 struct virtio_gpu_output *output;
744 struct edid *new_edid, *old_edid;
745
746 if (scanout >= vgdev->num_scanouts)
747 return;
748 output = vgdev->outputs + scanout;
749
750 new_edid = drm_do_get_edid(&output->conn, virtio_get_edid_block, resp);
751 drm_connector_update_edid_property(&output->conn, new_edid);
752
753 spin_lock(&vgdev->display_info_lock);
754 old_edid = output->edid;
755 output->edid = new_edid;
756 spin_unlock(&vgdev->display_info_lock);
757
758 kfree(old_edid);
759 wake_up(&vgdev->resp_wq);
760}
761
762int virtio_gpu_cmd_get_display_info(struct virtio_gpu_device *vgdev)
763{
764 struct virtio_gpu_ctrl_hdr *cmd_p;
765 struct virtio_gpu_vbuffer *vbuf;
766 void *resp_buf;
767
768 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_display_info),
769 GFP_KERNEL);
770 if (!resp_buf)
771 return -ENOMEM;
772
773 cmd_p = virtio_gpu_alloc_cmd_resp
774 (vgdev, &virtio_gpu_cmd_get_display_info_cb, &vbuf,
775 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_display_info),
776 resp_buf);
777 memset(cmd_p, 0, sizeof(*cmd_p));
778
779 vgdev->display_info_pending = true;
780 cmd_p->type = cpu_to_le32(VIRTIO_GPU_CMD_GET_DISPLAY_INFO);
781 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
782 return 0;
783}
784
785int virtio_gpu_cmd_get_capset_info(struct virtio_gpu_device *vgdev, int idx)
786{
787 struct virtio_gpu_get_capset_info *cmd_p;
788 struct virtio_gpu_vbuffer *vbuf;
789 void *resp_buf;
790
791 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset_info),
792 GFP_KERNEL);
793 if (!resp_buf)
794 return -ENOMEM;
795
796 cmd_p = virtio_gpu_alloc_cmd_resp
797 (vgdev, &virtio_gpu_cmd_get_capset_info_cb, &vbuf,
798 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_capset_info),
799 resp_buf);
800 memset(cmd_p, 0, sizeof(*cmd_p));
801
802 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET_INFO);
803 cmd_p->capset_index = cpu_to_le32(idx);
804 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
805 return 0;
806}
807
808int virtio_gpu_cmd_get_capset(struct virtio_gpu_device *vgdev,
809 int idx, int version,
810 struct virtio_gpu_drv_cap_cache **cache_p)
811{
812 struct virtio_gpu_get_capset *cmd_p;
813 struct virtio_gpu_vbuffer *vbuf;
814 int max_size;
815 struct virtio_gpu_drv_cap_cache *cache_ent;
816 struct virtio_gpu_drv_cap_cache *search_ent;
817 void *resp_buf;
818
819 *cache_p = NULL;
820
821 if (idx >= vgdev->num_capsets)
822 return -EINVAL;
823
824 if (version > vgdev->capsets[idx].max_version)
825 return -EINVAL;
826
827 cache_ent = kzalloc(sizeof(*cache_ent), GFP_KERNEL);
828 if (!cache_ent)
829 return -ENOMEM;
830
831 max_size = vgdev->capsets[idx].max_size;
832 cache_ent->caps_cache = kmalloc(max_size, GFP_KERNEL);
833 if (!cache_ent->caps_cache) {
834 kfree(cache_ent);
835 return -ENOMEM;
836 }
837
838 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset) + max_size,
839 GFP_KERNEL);
840 if (!resp_buf) {
841 kfree(cache_ent->caps_cache);
842 kfree(cache_ent);
843 return -ENOMEM;
844 }
845
846 cache_ent->version = version;
847 cache_ent->id = vgdev->capsets[idx].id;
848 atomic_set(&cache_ent->is_valid, 0);
849 cache_ent->size = max_size;
850 spin_lock(&vgdev->display_info_lock);
851 /* Search while under lock in case it was added by another task. */
852 list_for_each_entry(search_ent, &vgdev->cap_cache, head) {
853 if (search_ent->id == vgdev->capsets[idx].id &&
854 search_ent->version == version) {
855 *cache_p = search_ent;
856 break;
857 }
858 }
859 if (!*cache_p)
860 list_add_tail(&cache_ent->head, &vgdev->cap_cache);
861 spin_unlock(&vgdev->display_info_lock);
862
863 if (*cache_p) {
864 /* Entry was found, so free everything that was just created. */
865 kfree(resp_buf);
866 kfree(cache_ent->caps_cache);
867 kfree(cache_ent);
868 return 0;
869 }
870
871 cmd_p = virtio_gpu_alloc_cmd_resp
872 (vgdev, &virtio_gpu_cmd_capset_cb, &vbuf, sizeof(*cmd_p),
873 sizeof(struct virtio_gpu_resp_capset) + max_size,
874 resp_buf);
875 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET);
876 cmd_p->capset_id = cpu_to_le32(vgdev->capsets[idx].id);
877 cmd_p->capset_version = cpu_to_le32(version);
878 *cache_p = cache_ent;
879 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
880
881 return 0;
882}
883
884int virtio_gpu_cmd_get_edids(struct virtio_gpu_device *vgdev)
885{
886 struct virtio_gpu_cmd_get_edid *cmd_p;
887 struct virtio_gpu_vbuffer *vbuf;
888 void *resp_buf;
889 int scanout;
890
891 if (WARN_ON(!vgdev->has_edid))
892 return -EINVAL;
893
894 for (scanout = 0; scanout < vgdev->num_scanouts; scanout++) {
895 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_edid),
896 GFP_KERNEL);
897 if (!resp_buf)
898 return -ENOMEM;
899
900 cmd_p = virtio_gpu_alloc_cmd_resp
901 (vgdev, &virtio_gpu_cmd_get_edid_cb, &vbuf,
902 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_edid),
903 resp_buf);
904 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_EDID);
905 cmd_p->scanout = cpu_to_le32(scanout);
906 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
907 }
908
909 return 0;
910}
911
912void virtio_gpu_cmd_context_create(struct virtio_gpu_device *vgdev, uint32_t id,
913 uint32_t context_init, uint32_t nlen,
914 const char *name)
915{
916 struct virtio_gpu_ctx_create *cmd_p;
917 struct virtio_gpu_vbuffer *vbuf;
918
919 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
920 memset(cmd_p, 0, sizeof(*cmd_p));
921
922 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_CREATE);
923 cmd_p->hdr.ctx_id = cpu_to_le32(id);
924 cmd_p->nlen = cpu_to_le32(nlen);
925 cmd_p->context_init = cpu_to_le32(context_init);
926 strscpy(cmd_p->debug_name, name, sizeof(cmd_p->debug_name));
927 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
928}
929
930void virtio_gpu_cmd_context_destroy(struct virtio_gpu_device *vgdev,
931 uint32_t id)
932{
933 struct virtio_gpu_ctx_destroy *cmd_p;
934 struct virtio_gpu_vbuffer *vbuf;
935
936 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
937 memset(cmd_p, 0, sizeof(*cmd_p));
938
939 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DESTROY);
940 cmd_p->hdr.ctx_id = cpu_to_le32(id);
941 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
942}
943
944void virtio_gpu_cmd_context_attach_resource(struct virtio_gpu_device *vgdev,
945 uint32_t ctx_id,
946 struct virtio_gpu_object_array *objs)
947{
948 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
949 struct virtio_gpu_ctx_resource *cmd_p;
950 struct virtio_gpu_vbuffer *vbuf;
951
952 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
953 memset(cmd_p, 0, sizeof(*cmd_p));
954 vbuf->objs = objs;
955
956 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_ATTACH_RESOURCE);
957 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
958 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
959 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
960}
961
962void virtio_gpu_cmd_context_detach_resource(struct virtio_gpu_device *vgdev,
963 uint32_t ctx_id,
964 struct virtio_gpu_object_array *objs)
965{
966 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
967 struct virtio_gpu_ctx_resource *cmd_p;
968 struct virtio_gpu_vbuffer *vbuf;
969
970 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
971 memset(cmd_p, 0, sizeof(*cmd_p));
972 vbuf->objs = objs;
973
974 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DETACH_RESOURCE);
975 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
976 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
977 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
978}
979
980void
981virtio_gpu_cmd_resource_create_3d(struct virtio_gpu_device *vgdev,
982 struct virtio_gpu_object *bo,
983 struct virtio_gpu_object_params *params,
984 struct virtio_gpu_object_array *objs,
985 struct virtio_gpu_fence *fence)
986{
987 struct virtio_gpu_resource_create_3d *cmd_p;
988 struct virtio_gpu_vbuffer *vbuf;
989
990 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
991 memset(cmd_p, 0, sizeof(*cmd_p));
992 vbuf->objs = objs;
993
994 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_3D);
995 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
996 cmd_p->format = cpu_to_le32(params->format);
997 cmd_p->width = cpu_to_le32(params->width);
998 cmd_p->height = cpu_to_le32(params->height);
999
1000 cmd_p->target = cpu_to_le32(params->target);
1001 cmd_p->bind = cpu_to_le32(params->bind);
1002 cmd_p->depth = cpu_to_le32(params->depth);
1003 cmd_p->array_size = cpu_to_le32(params->array_size);
1004 cmd_p->last_level = cpu_to_le32(params->last_level);
1005 cmd_p->nr_samples = cpu_to_le32(params->nr_samples);
1006 cmd_p->flags = cpu_to_le32(params->flags);
1007
1008 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1009
1010 bo->created = true;
1011}
1012
1013void virtio_gpu_cmd_transfer_to_host_3d(struct virtio_gpu_device *vgdev,
1014 uint32_t ctx_id,
1015 uint64_t offset, uint32_t level,
1016 uint32_t stride,
1017 uint32_t layer_stride,
1018 struct drm_virtgpu_3d_box *box,
1019 struct virtio_gpu_object_array *objs,
1020 struct virtio_gpu_fence *fence)
1021{
1022 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1023 struct virtio_gpu_transfer_host_3d *cmd_p;
1024 struct virtio_gpu_vbuffer *vbuf;
1025 bool use_dma_api = !virtio_has_dma_quirk(vgdev->vdev);
1026
1027 if (virtio_gpu_is_shmem(bo) && use_dma_api)
1028 dma_sync_sgtable_for_device(vgdev->vdev->dev.parent,
1029 bo->base.sgt, DMA_TO_DEVICE);
1030
1031 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1032 memset(cmd_p, 0, sizeof(*cmd_p));
1033
1034 vbuf->objs = objs;
1035
1036 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_3D);
1037 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1038 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1039 convert_to_hw_box(&cmd_p->box, box);
1040 cmd_p->offset = cpu_to_le64(offset);
1041 cmd_p->level = cpu_to_le32(level);
1042 cmd_p->stride = cpu_to_le32(stride);
1043 cmd_p->layer_stride = cpu_to_le32(layer_stride);
1044
1045 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1046}
1047
1048void virtio_gpu_cmd_transfer_from_host_3d(struct virtio_gpu_device *vgdev,
1049 uint32_t ctx_id,
1050 uint64_t offset, uint32_t level,
1051 uint32_t stride,
1052 uint32_t layer_stride,
1053 struct drm_virtgpu_3d_box *box,
1054 struct virtio_gpu_object_array *objs,
1055 struct virtio_gpu_fence *fence)
1056{
1057 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1058 struct virtio_gpu_transfer_host_3d *cmd_p;
1059 struct virtio_gpu_vbuffer *vbuf;
1060
1061 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1062 memset(cmd_p, 0, sizeof(*cmd_p));
1063
1064 vbuf->objs = objs;
1065
1066 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_FROM_HOST_3D);
1067 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1068 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1069 convert_to_hw_box(&cmd_p->box, box);
1070 cmd_p->offset = cpu_to_le64(offset);
1071 cmd_p->level = cpu_to_le32(level);
1072 cmd_p->stride = cpu_to_le32(stride);
1073 cmd_p->layer_stride = cpu_to_le32(layer_stride);
1074
1075 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1076}
1077
1078void virtio_gpu_cmd_submit(struct virtio_gpu_device *vgdev,
1079 void *data, uint32_t data_size,
1080 uint32_t ctx_id,
1081 struct virtio_gpu_object_array *objs,
1082 struct virtio_gpu_fence *fence)
1083{
1084 struct virtio_gpu_cmd_submit *cmd_p;
1085 struct virtio_gpu_vbuffer *vbuf;
1086
1087 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1088 memset(cmd_p, 0, sizeof(*cmd_p));
1089
1090 vbuf->data_buf = data;
1091 vbuf->data_size = data_size;
1092 vbuf->objs = objs;
1093
1094 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SUBMIT_3D);
1095 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1096 cmd_p->size = cpu_to_le32(data_size);
1097
1098 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, fence);
1099}
1100
1101void virtio_gpu_object_attach(struct virtio_gpu_device *vgdev,
1102 struct virtio_gpu_object *obj,
1103 struct virtio_gpu_mem_entry *ents,
1104 unsigned int nents)
1105{
1106 virtio_gpu_cmd_resource_attach_backing(vgdev, obj->hw_res_handle,
1107 ents, nents, NULL);
1108}
1109
1110void virtio_gpu_cursor_ping(struct virtio_gpu_device *vgdev,
1111 struct virtio_gpu_output *output)
1112{
1113 struct virtio_gpu_vbuffer *vbuf;
1114 struct virtio_gpu_update_cursor *cur_p;
1115
1116 output->cursor.pos.scanout_id = cpu_to_le32(output->index);
1117 cur_p = virtio_gpu_alloc_cursor(vgdev, &vbuf);
1118 memcpy(cur_p, &output->cursor, sizeof(output->cursor));
1119 virtio_gpu_queue_cursor(vgdev, vbuf);
1120}
1121
1122static void virtio_gpu_cmd_resource_uuid_cb(struct virtio_gpu_device *vgdev,
1123 struct virtio_gpu_vbuffer *vbuf)
1124{
1125 struct virtio_gpu_object *obj =
1126 gem_to_virtio_gpu_obj(vbuf->objs->objs[0]);
1127 struct virtio_gpu_resp_resource_uuid *resp =
1128 (struct virtio_gpu_resp_resource_uuid *)vbuf->resp_buf;
1129 uint32_t resp_type = le32_to_cpu(resp->hdr.type);
1130
1131 spin_lock(&vgdev->resource_export_lock);
1132 WARN_ON(obj->uuid_state != STATE_INITIALIZING);
1133
1134 if (resp_type == VIRTIO_GPU_RESP_OK_RESOURCE_UUID &&
1135 obj->uuid_state == STATE_INITIALIZING) {
1136 import_uuid(&obj->uuid, resp->uuid);
1137 obj->uuid_state = STATE_OK;
1138 } else {
1139 obj->uuid_state = STATE_ERR;
1140 }
1141 spin_unlock(&vgdev->resource_export_lock);
1142
1143 wake_up_all(&vgdev->resp_wq);
1144}
1145
1146int
1147virtio_gpu_cmd_resource_assign_uuid(struct virtio_gpu_device *vgdev,
1148 struct virtio_gpu_object_array *objs)
1149{
1150 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1151 struct virtio_gpu_resource_assign_uuid *cmd_p;
1152 struct virtio_gpu_vbuffer *vbuf;
1153 struct virtio_gpu_resp_resource_uuid *resp_buf;
1154
1155 resp_buf = kzalloc(sizeof(*resp_buf), GFP_KERNEL);
1156 if (!resp_buf) {
1157 spin_lock(&vgdev->resource_export_lock);
1158 bo->uuid_state = STATE_ERR;
1159 spin_unlock(&vgdev->resource_export_lock);
1160 virtio_gpu_array_put_free(objs);
1161 return -ENOMEM;
1162 }
1163
1164 cmd_p = virtio_gpu_alloc_cmd_resp
1165 (vgdev, virtio_gpu_cmd_resource_uuid_cb, &vbuf, sizeof(*cmd_p),
1166 sizeof(struct virtio_gpu_resp_resource_uuid), resp_buf);
1167 memset(cmd_p, 0, sizeof(*cmd_p));
1168
1169 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ASSIGN_UUID);
1170 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1171
1172 vbuf->objs = objs;
1173 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1174 return 0;
1175}
1176
1177static void virtio_gpu_cmd_resource_map_cb(struct virtio_gpu_device *vgdev,
1178 struct virtio_gpu_vbuffer *vbuf)
1179{
1180 struct virtio_gpu_object *bo =
1181 gem_to_virtio_gpu_obj(vbuf->objs->objs[0]);
1182 struct virtio_gpu_resp_map_info *resp =
1183 (struct virtio_gpu_resp_map_info *)vbuf->resp_buf;
1184 struct virtio_gpu_object_vram *vram = to_virtio_gpu_vram(bo);
1185 uint32_t resp_type = le32_to_cpu(resp->hdr.type);
1186
1187 spin_lock(&vgdev->host_visible_lock);
1188
1189 if (resp_type == VIRTIO_GPU_RESP_OK_MAP_INFO) {
1190 vram->map_info = resp->map_info;
1191 vram->map_state = STATE_OK;
1192 } else {
1193 vram->map_state = STATE_ERR;
1194 }
1195
1196 spin_unlock(&vgdev->host_visible_lock);
1197 wake_up_all(&vgdev->resp_wq);
1198}
1199
1200int virtio_gpu_cmd_map(struct virtio_gpu_device *vgdev,
1201 struct virtio_gpu_object_array *objs, uint64_t offset)
1202{
1203 struct virtio_gpu_resource_map_blob *cmd_p;
1204 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1205 struct virtio_gpu_vbuffer *vbuf;
1206 struct virtio_gpu_resp_map_info *resp_buf;
1207
1208 resp_buf = kzalloc(sizeof(*resp_buf), GFP_KERNEL);
1209 if (!resp_buf)
1210 return -ENOMEM;
1211
1212 cmd_p = virtio_gpu_alloc_cmd_resp
1213 (vgdev, virtio_gpu_cmd_resource_map_cb, &vbuf, sizeof(*cmd_p),
1214 sizeof(struct virtio_gpu_resp_map_info), resp_buf);
1215 memset(cmd_p, 0, sizeof(*cmd_p));
1216
1217 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_MAP_BLOB);
1218 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1219 cmd_p->offset = cpu_to_le64(offset);
1220 vbuf->objs = objs;
1221
1222 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1223 return 0;
1224}
1225
1226void virtio_gpu_cmd_unmap(struct virtio_gpu_device *vgdev,
1227 struct virtio_gpu_object *bo)
1228{
1229 struct virtio_gpu_resource_unmap_blob *cmd_p;
1230 struct virtio_gpu_vbuffer *vbuf;
1231
1232 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1233 memset(cmd_p, 0, sizeof(*cmd_p));
1234
1235 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNMAP_BLOB);
1236 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1237
1238 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1239}
1240
1241void
1242virtio_gpu_cmd_resource_create_blob(struct virtio_gpu_device *vgdev,
1243 struct virtio_gpu_object *bo,
1244 struct virtio_gpu_object_params *params,
1245 struct virtio_gpu_mem_entry *ents,
1246 uint32_t nents)
1247{
1248 struct virtio_gpu_resource_create_blob *cmd_p;
1249 struct virtio_gpu_vbuffer *vbuf;
1250
1251 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1252 memset(cmd_p, 0, sizeof(*cmd_p));
1253
1254 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_BLOB);
1255 cmd_p->hdr.ctx_id = cpu_to_le32(params->ctx_id);
1256 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1257 cmd_p->blob_mem = cpu_to_le32(params->blob_mem);
1258 cmd_p->blob_flags = cpu_to_le32(params->blob_flags);
1259 cmd_p->blob_id = cpu_to_le64(params->blob_id);
1260 cmd_p->size = cpu_to_le64(params->size);
1261 cmd_p->nr_entries = cpu_to_le32(nents);
1262
1263 vbuf->data_buf = ents;
1264 vbuf->data_size = sizeof(*ents) * nents;
1265
1266 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1267 bo->created = true;
1268}
1269
1270void virtio_gpu_cmd_set_scanout_blob(struct virtio_gpu_device *vgdev,
1271 uint32_t scanout_id,
1272 struct virtio_gpu_object *bo,
1273 struct drm_framebuffer *fb,
1274 uint32_t width, uint32_t height,
1275 uint32_t x, uint32_t y)
1276{
1277 uint32_t i;
1278 struct virtio_gpu_set_scanout_blob *cmd_p;
1279 struct virtio_gpu_vbuffer *vbuf;
1280 uint32_t format = virtio_gpu_translate_format(fb->format->format);
1281
1282 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1283 memset(cmd_p, 0, sizeof(*cmd_p));
1284
1285 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT_BLOB);
1286 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1287 cmd_p->scanout_id = cpu_to_le32(scanout_id);
1288
1289 cmd_p->format = cpu_to_le32(format);
1290 cmd_p->width = cpu_to_le32(fb->width);
1291 cmd_p->height = cpu_to_le32(fb->height);
1292
1293 for (i = 0; i < 4; i++) {
1294 cmd_p->strides[i] = cpu_to_le32(fb->pitches[i]);
1295 cmd_p->offsets[i] = cpu_to_le32(fb->offsets[i]);
1296 }
1297
1298 cmd_p->r.width = cpu_to_le32(width);
1299 cmd_p->r.height = cpu_to_le32(height);
1300 cmd_p->r.x = cpu_to_le32(x);
1301 cmd_p->r.y = cpu_to_le32(y);
1302
1303 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
1304}