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
  18 #include "exynos_drm_crtc.h"
  19 #include "exynos_drm_drv.h"
  20 #include "exynos_drm_encoder.h"
  21 #include "exynos_drm_plane.h"
  22
  23 static void exynos_drm_crtc_dpms(struct drm_crtc *crtc, int mode)
  24 {
  25         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
  26
  27         DRM_DEBUG_KMS("crtc[%d] mode[%d]\n", crtc->base.id, mode);
  28
  29         if (exynos_crtc->dpms == mode) {
  30                 DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
  31                 return;
  32         }
  33
  34         if (mode > DRM_MODE_DPMS_ON) {
  35                 /* wait for the completion of page flip. */
  36                 if (!wait_event_timeout(exynos_crtc->pending_flip_queue,
  37                                 !atomic_read(&exynos_crtc->pending_flip),
  38                                 HZ/20))
  39                         atomic_set(&exynos_crtc->pending_flip, 0);
  40                 drm_crtc_vblank_off(crtc);
  41         }
  42
  43         if (exynos_crtc->ops->dpms)
  44                 exynos_crtc->ops->dpms(exynos_crtc, mode);
  45
  46         exynos_crtc->dpms = mode;
  47
  48         if (mode == DRM_MODE_DPMS_ON)
  49                 drm_crtc_vblank_on(crtc);
  50 }
  51
  52 static void exynos_drm_crtc_prepare(struct drm_crtc *crtc)
  53 {
  54         /* drm framework doesn't check NULL. */
  55 }
  56
  57 static void exynos_drm_crtc_commit(struct drm_crtc *crtc)
  58 {
  59         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
  60         struct exynos_drm_plane *exynos_plane = to_exynos_plane(crtc->primary);
  61
  62         exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
  63
  64         if (exynos_crtc->ops->win_commit)
  65                 exynos_crtc->ops->win_commit(exynos_crtc, exynos_plane->zpos);
  66
  67         if (exynos_crtc->ops->commit)
  68                 exynos_crtc->ops->commit(exynos_crtc);
  69
  70         exynos_plane_dpms(crtc->primary, DRM_MODE_DPMS_ON);
  71 }
  72
  73 static bool
  74 exynos_drm_crtc_mode_fixup(struct drm_crtc *crtc,
  75                             const struct drm_display_mode *mode,
  76                             struct drm_display_mode *adjusted_mode)
  77 {
  78         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
  79
  80         if (exynos_crtc->ops->mode_fixup)
  81                 return exynos_crtc->ops->mode_fixup(exynos_crtc, mode,
  82                                                     adjusted_mode);
  83
  84         return true;
  85 }
  86
  87 static int
  88 exynos_drm_crtc_mode_set(struct drm_crtc *crtc, struct drm_display_mode *mode,
  89                           struct drm_display_mode *adjusted_mode, int x, int y,
  90                           struct drm_framebuffer *old_fb)
  91 {
  92         struct drm_framebuffer *fb = crtc->primary->fb;
  93         unsigned int crtc_w;
  94         unsigned int crtc_h;
  95         int ret;
  96
  97         /*
  98          * copy the mode data adjusted by mode_fixup() into crtc->mode
  99          * so that hardware can be seet to proper mode.
 100          */
 101         memcpy(&crtc->mode, adjusted_mode, sizeof(*adjusted_mode));
 102
 103         ret = exynos_check_plane(crtc->primary, fb);
 104         if (ret < 0)
 105                 return ret;
 106
 107         crtc_w = fb->width - x;
 108         crtc_h = fb->height - y;
 109         exynos_plane_mode_set(crtc->primary, crtc, fb, 0, 0,
 110                               crtc_w, crtc_h, x, y, crtc_w, crtc_h);
 111
 112         return 0;
 113 }
 114
 115 static int exynos_drm_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
 116                                           struct drm_framebuffer *old_fb)
 117 {
 118         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 119         struct drm_framebuffer *fb = crtc->primary->fb;
 120         unsigned int crtc_w;
 121         unsigned int crtc_h;
 122
 123         /* when framebuffer changing is requested, crtc's dpms should be on */
 124         if (exynos_crtc->dpms > DRM_MODE_DPMS_ON) {
 125                 DRM_ERROR("failed framebuffer changing request.\n");
 126                 return -EPERM;
 127         }
 128
 129         crtc_w = fb->width - x;
 130         crtc_h = fb->height - y;
 131
 132         return exynos_update_plane(crtc->primary, crtc, fb, 0, 0,
 133                                    crtc_w, crtc_h, x, y, crtc_w, crtc_h);
 134 }
 135
 136 static void exynos_drm_crtc_disable(struct drm_crtc *crtc)
 137 {
 138         struct drm_plane *plane;
 139         int ret;
 140
 141         exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
 142
 143         drm_for_each_legacy_plane(plane, &crtc->dev->mode_config.plane_list) {
 144                 if (plane->crtc != crtc)
 145                         continue;
 146
 147                 ret = plane->funcs->disable_plane(plane);
 148                 if (ret)
 149                         DRM_ERROR("Failed to disable plane %d\n", ret);
 150         }
 151 }
 152
 153 static struct drm_crtc_helper_funcs exynos_crtc_helper_funcs = {
 154         .dpms           = exynos_drm_crtc_dpms,
 155         .prepare        = exynos_drm_crtc_prepare,
 156         .commit         = exynos_drm_crtc_commit,
 157         .mode_fixup     = exynos_drm_crtc_mode_fixup,
 158         .mode_set       = exynos_drm_crtc_mode_set,
 159         .mode_set_base  = exynos_drm_crtc_mode_set_base,
 160         .disable        = exynos_drm_crtc_disable,
 161 };
 162
 163 static int exynos_drm_crtc_page_flip(struct drm_crtc *crtc,
 164                                      struct drm_framebuffer *fb,
 165                                      struct drm_pending_vblank_event *event,
 166                                      uint32_t page_flip_flags)
 167 {
 168         struct drm_device *dev = crtc->dev;
 169         struct exynos_drm_private *dev_priv = dev->dev_private;
 170         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 171         struct drm_framebuffer *old_fb = crtc->primary->fb;
 172         unsigned int crtc_w, crtc_h;
 173         int ret = -EINVAL;
 174
 175         /* when the page flip is requested, crtc's dpms should be on */
 176         if (exynos_crtc->dpms > DRM_MODE_DPMS_ON) {
 177                 DRM_ERROR("failed page flip request.\n");
 178                 return -EINVAL;
 179         }
 180
 181         mutex_lock(&dev->struct_mutex);
 182
 183         if (event) {
 184                 /*
 185                  * the pipe from user always is 0 so we can set pipe number
 186                  * of current owner to event.
 187                  */
 188                 event->pipe = exynos_crtc->pipe;
 189
 190                 ret = drm_vblank_get(dev, exynos_crtc->pipe);
 191                 if (ret) {
 192                         DRM_DEBUG("failed to acquire vblank counter\n");
 193
 194                         goto out;
 195                 }
 196
 197                 spin_lock_irq(&dev->event_lock);
 198                 list_add_tail(&event->base.link,
 199                                 &dev_priv->pageflip_event_list);
 200                 atomic_set(&exynos_crtc->pending_flip, 1);
 201                 spin_unlock_irq(&dev->event_lock);
 202
 203                 crtc->primary->fb = fb;
 204                 crtc_w = fb->width - crtc->x;
 205                 crtc_h = fb->height - crtc->y;
 206                 ret = exynos_update_plane(crtc->primary, crtc, fb, 0, 0,
 207                                           crtc_w, crtc_h, crtc->x, crtc->y,
 208                                           crtc_w, crtc_h);
 209                 if (ret) {
 210                         crtc->primary->fb = old_fb;
 211
 212                         spin_lock_irq(&dev->event_lock);
 213                         drm_vblank_put(dev, exynos_crtc->pipe);
 214                         list_del(&event->base.link);
 215                         atomic_set(&exynos_crtc->pending_flip, 0);
 216                         spin_unlock_irq(&dev->event_lock);
 217
 218                         goto out;
 219                 }
 220         }
 221 out:
 222         mutex_unlock(&dev->struct_mutex);
 223         return ret;
 224 }
 225
 226 static void exynos_drm_crtc_destroy(struct drm_crtc *crtc)
 227 {
 228         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 229         struct exynos_drm_private *private = crtc->dev->dev_private;
 230
 231         private->crtc[exynos_crtc->pipe] = NULL;
 232
 233         drm_crtc_cleanup(crtc);
 234         kfree(exynos_crtc);
 235 }
 236
 237 static int exynos_drm_crtc_set_property(struct drm_crtc *crtc,
 238                                         struct drm_property *property,
 239                                         uint64_t val)
 240 {
 241         struct drm_device *dev = crtc->dev;
 242         struct exynos_drm_private *dev_priv = dev->dev_private;
 243         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 244
 245         if (property == dev_priv->crtc_mode_property) {
 246                 enum exynos_crtc_mode mode = val;
 247
 248                 if (mode == exynos_crtc->mode)
 249                         return 0;
 250
 251                 exynos_crtc->mode = mode;
 252
 253                 switch (mode) {
 254                 case CRTC_MODE_NORMAL:
 255                         exynos_drm_crtc_commit(crtc);
 256                         break;
 257                 case CRTC_MODE_BLANK:
 258                         exynos_plane_dpms(crtc->primary, DRM_MODE_DPMS_OFF);
 259                         break;
 260                 default:
 261                         break;
 262                 }
 263
 264                 return 0;
 265         }
 266
 267         return -EINVAL;
 268 }
 269
 270 static struct drm_crtc_funcs exynos_crtc_funcs = {
 271         .set_config     = drm_crtc_helper_set_config,
 272         .page_flip      = exynos_drm_crtc_page_flip,
 273         .destroy        = exynos_drm_crtc_destroy,
 274         .set_property   = exynos_drm_crtc_set_property,
 275 };
 276
 277 static const struct drm_prop_enum_list mode_names[] = {
 278         { CRTC_MODE_NORMAL, "normal" },
 279         { CRTC_MODE_BLANK, "blank" },
 280 };
 281
 282 static void exynos_drm_crtc_attach_mode_property(struct drm_crtc *crtc)
 283 {
 284         struct drm_device *dev = crtc->dev;
 285         struct exynos_drm_private *dev_priv = dev->dev_private;
 286         struct drm_property *prop;
 287
 288         prop = dev_priv->crtc_mode_property;
 289         if (!prop) {
 290                 prop = drm_property_create_enum(dev, 0, "mode", mode_names,
 291                                                 ARRAY_SIZE(mode_names));
 292                 if (!prop)
 293                         return;
 294
 295                 dev_priv->crtc_mode_property = prop;
 296         }
 297
 298         drm_object_attach_property(&crtc->base, prop, 0);
 299 }
 300
 301 struct exynos_drm_crtc *exynos_drm_crtc_create(struct drm_device *drm_dev,
 302                                                int pipe,
 303                                                enum exynos_drm_output_type type,
 304                                                struct exynos_drm_crtc_ops *ops,
 305                                                void *ctx)
 306 {
 307         struct exynos_drm_crtc *exynos_crtc;
 308         struct drm_plane *plane;
 309         struct exynos_drm_private *private = drm_dev->dev_private;
 310         struct drm_crtc *crtc;
 311         int ret;
 312
 313         exynos_crtc = kzalloc(sizeof(*exynos_crtc), GFP_KERNEL);
 314         if (!exynos_crtc)
 315                 return ERR_PTR(-ENOMEM);
 316
 317         init_waitqueue_head(&exynos_crtc->pending_flip_queue);
 318         atomic_set(&exynos_crtc->pending_flip, 0);
 319
 320         exynos_crtc->dpms = DRM_MODE_DPMS_OFF;
 321         exynos_crtc->pipe = pipe;
 322         exynos_crtc->type = type;
 323         exynos_crtc->ops = ops;
 324         exynos_crtc->ctx = ctx;
 325         plane = exynos_plane_init(drm_dev, 1 << pipe,
 326                                   DRM_PLANE_TYPE_PRIMARY);
 327         if (IS_ERR(plane)) {
 328                 ret = PTR_ERR(plane);
 329                 goto err_plane;
 330         }
 331
 332         crtc = &exynos_crtc->base;
 333
 334         private->crtc[pipe] = crtc;
 335
 336         ret = drm_crtc_init_with_planes(drm_dev, crtc, plane, NULL,
 337                                         &exynos_crtc_funcs);
 338         if (ret < 0)
 339                 goto err_crtc;
 340
 341         drm_crtc_helper_add(crtc, &exynos_crtc_helper_funcs);
 342
 343         exynos_drm_crtc_attach_mode_property(crtc);
 344
 345         return exynos_crtc;
 346
 347 err_crtc:
 348         plane->funcs->destroy(plane);
 349 err_plane:
 350         kfree(exynos_crtc);
 351         return ERR_PTR(ret);
 352 }
 353
 354 int exynos_drm_crtc_enable_vblank(struct drm_device *dev, int pipe)
 355 {
 356         struct exynos_drm_private *private = dev->dev_private;
 357         struct exynos_drm_crtc *exynos_crtc =
 358                 to_exynos_crtc(private->crtc[pipe]);
 359
 360         if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
 361                 return -EPERM;
 362
 363         if (exynos_crtc->ops->enable_vblank)
 364                 exynos_crtc->ops->enable_vblank(exynos_crtc);
 365
 366         return 0;
 367 }
 368
 369 void exynos_drm_crtc_disable_vblank(struct drm_device *dev, int pipe)
 370 {
 371         struct exynos_drm_private *private = dev->dev_private;
 372         struct exynos_drm_crtc *exynos_crtc =
 373                 to_exynos_crtc(private->crtc[pipe]);
 374
 375         if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
 376                 return;
 377
 378         if (exynos_crtc->ops->disable_vblank)
 379                 exynos_crtc->ops->disable_vblank(exynos_crtc);
 380 }
 381
 382 void exynos_drm_crtc_finish_pageflip(struct drm_device *dev, int pipe)
 383 {
 384         struct exynos_drm_private *dev_priv = dev->dev_private;
 385         struct drm_pending_vblank_event *e, *t;
 386         struct drm_crtc *drm_crtc = dev_priv->crtc[pipe];
 387         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(drm_crtc);
 388         unsigned long flags;
 389
 390         spin_lock_irqsave(&dev->event_lock, flags);
 391
 392         list_for_each_entry_safe(e, t, &dev_priv->pageflip_event_list,
 393                         base.link) {
 394                 /* if event's pipe isn't same as crtc then ignore it. */
 395                 if (pipe != e->pipe)
 396                         continue;
 397
 398                 list_del(&e->base.link);
 399                 drm_send_vblank_event(dev, -1, e);
 400                 drm_vblank_put(dev, pipe);
 401                 atomic_set(&exynos_crtc->pending_flip, 0);
 402                 wake_up(&exynos_crtc->pending_flip_queue);
 403         }
 404
 405         spin_unlock_irqrestore(&dev->event_lock, flags);
 406 }
 407
 408 void exynos_drm_crtc_complete_scanout(struct drm_framebuffer *fb)
 409 {
 410         struct exynos_drm_crtc *exynos_crtc;
 411         struct drm_device *dev = fb->dev;
 412         struct drm_crtc *crtc;
 413
 414         /*
 415          * make sure that overlay data are updated to real hardware
 416          * for all encoders.
 417          */
 418         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 419                 exynos_crtc = to_exynos_crtc(crtc);
 420
 421                 /*
 422                  * wait for vblank interrupt
 423                  * - this makes sure that overlay data are updated to
 424                  *      real hardware.
 425                  */
 426                 if (exynos_crtc->ops->wait_for_vblank)
 427                         exynos_crtc->ops->wait_for_vblank(exynos_crtc);
 428         }
 429 }
 430
 431 int exynos_drm_crtc_get_pipe_from_type(struct drm_device *drm_dev,
 432                                         unsigned int out_type)
 433 {
 434         struct drm_crtc *crtc;
 435
 436         list_for_each_entry(crtc, &drm_dev->mode_config.crtc_list, head) {
 437                 struct exynos_drm_crtc *exynos_crtc;
 438
 439                 exynos_crtc = to_exynos_crtc(crtc);
 440                 if (exynos_crtc->type == out_type)
 441                         return exynos_crtc->pipe;
 442         }
 443
 444         return -EPERM;
 445 }
 446
 447 void exynos_drm_crtc_te_handler(struct drm_crtc *crtc)
 448 {
 449         struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
 450
 451         if (exynos_crtc->ops->te_handler)
 452                 exynos_crtc->ops->te_handler(exynos_crtc);
 453 }