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  * This program is free software; you can redistribute  it and/or modify it
   9  * under  the terms of  the GNU General  Public License as published by the
  10  * Free Software Foundation;  either version 2 of the  License, or (at your
  11  * option) any later version.
  12  */
  13
  14 #include <drm/drmP.h>
  15 #include <drm/drm_crtc_helper.h>
  16
  17 #include <drm/exynos_drm.h>
  18 #include "exynos_drm_drv.h"
  19 #include "exynos_drm_encoder.h"
  20
  21 #define MAX_EDID 256
  22 #define to_exynos_connector(x)  container_of(x, struct exynos_drm_connector,\
  23                                 drm_connector)
  24
  25 struct exynos_drm_connector {
  26         struct drm_connector    drm_connector;
  27         uint32_t                encoder_id;
  28         struct exynos_drm_manager *manager;
  29         uint32_t                dpms;
  30 };
  31
  32 /* convert exynos_video_timings to drm_display_mode */
  33 static inline void
  34 convert_to_display_mode(struct drm_display_mode *mode,
  35                         struct exynos_drm_panel_info *panel)
  36 {
  37         struct fb_videomode *timing = &panel->timing;
  38         DRM_DEBUG_KMS("%s\n", __FILE__);
  39
  40         mode->clock = timing->pixclock / 1000;
  41         mode->vrefresh = timing->refresh;
  42
  43         mode->hdisplay = timing->xres;
  44         mode->hsync_start = mode->hdisplay + timing->right_margin;
  45         mode->hsync_end = mode->hsync_start + timing->hsync_len;
  46         mode->htotal = mode->hsync_end + timing->left_margin;
  47
  48         mode->vdisplay = timing->yres;
  49         mode->vsync_start = mode->vdisplay + timing->lower_margin;
  50         mode->vsync_end = mode->vsync_start + timing->vsync_len;
  51         mode->vtotal = mode->vsync_end + timing->upper_margin;
  52         mode->width_mm = panel->width_mm;
  53         mode->height_mm = panel->height_mm;
  54
  55         if (timing->vmode & FB_VMODE_INTERLACED)
  56                 mode->flags |= DRM_MODE_FLAG_INTERLACE;
  57
  58         if (timing->vmode & FB_VMODE_DOUBLE)
  59                 mode->flags |= DRM_MODE_FLAG_DBLSCAN;
  60 }
  61
  62 /* convert drm_display_mode to exynos_video_timings */
  63 static inline void
  64 convert_to_video_timing(struct fb_videomode *timing,
  65                         struct drm_display_mode *mode)
  66 {
  67         DRM_DEBUG_KMS("%s\n", __FILE__);
  68
  69         memset(timing, 0, sizeof(*timing));
  70
  71         timing->pixclock = mode->clock * 1000;
  72         timing->refresh = drm_mode_vrefresh(mode);
  73
  74         timing->xres = mode->hdisplay;
  75         timing->right_margin = mode->hsync_start - mode->hdisplay;
  76         timing->hsync_len = mode->hsync_end - mode->hsync_start;
  77         timing->left_margin = mode->htotal - mode->hsync_end;
  78
  79         timing->yres = mode->vdisplay;
  80         timing->lower_margin = mode->vsync_start - mode->vdisplay;
  81         timing->vsync_len = mode->vsync_end - mode->vsync_start;
  82         timing->upper_margin = mode->vtotal - mode->vsync_end;
  83
  84         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
  85                 timing->vmode = FB_VMODE_INTERLACED;
  86         else
  87                 timing->vmode = FB_VMODE_NONINTERLACED;
  88
  89         if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
  90                 timing->vmode |= FB_VMODE_DOUBLE;
  91 }
  92
  93 static int exynos_drm_connector_get_modes(struct drm_connector *connector)
  94 {
  95         struct exynos_drm_connector *exynos_connector =
  96                                         to_exynos_connector(connector);
  97         struct exynos_drm_manager *manager = exynos_connector->manager;
  98         struct exynos_drm_display_ops *display_ops = manager->display_ops;
  99         unsigned int count;
 100
 101         DRM_DEBUG_KMS("%s\n", __FILE__);
 102
 103         if (!display_ops) {
 104                 DRM_DEBUG_KMS("display_ops is null.\n");
 105                 return 0;
 106         }
 107
 108         /*
 109          * if get_edid() exists then get_edid() callback of hdmi side
 110          * is called to get edid data through i2c interface else
 111          * get timing from the FIMD driver(display controller).
 112          *
 113          * P.S. in case of lcd panel, count is always 1 if success
 114          * because lcd panel has only one mode.
 115          */
 116         if (display_ops->get_edid) {
 117                 int ret;
 118                 void *edid;
 119
 120                 edid = kzalloc(MAX_EDID, GFP_KERNEL);
 121                 if (!edid) {
 122                         DRM_ERROR("failed to allocate edid\n");
 123                         return 0;
 124                 }
 125
 126                 ret = display_ops->get_edid(manager->dev, connector,
 127                                                 edid, MAX_EDID);
 128                 if (ret < 0) {
 129                         DRM_ERROR("failed to get edid data.\n");
 130                         kfree(edid);
 131                         edid = NULL;
 132                         return 0;
 133                 }
 134
 135                 drm_mode_connector_update_edid_property(connector, edid);
 136                 count = drm_add_edid_modes(connector, edid);
 137                 kfree(edid);
 138         } else {
 139                 struct exynos_drm_panel_info *panel;
 140                 struct drm_display_mode *mode = drm_mode_create(connector->dev);
 141                 if (!mode) {
 142                         DRM_ERROR("failed to create a new display mode.\n");
 143                         return 0;
 144                 }
 145
 146                 if (display_ops->get_panel)
 147                         panel = display_ops->get_panel(manager->dev);
 148                 else {
 149                         drm_mode_destroy(connector->dev, mode);
 150                         return 0;
 151                 }
 152
 153                 convert_to_display_mode(mode, panel);
 154                 connector->display_info.width_mm = mode->width_mm;
 155                 connector->display_info.height_mm = mode->height_mm;
 156
 157                 mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
 158                 drm_mode_set_name(mode);
 159                 drm_mode_probed_add(connector, mode);
 160
 161                 count = 1;
 162         }
 163
 164         return count;
 165 }
 166
 167 static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
 168                                             struct drm_display_mode *mode)
 169 {
 170         struct exynos_drm_connector *exynos_connector =
 171                                         to_exynos_connector(connector);
 172         struct exynos_drm_manager *manager = exynos_connector->manager;
 173         struct exynos_drm_display_ops *display_ops = manager->display_ops;
 174         struct fb_videomode timing;
 175         int ret = MODE_BAD;
 176
 177         DRM_DEBUG_KMS("%s\n", __FILE__);
 178
 179         convert_to_video_timing(&timing, mode);
 180
 181         if (display_ops && display_ops->check_timing)
 182                 if (!display_ops->check_timing(manager->dev, (void *)&timing))
 183                         ret = MODE_OK;
 184
 185         return ret;
 186 }
 187
 188 struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
 189 {
 190         struct drm_device *dev = connector->dev;
 191         struct exynos_drm_connector *exynos_connector =
 192                                         to_exynos_connector(connector);
 193         struct drm_mode_object *obj;
 194         struct drm_encoder *encoder;
 195
 196         DRM_DEBUG_KMS("%s\n", __FILE__);
 197
 198         obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
 199                                    DRM_MODE_OBJECT_ENCODER);
 200         if (!obj) {
 201                 DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
 202                                 exynos_connector->encoder_id);
 203                 return NULL;
 204         }
 205
 206         encoder = obj_to_encoder(obj);
 207
 208         return encoder;
 209 }
 210
 211 static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
 212         .get_modes      = exynos_drm_connector_get_modes,
 213         .mode_valid     = exynos_drm_connector_mode_valid,
 214         .best_encoder   = exynos_drm_best_encoder,
 215 };
 216
 217 void exynos_drm_display_power(struct drm_connector *connector, int mode)
 218 {
 219         struct drm_encoder *encoder = exynos_drm_best_encoder(connector);
 220         struct exynos_drm_connector *exynos_connector;
 221         struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
 222         struct exynos_drm_display_ops *display_ops = manager->display_ops;
 223
 224         exynos_connector = to_exynos_connector(connector);
 225
 226         if (exynos_connector->dpms == mode) {
 227                 DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
 228                 return;
 229         }
 230
 231         if (display_ops && display_ops->power_on)
 232                 display_ops->power_on(manager->dev, mode);
 233
 234         exynos_connector->dpms = mode;
 235 }
 236
 237 static void exynos_drm_connector_dpms(struct drm_connector *connector,
 238                                         int mode)
 239 {
 240         DRM_DEBUG_KMS("%s\n", __FILE__);
 241
 242         /*
 243          * in case that drm_crtc_helper_set_mode() is called,
 244          * encoder/crtc->funcs->dpms() will be just returned
 245          * because they already were DRM_MODE_DPMS_ON so only
 246          * exynos_drm_display_power() will be called.
 247          */
 248         drm_helper_connector_dpms(connector, mode);
 249
 250         exynos_drm_display_power(connector, mode);
 251
 252 }
 253
 254 static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
 255                                 unsigned int max_width, unsigned int max_height)
 256 {
 257         struct exynos_drm_connector *exynos_connector =
 258                                         to_exynos_connector(connector);
 259         struct exynos_drm_manager *manager = exynos_connector->manager;
 260         struct exynos_drm_manager_ops *ops = manager->ops;
 261         unsigned int width, height;
 262
 263         width = max_width;
 264         height = max_height;
 265
 266         /*
 267          * if specific driver want to find desired_mode using maxmum
 268          * resolution then get max width and height from that driver.
 269          */
 270         if (ops && ops->get_max_resol)
 271                 ops->get_max_resol(manager->dev, &width, &height);
 272
 273         return drm_helper_probe_single_connector_modes(connector, width,
 274                                                         height);
 275 }
 276
 277 /* get detection status of display device. */
 278 static enum drm_connector_status
 279 exynos_drm_connector_detect(struct drm_connector *connector, bool force)
 280 {
 281         struct exynos_drm_connector *exynos_connector =
 282                                         to_exynos_connector(connector);
 283         struct exynos_drm_manager *manager = exynos_connector->manager;
 284         struct exynos_drm_display_ops *display_ops =
 285                                         manager->display_ops;
 286         enum drm_connector_status status = connector_status_disconnected;
 287
 288         DRM_DEBUG_KMS("%s\n", __FILE__);
 289
 290         if (display_ops && display_ops->is_connected) {
 291                 if (display_ops->is_connected(manager->dev))
 292                         status = connector_status_connected;
 293                 else
 294                         status = connector_status_disconnected;
 295         }
 296
 297         return status;
 298 }
 299
 300 static void exynos_drm_connector_destroy(struct drm_connector *connector)
 301 {
 302         struct exynos_drm_connector *exynos_connector =
 303                 to_exynos_connector(connector);
 304
 305         DRM_DEBUG_KMS("%s\n", __FILE__);
 306
 307         drm_sysfs_connector_remove(connector);
 308         drm_connector_cleanup(connector);
 309         kfree(exynos_connector);
 310 }
 311
 312 static struct drm_connector_funcs exynos_connector_funcs = {
 313         .dpms           = exynos_drm_connector_dpms,
 314         .fill_modes     = exynos_drm_connector_fill_modes,
 315         .detect         = exynos_drm_connector_detect,
 316         .destroy        = exynos_drm_connector_destroy,
 317 };
 318
 319 struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
 320                                                    struct drm_encoder *encoder)
 321 {
 322         struct exynos_drm_connector *exynos_connector;
 323         struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
 324         struct drm_connector *connector;
 325         int type;
 326         int err;
 327
 328         DRM_DEBUG_KMS("%s\n", __FILE__);
 329
 330         exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
 331         if (!exynos_connector) {
 332                 DRM_ERROR("failed to allocate connector\n");
 333                 return NULL;
 334         }
 335
 336         connector = &exynos_connector->drm_connector;
 337
 338         switch (manager->display_ops->type) {
 339         case EXYNOS_DISPLAY_TYPE_HDMI:
 340                 type = DRM_MODE_CONNECTOR_HDMIA;
 341                 connector->interlace_allowed = true;
 342                 connector->polled = DRM_CONNECTOR_POLL_HPD;
 343                 break;
 344         case EXYNOS_DISPLAY_TYPE_VIDI:
 345                 type = DRM_MODE_CONNECTOR_VIRTUAL;
 346                 connector->polled = DRM_CONNECTOR_POLL_HPD;
 347                 break;
 348         default:
 349                 type = DRM_MODE_CONNECTOR_Unknown;
 350                 break;
 351         }
 352
 353         drm_connector_init(dev, connector, &exynos_connector_funcs, type);
 354         drm_connector_helper_add(connector, &exynos_connector_helper_funcs);
 355
 356         err = drm_sysfs_connector_add(connector);
 357         if (err)
 358                 goto err_connector;
 359
 360         exynos_connector->encoder_id = encoder->base.id;
 361         exynos_connector->manager = manager;
 362         exynos_connector->dpms = DRM_MODE_DPMS_OFF;
 363         connector->dpms = DRM_MODE_DPMS_OFF;
 364         connector->encoder = encoder;
 365
 366         err = drm_mode_connector_attach_encoder(connector, encoder);
 367         if (err) {
 368                 DRM_ERROR("failed to attach a connector to a encoder\n");
 369                 goto err_sysfs;
 370         }
 371
 372         DRM_DEBUG_KMS("connector has been created\n");
 373
 374         return connector;
 375
 376 err_sysfs:
 377         drm_sysfs_connector_remove(connector);
 378 err_connector:
 379         drm_connector_cleanup(connector);
 380         kfree(exynos_connector);
 381         return NULL;
 382 }