1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <drm/drm_atomic.h>
21#include <drm/drm_atomic_helper.h>
22#include <drm/drm_plane_helper.h>
23
24#include "omap_dmm_tiler.h"
25#include "omap_drv.h"
26
27
28
29
30
31#define omap_plane _omap_plane
32
33
34
35
36
37#define to_omap_plane(x) container_of(x, struct omap_plane, base)
38
39struct omap_plane {
40 struct drm_plane base;
41 int id;
42 const char *name;
43
44 uint32_t nformats;
45 uint32_t formats[32];
46
47 struct omap_drm_irq error_irq;
48};
49
50struct omap_plane_state {
51 struct drm_plane_state base;
52
53 unsigned int zorder;
54};
55
56static inline struct omap_plane_state *
57to_omap_plane_state(struct drm_plane_state *state)
58{
59 return container_of(state, struct omap_plane_state, base);
60}
61
62static int omap_plane_prepare_fb(struct drm_plane *plane,
63 const struct drm_plane_state *new_state)
64{
65 if (!new_state->fb)
66 return 0;
67
68 return omap_framebuffer_pin(new_state->fb);
69}
70
71static void omap_plane_cleanup_fb(struct drm_plane *plane,
72 const struct drm_plane_state *old_state)
73{
74 if (old_state->fb)
75 omap_framebuffer_unpin(old_state->fb);
76}
77
78static void omap_plane_atomic_update(struct drm_plane *plane,
79 struct drm_plane_state *old_state)
80{
81 struct omap_plane *omap_plane = to_omap_plane(plane);
82 struct drm_plane_state *state = plane->state;
83 struct omap_plane_state *omap_state = to_omap_plane_state(state);
84 struct omap_overlay_info info;
85 struct omap_drm_window win;
86 int ret;
87
88 DBG("%s, crtc=%p fb=%p", omap_plane->name, state->crtc, state->fb);
89
90 memset(&info, 0, sizeof(info));
91 info.rotation_type = OMAP_DSS_ROT_DMA;
92 info.rotation = OMAP_DSS_ROT_0;
93 info.global_alpha = 0xff;
94 info.mirror = 0;
95 info.zorder = omap_state->zorder;
96
97 memset(&win, 0, sizeof(win));
98 win.rotation = state->rotation;
99 win.crtc_x = state->crtc_x;
100 win.crtc_y = state->crtc_y;
101 win.crtc_w = state->crtc_w;
102 win.crtc_h = state->crtc_h;
103
104
105
106
107
108 win.src_x = state->src_x >> 16;
109 win.src_y = state->src_y >> 16;
110
111 switch (state->rotation & DRM_ROTATE_MASK) {
112 case BIT(DRM_ROTATE_90):
113 case BIT(DRM_ROTATE_270):
114 win.src_w = state->src_h >> 16;
115 win.src_h = state->src_w >> 16;
116 break;
117 default:
118 win.src_w = state->src_w >> 16;
119 win.src_h = state->src_h >> 16;
120 break;
121 }
122
123
124 omap_framebuffer_update_scanout(state->fb, &win, &info);
125
126 DBG("%dx%d -> %dx%d (%d)", info.width, info.height,
127 info.out_width, info.out_height,
128 info.screen_width);
129 DBG("%d,%d %pad %pad", info.pos_x, info.pos_y,
130 &info.paddr, &info.p_uv_addr);
131
132 dispc_ovl_set_channel_out(omap_plane->id,
133 omap_crtc_channel(state->crtc));
134
135
136 ret = dispc_ovl_setup(omap_plane->id, &info, false,
137 omap_crtc_timings(state->crtc), false);
138 if (WARN_ON(ret)) {
139 dispc_ovl_enable(omap_plane->id, false);
140 return;
141 }
142
143 dispc_ovl_enable(omap_plane->id, true);
144}
145
146static void omap_plane_atomic_disable(struct drm_plane *plane,
147 struct drm_plane_state *old_state)
148{
149 struct omap_plane_state *omap_state = to_omap_plane_state(plane->state);
150 struct omap_plane *omap_plane = to_omap_plane(plane);
151
152 plane->state->rotation = BIT(DRM_ROTATE_0);
153 omap_state->zorder = plane->type == DRM_PLANE_TYPE_PRIMARY
154 ? 0 : omap_plane->id;
155
156 dispc_ovl_enable(omap_plane->id, false);
157}
158
159static int omap_plane_atomic_check(struct drm_plane *plane,
160 struct drm_plane_state *state)
161{
162 struct drm_crtc_state *crtc_state;
163
164 if (!state->crtc)
165 return 0;
166
167 crtc_state = drm_atomic_get_crtc_state(state->state, state->crtc);
168 if (IS_ERR(crtc_state))
169 return PTR_ERR(crtc_state);
170
171 if (state->crtc_x < 0 || state->crtc_y < 0)
172 return -EINVAL;
173
174 if (state->crtc_x + state->crtc_w > crtc_state->adjusted_mode.hdisplay)
175 return -EINVAL;
176
177 if (state->crtc_y + state->crtc_h > crtc_state->adjusted_mode.vdisplay)
178 return -EINVAL;
179
180 if (state->fb) {
181 if (state->rotation != BIT(DRM_ROTATE_0) &&
182 !omap_framebuffer_supports_rotation(state->fb))
183 return -EINVAL;
184 }
185
186 return 0;
187}
188
189static const struct drm_plane_helper_funcs omap_plane_helper_funcs = {
190 .prepare_fb = omap_plane_prepare_fb,
191 .cleanup_fb = omap_plane_cleanup_fb,
192 .atomic_check = omap_plane_atomic_check,
193 .atomic_update = omap_plane_atomic_update,
194 .atomic_disable = omap_plane_atomic_disable,
195};
196
197static void omap_plane_destroy(struct drm_plane *plane)
198{
199 struct omap_plane *omap_plane = to_omap_plane(plane);
200
201 DBG("%s", omap_plane->name);
202
203 omap_irq_unregister(plane->dev, &omap_plane->error_irq);
204
205 drm_plane_cleanup(plane);
206
207 kfree(omap_plane);
208}
209
210
211void omap_plane_install_properties(struct drm_plane *plane,
212 struct drm_mode_object *obj)
213{
214 struct drm_device *dev = plane->dev;
215 struct omap_drm_private *priv = dev->dev_private;
216
217 if (priv->has_dmm) {
218 struct drm_property *prop = dev->mode_config.rotation_property;
219
220 drm_object_attach_property(obj, prop, 0);
221 }
222
223 drm_object_attach_property(obj, priv->zorder_prop, 0);
224}
225
226static struct drm_plane_state *
227omap_plane_atomic_duplicate_state(struct drm_plane *plane)
228{
229 struct omap_plane_state *state;
230 struct omap_plane_state *copy;
231
232 if (WARN_ON(!plane->state))
233 return NULL;
234
235 state = to_omap_plane_state(plane->state);
236 copy = kmemdup(state, sizeof(*state), GFP_KERNEL);
237 if (copy == NULL)
238 return NULL;
239
240 __drm_atomic_helper_plane_duplicate_state(plane, ©->base);
241
242 return ©->base;
243}
244
245static void omap_plane_atomic_destroy_state(struct drm_plane *plane,
246 struct drm_plane_state *state)
247{
248 __drm_atomic_helper_plane_destroy_state(plane, state);
249 kfree(to_omap_plane_state(state));
250}
251
252static void omap_plane_reset(struct drm_plane *plane)
253{
254 struct omap_plane *omap_plane = to_omap_plane(plane);
255 struct omap_plane_state *omap_state;
256
257 if (plane->state) {
258 omap_plane_atomic_destroy_state(plane, plane->state);
259 plane->state = NULL;
260 }
261
262 omap_state = kzalloc(sizeof(*omap_state), GFP_KERNEL);
263 if (omap_state == NULL)
264 return;
265
266
267
268
269
270 omap_state->zorder = plane->type == DRM_PLANE_TYPE_PRIMARY
271 ? 0 : omap_plane->id;
272 omap_state->base.rotation = BIT(DRM_ROTATE_0);
273
274 plane->state = &omap_state->base;
275 plane->state->plane = plane;
276}
277
278static int omap_plane_atomic_set_property(struct drm_plane *plane,
279 struct drm_plane_state *state,
280 struct drm_property *property,
281 uint64_t val)
282{
283 struct omap_drm_private *priv = plane->dev->dev_private;
284 struct omap_plane_state *omap_state = to_omap_plane_state(state);
285
286 if (property == priv->zorder_prop)
287 omap_state->zorder = val;
288 else
289 return -EINVAL;
290
291 return 0;
292}
293
294static int omap_plane_atomic_get_property(struct drm_plane *plane,
295 const struct drm_plane_state *state,
296 struct drm_property *property,
297 uint64_t *val)
298{
299 struct omap_drm_private *priv = plane->dev->dev_private;
300 const struct omap_plane_state *omap_state =
301 container_of(state, const struct omap_plane_state, base);
302
303 if (property == priv->zorder_prop)
304 *val = omap_state->zorder;
305 else
306 return -EINVAL;
307
308 return 0;
309}
310
311static const struct drm_plane_funcs omap_plane_funcs = {
312 .update_plane = drm_atomic_helper_update_plane,
313 .disable_plane = drm_atomic_helper_disable_plane,
314 .reset = omap_plane_reset,
315 .destroy = omap_plane_destroy,
316 .set_property = drm_atomic_helper_plane_set_property,
317 .atomic_duplicate_state = omap_plane_atomic_duplicate_state,
318 .atomic_destroy_state = omap_plane_atomic_destroy_state,
319 .atomic_set_property = omap_plane_atomic_set_property,
320 .atomic_get_property = omap_plane_atomic_get_property,
321};
322
323static void omap_plane_error_irq(struct omap_drm_irq *irq, uint32_t irqstatus)
324{
325 struct omap_plane *omap_plane =
326 container_of(irq, struct omap_plane, error_irq);
327 DRM_ERROR_RATELIMITED("%s: errors: %08x\n", omap_plane->name,
328 irqstatus);
329}
330
331static const char *plane_names[] = {
332 [OMAP_DSS_GFX] = "gfx",
333 [OMAP_DSS_VIDEO1] = "vid1",
334 [OMAP_DSS_VIDEO2] = "vid2",
335 [OMAP_DSS_VIDEO3] = "vid3",
336};
337
338static const uint32_t error_irqs[] = {
339 [OMAP_DSS_GFX] = DISPC_IRQ_GFX_FIFO_UNDERFLOW,
340 [OMAP_DSS_VIDEO1] = DISPC_IRQ_VID1_FIFO_UNDERFLOW,
341 [OMAP_DSS_VIDEO2] = DISPC_IRQ_VID2_FIFO_UNDERFLOW,
342 [OMAP_DSS_VIDEO3] = DISPC_IRQ_VID3_FIFO_UNDERFLOW,
343};
344
345
346struct drm_plane *omap_plane_init(struct drm_device *dev,
347 int id, enum drm_plane_type type)
348{
349 struct omap_drm_private *priv = dev->dev_private;
350 struct drm_plane *plane;
351 struct omap_plane *omap_plane;
352 int ret;
353
354 DBG("%s: type=%d", plane_names[id], type);
355
356 omap_plane = kzalloc(sizeof(*omap_plane), GFP_KERNEL);
357 if (!omap_plane)
358 return ERR_PTR(-ENOMEM);
359
360 omap_plane->nformats = omap_framebuffer_get_formats(
361 omap_plane->formats, ARRAY_SIZE(omap_plane->formats),
362 dss_feat_get_supported_color_modes(id));
363 omap_plane->id = id;
364 omap_plane->name = plane_names[id];
365
366 plane = &omap_plane->base;
367
368 omap_plane->error_irq.irqmask = error_irqs[id];
369 omap_plane->error_irq.irq = omap_plane_error_irq;
370 omap_irq_register(dev, &omap_plane->error_irq);
371
372 ret = drm_universal_plane_init(dev, plane, (1 << priv->num_crtcs) - 1,
373 &omap_plane_funcs, omap_plane->formats,
374 omap_plane->nformats, type, NULL);
375 if (ret < 0)
376 goto error;
377
378 drm_plane_helper_add(plane, &omap_plane_helper_funcs);
379
380 omap_plane_install_properties(plane, &plane->base);
381
382 return plane;
383
384error:
385 omap_irq_unregister(plane->dev, &omap_plane->error_irq);
386 kfree(omap_plane);
387 return NULL;
388}
389