Linux Audio

Check our new training course

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