drivers/gpu/drm/exynos/exynos_drm_connector.c

   1 /*
   2  * Copyright (c) 2011 Samsung Electronics Co., Ltd.
   3  * Authors:
   4  *      Inki Dae <inki.dae@samsung.com>
   5  *      Joonyoung Shim <jy0922.shim@samsung.com>
   6  *      Seung-Woo Kim <sw0312.kim@samsung.com>
   7  *
   8  * Permission is hereby granted, free of charge, to any person obtaining a
   9  * copy of this software and associated documentation files (the "Software"),
  10  * to deal in the Software without restriction, including without limitation
  11  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  12  * and/or sell copies of the Software, and to permit persons to whom the
  13  * Software is furnished to do so, subject to the following conditions:
  14  *
  15  * The above copyright notice and this permission notice (including the next
  16  * paragraph) shall be included in all copies or substantial portions of the
  17  * Software.
  18  *
  19  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  20  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  22  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
  23  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  24  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  25  * OTHER DEALINGS IN THE SOFTWARE.
  26  */
  27
  28 #include "drmP.h"
  29 #include "drm_crtc_helper.h"
  30
  31 #include <drm/exynos_drm.h>
  32 #include "exynos_drm_drv.h"
  33 #include "exynos_drm_encoder.h"
  34 #include "exynos_drm_display.h"
  35
  36 #define MAX_EDID 256
  37 #define to_exynos_connector(x)  container_of(x, struct exynos_drm_connector,\
  38                                 drm_connector)
  39
  40 struct exynos_drm_connector {
  41         struct drm_connector    drm_connector;
  42         uint32_t                encoder_id;
  43         struct exynos_drm_display *display;
  44 };
  45
  46 /* convert exynos_video_timings to drm_display_mode */
  47 static inline void
  48 convert_to_display_mode(struct drm_display_mode *mode,
  49                         struct exynos_drm_panel_info *panel)
  50 {
  51         struct fb_videomode *timing = &panel->timing;
  52         DRM_DEBUG_KMS("[MODE:%d:%s]\n", DRM_BASE_ID(mode), mode->name);
  53
  54         mode->clock = timing->pixclock / 1000;
  55         mode->vrefresh = timing->refresh;
  56
  57         mode->hdisplay = timing->xres;
  58         mode->hsync_start = mode->hdisplay + timing->right_margin;
  59         mode->hsync_end = mode->hsync_start + timing->hsync_len;
  60         mode->htotal = mode->hsync_end + timing->left_margin;
  61
  62         mode->vdisplay = timing->yres;
  63         mode->vsync_start = mode->vdisplay + timing->lower_margin;
  64         mode->vsync_end = mode->vsync_start + timing->vsync_len;
  65         mode->vtotal = mode->vsync_end + timing->upper_margin;
  66         mode->width_mm = panel->width_mm;
  67         mode->height_mm = panel->height_mm;
  68
  69         if (timing->vmode & FB_VMODE_INTERLACED)
  70                 mode->flags |= DRM_MODE_FLAG_INTERLACE;
  71
  72         if (timing->vmode & FB_VMODE_DOUBLE)
  73                 mode->flags |= DRM_MODE_FLAG_DBLSCAN;
  74 }
  75
  76 /* convert drm_display_mode to exynos_video_timings */
  77 static inline void
  78 convert_to_video_timing(struct fb_videomode *timing,
  79                         struct drm_display_mode *mode)
  80 {
  81         DRM_DEBUG_KMS("[MODE:%d:%s]\n", DRM_BASE_ID(mode), mode->name);
  82
  83         memset(timing, 0, sizeof(*timing));
  84
  85         timing->pixclock = mode->clock * 1000;
  86         timing->refresh = drm_mode_vrefresh(mode);
  87
  88         timing->xres = mode->hdisplay;
  89         timing->right_margin = mode->hsync_start - mode->hdisplay;
  90         timing->hsync_len = mode->hsync_end - mode->hsync_start;
  91         timing->left_margin = mode->htotal - mode->hsync_end;
  92
  93         timing->yres = mode->vdisplay;
  94         timing->lower_margin = mode->vsync_start - mode->vdisplay;
  95         timing->vsync_len = mode->vsync_end - mode->vsync_start;
  96         timing->upper_margin = mode->vtotal - mode->vsync_end;
  97
  98         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
  99                 timing->vmode = FB_VMODE_INTERLACED;
 100         else
 101                 timing->vmode = FB_VMODE_NONINTERLACED;
 102
 103         if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
 104                 timing->vmode |= FB_VMODE_DOUBLE;
 105 }
 106
 107 static struct exynos_drm_display *display_from_connector(
 108                 struct drm_connector *connector)
 109 {
 110         return to_exynos_connector(connector)->display;
 111 }
 112
 113 static int exynos_drm_connector_get_edid(struct drm_connector *connector)
 114 {
 115         struct exynos_drm_display *display = display_from_connector(connector);
 116         int ret;
 117         struct edid *edid;
 118
 119         DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
 120                         drm_get_connector_name(connector));
 121
 122         if (!display->panel_ops->get_edid)
 123                 return -EINVAL;
 124
 125         edid = display->panel_ops->get_edid(display->panel_ctx, connector);
 126         if (IS_ERR_OR_NULL(edid)) {
 127                 ret = PTR_ERR(edid);
 128                 edid = NULL;
 129                 DRM_ERROR("Panel operation get_edid failed %d\n", ret);
 130                 goto out;
 131         }
 132
 133         ret = drm_mode_connector_update_edid_property(connector, edid);
 134         if (ret) {
 135                 DRM_ERROR("update edid property failed(%d)\n", ret);
 136                 goto out;
 137         }
 138
 139         ret = drm_add_edid_modes(connector, edid);
 140         if (ret < 0) {
 141                 DRM_ERROR("Add edid modes failed %d\n", ret);
 142                 goto out;
 143         }
 144
 145 out:
 146         connector->display_info.raw_edid = NULL;
 147         kfree(edid);
 148         return ret;
 149 }
 150
 151 static int exynos_drm_connector_get_panel(struct drm_connector *connector)
 152 {
 153         struct exynos_drm_display *display = display_from_connector(connector);
 154         struct drm_display_mode *mode;
 155         struct exynos_drm_panel_info *panel;
 156
 157         DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
 158                         drm_get_connector_name(connector));
 159
 160         if (!display->controller_ops->get_panel)
 161                 return -EINVAL;
 162
 163         panel = display->controller_ops->get_panel(display->controller_ctx);
 164
 165         mode = drm_mode_create(connector->dev);
 166         mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
 167
 168         convert_to_display_mode(mode, panel);
 169         connector->display_info.width_mm = mode->width_mm;
 170         connector->display_info.height_mm = mode->height_mm;
 171         drm_mode_set_name(mode);
 172         drm_mode_probed_add(connector, mode);
 173
 174         return 1;
 175 }
 176
 177 static int exynos_drm_connector_get_modes(struct drm_connector *connector)
 178 {
 179         int ret;
 180
 181         DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
 182                         drm_get_connector_name(connector));
 183
 184         /*
 185          * First try getting modes from EDID. If that doesn't yield any results,
 186          * fall back to the panel call.
 187          */
 188         ret = exynos_drm_connector_get_edid(connector);
 189         if (ret > 0)
 190                 return ret;
 191
 192         return exynos_drm_connector_get_panel(connector);
 193 }
 194
 195 static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
 196                                             struct drm_display_mode *mode)
 197 {
 198         struct exynos_drm_display *display = display_from_connector(connector);
 199         struct fb_videomode timing;
 200         int ret = MODE_BAD;
 201
 202         DRM_DEBUG_KMS("[CONNECTOR:%d:%s] [MODE:%d:%s]\n",
 203                         DRM_BASE_ID(connector),
 204                         drm_get_connector_name(connector), DRM_BASE_ID(mode),
 205                         mode->name);
 206
 207         convert_to_video_timing(&timing, mode);
 208
 209         if (!display->panel_ops->check_timing)
 210                 return ret;
 211
 212         if (!display->panel_ops->check_timing(display->panel_ctx, &timing))
 213                 ret = MODE_OK;
 214
 215         return ret;
 216 }
 217
 218 struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
 219 {
 220         struct drm_device *dev = connector->dev;
 221         struct exynos_drm_connector *exynos_connector =
 222                                         to_exynos_connector(connector);
 223         struct drm_mode_object *obj;
 224         struct drm_encoder *encoder;
 225
 226         DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
 227                         drm_get_connector_name(connector));
 228
 229         obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
 230                                    DRM_MODE_OBJECT_ENCODER);
 231         if (!obj) {
 232                 DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
 233                                 exynos_connector->encoder_id);
 234                 return NULL;
 235         }
 236
 237         encoder = obj_to_encoder(obj);
 238
 239         DRM_DEBUG_KMS("[CONNECTOR:%d:%s] == [ENCODER:%d:%s]\n",
 240                         DRM_BASE_ID(connector),
 241                         drm_get_connector_name(connector),
 242                         DRM_BASE_ID(encoder), drm_get_encoder_name(encoder));
 243
 244         return encoder;
 245 }
 246
 247 struct drm_bridge *exynos_drm_best_bridge(struct drm_connector *connector)
 248 {
 249         struct drm_device *dev = connector->dev;
 250         struct drm_bridge *bridge;
 251
 252         list_for_each_entry(bridge, &dev->mode_config.bridge_list, head) {
 253                 if (bridge->connector_type == connector->connector_type)
 254                         return bridge;
 255         }
 256         return NULL;
 257 }
 258
 259 static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
 260         .get_modes      = exynos_drm_connector_get_modes,
 261         .mode_valid     = exynos_drm_connector_mode_valid,
 262         .best_encoder   = exynos_drm_best_encoder,
 263         .best_bridge    = exynos_drm_best_bridge,
 264 };
 265
 266 static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
 267                                 unsigned int max_width, unsigned int max_height)
 268 {
 269         struct exynos_drm_display *display = display_from_connector(connector);
 270         unsigned int width, height;
 271
 272         DRM_DEBUG_KMS("[CONNECTOR:%d:%s] %d x %d\n", DRM_BASE_ID(connector),
 273                         drm_get_connector_name(connector), max_width,
 274                         max_height);
 275
 276         width = max_width;
 277         height = max_height;
 278
 279         /*
 280          * If the specific driver wants to find desired_mode using maximum
 281          * resolution then get max width and height from that driver.
 282          */
 283         if (display->panel_ops->get_max_res)
 284                 display->panel_ops->get_max_res(display->panel_ctx, &width,
 285                                 &height);
 286
 287         return drm_helper_probe_single_connector_modes(connector, width,
 288                                                         height);
 289 }
 290
 291 /* get detection status of display device. */
 292 static enum drm_connector_status
 293 exynos_drm_connector_detect(struct drm_connector *connector, bool force)
 294 {
 295         struct exynos_drm_display *display = display_from_connector(connector);
 296         enum drm_connector_status status;
 297
 298         if (display->panel_ops->is_connected &&
 299             display->panel_ops->is_connected(display->panel_ctx))
 300                 status = connector_status_connected;
 301         else
 302                 status = connector_status_disconnected;
 303
 304         DRM_DEBUG_KMS("[CONNECTOR:%d:%s] force: %d == %s\n",
 305                         DRM_BASE_ID(connector),
 306                         drm_get_connector_name(connector), force,
 307                         drm_get_connector_status_name(status));
 308
 309         return status;
 310 }
 311
 312 static void exynos_drm_connector_destroy(struct drm_connector *connector)
 313 {
 314         struct exynos_drm_connector *exynos_connector =
 315                 to_exynos_connector(connector);
 316
 317         DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
 318                         drm_get_connector_name(connector));
 319
 320         drm_sysfs_connector_remove(connector);
 321         drm_connector_cleanup(connector);
 322         kfree(exynos_connector);
 323 }
 324
 325 static struct drm_connector_funcs exynos_connector_funcs = {
 326         .dpms           = drm_helper_connector_dpms,
 327         .fill_modes     = exynos_drm_connector_fill_modes,
 328         .detect         = exynos_drm_connector_detect,
 329         .destroy        = exynos_drm_connector_destroy,
 330 };
 331
 332 struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
 333                                                    struct drm_encoder *encoder)
 334 {
 335         struct exynos_drm_connector *exynos_connector;
 336         struct exynos_drm_display *display = exynos_drm_get_display(encoder);
 337         struct drm_connector *connector;
 338         int type;
 339         int err;
 340
 341         DRM_DEBUG_KMS("[DEV:%s] [ENCODER:%d:%s]\n", dev->devname,
 342                         DRM_BASE_ID(encoder), drm_get_encoder_name(encoder));
 343
 344         exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
 345         if (!exynos_connector) {
 346                 DRM_ERROR("failed to allocate connector\n");
 347                 return NULL;
 348         }
 349
 350         connector = &exynos_connector->drm_connector;
 351         connector->dpms = DRM_MODE_DPMS_OFF;
 352
 353         switch (display->display_type) {
 354         case EXYNOS_DRM_DISPLAY_TYPE_MIXER:
 355                 type = DRM_MODE_CONNECTOR_HDMIA;
 356                 connector->interlace_allowed = true;
 357                 connector->polled = DRM_CONNECTOR_POLL_HPD;
 358                 break;
 359         case EXYNOS_DRM_DISPLAY_TYPE_VIDI:
 360                 type = DRM_MODE_CONNECTOR_VIRTUAL;
 361                 connector->polled = DRM_CONNECTOR_POLL_HPD;
 362                 break;
 363         case EXYNOS_DRM_DISPLAY_TYPE_FIMD:
 364                 type = DRM_MODE_CONNECTOR_eDP;
 365                 connector->polled = DRM_CONNECTOR_POLL_HPD;
 366                 break;
 367         default:
 368                 type = DRM_MODE_CONNECTOR_Unknown;
 369                 break;
 370         }
 371
 372         drm_connector_init(dev, connector, &exynos_connector_funcs, type);
 373         drm_connector_helper_add(connector, &exynos_connector_helper_funcs);
 374
 375         err = drm_sysfs_connector_add(connector);
 376         if (err)
 377                 goto err_connector;
 378
 379         exynos_connector->encoder_id = encoder->base.id;
 380         exynos_connector->display = display;
 381         connector->encoder = encoder;
 382
 383         err = drm_mode_connector_attach_encoder(connector, encoder);
 384         if (err) {
 385                 DRM_ERROR("failed to attach a connector to a encoder\n");
 386                 goto err_sysfs;
 387         }
 388
 389         DRM_DEBUG_KMS("New [CONNECTOR:%d:%s] attached to [ENCODER:%d:%s]\n",
 390                         DRM_BASE_ID(connector),
 391                         drm_get_connector_name(connector),
 392                         DRM_BASE_ID(encoder), drm_get_encoder_name(encoder));
 393
 394         return connector;
 395
 396 err_sysfs:
 397         drm_sysfs_connector_remove(connector);
 398 err_connector:
 399         drm_connector_cleanup(connector);
 400         kfree(exynos_connector);
 401         return NULL;
 402 }