[linux-2.6-block.git] / drivers / gpu / drm / vkms / vkms_plane.c

// SPDX-License-Identifier: GPL-2.0+

#include <linux/iosys-map.h>

#include <drm/drm_atomic.h>
#include <drm/drm_atomic_helper.h>
#include <drm/drm_blend.h>
#include <drm/drm_fourcc.h>
#include <drm/drm_gem_atomic_helper.h>
#include <drm/drm_gem_framebuffer_helper.h>

#include "vkms_drv.h"
#include "vkms_formats.h"

static const u32 vkms_formats[] = {
	DRM_FORMAT_ARGB8888,
	DRM_FORMAT_XRGB8888,
	DRM_FORMAT_XRGB16161616,
	DRM_FORMAT_ARGB16161616,
	DRM_FORMAT_RGB565
};

static struct drm_plane_state *
vkms_plane_duplicate_state(struct drm_plane *plane)
{
	struct vkms_plane_state *vkms_state;
	struct vkms_frame_info *frame_info;

	vkms_state = kzalloc(sizeof(*vkms_state), GFP_KERNEL);
	if (!vkms_state)
		return NULL;

	frame_info = kzalloc(sizeof(*frame_info), GFP_KERNEL);
	if (!frame_info) {
		DRM_DEBUG_KMS("Couldn't allocate frame_info\n");
		kfree(vkms_state);
		return NULL;
	}

	vkms_state->frame_info = frame_info;

	__drm_gem_duplicate_shadow_plane_state(plane, &vkms_state->base);

	return &vkms_state->base.base;
}

static void vkms_plane_destroy_state(struct drm_plane *plane,
				     struct drm_plane_state *old_state)
{
	struct vkms_plane_state *vkms_state = to_vkms_plane_state(old_state);
	struct drm_crtc *crtc = vkms_state->base.base.crtc;

	if (crtc && vkms_state->frame_info->fb) {
		/* dropping the reference we acquired in
		 * vkms_primary_plane_update()
		 */
		if (drm_framebuffer_read_refcount(vkms_state->frame_info->fb))
			drm_framebuffer_put(vkms_state->frame_info->fb);
	}

	kfree(vkms_state->frame_info);
	vkms_state->frame_info = NULL;

	__drm_gem_destroy_shadow_plane_state(&vkms_state->base);
	kfree(vkms_state);
}

static void vkms_plane_reset(struct drm_plane *plane)
{
	struct vkms_plane_state *vkms_state;

	if (plane->state) {
		vkms_plane_destroy_state(plane, plane->state);
		plane->state = NULL; /* must be set to NULL here */
	}

	vkms_state = kzalloc(sizeof(*vkms_state), GFP_KERNEL);
	if (!vkms_state) {
		DRM_ERROR("Cannot allocate vkms_plane_state\n");
		return;
	}

	__drm_gem_reset_shadow_plane(plane, &vkms_state->base);
}

static const struct drm_plane_funcs vkms_plane_funcs = {
	.update_plane		= drm_atomic_helper_update_plane,
	.disable_plane		= drm_atomic_helper_disable_plane,
	.reset			= vkms_plane_reset,
	.atomic_duplicate_state = vkms_plane_duplicate_state,
	.atomic_destroy_state	= vkms_plane_destroy_state,
};

