1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
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 "virtgpu_drv.h"
35#include "virtgpu_trace.h"
36
37#define MAX_INLINE_CMD_SIZE 96
38#define MAX_INLINE_RESP_SIZE 24
39#define VBUFFER_SIZE (sizeof(struct virtio_gpu_vbuffer) \
40 + MAX_INLINE_CMD_SIZE \
41 + MAX_INLINE_RESP_SIZE)
42
43static void convert_to_hw_box(struct virtio_gpu_box *dst,
44 const struct drm_virtgpu_3d_box *src)
45{
46 dst->x = cpu_to_le32(src->x);
47 dst->y = cpu_to_le32(src->y);
48 dst->z = cpu_to_le32(src->z);
49 dst->w = cpu_to_le32(src->w);
50 dst->h = cpu_to_le32(src->h);
51 dst->d = cpu_to_le32(src->d);
52}
53
54void virtio_gpu_ctrl_ack(struct virtqueue *vq)
55{
56 struct drm_device *dev = vq->vdev->priv;
57 struct virtio_gpu_device *vgdev = dev->dev_private;
58
59 schedule_work(&vgdev->ctrlq.dequeue_work);
60}
61
62void virtio_gpu_cursor_ack(struct virtqueue *vq)
63{
64 struct drm_device *dev = vq->vdev->priv;
65 struct virtio_gpu_device *vgdev = dev->dev_private;
66
67 schedule_work(&vgdev->cursorq.dequeue_work);
68}
69
70int virtio_gpu_alloc_vbufs(struct virtio_gpu_device *vgdev)
71{
72 vgdev->vbufs = kmem_cache_create("virtio-gpu-vbufs",
73 VBUFFER_SIZE,
74 __alignof__(struct virtio_gpu_vbuffer),
75 0, NULL);
76 if (!vgdev->vbufs)
77 return -ENOMEM;
78 return 0;
79}
80
81void virtio_gpu_free_vbufs(struct virtio_gpu_device *vgdev)
82{
83 kmem_cache_destroy(vgdev->vbufs);
84 vgdev->vbufs = NULL;
85}
86
87static struct virtio_gpu_vbuffer*
88virtio_gpu_get_vbuf(struct virtio_gpu_device *vgdev,
89 int size, int resp_size, void *resp_buf,
90 virtio_gpu_resp_cb resp_cb)
91{
92 struct virtio_gpu_vbuffer *vbuf;
93
94 vbuf = kmem_cache_zalloc(vgdev->vbufs, GFP_KERNEL);
95 if (!vbuf)
96 return ERR_PTR(-ENOMEM);
97
98 BUG_ON(size > MAX_INLINE_CMD_SIZE);
99 vbuf->buf = (void *)vbuf + sizeof(*vbuf);
100 vbuf->size = size;
101
102 vbuf->resp_cb = resp_cb;
103 vbuf->resp_size = resp_size;
104 if (resp_size <= MAX_INLINE_RESP_SIZE)
105 vbuf->resp_buf = (void *)vbuf->buf + size;
106 else
107 vbuf->resp_buf = resp_buf;
108 BUG_ON(!vbuf->resp_buf);
109 return vbuf;
110}
111
112static void *virtio_gpu_alloc_cmd(struct virtio_gpu_device *vgdev,
113 struct virtio_gpu_vbuffer **vbuffer_p,
114 int size)
115{
116 struct virtio_gpu_vbuffer *vbuf;
117
118 vbuf = virtio_gpu_get_vbuf(vgdev, size,
119 sizeof(struct virtio_gpu_ctrl_hdr),
120 NULL, NULL);
121 if (IS_ERR(vbuf)) {
122 *vbuffer_p = NULL;
123 return ERR_CAST(vbuf);
124 }
125 *vbuffer_p = vbuf;
126 return vbuf->buf;
127}
128
129static struct virtio_gpu_update_cursor*
130virtio_gpu_alloc_cursor(struct virtio_gpu_device *vgdev,
131 struct virtio_gpu_vbuffer **vbuffer_p)
132{
133 struct virtio_gpu_vbuffer *vbuf;
134
135 vbuf = virtio_gpu_get_vbuf
136 (vgdev, sizeof(struct virtio_gpu_update_cursor),
137 0, NULL, NULL);
138 if (IS_ERR(vbuf)) {
139 *vbuffer_p = NULL;
140 return ERR_CAST(vbuf);
141 }
142 *vbuffer_p = vbuf;
143 return (struct virtio_gpu_update_cursor *)vbuf->buf;
144}
145
146static void *virtio_gpu_alloc_cmd_resp(struct virtio_gpu_device *vgdev,
147 virtio_gpu_resp_cb cb,
148 struct virtio_gpu_vbuffer **vbuffer_p,
149 int cmd_size, int resp_size,
150 void *resp_buf)
151{
152 struct virtio_gpu_vbuffer *vbuf;
153
154 vbuf = virtio_gpu_get_vbuf(vgdev, cmd_size,
155 resp_size, resp_buf, cb);
156 if (IS_ERR(vbuf)) {
157 *vbuffer_p = NULL;
158 return ERR_CAST(vbuf);
159 }
160 *vbuffer_p = vbuf;
161 return (struct virtio_gpu_command *)vbuf->buf;
162}
163
164static void free_vbuf(struct virtio_gpu_device *vgdev,
165 struct virtio_gpu_vbuffer *vbuf)
166{
167 if (vbuf->resp_size > MAX_INLINE_RESP_SIZE)
168 kfree(vbuf->resp_buf);
169 kvfree(vbuf->data_buf);
170 kmem_cache_free(vgdev->vbufs, vbuf);
171}
172
173static void reclaim_vbufs(struct virtqueue *vq, struct list_head *reclaim_list)
174{
175 struct virtio_gpu_vbuffer *vbuf;
176 unsigned int len;
177 int freed = 0;
178
179 while ((vbuf = virtqueue_get_buf(vq, &len))) {
180 list_add_tail(&vbuf->list, reclaim_list);
181 freed++;
182 }
183 if (freed == 0)
184 DRM_DEBUG("Huh? zero vbufs reclaimed");
185}
186
187void virtio_gpu_dequeue_ctrl_func(struct work_struct *work)
188{
189 struct virtio_gpu_device *vgdev =
190 container_of(work, struct virtio_gpu_device,
191 ctrlq.dequeue_work);
192 struct list_head reclaim_list;
193 struct virtio_gpu_vbuffer *entry, *tmp;
194 struct virtio_gpu_ctrl_hdr *resp;
195 u64 fence_id = 0;
196
197 INIT_LIST_HEAD(&reclaim_list);
198 spin_lock(&vgdev->ctrlq.qlock);
199 do {
200 virtqueue_disable_cb(vgdev->ctrlq.vq);
201 reclaim_vbufs(vgdev->ctrlq.vq, &reclaim_list);
202
203 } while (!virtqueue_enable_cb(vgdev->ctrlq.vq));
204 spin_unlock(&vgdev->ctrlq.qlock);
205
206 list_for_each_entry(entry, &reclaim_list, list) {
207 resp = (struct virtio_gpu_ctrl_hdr *)entry->resp_buf;
208
209 trace_virtio_gpu_cmd_response(vgdev->ctrlq.vq, resp);
210
211 if (resp->type != cpu_to_le32(VIRTIO_GPU_RESP_OK_NODATA)) {
212 if (resp->type >= cpu_to_le32(VIRTIO_GPU_RESP_ERR_UNSPEC)) {
213 struct virtio_gpu_ctrl_hdr *cmd;
214 cmd = (struct virtio_gpu_ctrl_hdr *)entry->buf;
215 DRM_ERROR("response 0x%x (command 0x%x)\n",
216 le32_to_cpu(resp->type),
217 le32_to_cpu(cmd->type));
218 } else
219 DRM_DEBUG("response 0x%x\n", le32_to_cpu(resp->type));
220 }
221 if (resp->flags & cpu_to_le32(VIRTIO_GPU_FLAG_FENCE)) {
222 u64 f = le64_to_cpu(resp->fence_id);
223
224 if (fence_id > f) {
225 DRM_ERROR("%s: Oops: fence %llx -> %llx\n",
226 __func__, fence_id, f);
227 } else {
228 fence_id = f;
229 }
230 }
231 if (entry->resp_cb)
232 entry->resp_cb(vgdev, entry);
233 }
234 wake_up(&vgdev->ctrlq.ack_queue);
235
236 if (fence_id)
237 virtio_gpu_fence_event_process(vgdev, fence_id);
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 list_del(&entry->list);
265 free_vbuf(vgdev, entry);
266 }
267 wake_up(&vgdev->cursorq.ack_queue);
268}
269
270
271static struct sg_table *vmalloc_to_sgt(char *data, uint32_t size, int *sg_ents)
272{
273 int ret, s, i;
274 struct sg_table *sgt;
275 struct scatterlist *sg;
276 struct page *pg;
277
278 if (WARN_ON(!PAGE_ALIGNED(data)))
279 return NULL;
280
281 sgt = kmalloc(sizeof(*sgt), GFP_KERNEL);
282 if (!sgt)
283 return NULL;
284
285 *sg_ents = DIV_ROUND_UP(size, PAGE_SIZE);
286 ret = sg_alloc_table(sgt, *sg_ents, GFP_KERNEL);
287 if (ret) {
288 kfree(sgt);
289 return NULL;
290 }
291
292 for_each_sg(sgt->sgl, sg, *sg_ents, i) {
293 pg = vmalloc_to_page(data);
294 if (!pg) {
295 sg_free_table(sgt);
296 kfree(sgt);
297 return NULL;
298 }
299
300 s = min_t(int, PAGE_SIZE, size);
301 sg_set_page(sg, pg, s, 0);
302
303 size -= s;
304 data += s;
305 }
306
307 return sgt;
308}
309
310static bool virtio_gpu_queue_ctrl_buffer_locked(struct virtio_gpu_device *vgdev,
311 struct virtio_gpu_vbuffer *vbuf,
312 struct scatterlist *vout)
313 __releases(&vgdev->ctrlq.qlock)
314 __acquires(&vgdev->ctrlq.qlock)
315{
316 struct virtqueue *vq = vgdev->ctrlq.vq;
317 struct scatterlist *sgs[3], vcmd, vresp;
318 int outcnt = 0, incnt = 0;
319 bool notify = false;
320 int ret;
321
322 if (!vgdev->vqs_ready)
323 return notify;
324
325 sg_init_one(&vcmd, vbuf->buf, vbuf->size);
326 sgs[outcnt + incnt] = &vcmd;
327 outcnt++;
328
329 if (vout) {
330 sgs[outcnt + incnt] = vout;
331 outcnt++;
332 }
333
334 if (vbuf->resp_size) {
335 sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size);
336 sgs[outcnt + incnt] = &vresp;
337 incnt++;
338 }
339
340retry:
341 ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC);
342 if (ret == -ENOSPC) {
343 spin_unlock(&vgdev->ctrlq.qlock);
344 wait_event(vgdev->ctrlq.ack_queue, vq->num_free >= outcnt + incnt);
345 spin_lock(&vgdev->ctrlq.qlock);
346 goto retry;
347 } else {
348 trace_virtio_gpu_cmd_queue(vq,
349 (struct virtio_gpu_ctrl_hdr *)vbuf->buf);
350
351 notify = virtqueue_kick_prepare(vq);
352 }
353 return notify;
354}
355
356static void virtio_gpu_queue_fenced_ctrl_buffer(struct virtio_gpu_device *vgdev,
357 struct virtio_gpu_vbuffer *vbuf,
358 struct virtio_gpu_ctrl_hdr *hdr,
359 struct virtio_gpu_fence *fence)
360{
361 struct virtqueue *vq = vgdev->ctrlq.vq;
362 struct scatterlist *vout = NULL, sg;
363 struct sg_table *sgt = NULL;
364 bool notify;
365 int outcnt = 0;
366
367 if (vbuf->data_size) {
368 if (is_vmalloc_addr(vbuf->data_buf)) {
369 sgt = vmalloc_to_sgt(vbuf->data_buf, vbuf->data_size,
370 &outcnt);
371 if (!sgt)
372 return;
373 vout = sgt->sgl;
374 } else {
375 sg_init_one(&sg, vbuf->data_buf, vbuf->data_size);
376 vout = &sg;
377 outcnt = 1;
378 }
379 }
380
381again:
382 spin_lock(&vgdev->ctrlq.qlock);
383
384
385
386
387
388
389
390
391
392 if (vq->num_free < 2 + outcnt) {
393 spin_unlock(&vgdev->ctrlq.qlock);
394 wait_event(vgdev->ctrlq.ack_queue, vq->num_free >= 3);
395 goto again;
396 }
397
398 if (hdr && fence) {
399 virtio_gpu_fence_emit(vgdev, hdr, fence);
400 if (vbuf->objs) {
401 virtio_gpu_array_add_fence(vbuf->objs, &fence->f);
402 virtio_gpu_array_unlock_resv(vbuf->objs);
403 }
404 }
405 notify = virtio_gpu_queue_ctrl_buffer_locked(vgdev, vbuf, vout);
406 spin_unlock(&vgdev->ctrlq.qlock);
407 if (notify) {
408 if (vgdev->disable_notify)
409 vgdev->pending_notify = true;
410 else
411 virtqueue_notify(vgdev->ctrlq.vq);
412 }
413
414 if (sgt) {
415 sg_free_table(sgt);
416 kfree(sgt);
417 }
418}
419
420void virtio_gpu_disable_notify(struct virtio_gpu_device *vgdev)
421{
422 vgdev->disable_notify = true;
423}
424
425void virtio_gpu_enable_notify(struct virtio_gpu_device *vgdev)
426{
427 vgdev->disable_notify = false;
428
429 if (!vgdev->pending_notify)
430 return;
431 vgdev->pending_notify = false;
432 virtqueue_notify(vgdev->ctrlq.vq);
433}
434
435static void virtio_gpu_queue_ctrl_buffer(struct virtio_gpu_device *vgdev,
436 struct virtio_gpu_vbuffer *vbuf)
437{
438 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, NULL, NULL);
439}
440
441static void virtio_gpu_queue_cursor(struct virtio_gpu_device *vgdev,
442 struct virtio_gpu_vbuffer *vbuf)
443{
444 struct virtqueue *vq = vgdev->cursorq.vq;
445 struct scatterlist *sgs[1], ccmd;
446 bool notify;
447 int ret;
448 int outcnt;
449
450 if (!vgdev->vqs_ready)
451 return;
452
453 sg_init_one(&ccmd, vbuf->buf, vbuf->size);
454 sgs[0] = &ccmd;
455 outcnt = 1;
456
457 spin_lock(&vgdev->cursorq.qlock);
458retry:
459 ret = virtqueue_add_sgs(vq, sgs, outcnt, 0, vbuf, GFP_ATOMIC);
460 if (ret == -ENOSPC) {
461 spin_unlock(&vgdev->cursorq.qlock);
462 wait_event(vgdev->cursorq.ack_queue, vq->num_free >= outcnt);
463 spin_lock(&vgdev->cursorq.qlock);
464 goto retry;
465 } else {
466 trace_virtio_gpu_cmd_queue(vq,
467 (struct virtio_gpu_ctrl_hdr *)vbuf->buf);
468
469 notify = virtqueue_kick_prepare(vq);
470 }
471
472 spin_unlock(&vgdev->cursorq.qlock);
473
474 if (notify)
475 virtqueue_notify(vq);
476}
477
478
479
480
481
482
483void virtio_gpu_cmd_create_resource(struct virtio_gpu_device *vgdev,
484 struct virtio_gpu_object *bo,
485 struct virtio_gpu_object_params *params,
486 struct virtio_gpu_object_array *objs,
487 struct virtio_gpu_fence *fence)
488{
489 struct virtio_gpu_resource_create_2d *cmd_p;
490 struct virtio_gpu_vbuffer *vbuf;
491
492 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
493 memset(cmd_p, 0, sizeof(*cmd_p));
494 vbuf->objs = objs;
495
496 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_2D);
497 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
498 cmd_p->format = cpu_to_le32(params->format);
499 cmd_p->width = cpu_to_le32(params->width);
500 cmd_p->height = cpu_to_le32(params->height);
501
502 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
503 bo->created = true;
504}
505
506void virtio_gpu_cmd_unref_resource(struct virtio_gpu_device *vgdev,
507 uint32_t resource_id)
508{
509 struct virtio_gpu_resource_unref *cmd_p;
510 struct virtio_gpu_vbuffer *vbuf;
511
512 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
513 memset(cmd_p, 0, sizeof(*cmd_p));
514
515 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNREF);
516 cmd_p->resource_id = cpu_to_le32(resource_id);
517
518 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
519}
520
521static void virtio_gpu_cmd_resource_inval_backing(struct virtio_gpu_device *vgdev,
522 uint32_t resource_id,
523 struct virtio_gpu_fence *fence)
524{
525 struct virtio_gpu_resource_detach_backing *cmd_p;
526 struct virtio_gpu_vbuffer *vbuf;
527
528 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
529 memset(cmd_p, 0, sizeof(*cmd_p));
530
531 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_DETACH_BACKING);
532 cmd_p->resource_id = cpu_to_le32(resource_id);
533
534 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
535}
536
537void virtio_gpu_cmd_set_scanout(struct virtio_gpu_device *vgdev,
538 uint32_t scanout_id, uint32_t resource_id,
539 uint32_t width, uint32_t height,
540 uint32_t x, uint32_t y)
541{
542 struct virtio_gpu_set_scanout *cmd_p;
543 struct virtio_gpu_vbuffer *vbuf;
544
545 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
546 memset(cmd_p, 0, sizeof(*cmd_p));
547
548 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT);
549 cmd_p->resource_id = cpu_to_le32(resource_id);
550 cmd_p->scanout_id = cpu_to_le32(scanout_id);
551 cmd_p->r.width = cpu_to_le32(width);
552 cmd_p->r.height = cpu_to_le32(height);
553 cmd_p->r.x = cpu_to_le32(x);
554 cmd_p->r.y = cpu_to_le32(y);
555
556 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
557}
558
559void virtio_gpu_cmd_resource_flush(struct virtio_gpu_device *vgdev,
560 uint32_t resource_id,
561 uint32_t x, uint32_t y,
562 uint32_t width, uint32_t height)
563{
564 struct virtio_gpu_resource_flush *cmd_p;
565 struct virtio_gpu_vbuffer *vbuf;
566
567 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
568 memset(cmd_p, 0, sizeof(*cmd_p));
569
570 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_FLUSH);
571 cmd_p->resource_id = cpu_to_le32(resource_id);
572 cmd_p->r.width = cpu_to_le32(width);
573 cmd_p->r.height = cpu_to_le32(height);
574 cmd_p->r.x = cpu_to_le32(x);
575 cmd_p->r.y = cpu_to_le32(y);
576
577 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
578}
579
580void virtio_gpu_cmd_transfer_to_host_2d(struct virtio_gpu_device *vgdev,
581 uint64_t offset,
582 uint32_t width, uint32_t height,
583 uint32_t x, uint32_t y,
584 struct virtio_gpu_object_array *objs,
585 struct virtio_gpu_fence *fence)
586{
587 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
588 struct virtio_gpu_transfer_to_host_2d *cmd_p;
589 struct virtio_gpu_vbuffer *vbuf;
590 bool use_dma_api = !virtio_has_iommu_quirk(vgdev->vdev);
591
592 if (use_dma_api)
593 dma_sync_sg_for_device(vgdev->vdev->dev.parent,
594 bo->pages->sgl, bo->pages->nents,
595 DMA_TO_DEVICE);
596
597 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
598 memset(cmd_p, 0, sizeof(*cmd_p));
599 vbuf->objs = objs;
600
601 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D);
602 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
603 cmd_p->offset = cpu_to_le64(offset);
604 cmd_p->r.width = cpu_to_le32(width);
605 cmd_p->r.height = cpu_to_le32(height);
606 cmd_p->r.x = cpu_to_le32(x);
607 cmd_p->r.y = cpu_to_le32(y);
608
609 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
610}
611
612static void
613virtio_gpu_cmd_resource_attach_backing(struct virtio_gpu_device *vgdev,
614 uint32_t resource_id,
615 struct virtio_gpu_mem_entry *ents,
616 uint32_t nents,
617 struct virtio_gpu_fence *fence)
618{
619 struct virtio_gpu_resource_attach_backing *cmd_p;
620 struct virtio_gpu_vbuffer *vbuf;
621
622 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
623 memset(cmd_p, 0, sizeof(*cmd_p));
624
625 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ATTACH_BACKING);
626 cmd_p->resource_id = cpu_to_le32(resource_id);
627 cmd_p->nr_entries = cpu_to_le32(nents);
628
629 vbuf->data_buf = ents;
630 vbuf->data_size = sizeof(*ents) * nents;
631
632 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
633}
634
635static void virtio_gpu_cmd_get_display_info_cb(struct virtio_gpu_device *vgdev,
636 struct virtio_gpu_vbuffer *vbuf)
637{
638 struct virtio_gpu_resp_display_info *resp =
639 (struct virtio_gpu_resp_display_info *)vbuf->resp_buf;
640 int i;
641
642 spin_lock(&vgdev->display_info_lock);
643 for (i = 0; i < vgdev->num_scanouts; i++) {
644 vgdev->outputs[i].info = resp->pmodes[i];
645 if (resp->pmodes[i].enabled) {
646 DRM_DEBUG("output %d: %dx%d+%d+%d", i,
647 le32_to_cpu(resp->pmodes[i].r.width),
648 le32_to_cpu(resp->pmodes[i].r.height),
649 le32_to_cpu(resp->pmodes[i].r.x),
650 le32_to_cpu(resp->pmodes[i].r.y));
651 } else {
652 DRM_DEBUG("output %d: disabled", i);
653 }
654 }
655
656 vgdev->display_info_pending = false;
657 spin_unlock(&vgdev->display_info_lock);
658 wake_up(&vgdev->resp_wq);
659
660 if (!drm_helper_hpd_irq_event(vgdev->ddev))
661 drm_kms_helper_hotplug_event(vgdev->ddev);
662}
663
664static void virtio_gpu_cmd_get_capset_info_cb(struct virtio_gpu_device *vgdev,
665 struct virtio_gpu_vbuffer *vbuf)
666{
667 struct virtio_gpu_get_capset_info *cmd =
668 (struct virtio_gpu_get_capset_info *)vbuf->buf;
669 struct virtio_gpu_resp_capset_info *resp =
670 (struct virtio_gpu_resp_capset_info *)vbuf->resp_buf;
671 int i = le32_to_cpu(cmd->capset_index);
672
673 spin_lock(&vgdev->display_info_lock);
674 vgdev->capsets[i].id = le32_to_cpu(resp->capset_id);
675 vgdev->capsets[i].max_version = le32_to_cpu(resp->capset_max_version);
676 vgdev->capsets[i].max_size = le32_to_cpu(resp->capset_max_size);
677 spin_unlock(&vgdev->display_info_lock);
678 wake_up(&vgdev->resp_wq);
679}
680
681static void virtio_gpu_cmd_capset_cb(struct virtio_gpu_device *vgdev,
682 struct virtio_gpu_vbuffer *vbuf)
683{
684 struct virtio_gpu_get_capset *cmd =
685 (struct virtio_gpu_get_capset *)vbuf->buf;
686 struct virtio_gpu_resp_capset *resp =
687 (struct virtio_gpu_resp_capset *)vbuf->resp_buf;
688 struct virtio_gpu_drv_cap_cache *cache_ent;
689
690 spin_lock(&vgdev->display_info_lock);
691 list_for_each_entry(cache_ent, &vgdev->cap_cache, head) {
692 if (cache_ent->version == le32_to_cpu(cmd->capset_version) &&
693 cache_ent->id == le32_to_cpu(cmd->capset_id)) {
694 memcpy(cache_ent->caps_cache, resp->capset_data,
695 cache_ent->size);
696
697 smp_wmb();
698 atomic_set(&cache_ent->is_valid, 1);
699 break;
700 }
701 }
702 spin_unlock(&vgdev->display_info_lock);
703 wake_up_all(&vgdev->resp_wq);
704}
705
706static int virtio_get_edid_block(void *data, u8 *buf,
707 unsigned int block, size_t len)
708{
709 struct virtio_gpu_resp_edid *resp = data;
710 size_t start = block * EDID_LENGTH;
711
712 if (start + len > le32_to_cpu(resp->size))
713 return -1;
714 memcpy(buf, resp->edid + start, len);
715 return 0;
716}
717
718static void virtio_gpu_cmd_get_edid_cb(struct virtio_gpu_device *vgdev,
719 struct virtio_gpu_vbuffer *vbuf)
720{
721 struct virtio_gpu_cmd_get_edid *cmd =
722 (struct virtio_gpu_cmd_get_edid *)vbuf->buf;
723 struct virtio_gpu_resp_edid *resp =
724 (struct virtio_gpu_resp_edid *)vbuf->resp_buf;
725 uint32_t scanout = le32_to_cpu(cmd->scanout);
726 struct virtio_gpu_output *output;
727 struct edid *new_edid, *old_edid;
728
729 if (scanout >= vgdev->num_scanouts)
730 return;
731 output = vgdev->outputs + scanout;
732
733 new_edid = drm_do_get_edid(&output->conn, virtio_get_edid_block, resp);
734 drm_connector_update_edid_property(&output->conn, new_edid);
735
736 spin_lock(&vgdev->display_info_lock);
737 old_edid = output->edid;
738 output->edid = new_edid;
739 spin_unlock(&vgdev->display_info_lock);
740
741 kfree(old_edid);
742 wake_up(&vgdev->resp_wq);
743}
744
745int virtio_gpu_cmd_get_display_info(struct virtio_gpu_device *vgdev)
746{
747 struct virtio_gpu_ctrl_hdr *cmd_p;
748 struct virtio_gpu_vbuffer *vbuf;
749 void *resp_buf;
750
751 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_display_info),
752 GFP_KERNEL);
753 if (!resp_buf)
754 return -ENOMEM;
755
756 cmd_p = virtio_gpu_alloc_cmd_resp
757 (vgdev, &virtio_gpu_cmd_get_display_info_cb, &vbuf,
758 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_display_info),
759 resp_buf);
760 memset(cmd_p, 0, sizeof(*cmd_p));
761
762 vgdev->display_info_pending = true;
763 cmd_p->type = cpu_to_le32(VIRTIO_GPU_CMD_GET_DISPLAY_INFO);
764 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
765 return 0;
766}
767
768int virtio_gpu_cmd_get_capset_info(struct virtio_gpu_device *vgdev, int idx)
769{
770 struct virtio_gpu_get_capset_info *cmd_p;
771 struct virtio_gpu_vbuffer *vbuf;
772 void *resp_buf;
773
774 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset_info),
775 GFP_KERNEL);
776 if (!resp_buf)
777 return -ENOMEM;
778
779 cmd_p = virtio_gpu_alloc_cmd_resp
780 (vgdev, &virtio_gpu_cmd_get_capset_info_cb, &vbuf,
781 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_capset_info),
782 resp_buf);
783 memset(cmd_p, 0, sizeof(*cmd_p));
784
785 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET_INFO);
786 cmd_p->capset_index = cpu_to_le32(idx);
787 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
788 return 0;
789}
790
791int virtio_gpu_cmd_get_capset(struct virtio_gpu_device *vgdev,
792 int idx, int version,
793 struct virtio_gpu_drv_cap_cache **cache_p)
794{
795 struct virtio_gpu_get_capset *cmd_p;
796 struct virtio_gpu_vbuffer *vbuf;
797 int max_size;
798 struct virtio_gpu_drv_cap_cache *cache_ent;
799 struct virtio_gpu_drv_cap_cache *search_ent;
800 void *resp_buf;
801
802 *cache_p = NULL;
803
804 if (idx >= vgdev->num_capsets)
805 return -EINVAL;
806
807 if (version > vgdev->capsets[idx].max_version)
808 return -EINVAL;
809
810 cache_ent = kzalloc(sizeof(*cache_ent), GFP_KERNEL);
811 if (!cache_ent)
812 return -ENOMEM;
813
814 max_size = vgdev->capsets[idx].max_size;
815 cache_ent->caps_cache = kmalloc(max_size, GFP_KERNEL);
816 if (!cache_ent->caps_cache) {
817 kfree(cache_ent);
818 return -ENOMEM;
819 }
820
821 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset) + max_size,
822 GFP_KERNEL);
823 if (!resp_buf) {
824 kfree(cache_ent->caps_cache);
825 kfree(cache_ent);
826 return -ENOMEM;
827 }
828
829 cache_ent->version = version;
830 cache_ent->id = vgdev->capsets[idx].id;
831 atomic_set(&cache_ent->is_valid, 0);
832 cache_ent->size = max_size;
833 spin_lock(&vgdev->display_info_lock);
834
835 list_for_each_entry(search_ent, &vgdev->cap_cache, head) {
836 if (search_ent->id == vgdev->capsets[idx].id &&
837 search_ent->version == version) {
838 *cache_p = search_ent;
839 break;
840 }
841 }
842 if (!*cache_p)
843 list_add_tail(&cache_ent->head, &vgdev->cap_cache);
844 spin_unlock(&vgdev->display_info_lock);
845
846 if (*cache_p) {
847
848 kfree(resp_buf);
849 kfree(cache_ent->caps_cache);
850 kfree(cache_ent);
851 return 0;
852 }
853
854 cmd_p = virtio_gpu_alloc_cmd_resp
855 (vgdev, &virtio_gpu_cmd_capset_cb, &vbuf, sizeof(*cmd_p),
856 sizeof(struct virtio_gpu_resp_capset) + max_size,
857 resp_buf);
858 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET);
859 cmd_p->capset_id = cpu_to_le32(vgdev->capsets[idx].id);
860 cmd_p->capset_version = cpu_to_le32(version);
861 *cache_p = cache_ent;
862 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
863
864 return 0;
865}
866
867int virtio_gpu_cmd_get_edids(struct virtio_gpu_device *vgdev)
868{
869 struct virtio_gpu_cmd_get_edid *cmd_p;
870 struct virtio_gpu_vbuffer *vbuf;
871 void *resp_buf;
872 int scanout;
873
874 if (WARN_ON(!vgdev->has_edid))
875 return -EINVAL;
876
877 for (scanout = 0; scanout < vgdev->num_scanouts; scanout++) {
878 resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_edid),
879 GFP_KERNEL);
880 if (!resp_buf)
881 return -ENOMEM;
882
883 cmd_p = virtio_gpu_alloc_cmd_resp
884 (vgdev, &virtio_gpu_cmd_get_edid_cb, &vbuf,
885 sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_edid),
886 resp_buf);
887 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_EDID);
888 cmd_p->scanout = cpu_to_le32(scanout);
889 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
890 }
891
892 return 0;
893}
894
895void virtio_gpu_cmd_context_create(struct virtio_gpu_device *vgdev, uint32_t id,
896 uint32_t nlen, const char *name)
897{
898 struct virtio_gpu_ctx_create *cmd_p;
899 struct virtio_gpu_vbuffer *vbuf;
900
901 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
902 memset(cmd_p, 0, sizeof(*cmd_p));
903
904 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_CREATE);
905 cmd_p->hdr.ctx_id = cpu_to_le32(id);
906 cmd_p->nlen = cpu_to_le32(nlen);
907 strncpy(cmd_p->debug_name, name, sizeof(cmd_p->debug_name) - 1);
908 cmd_p->debug_name[sizeof(cmd_p->debug_name) - 1] = 0;
909 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
910}
911
912void virtio_gpu_cmd_context_destroy(struct virtio_gpu_device *vgdev,
913 uint32_t id)
914{
915 struct virtio_gpu_ctx_destroy *cmd_p;
916 struct virtio_gpu_vbuffer *vbuf;
917
918 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
919 memset(cmd_p, 0, sizeof(*cmd_p));
920
921 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DESTROY);
922 cmd_p->hdr.ctx_id = cpu_to_le32(id);
923 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
924}
925
926void virtio_gpu_cmd_context_attach_resource(struct virtio_gpu_device *vgdev,
927 uint32_t ctx_id,
928 struct virtio_gpu_object_array *objs)
929{
930 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
931 struct virtio_gpu_ctx_resource *cmd_p;
932 struct virtio_gpu_vbuffer *vbuf;
933
934 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
935 memset(cmd_p, 0, sizeof(*cmd_p));
936 vbuf->objs = objs;
937
938 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_ATTACH_RESOURCE);
939 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
940 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
941 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
942
943}
944
945void virtio_gpu_cmd_context_detach_resource(struct virtio_gpu_device *vgdev,
946 uint32_t ctx_id,
947 struct virtio_gpu_object_array *objs)
948{
949 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
950 struct virtio_gpu_ctx_resource *cmd_p;
951 struct virtio_gpu_vbuffer *vbuf;
952
953 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
954 memset(cmd_p, 0, sizeof(*cmd_p));
955 vbuf->objs = objs;
956
957 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DETACH_RESOURCE);
958 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
959 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
960 virtio_gpu_queue_ctrl_buffer(vgdev, vbuf);
961}
962
963void
964virtio_gpu_cmd_resource_create_3d(struct virtio_gpu_device *vgdev,
965 struct virtio_gpu_object *bo,
966 struct virtio_gpu_object_params *params,
967 struct virtio_gpu_object_array *objs,
968 struct virtio_gpu_fence *fence)
969{
970 struct virtio_gpu_resource_create_3d *cmd_p;
971 struct virtio_gpu_vbuffer *vbuf;
972
973 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
974 memset(cmd_p, 0, sizeof(*cmd_p));
975 vbuf->objs = objs;
976
977 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_3D);
978 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
979 cmd_p->format = cpu_to_le32(params->format);
980 cmd_p->width = cpu_to_le32(params->width);
981 cmd_p->height = cpu_to_le32(params->height);
982
983 cmd_p->target = cpu_to_le32(params->target);
984 cmd_p->bind = cpu_to_le32(params->bind);
985 cmd_p->depth = cpu_to_le32(params->depth);
986 cmd_p->array_size = cpu_to_le32(params->array_size);
987 cmd_p->last_level = cpu_to_le32(params->last_level);
988 cmd_p->nr_samples = cpu_to_le32(params->nr_samples);
989 cmd_p->flags = cpu_to_le32(params->flags);
990
991 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
992 bo->created = true;
993}
994
995void virtio_gpu_cmd_transfer_to_host_3d(struct virtio_gpu_device *vgdev,
996 uint32_t ctx_id,
997 uint64_t offset, uint32_t level,
998 struct drm_virtgpu_3d_box *box,
999 struct virtio_gpu_object_array *objs,
1000 struct virtio_gpu_fence *fence)
1001{
1002 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1003 struct virtio_gpu_transfer_host_3d *cmd_p;
1004 struct virtio_gpu_vbuffer *vbuf;
1005 bool use_dma_api = !virtio_has_iommu_quirk(vgdev->vdev);
1006
1007 if (use_dma_api)
1008 dma_sync_sg_for_device(vgdev->vdev->dev.parent,
1009 bo->pages->sgl, bo->pages->nents,
1010 DMA_TO_DEVICE);
1011
1012 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1013 memset(cmd_p, 0, sizeof(*cmd_p));
1014
1015 vbuf->objs = objs;
1016
1017 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_3D);
1018 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1019 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1020 convert_to_hw_box(&cmd_p->box, box);
1021 cmd_p->offset = cpu_to_le64(offset);
1022 cmd_p->level = cpu_to_le32(level);
1023
1024 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
1025}
1026
1027void virtio_gpu_cmd_transfer_from_host_3d(struct virtio_gpu_device *vgdev,
1028 uint32_t ctx_id,
1029 uint64_t offset, uint32_t level,
1030 struct drm_virtgpu_3d_box *box,
1031 struct virtio_gpu_object_array *objs,
1032 struct virtio_gpu_fence *fence)
1033{
1034 struct virtio_gpu_object *bo = gem_to_virtio_gpu_obj(objs->objs[0]);
1035 struct virtio_gpu_transfer_host_3d *cmd_p;
1036 struct virtio_gpu_vbuffer *vbuf;
1037
1038 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1039 memset(cmd_p, 0, sizeof(*cmd_p));
1040
1041 vbuf->objs = objs;
1042
1043 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_FROM_HOST_3D);
1044 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1045 cmd_p->resource_id = cpu_to_le32(bo->hw_res_handle);
1046 convert_to_hw_box(&cmd_p->box, box);
1047 cmd_p->offset = cpu_to_le64(offset);
1048 cmd_p->level = cpu_to_le32(level);
1049
1050 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
1051}
1052
1053void virtio_gpu_cmd_submit(struct virtio_gpu_device *vgdev,
1054 void *data, uint32_t data_size,
1055 uint32_t ctx_id,
1056 struct virtio_gpu_object_array *objs,
1057 struct virtio_gpu_fence *fence)
1058{
1059 struct virtio_gpu_cmd_submit *cmd_p;
1060 struct virtio_gpu_vbuffer *vbuf;
1061
1062 cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p));
1063 memset(cmd_p, 0, sizeof(*cmd_p));
1064
1065 vbuf->data_buf = data;
1066 vbuf->data_size = data_size;
1067 vbuf->objs = objs;
1068
1069 cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SUBMIT_3D);
1070 cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id);
1071 cmd_p->size = cpu_to_le32(data_size);
1072
1073 virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence);
1074}
1075
1076int virtio_gpu_object_attach(struct virtio_gpu_device *vgdev,
1077 struct virtio_gpu_object *obj,
1078 struct virtio_gpu_fence *fence)
1079{
1080 bool use_dma_api = !virtio_has_iommu_quirk(vgdev->vdev);
1081 struct virtio_gpu_mem_entry *ents;
1082 struct scatterlist *sg;
1083 int si, nents, ret;
1084
1085 if (WARN_ON_ONCE(!obj->created))
1086 return -EINVAL;
1087 if (WARN_ON_ONCE(obj->pages))
1088 return -EINVAL;
1089
1090 ret = drm_gem_shmem_pin(&obj->base.base);
1091 if (ret < 0)
1092 return -EINVAL;
1093
1094 obj->pages = drm_gem_shmem_get_sg_table(&obj->base.base);
1095 if (obj->pages == NULL) {
1096 drm_gem_shmem_unpin(&obj->base.base);
1097 return -EINVAL;
1098 }
1099
1100 if (use_dma_api) {
1101 obj->mapped = dma_map_sg(vgdev->vdev->dev.parent,
1102 obj->pages->sgl, obj->pages->nents,
1103 DMA_TO_DEVICE);
1104 nents = obj->mapped;
1105 } else {
1106 nents = obj->pages->nents;
1107 }
1108
1109
1110 ents = kmalloc_array(nents, sizeof(struct virtio_gpu_mem_entry),
1111 GFP_KERNEL);
1112 if (!ents) {
1113 DRM_ERROR("failed to allocate ent list\n");
1114 return -ENOMEM;
1115 }
1116
1117 for_each_sg(obj->pages->sgl, sg, nents, si) {
1118 ents[si].addr = cpu_to_le64(use_dma_api
1119 ? sg_dma_address(sg)
1120 : sg_phys(sg));
1121 ents[si].length = cpu_to_le32(sg->length);
1122 ents[si].padding = 0;
1123 }
1124
1125 virtio_gpu_cmd_resource_attach_backing(vgdev, obj->hw_res_handle,
1126 ents, nents,
1127 fence);
1128 return 0;
1129}
1130
1131void virtio_gpu_object_detach(struct virtio_gpu_device *vgdev,
1132 struct virtio_gpu_object *obj)
1133{
1134 bool use_dma_api = !virtio_has_iommu_quirk(vgdev->vdev);
1135
1136 if (WARN_ON_ONCE(!obj->pages))
1137 return;
1138
1139 if (use_dma_api && obj->mapped) {
1140 struct virtio_gpu_fence *fence = virtio_gpu_fence_alloc(vgdev);
1141
1142 virtio_gpu_cmd_resource_inval_backing(vgdev, obj->hw_res_handle, fence);
1143 dma_fence_wait(&fence->f, true);
1144 dma_fence_put(&fence->f);
1145
1146
1147 dma_unmap_sg(vgdev->vdev->dev.parent,
1148 obj->pages->sgl, obj->mapped,
1149 DMA_TO_DEVICE);
1150 obj->mapped = 0;
1151 } else {
1152 virtio_gpu_cmd_resource_inval_backing(vgdev, obj->hw_res_handle, NULL);
1153 }
1154
1155 sg_free_table(obj->pages);
1156 obj->pages = NULL;
1157
1158 drm_gem_shmem_unpin(&obj->base.base);
1159}
1160
1161void virtio_gpu_cursor_ping(struct virtio_gpu_device *vgdev,
1162 struct virtio_gpu_output *output)
1163{
1164 struct virtio_gpu_vbuffer *vbuf;
1165 struct virtio_gpu_update_cursor *cur_p;
1166
1167 output->cursor.pos.scanout_id = cpu_to_le32(output->index);
1168 cur_p = virtio_gpu_alloc_cursor(vgdev, &vbuf);
1169 memcpy(cur_p, &output->cursor, sizeof(output->cursor));
1170 virtio_gpu_queue_cursor(vgdev, vbuf);
1171}
1172
