| /* |
| * Copyright (C) 2015 Red Hat, Inc. |
| * All Rights Reserved. |
| * |
| * Authors: |
| * Dave Airlie <airlied@redhat.com> |
| * Gerd Hoffmann <kraxel@redhat.com> |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a |
| * copy of this software and associated documentation files (the "Software"), |
| * to deal in the Software without restriction, including without limitation |
| * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
| * and/or sell copies of the Software, and to permit persons to whom the |
| * Software is furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice (including the next |
| * paragraph) shall be included in all copies or substantial portions of the |
| * Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR |
| * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
| * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
| * OTHER DEALINGS IN THE SOFTWARE. |
| */ |
| |
| #include <drm/drmP.h> |
| #include "virtgpu_drv.h" |
| #include <linux/virtio.h> |
| #include <linux/virtio_config.h> |
| #include <linux/virtio_ring.h> |
| |
| #define MAX_INLINE_CMD_SIZE 96 |
| #define MAX_INLINE_RESP_SIZE 24 |
| #define VBUFFER_SIZE (sizeof(struct virtio_gpu_vbuffer) \ |
| + MAX_INLINE_CMD_SIZE \ |
| + MAX_INLINE_RESP_SIZE) |
| |
| void virtio_gpu_resource_id_get(struct virtio_gpu_device *vgdev, |
| uint32_t *resid) |
| { |
| int handle; |
| |
| idr_preload(GFP_KERNEL); |
| spin_lock(&vgdev->resource_idr_lock); |
| handle = idr_alloc(&vgdev->resource_idr, NULL, 1, 0, GFP_NOWAIT); |
| spin_unlock(&vgdev->resource_idr_lock); |
| idr_preload_end(); |
| *resid = handle; |
| } |
| |
| void virtio_gpu_resource_id_put(struct virtio_gpu_device *vgdev, uint32_t id) |
| { |
| spin_lock(&vgdev->resource_idr_lock); |
| idr_remove(&vgdev->resource_idr, id); |
| spin_unlock(&vgdev->resource_idr_lock); |
| } |
| |
| void virtio_gpu_ctrl_ack(struct virtqueue *vq) |
| { |
| struct drm_device *dev = vq->vdev->priv; |
| struct virtio_gpu_device *vgdev = dev->dev_private; |
| schedule_work(&vgdev->ctrlq.dequeue_work); |
| } |
| |
| void virtio_gpu_cursor_ack(struct virtqueue *vq) |
| { |
| struct drm_device *dev = vq->vdev->priv; |
| struct virtio_gpu_device *vgdev = dev->dev_private; |
| schedule_work(&vgdev->cursorq.dequeue_work); |
| } |
| |
| int virtio_gpu_alloc_vbufs(struct virtio_gpu_device *vgdev) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| int i, size, count = 16; |
| void *ptr; |
| |
| INIT_LIST_HEAD(&vgdev->free_vbufs); |
| spin_lock_init(&vgdev->free_vbufs_lock); |
| count += virtqueue_get_vring_size(vgdev->ctrlq.vq); |
| count += virtqueue_get_vring_size(vgdev->cursorq.vq); |
| size = count * VBUFFER_SIZE; |
| DRM_INFO("virtio vbuffers: %d bufs, %zdB each, %dkB total.\n", |
| count, VBUFFER_SIZE, size / 1024); |
| |
| vgdev->vbufs = kzalloc(size, GFP_KERNEL); |
| if (!vgdev->vbufs) |
| return -ENOMEM; |
| |
| for (i = 0, ptr = vgdev->vbufs; |
| i < count; |
| i++, ptr += VBUFFER_SIZE) { |
| vbuf = ptr; |
| list_add(&vbuf->list, &vgdev->free_vbufs); |
| } |
| return 0; |
| } |
| |
| void virtio_gpu_free_vbufs(struct virtio_gpu_device *vgdev) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| int i, count = 0; |
| |
| count += virtqueue_get_vring_size(vgdev->ctrlq.vq); |
| count += virtqueue_get_vring_size(vgdev->cursorq.vq); |
| |
| spin_lock(&vgdev->free_vbufs_lock); |
| for (i = 0; i < count; i++) { |
| if (WARN_ON(list_empty(&vgdev->free_vbufs))) |
| return; |
| vbuf = list_first_entry(&vgdev->free_vbufs, |
| struct virtio_gpu_vbuffer, list); |
| list_del(&vbuf->list); |
| } |
| spin_unlock(&vgdev->free_vbufs_lock); |
| kfree(vgdev->vbufs); |
| } |
| |
| static struct virtio_gpu_vbuffer* |
| virtio_gpu_get_vbuf(struct virtio_gpu_device *vgdev, |
| int size, int resp_size, void *resp_buf, |
| virtio_gpu_resp_cb resp_cb) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| spin_lock(&vgdev->free_vbufs_lock); |
| BUG_ON(list_empty(&vgdev->free_vbufs)); |
| vbuf = list_first_entry(&vgdev->free_vbufs, |
| struct virtio_gpu_vbuffer, list); |
| list_del(&vbuf->list); |
| spin_unlock(&vgdev->free_vbufs_lock); |
| memset(vbuf, 0, VBUFFER_SIZE); |
| |
| BUG_ON(size > MAX_INLINE_CMD_SIZE); |
| vbuf->buf = (void *)vbuf + sizeof(*vbuf); |
| vbuf->size = size; |
| |
| vbuf->resp_cb = resp_cb; |
| vbuf->resp_size = resp_size; |
| if (resp_size <= MAX_INLINE_RESP_SIZE) |
| vbuf->resp_buf = (void *)vbuf->buf + size; |
| else |
| vbuf->resp_buf = resp_buf; |
| BUG_ON(!vbuf->resp_buf); |
| return vbuf; |
| } |
| |
| static void *virtio_gpu_alloc_cmd(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer **vbuffer_p, |
| int size) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| vbuf = virtio_gpu_get_vbuf(vgdev, size, |
| sizeof(struct virtio_gpu_ctrl_hdr), |
| NULL, NULL); |
| if (IS_ERR(vbuf)) { |
| *vbuffer_p = NULL; |
| return ERR_CAST(vbuf); |
| } |
| *vbuffer_p = vbuf; |
| return vbuf->buf; |
| } |
| |
| static struct virtio_gpu_update_cursor* |
| virtio_gpu_alloc_cursor(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer **vbuffer_p) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| vbuf = virtio_gpu_get_vbuf |
| (vgdev, sizeof(struct virtio_gpu_update_cursor), |
| 0, NULL, NULL); |
| if (IS_ERR(vbuf)) { |
| *vbuffer_p = NULL; |
| return ERR_CAST(vbuf); |
| } |
| *vbuffer_p = vbuf; |
| return (struct virtio_gpu_update_cursor *)vbuf->buf; |
| } |
| |
| static void *virtio_gpu_alloc_cmd_resp(struct virtio_gpu_device *vgdev, |
| virtio_gpu_resp_cb cb, |
| struct virtio_gpu_vbuffer **vbuffer_p, |
| int cmd_size, int resp_size, |
| void *resp_buf) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| vbuf = virtio_gpu_get_vbuf(vgdev, cmd_size, |
| resp_size, resp_buf, cb); |
| if (IS_ERR(vbuf)) { |
| *vbuffer_p = NULL; |
| return ERR_CAST(vbuf); |
| } |
| *vbuffer_p = vbuf; |
| return (struct virtio_gpu_command *)vbuf->buf; |
| } |
| |
| static void free_vbuf(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf) |
| { |
| if (vbuf->resp_size > MAX_INLINE_RESP_SIZE) |
| kfree(vbuf->resp_buf); |
| kfree(vbuf->data_buf); |
| spin_lock(&vgdev->free_vbufs_lock); |
| list_add(&vbuf->list, &vgdev->free_vbufs); |
| spin_unlock(&vgdev->free_vbufs_lock); |
| } |
| |
| static void reclaim_vbufs(struct virtqueue *vq, struct list_head *reclaim_list) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| unsigned int len; |
| int freed = 0; |
| |
| while ((vbuf = virtqueue_get_buf(vq, &len))) { |
| list_add_tail(&vbuf->list, reclaim_list); |
| freed++; |
| } |
| if (freed == 0) |
| DRM_DEBUG("Huh? zero vbufs reclaimed"); |
| } |
| |
| void virtio_gpu_dequeue_ctrl_func(struct work_struct *work) |
| { |
| struct virtio_gpu_device *vgdev = |
| container_of(work, struct virtio_gpu_device, |
| ctrlq.dequeue_work); |
| struct list_head reclaim_list; |
| struct virtio_gpu_vbuffer *entry, *tmp; |
| struct virtio_gpu_ctrl_hdr *resp; |
| u64 fence_id = 0; |
| |
| INIT_LIST_HEAD(&reclaim_list); |
| spin_lock(&vgdev->ctrlq.qlock); |
| do { |
| virtqueue_disable_cb(vgdev->ctrlq.vq); |
| reclaim_vbufs(vgdev->ctrlq.vq, &reclaim_list); |
| |
| } while (!virtqueue_enable_cb(vgdev->ctrlq.vq)); |
| spin_unlock(&vgdev->ctrlq.qlock); |
| |
| list_for_each_entry_safe(entry, tmp, &reclaim_list, list) { |
| resp = (struct virtio_gpu_ctrl_hdr *)entry->resp_buf; |
| if (resp->type != cpu_to_le32(VIRTIO_GPU_RESP_OK_NODATA)) |
| DRM_DEBUG("response 0x%x\n", le32_to_cpu(resp->type)); |
| if (resp->flags & cpu_to_le32(VIRTIO_GPU_FLAG_FENCE)) { |
| u64 f = le64_to_cpu(resp->fence_id); |
| |
| if (fence_id > f) { |
| DRM_ERROR("%s: Oops: fence %llx -> %llx\n", |
| __func__, fence_id, f); |
| } else { |
| fence_id = f; |
| } |
| } |
| if (entry->resp_cb) |
| entry->resp_cb(vgdev, entry); |
| |
| list_del(&entry->list); |
| free_vbuf(vgdev, entry); |
| } |
| wake_up(&vgdev->ctrlq.ack_queue); |
| |
| if (fence_id) |
| virtio_gpu_fence_event_process(vgdev, fence_id); |
| } |
| |
| void virtio_gpu_dequeue_cursor_func(struct work_struct *work) |
| { |
| struct virtio_gpu_device *vgdev = |
| container_of(work, struct virtio_gpu_device, |
| cursorq.dequeue_work); |
| struct list_head reclaim_list; |
| struct virtio_gpu_vbuffer *entry, *tmp; |
| |
| INIT_LIST_HEAD(&reclaim_list); |
| spin_lock(&vgdev->cursorq.qlock); |
| do { |
| virtqueue_disable_cb(vgdev->cursorq.vq); |
| reclaim_vbufs(vgdev->cursorq.vq, &reclaim_list); |
| } while (!virtqueue_enable_cb(vgdev->cursorq.vq)); |
| spin_unlock(&vgdev->cursorq.qlock); |
| |
| list_for_each_entry_safe(entry, tmp, &reclaim_list, list) { |
| list_del(&entry->list); |
| free_vbuf(vgdev, entry); |
| } |
| wake_up(&vgdev->cursorq.ack_queue); |
| } |
| |
| static int virtio_gpu_queue_ctrl_buffer_locked(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf) |
| { |
| struct virtqueue *vq = vgdev->ctrlq.vq; |
| struct scatterlist *sgs[3], vcmd, vout, vresp; |
| int outcnt = 0, incnt = 0; |
| int ret; |
| |
| if (!vgdev->vqs_ready) |
| return -ENODEV; |
| |
| sg_init_one(&vcmd, vbuf->buf, vbuf->size); |
| sgs[outcnt+incnt] = &vcmd; |
| outcnt++; |
| |
| if (vbuf->data_size) { |
| sg_init_one(&vout, vbuf->data_buf, vbuf->data_size); |
| sgs[outcnt + incnt] = &vout; |
| outcnt++; |
| } |
| |
| if (vbuf->resp_size) { |
| sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size); |
| sgs[outcnt + incnt] = &vresp; |
| incnt++; |
| } |
| |
| retry: |
| ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC); |
| if (ret == -ENOSPC) { |
| spin_unlock(&vgdev->ctrlq.qlock); |
| wait_event(vgdev->ctrlq.ack_queue, vq->num_free); |
| spin_lock(&vgdev->ctrlq.qlock); |
| goto retry; |
| } else { |
| virtqueue_kick(vq); |
| } |
| |
| if (!ret) |
| ret = vq->num_free; |
| return ret; |
| } |
| |
| static int virtio_gpu_queue_ctrl_buffer(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf) |
| { |
| int rc; |
| |
| spin_lock(&vgdev->ctrlq.qlock); |
| rc = virtio_gpu_queue_ctrl_buffer_locked(vgdev, vbuf); |
| spin_unlock(&vgdev->ctrlq.qlock); |
| return rc; |
| } |
| |
| static int virtio_gpu_queue_fenced_ctrl_buffer(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf, |
| struct virtio_gpu_ctrl_hdr *hdr, |
| struct virtio_gpu_fence **fence) |
| { |
| struct virtqueue *vq = vgdev->ctrlq.vq; |
| int rc; |
| |
| again: |
| spin_lock(&vgdev->ctrlq.qlock); |
| |
| /* |
| * Make sure we have enouth space in the virtqueue. If not |
| * wait here until we have. |
| * |
| * Without that virtio_gpu_queue_ctrl_buffer_nolock might have |
| * to wait for free space, which can result in fence ids being |
| * submitted out-of-order. |
| */ |
| if (vq->num_free < 3) { |
| spin_unlock(&vgdev->ctrlq.qlock); |
| wait_event(vgdev->ctrlq.ack_queue, vq->num_free >= 3); |
| goto again; |
| } |
| |
| if (fence) |
| virtio_gpu_fence_emit(vgdev, hdr, fence); |
| rc = virtio_gpu_queue_ctrl_buffer_locked(vgdev, vbuf); |
| spin_unlock(&vgdev->ctrlq.qlock); |
| return rc; |
| } |
| |
| static int virtio_gpu_queue_cursor(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf) |
| { |
| struct virtqueue *vq = vgdev->cursorq.vq; |
| struct scatterlist *sgs[1], ccmd; |
| int ret; |
| int outcnt; |
| |
| if (!vgdev->vqs_ready) |
| return -ENODEV; |
| |
| sg_init_one(&ccmd, vbuf->buf, vbuf->size); |
| sgs[0] = &ccmd; |
| outcnt = 1; |
| |
| spin_lock(&vgdev->cursorq.qlock); |
| retry: |
| ret = virtqueue_add_sgs(vq, sgs, outcnt, 0, vbuf, GFP_ATOMIC); |
| if (ret == -ENOSPC) { |
| spin_unlock(&vgdev->cursorq.qlock); |
| wait_event(vgdev->cursorq.ack_queue, vq->num_free); |
| spin_lock(&vgdev->cursorq.qlock); |
| goto retry; |
| } else { |
| virtqueue_kick(vq); |
| } |
| |
| spin_unlock(&vgdev->cursorq.qlock); |
| |
| if (!ret) |
| ret = vq->num_free; |
| return ret; |
| } |
| |
| /* just create gem objects for userspace and long lived objects, |
| just use dma_alloced pages for the queue objects? */ |
| |
| /* create a basic resource */ |
| void virtio_gpu_cmd_create_resource(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id, |
| uint32_t format, |
| uint32_t width, |
| uint32_t height) |
| { |
| struct virtio_gpu_resource_create_2d *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_2D); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| cmd_p->format = cpu_to_le32(format); |
| cmd_p->width = cpu_to_le32(width); |
| cmd_p->height = cpu_to_le32(height); |
| |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void virtio_gpu_cmd_unref_resource(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id) |
| { |
| struct virtio_gpu_resource_unref *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_UNREF); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void virtio_gpu_cmd_resource_inval_backing(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id) |
| { |
| struct virtio_gpu_resource_detach_backing *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_DETACH_BACKING); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void virtio_gpu_cmd_set_scanout(struct virtio_gpu_device *vgdev, |
| uint32_t scanout_id, uint32_t resource_id, |
| uint32_t width, uint32_t height, |
| uint32_t x, uint32_t y) |
| { |
| struct virtio_gpu_set_scanout *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SET_SCANOUT); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| cmd_p->scanout_id = cpu_to_le32(scanout_id); |
| cmd_p->r.width = cpu_to_le32(width); |
| cmd_p->r.height = cpu_to_le32(height); |
| cmd_p->r.x = cpu_to_le32(x); |
| cmd_p->r.y = cpu_to_le32(y); |
| |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void virtio_gpu_cmd_resource_flush(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id, |
| uint32_t x, uint32_t y, |
| uint32_t width, uint32_t height) |
| { |
| struct virtio_gpu_resource_flush *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_FLUSH); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| cmd_p->r.width = cpu_to_le32(width); |
| cmd_p->r.height = cpu_to_le32(height); |
| cmd_p->r.x = cpu_to_le32(x); |
| cmd_p->r.y = cpu_to_le32(y); |
| |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void virtio_gpu_cmd_transfer_to_host_2d(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id, uint64_t offset, |
| __le32 width, __le32 height, |
| __le32 x, __le32 y, |
| struct virtio_gpu_fence **fence) |
| { |
| struct virtio_gpu_transfer_to_host_2d *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| cmd_p->offset = cpu_to_le64(offset); |
| cmd_p->r.width = width; |
| cmd_p->r.height = height; |
| cmd_p->r.x = x; |
| cmd_p->r.y = y; |
| |
| virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
| } |
| |
| static void |
| virtio_gpu_cmd_resource_attach_backing(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id, |
| struct virtio_gpu_mem_entry *ents, |
| uint32_t nents, |
| struct virtio_gpu_fence **fence) |
| { |
| struct virtio_gpu_resource_attach_backing *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_ATTACH_BACKING); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| cmd_p->nr_entries = cpu_to_le32(nents); |
| |
| vbuf->data_buf = ents; |
| vbuf->data_size = sizeof(*ents) * nents; |
| |
| virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
| } |
| |
| static void virtio_gpu_cmd_get_display_info_cb(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf) |
| { |
| struct virtio_gpu_resp_display_info *resp = |
| (struct virtio_gpu_resp_display_info *)vbuf->resp_buf; |
| int i; |
| |
| spin_lock(&vgdev->display_info_lock); |
| for (i = 0; i < vgdev->num_scanouts; i++) { |
| vgdev->outputs[i].info = resp->pmodes[i]; |
| if (resp->pmodes[i].enabled) { |
| DRM_DEBUG("output %d: %dx%d+%d+%d", i, |
| le32_to_cpu(resp->pmodes[i].r.width), |
| le32_to_cpu(resp->pmodes[i].r.height), |
| le32_to_cpu(resp->pmodes[i].r.x), |
| le32_to_cpu(resp->pmodes[i].r.y)); |
| } else { |
| DRM_DEBUG("output %d: disabled", i); |
| } |
| } |
| |
| vgdev->display_info_pending = false; |
| spin_unlock(&vgdev->display_info_lock); |
| wake_up(&vgdev->resp_wq); |
| |
| if (!drm_helper_hpd_irq_event(vgdev->ddev)) |
| drm_kms_helper_hotplug_event(vgdev->ddev); |
| } |
| |
| static void virtio_gpu_cmd_get_capset_info_cb(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf) |
| { |
| struct virtio_gpu_get_capset_info *cmd = |
| (struct virtio_gpu_get_capset_info *)vbuf->buf; |
| struct virtio_gpu_resp_capset_info *resp = |
| (struct virtio_gpu_resp_capset_info *)vbuf->resp_buf; |
| int i = le32_to_cpu(cmd->capset_index); |
| |
| spin_lock(&vgdev->display_info_lock); |
| vgdev->capsets[i].id = le32_to_cpu(resp->capset_id); |
| vgdev->capsets[i].max_version = le32_to_cpu(resp->capset_max_version); |
| vgdev->capsets[i].max_size = le32_to_cpu(resp->capset_max_size); |
| spin_unlock(&vgdev->display_info_lock); |
| wake_up(&vgdev->resp_wq); |
| } |
| |
| static void virtio_gpu_cmd_capset_cb(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_vbuffer *vbuf) |
| { |
| struct virtio_gpu_get_capset *cmd = |
| (struct virtio_gpu_get_capset *)vbuf->buf; |
| struct virtio_gpu_resp_capset *resp = |
| (struct virtio_gpu_resp_capset *)vbuf->resp_buf; |
| struct virtio_gpu_drv_cap_cache *cache_ent; |
| |
| spin_lock(&vgdev->display_info_lock); |
| list_for_each_entry(cache_ent, &vgdev->cap_cache, head) { |
| if (cache_ent->version == le32_to_cpu(cmd->capset_version) && |
| cache_ent->id == le32_to_cpu(cmd->capset_id)) { |
| memcpy(cache_ent->caps_cache, resp->capset_data, |
| cache_ent->size); |
| atomic_set(&cache_ent->is_valid, 1); |
| break; |
| } |
| } |
| spin_unlock(&vgdev->display_info_lock); |
| wake_up(&vgdev->resp_wq); |
| } |
| |
| |
| int virtio_gpu_cmd_get_display_info(struct virtio_gpu_device *vgdev) |
| { |
| struct virtio_gpu_ctrl_hdr *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| void *resp_buf; |
| |
| resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_display_info), |
| GFP_KERNEL); |
| if (!resp_buf) |
| return -ENOMEM; |
| |
| cmd_p = virtio_gpu_alloc_cmd_resp |
| (vgdev, &virtio_gpu_cmd_get_display_info_cb, &vbuf, |
| sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_display_info), |
| resp_buf); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| vgdev->display_info_pending = true; |
| cmd_p->type = cpu_to_le32(VIRTIO_GPU_CMD_GET_DISPLAY_INFO); |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| return 0; |
| } |
| |
| int virtio_gpu_cmd_get_capset_info(struct virtio_gpu_device *vgdev, int idx) |
| { |
| struct virtio_gpu_get_capset_info *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| void *resp_buf; |
| |
| resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset_info), |
| GFP_KERNEL); |
| if (!resp_buf) |
| return -ENOMEM; |
| |
| cmd_p = virtio_gpu_alloc_cmd_resp |
| (vgdev, &virtio_gpu_cmd_get_capset_info_cb, &vbuf, |
| sizeof(*cmd_p), sizeof(struct virtio_gpu_resp_capset_info), |
| resp_buf); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET_INFO); |
| cmd_p->capset_index = cpu_to_le32(idx); |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| return 0; |
| } |
| |
| int virtio_gpu_cmd_get_capset(struct virtio_gpu_device *vgdev, |
| int idx, int version, |
| struct virtio_gpu_drv_cap_cache **cache_p) |
| { |
| struct virtio_gpu_get_capset *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| int max_size = vgdev->capsets[idx].max_size; |
| struct virtio_gpu_drv_cap_cache *cache_ent; |
| void *resp_buf; |
| |
| if (idx > vgdev->num_capsets) |
| return -EINVAL; |
| |
| if (version > vgdev->capsets[idx].max_version) |
| return -EINVAL; |
| |
| cache_ent = kzalloc(sizeof(*cache_ent), GFP_KERNEL); |
| if (!cache_ent) |
| return -ENOMEM; |
| |
| cache_ent->caps_cache = kmalloc(max_size, GFP_KERNEL); |
| if (!cache_ent->caps_cache) { |
| kfree(cache_ent); |
| return -ENOMEM; |
| } |
| |
| resp_buf = kzalloc(sizeof(struct virtio_gpu_resp_capset) + max_size, |
| GFP_KERNEL); |
| if (!resp_buf) { |
| kfree(cache_ent->caps_cache); |
| kfree(cache_ent); |
| return -ENOMEM; |
| } |
| |
| cache_ent->version = version; |
| cache_ent->id = vgdev->capsets[idx].id; |
| atomic_set(&cache_ent->is_valid, 0); |
| cache_ent->size = max_size; |
| spin_lock(&vgdev->display_info_lock); |
| list_add_tail(&cache_ent->head, &vgdev->cap_cache); |
| spin_unlock(&vgdev->display_info_lock); |
| |
| cmd_p = virtio_gpu_alloc_cmd_resp |
| (vgdev, &virtio_gpu_cmd_capset_cb, &vbuf, sizeof(*cmd_p), |
| sizeof(struct virtio_gpu_resp_capset) + max_size, |
| resp_buf); |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_GET_CAPSET); |
| cmd_p->capset_id = cpu_to_le32(vgdev->capsets[idx].id); |
| cmd_p->capset_version = cpu_to_le32(version); |
| *cache_p = cache_ent; |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| |
| return 0; |
| } |
| |
| void virtio_gpu_cmd_context_create(struct virtio_gpu_device *vgdev, uint32_t id, |
| uint32_t nlen, const char *name) |
| { |
| struct virtio_gpu_ctx_create *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_CREATE); |
| cmd_p->hdr.ctx_id = cpu_to_le32(id); |
| cmd_p->nlen = cpu_to_le32(nlen); |
| strncpy(cmd_p->debug_name, name, sizeof(cmd_p->debug_name)-1); |
| cmd_p->debug_name[sizeof(cmd_p->debug_name)-1] = 0; |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void virtio_gpu_cmd_context_destroy(struct virtio_gpu_device *vgdev, |
| uint32_t id) |
| { |
| struct virtio_gpu_ctx_destroy *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DESTROY); |
| cmd_p->hdr.ctx_id = cpu_to_le32(id); |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void virtio_gpu_cmd_context_attach_resource(struct virtio_gpu_device *vgdev, |
| uint32_t ctx_id, |
| uint32_t resource_id) |
| { |
| struct virtio_gpu_ctx_resource *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_ATTACH_RESOURCE); |
| cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| |
| } |
| |
| void virtio_gpu_cmd_context_detach_resource(struct virtio_gpu_device *vgdev, |
| uint32_t ctx_id, |
| uint32_t resource_id) |
| { |
| struct virtio_gpu_ctx_resource *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_CTX_DETACH_RESOURCE); |
| cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| virtio_gpu_queue_ctrl_buffer(vgdev, vbuf); |
| } |
| |
| void |
| virtio_gpu_cmd_resource_create_3d(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_resource_create_3d *rc_3d, |
| struct virtio_gpu_fence **fence) |
| { |
| struct virtio_gpu_resource_create_3d *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| *cmd_p = *rc_3d; |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_RESOURCE_CREATE_3D); |
| cmd_p->hdr.flags = 0; |
| |
| virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
| } |
| |
| void virtio_gpu_cmd_transfer_to_host_3d(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id, uint32_t ctx_id, |
| uint64_t offset, uint32_t level, |
| struct virtio_gpu_box *box, |
| struct virtio_gpu_fence **fence) |
| { |
| struct virtio_gpu_transfer_host_3d *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_TO_HOST_3D); |
| cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| cmd_p->box = *box; |
| cmd_p->offset = cpu_to_le64(offset); |
| cmd_p->level = cpu_to_le32(level); |
| |
| virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
| } |
| |
| void virtio_gpu_cmd_transfer_from_host_3d(struct virtio_gpu_device *vgdev, |
| uint32_t resource_id, uint32_t ctx_id, |
| uint64_t offset, uint32_t level, |
| struct virtio_gpu_box *box, |
| struct virtio_gpu_fence **fence) |
| { |
| struct virtio_gpu_transfer_host_3d *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_TRANSFER_FROM_HOST_3D); |
| cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id); |
| cmd_p->resource_id = cpu_to_le32(resource_id); |
| cmd_p->box = *box; |
| cmd_p->offset = cpu_to_le64(offset); |
| cmd_p->level = cpu_to_le32(level); |
| |
| virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
| } |
| |
| void virtio_gpu_cmd_submit(struct virtio_gpu_device *vgdev, |
| void *data, uint32_t data_size, |
| uint32_t ctx_id, struct virtio_gpu_fence **fence) |
| { |
| struct virtio_gpu_cmd_submit *cmd_p; |
| struct virtio_gpu_vbuffer *vbuf; |
| |
| cmd_p = virtio_gpu_alloc_cmd(vgdev, &vbuf, sizeof(*cmd_p)); |
| memset(cmd_p, 0, sizeof(*cmd_p)); |
| |
| vbuf->data_buf = data; |
| vbuf->data_size = data_size; |
| |
| cmd_p->hdr.type = cpu_to_le32(VIRTIO_GPU_CMD_SUBMIT_3D); |
| cmd_p->hdr.ctx_id = cpu_to_le32(ctx_id); |
| cmd_p->size = cpu_to_le32(data_size); |
| |
| virtio_gpu_queue_fenced_ctrl_buffer(vgdev, vbuf, &cmd_p->hdr, fence); |
| } |
| |
| int virtio_gpu_object_attach(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_object *obj, |
| uint32_t resource_id, |
| struct virtio_gpu_fence **fence) |
| { |
| struct virtio_gpu_mem_entry *ents; |
| struct scatterlist *sg; |
| int si; |
| |
| if (!obj->pages) { |
| int ret; |
| ret = virtio_gpu_object_get_sg_table(vgdev, obj); |
| if (ret) |
| return ret; |
| } |
| |
| /* gets freed when the ring has consumed it */ |
| ents = kmalloc_array(obj->pages->nents, |
| sizeof(struct virtio_gpu_mem_entry), |
| GFP_KERNEL); |
| if (!ents) { |
| DRM_ERROR("failed to allocate ent list\n"); |
| return -ENOMEM; |
| } |
| |
| for_each_sg(obj->pages->sgl, sg, obj->pages->nents, si) { |
| ents[si].addr = cpu_to_le64(sg_phys(sg)); |
| ents[si].length = cpu_to_le32(sg->length); |
| ents[si].padding = 0; |
| } |
| |
| virtio_gpu_cmd_resource_attach_backing(vgdev, resource_id, |
| ents, obj->pages->nents, |
| fence); |
| obj->hw_res_handle = resource_id; |
| return 0; |
| } |
| |
| void virtio_gpu_cursor_ping(struct virtio_gpu_device *vgdev, |
| struct virtio_gpu_output *output) |
| { |
| struct virtio_gpu_vbuffer *vbuf; |
| struct virtio_gpu_update_cursor *cur_p; |
| |
| output->cursor.pos.scanout_id = cpu_to_le32(output->index); |
| cur_p = virtio_gpu_alloc_cursor(vgdev, &vbuf); |
| memcpy(cur_p, &output->cursor, sizeof(output->cursor)); |
| virtio_gpu_queue_cursor(vgdev, vbuf); |
| } |