drivers/gpu/drm/virtio/virtgpu_plane.c - third_party/kernel - Git at Google

 /*
  * Copyright (C) 2015 Red Hat, Inc.
  * All Rights Reserved.
  *
  * 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 THE COPYRIGHT OWNER(S) 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/drm_atomic_helper.h>
 #include <drm/drm_fourcc.h>
 #include <drm/drm_plane_helper.h>

 #include "virtgpu_drv.h"

 static const uint32_t virtio_gpu_formats[] = {
 	DRM_FORMAT_HOST_XRGB8888,
 };

 static const uint32_t virtio_gpu_cursor_formats[] = {
 	DRM_FORMAT_HOST_ARGB8888,
 };

 uint32_t virtio_gpu_translate_format(uint32_t drm_fourcc)
 {
 	uint32_t format;

 	switch (drm_fourcc) {
 	case DRM_FORMAT_XRGB8888:
 		format = VIRTIO_GPU_FORMAT_B8G8R8X8_UNORM;
 		break;
 	case DRM_FORMAT_ARGB8888:
 		format = VIRTIO_GPU_FORMAT_B8G8R8A8_UNORM;
 		break;
 	case DRM_FORMAT_BGRX8888:
 		format = VIRTIO_GPU_FORMAT_X8R8G8B8_UNORM;
 		break;
 	case DRM_FORMAT_BGRA8888:
 		format = VIRTIO_GPU_FORMAT_A8R8G8B8_UNORM;
 		break;
 	default:
 		/*
 		 * This should not happen, we handle everything listed
 		 * in virtio_gpu_formats[].
 		 */
 		format = 0;
 		break;
 	}
 	WARN_ON(format == 0);
 	return format;
 }

 static void virtio_gpu_plane_destroy(struct drm_plane *plane)
 {
 	drm_plane_cleanup(plane);
 	kfree(plane);
 }

 static const struct drm_plane_funcs virtio_gpu_plane_funcs = {
 	.update_plane		= drm_atomic_helper_update_plane,
 	.disable_plane		= drm_atomic_helper_disable_plane,
 	.destroy		= virtio_gpu_plane_destroy,
 	.reset			= drm_atomic_helper_plane_reset,
 	.atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
 	.atomic_destroy_state	= drm_atomic_helper_plane_destroy_state,
 };

 static int virtio_gpu_plane_atomic_check(struct drm_plane *plane,
 					 struct drm_plane_state *state)
 {
 	return 0;
 }

 static void virtio_gpu_primary_plane_update(struct drm_plane *plane,
 					    struct drm_plane_state *old_state)
 {
 	struct drm_device *dev = plane->dev;
 	struct virtio_gpu_device *vgdev = dev->dev_private;
 	struct virtio_gpu_output *output = NULL;
 	struct virtio_gpu_framebuffer *vgfb;
 	struct virtio_gpu_object *bo;
 	uint32_t handle;

 	if (plane->state->crtc)
 		output = drm_crtc_to_virtio_gpu_output(plane->state->crtc);
 	if (old_state->crtc)
 		output = drm_crtc_to_virtio_gpu_output(old_state->crtc);
 	if (WARN_ON(!output))
 		return;

 	if (plane->state->fb && output->enabled) {
 		vgfb = to_virtio_gpu_framebuffer(plane->state->fb);
 		bo = gem_to_virtio_gpu_obj(vgfb->base.obj[0]);
 		handle = bo->hw_res_handle;
 		if (bo->dumb) {
 			virtio_gpu_cmd_transfer_to_host_2d
 				(vgdev, bo, 0,
 				 cpu_to_le32(plane->state->src_w >> 16),
 				 cpu_to_le32(plane->state->src_h >> 16),
 				 cpu_to_le32(plane->state->src_x >> 16),
 				 cpu_to_le32(plane->state->src_y >> 16), NULL);
 		}
 	} else {
 		handle = 0;
 	}

 	DRM_DEBUG("handle 0x%x, crtc %dx%d+%d+%d, src %dx%d+%d+%d\n", handle,
 		  plane->state->crtc_w, plane->state->crtc_h,
 		  plane->state->crtc_x, plane->state->crtc_y,
 		  plane->state->src_w >> 16,
 		  plane->state->src_h >> 16,
 		  plane->state->src_x >> 16,
 		  plane->state->src_y >> 16);
 	virtio_gpu_cmd_set_scanout(vgdev, output->index, handle,
 				   plane->state->src_w >> 16,
 				   plane->state->src_h >> 16,
 				   plane->state->src_x >> 16,
 				   plane->state->src_y >> 16);
 	if (handle)
 		virtio_gpu_cmd_resource_flush(vgdev, handle,
 					      plane->state->src_x >> 16,
 					      plane->state->src_y >> 16,
 					      plane->state->src_w >> 16,
 					      plane->state->src_h >> 16);
 }

 static int virtio_gpu_cursor_prepare_fb(struct drm_plane *plane,
 					struct drm_plane_state *new_state)
 {
 	struct drm_device *dev = plane->dev;
 	struct virtio_gpu_device *vgdev = dev->dev_private;
 	struct virtio_gpu_framebuffer *vgfb;
 	struct virtio_gpu_object *bo;

 	if (!new_state->fb)
 		return 0;

 	vgfb = to_virtio_gpu_framebuffer(new_state->fb);
 	bo = gem_to_virtio_gpu_obj(vgfb->base.obj[0]);
 	if (bo && bo->dumb && (plane->state->fb != new_state->fb)) {
 		vgfb->fence = virtio_gpu_fence_alloc(vgdev);
 		if (!vgfb->fence)
 			return -ENOMEM;
 	}

 	return 0;
 }

 static void virtio_gpu_cursor_cleanup_fb(struct drm_plane *plane,
 					 struct drm_plane_state *old_state)
 {
 	struct virtio_gpu_framebuffer *vgfb;

 	if (!plane->state->fb)
 		return;

 	vgfb = to_virtio_gpu_framebuffer(plane->state->fb);
 	if (vgfb->fence) {
 		dma_fence_put(&vgfb->fence->f);
 		vgfb->fence = NULL;
 	}
 }

 static void virtio_gpu_cursor_plane_update(struct drm_plane *plane,
 					   struct drm_plane_state *old_state)
 {
 	struct drm_device *dev = plane->dev;
 	struct virtio_gpu_device *vgdev = dev->dev_private;
 	struct virtio_gpu_output *output = NULL;
 	struct virtio_gpu_framebuffer *vgfb;
 	struct virtio_gpu_object *bo = NULL;
 	uint32_t handle;
 	int ret = 0;

 	if (plane->state->crtc)
 		output = drm_crtc_to_virtio_gpu_output(plane->state->crtc);
 	if (old_state->crtc)
 		output = drm_crtc_to_virtio_gpu_output(old_state->crtc);
 	if (WARN_ON(!output))
 		return;

 	if (plane->state->fb) {
 		vgfb = to_virtio_gpu_framebuffer(plane->state->fb);
 		bo = gem_to_virtio_gpu_obj(vgfb->base.obj[0]);
 		handle = bo->hw_res_handle;
 	} else {
 		handle = 0;
 	}

 	if (bo && bo->dumb && (plane->state->fb != old_state->fb)) {
 		/* new cursor -- update & wait */
 		virtio_gpu_cmd_transfer_to_host_2d
 			(vgdev, bo, 0,
 			 cpu_to_le32(plane->state->crtc_w),
 			 cpu_to_le32(plane->state->crtc_h),
 			 0, 0, vgfb->fence);
 		ret = virtio_gpu_object_reserve(bo, false);
 		if (!ret) {
 			dma_resv_add_excl_fence(bo->tbo.base.resv,
 							  &vgfb->fence->f);
 			dma_fence_put(&vgfb->fence->f);
 			vgfb->fence = NULL;
 			virtio_gpu_object_unreserve(bo);
 			virtio_gpu_object_wait(bo, false);
 		}
 	}

 	if (plane->state->fb != old_state->fb) {
 		DRM_DEBUG("update, handle %d, pos +%d+%d, hot %d,%d\n", handle,
 			  plane->state->crtc_x,
 			  plane->state->crtc_y,
 			  plane->state->fb ? plane->state->fb->hot_x : 0,
 			  plane->state->fb ? plane->state->fb->hot_y : 0);
 		output->cursor.hdr.type =
 			cpu_to_le32(VIRTIO_GPU_CMD_UPDATE_CURSOR);
 		output->cursor.resource_id = cpu_to_le32(handle);
 		if (plane->state->fb) {
 			output->cursor.hot_x =
 				cpu_to_le32(plane->state->fb->hot_x);
 			output->cursor.hot_y =
 				cpu_to_le32(plane->state->fb->hot_y);
 		} else {
 			output->cursor.hot_x = cpu_to_le32(0);
 			output->cursor.hot_y = cpu_to_le32(0);
 		}
 	} else {
 		DRM_DEBUG("move +%d+%d\n",
 			  plane->state->crtc_x,
 			  plane->state->crtc_y);
 		output->cursor.hdr.type =
 			cpu_to_le32(VIRTIO_GPU_CMD_MOVE_CURSOR);
 	}
 	output->cursor.pos.x = cpu_to_le32(plane->state->crtc_x);
 	output->cursor.pos.y = cpu_to_le32(plane->state->crtc_y);
 	virtio_gpu_cursor_ping(vgdev, output);
 }

 static const struct drm_plane_helper_funcs virtio_gpu_primary_helper_funcs = {
 	.atomic_check		= virtio_gpu_plane_atomic_check,
 	.atomic_update		= virtio_gpu_primary_plane_update,
 };

 static const struct drm_plane_helper_funcs virtio_gpu_cursor_helper_funcs = {
 	.prepare_fb		= virtio_gpu_cursor_prepare_fb,
 	.cleanup_fb		= virtio_gpu_cursor_cleanup_fb,
 	.atomic_check		= virtio_gpu_plane_atomic_check,
 	.atomic_update		= virtio_gpu_cursor_plane_update,
 };

 struct drm_plane *virtio_gpu_plane_init(struct virtio_gpu_device *vgdev,
 					enum drm_plane_type type,
 					int index)
 {
 	struct drm_device *dev = vgdev->ddev;
 	const struct drm_plane_helper_funcs *funcs;
 	struct drm_plane *plane;
 	const uint32_t *formats;
 	int ret, nformats;

 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
 	if (!plane)
 		return ERR_PTR(-ENOMEM);

 	if (type == DRM_PLANE_TYPE_CURSOR) {
 		formats = virtio_gpu_cursor_formats;
 		nformats = ARRAY_SIZE(virtio_gpu_cursor_formats);
 		funcs = &virtio_gpu_cursor_helper_funcs;
 	} else {
 		formats = virtio_gpu_formats;
 		nformats = ARRAY_SIZE(virtio_gpu_formats);
 		funcs = &virtio_gpu_primary_helper_funcs;
 	}
 	ret = drm_universal_plane_init(dev, plane, 1 << index,
 				       &virtio_gpu_plane_funcs,
 				       formats, nformats,
 				       NULL, type, NULL);
 	if (ret)
 		goto err_plane_init;

 	drm_plane_helper_add(plane, funcs);
 	return plane;

 err_plane_init:
 	kfree(plane);
 	return ERR_PTR(ret);
 }
	/*
	* Copyright (C) 2015 Red Hat, Inc.
	* All Rights Reserved.
	*
	* 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 THE COPYRIGHT OWNER(S) 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/drm_atomic_helper.h>
	#include <drm/drm_fourcc.h>
	#include <drm/drm_plane_helper.h>

	#include "virtgpu_drv.h"

	static const uint32_t virtio_gpu_formats[] = {
	DRM_FORMAT_HOST_XRGB8888,
	};

	static const uint32_t virtio_gpu_cursor_formats[] = {
	DRM_FORMAT_HOST_ARGB8888,
	};

	uint32_t virtio_gpu_translate_format(uint32_t drm_fourcc)
	{
	uint32_t format;

	switch (drm_fourcc) {
	case DRM_FORMAT_XRGB8888:
	format = VIRTIO_GPU_FORMAT_B8G8R8X8_UNORM;
	break;
	case DRM_FORMAT_ARGB8888:
	format = VIRTIO_GPU_FORMAT_B8G8R8A8_UNORM;
	break;
	case DRM_FORMAT_BGRX8888:
	format = VIRTIO_GPU_FORMAT_X8R8G8B8_UNORM;
	break;
	case DRM_FORMAT_BGRA8888:
	format = VIRTIO_GPU_FORMAT_A8R8G8B8_UNORM;
	break;
	default:
	/*
	* This should not happen, we handle everything listed
	* in virtio_gpu_formats[].
	*/
	format = 0;
	break;
	}
	WARN_ON(format == 0);
	return format;
	}

	static void virtio_gpu_plane_destroy(struct drm_plane *plane)
	{
	drm_plane_cleanup(plane);
	kfree(plane);
	}

	static const struct drm_plane_funcs virtio_gpu_plane_funcs = {
	.update_plane = drm_atomic_helper_update_plane,
	.disable_plane = drm_atomic_helper_disable_plane,
	.destroy = virtio_gpu_plane_destroy,
	.reset = drm_atomic_helper_plane_reset,
	.atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
	.atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
	};

	static int virtio_gpu_plane_atomic_check(struct drm_plane *plane,
	struct drm_plane_state *state)
	{
	return 0;
	}

	static void virtio_gpu_primary_plane_update(struct drm_plane *plane,
	struct drm_plane_state *old_state)
	{
	struct drm_device *dev = plane->dev;
	struct virtio_gpu_device *vgdev = dev->dev_private;
	struct virtio_gpu_output *output = NULL;
	struct virtio_gpu_framebuffer *vgfb;
	struct virtio_gpu_object *bo;
	uint32_t handle;

	if (plane->state->crtc)
	output = drm_crtc_to_virtio_gpu_output(plane->state->crtc);
	if (old_state->crtc)
	output = drm_crtc_to_virtio_gpu_output(old_state->crtc);
	if (WARN_ON(!output))
	return;

	if (plane->state->fb && output->enabled) {
	vgfb = to_virtio_gpu_framebuffer(plane->state->fb);
	bo = gem_to_virtio_gpu_obj(vgfb->base.obj[0]);
	handle = bo->hw_res_handle;
	if (bo->dumb) {
	virtio_gpu_cmd_transfer_to_host_2d
	(vgdev, bo, 0,
	cpu_to_le32(plane->state->src_w >> 16),
	cpu_to_le32(plane->state->src_h >> 16),
	cpu_to_le32(plane->state->src_x >> 16),
	cpu_to_le32(plane->state->src_y >> 16), NULL);
	}
	} else {
	handle = 0;
	}

	DRM_DEBUG("handle 0x%x, crtc %dx%d+%d+%d, src %dx%d+%d+%d\n", handle,
	plane->state->crtc_w, plane->state->crtc_h,
	plane->state->crtc_x, plane->state->crtc_y,
	plane->state->src_w >> 16,
	plane->state->src_h >> 16,
	plane->state->src_x >> 16,
	plane->state->src_y >> 16);
	virtio_gpu_cmd_set_scanout(vgdev, output->index, handle,
	plane->state->src_w >> 16,
	plane->state->src_h >> 16,
	plane->state->src_x >> 16,
	plane->state->src_y >> 16);
	if (handle)
	virtio_gpu_cmd_resource_flush(vgdev, handle,
	plane->state->src_x >> 16,
	plane->state->src_y >> 16,
	plane->state->src_w >> 16,
	plane->state->src_h >> 16);
	}

	static int virtio_gpu_cursor_prepare_fb(struct drm_plane *plane,
	struct drm_plane_state *new_state)
	{
	struct drm_device *dev = plane->dev;
	struct virtio_gpu_device *vgdev = dev->dev_private;
	struct virtio_gpu_framebuffer *vgfb;
	struct virtio_gpu_object *bo;

	if (!new_state->fb)
	return 0;

	vgfb = to_virtio_gpu_framebuffer(new_state->fb);
	bo = gem_to_virtio_gpu_obj(vgfb->base.obj[0]);
	if (bo && bo->dumb && (plane->state->fb != new_state->fb)) {
	vgfb->fence = virtio_gpu_fence_alloc(vgdev);
	if (!vgfb->fence)
	return -ENOMEM;
	}

	return 0;
	}

	static void virtio_gpu_cursor_cleanup_fb(struct drm_plane *plane,
	struct drm_plane_state *old_state)
	{
	struct virtio_gpu_framebuffer *vgfb;

	if (!plane->state->fb)
	return;

	vgfb = to_virtio_gpu_framebuffer(plane->state->fb);
	if (vgfb->fence) {
	dma_fence_put(&vgfb->fence->f);
	vgfb->fence = NULL;
	}
	}

	static void virtio_gpu_cursor_plane_update(struct drm_plane *plane,
	struct drm_plane_state *old_state)
	{
	struct drm_device *dev = plane->dev;
	struct virtio_gpu_device *vgdev = dev->dev_private;
	struct virtio_gpu_output *output = NULL;
	struct virtio_gpu_framebuffer *vgfb;
	struct virtio_gpu_object *bo = NULL;
	uint32_t handle;
	int ret = 0;

	if (plane->state->crtc)
	output = drm_crtc_to_virtio_gpu_output(plane->state->crtc);
	if (old_state->crtc)
	output = drm_crtc_to_virtio_gpu_output(old_state->crtc);
	if (WARN_ON(!output))
	return;

	if (plane->state->fb) {
	vgfb = to_virtio_gpu_framebuffer(plane->state->fb);
	bo = gem_to_virtio_gpu_obj(vgfb->base.obj[0]);
	handle = bo->hw_res_handle;
	} else {
	handle = 0;
	}

	if (bo && bo->dumb && (plane->state->fb != old_state->fb)) {
	/* new cursor -- update & wait */
	virtio_gpu_cmd_transfer_to_host_2d
	(vgdev, bo, 0,
	cpu_to_le32(plane->state->crtc_w),
	cpu_to_le32(plane->state->crtc_h),
	0, 0, vgfb->fence);
	ret = virtio_gpu_object_reserve(bo, false);
	if (!ret) {
	dma_resv_add_excl_fence(bo->tbo.base.resv,
	&vgfb->fence->f);
	dma_fence_put(&vgfb->fence->f);
	vgfb->fence = NULL;
	virtio_gpu_object_unreserve(bo);
	virtio_gpu_object_wait(bo, false);
	}
	}

	if (plane->state->fb != old_state->fb) {
	DRM_DEBUG("update, handle %d, pos +%d+%d, hot %d,%d\n", handle,
	plane->state->crtc_x,
	plane->state->crtc_y,
	plane->state->fb ? plane->state->fb->hot_x : 0,
	plane->state->fb ? plane->state->fb->hot_y : 0);
	output->cursor.hdr.type =
	cpu_to_le32(VIRTIO_GPU_CMD_UPDATE_CURSOR);
	output->cursor.resource_id = cpu_to_le32(handle);
	if (plane->state->fb) {
	output->cursor.hot_x =
	cpu_to_le32(plane->state->fb->hot_x);
	output->cursor.hot_y =
	cpu_to_le32(plane->state->fb->hot_y);
	} else {
	output->cursor.hot_x = cpu_to_le32(0);
	output->cursor.hot_y = cpu_to_le32(0);
	}
	} else {
	DRM_DEBUG("move +%d+%d\n",
	plane->state->crtc_x,
	plane->state->crtc_y);
	output->cursor.hdr.type =
	cpu_to_le32(VIRTIO_GPU_CMD_MOVE_CURSOR);
	}
	output->cursor.pos.x = cpu_to_le32(plane->state->crtc_x);
	output->cursor.pos.y = cpu_to_le32(plane->state->crtc_y);
	virtio_gpu_cursor_ping(vgdev, output);
	}

	static const struct drm_plane_helper_funcs virtio_gpu_primary_helper_funcs = {
	.atomic_check = virtio_gpu_plane_atomic_check,
	.atomic_update = virtio_gpu_primary_plane_update,
	};

	static const struct drm_plane_helper_funcs virtio_gpu_cursor_helper_funcs = {
	.prepare_fb = virtio_gpu_cursor_prepare_fb,
	.cleanup_fb = virtio_gpu_cursor_cleanup_fb,
	.atomic_check = virtio_gpu_plane_atomic_check,
	.atomic_update = virtio_gpu_cursor_plane_update,
	};

	struct drm_plane virtio_gpu_plane_init(struct virtio_gpu_device vgdev,
	enum drm_plane_type type,
	int index)
	{
	struct drm_device *dev = vgdev->ddev;
	const struct drm_plane_helper_funcs *funcs;
	struct drm_plane *plane;
	const uint32_t *formats;
	int ret, nformats;

	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
	if (!plane)
	return ERR_PTR(-ENOMEM);

	if (type == DRM_PLANE_TYPE_CURSOR) {
	formats = virtio_gpu_cursor_formats;
	nformats = ARRAY_SIZE(virtio_gpu_cursor_formats);
	funcs = &virtio_gpu_cursor_helper_funcs;
	} else {
	formats = virtio_gpu_formats;
	nformats = ARRAY_SIZE(virtio_gpu_formats);
	funcs = &virtio_gpu_primary_helper_funcs;
	}
	ret = drm_universal_plane_init(dev, plane, 1 << index,
	&virtio_gpu_plane_funcs,
	formats, nformats,
	NULL, type, NULL);
	if (ret)
	goto err_plane_init;

	drm_plane_helper_add(plane, funcs);
	return plane;

	err_plane_init:
	kfree(plane);
	return ERR_PTR(ret);
	}