drivers/gpu/drm/exynos/exynos_drm_crtc.c

   1 /* exynos_drm_crtc.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  *
   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.
  13  */
  14
  15 #include <drm/drmP.h>
  16 #include <drm/drm_crtc_helper.h>
  17 #include <drm/drm_atomic.h>
  18 #include <drm/drm_atomic_helper.h>
  19
  20 #include "exynos_drm_crtc.h"
  21 #include "exynos_drm_drv.h"
  22 #include "exynos_drm_encoder.h"
  23 #include "exynos_drm_plane.h"
  24
  25 static void exynos_drm_crtc_dpms(struct drm_crtc *crtc, int mode)
  26 {
  27         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
  28
  29         DRM_DEBUG_KMS("crtc[%d] mode[%d]\n", crtc->base.id, mode);
  30
  31         if (exynos_crtc->dpms == mode) {
  32                 DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
  33                 return;
  34         }
  35
  36         if (mode > DRM_MODE_DPMS_ON) {
  37                 /* wait for the completion of page flip. */
  38                 if (!wait_event_timeout(exynos_crtc->pending_flip_queue,
  39                                 (exynos_crtc->event == NULL), HZ/20))
  40                         exynos_crtc->event = NULL;
  41                 drm_crtc_vblank_off(crtc);
  42         }
  43
  44         if (exynos_crtc->ops->dpms)
  45                 exynos_crtc->ops->dpms(exynos_crtc, mode);
  46
  47         exynos_crtc->dpms = mode;
  48
  49         if (mode == DRM_MODE_DPMS_ON)
  50                 drm_crtc_vblank_on(crtc);
  51 }
  52
  53 static void exynos_drm_crtc_prepare(struct drm_crtc *crtc)
  54 {
  55         /* drm framework doesn't check NULL. */
  56 }
  57
  58 static void exynos_drm_crtc_commit(struct drm_crtc *crtc)
  59 {
  60         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
  61         struct exynos_drm_plane *exynos_plane = to_exynos_plane(crtc->primary);
  62
  63         exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
  64
  65         if (exynos_crtc->ops->win_commit)
  66                 exynos_crtc->ops->win_commit(exynos_crtc, exynos_plane->zpos);
  67 }
  68
  69 static bool
  70 exynos_drm_crtc_mode_fixup(struct drm_crtc *crtc,
  71                             const struct drm_display_mode *mode,
  72                             struct drm_display_mode *adjusted_mode)
  73 {
  74         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
  75
  76         if (exynos_crtc->ops->mode_fixup)
  77                 return exynos_crtc->ops->mode_fixup(exynos_crtc, mode,
  78                                                     adjusted_mode);
  79
  80         return true;
  81 }
  82
  83 static void
  84 exynos_drm_crtc_mode_set_nofb(struct drm_crtc *crtc)
  85 {
  86         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
  87
  88         if (exynos_crtc->ops->commit)
  89                 exynos_crtc->ops->commit(exynos_crtc);
  90 }
  91
  92 static void exynos_drm_crtc_disable(struct drm_crtc *crtc)
  93 {
  94         struct drm_plane *plane;
  95         int ret;
  96
  97         exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  98
  99         drm_for_each_legacy_plane(plane, &crtc->dev->mode_config.plane_list) {
 100                 if (plane->crtc != crtc)
 101                         continue;
 102
 103                 ret = plane->funcs->disable_plane(plane);
 104                 if (ret)
 105                         DRM_ERROR("Failed to disable plane %d\n", ret);
 106         }
 107 }
 108
 109 static struct drm_crtc_helper_funcs exynos_crtc_helper_funcs = {
 110         .dpms           = exynos_drm_crtc_dpms,
 111         .prepare        = exynos_drm_crtc_prepare,
 112         .commit         = exynos_drm_crtc_commit,
 113         .mode_fixup     = exynos_drm_crtc_mode_fixup,
 114         .mode_set       = drm_helper_crtc_mode_set,
 115         .mode_set_nofb  = exynos_drm_crtc_mode_set_nofb,
 116         .mode_set_base  = drm_helper_crtc_mode_set_base,
 117         .disable        = exynos_drm_crtc_disable,
 118 };
 119
 120 static int exynos_drm_crtc_page_flip(struct drm_crtc *crtc,
 121                                      struct drm_framebuffer *fb,
 122                                      struct drm_pending_vblank_event *event,
 123                                      uint32_t page_flip_flags)
 124 {
 125         struct drm_device *dev = crtc->dev;
 126         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 127         unsigned int crtc_w, crtc_h;
 128         int ret;
 129
 130         /* when the page flip is requested, crtc's dpms should be on */
 131         if (exynos_crtc->dpms > DRM_MODE_DPMS_ON) {
 132                 DRM_ERROR("failed page flip request.\n");
 133                 return -EINVAL;
 134         }
 135
 136         if (!event)
 137                 return -EINVAL;
 138
 139         spin_lock_irq(&dev->event_lock);
 140         if (exynos_crtc->event) {
 141                 ret = -EBUSY;
 142                 goto out;
 143         }
 144
 145         ret = exynos_check_plane(crtc->primary, fb);
 146         if (ret)
 147                 goto out;
 148
 149         ret = drm_vblank_get(dev, exynos_crtc->pipe);
 150         if (ret) {
 151                 DRM_DEBUG("failed to acquire vblank counter\n");
 152                 goto out;
 153         }
 154
 155         exynos_crtc->event = event;
 156         spin_unlock_irq(&dev->event_lock);
 157
 158         /*
 159          * the pipe from user always is 0 so we can set pipe number
 160          * of current owner to event.
 161          */
 162         event->pipe = exynos_crtc->pipe;
 163
 164         crtc->primary->fb = fb;
 165         crtc_w = fb->width - crtc->x;
 166         crtc_h = fb->height - crtc->y;
 167         exynos_update_plane(crtc->primary, crtc, fb, 0, 0,
 168                             crtc_w, crtc_h, crtc->x << 16, crtc->y << 16,
 169                             crtc_w << 16, crtc_h << 16);
 170
 171         if (crtc->primary->state)
 172                 drm_atomic_set_fb_for_plane(crtc->primary->state, fb);
 173
 174         return 0;
 175
 176 out:
 177         spin_unlock_irq(&dev->event_lock);
 178         return ret;
 179 }
 180
 181 static void exynos_drm_crtc_destroy(struct drm_crtc *crtc)
 182 {
 183         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 184         struct exynos_drm_private *private = crtc->dev->dev_private;
 185
 186         private->crtc[exynos_crtc->pipe] = NULL;
 187
 188         drm_crtc_cleanup(crtc);
 189         kfree(exynos_crtc);
 190 }
 191
 192 static struct drm_crtc_funcs exynos_crtc_funcs = {
 193         .set_config     = drm_crtc_helper_set_config,
 194         .page_flip      = exynos_drm_crtc_page_flip,
 195         .destroy        = exynos_drm_crtc_destroy,
 196         .reset = drm_atomic_helper_crtc_reset,
 197         .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
 198         .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
 199 };
 200
 201 struct exynos_drm_crtc *exynos_drm_crtc_create(struct drm_device *drm_dev,
 202                                         struct drm_plane *plane,
 203                                         int pipe,
 204                                         enum exynos_drm_output_type type,
 205                                         const struct exynos_drm_crtc_ops *ops,
 206                                         void *ctx)
 207 {
 208         struct exynos_drm_crtc *exynos_crtc;
 209         struct exynos_drm_private *private = drm_dev->dev_private;
 210         struct drm_crtc *crtc;
 211         int ret;
 212
 213         exynos_crtc = kzalloc(sizeof(*exynos_crtc), GFP_KERNEL);
 214         if (!exynos_crtc)
 215                 return ERR_PTR(-ENOMEM);
 216
 217         init_waitqueue_head(&exynos_crtc->pending_flip_queue);
 218
 219         exynos_crtc->dpms = DRM_MODE_DPMS_OFF;
 220         exynos_crtc->pipe = pipe;
 221         exynos_crtc->type = type;
 222         exynos_crtc->ops = ops;
 223         exynos_crtc->ctx = ctx;
 224
 225         crtc = &exynos_crtc->base;
 226
 227         private->crtc[pipe] = crtc;
 228
 229         ret = drm_crtc_init_with_planes(drm_dev, crtc, plane, NULL,
 230                                         &exynos_crtc_funcs);
 231         if (ret < 0)
 232                 goto err_crtc;
 233
 234         drm_crtc_helper_add(crtc, &exynos_crtc_helper_funcs);
 235
 236         return exynos_crtc;
 237
 238 err_crtc:
 239         plane->funcs->destroy(plane);
 240         kfree(exynos_crtc);
 241         return ERR_PTR(ret);
 242 }
 243
 244 int exynos_drm_crtc_enable_vblank(struct drm_device *dev, int pipe)
 245 {
 246         struct exynos_drm_private *private = dev->dev_private;
 247         struct exynos_drm_crtc *exynos_crtc =
 248                 to_exynos_crtc(private->crtc[pipe]);
 249
 250         if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
 251                 return -EPERM;
 252
 253         if (exynos_crtc->ops->enable_vblank)
 254                 exynos_crtc->ops->enable_vblank(exynos_crtc);
 255
 256         return 0;
 257 }
 258
 259 void exynos_drm_crtc_disable_vblank(struct drm_device *dev, int pipe)
 260 {
 261         struct exynos_drm_private *private = dev->dev_private;
 262         struct exynos_drm_crtc *exynos_crtc =
 263                 to_exynos_crtc(private->crtc[pipe]);
 264
 265         if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
 266                 return;
 267
 268         if (exynos_crtc->ops->disable_vblank)
 269                 exynos_crtc->ops->disable_vblank(exynos_crtc);
 270 }
 271
 272 void exynos_drm_crtc_finish_pageflip(struct drm_device *dev, int pipe)
 273 {
 274         struct exynos_drm_private *dev_priv = dev->dev_private;
 275         struct drm_crtc *drm_crtc = dev_priv->crtc[pipe];
 276         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(drm_crtc);
 277         unsigned long flags;
 278
 279         spin_lock_irqsave(&dev->event_lock, flags);
 280         if (exynos_crtc->event) {
 281
 282                 drm_send_vblank_event(dev, -1, exynos_crtc->event);
 283                 drm_vblank_put(dev, pipe);
 284                 wake_up(&exynos_crtc->pending_flip_queue);
 285
 286         }
 287
 288         exynos_crtc->event = NULL;
 289         spin_unlock_irqrestore(&dev->event_lock, flags);
 290 }
 291
 292 void exynos_drm_crtc_complete_scanout(struct drm_framebuffer *fb)
 293 {
 294         struct exynos_drm_crtc *exynos_crtc;
 295         struct drm_device *dev = fb->dev;
 296         struct drm_crtc *crtc;
 297
 298         /*
 299          * make sure that overlay data are updated to real hardware
 300          * for all encoders.
 301          */
 302         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 303                 exynos_crtc = to_exynos_crtc(crtc);
 304
 305                 /*
 306                  * wait for vblank interrupt
 307                  * - this makes sure that overlay data are updated to
 308                  *      real hardware.
 309                  */
 310                 if (exynos_crtc->ops->wait_for_vblank)
 311                         exynos_crtc->ops->wait_for_vblank(exynos_crtc);
 312         }
 313 }
 314
 315 int exynos_drm_crtc_get_pipe_from_type(struct drm_device *drm_dev,
 316                                         unsigned int out_type)
 317 {
 318         struct drm_crtc *crtc;
 319
 320         list_for_each_entry(crtc, &drm_dev->mode_config.crtc_list, head) {
 321                 struct exynos_drm_crtc *exynos_crtc;
 322
 323                 exynos_crtc = to_exynos_crtc(crtc);
 324                 if (exynos_crtc->type == out_type)
 325                         return exynos_crtc->pipe;
 326         }
 327
 328         return -EPERM;
 329 }
 330
 331 void exynos_drm_crtc_te_handler(struct drm_crtc *crtc)
 332 {
 333         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 334
 335         if (exynos_crtc->ops->te_handler)
 336                 exynos_crtc->ops->te_handler(exynos_crtc);
 337 }