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