]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - drivers/gpu/drm/i915/intel_dp.c
drm/i915: Use a device flag for non-interruptible phases
[mirror_ubuntu-zesty-kernel.git] / drivers / gpu / drm / i915 / intel_dp.c
CommitLineData
a4fc5ed6
KP
1/*
2 * Copyright © 2008 Intel Corporation
3 *
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
10 *
11 * The above copyright notice and this permission notice (including the next
12 * paragraph) shall be included in all copies or substantial portions of the
13 * Software.
14 *
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
21 * IN THE SOFTWARE.
22 *
23 * Authors:
24 * Keith Packard <keithp@keithp.com>
25 *
26 */
27
28#include <linux/i2c.h>
5a0e3ad6 29#include <linux/slab.h>
a4fc5ed6
KP
30#include "drmP.h"
31#include "drm.h"
32#include "drm_crtc.h"
33#include "drm_crtc_helper.h"
34#include "intel_drv.h"
35#include "i915_drm.h"
36#include "i915_drv.h"
ab2c0672 37#include "drm_dp_helper.h"
a4fc5ed6 38
ae266c98 39
a4fc5ed6
KP
40#define DP_LINK_STATUS_SIZE 6
41#define DP_LINK_CHECK_TIMEOUT (10 * 1000)
42
43#define DP_LINK_CONFIGURATION_SIZE 9
44
ea5b213a
CW
45struct intel_dp {
46 struct intel_encoder base;
a4fc5ed6
KP
47 uint32_t output_reg;
48 uint32_t DP;
49 uint8_t link_configuration[DP_LINK_CONFIGURATION_SIZE];
a4fc5ed6 50 bool has_audio;
f684960e 51 int force_audio;
c8110e52 52 int dpms_mode;
a4fc5ed6
KP
53 uint8_t link_bw;
54 uint8_t lane_count;
55 uint8_t dpcd[4];
a4fc5ed6
KP
56 struct i2c_adapter adapter;
57 struct i2c_algo_dp_aux_data algo;
f0917379 58 bool is_pch_edp;
33a34e4e
JB
59 uint8_t train_set[4];
60 uint8_t link_status[DP_LINK_STATUS_SIZE];
f684960e
CW
61
62 struct drm_property *force_audio_property;
a4fc5ed6
KP
63};
64
cfcb0fc9
JB
65/**
66 * is_edp - is the given port attached to an eDP panel (either CPU or PCH)
67 * @intel_dp: DP struct
68 *
69 * If a CPU or PCH DP output is attached to an eDP panel, this function
70 * will return true, and false otherwise.
71 */
72static bool is_edp(struct intel_dp *intel_dp)
73{
74 return intel_dp->base.type == INTEL_OUTPUT_EDP;
75}
76
77/**
78 * is_pch_edp - is the port on the PCH and attached to an eDP panel?
79 * @intel_dp: DP struct
80 *
81 * Returns true if the given DP struct corresponds to a PCH DP port attached
82 * to an eDP panel, false otherwise. Helpful for determining whether we
83 * may need FDI resources for a given DP output or not.
84 */
85static bool is_pch_edp(struct intel_dp *intel_dp)
86{
87 return intel_dp->is_pch_edp;
88}
89
ea5b213a
CW
90static struct intel_dp *enc_to_intel_dp(struct drm_encoder *encoder)
91{
4ef69c7a 92 return container_of(encoder, struct intel_dp, base.base);
ea5b213a 93}
a4fc5ed6 94
df0e9248
CW
95static struct intel_dp *intel_attached_dp(struct drm_connector *connector)
96{
97 return container_of(intel_attached_encoder(connector),
98 struct intel_dp, base);
99}
100
814948ad
JB
101/**
102 * intel_encoder_is_pch_edp - is the given encoder a PCH attached eDP?
103 * @encoder: DRM encoder
104 *
105 * Return true if @encoder corresponds to a PCH attached eDP panel. Needed
106 * by intel_display.c.
107 */
108bool intel_encoder_is_pch_edp(struct drm_encoder *encoder)
109{
110 struct intel_dp *intel_dp;
111
112 if (!encoder)
113 return false;
114
115 intel_dp = enc_to_intel_dp(encoder);
116
117 return is_pch_edp(intel_dp);
118}
119
33a34e4e
JB
120static void intel_dp_start_link_train(struct intel_dp *intel_dp);
121static void intel_dp_complete_link_train(struct intel_dp *intel_dp);
ea5b213a 122static void intel_dp_link_down(struct intel_dp *intel_dp);
a4fc5ed6 123
32f9d658 124void
21d40d37 125intel_edp_link_config (struct intel_encoder *intel_encoder,
ea5b213a 126 int *lane_num, int *link_bw)
32f9d658 127{
ea5b213a 128 struct intel_dp *intel_dp = container_of(intel_encoder, struct intel_dp, base);
32f9d658 129
ea5b213a
CW
130 *lane_num = intel_dp->lane_count;
131 if (intel_dp->link_bw == DP_LINK_BW_1_62)
32f9d658 132 *link_bw = 162000;
ea5b213a 133 else if (intel_dp->link_bw == DP_LINK_BW_2_7)
32f9d658
ZW
134 *link_bw = 270000;
135}
136
a4fc5ed6 137static int
ea5b213a 138intel_dp_max_lane_count(struct intel_dp *intel_dp)
a4fc5ed6 139{
a4fc5ed6
KP
140 int max_lane_count = 4;
141
ea5b213a
CW
142 if (intel_dp->dpcd[0] >= 0x11) {
143 max_lane_count = intel_dp->dpcd[2] & 0x1f;
a4fc5ed6
KP
144 switch (max_lane_count) {
145 case 1: case 2: case 4:
146 break;
147 default:
148 max_lane_count = 4;
149 }
150 }
151 return max_lane_count;
152}
153
154static int
ea5b213a 155intel_dp_max_link_bw(struct intel_dp *intel_dp)
a4fc5ed6 156{
ea5b213a 157 int max_link_bw = intel_dp->dpcd[1];
a4fc5ed6
KP
158
159 switch (max_link_bw) {
160 case DP_LINK_BW_1_62:
161 case DP_LINK_BW_2_7:
162 break;
163 default:
164 max_link_bw = DP_LINK_BW_1_62;
165 break;
166 }
167 return max_link_bw;
168}
169
170static int
171intel_dp_link_clock(uint8_t link_bw)
172{
173 if (link_bw == DP_LINK_BW_2_7)
174 return 270000;
175 else
176 return 162000;
177}
178
179/* I think this is a fiction */
180static int
ea5b213a 181intel_dp_link_required(struct drm_device *dev, struct intel_dp *intel_dp, int pixel_clock)
a4fc5ed6 182{
885a5fb5
ZW
183 struct drm_i915_private *dev_priv = dev->dev_private;
184
4d926461 185 if (is_edp(intel_dp))
5ceb0f9b 186 return (pixel_clock * dev_priv->edp.bpp + 7) / 8;
885a5fb5
ZW
187 else
188 return pixel_clock * 3;
a4fc5ed6
KP
189}
190
fe27d53e
DA
191static int
192intel_dp_max_data_rate(int max_link_clock, int max_lanes)
193{
194 return (max_link_clock * max_lanes * 8) / 10;
195}
196
a4fc5ed6
KP
197static int
198intel_dp_mode_valid(struct drm_connector *connector,
199 struct drm_display_mode *mode)
200{
df0e9248 201 struct intel_dp *intel_dp = intel_attached_dp(connector);
7de56f43
ZY
202 struct drm_device *dev = connector->dev;
203 struct drm_i915_private *dev_priv = dev->dev_private;
ea5b213a
CW
204 int max_link_clock = intel_dp_link_clock(intel_dp_max_link_bw(intel_dp));
205 int max_lanes = intel_dp_max_lane_count(intel_dp);
a4fc5ed6 206
4d926461 207 if (is_edp(intel_dp) && dev_priv->panel_fixed_mode) {
7de56f43
ZY
208 if (mode->hdisplay > dev_priv->panel_fixed_mode->hdisplay)
209 return MODE_PANEL;
210
211 if (mode->vdisplay > dev_priv->panel_fixed_mode->vdisplay)
212 return MODE_PANEL;
213 }
214
fe27d53e
DA
215 /* only refuse the mode on non eDP since we have seen some wierd eDP panels
216 which are outside spec tolerances but somehow work by magic */
cfcb0fc9 217 if (!is_edp(intel_dp) &&
ea5b213a 218 (intel_dp_link_required(connector->dev, intel_dp, mode->clock)
fe27d53e 219 > intel_dp_max_data_rate(max_link_clock, max_lanes)))
a4fc5ed6
KP
220 return MODE_CLOCK_HIGH;
221
222 if (mode->clock < 10000)
223 return MODE_CLOCK_LOW;
224
225 return MODE_OK;
226}
227
228static uint32_t
229pack_aux(uint8_t *src, int src_bytes)
230{
231 int i;
232 uint32_t v = 0;
233
234 if (src_bytes > 4)
235 src_bytes = 4;
236 for (i = 0; i < src_bytes; i++)
237 v |= ((uint32_t) src[i]) << ((3-i) * 8);
238 return v;
239}
240
241static void
242unpack_aux(uint32_t src, uint8_t *dst, int dst_bytes)
243{
244 int i;
245 if (dst_bytes > 4)
246 dst_bytes = 4;
247 for (i = 0; i < dst_bytes; i++)
248 dst[i] = src >> ((3-i) * 8);
249}
250
fb0f8fbf
KP
251/* hrawclock is 1/4 the FSB frequency */
252static int
253intel_hrawclk(struct drm_device *dev)
254{
255 struct drm_i915_private *dev_priv = dev->dev_private;
256 uint32_t clkcfg;
257
258 clkcfg = I915_READ(CLKCFG);
259 switch (clkcfg & CLKCFG_FSB_MASK) {
260 case CLKCFG_FSB_400:
261 return 100;
262 case CLKCFG_FSB_533:
263 return 133;
264 case CLKCFG_FSB_667:
265 return 166;
266 case CLKCFG_FSB_800:
267 return 200;
268 case CLKCFG_FSB_1067:
269 return 266;
270 case CLKCFG_FSB_1333:
271 return 333;
272 /* these two are just a guess; one of them might be right */
273 case CLKCFG_FSB_1600:
274 case CLKCFG_FSB_1600_ALT:
275 return 400;
276 default:
277 return 133;
278 }
279}
280
a4fc5ed6 281static int
ea5b213a 282intel_dp_aux_ch(struct intel_dp *intel_dp,
a4fc5ed6
KP
283 uint8_t *send, int send_bytes,
284 uint8_t *recv, int recv_size)
285{
ea5b213a 286 uint32_t output_reg = intel_dp->output_reg;
4ef69c7a 287 struct drm_device *dev = intel_dp->base.base.dev;
a4fc5ed6
KP
288 struct drm_i915_private *dev_priv = dev->dev_private;
289 uint32_t ch_ctl = output_reg + 0x10;
290 uint32_t ch_data = ch_ctl + 4;
291 int i;
292 int recv_bytes;
a4fc5ed6 293 uint32_t status;
fb0f8fbf 294 uint32_t aux_clock_divider;
e3421a18 295 int try, precharge;
a4fc5ed6
KP
296
297 /* The clock divider is based off the hrawclk,
fb0f8fbf
KP
298 * and would like to run at 2MHz. So, take the
299 * hrawclk value and divide by 2 and use that
6176b8f9
JB
300 *
301 * Note that PCH attached eDP panels should use a 125MHz input
302 * clock divider.
a4fc5ed6 303 */
cfcb0fc9 304 if (is_edp(intel_dp) && !is_pch_edp(intel_dp)) {
e3421a18
ZW
305 if (IS_GEN6(dev))
306 aux_clock_divider = 200; /* SNB eDP input clock at 400Mhz */
307 else
308 aux_clock_divider = 225; /* eDP input clock at 450Mhz */
309 } else if (HAS_PCH_SPLIT(dev))
f2b115e6 310 aux_clock_divider = 62; /* IRL input clock fixed at 125Mhz */
5eb08b69
ZW
311 else
312 aux_clock_divider = intel_hrawclk(dev) / 2;
313
e3421a18
ZW
314 if (IS_GEN6(dev))
315 precharge = 3;
316 else
317 precharge = 5;
318
4f7f7b7e
CW
319 if (I915_READ(ch_ctl) & DP_AUX_CH_CTL_SEND_BUSY) {
320 DRM_ERROR("dp_aux_ch not started status 0x%08x\n",
321 I915_READ(ch_ctl));
322 return -EBUSY;
323 }
324
fb0f8fbf
KP
325 /* Must try at least 3 times according to DP spec */
326 for (try = 0; try < 5; try++) {
327 /* Load the send data into the aux channel data registers */
4f7f7b7e
CW
328 for (i = 0; i < send_bytes; i += 4)
329 I915_WRITE(ch_data + i,
330 pack_aux(send + i, send_bytes - i));
fb0f8fbf
KP
331
332 /* Send the command and wait for it to complete */
4f7f7b7e
CW
333 I915_WRITE(ch_ctl,
334 DP_AUX_CH_CTL_SEND_BUSY |
335 DP_AUX_CH_CTL_TIME_OUT_400us |
336 (send_bytes << DP_AUX_CH_CTL_MESSAGE_SIZE_SHIFT) |
337 (precharge << DP_AUX_CH_CTL_PRECHARGE_2US_SHIFT) |
338 (aux_clock_divider << DP_AUX_CH_CTL_BIT_CLOCK_2X_SHIFT) |
339 DP_AUX_CH_CTL_DONE |
340 DP_AUX_CH_CTL_TIME_OUT_ERROR |
341 DP_AUX_CH_CTL_RECEIVE_ERROR);
fb0f8fbf 342 for (;;) {
fb0f8fbf
KP
343 status = I915_READ(ch_ctl);
344 if ((status & DP_AUX_CH_CTL_SEND_BUSY) == 0)
345 break;
4f7f7b7e 346 udelay(100);
fb0f8fbf
KP
347 }
348
349 /* Clear done status and any errors */
4f7f7b7e
CW
350 I915_WRITE(ch_ctl,
351 status |
352 DP_AUX_CH_CTL_DONE |
353 DP_AUX_CH_CTL_TIME_OUT_ERROR |
354 DP_AUX_CH_CTL_RECEIVE_ERROR);
355 if (status & DP_AUX_CH_CTL_DONE)
a4fc5ed6
KP
356 break;
357 }
358
a4fc5ed6 359 if ((status & DP_AUX_CH_CTL_DONE) == 0) {
1ae8c0a5 360 DRM_ERROR("dp_aux_ch not done status 0x%08x\n", status);
a5b3da54 361 return -EBUSY;
a4fc5ed6
KP
362 }
363
364 /* Check for timeout or receive error.
365 * Timeouts occur when the sink is not connected
366 */
a5b3da54 367 if (status & DP_AUX_CH_CTL_RECEIVE_ERROR) {
1ae8c0a5 368 DRM_ERROR("dp_aux_ch receive error status 0x%08x\n", status);
a5b3da54
KP
369 return -EIO;
370 }
1ae8c0a5
KP
371
372 /* Timeouts occur when the device isn't connected, so they're
373 * "normal" -- don't fill the kernel log with these */
a5b3da54 374 if (status & DP_AUX_CH_CTL_TIME_OUT_ERROR) {
28c97730 375 DRM_DEBUG_KMS("dp_aux_ch timeout status 0x%08x\n", status);
a5b3da54 376 return -ETIMEDOUT;
a4fc5ed6
KP
377 }
378
379 /* Unload any bytes sent back from the other side */
380 recv_bytes = ((status & DP_AUX_CH_CTL_MESSAGE_SIZE_MASK) >>
381 DP_AUX_CH_CTL_MESSAGE_SIZE_SHIFT);
a4fc5ed6
KP
382 if (recv_bytes > recv_size)
383 recv_bytes = recv_size;
384
4f7f7b7e
CW
385 for (i = 0; i < recv_bytes; i += 4)
386 unpack_aux(I915_READ(ch_data + i),
387 recv + i, recv_bytes - i);
a4fc5ed6
KP
388
389 return recv_bytes;
390}
391
392/* Write data to the aux channel in native mode */
393static int
ea5b213a 394intel_dp_aux_native_write(struct intel_dp *intel_dp,
a4fc5ed6
KP
395 uint16_t address, uint8_t *send, int send_bytes)
396{
397 int ret;
398 uint8_t msg[20];
399 int msg_bytes;
400 uint8_t ack;
401
402 if (send_bytes > 16)
403 return -1;
404 msg[0] = AUX_NATIVE_WRITE << 4;
405 msg[1] = address >> 8;
eebc863e 406 msg[2] = address & 0xff;
a4fc5ed6
KP
407 msg[3] = send_bytes - 1;
408 memcpy(&msg[4], send, send_bytes);
409 msg_bytes = send_bytes + 4;
410 for (;;) {
ea5b213a 411 ret = intel_dp_aux_ch(intel_dp, msg, msg_bytes, &ack, 1);
a4fc5ed6
KP
412 if (ret < 0)
413 return ret;
414 if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_ACK)
415 break;
416 else if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_DEFER)
417 udelay(100);
418 else
a5b3da54 419 return -EIO;
a4fc5ed6
KP
420 }
421 return send_bytes;
422}
423
424/* Write a single byte to the aux channel in native mode */
425static int
ea5b213a 426intel_dp_aux_native_write_1(struct intel_dp *intel_dp,
a4fc5ed6
KP
427 uint16_t address, uint8_t byte)
428{
ea5b213a 429 return intel_dp_aux_native_write(intel_dp, address, &byte, 1);
a4fc5ed6
KP
430}
431
432/* read bytes from a native aux channel */
433static int
ea5b213a 434intel_dp_aux_native_read(struct intel_dp *intel_dp,
a4fc5ed6
KP
435 uint16_t address, uint8_t *recv, int recv_bytes)
436{
437 uint8_t msg[4];
438 int msg_bytes;
439 uint8_t reply[20];
440 int reply_bytes;
441 uint8_t ack;
442 int ret;
443
444 msg[0] = AUX_NATIVE_READ << 4;
445 msg[1] = address >> 8;
446 msg[2] = address & 0xff;
447 msg[3] = recv_bytes - 1;
448
449 msg_bytes = 4;
450 reply_bytes = recv_bytes + 1;
451
452 for (;;) {
ea5b213a 453 ret = intel_dp_aux_ch(intel_dp, msg, msg_bytes,
a4fc5ed6 454 reply, reply_bytes);
a5b3da54
KP
455 if (ret == 0)
456 return -EPROTO;
457 if (ret < 0)
a4fc5ed6
KP
458 return ret;
459 ack = reply[0];
460 if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_ACK) {
461 memcpy(recv, reply + 1, ret - 1);
462 return ret - 1;
463 }
464 else if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_DEFER)
465 udelay(100);
466 else
a5b3da54 467 return -EIO;
a4fc5ed6
KP
468 }
469}
470
471static int
ab2c0672
DA
472intel_dp_i2c_aux_ch(struct i2c_adapter *adapter, int mode,
473 uint8_t write_byte, uint8_t *read_byte)
a4fc5ed6 474{
ab2c0672 475 struct i2c_algo_dp_aux_data *algo_data = adapter->algo_data;
ea5b213a
CW
476 struct intel_dp *intel_dp = container_of(adapter,
477 struct intel_dp,
478 adapter);
ab2c0672
DA
479 uint16_t address = algo_data->address;
480 uint8_t msg[5];
481 uint8_t reply[2];
8316f337 482 unsigned retry;
ab2c0672
DA
483 int msg_bytes;
484 int reply_bytes;
485 int ret;
486
487 /* Set up the command byte */
488 if (mode & MODE_I2C_READ)
489 msg[0] = AUX_I2C_READ << 4;
490 else
491 msg[0] = AUX_I2C_WRITE << 4;
492
493 if (!(mode & MODE_I2C_STOP))
494 msg[0] |= AUX_I2C_MOT << 4;
a4fc5ed6 495
ab2c0672
DA
496 msg[1] = address >> 8;
497 msg[2] = address;
498
499 switch (mode) {
500 case MODE_I2C_WRITE:
501 msg[3] = 0;
502 msg[4] = write_byte;
503 msg_bytes = 5;
504 reply_bytes = 1;
505 break;
506 case MODE_I2C_READ:
507 msg[3] = 0;
508 msg_bytes = 4;
509 reply_bytes = 2;
510 break;
511 default:
512 msg_bytes = 3;
513 reply_bytes = 1;
514 break;
515 }
516
8316f337
DF
517 for (retry = 0; retry < 5; retry++) {
518 ret = intel_dp_aux_ch(intel_dp,
519 msg, msg_bytes,
520 reply, reply_bytes);
ab2c0672 521 if (ret < 0) {
3ff99164 522 DRM_DEBUG_KMS("aux_ch failed %d\n", ret);
ab2c0672
DA
523 return ret;
524 }
8316f337
DF
525
526 switch (reply[0] & AUX_NATIVE_REPLY_MASK) {
527 case AUX_NATIVE_REPLY_ACK:
528 /* I2C-over-AUX Reply field is only valid
529 * when paired with AUX ACK.
530 */
531 break;
532 case AUX_NATIVE_REPLY_NACK:
533 DRM_DEBUG_KMS("aux_ch native nack\n");
534 return -EREMOTEIO;
535 case AUX_NATIVE_REPLY_DEFER:
536 udelay(100);
537 continue;
538 default:
539 DRM_ERROR("aux_ch invalid native reply 0x%02x\n",
540 reply[0]);
541 return -EREMOTEIO;
542 }
543
ab2c0672
DA
544 switch (reply[0] & AUX_I2C_REPLY_MASK) {
545 case AUX_I2C_REPLY_ACK:
546 if (mode == MODE_I2C_READ) {
547 *read_byte = reply[1];
548 }
549 return reply_bytes - 1;
550 case AUX_I2C_REPLY_NACK:
8316f337 551 DRM_DEBUG_KMS("aux_i2c nack\n");
ab2c0672
DA
552 return -EREMOTEIO;
553 case AUX_I2C_REPLY_DEFER:
8316f337 554 DRM_DEBUG_KMS("aux_i2c defer\n");
ab2c0672
DA
555 udelay(100);
556 break;
557 default:
8316f337 558 DRM_ERROR("aux_i2c invalid reply 0x%02x\n", reply[0]);
ab2c0672
DA
559 return -EREMOTEIO;
560 }
561 }
8316f337
DF
562
563 DRM_ERROR("too many retries, giving up\n");
564 return -EREMOTEIO;
a4fc5ed6
KP
565}
566
567static int
ea5b213a 568intel_dp_i2c_init(struct intel_dp *intel_dp,
55f78c43 569 struct intel_connector *intel_connector, const char *name)
a4fc5ed6 570{
d54e9d28 571 DRM_DEBUG_KMS("i2c_init %s\n", name);
ea5b213a
CW
572 intel_dp->algo.running = false;
573 intel_dp->algo.address = 0;
574 intel_dp->algo.aux_ch = intel_dp_i2c_aux_ch;
575
576 memset(&intel_dp->adapter, '\0', sizeof (intel_dp->adapter));
577 intel_dp->adapter.owner = THIS_MODULE;
578 intel_dp->adapter.class = I2C_CLASS_DDC;
579 strncpy (intel_dp->adapter.name, name, sizeof(intel_dp->adapter.name) - 1);
580 intel_dp->adapter.name[sizeof(intel_dp->adapter.name) - 1] = '\0';
581 intel_dp->adapter.algo_data = &intel_dp->algo;
582 intel_dp->adapter.dev.parent = &intel_connector->base.kdev;
583
584 return i2c_dp_aux_add_bus(&intel_dp->adapter);
a4fc5ed6
KP
585}
586
587static bool
588intel_dp_mode_fixup(struct drm_encoder *encoder, struct drm_display_mode *mode,
589 struct drm_display_mode *adjusted_mode)
590{
0d3a1bee
ZY
591 struct drm_device *dev = encoder->dev;
592 struct drm_i915_private *dev_priv = dev->dev_private;
ea5b213a 593 struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
a4fc5ed6 594 int lane_count, clock;
ea5b213a
CW
595 int max_lane_count = intel_dp_max_lane_count(intel_dp);
596 int max_clock = intel_dp_max_link_bw(intel_dp) == DP_LINK_BW_2_7 ? 1 : 0;
a4fc5ed6
KP
597 static int bws[2] = { DP_LINK_BW_1_62, DP_LINK_BW_2_7 };
598
4d926461 599 if (is_edp(intel_dp) && dev_priv->panel_fixed_mode) {
1d8e1c75
CW
600 intel_fixed_panel_mode(dev_priv->panel_fixed_mode, adjusted_mode);
601 intel_pch_panel_fitting(dev, DRM_MODE_SCALE_FULLSCREEN,
602 mode, adjusted_mode);
0d3a1bee
ZY
603 /*
604 * the mode->clock is used to calculate the Data&Link M/N
605 * of the pipe. For the eDP the fixed clock should be used.
606 */
607 mode->clock = dev_priv->panel_fixed_mode->clock;
608 }
609
a4fc5ed6
KP
610 for (lane_count = 1; lane_count <= max_lane_count; lane_count <<= 1) {
611 for (clock = 0; clock <= max_clock; clock++) {
fe27d53e 612 int link_avail = intel_dp_max_data_rate(intel_dp_link_clock(bws[clock]), lane_count);
a4fc5ed6 613
ea5b213a 614 if (intel_dp_link_required(encoder->dev, intel_dp, mode->clock)
885a5fb5 615 <= link_avail) {
ea5b213a
CW
616 intel_dp->link_bw = bws[clock];
617 intel_dp->lane_count = lane_count;
618 adjusted_mode->clock = intel_dp_link_clock(intel_dp->link_bw);
28c97730
ZY
619 DRM_DEBUG_KMS("Display port link bw %02x lane "
620 "count %d clock %d\n",
ea5b213a 621 intel_dp->link_bw, intel_dp->lane_count,
a4fc5ed6
KP
622 adjusted_mode->clock);
623 return true;
624 }
625 }
626 }
fe27d53e 627
3cf2efb1
CW
628 if (is_edp(intel_dp)) {
629 /* okay we failed just pick the highest */
630 intel_dp->lane_count = max_lane_count;
631 intel_dp->link_bw = bws[max_clock];
632 adjusted_mode->clock = intel_dp_link_clock(intel_dp->link_bw);
633 DRM_DEBUG_KMS("Force picking display port link bw %02x lane "
634 "count %d clock %d\n",
635 intel_dp->link_bw, intel_dp->lane_count,
636 adjusted_mode->clock);
637
638 return true;
639 }
640
a4fc5ed6
KP
641 return false;
642}
643
644struct intel_dp_m_n {
645 uint32_t tu;
646 uint32_t gmch_m;
647 uint32_t gmch_n;
648 uint32_t link_m;
649 uint32_t link_n;
650};
651
652static void
653intel_reduce_ratio(uint32_t *num, uint32_t *den)
654{
655 while (*num > 0xffffff || *den > 0xffffff) {
656 *num >>= 1;
657 *den >>= 1;
658 }
659}
660
661static void
36e83a18 662intel_dp_compute_m_n(int bpp,
a4fc5ed6
KP
663 int nlanes,
664 int pixel_clock,
665 int link_clock,
666 struct intel_dp_m_n *m_n)
667{
668 m_n->tu = 64;
36e83a18 669 m_n->gmch_m = (pixel_clock * bpp) >> 3;
a4fc5ed6
KP
670 m_n->gmch_n = link_clock * nlanes;
671 intel_reduce_ratio(&m_n->gmch_m, &m_n->gmch_n);
672 m_n->link_m = pixel_clock;
673 m_n->link_n = link_clock;
674 intel_reduce_ratio(&m_n->link_m, &m_n->link_n);
675}
676
677void
678intel_dp_set_m_n(struct drm_crtc *crtc, struct drm_display_mode *mode,
679 struct drm_display_mode *adjusted_mode)
680{
681 struct drm_device *dev = crtc->dev;
682 struct drm_mode_config *mode_config = &dev->mode_config;
55f78c43 683 struct drm_encoder *encoder;
a4fc5ed6
KP
684 struct drm_i915_private *dev_priv = dev->dev_private;
685 struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
36e83a18 686 int lane_count = 4, bpp = 24;
a4fc5ed6 687 struct intel_dp_m_n m_n;
9db4a9c7 688 int pipe = intel_crtc->pipe;
a4fc5ed6
KP
689
690 /*
21d40d37 691 * Find the lane count in the intel_encoder private
a4fc5ed6 692 */
55f78c43 693 list_for_each_entry(encoder, &mode_config->encoder_list, head) {
ea5b213a 694 struct intel_dp *intel_dp;
a4fc5ed6 695
d8201ab6 696 if (encoder->crtc != crtc)
a4fc5ed6
KP
697 continue;
698
ea5b213a
CW
699 intel_dp = enc_to_intel_dp(encoder);
700 if (intel_dp->base.type == INTEL_OUTPUT_DISPLAYPORT) {
701 lane_count = intel_dp->lane_count;
51190667
JB
702 break;
703 } else if (is_edp(intel_dp)) {
704 lane_count = dev_priv->edp.lanes;
705 bpp = dev_priv->edp.bpp;
a4fc5ed6
KP
706 break;
707 }
708 }
709
710 /*
711 * Compute the GMCH and Link ratios. The '3' here is
712 * the number of bytes_per_pixel post-LUT, which we always
713 * set up for 8-bits of R/G/B, or 3 bytes total.
714 */
36e83a18 715 intel_dp_compute_m_n(bpp, lane_count,
a4fc5ed6
KP
716 mode->clock, adjusted_mode->clock, &m_n);
717
c619eed4 718 if (HAS_PCH_SPLIT(dev)) {
9db4a9c7
JB
719 I915_WRITE(TRANSDATA_M1(pipe),
720 ((m_n.tu - 1) << PIPE_GMCH_DATA_M_TU_SIZE_SHIFT) |
721 m_n.gmch_m);
722 I915_WRITE(TRANSDATA_N1(pipe), m_n.gmch_n);
723 I915_WRITE(TRANSDPLINK_M1(pipe), m_n.link_m);
724 I915_WRITE(TRANSDPLINK_N1(pipe), m_n.link_n);
a4fc5ed6 725 } else {
9db4a9c7
JB
726 I915_WRITE(PIPE_GMCH_DATA_M(pipe),
727 ((m_n.tu - 1) << PIPE_GMCH_DATA_M_TU_SIZE_SHIFT) |
728 m_n.gmch_m);
729 I915_WRITE(PIPE_GMCH_DATA_N(pipe), m_n.gmch_n);
730 I915_WRITE(PIPE_DP_LINK_M(pipe), m_n.link_m);
731 I915_WRITE(PIPE_DP_LINK_N(pipe), m_n.link_n);
a4fc5ed6
KP
732 }
733}
734
735static void
736intel_dp_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
737 struct drm_display_mode *adjusted_mode)
738{
e3421a18 739 struct drm_device *dev = encoder->dev;
ea5b213a 740 struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
4ef69c7a 741 struct drm_crtc *crtc = intel_dp->base.base.crtc;
a4fc5ed6
KP
742 struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
743
ea5b213a 744 intel_dp->DP = (DP_VOLTAGE_0_4 |
9c9e7927
AJ
745 DP_PRE_EMPHASIS_0);
746
747 if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
ea5b213a 748 intel_dp->DP |= DP_SYNC_HS_HIGH;
9c9e7927 749 if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
ea5b213a 750 intel_dp->DP |= DP_SYNC_VS_HIGH;
a4fc5ed6 751
cfcb0fc9 752 if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
ea5b213a 753 intel_dp->DP |= DP_LINK_TRAIN_OFF_CPT;
e3421a18 754 else
ea5b213a 755 intel_dp->DP |= DP_LINK_TRAIN_OFF;
a4fc5ed6 756
ea5b213a 757 switch (intel_dp->lane_count) {
a4fc5ed6 758 case 1:
ea5b213a 759 intel_dp->DP |= DP_PORT_WIDTH_1;
a4fc5ed6
KP
760 break;
761 case 2:
ea5b213a 762 intel_dp->DP |= DP_PORT_WIDTH_2;
a4fc5ed6
KP
763 break;
764 case 4:
ea5b213a 765 intel_dp->DP |= DP_PORT_WIDTH_4;
a4fc5ed6
KP
766 break;
767 }
ea5b213a
CW
768 if (intel_dp->has_audio)
769 intel_dp->DP |= DP_AUDIO_OUTPUT_ENABLE;
a4fc5ed6 770
ea5b213a
CW
771 memset(intel_dp->link_configuration, 0, DP_LINK_CONFIGURATION_SIZE);
772 intel_dp->link_configuration[0] = intel_dp->link_bw;
773 intel_dp->link_configuration[1] = intel_dp->lane_count;
a4fc5ed6
KP
774
775 /*
9962c925 776 * Check for DPCD version > 1.1 and enhanced framing support
a4fc5ed6 777 */
ea5b213a
CW
778 if (intel_dp->dpcd[0] >= 0x11 && (intel_dp->dpcd[2] & DP_ENHANCED_FRAME_CAP)) {
779 intel_dp->link_configuration[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN;
780 intel_dp->DP |= DP_ENHANCED_FRAMING;
a4fc5ed6
KP
781 }
782
e3421a18
ZW
783 /* CPT DP's pipe select is decided in TRANS_DP_CTL */
784 if (intel_crtc->pipe == 1 && !HAS_PCH_CPT(dev))
ea5b213a 785 intel_dp->DP |= DP_PIPEB_SELECT;
32f9d658 786
895692be 787 if (is_edp(intel_dp) && !is_pch_edp(intel_dp)) {
32f9d658 788 /* don't miss out required setting for eDP */
ea5b213a 789 intel_dp->DP |= DP_PLL_ENABLE;
32f9d658 790 if (adjusted_mode->clock < 200000)
ea5b213a 791 intel_dp->DP |= DP_PLL_FREQ_160MHZ;
32f9d658 792 else
ea5b213a 793 intel_dp->DP |= DP_PLL_FREQ_270MHZ;
32f9d658 794 }
a4fc5ed6
KP
795}
796
5d613501
JB
797static void ironlake_edp_panel_vdd_on(struct intel_dp *intel_dp)
798{
799 struct drm_device *dev = intel_dp->base.base.dev;
800 struct drm_i915_private *dev_priv = dev->dev_private;
801 u32 pp;
802
803 /*
804 * If the panel wasn't on, make sure there's not a currently
805 * active PP sequence before enabling AUX VDD.
806 */
807 if (!(I915_READ(PCH_PP_STATUS) & PP_ON))
808 msleep(dev_priv->panel_t3);
809
810 pp = I915_READ(PCH_PP_CONTROL);
811 pp |= EDP_FORCE_VDD;
812 I915_WRITE(PCH_PP_CONTROL, pp);
813 POSTING_READ(PCH_PP_CONTROL);
814}
815
816static void ironlake_edp_panel_vdd_off(struct intel_dp *intel_dp)
817{
818 struct drm_device *dev = intel_dp->base.base.dev;
819 struct drm_i915_private *dev_priv = dev->dev_private;
820 u32 pp;
821
822 pp = I915_READ(PCH_PP_CONTROL);
823 pp &= ~EDP_FORCE_VDD;
824 I915_WRITE(PCH_PP_CONTROL, pp);
825 POSTING_READ(PCH_PP_CONTROL);
826
827 /* Make sure sequencer is idle before allowing subsequent activity */
828 msleep(dev_priv->panel_t12);
829}
830
7eaf5547 831/* Returns true if the panel was already on when called */
01cb9ea6 832static bool ironlake_edp_panel_on (struct intel_dp *intel_dp)
9934c132 833{
01cb9ea6 834 struct drm_device *dev = intel_dp->base.base.dev;
9934c132 835 struct drm_i915_private *dev_priv = dev->dev_private;
01cb9ea6 836 u32 pp, idle_on_mask = PP_ON | PP_SEQUENCE_STATE_ON_IDLE;
9934c132 837
913d8d11 838 if (I915_READ(PCH_PP_STATUS) & PP_ON)
7eaf5547 839 return true;
9934c132
JB
840
841 pp = I915_READ(PCH_PP_CONTROL);
37c6c9b0
JB
842
843 /* ILK workaround: disable reset around power sequence */
844 pp &= ~PANEL_POWER_RESET;
845 I915_WRITE(PCH_PP_CONTROL, pp);
846 POSTING_READ(PCH_PP_CONTROL);
847
01cb9ea6 848 pp |= PANEL_UNLOCK_REGS | POWER_TARGET_ON;
9934c132 849 I915_WRITE(PCH_PP_CONTROL, pp);
01cb9ea6 850 POSTING_READ(PCH_PP_CONTROL);
9934c132 851
01cb9ea6
JB
852 if (wait_for((I915_READ(PCH_PP_STATUS) & idle_on_mask) == idle_on_mask,
853 5000))
913d8d11
CW
854 DRM_ERROR("panel on wait timed out: 0x%08x\n",
855 I915_READ(PCH_PP_STATUS));
9934c132 856
37c6c9b0 857 pp |= PANEL_POWER_RESET; /* restore panel reset bit */
9934c132 858 I915_WRITE(PCH_PP_CONTROL, pp);
37c6c9b0 859 POSTING_READ(PCH_PP_CONTROL);
7eaf5547
JB
860
861 return false;
9934c132
JB
862}
863
864static void ironlake_edp_panel_off (struct drm_device *dev)
865{
866 struct drm_i915_private *dev_priv = dev->dev_private;
01cb9ea6
JB
867 u32 pp, idle_off_mask = PP_ON | PP_SEQUENCE_MASK |
868 PP_CYCLE_DELAY_ACTIVE | PP_SEQUENCE_STATE_MASK;
9934c132
JB
869
870 pp = I915_READ(PCH_PP_CONTROL);
37c6c9b0
JB
871
872 /* ILK workaround: disable reset around power sequence */
873 pp &= ~PANEL_POWER_RESET;
874 I915_WRITE(PCH_PP_CONTROL, pp);
875 POSTING_READ(PCH_PP_CONTROL);
876
9934c132
JB
877 pp &= ~POWER_TARGET_ON;
878 I915_WRITE(PCH_PP_CONTROL, pp);
01cb9ea6 879 POSTING_READ(PCH_PP_CONTROL);
9934c132 880
01cb9ea6 881 if (wait_for((I915_READ(PCH_PP_STATUS) & idle_off_mask) == 0, 5000))
913d8d11
CW
882 DRM_ERROR("panel off wait timed out: 0x%08x\n",
883 I915_READ(PCH_PP_STATUS));
9934c132 884
3969c9c9 885 pp |= PANEL_POWER_RESET; /* restore panel reset bit */
9934c132 886 I915_WRITE(PCH_PP_CONTROL, pp);
37c6c9b0 887 POSTING_READ(PCH_PP_CONTROL);
9934c132
JB
888}
889
f2b115e6 890static void ironlake_edp_backlight_on (struct drm_device *dev)
32f9d658
ZW
891{
892 struct drm_i915_private *dev_priv = dev->dev_private;
893 u32 pp;
894
28c97730 895 DRM_DEBUG_KMS("\n");
01cb9ea6
JB
896 /*
897 * If we enable the backlight right away following a panel power
898 * on, we may see slight flicker as the panel syncs with the eDP
899 * link. So delay a bit to make sure the image is solid before
900 * allowing it to appear.
901 */
902 msleep(300);
32f9d658
ZW
903 pp = I915_READ(PCH_PP_CONTROL);
904 pp |= EDP_BLC_ENABLE;
905 I915_WRITE(PCH_PP_CONTROL, pp);
906}
907
f2b115e6 908static void ironlake_edp_backlight_off (struct drm_device *dev)
32f9d658
ZW
909{
910 struct drm_i915_private *dev_priv = dev->dev_private;
911 u32 pp;
912
28c97730 913 DRM_DEBUG_KMS("\n");
32f9d658
ZW
914 pp = I915_READ(PCH_PP_CONTROL);
915 pp &= ~EDP_BLC_ENABLE;
916 I915_WRITE(PCH_PP_CONTROL, pp);
917}
a4fc5ed6 918
d240f20f
JB
919static void ironlake_edp_pll_on(struct drm_encoder *encoder)
920{
921 struct drm_device *dev = encoder->dev;
922 struct drm_i915_private *dev_priv = dev->dev_private;
923 u32 dpa_ctl;
924
925 DRM_DEBUG_KMS("\n");
926 dpa_ctl = I915_READ(DP_A);
298b0b39 927 dpa_ctl |= DP_PLL_ENABLE;
d240f20f 928 I915_WRITE(DP_A, dpa_ctl);
298b0b39
JB
929 POSTING_READ(DP_A);
930 udelay(200);
d240f20f
JB
931}
932
933static void ironlake_edp_pll_off(struct drm_encoder *encoder)
934{
935 struct drm_device *dev = encoder->dev;
936 struct drm_i915_private *dev_priv = dev->dev_private;
937 u32 dpa_ctl;
938
939 dpa_ctl = I915_READ(DP_A);
298b0b39 940 dpa_ctl &= ~DP_PLL_ENABLE;
d240f20f 941 I915_WRITE(DP_A, dpa_ctl);
1af5fa1b 942 POSTING_READ(DP_A);
d240f20f
JB
943 udelay(200);
944}
945
946static void intel_dp_prepare(struct drm_encoder *encoder)
947{
948 struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
949 struct drm_device *dev = encoder->dev;
d240f20f 950
4d926461 951 if (is_edp(intel_dp)) {
d240f20f 952 ironlake_edp_backlight_off(dev);
5d613501 953 ironlake_edp_panel_off(dev);
01cb9ea6
JB
954 if (!is_pch_edp(intel_dp))
955 ironlake_edp_pll_on(encoder);
956 else
957 ironlake_edp_pll_off(encoder);
d240f20f 958 }
736085bc 959 intel_dp_link_down(intel_dp);
d240f20f
JB
960}
961
962static void intel_dp_commit(struct drm_encoder *encoder)
963{
964 struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
965 struct drm_device *dev = encoder->dev;
d240f20f 966
5d613501
JB
967 if (is_edp(intel_dp))
968 ironlake_edp_panel_vdd_on(intel_dp);
969
33a34e4e
JB
970 intel_dp_start_link_train(intel_dp);
971
5d613501 972 if (is_edp(intel_dp)) {
01cb9ea6 973 ironlake_edp_panel_on(intel_dp);
5d613501
JB
974 ironlake_edp_panel_vdd_off(intel_dp);
975 }
33a34e4e
JB
976
977 intel_dp_complete_link_train(intel_dp);
978
4d926461 979 if (is_edp(intel_dp))
d240f20f
JB
980 ironlake_edp_backlight_on(dev);
981}
982
a4fc5ed6
KP
983static void
984intel_dp_dpms(struct drm_encoder *encoder, int mode)
985{
ea5b213a 986 struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
55f78c43 987 struct drm_device *dev = encoder->dev;
a4fc5ed6 988 struct drm_i915_private *dev_priv = dev->dev_private;
ea5b213a 989 uint32_t dp_reg = I915_READ(intel_dp->output_reg);
a4fc5ed6
KP
990
991 if (mode != DRM_MODE_DPMS_ON) {
01cb9ea6 992 if (is_edp(intel_dp))
7643a7fa 993 ironlake_edp_backlight_off(dev);
736085bc 994 intel_dp_link_down(intel_dp);
4d926461 995 if (is_edp(intel_dp))
01cb9ea6
JB
996 ironlake_edp_panel_off(dev);
997 if (is_edp(intel_dp) && !is_pch_edp(intel_dp))
d240f20f 998 ironlake_edp_pll_off(encoder);
a4fc5ed6 999 } else {
736085bc 1000 if (is_edp(intel_dp))
5d613501 1001 ironlake_edp_panel_vdd_on(intel_dp);
32f9d658 1002 if (!(dp_reg & DP_PORT_EN)) {
01cb9ea6 1003 intel_dp_start_link_train(intel_dp);
5d613501
JB
1004 if (is_edp(intel_dp)) {
1005 ironlake_edp_panel_on(intel_dp);
1006 ironlake_edp_panel_vdd_off(intel_dp);
1007 }
33a34e4e 1008 intel_dp_complete_link_train(intel_dp);
32f9d658 1009 }
736085bc
JB
1010 if (is_edp(intel_dp))
1011 ironlake_edp_backlight_on(dev);
a4fc5ed6 1012 }
ea5b213a 1013 intel_dp->dpms_mode = mode;
a4fc5ed6
KP
1014}
1015
1016/*
1017 * Fetch AUX CH registers 0x202 - 0x207 which contain
1018 * link status information
1019 */
1020static bool
33a34e4e 1021intel_dp_get_link_status(struct intel_dp *intel_dp)
a4fc5ed6
KP
1022{
1023 int ret;
1024
ea5b213a 1025 ret = intel_dp_aux_native_read(intel_dp,
a4fc5ed6 1026 DP_LANE0_1_STATUS,
33a34e4e 1027 intel_dp->link_status, DP_LINK_STATUS_SIZE);
a4fc5ed6
KP
1028 if (ret != DP_LINK_STATUS_SIZE)
1029 return false;
1030 return true;
1031}
1032
1033static uint8_t
1034intel_dp_link_status(uint8_t link_status[DP_LINK_STATUS_SIZE],
1035 int r)
1036{
1037 return link_status[r - DP_LANE0_1_STATUS];
1038}
1039
a4fc5ed6
KP
1040static uint8_t
1041intel_get_adjust_request_voltage(uint8_t link_status[DP_LINK_STATUS_SIZE],
1042 int lane)
1043{
1044 int i = DP_ADJUST_REQUEST_LANE0_1 + (lane >> 1);
1045 int s = ((lane & 1) ?
1046 DP_ADJUST_VOLTAGE_SWING_LANE1_SHIFT :
1047 DP_ADJUST_VOLTAGE_SWING_LANE0_SHIFT);
1048 uint8_t l = intel_dp_link_status(link_status, i);
1049
1050 return ((l >> s) & 3) << DP_TRAIN_VOLTAGE_SWING_SHIFT;
1051}
1052
1053static uint8_t
1054intel_get_adjust_request_pre_emphasis(uint8_t link_status[DP_LINK_STATUS_SIZE],
1055 int lane)
1056{
1057 int i = DP_ADJUST_REQUEST_LANE0_1 + (lane >> 1);
1058 int s = ((lane & 1) ?
1059 DP_ADJUST_PRE_EMPHASIS_LANE1_SHIFT :
1060 DP_ADJUST_PRE_EMPHASIS_LANE0_SHIFT);
1061 uint8_t l = intel_dp_link_status(link_status, i);
1062
1063 return ((l >> s) & 3) << DP_TRAIN_PRE_EMPHASIS_SHIFT;
1064}
1065
1066
1067#if 0
1068static char *voltage_names[] = {
1069 "0.4V", "0.6V", "0.8V", "1.2V"
1070};
1071static char *pre_emph_names[] = {
1072 "0dB", "3.5dB", "6dB", "9.5dB"
1073};
1074static char *link_train_names[] = {
1075 "pattern 1", "pattern 2", "idle", "off"
1076};
1077#endif
1078
1079/*
1080 * These are source-specific values; current Intel hardware supports
1081 * a maximum voltage of 800mV and a maximum pre-emphasis of 6dB
1082 */
1083#define I830_DP_VOLTAGE_MAX DP_TRAIN_VOLTAGE_SWING_800
1084
1085static uint8_t
1086intel_dp_pre_emphasis_max(uint8_t voltage_swing)
1087{
1088 switch (voltage_swing & DP_TRAIN_VOLTAGE_SWING_MASK) {
1089 case DP_TRAIN_VOLTAGE_SWING_400:
1090 return DP_TRAIN_PRE_EMPHASIS_6;
1091 case DP_TRAIN_VOLTAGE_SWING_600:
1092 return DP_TRAIN_PRE_EMPHASIS_6;
1093 case DP_TRAIN_VOLTAGE_SWING_800:
1094 return DP_TRAIN_PRE_EMPHASIS_3_5;
1095 case DP_TRAIN_VOLTAGE_SWING_1200:
1096 default:
1097 return DP_TRAIN_PRE_EMPHASIS_0;
1098 }
1099}
1100
1101static void
33a34e4e 1102intel_get_adjust_train(struct intel_dp *intel_dp)
a4fc5ed6
KP
1103{
1104 uint8_t v = 0;
1105 uint8_t p = 0;
1106 int lane;
1107
33a34e4e
JB
1108 for (lane = 0; lane < intel_dp->lane_count; lane++) {
1109 uint8_t this_v = intel_get_adjust_request_voltage(intel_dp->link_status, lane);
1110 uint8_t this_p = intel_get_adjust_request_pre_emphasis(intel_dp->link_status, lane);
a4fc5ed6
KP
1111
1112 if (this_v > v)
1113 v = this_v;
1114 if (this_p > p)
1115 p = this_p;
1116 }
1117
1118 if (v >= I830_DP_VOLTAGE_MAX)
1119 v = I830_DP_VOLTAGE_MAX | DP_TRAIN_MAX_SWING_REACHED;
1120
1121 if (p >= intel_dp_pre_emphasis_max(v))
1122 p = intel_dp_pre_emphasis_max(v) | DP_TRAIN_MAX_PRE_EMPHASIS_REACHED;
1123
1124 for (lane = 0; lane < 4; lane++)
33a34e4e 1125 intel_dp->train_set[lane] = v | p;
a4fc5ed6
KP
1126}
1127
1128static uint32_t
3cf2efb1 1129intel_dp_signal_levels(uint8_t train_set, int lane_count)
a4fc5ed6 1130{
3cf2efb1 1131 uint32_t signal_levels = 0;
a4fc5ed6 1132
3cf2efb1 1133 switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) {
a4fc5ed6
KP
1134 case DP_TRAIN_VOLTAGE_SWING_400:
1135 default:
1136 signal_levels |= DP_VOLTAGE_0_4;
1137 break;
1138 case DP_TRAIN_VOLTAGE_SWING_600:
1139 signal_levels |= DP_VOLTAGE_0_6;
1140 break;
1141 case DP_TRAIN_VOLTAGE_SWING_800:
1142 signal_levels |= DP_VOLTAGE_0_8;
1143 break;
1144 case DP_TRAIN_VOLTAGE_SWING_1200:
1145 signal_levels |= DP_VOLTAGE_1_2;
1146 break;
1147 }
3cf2efb1 1148 switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) {
a4fc5ed6
KP
1149 case DP_TRAIN_PRE_EMPHASIS_0:
1150 default:
1151 signal_levels |= DP_PRE_EMPHASIS_0;
1152 break;
1153 case DP_TRAIN_PRE_EMPHASIS_3_5:
1154 signal_levels |= DP_PRE_EMPHASIS_3_5;
1155 break;
1156 case DP_TRAIN_PRE_EMPHASIS_6:
1157 signal_levels |= DP_PRE_EMPHASIS_6;
1158 break;
1159 case DP_TRAIN_PRE_EMPHASIS_9_5:
1160 signal_levels |= DP_PRE_EMPHASIS_9_5;
1161 break;
1162 }
1163 return signal_levels;
1164}
1165
e3421a18
ZW
1166/* Gen6's DP voltage swing and pre-emphasis control */
1167static uint32_t
1168intel_gen6_edp_signal_levels(uint8_t train_set)
1169{
3c5a62b5
YL
1170 int signal_levels = train_set & (DP_TRAIN_VOLTAGE_SWING_MASK |
1171 DP_TRAIN_PRE_EMPHASIS_MASK);
1172 switch (signal_levels) {
e3421a18 1173 case DP_TRAIN_VOLTAGE_SWING_400 | DP_TRAIN_PRE_EMPHASIS_0:
3c5a62b5
YL
1174 case DP_TRAIN_VOLTAGE_SWING_600 | DP_TRAIN_PRE_EMPHASIS_0:
1175 return EDP_LINK_TRAIN_400_600MV_0DB_SNB_B;
1176 case DP_TRAIN_VOLTAGE_SWING_400 | DP_TRAIN_PRE_EMPHASIS_3_5:
1177 return EDP_LINK_TRAIN_400MV_3_5DB_SNB_B;
e3421a18 1178 case DP_TRAIN_VOLTAGE_SWING_400 | DP_TRAIN_PRE_EMPHASIS_6:
3c5a62b5
YL
1179 case DP_TRAIN_VOLTAGE_SWING_600 | DP_TRAIN_PRE_EMPHASIS_6:
1180 return EDP_LINK_TRAIN_400_600MV_6DB_SNB_B;
e3421a18 1181 case DP_TRAIN_VOLTAGE_SWING_600 | DP_TRAIN_PRE_EMPHASIS_3_5:
3c5a62b5
YL
1182 case DP_TRAIN_VOLTAGE_SWING_800 | DP_TRAIN_PRE_EMPHASIS_3_5:
1183 return EDP_LINK_TRAIN_600_800MV_3_5DB_SNB_B;
e3421a18 1184 case DP_TRAIN_VOLTAGE_SWING_800 | DP_TRAIN_PRE_EMPHASIS_0:
3c5a62b5
YL
1185 case DP_TRAIN_VOLTAGE_SWING_1200 | DP_TRAIN_PRE_EMPHASIS_0:
1186 return EDP_LINK_TRAIN_800_1200MV_0DB_SNB_B;
e3421a18 1187 default:
3c5a62b5
YL
1188 DRM_DEBUG_KMS("Unsupported voltage swing/pre-emphasis level:"
1189 "0x%x\n", signal_levels);
1190 return EDP_LINK_TRAIN_400_600MV_0DB_SNB_B;
e3421a18
ZW
1191 }
1192}
1193
a4fc5ed6
KP
1194static uint8_t
1195intel_get_lane_status(uint8_t link_status[DP_LINK_STATUS_SIZE],
1196 int lane)
1197{
1198 int i = DP_LANE0_1_STATUS + (lane >> 1);
1199 int s = (lane & 1) * 4;
1200 uint8_t l = intel_dp_link_status(link_status, i);
1201
1202 return (l >> s) & 0xf;
1203}
1204
1205/* Check for clock recovery is done on all channels */
1206static bool
1207intel_clock_recovery_ok(uint8_t link_status[DP_LINK_STATUS_SIZE], int lane_count)
1208{
1209 int lane;
1210 uint8_t lane_status;
1211
1212 for (lane = 0; lane < lane_count; lane++) {
1213 lane_status = intel_get_lane_status(link_status, lane);
1214 if ((lane_status & DP_LANE_CR_DONE) == 0)
1215 return false;
1216 }
1217 return true;
1218}
1219
1220/* Check to see if channel eq is done on all channels */
1221#define CHANNEL_EQ_BITS (DP_LANE_CR_DONE|\
1222 DP_LANE_CHANNEL_EQ_DONE|\
1223 DP_LANE_SYMBOL_LOCKED)
1224static bool
33a34e4e 1225intel_channel_eq_ok(struct intel_dp *intel_dp)
a4fc5ed6
KP
1226{
1227 uint8_t lane_align;
1228 uint8_t lane_status;
1229 int lane;
1230
33a34e4e 1231 lane_align = intel_dp_link_status(intel_dp->link_status,
a4fc5ed6
KP
1232 DP_LANE_ALIGN_STATUS_UPDATED);
1233 if ((lane_align & DP_INTERLANE_ALIGN_DONE) == 0)
1234 return false;
33a34e4e
JB
1235 for (lane = 0; lane < intel_dp->lane_count; lane++) {
1236 lane_status = intel_get_lane_status(intel_dp->link_status, lane);
a4fc5ed6
KP
1237 if ((lane_status & CHANNEL_EQ_BITS) != CHANNEL_EQ_BITS)
1238 return false;
1239 }
1240 return true;
1241}
1242
1243static bool
ea5b213a 1244intel_dp_set_link_train(struct intel_dp *intel_dp,
a4fc5ed6 1245 uint32_t dp_reg_value,
58e10eb9 1246 uint8_t dp_train_pat)
a4fc5ed6 1247{
4ef69c7a 1248 struct drm_device *dev = intel_dp->base.base.dev;
a4fc5ed6 1249 struct drm_i915_private *dev_priv = dev->dev_private;
a4fc5ed6
KP
1250 int ret;
1251
ea5b213a
CW
1252 I915_WRITE(intel_dp->output_reg, dp_reg_value);
1253 POSTING_READ(intel_dp->output_reg);
a4fc5ed6 1254
ea5b213a 1255 intel_dp_aux_native_write_1(intel_dp,
a4fc5ed6
KP
1256 DP_TRAINING_PATTERN_SET,
1257 dp_train_pat);
1258
ea5b213a 1259 ret = intel_dp_aux_native_write(intel_dp,
58e10eb9
CW
1260 DP_TRAINING_LANE0_SET,
1261 intel_dp->train_set, 4);
a4fc5ed6
KP
1262 if (ret != 4)
1263 return false;
1264
1265 return true;
1266}
1267
33a34e4e 1268/* Enable corresponding port and start training pattern 1 */
a4fc5ed6 1269static void
33a34e4e 1270intel_dp_start_link_train(struct intel_dp *intel_dp)
a4fc5ed6 1271{
4ef69c7a 1272 struct drm_device *dev = intel_dp->base.base.dev;
a4fc5ed6 1273 struct drm_i915_private *dev_priv = dev->dev_private;
58e10eb9 1274 struct intel_crtc *intel_crtc = to_intel_crtc(intel_dp->base.base.crtc);
a4fc5ed6
KP
1275 int i;
1276 uint8_t voltage;
1277 bool clock_recovery = false;
a4fc5ed6 1278 int tries;
e3421a18 1279 u32 reg;
ea5b213a 1280 uint32_t DP = intel_dp->DP;
a4fc5ed6 1281
b99a9d9b
KP
1282 /* Enable output, wait for it to become active */
1283 I915_WRITE(intel_dp->output_reg, intel_dp->DP);
1284 POSTING_READ(intel_dp->output_reg);
1285 intel_wait_for_vblank(dev, intel_crtc->pipe);
a4fc5ed6 1286
3cf2efb1
CW
1287 /* Write the link configuration data */
1288 intel_dp_aux_native_write(intel_dp, DP_LINK_BW_SET,
1289 intel_dp->link_configuration,
1290 DP_LINK_CONFIGURATION_SIZE);
a4fc5ed6
KP
1291
1292 DP |= DP_PORT_EN;
cfcb0fc9 1293 if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
e3421a18
ZW
1294 DP &= ~DP_LINK_TRAIN_MASK_CPT;
1295 else
1296 DP &= ~DP_LINK_TRAIN_MASK;
33a34e4e 1297 memset(intel_dp->train_set, 0, 4);
a4fc5ed6
KP
1298 voltage = 0xff;
1299 tries = 0;
1300 clock_recovery = false;
1301 for (;;) {
33a34e4e 1302 /* Use intel_dp->train_set[0] to set the voltage and pre emphasis values */
e3421a18 1303 uint32_t signal_levels;
cfcb0fc9 1304 if (IS_GEN6(dev) && is_edp(intel_dp)) {
33a34e4e 1305 signal_levels = intel_gen6_edp_signal_levels(intel_dp->train_set[0]);
e3421a18
ZW
1306 DP = (DP & ~EDP_LINK_TRAIN_VOL_EMP_MASK_SNB) | signal_levels;
1307 } else {
3cf2efb1 1308 signal_levels = intel_dp_signal_levels(intel_dp->train_set[0], intel_dp->lane_count);
e3421a18
ZW
1309 DP = (DP & ~(DP_VOLTAGE_MASK|DP_PRE_EMPHASIS_MASK)) | signal_levels;
1310 }
a4fc5ed6 1311
cfcb0fc9 1312 if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
e3421a18
ZW
1313 reg = DP | DP_LINK_TRAIN_PAT_1_CPT;
1314 else
1315 reg = DP | DP_LINK_TRAIN_PAT_1;
1316
ea5b213a 1317 if (!intel_dp_set_link_train(intel_dp, reg,
58e10eb9 1318 DP_TRAINING_PATTERN_1))
a4fc5ed6 1319 break;
a4fc5ed6
KP
1320 /* Set training pattern 1 */
1321
3cf2efb1
CW
1322 udelay(100);
1323 if (!intel_dp_get_link_status(intel_dp))
a4fc5ed6 1324 break;
a4fc5ed6 1325
3cf2efb1
CW
1326 if (intel_clock_recovery_ok(intel_dp->link_status, intel_dp->lane_count)) {
1327 clock_recovery = true;
1328 break;
1329 }
1330
1331 /* Check to see if we've tried the max voltage */
1332 for (i = 0; i < intel_dp->lane_count; i++)
1333 if ((intel_dp->train_set[i] & DP_TRAIN_MAX_SWING_REACHED) == 0)
a4fc5ed6 1334 break;
3cf2efb1
CW
1335 if (i == intel_dp->lane_count)
1336 break;
a4fc5ed6 1337
3cf2efb1
CW
1338 /* Check to see if we've tried the same voltage 5 times */
1339 if ((intel_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK) == voltage) {
1340 ++tries;
1341 if (tries == 5)
a4fc5ed6 1342 break;
3cf2efb1
CW
1343 } else
1344 tries = 0;
1345 voltage = intel_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK;
a4fc5ed6 1346
3cf2efb1
CW
1347 /* Compute new intel_dp->train_set as requested by target */
1348 intel_get_adjust_train(intel_dp);
a4fc5ed6
KP
1349 }
1350
33a34e4e
JB
1351 intel_dp->DP = DP;
1352}
1353
1354static void
1355intel_dp_complete_link_train(struct intel_dp *intel_dp)
1356{
4ef69c7a 1357 struct drm_device *dev = intel_dp->base.base.dev;
33a34e4e
JB
1358 struct drm_i915_private *dev_priv = dev->dev_private;
1359 bool channel_eq = false;
37f80975 1360 int tries, cr_tries;
33a34e4e
JB
1361 u32 reg;
1362 uint32_t DP = intel_dp->DP;
1363
a4fc5ed6
KP
1364 /* channel equalization */
1365 tries = 0;
37f80975 1366 cr_tries = 0;
a4fc5ed6
KP
1367 channel_eq = false;
1368 for (;;) {
33a34e4e 1369 /* Use intel_dp->train_set[0] to set the voltage and pre emphasis values */
e3421a18
ZW
1370 uint32_t signal_levels;
1371
37f80975
JB
1372 if (cr_tries > 5) {
1373 DRM_ERROR("failed to train DP, aborting\n");
1374 intel_dp_link_down(intel_dp);
1375 break;
1376 }
1377
cfcb0fc9 1378 if (IS_GEN6(dev) && is_edp(intel_dp)) {
33a34e4e 1379 signal_levels = intel_gen6_edp_signal_levels(intel_dp->train_set[0]);
e3421a18
ZW
1380 DP = (DP & ~EDP_LINK_TRAIN_VOL_EMP_MASK_SNB) | signal_levels;
1381 } else {
3cf2efb1 1382 signal_levels = intel_dp_signal_levels(intel_dp->train_set[0], intel_dp->lane_count);
e3421a18
ZW
1383 DP = (DP & ~(DP_VOLTAGE_MASK|DP_PRE_EMPHASIS_MASK)) | signal_levels;
1384 }
1385
cfcb0fc9 1386 if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
e3421a18
ZW
1387 reg = DP | DP_LINK_TRAIN_PAT_2_CPT;
1388 else
1389 reg = DP | DP_LINK_TRAIN_PAT_2;
a4fc5ed6
KP
1390
1391 /* channel eq pattern */
ea5b213a 1392 if (!intel_dp_set_link_train(intel_dp, reg,
58e10eb9 1393 DP_TRAINING_PATTERN_2))
a4fc5ed6
KP
1394 break;
1395
3cf2efb1
CW
1396 udelay(400);
1397 if (!intel_dp_get_link_status(intel_dp))
a4fc5ed6 1398 break;
a4fc5ed6 1399
37f80975
JB
1400 /* Make sure clock is still ok */
1401 if (!intel_clock_recovery_ok(intel_dp->link_status, intel_dp->lane_count)) {
1402 intel_dp_start_link_train(intel_dp);
1403 cr_tries++;
1404 continue;
1405 }
1406
3cf2efb1
CW
1407 if (intel_channel_eq_ok(intel_dp)) {
1408 channel_eq = true;
1409 break;
1410 }
a4fc5ed6 1411
37f80975
JB
1412 /* Try 5 times, then try clock recovery if that fails */
1413 if (tries > 5) {
1414 intel_dp_link_down(intel_dp);
1415 intel_dp_start_link_train(intel_dp);
1416 tries = 0;
1417 cr_tries++;
1418 continue;
1419 }
a4fc5ed6 1420
3cf2efb1
CW
1421 /* Compute new intel_dp->train_set as requested by target */
1422 intel_get_adjust_train(intel_dp);
1423 ++tries;
869184a6 1424 }
3cf2efb1 1425
cfcb0fc9 1426 if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
e3421a18
ZW
1427 reg = DP | DP_LINK_TRAIN_OFF_CPT;
1428 else
1429 reg = DP | DP_LINK_TRAIN_OFF;
1430
ea5b213a
CW
1431 I915_WRITE(intel_dp->output_reg, reg);
1432 POSTING_READ(intel_dp->output_reg);
1433 intel_dp_aux_native_write_1(intel_dp,
a4fc5ed6
KP
1434 DP_TRAINING_PATTERN_SET, DP_TRAINING_PATTERN_DISABLE);
1435}
1436
1437static void
ea5b213a 1438intel_dp_link_down(struct intel_dp *intel_dp)
a4fc5ed6 1439{
4ef69c7a 1440 struct drm_device *dev = intel_dp->base.base.dev;
a4fc5ed6 1441 struct drm_i915_private *dev_priv = dev->dev_private;
ea5b213a 1442 uint32_t DP = intel_dp->DP;
a4fc5ed6 1443
1b39d6f3
CW
1444 if ((I915_READ(intel_dp->output_reg) & DP_PORT_EN) == 0)
1445 return;
1446
28c97730 1447 DRM_DEBUG_KMS("\n");
32f9d658 1448
cfcb0fc9 1449 if (is_edp(intel_dp)) {
32f9d658 1450 DP &= ~DP_PLL_ENABLE;
ea5b213a
CW
1451 I915_WRITE(intel_dp->output_reg, DP);
1452 POSTING_READ(intel_dp->output_reg);
32f9d658
ZW
1453 udelay(100);
1454 }
1455
cfcb0fc9 1456 if (HAS_PCH_CPT(dev) && !is_edp(intel_dp)) {
e3421a18 1457 DP &= ~DP_LINK_TRAIN_MASK_CPT;
ea5b213a 1458 I915_WRITE(intel_dp->output_reg, DP | DP_LINK_TRAIN_PAT_IDLE_CPT);
e3421a18
ZW
1459 } else {
1460 DP &= ~DP_LINK_TRAIN_MASK;
ea5b213a 1461 I915_WRITE(intel_dp->output_reg, DP | DP_LINK_TRAIN_PAT_IDLE);
e3421a18 1462 }
fe255d00 1463 POSTING_READ(intel_dp->output_reg);
5eb08b69 1464
fe255d00 1465 msleep(17);
5eb08b69 1466
cfcb0fc9 1467 if (is_edp(intel_dp))
32f9d658 1468 DP |= DP_LINK_TRAIN_OFF;
5bddd17f 1469
1b39d6f3
CW
1470 if (!HAS_PCH_CPT(dev) &&
1471 I915_READ(intel_dp->output_reg) & DP_PIPEB_SELECT) {
160b1543 1472 struct intel_crtc *intel_crtc = to_intel_crtc(intel_dp->base.base.crtc);
5bddd17f
EA
1473 /* Hardware workaround: leaving our transcoder select
1474 * set to transcoder B while it's off will prevent the
1475 * corresponding HDMI output on transcoder A.
1476 *
1477 * Combine this with another hardware workaround:
1478 * transcoder select bit can only be cleared while the
1479 * port is enabled.
1480 */
1481 DP &= ~DP_PIPEB_SELECT;
1482 I915_WRITE(intel_dp->output_reg, DP);
1483
1484 /* Changes to enable or select take place the vblank
1485 * after being written.
1486 */
160b1543 1487 intel_wait_for_vblank(dev, intel_crtc->pipe);
5bddd17f
EA
1488 }
1489
ea5b213a
CW
1490 I915_WRITE(intel_dp->output_reg, DP & ~DP_PORT_EN);
1491 POSTING_READ(intel_dp->output_reg);
a4fc5ed6
KP
1492}
1493
a4fc5ed6
KP
1494/*
1495 * According to DP spec
1496 * 5.1.2:
1497 * 1. Read DPCD
1498 * 2. Configure link according to Receiver Capabilities
1499 * 3. Use Link Training from 2.5.3.3 and 3.5.1.3
1500 * 4. Check link status on receipt of hot-plug interrupt
1501 */
1502
1503static void
ea5b213a 1504intel_dp_check_link_status(struct intel_dp *intel_dp)
a4fc5ed6 1505{
4ef69c7a 1506 if (!intel_dp->base.base.crtc)
a4fc5ed6
KP
1507 return;
1508
33a34e4e 1509 if (!intel_dp_get_link_status(intel_dp)) {
ea5b213a 1510 intel_dp_link_down(intel_dp);
a4fc5ed6
KP
1511 return;
1512 }
1513
33a34e4e
JB
1514 if (!intel_channel_eq_ok(intel_dp)) {
1515 intel_dp_start_link_train(intel_dp);
1516 intel_dp_complete_link_train(intel_dp);
1517 }
a4fc5ed6 1518}
a4fc5ed6 1519
5eb08b69 1520static enum drm_connector_status
a9756bb5 1521ironlake_dp_detect(struct intel_dp *intel_dp)
5eb08b69 1522{
5eb08b69
ZW
1523 enum drm_connector_status status;
1524
fe16d949
CW
1525 /* Can't disconnect eDP, but you can close the lid... */
1526 if (is_edp(intel_dp)) {
1527 status = intel_panel_detect(intel_dp->base.base.dev);
1528 if (status == connector_status_unknown)
1529 status = connector_status_connected;
1530 return status;
1531 }
01cb9ea6 1532
5eb08b69 1533 status = connector_status_disconnected;
ea5b213a
CW
1534 if (intel_dp_aux_native_read(intel_dp,
1535 0x000, intel_dp->dpcd,
a9756bb5
ZW
1536 sizeof (intel_dp->dpcd))
1537 == sizeof(intel_dp->dpcd)) {
ea5b213a 1538 if (intel_dp->dpcd[0] != 0)
5eb08b69
ZW
1539 status = connector_status_connected;
1540 }
ea5b213a
CW
1541 DRM_DEBUG_KMS("DPCD: %hx%hx%hx%hx\n", intel_dp->dpcd[0],
1542 intel_dp->dpcd[1], intel_dp->dpcd[2], intel_dp->dpcd[3]);
5eb08b69
ZW
1543 return status;
1544}
1545
a4fc5ed6 1546static enum drm_connector_status
a9756bb5 1547g4x_dp_detect(struct intel_dp *intel_dp)
a4fc5ed6 1548{
4ef69c7a 1549 struct drm_device *dev = intel_dp->base.base.dev;
a4fc5ed6 1550 struct drm_i915_private *dev_priv = dev->dev_private;
a4fc5ed6 1551 enum drm_connector_status status;
a9756bb5 1552 uint32_t temp, bit;
5eb08b69 1553
ea5b213a 1554 switch (intel_dp->output_reg) {
a4fc5ed6
KP
1555 case DP_B:
1556 bit = DPB_HOTPLUG_INT_STATUS;
1557 break;
1558 case DP_C:
1559 bit = DPC_HOTPLUG_INT_STATUS;
1560 break;
1561 case DP_D:
1562 bit = DPD_HOTPLUG_INT_STATUS;
1563 break;
1564 default:
1565 return connector_status_unknown;
1566 }
1567
1568 temp = I915_READ(PORT_HOTPLUG_STAT);
1569
1570 if ((temp & bit) == 0)
1571 return connector_status_disconnected;
1572
1573 status = connector_status_disconnected;
a9756bb5 1574 if (intel_dp_aux_native_read(intel_dp, 0x000, intel_dp->dpcd,
ea5b213a 1575 sizeof (intel_dp->dpcd)) == sizeof (intel_dp->dpcd))
a4fc5ed6 1576 {
ea5b213a 1577 if (intel_dp->dpcd[0] != 0)
a4fc5ed6
KP
1578 status = connector_status_connected;
1579 }
a9756bb5 1580
dd2b379f 1581 return status;
a9756bb5
ZW
1582}
1583
1584/**
1585 * Uses CRT_HOTPLUG_EN and CRT_HOTPLUG_STAT to detect DP connection.
1586 *
1587 * \return true if DP port is connected.
1588 * \return false if DP port is disconnected.
1589 */
1590static enum drm_connector_status
1591intel_dp_detect(struct drm_connector *connector, bool force)
1592{
1593 struct intel_dp *intel_dp = intel_attached_dp(connector);
1594 struct drm_device *dev = intel_dp->base.base.dev;
1595 enum drm_connector_status status;
1596 struct edid *edid = NULL;
1597
1598 intel_dp->has_audio = false;
1599
1600 if (HAS_PCH_SPLIT(dev))
1601 status = ironlake_dp_detect(intel_dp);
1602 else
1603 status = g4x_dp_detect(intel_dp);
1604 if (status != connector_status_connected)
1605 return status;
1606
f684960e
CW
1607 if (intel_dp->force_audio) {
1608 intel_dp->has_audio = intel_dp->force_audio > 0;
1609 } else {
1610 edid = drm_get_edid(connector, &intel_dp->adapter);
1611 if (edid) {
1612 intel_dp->has_audio = drm_detect_monitor_audio(edid);
1613 connector->display_info.raw_edid = NULL;
1614 kfree(edid);
1615 }
a9756bb5
ZW
1616 }
1617
1618 return connector_status_connected;
a4fc5ed6
KP
1619}
1620
1621static int intel_dp_get_modes(struct drm_connector *connector)
1622{
df0e9248 1623 struct intel_dp *intel_dp = intel_attached_dp(connector);
4ef69c7a 1624 struct drm_device *dev = intel_dp->base.base.dev;
32f9d658
ZW
1625 struct drm_i915_private *dev_priv = dev->dev_private;
1626 int ret;
a4fc5ed6
KP
1627
1628 /* We should parse the EDID data and find out if it has an audio sink
1629 */
1630
f899fc64 1631 ret = intel_ddc_get_modes(connector, &intel_dp->adapter);
b9efc480 1632 if (ret) {
4d926461 1633 if (is_edp(intel_dp) && !dev_priv->panel_fixed_mode) {
b9efc480
ZY
1634 struct drm_display_mode *newmode;
1635 list_for_each_entry(newmode, &connector->probed_modes,
1636 head) {
1637 if (newmode->type & DRM_MODE_TYPE_PREFERRED) {
1638 dev_priv->panel_fixed_mode =
1639 drm_mode_duplicate(dev, newmode);
1640 break;
1641 }
1642 }
1643 }
1644
32f9d658 1645 return ret;
b9efc480 1646 }
32f9d658
ZW
1647
1648 /* if eDP has no EDID, try to use fixed panel mode from VBT */
4d926461 1649 if (is_edp(intel_dp)) {
32f9d658
ZW
1650 if (dev_priv->panel_fixed_mode != NULL) {
1651 struct drm_display_mode *mode;
1652 mode = drm_mode_duplicate(dev, dev_priv->panel_fixed_mode);
1653 drm_mode_probed_add(connector, mode);
1654 return 1;
1655 }
1656 }
1657 return 0;
a4fc5ed6
KP
1658}
1659
1aad7ac0
CW
1660static bool
1661intel_dp_detect_audio(struct drm_connector *connector)
1662{
1663 struct intel_dp *intel_dp = intel_attached_dp(connector);
1664 struct edid *edid;
1665 bool has_audio = false;
1666
1667 edid = drm_get_edid(connector, &intel_dp->adapter);
1668 if (edid) {
1669 has_audio = drm_detect_monitor_audio(edid);
1670
1671 connector->display_info.raw_edid = NULL;
1672 kfree(edid);
1673 }
1674
1675 return has_audio;
1676}
1677
f684960e
CW
1678static int
1679intel_dp_set_property(struct drm_connector *connector,
1680 struct drm_property *property,
1681 uint64_t val)
1682{
1683 struct intel_dp *intel_dp = intel_attached_dp(connector);
1684 int ret;
1685
1686 ret = drm_connector_property_set_value(connector, property, val);
1687 if (ret)
1688 return ret;
1689
1690 if (property == intel_dp->force_audio_property) {
1aad7ac0
CW
1691 int i = val;
1692 bool has_audio;
1693
1694 if (i == intel_dp->force_audio)
f684960e
CW
1695 return 0;
1696
1aad7ac0 1697 intel_dp->force_audio = i;
f684960e 1698
1aad7ac0
CW
1699 if (i == 0)
1700 has_audio = intel_dp_detect_audio(connector);
1701 else
1702 has_audio = i > 0;
1703
1704 if (has_audio == intel_dp->has_audio)
f684960e
CW
1705 return 0;
1706
1aad7ac0 1707 intel_dp->has_audio = has_audio;
f684960e
CW
1708 goto done;
1709 }
1710
1711 return -EINVAL;
1712
1713done:
1714 if (intel_dp->base.base.crtc) {
1715 struct drm_crtc *crtc = intel_dp->base.base.crtc;
1716 drm_crtc_helper_set_mode(crtc, &crtc->mode,
1717 crtc->x, crtc->y,
1718 crtc->fb);
1719 }
1720
1721 return 0;
1722}
1723
a4fc5ed6
KP
1724static void
1725intel_dp_destroy (struct drm_connector *connector)
1726{
a4fc5ed6
KP
1727 drm_sysfs_connector_remove(connector);
1728 drm_connector_cleanup(connector);
55f78c43 1729 kfree(connector);
a4fc5ed6
KP
1730}
1731
24d05927
DV
1732static void intel_dp_encoder_destroy(struct drm_encoder *encoder)
1733{
1734 struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
1735
1736 i2c_del_adapter(&intel_dp->adapter);
1737 drm_encoder_cleanup(encoder);
1738 kfree(intel_dp);
1739}
1740
a4fc5ed6
KP
1741static const struct drm_encoder_helper_funcs intel_dp_helper_funcs = {
1742 .dpms = intel_dp_dpms,
1743 .mode_fixup = intel_dp_mode_fixup,
d240f20f 1744 .prepare = intel_dp_prepare,
a4fc5ed6 1745 .mode_set = intel_dp_mode_set,
d240f20f 1746 .commit = intel_dp_commit,
a4fc5ed6
KP
1747};
1748
1749static const struct drm_connector_funcs intel_dp_connector_funcs = {
1750 .dpms = drm_helper_connector_dpms,
a4fc5ed6
KP
1751 .detect = intel_dp_detect,
1752 .fill_modes = drm_helper_probe_single_connector_modes,
f684960e 1753 .set_property = intel_dp_set_property,
a4fc5ed6
KP
1754 .destroy = intel_dp_destroy,
1755};
1756
1757static const struct drm_connector_helper_funcs intel_dp_connector_helper_funcs = {
1758 .get_modes = intel_dp_get_modes,
1759 .mode_valid = intel_dp_mode_valid,
df0e9248 1760 .best_encoder = intel_best_encoder,
a4fc5ed6
KP
1761};
1762
a4fc5ed6 1763static const struct drm_encoder_funcs intel_dp_enc_funcs = {
24d05927 1764 .destroy = intel_dp_encoder_destroy,
a4fc5ed6
KP
1765};
1766
995b6762 1767static void
21d40d37 1768intel_dp_hot_plug(struct intel_encoder *intel_encoder)
c8110e52 1769{
ea5b213a 1770 struct intel_dp *intel_dp = container_of(intel_encoder, struct intel_dp, base);
c8110e52 1771
ea5b213a
CW
1772 if (intel_dp->dpms_mode == DRM_MODE_DPMS_ON)
1773 intel_dp_check_link_status(intel_dp);
c8110e52 1774}
6207937d 1775
e3421a18
ZW
1776/* Return which DP Port should be selected for Transcoder DP control */
1777int
1778intel_trans_dp_port_sel (struct drm_crtc *crtc)
1779{
1780 struct drm_device *dev = crtc->dev;
1781 struct drm_mode_config *mode_config = &dev->mode_config;
1782 struct drm_encoder *encoder;
e3421a18
ZW
1783
1784 list_for_each_entry(encoder, &mode_config->encoder_list, head) {
ea5b213a
CW
1785 struct intel_dp *intel_dp;
1786
d8201ab6 1787 if (encoder->crtc != crtc)
e3421a18
ZW
1788 continue;
1789
ea5b213a
CW
1790 intel_dp = enc_to_intel_dp(encoder);
1791 if (intel_dp->base.type == INTEL_OUTPUT_DISPLAYPORT)
1792 return intel_dp->output_reg;
e3421a18 1793 }
ea5b213a 1794
e3421a18
ZW
1795 return -1;
1796}
1797
36e83a18 1798/* check the VBT to see whether the eDP is on DP-D port */
cb0953d7 1799bool intel_dpd_is_edp(struct drm_device *dev)
36e83a18
ZY
1800{
1801 struct drm_i915_private *dev_priv = dev->dev_private;
1802 struct child_device_config *p_child;
1803 int i;
1804
1805 if (!dev_priv->child_dev_num)
1806 return false;
1807
1808 for (i = 0; i < dev_priv->child_dev_num; i++) {
1809 p_child = dev_priv->child_dev + i;
1810
1811 if (p_child->dvo_port == PORT_IDPD &&
1812 p_child->device_type == DEVICE_TYPE_eDP)
1813 return true;
1814 }
1815 return false;
1816}
1817
f684960e
CW
1818static void
1819intel_dp_add_properties(struct intel_dp *intel_dp, struct drm_connector *connector)
1820{
1821 struct drm_device *dev = connector->dev;
1822
1823 intel_dp->force_audio_property =
1824 drm_property_create(dev, DRM_MODE_PROP_RANGE, "force_audio", 2);
1825 if (intel_dp->force_audio_property) {
1826 intel_dp->force_audio_property->values[0] = -1;
1827 intel_dp->force_audio_property->values[1] = 1;
1828 drm_connector_attach_property(connector, intel_dp->force_audio_property, 0);
1829 }
1830}
1831
a4fc5ed6
KP
1832void
1833intel_dp_init(struct drm_device *dev, int output_reg)
1834{
1835 struct drm_i915_private *dev_priv = dev->dev_private;
1836 struct drm_connector *connector;
ea5b213a 1837 struct intel_dp *intel_dp;
21d40d37 1838 struct intel_encoder *intel_encoder;
55f78c43 1839 struct intel_connector *intel_connector;
5eb08b69 1840 const char *name = NULL;
b329530c 1841 int type;
a4fc5ed6 1842
ea5b213a
CW
1843 intel_dp = kzalloc(sizeof(struct intel_dp), GFP_KERNEL);
1844 if (!intel_dp)
a4fc5ed6
KP
1845 return;
1846
55f78c43
ZW
1847 intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
1848 if (!intel_connector) {
ea5b213a 1849 kfree(intel_dp);
55f78c43
ZW
1850 return;
1851 }
ea5b213a 1852 intel_encoder = &intel_dp->base;
55f78c43 1853
ea5b213a 1854 if (HAS_PCH_SPLIT(dev) && output_reg == PCH_DP_D)
b329530c 1855 if (intel_dpd_is_edp(dev))
ea5b213a 1856 intel_dp->is_pch_edp = true;
b329530c 1857
cfcb0fc9 1858 if (output_reg == DP_A || is_pch_edp(intel_dp)) {
b329530c
AJ
1859 type = DRM_MODE_CONNECTOR_eDP;
1860 intel_encoder->type = INTEL_OUTPUT_EDP;
1861 } else {
1862 type = DRM_MODE_CONNECTOR_DisplayPort;
1863 intel_encoder->type = INTEL_OUTPUT_DISPLAYPORT;
1864 }
1865
55f78c43 1866 connector = &intel_connector->base;
b329530c 1867 drm_connector_init(dev, connector, &intel_dp_connector_funcs, type);
a4fc5ed6
KP
1868 drm_connector_helper_add(connector, &intel_dp_connector_helper_funcs);
1869
eb1f8e4f
DA
1870 connector->polled = DRM_CONNECTOR_POLL_HPD;
1871
652af9d7 1872 if (output_reg == DP_B || output_reg == PCH_DP_B)
21d40d37 1873 intel_encoder->clone_mask = (1 << INTEL_DP_B_CLONE_BIT);
652af9d7 1874 else if (output_reg == DP_C || output_reg == PCH_DP_C)
21d40d37 1875 intel_encoder->clone_mask = (1 << INTEL_DP_C_CLONE_BIT);
652af9d7 1876 else if (output_reg == DP_D || output_reg == PCH_DP_D)
21d40d37 1877 intel_encoder->clone_mask = (1 << INTEL_DP_D_CLONE_BIT);
f8aed700 1878
cfcb0fc9 1879 if (is_edp(intel_dp))
21d40d37 1880 intel_encoder->clone_mask = (1 << INTEL_EDP_CLONE_BIT);
6251ec0a 1881
21d40d37 1882 intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
a4fc5ed6
KP
1883 connector->interlace_allowed = true;
1884 connector->doublescan_allowed = 0;
1885
ea5b213a
CW
1886 intel_dp->output_reg = output_reg;
1887 intel_dp->has_audio = false;
1888 intel_dp->dpms_mode = DRM_MODE_DPMS_ON;
a4fc5ed6 1889
4ef69c7a 1890 drm_encoder_init(dev, &intel_encoder->base, &intel_dp_enc_funcs,
a4fc5ed6 1891 DRM_MODE_ENCODER_TMDS);
4ef69c7a 1892 drm_encoder_helper_add(&intel_encoder->base, &intel_dp_helper_funcs);
a4fc5ed6 1893
df0e9248 1894 intel_connector_attach_encoder(intel_connector, intel_encoder);
a4fc5ed6
KP
1895 drm_sysfs_connector_add(connector);
1896
1897 /* Set up the DDC bus. */
5eb08b69 1898 switch (output_reg) {
32f9d658
ZW
1899 case DP_A:
1900 name = "DPDDC-A";
1901 break;
5eb08b69
ZW
1902 case DP_B:
1903 case PCH_DP_B:
b01f2c3a
JB
1904 dev_priv->hotplug_supported_mask |=
1905 HDMIB_HOTPLUG_INT_STATUS;
5eb08b69
ZW
1906 name = "DPDDC-B";
1907 break;
1908 case DP_C:
1909 case PCH_DP_C:
b01f2c3a
JB
1910 dev_priv->hotplug_supported_mask |=
1911 HDMIC_HOTPLUG_INT_STATUS;
5eb08b69
ZW
1912 name = "DPDDC-C";
1913 break;
1914 case DP_D:
1915 case PCH_DP_D:
b01f2c3a
JB
1916 dev_priv->hotplug_supported_mask |=
1917 HDMID_HOTPLUG_INT_STATUS;
5eb08b69
ZW
1918 name = "DPDDC-D";
1919 break;
1920 }
1921
ea5b213a 1922 intel_dp_i2c_init(intel_dp, intel_connector, name);
32f9d658 1923
89667383
JB
1924 /* Cache some DPCD data in the eDP case */
1925 if (is_edp(intel_dp)) {
1926 int ret;
5d613501
JB
1927 u32 pp_on, pp_div;
1928
1929 pp_on = I915_READ(PCH_PP_ON_DELAYS);
1930 pp_div = I915_READ(PCH_PP_DIVISOR);
89667383 1931
5d613501
JB
1932 /* Get T3 & T12 values (note: VESA not bspec terminology) */
1933 dev_priv->panel_t3 = (pp_on & 0x1fff0000) >> 16;
1934 dev_priv->panel_t3 /= 10; /* t3 in 100us units */
1935 dev_priv->panel_t12 = pp_div & 0xf;
1936 dev_priv->panel_t12 *= 100; /* t12 in 100ms units */
1937
1938 ironlake_edp_panel_vdd_on(intel_dp);
89667383
JB
1939 ret = intel_dp_aux_native_read(intel_dp, DP_DPCD_REV,
1940 intel_dp->dpcd,
1941 sizeof(intel_dp->dpcd));
1942 if (ret == sizeof(intel_dp->dpcd)) {
1943 if (intel_dp->dpcd[0] >= 0x11)
1944 dev_priv->no_aux_handshake = intel_dp->dpcd[3] &
1945 DP_NO_AUX_HANDSHAKE_LINK_TRAINING;
1946 } else {
1947 DRM_ERROR("failed to retrieve link info\n");
1948 }
5d613501 1949 ironlake_edp_panel_vdd_off(intel_dp);
89667383
JB
1950 }
1951
21d40d37 1952 intel_encoder->hot_plug = intel_dp_hot_plug;
a4fc5ed6 1953
4d926461 1954 if (is_edp(intel_dp)) {
32f9d658
ZW
1955 /* initialize panel mode from VBT if available for eDP */
1956 if (dev_priv->lfp_lvds_vbt_mode) {
1957 dev_priv->panel_fixed_mode =
1958 drm_mode_duplicate(dev, dev_priv->lfp_lvds_vbt_mode);
1959 if (dev_priv->panel_fixed_mode) {
1960 dev_priv->panel_fixed_mode->type |=
1961 DRM_MODE_TYPE_PREFERRED;
1962 }
1963 }
1964 }
1965
f684960e
CW
1966 intel_dp_add_properties(intel_dp, connector);
1967
a4fc5ed6
KP
1968 /* For G4X desktop chip, PEG_BAND_GAP_DATA 3:0 must first be written
1969 * 0xd. Failure to do so will result in spurious interrupts being
1970 * generated on the port when a cable is not attached.
1971 */
1972 if (IS_G4X(dev) && !IS_GM45(dev)) {
1973 u32 temp = I915_READ(PEG_BAND_GAP_DATA);
1974 I915_WRITE(PEG_BAND_GAP_DATA, (temp & ~0xf) | 0xd);
1975 }
1976}