drivers/gpu/drm/exynos/exynos_drm_encoder.c

   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  *
   9  * Permission is hereby granted, free of charge, to any person obtaining a
  10  * copy of this software and associated documentation files (the "Software"),
  11  * to deal in the Software without restriction, including without limitation
  12  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  13  * and/or sell copies of the Software, and to permit persons to whom the
  14  * Software is furnished to do so, subject to the following conditions:
  15  *
  16  * The above copyright notice and this permission notice (including the next
  17  * paragraph) shall be included in all copies or substantial portions of the
  18  * Software.
  19  *
  20  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  21  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  22  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  23  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
  24  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  25  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  26  * OTHER DEALINGS IN THE SOFTWARE.
  27  */
  28
  29 #include "drmP.h"
  30 #include "drm_crtc_helper.h"
  31
  32 #include "exynos_drm_drv.h"
  33 #include "exynos_drm_crtc.h"
  34 #include "exynos_drm_encoder.h"
  35
  36 #define to_exynos_encoder(x)    container_of(x, struct exynos_drm_encoder,\
  37                                 drm_encoder)
  38
  39 /*
  40  * exynos specific encoder structure.
  41  *
  42  * @drm_encoder: encoder object.
  43  * @manager: specific encoder has its own manager to control a hardware
  44  *      appropriately and we can access a hardware drawing on this manager.
  45  * @dpms: store the encoder dpms value.
  46  */
  47 struct exynos_drm_encoder {
  48         struct drm_encoder              drm_encoder;
  49         struct exynos_drm_manager       *manager;
  50         int dpms;
  51 };
  52
  53 static void exynos_drm_display_power(struct drm_encoder *encoder, int mode)
  54 {
  55         struct drm_device *dev = encoder->dev;
  56         struct drm_connector *connector;
  57         struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
  58
  59         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
  60                 if (connector->encoder == encoder) {
  61                         struct exynos_drm_display_ops *display_ops =
  62                                                         manager->display_ops;
  63
  64                         DRM_DEBUG_KMS("connector[%d] dpms[%d]\n",
  65                                         connector->base.id, mode);
  66                         if (display_ops && display_ops->power_on)
  67                                 display_ops->power_on(manager->dev, mode);
  68                 }
  69         }
  70 }
  71
  72 static void exynos_drm_encoder_dpms(struct drm_encoder *encoder, int mode)
  73 {
  74         struct drm_device *dev = encoder->dev;
  75         struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
  76         struct exynos_drm_manager_ops *manager_ops = manager->ops;
  77         struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
  78
  79         DRM_DEBUG_KMS("%s, encoder dpms: %d\n", __FILE__, mode);
  80
  81         if (exynos_encoder->dpms == mode) {
  82                 DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
  83                 return;
  84         }
  85
  86         mutex_lock(&dev->struct_mutex);
  87
  88         switch (mode) {
  89         case DRM_MODE_DPMS_ON:
  90                 if (manager_ops && manager_ops->apply)
  91                         manager_ops->apply(manager->dev);
  92                 exynos_drm_display_power(encoder, mode);
  93                 exynos_encoder->dpms = mode;
  94                 break;
  95         case DRM_MODE_DPMS_STANDBY:
  96         case DRM_MODE_DPMS_SUSPEND:
  97         case DRM_MODE_DPMS_OFF:
  98                 exynos_drm_display_power(encoder, mode);
  99                 exynos_encoder->dpms = mode;
 100                 break;
 101         default:
 102                 DRM_ERROR("unspecified mode %d\n", mode);
 103                 break;
 104         }
 105
 106         mutex_unlock(&dev->struct_mutex);
 107 }
 108
 109 static bool
 110 exynos_drm_encoder_mode_fixup(struct drm_encoder *encoder,
 111                                const struct drm_display_mode *mode,
 112                                struct drm_display_mode *adjusted_mode)
 113 {
 114         struct drm_device *dev = encoder->dev;
 115         struct drm_connector *connector;
 116         struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
 117         struct exynos_drm_manager_ops *manager_ops = manager->ops;
 118
 119         DRM_DEBUG_KMS("%s\n", __FILE__);
 120
 121         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 122                 if (connector->encoder == encoder)
 123                         if (manager_ops && manager_ops->mode_fixup)
 124                                 manager_ops->mode_fixup(manager->dev, connector,
 125                                                         mode, adjusted_mode);
 126         }
 127
 128         return true;
 129 }
 130
 131 static void exynos_drm_encoder_mode_set(struct drm_encoder *encoder,
 132                                          struct drm_display_mode *mode,
 133                                          struct drm_display_mode *adjusted_mode)
 134 {
 135         struct drm_device *dev = encoder->dev;
 136         struct drm_connector *connector;
 137         struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
 138         struct exynos_drm_manager_ops *manager_ops = manager->ops;
 139
 140         DRM_DEBUG_KMS("%s\n", __FILE__);
 141
 142         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 143                 if (connector->encoder == encoder)
 144                         if (manager_ops && manager_ops->mode_set)
 145                                 manager_ops->mode_set(manager->dev,
 146                                                         adjusted_mode);
 147         }
 148 }
 149
 150 static void exynos_drm_encoder_prepare(struct drm_encoder *encoder)
 151 {
 152         DRM_DEBUG_KMS("%s\n", __FILE__);
 153
 154         /* drm framework doesn't check NULL. */
 155 }
 156
 157 static void exynos_drm_encoder_commit(struct drm_encoder *encoder)
 158 {
 159         struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
 160         struct exynos_drm_manager_ops *manager_ops = manager->ops;
 161
 162         DRM_DEBUG_KMS("%s\n", __FILE__);
 163
 164         if (manager_ops && manager_ops->commit)
 165                 manager_ops->commit(manager->dev);
 166 }
 167
 168 static struct drm_encoder_helper_funcs exynos_encoder_helper_funcs = {
 169         .dpms           = exynos_drm_encoder_dpms,
 170         .mode_fixup     = exynos_drm_encoder_mode_fixup,
 171         .mode_set       = exynos_drm_encoder_mode_set,
 172         .prepare        = exynos_drm_encoder_prepare,
 173         .commit         = exynos_drm_encoder_commit,
 174 };
 175
 176 static void exynos_drm_encoder_destroy(struct drm_encoder *encoder)
 177 {
 178         struct exynos_drm_encoder *exynos_encoder =
 179                 to_exynos_encoder(encoder);
 180
 181         DRM_DEBUG_KMS("%s\n", __FILE__);
 182
 183         exynos_encoder->manager->pipe = -1;
 184
 185         drm_encoder_cleanup(encoder);
 186         kfree(exynos_encoder);
 187 }
 188
 189 static struct drm_encoder_funcs exynos_encoder_funcs = {
 190         .destroy = exynos_drm_encoder_destroy,
 191 };
 192
 193 static unsigned int exynos_drm_encoder_clones(struct drm_encoder *encoder)
 194 {
 195         struct drm_encoder *clone;
 196         struct drm_device *dev = encoder->dev;
 197         struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
 198         struct exynos_drm_display_ops *display_ops =
 199                                 exynos_encoder->manager->display_ops;
 200         unsigned int clone_mask = 0;
 201         int cnt = 0;
 202
 203         list_for_each_entry(clone, &dev->mode_config.encoder_list, head) {
 204                 switch (display_ops->type) {
 205                 case EXYNOS_DISPLAY_TYPE_LCD:
 206                 case EXYNOS_DISPLAY_TYPE_HDMI:
 207                 case EXYNOS_DISPLAY_TYPE_VIDI:
 208                         clone_mask |= (1 << (cnt++));
 209                         break;
 210                 default:
 211                         continue;
 212                 }
 213         }
 214
 215         return clone_mask;
 216 }
 217
 218 void exynos_drm_encoder_setup(struct drm_device *dev)
 219 {
 220         struct drm_encoder *encoder;
 221
 222         DRM_DEBUG_KMS("%s\n", __FILE__);
 223
 224         list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
 225                 encoder->possible_clones = exynos_drm_encoder_clones(encoder);
 226 }
 227
 228 struct drm_encoder *
 229 exynos_drm_encoder_create(struct drm_device *dev,
 230                            struct exynos_drm_manager *manager,
 231                            unsigned int possible_crtcs)
 232 {
 233         struct drm_encoder *encoder;
 234         struct exynos_drm_encoder *exynos_encoder;
 235
 236         DRM_DEBUG_KMS("%s\n", __FILE__);
 237
 238         if (!manager || !possible_crtcs)
 239                 return NULL;
 240
 241         if (!manager->dev)
 242                 return NULL;
 243
 244         exynos_encoder = kzalloc(sizeof(*exynos_encoder), GFP_KERNEL);
 245         if (!exynos_encoder) {
 246                 DRM_ERROR("failed to allocate encoder\n");
 247                 return NULL;
 248         }
 249
 250         exynos_encoder->dpms = DRM_MODE_DPMS_OFF;
 251         exynos_encoder->manager = manager;
 252         encoder = &exynos_encoder->drm_encoder;
 253         encoder->possible_crtcs = possible_crtcs;
 254
 255         DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs);
 256
 257         drm_encoder_init(dev, encoder, &exynos_encoder_funcs,
 258                         DRM_MODE_ENCODER_TMDS);
 259
 260         drm_encoder_helper_add(encoder, &exynos_encoder_helper_funcs);
 261
 262         DRM_DEBUG_KMS("encoder has been created\n");
 263
 264         return encoder;
 265 }
 266
 267 struct exynos_drm_manager *exynos_drm_get_manager(struct drm_encoder *encoder)
 268 {
 269         return to_exynos_encoder(encoder)->manager;
 270 }
 271
 272 void exynos_drm_fn_encoder(struct drm_crtc *crtc, void *data,
 273                             void (*fn)(struct drm_encoder *, void *))
 274 {
 275         struct drm_device *dev = crtc->dev;
 276         struct drm_encoder *encoder;
 277         struct exynos_drm_private *private = dev->dev_private;
 278         struct exynos_drm_manager *manager;
 279
 280         list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
 281                 /*
 282                  * if crtc is detached from encoder, check pipe,
 283                  * otherwise check crtc attached to encoder
 284                  */
 285                 if (!encoder->crtc) {
 286                         manager = to_exynos_encoder(encoder)->manager;
 287                         if (manager->pipe < 0 ||
 288                                         private->crtc[manager->pipe] != crtc)
 289                                 continue;
 290                 } else {
 291                         if (encoder->crtc != crtc)
 292                                 continue;
 293                 }
 294
 295                 fn(encoder, data);
 296         }
 297 }
 298
 299 void exynos_drm_enable_vblank(struct drm_encoder *encoder, void *data)
 300 {
 301         struct exynos_drm_manager *manager =
 302                 to_exynos_encoder(encoder)->manager;
 303         struct exynos_drm_manager_ops *manager_ops = manager->ops;
 304         int crtc = *(int *)data;
 305
 306         if (manager->pipe == -1)
 307                 manager->pipe = crtc;
 308
 309         if (manager_ops->enable_vblank)
 310                 manager_ops->enable_vblank(manager->dev);
 311 }
 312
 313 void exynos_drm_disable_vblank(struct drm_encoder *encoder, void *data)
 314 {
 315         struct exynos_drm_manager *manager =
 316                 to_exynos_encoder(encoder)->manager;
 317         struct exynos_drm_manager_ops *manager_ops = manager->ops;
 318         int crtc = *(int *)data;
 319
 320         if (manager->pipe == -1)
 321                 manager->pipe = crtc;
 322
 323         if (manager_ops->disable_vblank)
 324                 manager_ops->disable_vblank(manager->dev);
 325 }
 326
 327 void exynos_drm_encoder_crtc_plane_commit(struct drm_encoder *encoder,
 328                                           void *data)
 329 {
 330         struct exynos_drm_manager *manager =
 331                 to_exynos_encoder(encoder)->manager;
 332         struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops;
 333         int zpos = DEFAULT_ZPOS;
 334
 335         if (data)
 336                 zpos = *(int *)data;
 337
 338         if (overlay_ops && overlay_ops->commit)
 339                 overlay_ops->commit(manager->dev, zpos);
 340 }
 341
 342 void exynos_drm_encoder_crtc_commit(struct drm_encoder *encoder, void *data)
 343 {
 344         struct exynos_drm_manager *manager =
 345                 to_exynos_encoder(encoder)->manager;
 346         int crtc = *(int *)data;
 347         int zpos = DEFAULT_ZPOS;
 348
 349         DRM_DEBUG_KMS("%s\n", __FILE__);
 350
 351         /*
 352          * when crtc is detached from encoder, this pipe is used
 353          * to select manager operation
 354          */
 355         manager->pipe = crtc;
 356
 357         exynos_drm_encoder_crtc_plane_commit(encoder, &zpos);
 358 }
 359
 360 void exynos_drm_encoder_dpms_from_crtc(struct drm_encoder *encoder, void *data)
 361 {
 362         struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
 363         int mode = *(int *)data;
 364
 365         DRM_DEBUG_KMS("%s\n", __FILE__);
 366
 367         exynos_drm_encoder_dpms(encoder, mode);
 368
 369         exynos_encoder->dpms = mode;
 370 }
 371
 372 void exynos_drm_encoder_crtc_dpms(struct drm_encoder *encoder, void *data)
 373 {
 374         struct drm_device *dev = encoder->dev;
 375         struct exynos_drm_encoder *exynos_encoder = to_exynos_encoder(encoder);
 376         struct exynos_drm_manager *manager = exynos_encoder->manager;
 377         struct exynos_drm_manager_ops *manager_ops = manager->ops;
 378         struct drm_connector *connector;
 379         int mode = *(int *)data;
 380
 381         DRM_DEBUG_KMS("%s\n", __FILE__);
 382
 383         if (manager_ops && manager_ops->dpms)
 384                 manager_ops->dpms(manager->dev, mode);
 385
 386         /*
 387          * set current dpms mode to the connector connected to
 388          * current encoder. connector->dpms would be checked
 389          * at drm_helper_connector_dpms()
 390          */
 391         list_for_each_entry(connector, &dev->mode_config.connector_list, head)
 392                 if (connector->encoder == encoder)
 393                         connector->dpms = mode;
 394
 395         /*
 396          * if this condition is ok then it means that the crtc is already
 397          * detached from encoder and last function for detaching is properly
 398          * done, so clear pipe from manager to prevent repeated call.
 399          */
 400         if (mode > DRM_MODE_DPMS_ON) {
 401                 if (!encoder->crtc)
 402                         manager->pipe = -1;
 403         }
 404 }
 405
 406 void exynos_drm_encoder_crtc_mode_set(struct drm_encoder *encoder, void *data)
 407 {
 408         struct exynos_drm_manager *manager =
 409                 to_exynos_encoder(encoder)->manager;
 410         struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops;
 411         struct exynos_drm_overlay *overlay = data;
 412
 413         if (overlay_ops && overlay_ops->mode_set)
 414                 overlay_ops->mode_set(manager->dev, overlay);
 415 }
 416
 417 void exynos_drm_encoder_crtc_disable(struct drm_encoder *encoder, void *data)
 418 {
 419         struct exynos_drm_manager *manager =
 420                 to_exynos_encoder(encoder)->manager;
 421         struct exynos_drm_overlay_ops *overlay_ops = manager->overlay_ops;
 422         int zpos = DEFAULT_ZPOS;
 423
 424         DRM_DEBUG_KMS("\n");
 425
 426         if (data)
 427                 zpos = *(int *)data;
 428
 429         if (overlay_ops && overlay_ops->disable)
 430                 overlay_ops->disable(manager->dev, zpos);
 431 }