Commit | Line | Data |
---|---|---|
1c248b7d ID |
1 | /* exynos_drm_encoder.c |
2 | * | |
3 | * Copyright (c) 2011 Samsung Electronics Co., Ltd. | |
4 | * Authors: | |
5 | * Inki Dae <inki.dae@samsung.com> | |
6 | * Joonyoung Shim <jy0922.shim@samsung.com> | |
7 | * Seung-Woo Kim <sw0312.kim@samsung.com> | |
8 | * | |
d81aecb5 ID |
9 | * This program is free software; you can redistribute it and/or modify it |
10 | * under the terms of the GNU General Public License as published by the | |
11 | * Free Software Foundation; either version 2 of the License, or (at your | |
12 | * option) any later version. | |
1c248b7d ID |
13 | */ |
14 | ||
760285e7 DH |
15 | #include <drm/drmP.h> |
16 | #include <drm/drm_crtc_helper.h> | |
1c248b7d ID |
17 | |
18 | #include "exynos_drm_drv.h" | |
1c248b7d | 19 | #include "exynos_drm_encoder.h" |
50caf25c | 20 | #include "exynos_drm_connector.h" |
1c248b7d ID |
21 | |
22 | #define to_exynos_encoder(x) container_of(x, struct exynos_drm_encoder,\ | |
23 | drm_encoder) | |
24 | ||
25 | /* | |
26 | * exynos specific encoder structure. | |
27 | * | |
28 | * @drm_encoder: encoder object. | |
29 | * @manager: specific encoder has its own manager to control a hardware | |
30 | * appropriately and we can access a hardware drawing on this manager. | |
ec05da95 | 31 | * @dpms: store the encoder dpms value. |
44c91697 | 32 | * @updated: indicate whether overlay data updating is needed or not. |
1c248b7d ID |
33 | */ |
34 | struct exynos_drm_encoder { | |
1b85a071 | 35 | struct drm_crtc *old_crtc; |
1c248b7d ID |
36 | struct drm_encoder drm_encoder; |
37 | struct exynos_drm_manager *manager; | |
44c91697 ID |
38 | int dpms; |
39 | bool updated; | |
1c248b7d ID |
40 | }; |
41 | ||
50caf25c | 42 | static void exynos_drm_connector_power(struct drm_encoder *encoder, int mode) |
1c248b7d ID |
43 | { |
44 | struct drm_device *dev = encoder->dev; | |
45 | struct drm_connector *connector; | |
ec05da95 ID |
46 | |
47 | list_for_each_entry(connector, &dev->mode_config.connector_list, head) { | |
58f6aad7 | 48 | if (exynos_drm_best_encoder(connector) == encoder) { |
ec05da95 ID |
49 | DRM_DEBUG_KMS("connector[%d] dpms[%d]\n", |
50 | connector->base.id, mode); | |
50caf25c ID |
51 | |
52 | exynos_drm_display_power(connector, mode); | |
ec05da95 ID |
53 | } |
54 | } | |
55 | } | |
56 | ||
57 | static void exynos_drm_encoder_dpms(struct drm_encoder *encoder, int mode) | |
58 | { | |
59 | struct drm_device *dev = encoder->dev; | |
60 | struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder); | |
396464df | 61 | struct exynos_drm_manager_ops *manager_ops = manager->ops; |
ec05da95 | 62 | struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder); |
1c248b7d | 63 | |
bca34c9a | 64 | DRM_DEBUG_KMS("encoder dpms: %d\n", mode); |
1c248b7d | 65 | |
ec05da95 ID |
66 | if (exynos_encoder->dpms == mode) { |
67 | DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n"); | |
68 | return; | |
69 | } | |
70 | ||
71 | mutex_lock(&dev->struct_mutex); | |
72 | ||
396464df JS |
73 | switch (mode) { |
74 | case DRM_MODE_DPMS_ON: | |
ec05da95 | 75 | if (manager_ops && manager_ops->apply) |
44c91697 ID |
76 | if (!exynos_encoder->updated) |
77 | manager_ops->apply(manager->dev); | |
78 | ||
50caf25c | 79 | exynos_drm_connector_power(encoder, mode); |
ec05da95 | 80 | exynos_encoder->dpms = mode; |
396464df JS |
81 | break; |
82 | case DRM_MODE_DPMS_STANDBY: | |
83 | case DRM_MODE_DPMS_SUSPEND: | |
84 | case DRM_MODE_DPMS_OFF: | |
50caf25c | 85 | exynos_drm_connector_power(encoder, mode); |
ec05da95 | 86 | exynos_encoder->dpms = mode; |
44c91697 | 87 | exynos_encoder->updated = false; |
396464df JS |
88 | break; |
89 | default: | |
90 | DRM_ERROR("unspecified mode %d\n", mode); | |
91 | break; | |
92 | } | |
93 | ||
ec05da95 | 94 | mutex_unlock(&dev->struct_mutex); |
1c248b7d ID |
95 | } |
96 | ||
97 | static bool | |
98 | exynos_drm_encoder_mode_fixup(struct drm_encoder *encoder, | |
e811f5ae | 99 | const struct drm_display_mode *mode, |
1c248b7d ID |
100 | struct drm_display_mode *adjusted_mode) |
101 | { | |
1de425b0 ID |
102 | struct drm_device *dev = encoder->dev; |
103 | struct drm_connector *connector; | |
104 | struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder); | |
105 | struct exynos_drm_manager_ops *manager_ops = manager->ops; | |
106 | ||
1de425b0 ID |
107 | list_for_each_entry(connector, &dev->mode_config.connector_list, head) { |
108 | if (connector->encoder == encoder) | |
109 | if (manager_ops && manager_ops->mode_fixup) | |
110 | manager_ops->mode_fixup(manager->dev, connector, | |
111 | mode, adjusted_mode); | |
112 | } | |
1c248b7d ID |
113 | |
114 | return true; | |
115 | } | |
116 | ||
1b85a071 ID |
117 | static void disable_plane_to_crtc(struct drm_device *dev, |
118 | struct drm_crtc *old_crtc, | |
119 | struct drm_crtc *new_crtc) | |
120 | { | |
121 | struct drm_plane *plane; | |
122 | ||
123 | /* | |
124 | * if old_crtc isn't same as encoder->crtc then it means that | |
125 | * user changed crtc id to another one so the plane to old_crtc | |
126 | * should be disabled and plane->crtc should be set to new_crtc | |
127 | * (encoder->crtc) | |
128 | */ | |
129 | list_for_each_entry(plane, &dev->mode_config.plane_list, head) { | |
130 | if (plane->crtc == old_crtc) { | |
131 | /* | |
132 | * do not change below call order. | |
133 | * | |
134 | * plane->funcs->disable_plane call checks | |
135 | * if encoder->crtc is same as plane->crtc and if same | |
136 | * then overlay_ops->disable callback will be called | |
137 | * to diasble current hw overlay so plane->crtc should | |
138 | * have new_crtc because new_crtc was set to | |
139 | * encoder->crtc in advance. | |
140 | */ | |
141 | plane->crtc = new_crtc; | |
142 | plane->funcs->disable_plane(plane); | |
143 | } | |
144 | } | |
145 | } | |
146 | ||
1c248b7d ID |
147 | static void exynos_drm_encoder_mode_set(struct drm_encoder *encoder, |
148 | struct drm_display_mode *mode, | |
149 | struct drm_display_mode *adjusted_mode) | |
150 | { | |
151 | struct drm_device *dev = encoder->dev; | |
152 | struct drm_connector *connector; | |
1b85a071 ID |
153 | struct exynos_drm_manager *manager; |
154 | struct exynos_drm_manager_ops *manager_ops; | |
1c248b7d | 155 | |
1c248b7d | 156 | list_for_each_entry(connector, &dev->mode_config.connector_list, head) { |
1b85a071 ID |
157 | if (connector->encoder == encoder) { |
158 | struct exynos_drm_encoder *exynos_encoder; | |
159 | ||
160 | exynos_encoder = to_exynos_encoder(encoder); | |
161 | ||
162 | if (exynos_encoder->old_crtc != encoder->crtc && | |
163 | exynos_encoder->old_crtc) { | |
164 | ||
165 | /* | |
166 | * disable a plane to old crtc and change | |
167 | * crtc of the plane to new one. | |
168 | */ | |
169 | disable_plane_to_crtc(dev, | |
170 | exynos_encoder->old_crtc, | |
171 | encoder->crtc); | |
172 | } | |
173 | ||
174 | manager = exynos_drm_get_manager(encoder); | |
175 | manager_ops = manager->ops; | |
176 | ||
1c248b7d | 177 | if (manager_ops && manager_ops->mode_set) |
1de425b0 ID |
178 | manager_ops->mode_set(manager->dev, |
179 | adjusted_mode); | |
1b85a071 ID |
180 | |
181 | exynos_encoder->old_crtc = encoder->crtc; | |
182 | } | |
1c248b7d ID |
183 | } |
184 | } | |
185 | ||
186 | static void exynos_drm_encoder_prepare(struct drm_encoder *encoder) | |
187 | { | |
1c248b7d ID |
188 | /* drm framework doesn't check NULL. */ |
189 | } | |
190 | ||
191 | static void exynos_drm_encoder_commit(struct drm_encoder *encoder) | |
192 | { | |
44c91697 ID |
193 | struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder); |
194 | struct exynos_drm_manager *manager = exynos_encoder->manager; | |
1c248b7d | 195 | struct exynos_drm_manager_ops *manager_ops = manager->ops; |
1c248b7d | 196 | |
1c248b7d ID |
197 | if (manager_ops && manager_ops->commit) |
198 | manager_ops->commit(manager->dev); | |
44c91697 ID |
199 | |
200 | /* | |
201 | * this will avoid one issue that overlay data is updated to | |
202 | * real hardware two times. | |
203 | * And this variable will be used to check if the data was | |
204 | * already updated or not by exynos_drm_encoder_dpms function. | |
205 | */ | |
206 | exynos_encoder->updated = true; | |
8e8755dd ID |
207 | |
208 | /* | |
209 | * In case of setcrtc, there is no way to update encoder's dpms | |
210 | * so update it here. | |
211 | */ | |
212 | exynos_encoder->dpms = DRM_MODE_DPMS_ON; | |
1c248b7d ID |
213 | } |
214 | ||
1daa892c ID |
215 | void exynos_drm_encoder_complete_scanout(struct drm_framebuffer *fb) |
216 | { | |
217 | struct exynos_drm_encoder *exynos_encoder; | |
f74085a9 | 218 | struct exynos_drm_manager_ops *ops; |
1daa892c ID |
219 | struct drm_device *dev = fb->dev; |
220 | struct drm_encoder *encoder; | |
221 | ||
222 | /* | |
223 | * make sure that overlay data are updated to real hardware | |
224 | * for all encoders. | |
225 | */ | |
226 | list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) { | |
227 | exynos_encoder = to_exynos_encoder(encoder); | |
f74085a9 | 228 | ops = exynos_encoder->manager->ops; |
1daa892c ID |
229 | |
230 | /* | |
231 | * wait for vblank interrupt | |
232 | * - this makes sure that overlay data are updated to | |
233 | * real hardware. | |
234 | */ | |
f74085a9 P |
235 | if (ops->wait_for_vblank) |
236 | ops->wait_for_vblank(exynos_encoder->manager->dev); | |
1daa892c ID |
237 | } |
238 | } | |
239 | ||
240 | ||
bcf4cef9 ID |
241 | static void exynos_drm_encoder_disable(struct drm_encoder *encoder) |
242 | { | |
243 | struct drm_plane *plane; | |
244 | struct drm_device *dev = encoder->dev; | |
245 | ||
246 | exynos_drm_encoder_dpms(encoder, DRM_MODE_DPMS_OFF); | |
247 | ||
248 | /* all planes connected to this encoder should be also disabled. */ | |
249 | list_for_each_entry(plane, &dev->mode_config.plane_list, head) { | |
250 | if (plane->crtc == encoder->crtc) | |
251 | plane->funcs->disable_plane(plane); | |
252 | } | |
253 | } | |
254 | ||
1c248b7d ID |
255 | static struct drm_encoder_helper_funcs exynos_encoder_helper_funcs = { |
256 | .dpms = exynos_drm_encoder_dpms, | |
257 | .mode_fixup = exynos_drm_encoder_mode_fixup, | |
258 | .mode_set = exynos_drm_encoder_mode_set, | |
259 | .prepare = exynos_drm_encoder_prepare, | |
260 | .commit = exynos_drm_encoder_commit, | |
bcf4cef9 | 261 | .disable = exynos_drm_encoder_disable, |
1c248b7d ID |
262 | }; |
263 | ||
264 | static void exynos_drm_encoder_destroy(struct drm_encoder *encoder) | |
265 | { | |
266 | struct exynos_drm_encoder *exynos_encoder = | |
267 | to_exynos_encoder(encoder); | |
268 | ||
1c248b7d ID |
269 | exynos_encoder->manager->pipe = -1; |
270 | ||
271 | drm_encoder_cleanup(encoder); | |
1c248b7d ID |
272 | kfree(exynos_encoder); |
273 | } | |
274 | ||
275 | static struct drm_encoder_funcs exynos_encoder_funcs = { | |
276 | .destroy = exynos_drm_encoder_destroy, | |
277 | }; | |
278 | ||
d081f566 ID |
279 | static unsigned int exynos_drm_encoder_clones(struct drm_encoder *encoder) |
280 | { | |
281 | struct drm_encoder *clone; | |
282 | struct drm_device *dev = encoder->dev; | |
283 | struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder); | |
284 | struct exynos_drm_display_ops *display_ops = | |
285 | exynos_encoder->manager->display_ops; | |
286 | unsigned int clone_mask = 0; | |
287 | int cnt = 0; | |
288 | ||
289 | list_for_each_entry(clone, &dev->mode_config.encoder_list, head) { | |
290 | switch (display_ops->type) { | |
291 | case EXYNOS_DISPLAY_TYPE_LCD: | |
292 | case EXYNOS_DISPLAY_TYPE_HDMI: | |
b73d1230 | 293 | case EXYNOS_DISPLAY_TYPE_VIDI: |
d081f566 ID |
294 | clone_mask |= (1 << (cnt++)); |
295 | break; | |
296 | default: | |
297 | continue; | |
298 | } | |
299 | } | |
300 | ||
301 | return clone_mask; | |
302 | } | |
303 | ||
304 | void exynos_drm_encoder_setup(struct drm_device *dev) | |
305 | { | |
306 | struct drm_encoder *encoder; | |
307 | ||
d081f566 ID |
308 | list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) |
309 | encoder->possible_clones = exynos_drm_encoder_clones(encoder); | |
310 | } | |
311 | ||
1c248b7d ID |
312 | struct drm_encoder * |
313 | exynos_drm_encoder_create(struct drm_device *dev, | |
314 | struct exynos_drm_manager *manager, | |
315 | unsigned int possible_crtcs) | |
316 | { | |
317 | struct drm_encoder *encoder; | |
318 | struct exynos_drm_encoder *exynos_encoder; | |
319 | ||
1c248b7d ID |
320 | if (!manager || !possible_crtcs) |
321 | return NULL; | |
322 | ||
323 | if (!manager->dev) | |
324 | return NULL; | |
325 | ||
326 | exynos_encoder = kzalloc(sizeof(*exynos_encoder), GFP_KERNEL); | |
38bb5253 | 327 | if (!exynos_encoder) |
1c248b7d | 328 | return NULL; |
1c248b7d | 329 | |
ec05da95 | 330 | exynos_encoder->dpms = DRM_MODE_DPMS_OFF; |
1c248b7d ID |
331 | exynos_encoder->manager = manager; |
332 | encoder = &exynos_encoder->drm_encoder; | |
333 | encoder->possible_crtcs = possible_crtcs; | |
334 | ||
335 | DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs); | |
336 | ||
337 | drm_encoder_init(dev, encoder, &exynos_encoder_funcs, | |
338 | DRM_MODE_ENCODER_TMDS); | |
339 | ||
340 | drm_encoder_helper_add(encoder, &exynos_encoder_helper_funcs); | |
341 | ||
342 | DRM_DEBUG_KMS("encoder has been created\n"); | |
343 | ||
344 | return encoder; | |
345 | } | |
346 | ||
347 | struct exynos_drm_manager *exynos_drm_get_manager(struct drm_encoder *encoder) | |
348 | { | |
349 | return to_exynos_encoder(encoder)->manager; | |
350 | } | |
351 | ||
352 | void exynos_drm_fn_encoder(struct drm_crtc *crtc, void *data, | |
353 | void (*fn)(struct drm_encoder *, void *)) | |
354 | { | |
355 | struct drm_device *dev = crtc->dev; | |
356 | struct drm_encoder *encoder; | |
d2716c89 JS |
357 | struct exynos_drm_private *private = dev->dev_private; |
358 | struct exynos_drm_manager *manager; | |
1c248b7d ID |
359 | |
360 | list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) { | |
d2716c89 JS |
361 | /* |
362 | * if crtc is detached from encoder, check pipe, | |
363 | * otherwise check crtc attached to encoder | |
364 | */ | |
365 | if (!encoder->crtc) { | |
366 | manager = to_exynos_encoder(encoder)->manager; | |
367 | if (manager->pipe < 0 || | |
368 | private->crtc[manager->pipe] != crtc) | |
369 | continue; | |
370 | } else { | |
371 | if (encoder->crtc != crtc) | |
372 | continue; | |
373 | } | |
1c248b7d ID |
374 | |
375 | fn(encoder, data); | |
376 | } | |
377 | } | |
378 | ||
379 | void exynos_drm_enable_vblank(struct drm_encoder *encoder, void *data) | |
380 | { | |
381 | struct exynos_drm_manager *manager = | |
382 | to_exynos_encoder(encoder)->manager; | |
383 | struct exynos_drm_manager_ops *manager_ops = manager->ops; | |
384 | int crtc = *(int *)data; | |
385 | ||
d249ce02 JS |
386 | if (manager->pipe != crtc) |
387 | return; | |
1c248b7d ID |
388 | |
389 | if (manager_ops->enable_vblank) | |
390 | manager_ops->enable_vblank(manager->dev); | |
391 | } | |
392 | ||
393 | void exynos_drm_disable_vblank(struct drm_encoder *encoder, void *data) | |
394 | { | |
395 | struct exynos_drm_manager *manager = | |
396 | to_exynos_encoder(encoder)->manager; | |
397 | struct exynos_drm_manager_ops *manager_ops = manager->ops; | |
398 | int crtc = *(int *)data; | |
399 | ||
d249ce02 JS |
400 | if (manager->pipe != crtc) |
401 | return; | |
1c248b7d ID |
402 | |
403 | if (manager_ops->disable_vblank) | |
404 | manager_ops->disable_vblank(manager->dev); | |
405 | } | |
406 | ||
ec05da95 ID |
407 | void exynos_drm_encoder_crtc_dpms(struct drm_encoder *encoder, void *data) |
408 | { | |
ec05da95 ID |
409 | struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder); |
410 | struct exynos_drm_manager *manager = exynos_encoder->manager; | |
411 | struct exynos_drm_manager_ops *manager_ops = manager->ops; | |
ec05da95 ID |
412 | int mode = *(int *)data; |
413 | ||
ec05da95 ID |
414 | if (manager_ops && manager_ops->dpms) |
415 | manager_ops->dpms(manager->dev, mode); | |
416 | ||
ec05da95 ID |
417 | /* |
418 | * if this condition is ok then it means that the crtc is already | |
419 | * detached from encoder and last function for detaching is properly | |
420 | * done, so clear pipe from manager to prevent repeated call. | |
421 | */ | |
422 | if (mode > DRM_MODE_DPMS_ON) { | |
423 | if (!encoder->crtc) | |
424 | manager->pipe = -1; | |
425 | } | |
426 | } | |
427 | ||
4070d212 JS |
428 | void exynos_drm_encoder_crtc_pipe(struct drm_encoder *encoder, void *data) |
429 | { | |
430 | struct exynos_drm_manager *manager = | |
431 | to_exynos_encoder(encoder)->manager; | |
432 | int pipe = *(int *)data; | |
433 | ||
4070d212 JS |
434 | /* |
435 | * when crtc is detached from encoder, this pipe is used | |
436 | * to select manager operation | |
437 | */ | |
438 | manager->pipe = pipe; | |
439 | } | |
440 | ||
441 | void exynos_drm_encoder_plane_mode_set(struct drm_encoder *encoder, void *data) | |
1c248b7d ID |
442 | { |
443 | struct exynos_drm_manager *manager = | |
444 | to_exynos_encoder(encoder)->manager; | |
445 | struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops; | |
446 | struct exynos_drm_overlay *overlay = data; | |
447 | ||
b0e0f856 SWK |
448 | if (overlay_ops && overlay_ops->mode_set) |
449 | overlay_ops->mode_set(manager->dev, overlay); | |
1c248b7d ID |
450 | } |
451 | ||
4070d212 | 452 | void exynos_drm_encoder_plane_commit(struct drm_encoder *encoder, void *data) |
d2716c89 JS |
453 | { |
454 | struct exynos_drm_manager *manager = | |
455 | to_exynos_encoder(encoder)->manager; | |
456 | struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops; | |
864ee9e6 | 457 | int zpos = DEFAULT_ZPOS; |
d2716c89 | 458 | |
864ee9e6 JS |
459 | if (data) |
460 | zpos = *(int *)data; | |
461 | ||
4070d212 JS |
462 | if (overlay_ops && overlay_ops->commit) |
463 | overlay_ops->commit(manager->dev, zpos); | |
d2716c89 | 464 | } |
d249ce02 | 465 | |
cf5188ac JS |
466 | void exynos_drm_encoder_plane_enable(struct drm_encoder *encoder, void *data) |
467 | { | |
468 | struct exynos_drm_manager *manager = | |
469 | to_exynos_encoder(encoder)->manager; | |
470 | struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops; | |
471 | int zpos = DEFAULT_ZPOS; | |
472 | ||
cf5188ac JS |
473 | if (data) |
474 | zpos = *(int *)data; | |
475 | ||
476 | if (overlay_ops && overlay_ops->enable) | |
477 | overlay_ops->enable(manager->dev, zpos); | |
478 | } | |
479 | ||
4070d212 | 480 | void exynos_drm_encoder_plane_disable(struct drm_encoder *encoder, void *data) |
d249ce02 JS |
481 | { |
482 | struct exynos_drm_manager *manager = | |
483 | to_exynos_encoder(encoder)->manager; | |
4070d212 JS |
484 | struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops; |
485 | int zpos = DEFAULT_ZPOS; | |
d249ce02 | 486 | |
4070d212 JS |
487 | if (data) |
488 | zpos = *(int *)data; | |
489 | ||
490 | if (overlay_ops && overlay_ops->disable) | |
491 | overlay_ops->disable(manager->dev, zpos); | |
d249ce02 | 492 | } |