1 /*
2  * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/
3  * Author: Rob Clark <rob.clark@linaro.org>
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms of the GNU General Public License version 2 as published by
7  * the Free Software Foundation.
8  *
9  * This program is distributed in the hope that it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
12  * more details.
13  *
14  * You should have received a copy of the GNU General Public License along with
15  * this program.  If not, see <http://www.gnu.org/licenses/>.
16  */
17 
18 #include <drm/drm_atomic.h>
19 #include <drm/drm_atomic_helper.h>
20 #include <drm/drm_plane_helper.h>
21 
22 #include "omap_dmm_tiler.h"
23 #include "omap_drv.h"
24 
25 /*
26  * plane funcs
27  */
28 
29 #define to_omap_plane(x) container_of(x, struct omap_plane, base)
30 
31 struct omap_plane {
32 	struct drm_plane base;
33 	enum omap_plane_id id;
34 	const char *name;
35 };
36 
37 static int omap_plane_prepare_fb(struct drm_plane *plane,
38 				 struct drm_plane_state *new_state)
39 {
40 	if (!new_state->fb)
41 		return 0;
42 
43 	return omap_framebuffer_pin(new_state->fb);
44 }
45 
46 static void omap_plane_cleanup_fb(struct drm_plane *plane,
47 				  struct drm_plane_state *old_state)
48 {
49 	if (old_state->fb)
50 		omap_framebuffer_unpin(old_state->fb);
51 }
52 
53 static void omap_plane_atomic_update(struct drm_plane *plane,
54 				     struct drm_plane_state *old_state)
55 {
56 	struct omap_drm_private *priv = plane->dev->dev_private;
57 	struct omap_plane *omap_plane = to_omap_plane(plane);
58 	struct drm_plane_state *state = plane->state;
59 	struct omap_overlay_info info;
60 	int ret;
61 
62 	DBG("%s, crtc=%p fb=%p", omap_plane->name, state->crtc, state->fb);
63 
64 	memset(&info, 0, sizeof(info));
65 	info.rotation_type = OMAP_DSS_ROT_NONE;
66 	info.rotation = DRM_MODE_ROTATE_0;
67 	info.global_alpha = 0xff;
68 	info.zorder = state->zpos;
69 
70 	/* update scanout: */
71 	omap_framebuffer_update_scanout(state->fb, state, &info);
72 
73 	DBG("%dx%d -> %dx%d (%d)", info.width, info.height,
74 			info.out_width, info.out_height,
75 			info.screen_width);
76 	DBG("%d,%d %pad %pad", info.pos_x, info.pos_y,
77 			&info.paddr, &info.p_uv_addr);
78 
79 	/* and finally, update omapdss: */
80 	ret = priv->dispc_ops->ovl_setup(priv->dispc, omap_plane->id, &info,
81 			      omap_crtc_timings(state->crtc), false,
82 			      omap_crtc_channel(state->crtc));
83 	if (ret) {
84 		dev_err(plane->dev->dev, "Failed to setup plane %s\n",
85 			omap_plane->name);
86 		priv->dispc_ops->ovl_enable(priv->dispc, omap_plane->id, false);
87 		return;
88 	}
89 
90 	priv->dispc_ops->ovl_enable(priv->dispc, omap_plane->id, true);
91 }
92 
93 static void omap_plane_atomic_disable(struct drm_plane *plane,
94 				      struct drm_plane_state *old_state)
95 {
96 	struct omap_drm_private *priv = plane->dev->dev_private;
97 	struct omap_plane *omap_plane = to_omap_plane(plane);
98 
99 	plane->state->rotation = DRM_MODE_ROTATE_0;
100 	plane->state->zpos = plane->type == DRM_PLANE_TYPE_PRIMARY
101 			   ? 0 : omap_plane->id;
102 
103 	priv->dispc_ops->ovl_enable(priv->dispc, omap_plane->id, false);
104 }
105 
106 static int omap_plane_atomic_check(struct drm_plane *plane,
107 				   struct drm_plane_state *state)
108 {
109 	struct drm_crtc_state *crtc_state;
110 
111 	if (!state->fb)
112 		return 0;
113 
114 	/* crtc should only be NULL when disabling (i.e., !state->fb) */
115 	if (WARN_ON(!state->crtc))
116 		return 0;
117 
118 	crtc_state = drm_atomic_get_existing_crtc_state(state->state, state->crtc);
119 	/* we should have a crtc state if the plane is attached to a crtc */
120 	if (WARN_ON(!crtc_state))
121 		return 0;
122 
123 	if (!crtc_state->enable)
124 		return 0;
125 
126 	if (state->crtc_x < 0 || state->crtc_y < 0)
127 		return -EINVAL;
128 
129 	if (state->crtc_x + state->crtc_w > crtc_state->adjusted_mode.hdisplay)
130 		return -EINVAL;
131 
132 	if (state->crtc_y + state->crtc_h > crtc_state->adjusted_mode.vdisplay)
133 		return -EINVAL;
134 
135 	if (state->rotation != DRM_MODE_ROTATE_0 &&
136 	    !omap_framebuffer_supports_rotation(state->fb))
137 		return -EINVAL;
138 
139 	return 0;
140 }
141 
142 static const struct drm_plane_helper_funcs omap_plane_helper_funcs = {
143 	.prepare_fb = omap_plane_prepare_fb,
144 	.cleanup_fb = omap_plane_cleanup_fb,
145 	.atomic_check = omap_plane_atomic_check,
146 	.atomic_update = omap_plane_atomic_update,
147 	.atomic_disable = omap_plane_atomic_disable,
148 };
149 
150 static void omap_plane_destroy(struct drm_plane *plane)
151 {
152 	struct omap_plane *omap_plane = to_omap_plane(plane);
153 
154 	DBG("%s", omap_plane->name);
155 
156 	drm_plane_cleanup(plane);
157 
158 	kfree(omap_plane);
159 }
160 
161 /* helper to install properties which are common to planes and crtcs */
162 void omap_plane_install_properties(struct drm_plane *plane,
163 		struct drm_mode_object *obj)
164 {
165 	struct drm_device *dev = plane->dev;
166 	struct omap_drm_private *priv = dev->dev_private;
167 
168 	if (priv->has_dmm) {
169 		if (!plane->rotation_property)
170 			drm_plane_create_rotation_property(plane,
171 							   DRM_MODE_ROTATE_0,
172 							   DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_90 |
173 							   DRM_MODE_ROTATE_180 | DRM_MODE_ROTATE_270 |
174 							   DRM_MODE_REFLECT_X | DRM_MODE_REFLECT_Y);
175 
176 		/* Attach the rotation property also to the crtc object */
177 		if (plane->rotation_property && obj != &plane->base)
178 			drm_object_attach_property(obj, plane->rotation_property,
179 						   DRM_MODE_ROTATE_0);
180 	}
181 
182 	drm_object_attach_property(obj, priv->zorder_prop, 0);
183 }
184 
185 static void omap_plane_reset(struct drm_plane *plane)
186 {
187 	struct omap_plane *omap_plane = to_omap_plane(plane);
188 
189 	drm_atomic_helper_plane_reset(plane);
190 	if (!plane->state)
191 		return;
192 
193 	/*
194 	 * Set the zpos default depending on whether we are a primary or overlay
195 	 * plane.
196 	 */
197 	plane->state->zpos = plane->type == DRM_PLANE_TYPE_PRIMARY
198 			   ? 0 : omap_plane->id;
199 }
200 
201 static int omap_plane_atomic_set_property(struct drm_plane *plane,
202 					  struct drm_plane_state *state,
203 					  struct drm_property *property,
204 					  u64 val)
205 {
206 	struct omap_drm_private *priv = plane->dev->dev_private;
207 
208 	if (property == priv->zorder_prop)
209 		state->zpos = val;
210 	else
211 		return -EINVAL;
212 
213 	return 0;
214 }
215 
216 static int omap_plane_atomic_get_property(struct drm_plane *plane,
217 					  const struct drm_plane_state *state,
218 					  struct drm_property *property,
219 					  u64 *val)
220 {
221 	struct omap_drm_private *priv = plane->dev->dev_private;
222 
223 	if (property == priv->zorder_prop)
224 		*val = state->zpos;
225 	else
226 		return -EINVAL;
227 
228 	return 0;
229 }
230 
231 static const struct drm_plane_funcs omap_plane_funcs = {
232 	.update_plane = drm_atomic_helper_update_plane,
233 	.disable_plane = drm_atomic_helper_disable_plane,
234 	.reset = omap_plane_reset,
235 	.destroy = omap_plane_destroy,
236 	.atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
237 	.atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
238 	.atomic_set_property = omap_plane_atomic_set_property,
239 	.atomic_get_property = omap_plane_atomic_get_property,
240 };
241 
242 static const char *plane_id_to_name[] = {
243 	[OMAP_DSS_GFX] = "gfx",
244 	[OMAP_DSS_VIDEO1] = "vid1",
245 	[OMAP_DSS_VIDEO2] = "vid2",
246 	[OMAP_DSS_VIDEO3] = "vid3",
247 };
248 
249 static const enum omap_plane_id plane_idx_to_id[] = {
250 	OMAP_DSS_GFX,
251 	OMAP_DSS_VIDEO1,
252 	OMAP_DSS_VIDEO2,
253 	OMAP_DSS_VIDEO3,
254 };
255 
256 /* initialize plane */
257 struct drm_plane *omap_plane_init(struct drm_device *dev,
258 		int idx, enum drm_plane_type type,
259 		u32 possible_crtcs)
260 {
261 	struct omap_drm_private *priv = dev->dev_private;
262 	unsigned int num_planes = priv->dispc_ops->get_num_ovls(priv->dispc);
263 	struct drm_plane *plane;
264 	struct omap_plane *omap_plane;
265 	enum omap_plane_id id;
266 	int ret;
267 	u32 nformats;
268 	const u32 *formats;
269 
270 	if (WARN_ON(idx >= ARRAY_SIZE(plane_idx_to_id)))
271 		return ERR_PTR(-EINVAL);
272 
273 	id = plane_idx_to_id[idx];
274 
275 	DBG("%s: type=%d", plane_id_to_name[id], type);
276 
277 	omap_plane = kzalloc(sizeof(*omap_plane), GFP_KERNEL);
278 	if (!omap_plane)
279 		return ERR_PTR(-ENOMEM);
280 
281 	formats = priv->dispc_ops->ovl_get_color_modes(priv->dispc, id);
282 	for (nformats = 0; formats[nformats]; ++nformats)
283 		;
284 	omap_plane->id = id;
285 	omap_plane->name = plane_id_to_name[id];
286 
287 	plane = &omap_plane->base;
288 
289 	ret = drm_universal_plane_init(dev, plane, possible_crtcs,
290 				       &omap_plane_funcs, formats,
291 				       nformats, NULL, type, NULL);
292 	if (ret < 0)
293 		goto error;
294 
295 	drm_plane_helper_add(plane, &omap_plane_helper_funcs);
296 
297 	omap_plane_install_properties(plane, &plane->base);
298 	drm_plane_create_zpos_property(plane, 0, 0, num_planes - 1);
299 
300 	return plane;
301 
302 error:
303 	dev_err(dev->dev, "%s(): could not create plane: %s\n",
304 		__func__, plane_id_to_name[id]);
305 
306 	kfree(omap_plane);
307 	return NULL;
308 }
309