static void vkms_plane_atomic_update(struct drm_plane *plane,
				     struct drm_atomic_state *state)
{
	struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,
									   plane);
	struct vkms_plane_state *vkms_plane_state;
	struct drm_shadow_plane_state *shadow_plane_state;
	struct drm_framebuffer *fb = new_state->fb;
	struct vkms_frame_info *frame_info;
	u32 fmt;

	if (!new_state->crtc || !fb)
		return;

	fmt = fb->format->format;
	vkms_plane_state = to_vkms_plane_state(new_state);
	shadow_plane_state = &vkms_plane_state->base;

	frame_info = vkms_plane_state->frame_info;
	memcpy(&frame_info->src, &new_state->src, sizeof(struct drm_rect));
	memcpy(&frame_info->dst, &new_state->dst, sizeof(struct drm_rect));
	memcpy(&frame_info->rotated, &new_state->dst, sizeof(struct drm_rect));
	frame_info->fb = fb;
	memcpy(&frame_info->map, &shadow_plane_state->data, sizeof(frame_info->map));
	drm_framebuffer_get(frame_info->fb);
	frame_info->rotation = drm_rotation_simplify(new_state->rotation, DRM_MODE_ROTATE_0 |
						     DRM_MODE_ROTATE_90 |
						     DRM_MODE_ROTATE_270 |
						     DRM_MODE_REFLECT_X |
						     DRM_MODE_REFLECT_Y);

	drm_rect_rotate(&frame_info->rotated, drm_rect_width(&frame_info->rotated),
			drm_rect_height(&frame_info->rotated), frame_info->rotation);

	frame_info->offset = fb->offsets[0];
	frame_info->pitch = fb->pitches[0];
	frame_info->cpp = fb->format->cpp[0];
	vkms_plane_state->pixel_read = get_pixel_conversion_function(fmt);
}

static int vkms_plane_atomic_check(struct drm_plane *plane,
				   struct drm_atomic_state *state)
{
	struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,
										 plane);
	struct drm_crtc_state *crtc_state;
	int ret;

	if (!new_plane_state->fb || WARN_ON(!new_plane_state->crtc))
		return 0;

	crtc_state = drm_atomic_get_crtc_state(state,
					       new_plane_state->crtc);
	if (IS_ERR(crtc_state))
		return PTR_ERR(crtc_state);

	ret = drm_atomic_helper_check_plane_state(new_plane_state, crtc_state,
						  DRM_PLANE_NO_SCALING,
						  DRM_PLANE_NO_SCALING,
						  true, true);
	if (ret != 0)
		return ret;

	return 0;
}

static int vkms_prepare_fb(struct drm_plane *plane,
			   struct drm_plane_state *state)
{
	struct drm_shadow_plane_state *shadow_plane_state;
	struct drm_framebuffer *fb = state->fb;
	int ret;

	if (!fb)
		return 0;

	shadow_plane_state = to_drm_shadow_plane_state(state);

	ret = drm_gem_plane_helper_prepare_fb(plane, state);
	if (ret)
		return ret;

	return drm_gem_fb_vmap(fb, shadow_plane_state->map, shadow_plane_state->data);
}

static void vkms_cleanup_fb(struct drm_plane *plane,
			    struct drm_plane_state *state)
{
	struct drm_shadow_plane_state *shadow_plane_state;
	struct drm_framebuffer *fb = state->fb;

	if (!fb)
		return;

	shadow_plane_state = to_drm_shadow_plane_state(state);

	drm_gem_fb_vunmap(fb, shadow_plane_state->map);
}

static const struct drm_plane_helper_funcs vkms_plane_helper_funcs = {
	.atomic_update		= vkms_plane_atomic_update,
	.atomic_check		= vkms_plane_atomic_check,
	.prepare_fb		= vkms_prepare_fb,
	.cleanup_fb		= vkms_cleanup_fb,
};

struct vkms_plane *vkms_plane_init(struct vkms_device *vkmsdev,
				   enum drm_plane_type type, int index)
{
	struct drm_device *dev = &vkmsdev->drm;
	struct vkms_plane *plane;

	plane = drmm_universal_plane_alloc(dev, struct vkms_plane, base, 1 << index,
					   &vkms_plane_funcs,
					   vkms_formats, ARRAY_SIZE(vkms_formats),
					   NULL, type, NULL);
	if (IS_ERR(plane))
		return plane;

	drm_plane_helper_add(&plane->base, &vkms_plane_helper_funcs);

