3 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
5 * Inki Dae <inki.dae@samsung.com>
6 * Joonyoung Shim <jy0922.shim@samsung.com>
7 * Seung-Woo Kim <sw0312.kim@samsung.com>
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.
16 #include <drm/drm_crtc_helper.h>
18 #include "exynos_drm_crtc.h"
19 #include "exynos_drm_drv.h"
20 #include "exynos_drm_encoder.h"
21 #include "exynos_drm_plane.h"
23 #define to_exynos_crtc(x) container_of(x, struct exynos_drm_crtc,\
26 enum exynos_crtc_mode {
27 CRTC_MODE_NORMAL, /* normal mode */
28 CRTC_MODE_BLANK, /* The private plane of crtc is blank */
32 * Exynos specific crtc structure.
34 * @drm_crtc: crtc object.
35 * @drm_plane: pointer of private plane object for this crtc
36 * @manager: the manager associated with this crtc
37 * @pipe: a crtc index created at load() with a new crtc object creation
38 * and the crtc object would be set to private->crtc array
39 * to get a crtc object corresponding to this pipe from private->crtc
40 * array when irq interrupt occurred. the reason of using this pipe is that
41 * drm framework doesn't support multiple irq yet.
42 * we can refer to the crtc to current hardware interrupt occurred through
44 * @dpms: store the crtc dpms value
45 * @mode: store the crtc mode value
47 struct exynos_drm_crtc {
48 struct drm_crtc drm_crtc;
49 struct drm_plane *plane;
50 struct exynos_drm_manager *manager;
53 enum exynos_crtc_mode mode;
54 wait_queue_head_t pending_flip_queue;
55 atomic_t pending_flip;
58 static void exynos_drm_crtc_dpms(struct drm_crtc *crtc, int mode)
60 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
61 struct exynos_drm_manager *manager = exynos_crtc->manager;
63 DRM_DEBUG_KMS("crtc[%d] mode[%d]\n", crtc->base.id, mode);
65 if (exynos_crtc->dpms == mode) {
66 DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
70 if (mode > DRM_MODE_DPMS_ON) {
71 /* wait for the completion of page flip. */
72 if (!wait_event_timeout(exynos_crtc->pending_flip_queue,
73 !atomic_read(&exynos_crtc->pending_flip),
75 atomic_set(&exynos_crtc->pending_flip, 0);
76 drm_vblank_off(crtc->dev, exynos_crtc->pipe);
79 if (manager->ops->dpms)
80 manager->ops->dpms(manager, mode);
82 exynos_crtc->dpms = mode;
85 static void exynos_drm_crtc_prepare(struct drm_crtc *crtc)
87 /* drm framework doesn't check NULL. */
90 static void exynos_drm_crtc_commit(struct drm_crtc *crtc)
92 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
93 struct exynos_drm_manager *manager = exynos_crtc->manager;
95 exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
97 exynos_plane_commit(exynos_crtc->plane);
99 if (manager->ops->commit)
100 manager->ops->commit(manager);
102 exynos_plane_dpms(exynos_crtc->plane, DRM_MODE_DPMS_ON);
106 exynos_drm_crtc_mode_fixup(struct drm_crtc *crtc,
107 const struct drm_display_mode *mode,
108 struct drm_display_mode *adjusted_mode)
110 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
111 struct exynos_drm_manager *manager = exynos_crtc->manager;
113 if (manager->ops->mode_fixup)
114 return manager->ops->mode_fixup(manager, mode, adjusted_mode);
120 exynos_drm_crtc_mode_set(struct drm_crtc *crtc, struct drm_display_mode *mode,
121 struct drm_display_mode *adjusted_mode, int x, int y,
122 struct drm_framebuffer *old_fb)
124 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
125 struct exynos_drm_manager *manager = exynos_crtc->manager;
126 struct drm_plane *plane = exynos_crtc->plane;
132 * copy the mode data adjusted by mode_fixup() into crtc->mode
133 * so that hardware can be seet to proper mode.
135 memcpy(&crtc->mode, adjusted_mode, sizeof(*adjusted_mode));
137 crtc_w = crtc->primary->fb->width - x;
138 crtc_h = crtc->primary->fb->height - y;
140 if (manager->ops->mode_set)
141 manager->ops->mode_set(manager, &crtc->mode);
143 ret = exynos_plane_mode_set(plane, crtc, crtc->primary->fb, 0, 0, crtc_w, crtc_h,
144 x, y, crtc_w, crtc_h);
149 plane->fb = crtc->primary->fb;
150 drm_framebuffer_reference(plane->fb);
155 static int exynos_drm_crtc_mode_set_commit(struct drm_crtc *crtc, int x, int y,
156 struct drm_framebuffer *old_fb)
158 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
159 struct drm_plane *plane = exynos_crtc->plane;
164 /* when framebuffer changing is requested, crtc's dpms should be on */
165 if (exynos_crtc->dpms > DRM_MODE_DPMS_ON) {
166 DRM_ERROR("failed framebuffer changing request.\n");
170 crtc_w = crtc->primary->fb->width - x;
171 crtc_h = crtc->primary->fb->height - y;
173 ret = exynos_plane_mode_set(plane, crtc, crtc->primary->fb, 0, 0, crtc_w, crtc_h,
174 x, y, crtc_w, crtc_h);
178 exynos_drm_crtc_commit(crtc);
183 static int exynos_drm_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
184 struct drm_framebuffer *old_fb)
186 return exynos_drm_crtc_mode_set_commit(crtc, x, y, old_fb);
189 static void exynos_drm_crtc_disable(struct drm_crtc *crtc)
191 struct drm_plane *plane;
194 exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
196 drm_for_each_legacy_plane(plane, &crtc->dev->mode_config.plane_list) {
197 if (plane->crtc != crtc)
200 ret = plane->funcs->disable_plane(plane);
202 DRM_ERROR("Failed to disable plane %d\n", ret);
206 static struct drm_crtc_helper_funcs exynos_crtc_helper_funcs = {
207 .dpms = exynos_drm_crtc_dpms,
208 .prepare = exynos_drm_crtc_prepare,
209 .commit = exynos_drm_crtc_commit,
210 .mode_fixup = exynos_drm_crtc_mode_fixup,
211 .mode_set = exynos_drm_crtc_mode_set,
212 .mode_set_base = exynos_drm_crtc_mode_set_base,
213 .disable = exynos_drm_crtc_disable,
216 static int exynos_drm_crtc_page_flip(struct drm_crtc *crtc,
217 struct drm_framebuffer *fb,
218 struct drm_pending_vblank_event *event,
219 uint32_t page_flip_flags)
221 struct drm_device *dev = crtc->dev;
222 struct exynos_drm_private *dev_priv = dev->dev_private;
223 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
224 struct drm_framebuffer *old_fb = crtc->primary->fb;
227 /* when the page flip is requested, crtc's dpms should be on */
228 if (exynos_crtc->dpms > DRM_MODE_DPMS_ON) {
229 DRM_ERROR("failed page flip request.\n");
233 mutex_lock(&dev->struct_mutex);
237 * the pipe from user always is 0 so we can set pipe number
238 * of current owner to event.
240 event->pipe = exynos_crtc->pipe;
242 ret = drm_vblank_get(dev, exynos_crtc->pipe);
244 DRM_DEBUG("failed to acquire vblank counter\n");
249 spin_lock_irq(&dev->event_lock);
250 list_add_tail(&event->base.link,
251 &dev_priv->pageflip_event_list);
252 atomic_set(&exynos_crtc->pending_flip, 1);
253 spin_unlock_irq(&dev->event_lock);
255 crtc->primary->fb = fb;
256 ret = exynos_drm_crtc_mode_set_commit(crtc, crtc->x, crtc->y,
259 crtc->primary->fb = old_fb;
261 spin_lock_irq(&dev->event_lock);
262 drm_vblank_put(dev, exynos_crtc->pipe);
263 list_del(&event->base.link);
264 atomic_set(&exynos_crtc->pending_flip, 0);
265 spin_unlock_irq(&dev->event_lock);
271 mutex_unlock(&dev->struct_mutex);
275 static void exynos_drm_crtc_destroy(struct drm_crtc *crtc)
277 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
278 struct exynos_drm_private *private = crtc->dev->dev_private;
280 private->crtc[exynos_crtc->pipe] = NULL;
282 drm_crtc_cleanup(crtc);
286 static int exynos_drm_crtc_set_property(struct drm_crtc *crtc,
287 struct drm_property *property,
290 struct drm_device *dev = crtc->dev;
291 struct exynos_drm_private *dev_priv = dev->dev_private;
292 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
294 if (property == dev_priv->crtc_mode_property) {
295 enum exynos_crtc_mode mode = val;
297 if (mode == exynos_crtc->mode)
300 exynos_crtc->mode = mode;
303 case CRTC_MODE_NORMAL:
304 exynos_drm_crtc_commit(crtc);
306 case CRTC_MODE_BLANK:
307 exynos_plane_dpms(exynos_crtc->plane,
320 static struct drm_crtc_funcs exynos_crtc_funcs = {
321 .set_config = drm_crtc_helper_set_config,
322 .page_flip = exynos_drm_crtc_page_flip,
323 .destroy = exynos_drm_crtc_destroy,
324 .set_property = exynos_drm_crtc_set_property,
327 static const struct drm_prop_enum_list mode_names[] = {
328 { CRTC_MODE_NORMAL, "normal" },
329 { CRTC_MODE_BLANK, "blank" },
332 static void exynos_drm_crtc_attach_mode_property(struct drm_crtc *crtc)
334 struct drm_device *dev = crtc->dev;
335 struct exynos_drm_private *dev_priv = dev->dev_private;
336 struct drm_property *prop;
338 prop = dev_priv->crtc_mode_property;
340 prop = drm_property_create_enum(dev, 0, "mode", mode_names,
341 ARRAY_SIZE(mode_names));
345 dev_priv->crtc_mode_property = prop;
348 drm_object_attach_property(&crtc->base, prop, 0);
351 int exynos_drm_crtc_create(struct exynos_drm_manager *manager)
353 struct exynos_drm_crtc *exynos_crtc;
354 struct exynos_drm_private *private = manager->drm_dev->dev_private;
355 struct drm_crtc *crtc;
357 exynos_crtc = kzalloc(sizeof(*exynos_crtc), GFP_KERNEL);
361 init_waitqueue_head(&exynos_crtc->pending_flip_queue);
362 atomic_set(&exynos_crtc->pending_flip, 0);
364 exynos_crtc->dpms = DRM_MODE_DPMS_OFF;
365 exynos_crtc->manager = manager;
366 exynos_crtc->pipe = manager->pipe;
367 exynos_crtc->plane = exynos_plane_init(manager->drm_dev,
368 1 << manager->pipe, true);
369 if (!exynos_crtc->plane) {
374 manager->crtc = &exynos_crtc->drm_crtc;
375 crtc = &exynos_crtc->drm_crtc;
377 private->crtc[manager->pipe] = crtc;
379 drm_crtc_init(manager->drm_dev, crtc, &exynos_crtc_funcs);
380 drm_crtc_helper_add(crtc, &exynos_crtc_helper_funcs);
382 exynos_drm_crtc_attach_mode_property(crtc);
387 int exynos_drm_crtc_enable_vblank(struct drm_device *dev, int pipe)
389 struct exynos_drm_private *private = dev->dev_private;
390 struct exynos_drm_crtc *exynos_crtc =
391 to_exynos_crtc(private->crtc[pipe]);
392 struct exynos_drm_manager *manager = exynos_crtc->manager;
394 if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
397 if (manager->ops->enable_vblank)
398 manager->ops->enable_vblank(manager);
403 void exynos_drm_crtc_disable_vblank(struct drm_device *dev, int pipe)
405 struct exynos_drm_private *private = dev->dev_private;
406 struct exynos_drm_crtc *exynos_crtc =
407 to_exynos_crtc(private->crtc[pipe]);
408 struct exynos_drm_manager *manager = exynos_crtc->manager;
410 if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
413 if (manager->ops->disable_vblank)
414 manager->ops->disable_vblank(manager);
417 void exynos_drm_crtc_finish_pageflip(struct drm_device *dev, int pipe)
419 struct exynos_drm_private *dev_priv = dev->dev_private;
420 struct drm_pending_vblank_event *e, *t;
421 struct drm_crtc *drm_crtc = dev_priv->crtc[pipe];
422 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(drm_crtc);
425 spin_lock_irqsave(&dev->event_lock, flags);
427 list_for_each_entry_safe(e, t, &dev_priv->pageflip_event_list,
429 /* if event's pipe isn't same as crtc then ignore it. */
433 list_del(&e->base.link);
434 drm_send_vblank_event(dev, -1, e);
435 drm_vblank_put(dev, pipe);
436 atomic_set(&exynos_crtc->pending_flip, 0);
437 wake_up(&exynos_crtc->pending_flip_queue);
440 spin_unlock_irqrestore(&dev->event_lock, flags);
443 void exynos_drm_crtc_plane_mode_set(struct drm_crtc *crtc,
444 struct exynos_drm_overlay *overlay)
446 struct exynos_drm_manager *manager = to_exynos_crtc(crtc)->manager;
448 if (manager->ops->win_mode_set)
449 manager->ops->win_mode_set(manager, overlay);
452 void exynos_drm_crtc_plane_commit(struct drm_crtc *crtc, int zpos)
454 struct exynos_drm_manager *manager = to_exynos_crtc(crtc)->manager;
456 if (manager->ops->win_commit)
457 manager->ops->win_commit(manager, zpos);
460 void exynos_drm_crtc_plane_enable(struct drm_crtc *crtc, int zpos)
462 struct exynos_drm_manager *manager = to_exynos_crtc(crtc)->manager;
464 if (manager->ops->win_enable)
465 manager->ops->win_enable(manager, zpos);
468 void exynos_drm_crtc_plane_disable(struct drm_crtc *crtc, int zpos)
470 struct exynos_drm_manager *manager = to_exynos_crtc(crtc)->manager;
472 if (manager->ops->win_disable)
473 manager->ops->win_disable(manager, zpos);
476 void exynos_drm_crtc_complete_scanout(struct drm_framebuffer *fb)
478 struct exynos_drm_manager *manager;
479 struct drm_device *dev = fb->dev;
480 struct drm_crtc *crtc;
483 * make sure that overlay data are updated to real hardware
486 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
487 manager = to_exynos_crtc(crtc)->manager;
490 * wait for vblank interrupt
491 * - this makes sure that overlay data are updated to
494 if (manager->ops->wait_for_vblank)
495 manager->ops->wait_for_vblank(manager);
499 int exynos_drm_crtc_get_pipe_from_type(struct drm_device *drm_dev,
500 unsigned int out_type)
502 struct drm_crtc *crtc;
504 list_for_each_entry(crtc, &drm_dev->mode_config.crtc_list, head) {
505 struct exynos_drm_crtc *exynos_crtc;
507 exynos_crtc = to_exynos_crtc(crtc);
508 if (exynos_crtc->manager->type == out_type)
509 return exynos_crtc->manager->pipe;
515 void exynos_drm_crtc_te_handler(struct drm_crtc *crtc)
517 struct exynos_drm_manager *manager = to_exynos_crtc(crtc)->manager;
519 if (manager->ops->te_handler)
520 manager->ops->te_handler(manager);