drivers/gpu/drm/exynos/exynos_dp_core.c

   1 /*
   2  * Samsung SoC DP (Display Port) interface driver.
   3  *
   4  * Copyright (C) 2012 Samsung Electronics Co., Ltd.
   5  * Author: Jingoo Han <jg1.han@samsung.com>
   6  *
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms of the GNU General Public License as published by the
   9  * Free Software Foundation; either version 2 of the License, or (at your
  10  * option) any later version.
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/platform_device.h>
  15 #include <linux/err.h>
  16 #include <linux/clk.h>
  17 #include <linux/io.h>
  18 #include <linux/interrupt.h>
  19 #include <linux/of.h>
  20 #include <linux/of_gpio.h>
  21 #include <linux/of_graph.h>
  22 #include <linux/gpio.h>
  23 #include <linux/component.h>
  24 #include <linux/phy/phy.h>
  25 #include <video/of_display_timing.h>
  26 #include <video/of_videomode.h>
  27
  28 #include <drm/drmP.h>
  29 #include <drm/drm_crtc.h>
  30 #include <drm/drm_crtc_helper.h>
  31 #include <drm/drm_atomic_helper.h>
  32 #include <drm/drm_panel.h>
  33
  34 #include "exynos_dp_core.h"
  35 #include "exynos_drm_crtc.h"
  36
  37 #define ctx_from_connector(c)   container_of(c, struct exynos_dp_device, \
  38                                         connector)
  39
  40 static inline struct exynos_drm_crtc *dp_to_crtc(struct exynos_dp_device *dp)
  41 {
  42         return to_exynos_crtc(dp->encoder.crtc);
  43 }
  44
  45 static inline struct exynos_dp_device *encoder_to_dp(
  46                                                 struct drm_encoder *e)
  47 {
  48         return container_of(e, struct exynos_dp_device, encoder);
  49 }
  50
  51 struct bridge_init {
  52         struct i2c_client *client;
  53         struct device_node *node;
  54 };
  55
  56 static void exynos_dp_init_dp(struct exynos_dp_device *dp)
  57 {
  58         exynos_dp_reset(dp);
  59
  60         exynos_dp_swreset(dp);
  61
  62         exynos_dp_init_analog_param(dp);
  63         exynos_dp_init_interrupt(dp);
  64
  65         /* SW defined function Normal operation */
  66         exynos_dp_enable_sw_function(dp);
  67
  68         exynos_dp_config_interrupt(dp);
  69         exynos_dp_init_analog_func(dp);
  70
  71         exynos_dp_init_hpd(dp);
  72         exynos_dp_init_aux(dp);
  73 }
  74
  75 static int exynos_dp_detect_hpd(struct exynos_dp_device *dp)
  76 {
  77         int timeout_loop = 0;
  78
  79         while (exynos_dp_get_plug_in_status(dp) != 0) {
  80                 timeout_loop++;
  81                 if (DP_TIMEOUT_LOOP_COUNT < timeout_loop) {
  82                         dev_err(dp->dev, "failed to get hpd plug status\n");
  83                         return -ETIMEDOUT;
  84                 }
  85                 usleep_range(10, 11);
  86         }
  87
  88         return 0;
  89 }
  90
  91 static unsigned char exynos_dp_calc_edid_check_sum(unsigned char *edid_data)
  92 {
  93         int i;
  94         unsigned char sum = 0;
  95
  96         for (i = 0; i < EDID_BLOCK_LENGTH; i++)
  97                 sum = sum + edid_data[i];
  98
  99         return sum;
 100 }
 101
 102 static int exynos_dp_read_edid(struct exynos_dp_device *dp)
 103 {
 104         unsigned char edid[EDID_BLOCK_LENGTH * 2];
 105         unsigned int extend_block = 0;
 106         unsigned char sum;
 107         unsigned char test_vector;
 108         int retval;
 109
 110         /*
 111          * EDID device address is 0x50.
 112          * However, if necessary, you must have set upper address
 113          * into E-EDID in I2C device, 0x30.
 114          */
 115
 116         /* Read Extension Flag, Number of 128-byte EDID extension blocks */
 117         retval = exynos_dp_read_byte_from_i2c(dp, I2C_EDID_DEVICE_ADDR,
 118                                 EDID_EXTENSION_FLAG,
 119                                 &extend_block);
 120         if (retval)
 121                 return retval;
 122
 123         if (extend_block > 0) {
 124                 dev_dbg(dp->dev, "EDID data includes a single extension!\n");
 125
 126                 /* Read EDID data */
 127                 retval = exynos_dp_read_bytes_from_i2c(dp, I2C_EDID_DEVICE_ADDR,
 128                                                 EDID_HEADER_PATTERN,
 129                                                 EDID_BLOCK_LENGTH,
 130                                                 &edid[EDID_HEADER_PATTERN]);
 131                 if (retval != 0) {
 132                         dev_err(dp->dev, "EDID Read failed!\n");
 133                         return -EIO;
 134                 }
 135                 sum = exynos_dp_calc_edid_check_sum(edid);
 136                 if (sum != 0) {
 137                         dev_err(dp->dev, "EDID bad checksum!\n");
 138                         return -EIO;
 139                 }
 140
 141                 /* Read additional EDID data */
 142                 retval = exynos_dp_read_bytes_from_i2c(dp,
 143                                 I2C_EDID_DEVICE_ADDR,
 144                                 EDID_BLOCK_LENGTH,
 145                                 EDID_BLOCK_LENGTH,
 146                                 &edid[EDID_BLOCK_LENGTH]);
 147                 if (retval != 0) {
 148                         dev_err(dp->dev, "EDID Read failed!\n");
 149                         return -EIO;
 150                 }
 151                 sum = exynos_dp_calc_edid_check_sum(&edid[EDID_BLOCK_LENGTH]);
 152                 if (sum != 0) {
 153                         dev_err(dp->dev, "EDID bad checksum!\n");
 154                         return -EIO;
 155                 }
 156
 157                 exynos_dp_read_byte_from_dpcd(dp, DP_TEST_REQUEST,
 158                                         &test_vector);
 159                 if (test_vector & DP_TEST_LINK_EDID_READ) {
 160                         exynos_dp_write_byte_to_dpcd(dp,
 161                                 DP_TEST_EDID_CHECKSUM,
 162                                 edid[EDID_BLOCK_LENGTH + EDID_CHECKSUM]);
 163                         exynos_dp_write_byte_to_dpcd(dp,
 164                                 DP_TEST_RESPONSE,
 165                                 DP_TEST_EDID_CHECKSUM_WRITE);
 166                 }
 167         } else {
 168                 dev_info(dp->dev, "EDID data does not include any extensions.\n");
 169
 170                 /* Read EDID data */
 171                 retval = exynos_dp_read_bytes_from_i2c(dp,
 172                                 I2C_EDID_DEVICE_ADDR,
 173                                 EDID_HEADER_PATTERN,
 174                                 EDID_BLOCK_LENGTH,
 175                                 &edid[EDID_HEADER_PATTERN]);
 176                 if (retval != 0) {
 177                         dev_err(dp->dev, "EDID Read failed!\n");
 178                         return -EIO;
 179                 }
 180                 sum = exynos_dp_calc_edid_check_sum(edid);
 181                 if (sum != 0) {
 182                         dev_err(dp->dev, "EDID bad checksum!\n");
 183                         return -EIO;
 184                 }
 185
 186                 exynos_dp_read_byte_from_dpcd(dp,
 187                         DP_TEST_REQUEST,
 188                         &test_vector);
 189                 if (test_vector & DP_TEST_LINK_EDID_READ) {
 190                         exynos_dp_write_byte_to_dpcd(dp,
 191                                 DP_TEST_EDID_CHECKSUM,
 192                                 edid[EDID_CHECKSUM]);
 193                         exynos_dp_write_byte_to_dpcd(dp,
 194                                 DP_TEST_RESPONSE,
 195                                 DP_TEST_EDID_CHECKSUM_WRITE);
 196                 }
 197         }
 198
 199         dev_dbg(dp->dev, "EDID Read success!\n");
 200         return 0;
 201 }
 202
 203 static int exynos_dp_handle_edid(struct exynos_dp_device *dp)
 204 {
 205         u8 buf[12];
 206         int i;
 207         int retval;
 208
 209         /* Read DPCD DP_DPCD_REV~RECEIVE_PORT1_CAP_1 */
 210         retval = exynos_dp_read_bytes_from_dpcd(dp, DP_DPCD_REV,
 211                                 12, buf);
 212         if (retval)
 213                 return retval;
 214
 215         /* Read EDID */
 216         for (i = 0; i < 3; i++) {
 217                 retval = exynos_dp_read_edid(dp);
 218                 if (!retval)
 219                         break;
 220         }
 221
 222         return retval;
 223 }
 224
 225 static void exynos_dp_enable_rx_to_enhanced_mode(struct exynos_dp_device *dp,
 226                                                 bool enable)
 227 {
 228         u8 data;
 229
 230         exynos_dp_read_byte_from_dpcd(dp, DP_LANE_COUNT_SET, &data);
 231
 232         if (enable)
 233                 exynos_dp_write_byte_to_dpcd(dp, DP_LANE_COUNT_SET,
 234                         DP_LANE_COUNT_ENHANCED_FRAME_EN |
 235                         DPCD_LANE_COUNT_SET(data));
 236         else
 237                 exynos_dp_write_byte_to_dpcd(dp, DP_LANE_COUNT_SET,
 238                         DPCD_LANE_COUNT_SET(data));
 239 }
 240
 241 static int exynos_dp_is_enhanced_mode_available(struct exynos_dp_device *dp)
 242 {
 243         u8 data;
 244         int retval;
 245
 246         exynos_dp_read_byte_from_dpcd(dp, DP_MAX_LANE_COUNT, &data);
 247         retval = DPCD_ENHANCED_FRAME_CAP(data);
 248
 249         return retval;
 250 }
 251
 252 static void exynos_dp_set_enhanced_mode(struct exynos_dp_device *dp)
 253 {
 254         u8 data;
 255
 256         data = exynos_dp_is_enhanced_mode_available(dp);
 257         exynos_dp_enable_rx_to_enhanced_mode(dp, data);
 258         exynos_dp_enable_enhanced_mode(dp, data);
 259 }
 260
 261 static void exynos_dp_training_pattern_dis(struct exynos_dp_device *dp)
 262 {
 263         exynos_dp_set_training_pattern(dp, DP_NONE);
 264
 265         exynos_dp_write_byte_to_dpcd(dp,
 266                 DP_TRAINING_PATTERN_SET,
 267                 DP_TRAINING_PATTERN_DISABLE);
 268 }
 269
 270 static void exynos_dp_set_lane_lane_pre_emphasis(struct exynos_dp_device *dp,
 271                                         int pre_emphasis, int lane)
 272 {
 273         switch (lane) {
 274         case 0:
 275                 exynos_dp_set_lane0_pre_emphasis(dp, pre_emphasis);
 276                 break;
 277         case 1:
 278                 exynos_dp_set_lane1_pre_emphasis(dp, pre_emphasis);
 279                 break;
 280
 281         case 2:
 282                 exynos_dp_set_lane2_pre_emphasis(dp, pre_emphasis);
 283                 break;
 284
 285         case 3:
 286                 exynos_dp_set_lane3_pre_emphasis(dp, pre_emphasis);
 287                 break;
 288         }
 289 }
 290
 291 static int exynos_dp_link_start(struct exynos_dp_device *dp)
 292 {
 293         u8 buf[4];
 294         int lane, lane_count, pll_tries, retval;
 295
 296         lane_count = dp->link_train.lane_count;
 297
 298         dp->link_train.lt_state = CLOCK_RECOVERY;
 299         dp->link_train.eq_loop = 0;
 300
 301         for (lane = 0; lane < lane_count; lane++)
 302                 dp->link_train.cr_loop[lane] = 0;
 303
 304         /* Set link rate and count as you want to establish*/
 305         exynos_dp_set_link_bandwidth(dp, dp->link_train.link_rate);
 306         exynos_dp_set_lane_count(dp, dp->link_train.lane_count);
 307
 308         /* Setup RX configuration */
 309         buf[0] = dp->link_train.link_rate;
 310         buf[1] = dp->link_train.lane_count;
 311         retval = exynos_dp_write_bytes_to_dpcd(dp, DP_LINK_BW_SET,
 312                                 2, buf);
 313         if (retval)
 314                 return retval;
 315
 316         /* Set TX pre-emphasis to minimum */
 317         for (lane = 0; lane < lane_count; lane++)
 318                 exynos_dp_set_lane_lane_pre_emphasis(dp,
 319                         PRE_EMPHASIS_LEVEL_0, lane);
 320
 321         /* Wait for PLL lock */
 322         pll_tries = 0;
 323         while (exynos_dp_get_pll_lock_status(dp) == PLL_UNLOCKED) {
 324                 if (pll_tries == DP_TIMEOUT_LOOP_COUNT) {
 325                         dev_err(dp->dev, "Wait for PLL lock timed out\n");
 326                         return -ETIMEDOUT;
 327                 }
 328
 329                 pll_tries++;
 330                 usleep_range(90, 120);
 331         }
 332
 333         /* Set training pattern 1 */
 334         exynos_dp_set_training_pattern(dp, TRAINING_PTN1);
 335
 336         /* Set RX training pattern */
 337         retval = exynos_dp_write_byte_to_dpcd(dp,
 338                         DP_TRAINING_PATTERN_SET,
 339                         DP_LINK_SCRAMBLING_DISABLE | DP_TRAINING_PATTERN_1);
 340         if (retval)
 341                 return retval;
 342
 343         for (lane = 0; lane < lane_count; lane++)
 344                 buf[lane] = DP_TRAIN_PRE_EMPH_LEVEL_0 |
 345                             DP_TRAIN_VOLTAGE_SWING_LEVEL_0;
 346
 347         retval = exynos_dp_write_bytes_to_dpcd(dp, DP_TRAINING_LANE0_SET,
 348                         lane_count, buf);
 349
 350         return retval;
 351 }
 352
 353 static unsigned char exynos_dp_get_lane_status(u8 link_status[2], int lane)
 354 {
 355         int shift = (lane & 1) * 4;
 356         u8 link_value = link_status[lane>>1];
 357
 358         return (link_value >> shift) & 0xf;
 359 }
 360
 361 static int exynos_dp_clock_recovery_ok(u8 link_status[2], int lane_count)
 362 {
 363         int lane;
 364         u8 lane_status;
 365
 366         for (lane = 0; lane < lane_count; lane++) {
 367                 lane_status = exynos_dp_get_lane_status(link_status, lane);
 368                 if ((lane_status & DP_LANE_CR_DONE) == 0)
 369                         return -EINVAL;
 370         }
 371         return 0;
 372 }
 373
 374 static int exynos_dp_channel_eq_ok(u8 link_status[2], u8 link_align,
 375                                 int lane_count)
 376 {
 377         int lane;
 378         u8 lane_status;
 379
 380         if ((link_align & DP_INTERLANE_ALIGN_DONE) == 0)
 381                 return -EINVAL;
 382
 383         for (lane = 0; lane < lane_count; lane++) {
 384                 lane_status = exynos_dp_get_lane_status(link_status, lane);
 385                 lane_status &= DP_CHANNEL_EQ_BITS;
 386                 if (lane_status != DP_CHANNEL_EQ_BITS)
 387                         return -EINVAL;
 388         }
 389
 390         return 0;
 391 }
 392
 393 static unsigned char exynos_dp_get_adjust_request_voltage(u8 adjust_request[2],
 394                                                         int lane)
 395 {
 396         int shift = (lane & 1) * 4;
 397         u8 link_value = adjust_request[lane>>1];
 398
 399         return (link_value >> shift) & 0x3;
 400 }
 401
 402 static unsigned char exynos_dp_get_adjust_request_pre_emphasis(
 403                                         u8 adjust_request[2],
 404                                         int lane)
 405 {
 406         int shift = (lane & 1) * 4;
 407         u8 link_value = adjust_request[lane>>1];
 408
 409         return ((link_value >> shift) & 0xc) >> 2;
 410 }
 411
 412 static void exynos_dp_set_lane_link_training(struct exynos_dp_device *dp,
 413                                         u8 training_lane_set, int lane)
 414 {
 415         switch (lane) {
 416         case 0:
 417                 exynos_dp_set_lane0_link_training(dp, training_lane_set);
 418                 break;
 419         case 1:
 420                 exynos_dp_set_lane1_link_training(dp, training_lane_set);
 421                 break;
 422
 423         case 2:
 424                 exynos_dp_set_lane2_link_training(dp, training_lane_set);
 425                 break;
 426
 427         case 3:
 428                 exynos_dp_set_lane3_link_training(dp, training_lane_set);
 429                 break;
 430         }
 431 }
 432
 433 static unsigned int exynos_dp_get_lane_link_training(
 434                                 struct exynos_dp_device *dp,
 435                                 int lane)
 436 {
 437         u32 reg;
 438
 439         switch (lane) {
 440         case 0:
 441                 reg = exynos_dp_get_lane0_link_training(dp);
 442                 break;
 443         case 1:
 444                 reg = exynos_dp_get_lane1_link_training(dp);
 445                 break;
 446         case 2:
 447                 reg = exynos_dp_get_lane2_link_training(dp);
 448                 break;
 449         case 3:
 450                 reg = exynos_dp_get_lane3_link_training(dp);
 451                 break;
 452         default:
 453                 WARN_ON(1);
 454                 return 0;
 455         }
 456
 457         return reg;
 458 }
 459
 460 static void exynos_dp_reduce_link_rate(struct exynos_dp_device *dp)
 461 {
 462         exynos_dp_training_pattern_dis(dp);
 463         exynos_dp_set_enhanced_mode(dp);
 464
 465         dp->link_train.lt_state = FAILED;
 466 }
 467
 468 static void exynos_dp_get_adjust_training_lane(struct exynos_dp_device *dp,
 469                                         u8 adjust_request[2])
 470 {
 471         int lane, lane_count;
 472         u8 voltage_swing, pre_emphasis, training_lane;
 473
 474         lane_count = dp->link_train.lane_count;
 475         for (lane = 0; lane < lane_count; lane++) {
 476                 voltage_swing = exynos_dp_get_adjust_request_voltage(
 477                                                 adjust_request, lane);
 478                 pre_emphasis = exynos_dp_get_adjust_request_pre_emphasis(
 479                                                 adjust_request, lane);
 480                 training_lane = DPCD_VOLTAGE_SWING_SET(voltage_swing) |
 481                                 DPCD_PRE_EMPHASIS_SET(pre_emphasis);
 482
 483                 if (voltage_swing == VOLTAGE_LEVEL_3)
 484                         training_lane |= DP_TRAIN_MAX_SWING_REACHED;
 485                 if (pre_emphasis == PRE_EMPHASIS_LEVEL_3)
 486                         training_lane |= DP_TRAIN_MAX_PRE_EMPHASIS_REACHED;
 487
 488                 dp->link_train.training_lane[lane] = training_lane;
 489         }
 490 }
 491
 492 static int exynos_dp_process_clock_recovery(struct exynos_dp_device *dp)
 493 {
 494         int lane, lane_count, retval;
 495         u8 voltage_swing, pre_emphasis, training_lane;
 496         u8 link_status[2], adjust_request[2];
 497
 498         usleep_range(100, 101);
 499
 500         lane_count = dp->link_train.lane_count;
 501
 502         retval =  exynos_dp_read_bytes_from_dpcd(dp,
 503                         DP_LANE0_1_STATUS, 2, link_status);
 504         if (retval)
 505                 return retval;
 506
 507         retval =  exynos_dp_read_bytes_from_dpcd(dp,
 508                         DP_ADJUST_REQUEST_LANE0_1, 2, adjust_request);
 509         if (retval)
 510                 return retval;
 511
 512         if (exynos_dp_clock_recovery_ok(link_status, lane_count) == 0) {
 513                 /* set training pattern 2 for EQ */
 514                 exynos_dp_set_training_pattern(dp, TRAINING_PTN2);
 515
 516                 retval = exynos_dp_write_byte_to_dpcd(dp,
 517                                 DP_TRAINING_PATTERN_SET,
 518                                 DP_LINK_SCRAMBLING_DISABLE |
 519                                 DP_TRAINING_PATTERN_2);
 520                 if (retval)
 521                         return retval;
 522
 523                 dev_info(dp->dev, "Link Training Clock Recovery success\n");
 524                 dp->link_train.lt_state = EQUALIZER_TRAINING;
 525         } else {
 526                 for (lane = 0; lane < lane_count; lane++) {
 527                         training_lane = exynos_dp_get_lane_link_training(
 528                                                         dp, lane);
 529                         voltage_swing = exynos_dp_get_adjust_request_voltage(
 530                                                         adjust_request, lane);
 531                         pre_emphasis = exynos_dp_get_adjust_request_pre_emphasis(
 532                                                         adjust_request, lane);
 533
 534                         if (DPCD_VOLTAGE_SWING_GET(training_lane) ==
 535                                         voltage_swing &&
 536                             DPCD_PRE_EMPHASIS_GET(training_lane) ==
 537                                         pre_emphasis)
 538                                 dp->link_train.cr_loop[lane]++;
 539
 540                         if (dp->link_train.cr_loop[lane] == MAX_CR_LOOP ||
 541                             voltage_swing == VOLTAGE_LEVEL_3 ||
 542                             pre_emphasis == PRE_EMPHASIS_LEVEL_3) {
 543                                 dev_err(dp->dev, "CR Max reached (%d,%d,%d)\n",
 544                                         dp->link_train.cr_loop[lane],
 545                                         voltage_swing, pre_emphasis);
 546                                 exynos_dp_reduce_link_rate(dp);
 547                                 return -EIO;
 548                         }
 549                 }
 550         }
 551
 552         exynos_dp_get_adjust_training_lane(dp, adjust_request);
 553
 554         for (lane = 0; lane < lane_count; lane++)
 555                 exynos_dp_set_lane_link_training(dp,
 556                         dp->link_train.training_lane[lane], lane);
 557
 558         retval = exynos_dp_write_bytes_to_dpcd(dp,
 559                         DP_TRAINING_LANE0_SET, lane_count,
 560                         dp->link_train.training_lane);
 561         if (retval)
 562                 return retval;
 563
 564         return retval;
 565 }
 566
 567 static int exynos_dp_process_equalizer_training(struct exynos_dp_device *dp)
 568 {
 569         int lane, lane_count, retval;
 570         u32 reg;
 571         u8 link_align, link_status[2], adjust_request[2];
 572
 573         usleep_range(400, 401);
 574
 575         lane_count = dp->link_train.lane_count;
 576
 577         retval = exynos_dp_read_bytes_from_dpcd(dp,
 578                         DP_LANE0_1_STATUS, 2, link_status);
 579         if (retval)
 580                 return retval;
 581
 582         if (exynos_dp_clock_recovery_ok(link_status, lane_count)) {
 583                 exynos_dp_reduce_link_rate(dp);
 584                 return -EIO;
 585         }
 586
 587         retval = exynos_dp_read_bytes_from_dpcd(dp,
 588                         DP_ADJUST_REQUEST_LANE0_1, 2, adjust_request);
 589         if (retval)
 590                 return retval;
 591
 592         retval = exynos_dp_read_byte_from_dpcd(dp,
 593                         DP_LANE_ALIGN_STATUS_UPDATED, &link_align);
 594         if (retval)
 595                 return retval;
 596
 597         exynos_dp_get_adjust_training_lane(dp, adjust_request);
 598
 599         if (!exynos_dp_channel_eq_ok(link_status, link_align, lane_count)) {
 600                 /* traing pattern Set to Normal */
 601                 exynos_dp_training_pattern_dis(dp);
 602
 603                 dev_info(dp->dev, "Link Training success!\n");
 604
 605                 exynos_dp_get_link_bandwidth(dp, &reg);
 606                 dp->link_train.link_rate = reg;
 607                 dev_dbg(dp->dev, "final bandwidth = %.2x\n",
 608                         dp->link_train.link_rate);
 609
 610                 exynos_dp_get_lane_count(dp, &reg);
 611                 dp->link_train.lane_count = reg;
 612                 dev_dbg(dp->dev, "final lane count = %.2x\n",
 613                         dp->link_train.lane_count);
 614
 615                 /* set enhanced mode if available */
 616                 exynos_dp_set_enhanced_mode(dp);
 617                 dp->link_train.lt_state = FINISHED;
 618
 619                 return 0;
 620         }
 621
 622         /* not all locked */
 623         dp->link_train.eq_loop++;
 624
 625         if (dp->link_train.eq_loop > MAX_EQ_LOOP) {
 626                 dev_err(dp->dev, "EQ Max loop\n");
 627                 exynos_dp_reduce_link_rate(dp);
 628                 return -EIO;
 629         }
 630
 631         for (lane = 0; lane < lane_count; lane++)
 632                 exynos_dp_set_lane_link_training(dp,
 633                         dp->link_train.training_lane[lane], lane);
 634
 635         retval = exynos_dp_write_bytes_to_dpcd(dp, DP_TRAINING_LANE0_SET,
 636                         lane_count, dp->link_train.training_lane);
 637
 638         return retval;
 639 }
 640
 641 static void exynos_dp_get_max_rx_bandwidth(struct exynos_dp_device *dp,
 642                                         u8 *bandwidth)
 643 {
 644         u8 data;
 645
 646         /*
 647          * For DP rev.1.1, Maximum link rate of Main Link lanes
 648          * 0x06 = 1.62 Gbps, 0x0a = 2.7 Gbps
 649          */
 650         exynos_dp_read_byte_from_dpcd(dp, DP_MAX_LINK_RATE, &data);
 651         *bandwidth = data;
 652 }
 653
 654 static void exynos_dp_get_max_rx_lane_count(struct exynos_dp_device *dp,
 655                                         u8 *lane_count)
 656 {
 657         u8 data;
 658
 659         /*
 660          * For DP rev.1.1, Maximum number of Main Link lanes
 661          * 0x01 = 1 lane, 0x02 = 2 lanes, 0x04 = 4 lanes
 662          */
 663         exynos_dp_read_byte_from_dpcd(dp, DP_MAX_LANE_COUNT, &data);
 664         *lane_count = DPCD_MAX_LANE_COUNT(data);
 665 }
 666
 667 static void exynos_dp_init_training(struct exynos_dp_device *dp,
 668                         enum link_lane_count_type max_lane,
 669                         enum link_rate_type max_rate)
 670 {
 671         /*
 672          * MACRO_RST must be applied after the PLL_LOCK to avoid
 673          * the DP inter pair skew issue for at least 10 us
 674          */
 675         exynos_dp_reset_macro(dp);
 676
 677         /* Initialize by reading RX's DPCD */
 678         exynos_dp_get_max_rx_bandwidth(dp, &dp->link_train.link_rate);
 679         exynos_dp_get_max_rx_lane_count(dp, &dp->link_train.lane_count);
 680
 681         if ((dp->link_train.link_rate != LINK_RATE_1_62GBPS) &&
 682            (dp->link_train.link_rate != LINK_RATE_2_70GBPS)) {
 683                 dev_err(dp->dev, "Rx Max Link Rate is abnormal :%x !\n",
 684                         dp->link_train.link_rate);
 685                 dp->link_train.link_rate = LINK_RATE_1_62GBPS;
 686         }
 687
 688         if (dp->link_train.lane_count == 0) {
 689                 dev_err(dp->dev, "Rx Max Lane count is abnormal :%x !\n",
 690                         dp->link_train.lane_count);
 691                 dp->link_train.lane_count = (u8)LANE_COUNT1;
 692         }
 693
 694         /* Setup TX lane count & rate */
 695         if (dp->link_train.lane_count > max_lane)
 696                 dp->link_train.lane_count = max_lane;
 697         if (dp->link_train.link_rate > max_rate)
 698                 dp->link_train.link_rate = max_rate;
 699
 700         /* All DP analog module power up */
 701         exynos_dp_set_analog_power_down(dp, POWER_ALL, 0);
 702 }
 703
 704 static int exynos_dp_sw_link_training(struct exynos_dp_device *dp)
 705 {
 706         int retval = 0, training_finished = 0;
 707
 708         dp->link_train.lt_state = START;
 709
 710         /* Process here */
 711         while (!retval && !training_finished) {
 712                 switch (dp->link_train.lt_state) {
 713                 case START:
 714                         retval = exynos_dp_link_start(dp);
 715                         if (retval)
 716                                 dev_err(dp->dev, "LT link start failed!\n");
 717                         break;
 718                 case CLOCK_RECOVERY:
 719                         retval = exynos_dp_process_clock_recovery(dp);
 720                         if (retval)
 721                                 dev_err(dp->dev, "LT CR failed!\n");
 722                         break;
 723                 case EQUALIZER_TRAINING:
 724                         retval = exynos_dp_process_equalizer_training(dp);
 725                         if (retval)
 726                                 dev_err(dp->dev, "LT EQ failed!\n");
 727                         break;
 728                 case FINISHED:
 729                         training_finished = 1;
 730                         break;
 731                 case FAILED:
 732                         return -EREMOTEIO;
 733                 }
 734         }
 735         if (retval)
 736                 dev_err(dp->dev, "eDP link training failed (%d)\n", retval);
 737
 738         return retval;
 739 }
 740
 741 static int exynos_dp_set_link_train(struct exynos_dp_device *dp,
 742                                 u32 count,
 743                                 u32 bwtype)
 744 {
 745         int i;
 746         int retval;
 747
 748         for (i = 0; i < DP_TIMEOUT_LOOP_COUNT; i++) {
 749                 exynos_dp_init_training(dp, count, bwtype);
 750                 retval = exynos_dp_sw_link_training(dp);
 751                 if (retval == 0)
 752                         break;
 753
 754                 usleep_range(100, 110);
 755         }
 756
 757         return retval;
 758 }
 759
 760 static int exynos_dp_config_video(struct exynos_dp_device *dp)
 761 {
 762         int retval = 0;
 763         int timeout_loop = 0;
 764         int done_count = 0;
 765
 766         exynos_dp_config_video_slave_mode(dp);
 767
 768         exynos_dp_set_video_color_format(dp);
 769
 770         if (exynos_dp_get_pll_lock_status(dp) == PLL_UNLOCKED) {
 771                 dev_err(dp->dev, "PLL is not locked yet.\n");
 772                 return -EINVAL;
 773         }
 774
 775         for (;;) {
 776                 timeout_loop++;
 777                 if (exynos_dp_is_slave_video_stream_clock_on(dp) == 0)
 778                         break;
 779                 if (DP_TIMEOUT_LOOP_COUNT < timeout_loop) {
 780                         dev_err(dp->dev, "Timeout of video streamclk ok\n");
 781                         return -ETIMEDOUT;
 782                 }
 783
 784                 usleep_range(1, 2);
 785         }
 786
 787         /* Set to use the register calculated M/N video */
 788         exynos_dp_set_video_cr_mn(dp, CALCULATED_M, 0, 0);
 789
 790         /* For video bist, Video timing must be generated by register */
 791         exynos_dp_set_video_timing_mode(dp, VIDEO_TIMING_FROM_CAPTURE);
 792
 793         /* Disable video mute */
 794         exynos_dp_enable_video_mute(dp, 0);
 795
 796         /* Configure video slave mode */
 797         exynos_dp_enable_video_master(dp, 0);
 798
 799         timeout_loop = 0;
 800
 801         for (;;) {
 802                 timeout_loop++;
 803                 if (exynos_dp_is_video_stream_on(dp) == 0) {
 804                         done_count++;
 805                         if (done_count > 10)
 806                                 break;
 807                 } else if (done_count) {
 808                         done_count = 0;
 809                 }
 810                 if (DP_TIMEOUT_LOOP_COUNT < timeout_loop) {
 811                         dev_err(dp->dev, "Timeout of video streamclk ok\n");
 812                         return -ETIMEDOUT;
 813                 }
 814
 815                 usleep_range(1000, 1001);
 816         }
 817
 818         if (retval != 0)
 819                 dev_err(dp->dev, "Video stream is not detected!\n");
 820
 821         return retval;
 822 }
 823
 824 static void exynos_dp_enable_scramble(struct exynos_dp_device *dp, bool enable)
 825 {
 826         u8 data;
 827
 828         if (enable) {
 829                 exynos_dp_enable_scrambling(dp);
 830
 831                 exynos_dp_read_byte_from_dpcd(dp,
 832                         DP_TRAINING_PATTERN_SET,
 833                         &data);
 834                 exynos_dp_write_byte_to_dpcd(dp,
 835                         DP_TRAINING_PATTERN_SET,
 836                         (u8)(data & ~DP_LINK_SCRAMBLING_DISABLE));
 837         } else {
 838                 exynos_dp_disable_scrambling(dp);
 839
 840                 exynos_dp_read_byte_from_dpcd(dp,
 841                         DP_TRAINING_PATTERN_SET,
 842                         &data);
 843                 exynos_dp_write_byte_to_dpcd(dp,
 844                         DP_TRAINING_PATTERN_SET,
 845                         (u8)(data | DP_LINK_SCRAMBLING_DISABLE));
 846         }
 847 }
 848
 849 static irqreturn_t exynos_dp_irq_handler(int irq, void *arg)
 850 {
 851         struct exynos_dp_device *dp = arg;
 852
 853         enum dp_irq_type irq_type;
 854
 855         irq_type = exynos_dp_get_irq_type(dp);
 856         switch (irq_type) {
 857         case DP_IRQ_TYPE_HP_CABLE_IN:
 858                 dev_dbg(dp->dev, "Received irq - cable in\n");
 859                 schedule_work(&dp->hotplug_work);
 860                 exynos_dp_clear_hotplug_interrupts(dp);
 861                 break;
 862         case DP_IRQ_TYPE_HP_CABLE_OUT:
 863                 dev_dbg(dp->dev, "Received irq - cable out\n");
 864                 exynos_dp_clear_hotplug_interrupts(dp);
 865                 break;
 866         case DP_IRQ_TYPE_HP_CHANGE:
 867                 /*
 868                  * We get these change notifications once in a while, but there
 869                  * is nothing we can do with them. Just ignore it for now and
 870                  * only handle cable changes.
 871                  */
 872                 dev_dbg(dp->dev, "Received irq - hotplug change; ignoring.\n");
 873                 exynos_dp_clear_hotplug_interrupts(dp);
 874                 break;
 875         default:
 876                 dev_err(dp->dev, "Received irq - unknown type!\n");
 877                 break;
 878         }
 879         return IRQ_HANDLED;
 880 }
 881
 882 static void exynos_dp_hotplug(struct work_struct *work)
 883 {
 884         struct exynos_dp_device *dp;
 885
 886         dp = container_of(work, struct exynos_dp_device, hotplug_work);
 887
 888         if (dp->drm_dev)
 889                 drm_helper_hpd_irq_event(dp->drm_dev);
 890 }
 891
 892 static void exynos_dp_commit(struct drm_encoder *encoder)
 893 {
 894         struct exynos_dp_device *dp = encoder_to_dp(encoder);
 895         int ret;
 896
 897         /* Keep the panel disabled while we configure video */
 898         if (dp->panel) {
 899                 if (drm_panel_disable(dp->panel))
 900                         DRM_ERROR("failed to disable the panel\n");
 901         }
 902
 903         ret = exynos_dp_detect_hpd(dp);
 904         if (ret) {
 905                 /* Cable has been disconnected, we're done */
 906                 return;
 907         }
 908
 909         ret = exynos_dp_handle_edid(dp);
 910         if (ret) {
 911                 dev_err(dp->dev, "unable to handle edid\n");
 912                 return;
 913         }
 914
 915         ret = exynos_dp_set_link_train(dp, dp->video_info->lane_count,
 916                                         dp->video_info->link_rate);
 917         if (ret) {
 918                 dev_err(dp->dev, "unable to do link train\n");
 919                 return;
 920         }
 921
 922         exynos_dp_enable_scramble(dp, 1);
 923         exynos_dp_enable_rx_to_enhanced_mode(dp, 1);
 924         exynos_dp_enable_enhanced_mode(dp, 1);
 925
 926         exynos_dp_set_lane_count(dp, dp->video_info->lane_count);
 927         exynos_dp_set_link_bandwidth(dp, dp->video_info->link_rate);
 928
 929         exynos_dp_init_video(dp);
 930         ret = exynos_dp_config_video(dp);
 931         if (ret)
 932                 dev_err(dp->dev, "unable to config video\n");
 933
 934         /* Safe to enable the panel now */
 935         if (dp->panel) {
 936                 if (drm_panel_enable(dp->panel))
 937                         DRM_ERROR("failed to enable the panel\n");
 938         }
 939
 940         /* Enable video */
 941         exynos_dp_start_video(dp);
 942 }
 943
 944 static enum drm_connector_status exynos_dp_detect(
 945                                 struct drm_connector *connector, bool force)
 946 {
 947         return connector_status_connected;
 948 }
 949
 950 static void exynos_dp_connector_destroy(struct drm_connector *connector)
 951 {
 952         drm_connector_unregister(connector);
 953         drm_connector_cleanup(connector);
 954 }
 955
 956 static const struct drm_connector_funcs exynos_dp_connector_funcs = {
 957         .dpms = drm_atomic_helper_connector_dpms,
 958         .fill_modes = drm_helper_probe_single_connector_modes,
 959         .detect = exynos_dp_detect,
 960         .destroy = exynos_dp_connector_destroy,
 961         .reset = drm_atomic_helper_connector_reset,
 962         .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
 963         .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
 964 };
 965
 966 static int exynos_dp_get_modes(struct drm_connector *connector)
 967 {
 968         struct exynos_dp_device *dp = ctx_from_connector(connector);
 969         struct drm_display_mode *mode;
 970
 971         if (dp->panel)
 972                 return drm_panel_get_modes(dp->panel);
 973
 974         mode = drm_mode_create(connector->dev);
 975         if (!mode) {
 976                 DRM_ERROR("failed to create a new display mode.\n");
 977                 return 0;
 978         }
 979
 980         drm_display_mode_from_videomode(&dp->priv.vm, mode);
 981         mode->width_mm = dp->priv.width_mm;
 982         mode->height_mm = dp->priv.height_mm;
 983         connector->display_info.width_mm = mode->width_mm;
 984         connector->display_info.height_mm = mode->height_mm;
 985
 986         mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
 987         drm_mode_set_name(mode);
 988         drm_mode_probed_add(connector, mode);
 989
 990         return 1;
 991 }
 992
 993 static struct drm_encoder *exynos_dp_best_encoder(
 994                         struct drm_connector *connector)
 995 {
 996         struct exynos_dp_device *dp = ctx_from_connector(connector);
 997
 998         return &dp->encoder;
 999 }