	drm_plane_create_rotation_property(&plane->base, DRM_MODE_ROTATE_0,
					   DRM_MODE_ROTATE_MASK | DRM_MODE_REFLECT_MASK);

	return plane;
}
Commit	Line	Data
7fd56e02	1	// SPDX-License-Identifier: GPL-2.0+
854502fa	2
7938f421	3	#include <linux/iosys-map.h>
49a3f51d	4
d7734b74	5	#include <drm/drm_atomic.h>
854502fa	6	#include <drm/drm_atomic_helper.h>
4a982034	7	#include <drm/drm_blend.h>
ce672a1b	8	#include <drm/drm_fourcc.h>
820c1707	9	#include <drm/drm_gem_atomic_helper.h>
8ce1bb0b	10	#include <drm/drm_gem_framebuffer_helper.h>
ce672a1b SR	11
ce672a1b SR	12	#include "vkms_drv.h"
8ba16485	13	#include "vkms_formats.h"
854502fa	14
b6b3821f	15	static const u32 vkms_formats[] = {
b6b3821f	16	DRM_FORMAT_ARGB8888,
3675d8a1 IT	17	DRM_FORMAT_XRGB8888,
3675d8a1 IT	18	DRM_FORMAT_XRGB16161616,
396369d6 IT	19	DRM_FORMAT_ARGB16161616,
396369d6 IT	20	DRM_FORMAT_RGB565
b6b3821f DV	21	};
b6b3821f DV	22
3e77c4d0 HM	23	static struct drm_plane_state *
	24	vkms_plane_duplicate_state(struct drm_plane *plane)
	25	{
	26	struct vkms_plane_state *vkms_state;
1645e7b9	27	struct vkms_frame_info *frame_info;
3e77c4d0 HM	28
	29	vkms_state = kzalloc(sizeof(*vkms_state), GFP_KERNEL);
	30	if (!vkms_state)
	31	return NULL;
	32
1645e7b9 IT	33	frame_info = kzalloc(sizeof(*frame_info), GFP_KERNEL);
	34	if (!frame_info) {
	35	DRM_DEBUG_KMS("Couldn't allocate frame_info\n");
7cdf33ab DV	36	kfree(vkms_state);
	37	return NULL;
	38	}
6c234fe3	39
1645e7b9	40	vkms_state->frame_info = frame_info;
6c234fe3	41
7602d422	42	__drm_gem_duplicate_shadow_plane_state(plane, &vkms_state->base);
3e77c4d0	43
7602d422	44	return &vkms_state->base.base;
3e77c4d0 HM	45	}
	46
	47	static void vkms_plane_destroy_state(struct drm_plane *plane,
	48	struct drm_plane_state *old_state)
	49	{
	50	struct vkms_plane_state *vkms_state = to_vkms_plane_state(old_state);
7602d422	51	struct drm_crtc *crtc = vkms_state->base.base.crtc;
6c234fe3	52
2eef1ef6	53	if (crtc && vkms_state->frame_info->fb) {
6c234fe3 HM	54	/* dropping the reference we acquired in
	55	* vkms_primary_plane_update()
	56	*/
2eef1ef6 IT	57	if (drm_framebuffer_read_refcount(vkms_state->frame_info->fb))
2eef1ef6 IT	58	drm_framebuffer_put(vkms_state->frame_info->fb);
6c234fe3 HM	59	}
6c234fe3 HM	60
1645e7b9 IT	61	kfree(vkms_state->frame_info);
1645e7b9 IT	62	vkms_state->frame_info = NULL;
3e77c4d0	63
7602d422	64	__drm_gem_destroy_shadow_plane_state(&vkms_state->base);
3e77c4d0 HM	65	kfree(vkms_state);
	66	}
	67
	68	static void vkms_plane_reset(struct drm_plane *plane)
	69	{
	70	struct vkms_plane_state *vkms_state;
	71
7602d422	72	if (plane->state) {
3e77c4d0	73	vkms_plane_destroy_state(plane, plane->state);
7602d422 TZ	74	plane->state = NULL; /* must be set to NULL here */
7602d422 TZ	75	}
3e77c4d0 HM	76
	77	vkms_state = kzalloc(sizeof(*vkms_state), GFP_KERNEL);
	78	if (!vkms_state) {
	79	DRM_ERROR("Cannot allocate vkms_plane_state\n");
	80	return;
	81	}
	82
7602d422	83	__drm_gem_reset_shadow_plane(plane, &vkms_state->base);
3e77c4d0 HM	84	}
3e77c4d0 HM	85
854502fa RS	86	static const struct drm_plane_funcs vkms_plane_funcs = {
	87	.update_plane = drm_atomic_helper_update_plane,
	88	.disable_plane = drm_atomic_helper_disable_plane,
3e77c4d0 HM	89	.reset = vkms_plane_reset,
	90	.atomic_duplicate_state = vkms_plane_duplicate_state,
	91	.atomic_destroy_state = vkms_plane_destroy_state,
854502fa RS	92	};
854502fa RS	93
c27d931d	94	static void vkms_plane_atomic_update(struct drm_plane *plane,
977697e2	95	struct drm_atomic_state *state)
42ac0321	96	{
37418bf1 MR	97	struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,
37418bf1 MR	98	plane);
6c234fe3	99	struct vkms_plane_state *vkms_plane_state;
bbeb7461	100	struct drm_shadow_plane_state *shadow_plane_state;
e05162c0	101	struct drm_framebuffer *fb = new_state->fb;
1645e7b9	102	struct vkms_frame_info *frame_info;
aaa65520	103	u32 fmt;
6c234fe3	104
e05162c0	105	if (!new_state->crtc \|\| !fb)
6c234fe3 HM	106	return;
6c234fe3 HM	107
aaa65520	108	fmt = fb->format->format;
e05162c0	109	vkms_plane_state = to_vkms_plane_state(new_state);
bbeb7461	110	shadow_plane_state = &vkms_plane_state->base;
db7f419c	111
1645e7b9 IT	112	frame_info = vkms_plane_state->frame_info;
	113	memcpy(&frame_info->src, &new_state->src, sizeof(struct drm_rect));
	114	memcpy(&frame_info->dst, &new_state->dst, sizeof(struct drm_rect));
