Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2015 Red Hat, Inc. |
| 3 | * All Rights Reserved. |
| 4 | * |
| 5 | * Authors: |
| 6 | * Dave Airlie <airlied@redhat.com> |
| 7 | * Gerd Hoffmann <kraxel@redhat.com> |
| 8 | * |
| 9 | * Permission is hereby granted, free of charge, to any person obtaining a |
| 10 | * copy of this software and associated documentation files (the "Software"), |
| 11 | * to deal in the Software without restriction, including without limitation |
| 12 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
| 13 | * and/or sell copies of the Software, and to permit persons to whom the |
| 14 | * Software is furnished to do so, subject to the following conditions: |
| 15 | * |
| 16 | * The above copyright notice and this permission notice (including the next |
| 17 | * paragraph) shall be included in all copies or substantial portions of the |
| 18 | * Software. |
| 19 | * |
| 20 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| 21 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 22 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| 23 | * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR |
| 24 | * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
| 25 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
| 26 | * OTHER DEALINGS IN THE SOFTWARE. |
| 27 | */ |
| 28 | |
| 29 | #include <drm/drmP.h> |
| 30 | #include "virtgpu_drv.h" |
| 31 | #include <linux/virtio.h> |
| 32 | #include <linux/virtio_config.h> |
| 33 | #include <linux/virtio_ring.h> |
| 34 | |
| 35 | #define MAX_INLINE_CMD_SIZE 96 |
| 36 | #define MAX_INLINE_RESP_SIZE 24 |
| 37 | #define VBUFFER_SIZE (sizeof(struct virtio_gpu_vbuffer) \ |
| 38 | + MAX_INLINE_CMD_SIZE \ |
| 39 | + MAX_INLINE_RESP_SIZE) |
| 40 | |
| 41 | void virtio_gpu_resource_id_get(struct virtio_gpu_device *vgdev, |
| 42 | uint32_t *resid) |
| 43 | { |
| 44 | int handle; |
| 45 | |
| 46 | idr_preload(GFP_KERNEL); |
| 47 | spin_lock(&vgdev->resource_idr_lock); |
| 48 | handle = idr_alloc(&vgdev->resource_idr, NULL, 1, 0, GFP_NOWAIT); |
| 49 | spin_unlock(&vgdev->resource_idr_lock); |
| 50 | idr_preload_end(); |
| 51 | *resid = handle; |
| 52 | } |
| 53 | |
| 54 | void virtio_gpu_resource_id_put(struct virtio_gpu_device *vgdev, uint32_t id) |
| 55 | { |
| 56 | spin_lock(&vgdev->resource_idr_lock); |
| 57 | idr_remove(&vgdev->resource_idr, id); |
| 58 | spin_unlock(&vgdev->resource_idr_lock); |
| 59 | } |
| 60 | |
| 61 | void virtio_gpu_ctrl_ack(struct virtqueue *vq) |
| 62 | { |
| 63 | struct drm_device *dev = vq->vdev->priv; |
| 64 | struct virtio_gpu_device *vgdev = dev->dev_private; |
| 65 | schedule_work(&vgdev->ctrlq.dequeue_work); |
| 66 | } |
| 67 | |
| 68 | void virtio_gpu_cursor_ack(struct virtqueue *vq) |
| 69 | { |
| 70 | struct drm_device *dev = vq->vdev->priv; |
| 71 | struct virtio_gpu_device *vgdev = dev->dev_private; |
| 72 | schedule_work(&vgdev->cursorq.dequeue_work); |
| 73 | } |
| 74 | |
| 75 | int virtio_gpu_alloc_vbufs(struct virtio_gpu_device *vgdev) |
| 76 | { |
| 77 | struct virtio_gpu_vbuffer *vbuf; |
| 78 | int i, size, count = 0; |
| 79 | void *ptr; |
| 80 | |
| 81 | INIT_LIST_HEAD(&vgdev->free_vbufs); |
Dave Airlie | d5084f1 | 2015-06-16 15:42:13 +1000 | [diff] [blame] | 82 | spin_lock_init(&vgdev->free_vbufs_lock); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 83 | count += virtqueue_get_vring_size(vgdev->ctrlq.vq); |
| 84 | count += virtqueue_get_vring_size(vgdev->cursorq.vq); |
| 85 | size = count * VBUFFER_SIZE; |
| 86 | DRM_INFO("virtio vbuffers: %d bufs, %zdB each, %dkB total.\n", |
| 87 | count, VBUFFER_SIZE, size / 1024); |
| 88 | |
| 89 | vgdev->vbufs = kzalloc(size, GFP_KERNEL); |
| 90 | if (!vgdev->vbufs) |
| 91 | return -ENOMEM; |
| 92 | |
| 93 | for (i = 0, ptr = vgdev->vbufs; |
| 94 | i < count; |
| 95 | i++, ptr += VBUFFER_SIZE) { |
| 96 | vbuf = ptr; |
| 97 | list_add(&vbuf->list, &vgdev->free_vbufs); |
| 98 | } |
| 99 | return 0; |
| 100 | } |
| 101 | |
| 102 | void virtio_gpu_free_vbufs(struct virtio_gpu_device *vgdev) |
| 103 | { |
| 104 | struct virtio_gpu_vbuffer *vbuf; |
| 105 | int i, count = 0; |
| 106 | |
| 107 | count += virtqueue_get_vring_size(vgdev->ctrlq.vq); |
| 108 | count += virtqueue_get_vring_size(vgdev->cursorq.vq); |
| 109 | |
Dave Airlie | d5084f1 | 2015-06-16 15:42:13 +1000 | [diff] [blame] | 110 | spin_lock(&vgdev->free_vbufs_lock); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 111 | for (i = 0; i < count; i++) { |
| 112 | if (WARN_ON(list_empty(&vgdev->free_vbufs))) |
| 113 | return; |
| 114 | vbuf = list_first_entry(&vgdev->free_vbufs, |
| 115 | struct virtio_gpu_vbuffer, list); |
| 116 | list_del(&vbuf->list); |
| 117 | } |
Dave Airlie | d5084f1 | 2015-06-16 15:42:13 +1000 | [diff] [blame] | 118 | spin_unlock(&vgdev->free_vbufs_lock); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 119 | kfree(vgdev->vbufs); |
| 120 | } |
| 121 | |
| 122 | static struct virtio_gpu_vbuffer* |
| 123 | virtio_gpu_get_vbuf(struct virtio_gpu_device *vgdev, |
| 124 | int size, int resp_size, void *resp_buf, |
| 125 | virtio_gpu_resp_cb resp_cb) |
| 126 | { |
| 127 | struct virtio_gpu_vbuffer *vbuf; |
| 128 | |
Dave Airlie | d5084f1 | 2015-06-16 15:42:13 +1000 | [diff] [blame] | 129 | spin_lock(&vgdev->free_vbufs_lock); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 130 | BUG_ON(list_empty(&vgdev->free_vbufs)); |
| 131 | vbuf = list_first_entry(&vgdev->free_vbufs, |
| 132 | struct virtio_gpu_vbuffer, list); |
| 133 | list_del(&vbuf->list); |
Dave Airlie | d5084f1 | 2015-06-16 15:42:13 +1000 | [diff] [blame] | 134 | spin_unlock(&vgdev->free_vbufs_lock); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 135 | memset(vbuf, 0, VBUFFER_SIZE); |
| 136 | |
| 137 | BUG_ON(size > MAX_INLINE_CMD_SIZE); |
| 138 | vbuf->buf = (void *)vbuf + sizeof(*vbuf); |
| 139 | vbuf->size = size; |
| 140 | |
| 141 | vbuf->resp_cb = resp_cb; |
| 142 | vbuf->resp_size = resp_size; |
| 143 | if (resp_size <= MAX_INLINE_RESP_SIZE) |
| 144 | vbuf->resp_buf = (void *)vbuf->buf + size; |
| 145 | else |
| 146 | vbuf->resp_buf = resp_buf; |
| 147 | BUG_ON(!vbuf->resp_buf); |
| 148 | return vbuf; |
| 149 | } |
| 150 | |
| 151 | static void *virtio_gpu_alloc_cmd(struct virtio_gpu_device *vgdev, |
| 152 | struct virtio_gpu_vbuffer **vbuffer_p, |
| 153 | int size) |
| 154 | { |
| 155 | struct virtio_gpu_vbuffer *vbuf; |
| 156 | |
| 157 | vbuf = virtio_gpu_get_vbuf(vgdev, size, |
| 158 | sizeof(struct virtio_gpu_ctrl_hdr), |
| 159 | NULL, NULL); |
| 160 | if (IS_ERR(vbuf)) { |
| 161 | *vbuffer_p = NULL; |
| 162 | return ERR_CAST(vbuf); |
| 163 | } |
| 164 | *vbuffer_p = vbuf; |
| 165 | return vbuf->buf; |
| 166 | } |
| 167 | |
| 168 | static struct virtio_gpu_update_cursor* |
| 169 | virtio_gpu_alloc_cursor(struct virtio_gpu_device *vgdev, |
| 170 | struct virtio_gpu_vbuffer **vbuffer_p) |
| 171 | { |
| 172 | struct virtio_gpu_vbuffer *vbuf; |
| 173 | |
| 174 | vbuf = virtio_gpu_get_vbuf |
| 175 | (vgdev, sizeof(struct virtio_gpu_update_cursor), |
| 176 | 0, NULL, NULL); |
| 177 | if (IS_ERR(vbuf)) { |
| 178 | *vbuffer_p = NULL; |
| 179 | return ERR_CAST(vbuf); |
| 180 | } |
| 181 | *vbuffer_p = vbuf; |
| 182 | return (struct virtio_gpu_update_cursor *)vbuf->buf; |
| 183 | } |
| 184 | |
| 185 | static void *virtio_gpu_alloc_cmd_resp(struct virtio_gpu_device *vgdev, |
| 186 | virtio_gpu_resp_cb cb, |
| 187 | struct virtio_gpu_vbuffer **vbuffer_p, |
| 188 | int cmd_size, int resp_size, |
| 189 | void *resp_buf) |
| 190 | { |
| 191 | struct virtio_gpu_vbuffer *vbuf; |
| 192 | |
| 193 | vbuf = virtio_gpu_get_vbuf(vgdev, cmd_size, |
| 194 | resp_size, resp_buf, cb); |
| 195 | if (IS_ERR(vbuf)) { |
| 196 | *vbuffer_p = NULL; |
| 197 | return ERR_CAST(vbuf); |
| 198 | } |
| 199 | *vbuffer_p = vbuf; |
| 200 | return (struct virtio_gpu_command *)vbuf->buf; |
| 201 | } |
| 202 | |
| 203 | static void free_vbuf(struct virtio_gpu_device *vgdev, |
| 204 | struct virtio_gpu_vbuffer *vbuf) |
| 205 | { |
| 206 | if (vbuf->resp_size > MAX_INLINE_RESP_SIZE) |
| 207 | kfree(vbuf->resp_buf); |
| 208 | kfree(vbuf->data_buf); |
Dave Airlie | d5084f1 | 2015-06-16 15:42:13 +1000 | [diff] [blame] | 209 | spin_lock(&vgdev->free_vbufs_lock); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 210 | list_add(&vbuf->list, &vgdev->free_vbufs); |
Dave Airlie | d5084f1 | 2015-06-16 15:42:13 +1000 | [diff] [blame] | 211 | spin_unlock(&vgdev->free_vbufs_lock); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 212 | } |
| 213 | |
| 214 | static void reclaim_vbufs(struct virtqueue *vq, struct list_head *reclaim_list) |
| 215 | { |
| 216 | struct virtio_gpu_vbuffer *vbuf; |
| 217 | unsigned int len; |
| 218 | int freed = 0; |
| 219 | |
| 220 | while ((vbuf = virtqueue_get_buf(vq, &len))) { |
| 221 | list_add_tail(&vbuf->list, reclaim_list); |
| 222 | freed++; |
| 223 | } |
| 224 | if (freed == 0) |
| 225 | DRM_DEBUG("Huh? zero vbufs reclaimed"); |
| 226 | } |
| 227 | |
| 228 | void virtio_gpu_dequeue_ctrl_func(struct work_struct *work) |
| 229 | { |
| 230 | struct virtio_gpu_device *vgdev = |
| 231 | container_of(work, struct virtio_gpu_device, |
| 232 | ctrlq.dequeue_work); |
| 233 | struct list_head reclaim_list; |
| 234 | struct virtio_gpu_vbuffer *entry, *tmp; |
| 235 | struct virtio_gpu_ctrl_hdr *resp; |
| 236 | u64 fence_id = 0; |
| 237 | |
| 238 | INIT_LIST_HEAD(&reclaim_list); |
| 239 | spin_lock(&vgdev->ctrlq.qlock); |
| 240 | do { |
| 241 | virtqueue_disable_cb(vgdev->ctrlq.vq); |
| 242 | reclaim_vbufs(vgdev->ctrlq.vq, &reclaim_list); |
| 243 | |
| 244 | } while (!virtqueue_enable_cb(vgdev->ctrlq.vq)); |
| 245 | spin_unlock(&vgdev->ctrlq.qlock); |
| 246 | |
| 247 | list_for_each_entry_safe(entry, tmp, &reclaim_list, list) { |
| 248 | resp = (struct virtio_gpu_ctrl_hdr *)entry->resp_buf; |
| 249 | if (resp->type != cpu_to_le32(VIRTIO_GPU_RESP_OK_NODATA)) |
| 250 | DRM_DEBUG("response 0x%x\n", le32_to_cpu(resp->type)); |
| 251 | if (resp->flags & cpu_to_le32(VIRTIO_GPU_FLAG_FENCE)) { |
| 252 | u64 f = le64_to_cpu(resp->fence_id); |
| 253 | |
| 254 | if (fence_id > f) { |
| 255 | DRM_ERROR("%s: Oops: fence %llx -> %llx\n", |
| 256 | __func__, fence_id, f); |
| 257 | } else { |
| 258 | fence_id = f; |
| 259 | } |
| 260 | } |
| 261 | if (entry->resp_cb) |
| 262 | entry->resp_cb(vgdev, entry); |
| 263 | |
| 264 | list_del(&entry->list); |
| 265 | free_vbuf(vgdev, entry); |
| 266 | } |
| 267 | wake_up(&vgdev->ctrlq.ack_queue); |
| 268 | |
| 269 | if (fence_id) |
| 270 | virtio_gpu_fence_event_process(vgdev, fence_id); |
| 271 | } |
| 272 | |
| 273 | void virtio_gpu_dequeue_cursor_func(struct work_struct *work) |
| 274 | { |
| 275 | struct virtio_gpu_device *vgdev = |
| 276 | container_of(work, struct virtio_gpu_device, |
| 277 | cursorq.dequeue_work); |
| 278 | struct list_head reclaim_list; |
| 279 | struct virtio_gpu_vbuffer *entry, *tmp; |
| 280 | |
| 281 | INIT_LIST_HEAD(&reclaim_list); |
| 282 | spin_lock(&vgdev->cursorq.qlock); |
| 283 | do { |
| 284 | virtqueue_disable_cb(vgdev->cursorq.vq); |
| 285 | reclaim_vbufs(vgdev->cursorq.vq, &reclaim_list); |
| 286 | } while (!virtqueue_enable_cb(vgdev->cursorq.vq)); |
| 287 | spin_unlock(&vgdev->cursorq.qlock); |
| 288 | |
| 289 | list_for_each_entry_safe(entry, tmp, &reclaim_list, list) { |
| 290 | list_del(&entry->list); |
| 291 | free_vbuf(vgdev, entry); |
| 292 | } |
| 293 | wake_up(&vgdev->cursorq.ack_queue); |
| 294 | } |
| 295 | |
Gerd Hoffmann | 9c73f47 | 2015-08-19 23:35:57 +0200 | [diff] [blame] | 296 | static int virtio_gpu_queue_ctrl_buffer_locked(struct virtio_gpu_device *vgdev, |
| 297 | struct virtio_gpu_vbuffer *vbuf) |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 298 | { |
| 299 | struct virtqueue *vq = vgdev->ctrlq.vq; |
| 300 | struct scatterlist *sgs[3], vcmd, vout, vresp; |
| 301 | int outcnt = 0, incnt = 0; |
| 302 | int ret; |
| 303 | |
| 304 | if (!vgdev->vqs_ready) |
| 305 | return -ENODEV; |
| 306 | |
| 307 | sg_init_one(&vcmd, vbuf->buf, vbuf->size); |
| 308 | sgs[outcnt+incnt] = &vcmd; |
| 309 | outcnt++; |
| 310 | |
| 311 | if (vbuf->data_size) { |
| 312 | sg_init_one(&vout, vbuf->data_buf, vbuf->data_size); |
| 313 | sgs[outcnt + incnt] = &vout; |
| 314 | outcnt++; |
| 315 | } |
| 316 | |
| 317 | if (vbuf->resp_size) { |
| 318 | sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size); |
| 319 | sgs[outcnt + incnt] = &vresp; |
| 320 | incnt++; |
| 321 | } |
| 322 | |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 323 | retry: |
| 324 | ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC); |
| 325 | if (ret == -ENOSPC) { |
| 326 | spin_unlock(&vgdev->ctrlq.qlock); |
| 327 | wait_event(vgdev->ctrlq.ack_queue, vq->num_free); |
| 328 | spin_lock(&vgdev->ctrlq.qlock); |
| 329 | goto retry; |
| 330 | } else { |
| 331 | virtqueue_kick(vq); |
| 332 | } |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 333 | |
| 334 | if (!ret) |
| 335 | ret = vq->num_free; |
| 336 | return ret; |
| 337 | } |
| 338 | |
Gerd Hoffmann | 9c73f47 | 2015-08-19 23:35:57 +0200 | [diff] [blame] | 339 | static int virtio_gpu_queue_ctrl_buffer(struct virtio_gpu_device *vgdev, |
| 340 | struct virtio_gpu_vbuffer *vbuf) |
| 341 | { |
| 342 | int rc; |
| 343 | |
| 344 | spin_lock(&vgdev->ctrlq.qlock); |
| 345 | rc = virtio_gpu_queue_ctrl_buffer_locked(vgdev, vbuf); |
| 346 | spin_unlock(&vgdev->ctrlq.qlock); |
| 347 | return rc; |
| 348 | } |
| 349 | |
Gerd Hoffmann | ec2f057 | 2015-08-19 23:44:15 +0200 | [diff] [blame^] | 350 | static int virtio_gpu_queue_fenced_ctrl_buffer(struct virtio_gpu_device *vgdev, |
| 351 | struct virtio_gpu_vbuffer *vbuf, |
| 352 | struct virtio_gpu_ctrl_hdr *hdr, |
| 353 | struct virtio_gpu_fence **fence) |
| 354 | { |
| 355 | struct virtqueue *vq = vgdev->ctrlq.vq; |
| 356 | int rc; |
| 357 | |
| 358 | again: |
| 359 | spin_lock(&vgdev->ctrlq.qlock); |
| 360 | |
| 361 | /* |
| 362 | * Make sure we have enouth space in the virtqueue. If not |
| 363 | * wait here until we have. |
| 364 | * |
| 365 | * Without that virtio_gpu_queue_ctrl_buffer_nolock might have |
| 366 | * to wait for free space, which can result in fence ids being |
| 367 | * submitted out-of-order. |
| 368 | */ |
| 369 | if (vq->num_free < 3) { |
| 370 | spin_unlock(&vgdev->ctrlq.qlock); |
| 371 | wait_event(vgdev->ctrlq.ack_queue, vq->num_free >= 3); |
| 372 | goto again; |
| 373 | } |
| 374 | |
| 375 | if (fence) |
| 376 | virtio_gpu_fence_emit(vgdev, hdr, fence); |
| 377 | rc = virtio_gpu_queue_ctrl_buffer_locked(vgdev, vbuf); |
| 378 | spin_unlock(&vgdev->ctrlq.qlock); |
| 379 | return rc; |
| 380 | } |
| 381 | |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 382 | static int virtio_gpu_queue_cursor(struct virtio_gpu_device *vgdev, |
| 383 | struct virtio_gpu_vbuffer *vbuf) |
| 384 | { |
| 385 | struct virtqueue *vq = vgdev->cursorq.vq; |
| 386 | struct scatterlist *sgs[1], ccmd; |
| 387 | int ret; |
| 388 | int outcnt; |
| 389 | |
| 390 | if (!vgdev->vqs_ready) |
| 391 | return -ENODEV; |
| 392 | |
| 393 | sg_init_one(&ccmd, vbuf->buf, vbuf->size); |
| 394 | sgs[0] = &ccmd; |
| 395 | outcnt = 1; |
| 396 | |
| 397 | spin_lock(&vgdev->cursorq.qlock); |
| 398 | retry: |
| 399 | ret = virtqueue_add_sgs(vq, sgs, outcnt, 0, vbuf, GFP_ATOMIC); |
| 400 | if (ret == -ENOSPC) { |
| 401 | spin_unlock(&vgdev->cursorq.qlock); |
| 402 | wait_event(vgdev->cursorq.ack_queue, vq->num_free); |
| 403 | spin_lock(&vgdev->cursorq.qlock); |
| 404 | goto retry; |
| 405 | } else { |
| 406 | virtqueue_kick(vq); |
| 407 | } |
| 408 | |
| 409 | spin_unlock(&vgdev->cursorq.qlock); |
| 410 | |
| 411 | if (!ret) |
| 412 | ret = vq->num_free; |
| 413 | return ret; |
| 414 | } |
| 415 | |
| 416 | /* just create gem objects for userspace and long lived objects, |
| 417 | just use dma_alloced pages for the queue objects? */ |
| 418 | |
| 419 | /* create a basic resource */ |
| 420 | void virtio_gpu_cmd_create_resource(struct virtio_gpu_device *vgdev, |
| 421 | uint32_t resource_id, |
| 422 | uint32_t format, |
| 423 | uint32_t width, |
| 424 | uint32_t height) |
| 425 | { |
| 426 | struct virtio_gpu_resource_create_2d *cmd_p; |
| 427 | struct virtio_gpu_vbuffer *vbuf; |
| 428 | |
| 429 | cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| 430 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 431 | |
| 432 | cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_2D); |
| 433 | cmd_p->resource_id = cpu_to_le32(resource_id); |
| 434 | cmd_p->format = cpu_to_le32(format); |
| 435 | cmd_p->width = cpu_to_le32(width); |
| 436 | cmd_p->height = cpu_to_le32(height); |
| 437 | |
| 438 | virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| 439 | } |
| 440 | |
| 441 | void virtio_gpu_cmd_unref_resource(struct virtio_gpu_device *vgdev, |
| 442 | uint32_t resource_id) |
| 443 | { |
| 444 | struct virtio_gpu_resource_unref *cmd_p; |
| 445 | struct virtio_gpu_vbuffer *vbuf; |
| 446 | |
| 447 | cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| 448 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 449 | |
| 450 | cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNREF); |
| 451 | cmd_p->resource_id = cpu_to_le32(resource_id); |
| 452 | |
| 453 | virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| 454 | } |
| 455 | |
| 456 | void virtio_gpu_cmd_resource_inval_backing(struct virtio_gpu_device *vgdev, |
| 457 | uint32_t resource_id) |
| 458 | { |
| 459 | struct virtio_gpu_resource_detach_backing *cmd_p; |
| 460 | struct virtio_gpu_vbuffer *vbuf; |
| 461 | |
| 462 | cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| 463 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 464 | |
| 465 | cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_DETACH_BACKING); |
| 466 | cmd_p->resource_id = cpu_to_le32(resource_id); |
| 467 | |
| 468 | virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| 469 | } |
| 470 | |
| 471 | void virtio_gpu_cmd_set_scanout(struct virtio_gpu_device *vgdev, |
| 472 | uint32_t scanout_id, uint32_t resource_id, |
| 473 | uint32_t width, uint32_t height, |
| 474 | uint32_t x, uint32_t y) |
| 475 | { |
| 476 | struct virtio_gpu_set_scanout *cmd_p; |
| 477 | struct virtio_gpu_vbuffer *vbuf; |
| 478 | |
| 479 | cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| 480 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 481 | |
| 482 | cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT); |
| 483 | cmd_p->resource_id = cpu_to_le32(resource_id); |
| 484 | cmd_p->scanout_id = cpu_to_le32(scanout_id); |
| 485 | cmd_p->r.width = cpu_to_le32(width); |
| 486 | cmd_p->r.height = cpu_to_le32(height); |
| 487 | cmd_p->r.x = cpu_to_le32(x); |
| 488 | cmd_p->r.y = cpu_to_le32(y); |
| 489 | |
| 490 | virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| 491 | } |
| 492 | |
| 493 | void virtio_gpu_cmd_resource_flush(struct virtio_gpu_device *vgdev, |
| 494 | uint32_t resource_id, |
| 495 | uint32_t x, uint32_t y, |
| 496 | uint32_t width, uint32_t height) |
| 497 | { |
| 498 | struct virtio_gpu_resource_flush *cmd_p; |
| 499 | struct virtio_gpu_vbuffer *vbuf; |
| 500 | |
| 501 | cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| 502 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 503 | |
| 504 | cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_FLUSH); |
| 505 | cmd_p->resource_id = cpu_to_le32(resource_id); |
| 506 | cmd_p->r.width = cpu_to_le32(width); |
| 507 | cmd_p->r.height = cpu_to_le32(height); |
| 508 | cmd_p->r.x = cpu_to_le32(x); |
| 509 | cmd_p->r.y = cpu_to_le32(y); |
| 510 | |
| 511 | virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| 512 | } |
| 513 | |
| 514 | void virtio_gpu_cmd_transfer_to_host_2d(struct virtio_gpu_device *vgdev, |
| 515 | uint32_t resource_id, uint64_t offset, |
| 516 | __le32 width, __le32 height, |
| 517 | __le32 x, __le32 y, |
| 518 | struct virtio_gpu_fence **fence) |
| 519 | { |
| 520 | struct virtio_gpu_transfer_to_host_2d *cmd_p; |
| 521 | struct virtio_gpu_vbuffer *vbuf; |
| 522 | |
| 523 | cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| 524 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 525 | |
| 526 | cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D); |
| 527 | cmd_p->resource_id = cpu_to_le32(resource_id); |
| 528 | cmd_p->offset = cpu_to_le64(offset); |
| 529 | cmd_p->r.width = width; |
| 530 | cmd_p->r.height = height; |
| 531 | cmd_p->r.x = x; |
| 532 | cmd_p->r.y = y; |
| 533 | |
Gerd Hoffmann | ec2f057 | 2015-08-19 23:44:15 +0200 | [diff] [blame^] | 534 | virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 535 | } |
| 536 | |
| 537 | static void |
| 538 | virtio_gpu_cmd_resource_attach_backing(struct virtio_gpu_device *vgdev, |
| 539 | uint32_t resource_id, |
| 540 | struct virtio_gpu_mem_entry *ents, |
| 541 | uint32_t nents, |
| 542 | struct virtio_gpu_fence **fence) |
| 543 | { |
| 544 | struct virtio_gpu_resource_attach_backing *cmd_p; |
| 545 | struct virtio_gpu_vbuffer *vbuf; |
| 546 | |
| 547 | cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| 548 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 549 | |
| 550 | cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ATTACH_BACKING); |
| 551 | cmd_p->resource_id = cpu_to_le32(resource_id); |
| 552 | cmd_p->nr_entries = cpu_to_le32(nents); |
| 553 | |
| 554 | vbuf->data_buf = ents; |
| 555 | vbuf->data_size = sizeof(*ents) * nents; |
| 556 | |
Gerd Hoffmann | ec2f057 | 2015-08-19 23:44:15 +0200 | [diff] [blame^] | 557 | virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 558 | } |
| 559 | |
| 560 | static void virtio_gpu_cmd_get_display_info_cb(struct virtio_gpu_device *vgdev, |
| 561 | struct virtio_gpu_vbuffer *vbuf) |
| 562 | { |
| 563 | struct virtio_gpu_resp_display_info *resp = |
| 564 | (struct virtio_gpu_resp_display_info *)vbuf->resp_buf; |
| 565 | int i; |
| 566 | |
| 567 | spin_lock(&vgdev->display_info_lock); |
| 568 | for (i = 0; i < vgdev->num_scanouts; i++) { |
| 569 | vgdev->outputs[i].info = resp->pmodes[i]; |
| 570 | if (resp->pmodes[i].enabled) { |
| 571 | DRM_DEBUG("output %d: %dx%d+%d+%d", i, |
| 572 | le32_to_cpu(resp->pmodes[i].r.width), |
| 573 | le32_to_cpu(resp->pmodes[i].r.height), |
| 574 | le32_to_cpu(resp->pmodes[i].r.x), |
| 575 | le32_to_cpu(resp->pmodes[i].r.y)); |
| 576 | } else { |
| 577 | DRM_DEBUG("output %d: disabled", i); |
| 578 | } |
| 579 | } |
| 580 | |
Dave Airlie | 441012a | 2015-06-16 14:25:34 +1000 | [diff] [blame] | 581 | vgdev->display_info_pending = false; |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 582 | spin_unlock(&vgdev->display_info_lock); |
| 583 | wake_up(&vgdev->resp_wq); |
| 584 | |
| 585 | if (!drm_helper_hpd_irq_event(vgdev->ddev)) |
| 586 | drm_kms_helper_hotplug_event(vgdev->ddev); |
| 587 | } |
| 588 | |
| 589 | int virtio_gpu_cmd_get_display_info(struct virtio_gpu_device *vgdev) |
| 590 | { |
| 591 | struct virtio_gpu_ctrl_hdr *cmd_p; |
| 592 | struct virtio_gpu_vbuffer *vbuf; |
| 593 | void *resp_buf; |
| 594 | |
| 595 | resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_display_info), |
| 596 | GFP_KERNEL); |
| 597 | if (!resp_buf) |
| 598 | return -ENOMEM; |
| 599 | |
| 600 | cmd_p = virtio_gpu_alloc_cmd_resp |
| 601 | (vgdev, &virtio_gpu_cmd_get_display_info_cb, &vbuf, |
| 602 | sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_display_info), |
| 603 | resp_buf); |
| 604 | memset(cmd_p, 0, sizeof(*cmd_p)); |
| 605 | |
Dave Airlie | 441012a | 2015-06-16 14:25:34 +1000 | [diff] [blame] | 606 | vgdev->display_info_pending = true; |
Dave Airlie | dc5698e | 2013-09-09 10:02:56 +1000 | [diff] [blame] | 607 | cmd_p->type = cpu_to_le32(VIRTIO_GPU_CMD_GET_DISPLAY_INFO); |
| 608 | virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| 609 | return 0; |
| 610 | } |
| 611 | |
| 612 | int virtio_gpu_object_attach(struct virtio_gpu_device *vgdev, |
| 613 | struct virtio_gpu_object *obj, |
| 614 | uint32_t resource_id, |
| 615 | struct virtio_gpu_fence **fence) |
| 616 | { |
| 617 | struct virtio_gpu_mem_entry *ents; |
| 618 | struct scatterlist *sg; |
| 619 | int si; |
| 620 | |
| 621 | if (!obj->pages) { |
| 622 | int ret; |
| 623 | ret = virtio_gpu_object_get_sg_table(vgdev, obj); |
| 624 | if (ret) |
| 625 | return ret; |
| 626 | } |
| 627 | |
| 628 | /* gets freed when the ring has consumed it */ |
| 629 | ents = kmalloc_array(obj->pages->nents, |
| 630 | sizeof(struct virtio_gpu_mem_entry), |
| 631 | GFP_KERNEL); |
| 632 | if (!ents) { |
| 633 | DRM_ERROR("failed to allocate ent list\n"); |
| 634 | return -ENOMEM; |
| 635 | } |
| 636 | |
| 637 | for_each_sg(obj->pages->sgl, sg, obj->pages->nents, si) { |
| 638 | ents[si].addr = cpu_to_le64(sg_phys(sg)); |
| 639 | ents[si].length = cpu_to_le32(sg->length); |
| 640 | ents[si].padding = 0; |
| 641 | } |
| 642 | |
| 643 | virtio_gpu_cmd_resource_attach_backing(vgdev, resource_id, |
| 644 | ents, obj->pages->nents, |
| 645 | fence); |
| 646 | obj->hw_res_handle = resource_id; |
| 647 | return 0; |
| 648 | } |
| 649 | |
| 650 | void virtio_gpu_cursor_ping(struct virtio_gpu_device *vgdev, |
| 651 | struct virtio_gpu_output *output) |
| 652 | { |
| 653 | struct virtio_gpu_vbuffer *vbuf; |
| 654 | struct virtio_gpu_update_cursor *cur_p; |
| 655 | |
| 656 | output->cursor.pos.scanout_id = cpu_to_le32(output->index); |
| 657 | cur_p = virtio_gpu_alloc_cursor(vgdev, &vbuf); |
| 658 | memcpy(cur_p, &output->cursor, sizeof(output->cursor)); |
| 659 | virtio_gpu_queue_cursor(vgdev, vbuf); |
| 660 | } |