1000
1001 static const struct drm_connector_helper_funcs exynos_dp_connector_helper_funcs = {
1002         .get_modes = exynos_dp_get_modes,
1003         .best_encoder = exynos_dp_best_encoder,
1004 };
1005
1006 /* returns the number of bridges attached */
1007 static int exynos_drm_attach_lcd_bridge(struct exynos_dp_device *dp,
1008                 struct drm_encoder *encoder)
1009 {
1010         int ret;
1011
1012         encoder->bridge->next = dp->ptn_bridge;
1013         dp->ptn_bridge->encoder = encoder;
1014         ret = drm_bridge_attach(encoder->dev, dp->ptn_bridge);
1015         if (ret) {
1016                 DRM_ERROR("Failed to attach bridge to drm\n");
1017                 return ret;
1018         }
1019
1020         return 0;
1021 }
1022
1023 static int exynos_dp_bridge_attach(struct drm_bridge *bridge)
1024 {
1025         struct exynos_dp_device *dp = bridge->driver_private;
1026         struct drm_encoder *encoder = &dp->encoder;
1027         struct drm_connector *connector = &dp->connector;
1028         int ret;
1029
1030         /* Pre-empt DP connector creation if there's a bridge */
1031         if (dp->ptn_bridge) {
1032                 ret = exynos_drm_attach_lcd_bridge(dp, encoder);
1033                 if (!ret)
1034                         return 0;
1035         }
1036
1037         connector->polled = DRM_CONNECTOR_POLL_HPD;
1038
1039         ret = drm_connector_init(dp->drm_dev, connector,
1040                         &exynos_dp_connector_funcs, DRM_MODE_CONNECTOR_eDP);
1041         if (ret) {
1042                 DRM_ERROR("Failed to initialize connector with drm\n");
1043                 return ret;
1044         }
1045
1046         drm_connector_helper_add(connector, &exynos_dp_connector_helper_funcs);
1047         drm_connector_register(connector);
1048         drm_mode_connector_attach_encoder(connector, encoder);
1049
1050         if (dp->panel)
1051                 ret = drm_panel_attach(dp->panel, &dp->connector);
1052
1053         return ret;
1054 }
1055
1056 static void exynos_dp_bridge_enable(struct drm_bridge *bridge)
1057 {
1058         struct exynos_dp_device *dp = bridge->driver_private;
1059         struct exynos_drm_crtc *crtc = dp_to_crtc(dp);
1060
1061         if (dp->dpms_mode == DRM_MODE_DPMS_ON)
1062                 return;
1063
1064         pm_runtime_get_sync(dp->dev);
1065
1066         if (dp->panel) {
1067                 if (drm_panel_prepare(dp->panel)) {
1068                         DRM_ERROR("failed to setup the panel\n");
1069                         return;
1070                 }
1071         }
1072
1073         if (crtc->ops->clock_enable)
1074                 crtc->ops->clock_enable(dp_to_crtc(dp), true);
1075
1076         phy_power_on(dp->phy);
1077         exynos_dp_init_dp(dp);
1078         enable_irq(dp->irq);
1079         exynos_dp_commit(&dp->encoder);
1080
1081         dp->dpms_mode = DRM_MODE_DPMS_ON;
1082 }
1083
1084 static void exynos_dp_bridge_disable(struct drm_bridge *bridge)
1085 {
1086         struct exynos_dp_device *dp = bridge->driver_private;
1087         struct exynos_drm_crtc *crtc = dp_to_crtc(dp);
1088
1089         if (dp->dpms_mode != DRM_MODE_DPMS_ON)
1090                 return;
1091
1092         if (dp->panel) {
1093                 if (drm_panel_disable(dp->panel)) {
1094                         DRM_ERROR("failed to disable the panel\n");
1095                         return;
1096                 }
1097         }
1098
1099         disable_irq(dp->irq);
1100         flush_work(&dp->hotplug_work);
1101         phy_power_off(dp->phy);
1102
1103         if (crtc->ops->clock_enable)
1104                 crtc->ops->clock_enable(dp_to_crtc(dp), false);
1105
1106         if (dp->panel) {
1107                 if (drm_panel_unprepare(dp->panel))
1108                         DRM_ERROR("failed to turnoff the panel\n");
1109         }
1110
1111         pm_runtime_put_sync(dp->dev);
1112
1113         dp->dpms_mode = DRM_MODE_DPMS_OFF;
1114 }
1115
1116 static void exynos_dp_bridge_nop(struct drm_bridge *bridge)
1117 {
1118         /* do nothing */
1119 }
1120
1121 static const struct drm_bridge_funcs exynos_dp_bridge_funcs = {
1122         .enable = exynos_dp_bridge_enable,
1123         .disable = exynos_dp_bridge_disable,
1124         .pre_enable = exynos_dp_bridge_nop,
1125         .post_disable = exynos_dp_bridge_nop,
1126         .attach = exynos_dp_bridge_attach,
1127 };
1128
1129 static int exynos_dp_create_connector(struct drm_encoder *encoder)
1130 {
1131         struct exynos_dp_device *dp = encoder_to_dp(encoder);
1132         struct drm_device *drm_dev = dp->drm_dev;
1133         struct drm_bridge *bridge;
1134         int ret;
1135
1136         bridge = devm_kzalloc(drm_dev->dev, sizeof(*bridge), GFP_KERNEL);
1137         if (!bridge) {
1138                 DRM_ERROR("failed to allocate for drm bridge\n");
1139                 return -ENOMEM;
1140         }
1141
1142         dp->bridge = bridge;
1143
1144         encoder->bridge = bridge;
1145         bridge->driver_private = dp;
1146         bridge->encoder = encoder;
1147         bridge->funcs = &exynos_dp_bridge_funcs;
1148
1149         ret = drm_bridge_attach(drm_dev, bridge);
1150         if (ret) {
1151                 DRM_ERROR("failed to attach drm bridge\n");
1152                 return -EINVAL;
1153         }
1154
1155         return 0;
1156 }
1157
1158 static bool exynos_dp_mode_fixup(struct drm_encoder *encoder,
1159                                  const struct drm_display_mode *mode,
1160                                  struct drm_display_mode *adjusted_mode)
1161 {
1162         return true;
1163 }
1164
1165 static void exynos_dp_mode_set(struct drm_encoder *encoder,
1166                                struct drm_display_mode *mode,
1167                                struct drm_display_mode *adjusted_mode)
1168 {
1169 }
1170
1171 static void exynos_dp_enable(struct drm_encoder *encoder)
1172 {
1173 }
1174
1175 static void exynos_dp_disable(struct drm_encoder *encoder)
1176 {
1177 }
1178
1179 static const struct drm_encoder_helper_funcs exynos_dp_encoder_helper_funcs = {
1180         .mode_fixup = exynos_dp_mode_fixup,
1181         .mode_set = exynos_dp_mode_set,
1182         .enable = exynos_dp_enable,
1183         .disable = exynos_dp_disable,
1184 };
1185
1186 static const struct drm_encoder_funcs exynos_dp_encoder_funcs = {
1187         .destroy = drm_encoder_cleanup,
1188 };
1189
1190 static struct video_info *exynos_dp_dt_parse_pdata(struct device *dev)
1191 {
1192         struct device_node *dp_node = dev->of_node;
1193         struct video_info *dp_video_config;
1194
1195         dp_video_config = devm_kzalloc(dev,
1196                                 sizeof(*dp_video_config), GFP_KERNEL);
1197         if (!dp_video_config)
1198                 return ERR_PTR(-ENOMEM);
1199
1200         dp_video_config->h_sync_polarity =
1201                 of_property_read_bool(dp_node, "hsync-active-high");
1202
1203         dp_video_config->v_sync_polarity =
1204                 of_property_read_bool(dp_node, "vsync-active-high");
1205
1206         dp_video_config->interlaced =
1207                 of_property_read_bool(dp_node, "interlaced");
1208
1209         if (of_property_read_u32(dp_node, "samsung,color-space",
1210                                 &dp_video_config->color_space)) {
1211                 dev_err(dev, "failed to get color-space\n");
1212                 return ERR_PTR(-EINVAL);
1213         }
1214
1215         if (of_property_read_u32(dp_node, "samsung,dynamic-range",
1216                                 &dp_video_config->dynamic_range)) {
1217                 dev_err(dev, "failed to get dynamic-range\n");
1218                 return ERR_PTR(-EINVAL);
1219         }
1220
1221         if (of_property_read_u32(dp_node, "samsung,ycbcr-coeff",
1222                                 &dp_video_config->ycbcr_coeff)) {
1223                 dev_err(dev, "failed to get ycbcr-coeff\n");
1224                 return ERR_PTR(-EINVAL);
1225         }
1226
1227         if (of_property_read_u32(dp_node, "samsung,color-depth",
1228                                 &dp_video_config->color_depth)) {
1229                 dev_err(dev, "failed to get color-depth\n");
1230                 return ERR_PTR(-EINVAL);
1231         }
1232
1233         if (of_property_read_u32(dp_node, "samsung,link-rate",
1234                                 &dp_video_config->link_rate)) {
1235                 dev_err(dev, "failed to get link-rate\n");
1236                 return ERR_PTR(-EINVAL);
1237         }
1238
1239         if (of_property_read_u32(dp_node, "samsung,lane-count",
1240                                 &dp_video_config->lane_count)) {
1241                 dev_err(dev, "failed to get lane-count\n");
1242                 return ERR_PTR(-EINVAL);
1243         }
1244
1245         return dp_video_config;
1246 }
1247
1248 static int exynos_dp_dt_parse_panel(struct exynos_dp_device *dp)
1249 {
1250         int ret;
1251
1252         ret = of_get_videomode(dp->dev->of_node, &dp->priv.vm,
1253                         OF_USE_NATIVE_MODE);
1254         if (ret) {
1255                 DRM_ERROR("failed: of_get_videomode() : %d\n", ret);
1256                 return ret;
1257         }
1258         return 0;
1259 }
1260
1261 static int exynos_dp_bind(struct device *dev, struct device *master, void *data)
1262 {
1263         struct exynos_dp_device *dp = dev_get_drvdata(dev);
1264         struct platform_device *pdev = to_platform_device(dev);
1265         struct drm_device *drm_dev = data;
1266         struct drm_encoder *encoder = &dp->encoder;
1267         struct resource *res;
1268         unsigned int irq_flags;
1269         int pipe, ret = 0;
1270
1271         dp->dev = &pdev->dev;
1272         dp->dpms_mode = DRM_MODE_DPMS_OFF;
1273
1274         dp->video_info = exynos_dp_dt_parse_pdata(&pdev->dev);
1275         if (IS_ERR(dp->video_info))
1276                 return PTR_ERR(dp->video_info);
1277
1278         dp->phy = devm_phy_get(dp->dev, "dp");
1279         if (IS_ERR(dp->phy)) {
1280                 dev_err(dp->dev, "no DP phy configured\n");
1281                 ret = PTR_ERR(dp->phy);
1282                 if (ret) {
1283                         /*
1284                          * phy itself is not enabled, so we can move forward
1285                          * assigning NULL to phy pointer.
1286                          */
1287                         if (ret == -ENOSYS || ret == -ENODEV)
1288                                 dp->phy = NULL;
1289                         else
1290                                 return ret;
1291                 }
1292         }
1293
1294         if (!dp->panel && !dp->ptn_bridge) {
1295                 ret = exynos_dp_dt_parse_panel(dp);
1296                 if (ret)
1297                         return ret;
1298         }
1299
1300         dp->clock = devm_clk_get(&pdev->dev, "dp");
1301         if (IS_ERR(dp->clock)) {
1302                 dev_err(&pdev->dev, "failed to get clock\n");
1303                 return PTR_ERR(dp->clock);
1304         }
1305
1306         clk_prepare_enable(dp->clock);
1307
1308         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1309
1310         dp->reg_base = devm_ioremap_resource(&pdev->dev, res);
1311         if (IS_ERR(dp->reg_base))
1312                 return PTR_ERR(dp->reg_base);
1313
1314         dp->hpd_gpio = of_get_named_gpio(dev->of_node, "samsung,hpd-gpio", 0);
1315
1316         if (gpio_is_valid(dp->hpd_gpio)) {
1317                 /*
1318                  * Set up the hotplug GPIO from the device tree as an interrupt.
1319                  * Simply specifying a different interrupt in the device tree
1320                  * doesn't work since we handle hotplug rather differently when
1321                  * using a GPIO.  We also need the actual GPIO specifier so
1322                  * that we can get the current state of the GPIO.
1323                  */
1324                 ret = devm_gpio_request_one(&pdev->dev, dp->hpd_gpio, GPIOF_IN,
1325                                             "hpd_gpio");
1326                 if (ret) {
1327                         dev_err(&pdev->dev, "failed to get hpd gpio\n");
1328                         return ret;
1329                 }
1330                 dp->irq = gpio_to_irq(dp->hpd_gpio);
1331                 irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING;
1332         } else {
1333                 dp->hpd_gpio = -ENODEV;
1334                 dp->irq = platform_get_irq(pdev, 0);
1335                 irq_flags = 0;
1336         }
1337
1338         if (dp->irq == -ENXIO) {
1339                 dev_err(&pdev->dev, "failed to get irq\n");
1340                 return -ENODEV;
1341         }
1342
1343         INIT_WORK(&dp->hotplug_work, exynos_dp_hotplug);
1344
1345         ret = devm_request_irq(&pdev->dev, dp->irq, exynos_dp_irq_handler,
1346                         irq_flags, "exynos-dp", dp);
1347         if (ret) {
1348                 dev_err(&pdev->dev, "failed to request irq\n");
1349                 return ret;
1350         }
1351         disable_irq(dp->irq);
1352
1353         dp->drm_dev = drm_dev;
1354
1355         pipe = exynos_drm_crtc_get_pipe_from_type(drm_dev,
1356                                                   EXYNOS_DISPLAY_TYPE_LCD);
1357         if (pipe < 0)
1358                 return pipe;
1359
1360         encoder->possible_crtcs = 1 << pipe;
1361
1362         DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs);
1363
1364         drm_encoder_init(drm_dev, encoder, &exynos_dp_encoder_funcs,
1365                          DRM_MODE_ENCODER_TMDS, NULL);
1366
1367         drm_encoder_helper_add(encoder, &exynos_dp_encoder_helper_funcs);
1368
1369         ret = exynos_dp_create_connector(encoder);
1370         if (ret) {
1371                 DRM_ERROR("failed to create connector ret = %d\n", ret);
1372                 drm_encoder_cleanup(encoder);
1373                 return ret;
1374         }
1375
1376         return 0;
1377 }
1378
1379 static void exynos_dp_unbind(struct device *dev, struct device *master,
1380                                 void *data)
1381 {
1382         struct exynos_dp_device *dp = dev_get_drvdata(dev);
1383
1384         exynos_dp_disable(&dp->encoder);
1385 }
1386
1387 static const struct component_ops exynos_dp_ops = {
1388         .bind   = exynos_dp_bind,
1389         .unbind = exynos_dp_unbind,
1390 };
1391
1392 static int exynos_dp_probe(struct platform_device *pdev)
1393 {
1394         struct device *dev = &pdev->dev;
1395         struct device_node *np = NULL, *endpoint = NULL;
1396         struct exynos_dp_device *dp;
1397         int ret;
1398
1399         dp = devm_kzalloc(&pdev->dev, sizeof(struct exynos_dp_device),
1400                                 GFP_KERNEL);
1401         if (!dp)
1402                 return -ENOMEM;
1403
1404         platform_set_drvdata(pdev, dp);
1405
1406         /* This is for the backward compatibility. */
1407         np = of_parse_phandle(dev->of_node, "panel", 0);
1408         if (np) {
1409                 dp->panel = of_drm_find_panel(np);
1410                 of_node_put(np);
1411                 if (!dp->panel)
1412                         return -EPROBE_DEFER;
1413                 goto out;
1414         }
1415
1416         endpoint = of_graph_get_next_endpoint(dev->of_node, NULL);
1417         if (endpoint) {
1418                 np = of_graph_get_remote_port_parent(endpoint);
1419                 if (np) {
1420                         /* The remote port can be either a panel or a bridge */
1421                         dp->panel = of_drm_find_panel(np);
1422                         if (!dp->panel) {
1423                                 dp->ptn_bridge = of_drm_find_bridge(np);
1424                                 if (!dp->ptn_bridge) {
1425                                         of_node_put(np);
1426                                         return -EPROBE_DEFER;
1427                                 }
1428                         }
1429                         of_node_put(np);
1430                 } else {
1431                         DRM_ERROR("no remote endpoint device node found.\n");
1432                         return -EINVAL;
1433                 }
1434         } else {
1435                 DRM_ERROR("no port endpoint subnode found.\n");
1436                 return -EINVAL;
1437         }
1438
1439 out:
1440         pm_runtime_enable(dev);
1441
1442         ret = component_add(&pdev->dev, &exynos_dp_ops);
1443         if (ret)
1444                 goto err_disable_pm_runtime;
1445
1446         return ret;
1447
1448 err_disable_pm_runtime:
1449         pm_runtime_disable(dev);
1450
1451         return ret;
1452 }
1453
1454 static int exynos_dp_remove(struct platform_device *pdev)
1455 {
1456         pm_runtime_disable(&pdev->dev);
1457         component_del(&pdev->dev, &exynos_dp_ops);
1458
1459         return 0;
1460 }
1461
1462 #ifdef CONFIG_PM
1463 static int exynos_dp_suspend(struct device *dev)
1464 {
1465         struct exynos_dp_device *dp = dev_get_drvdata(dev);
1466
1467         clk_disable_unprepare(dp->clock);
1468
1469         return 0;
1470 }
1471
1472 static int exynos_dp_resume(struct device *dev)
1473 {
1474         struct exynos_dp_device *dp = dev_get_drvdata(dev);
1475         int ret;
1476
1477         ret = clk_prepare_enable(dp->clock);
1478         if (ret < 0) {
1479                 DRM_ERROR("Failed to prepare_enable the clock clk [%d]\n", ret);
1480                 return ret;
1481         }
1482
1483         return 0;
1484 }
1485 #endif
1486
1487 static const struct dev_pm_ops exynos_dp_pm_ops = {
1488         SET_RUNTIME_PM_OPS(exynos_dp_suspend, exynos_dp_resume, NULL)
1489 };
1490
1491 static const struct of_device_id exynos_dp_match[] = {
1492         { .compatible = "samsung,exynos5-dp" },
1493         {},
1494 };
1495 MODULE_DEVICE_TABLE(of, exynos_dp_match);
1496
1497 struct platform_driver dp_driver = {
1498         .probe          = exynos_dp_probe,
1499         .remove         = exynos_dp_remove,
1500         .driver         = {
1501                 .name   = "exynos-dp",
1502                 .owner  = THIS_MODULE,
1503                 .pm     = &exynos_dp_pm_ops,
1504                 .of_match_table = exynos_dp_match,
1505         },
1506 };
1507
1508 MODULE_AUTHOR("Jingoo Han <jg1.han@samsung.com>");
1509 MODULE_DESCRIPTION("Samsung SoC DP Driver");
1510 MODULE_LICENSE("GPL v2");