4a982034	115	memcpy(&frame_info->rotated, &new_state->dst, sizeof(struct drm_rect));
2eef1ef6	116	frame_info->fb = fb;
1645e7b9	117	memcpy(&frame_info->map, &shadow_plane_state->data, sizeof(frame_info->map));
2eef1ef6	118	drm_framebuffer_get(frame_info->fb);
4a982034	119	frame_info->rotation = drm_rotation_simplify(new_state->rotation, DRM_MODE_ROTATE_0 \|
cf7f8c67	120	DRM_MODE_ROTATE_90 \|
cd075550	121	DRM_MODE_ROTATE_270 \|
1ce76fae MC	122	DRM_MODE_REFLECT_X \|
1ce76fae MC	123	DRM_MODE_REFLECT_Y);
4a982034 MC	124
	125	drm_rect_rotate(&frame_info->rotated, drm_rect_width(&frame_info->rotated),
	126	drm_rect_height(&frame_info->rotated), frame_info->rotation);
	127
1645e7b9 IT	128	frame_info->offset = fb->offsets[0];
	129	frame_info->pitch = fb->pitches[0];
	130	frame_info->cpp = fb->format->cpp[0];
322d716a	131	vkms_plane_state->pixel_read = get_pixel_conversion_function(fmt);
42ac0321 RS	132	}
42ac0321 RS	133
d7734b74	134	static int vkms_plane_atomic_check(struct drm_plane *plane,
7c11b99a	135	struct drm_atomic_state *state)
d7734b74	136	{
7c11b99a MR	137	struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,
7c11b99a MR	138	plane);
d7734b74 HM	139	struct drm_crtc_state *crtc_state;
	140	int ret;
	141
