1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2012 Russell King
4 */
5
6#include <drm/drm_modeset_helper.h>
7#include <drm/drm_fourcc.h>
8#include <drm/drm_gem_framebuffer_helper.h>
9
10#include "armada_drm.h"
11#include "armada_fb.h"
12#include "armada_gem.h"
13#include "armada_hw.h"
14
15static const struct drm_framebuffer_funcs armada_fb_funcs = {
16	.destroy	= drm_gem_fb_destroy,
17	.create_handle	= drm_gem_fb_create_handle,
18};
19
20struct armada_framebuffer *armada_framebuffer_create(struct drm_device *dev,
21	const struct drm_mode_fb_cmd2 *mode, struct armada_gem_object *obj)
22{
23	struct armada_framebuffer *dfb;
24	uint8_t format, config;
25	int ret;
26
27	switch (mode->pixel_format) {
28#define FMT(drm, fmt, mod)		\
29	case DRM_FORMAT_##drm:		\
30		format = CFG_##fmt;	\
31		config = mod;		\
32		break
33	FMT(RGB565,	565,		CFG_SWAPRB);
34	FMT(BGR565,	565,		0);
35	FMT(ARGB1555,	1555,		CFG_SWAPRB);
36	FMT(ABGR1555,	1555,		0);
37	FMT(RGB888,	888PACK,	CFG_SWAPRB);
38	FMT(BGR888,	888PACK,	0);
39	FMT(XRGB8888,	X888,		CFG_SWAPRB);
40	FMT(XBGR8888,	X888,		0);
41	FMT(ARGB8888,	8888,		CFG_SWAPRB);
42	FMT(ABGR8888,	8888,		0);
43	FMT(YUYV,	422PACK,	CFG_YUV2RGB | CFG_SWAPYU | CFG_SWAPUV);
44	FMT(UYVY,	422PACK,	CFG_YUV2RGB);
45	FMT(VYUY,	422PACK,	CFG_YUV2RGB | CFG_SWAPUV);
46	FMT(YVYU,	422PACK,	CFG_YUV2RGB | CFG_SWAPYU);
47	FMT(YUV422,	422,		CFG_YUV2RGB);
48	FMT(YVU422,	422,		CFG_YUV2RGB | CFG_SWAPUV);
49	FMT(YUV420,	420,		CFG_YUV2RGB);
50	FMT(YVU420,	420,		CFG_YUV2RGB | CFG_SWAPUV);
51	FMT(C8,		PSEUDO8,	0);
52#undef FMT
53	default:
54		return ERR_PTR(-EINVAL);
55	}
56
57	dfb = kzalloc(sizeof(*dfb), GFP_KERNEL);
58	if (!dfb) {
59		DRM_ERROR("failed to allocate Armada fb object\n");
60		return ERR_PTR(-ENOMEM);
61	}
62
63	dfb->fmt = format;
64	dfb->mod = config;
65	dfb->fb.obj[0] = &obj->obj;
66
67	drm_helper_mode_fill_fb_struct(dev, &dfb->fb, mode);
68
69	ret = drm_framebuffer_init(dev, &dfb->fb, &armada_fb_funcs);
70	if (ret) {
71		kfree(dfb);
72		return ERR_PTR(ret);
73	}
74
75	/*
76	 * Take a reference on our object as we're successful - the
77	 * caller already holds a reference, which keeps us safe for
78	 * the above call, but the caller will drop their reference
79	 * to it.  Hence we need to take our own reference.
80	 */
81	drm_gem_object_get(&obj->obj);
82
83	return dfb;
84}
85
86struct drm_framebuffer *armada_fb_create(struct drm_device *dev,
87	struct drm_file *dfile, const struct drm_mode_fb_cmd2 *mode)
88{
89	const struct drm_format_info *info = drm_get_format_info(dev, mode);
90	struct armada_gem_object *obj;
91	struct armada_framebuffer *dfb;
92	int ret;
93
94	DRM_DEBUG_DRIVER("w%u h%u pf%08x f%u p%u,%u,%u\n",
95		mode->width, mode->height, mode->pixel_format,
96		mode->flags, mode->pitches[0], mode->pitches[1],
97		mode->pitches[2]);
98
99	/* We can only handle a single plane at the moment */
100	if (info->num_planes > 1 &&
101	    (mode->handles[0] != mode->handles[1] ||
102	     mode->handles[0] != mode->handles[2])) {
103		ret = -EINVAL;
104		goto err;
105	}
106
107	obj = armada_gem_object_lookup(dfile, mode->handles[0]);
108	if (!obj) {
109		ret = -ENOENT;
110		goto err;
111	}
112
113	if (obj->obj.import_attach && !obj->sgt) {
114		ret = armada_gem_map_import(obj);
115		if (ret)
116			goto err_unref;
117	}
118
119	/* Framebuffer objects must have a valid device address for scanout */
120	if (!obj->mapped) {
121		ret = -EINVAL;
122		goto err_unref;
123	}
124
125	dfb = armada_framebuffer_create(dev, mode, obj);
126	if (IS_ERR(dfb)) {
127		ret = PTR_ERR(dfb);
128		goto err;
129	}
130
131	drm_gem_object_put(&obj->obj);
132
133	return &dfb->fb;
134
135 err_unref:
136	drm_gem_object_put(&obj->obj);
137 err:
138	DRM_ERROR("failed to initialize framebuffer: %d\n", ret);
139	return ERR_PTR(ret);
140}
141