ba5c1649	142	if (!new_plane_state->fb \|\| WARN_ON(!new_plane_state->crtc))
d7734b74 HM	143	return 0;
d7734b74 HM	144
dec92020	145	crtc_state = drm_atomic_get_crtc_state(state,
ba5c1649	146	new_plane_state->crtc);
d7734b74 HM	147	if (IS_ERR(crtc_state))
	148	return PTR_ERR(crtc_state);
	149
ba5c1649	150	ret = drm_atomic_helper_check_plane_state(new_plane_state, crtc_state,
cce32e4e TZ	151	DRM_PLANE_NO_SCALING,
cce32e4e TZ	152	DRM_PLANE_NO_SCALING,
4a1b5d18	153	true, true);
d7734b74 HM	154	if (ret != 0)
	155	return ret;
	156
d7734b74 HM	157	return 0;
	158	}
	159
6e41acd2 MC	160	static int vkms_prepare_fb(struct drm_plane *plane,
	161	struct drm_plane_state *state)
	162	{
	163	struct drm_shadow_plane_state *shadow_plane_state;
	164	struct drm_framebuffer *fb = state->fb;
	165	int ret;
	166
	167	if (!fb)
	168	return 0;
	169
	170	shadow_plane_state = to_drm_shadow_plane_state(state);
	171
	172	ret = drm_gem_plane_helper_prepare_fb(plane, state);
	173	if (ret)
	174	return ret;
	175
	176	return drm_gem_fb_vmap(fb, shadow_plane_state->map, shadow_plane_state->data);
	177	}
	178
	179	static void vkms_cleanup_fb(struct drm_plane *plane,
	180	struct drm_plane_state *state)
	181	{
	182	struct drm_shadow_plane_state *shadow_plane_state;
	183	struct drm_framebuffer *fb = state->fb;
	184
	185	if (!fb)
	186	return;
	187
	188	shadow_plane_state = to_drm_shadow_plane_state(state);
	189
	190	drm_gem_fb_vunmap(fb, shadow_plane_state->map);
	191	}
	192
a03f0285	193	static const struct drm_plane_helper_funcs vkms_plane_helper_funcs = {
c27d931d	194	.atomic_update = vkms_plane_atomic_update,
d7734b74	195	.atomic_check = vkms_plane_atomic_check,
6e41acd2 MC	196	.prepare_fb = vkms_prepare_fb,
6e41acd2 MC	197	.cleanup_fb = vkms_cleanup_fb,
42ac0321 RS	198	};
42ac0321 RS	199
2f56dd8c MW	200	struct vkms_plane vkms_plane_init(struct vkms_device vkmsdev,
2f56dd8c MW	201	enum drm_plane_type type, int index)
854502fa RS	202	{
854502fa RS	203	struct drm_device *dev = &vkmsdev->drm;
2f56dd8c	204	struct vkms_plane *plane;
854502fa	205
2f56dd8c MW	206	plane = drmm_universal_plane_alloc(dev, struct vkms_plane, base, 1 << index,
2f56dd8c MW	207	&vkms_plane_funcs,
a03f0285	208	vkms_formats, ARRAY_SIZE(vkms_formats),
2f56dd8c MW	209	NULL, type, NULL);
	210	if (IS_ERR(plane))
	211	return plane;
854502fa	212
a03f0285	213	drm_plane_helper_add(&plane->base, &vkms_plane_helper_funcs);
42ac0321	214
4a982034	215	drm_plane_create_rotation_property(&plane->base, DRM_MODE_ROTATE_0,
cd075550	216	DRM_MODE_ROTATE_MASK \| DRM_MODE_REFLECT_MASK);
4a982034	217
854502fa RS	218	return plane;
854502fa RS	219	}