intel_dp.c 53.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
/*
 * Copyright © 2008 Intel Corporation
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
 * IN THE SOFTWARE.
 *
 * Authors:
 *    Keith Packard <keithp@keithp.com>
 *
 */

#include <linux/i2c.h>
29
#include <linux/slab.h>
30 31 32 33 34 35 36
#include "drmP.h"
#include "drm.h"
#include "drm_crtc.h"
#include "drm_crtc_helper.h"
#include "intel_drv.h"
#include "i915_drm.h"
#include "i915_drv.h"
37
#include "drm_dp_helper.h"
38

39

40 41 42 43 44
#define DP_LINK_STATUS_SIZE	6
#define DP_LINK_CHECK_TIMEOUT	(10 * 1000)

#define DP_LINK_CONFIGURATION_SIZE	9

C
Chris Wilson 已提交
45 46
struct intel_dp {
	struct intel_encoder base;
47 48 49 50
	uint32_t output_reg;
	uint32_t DP;
	uint8_t  link_configuration[DP_LINK_CONFIGURATION_SIZE];
	bool has_audio;
51
	int force_audio;
52
	uint32_t color_range;
53
	int dpms_mode;
54 55
	uint8_t link_bw;
	uint8_t lane_count;
56
	uint8_t dpcd[8];
57 58
	struct i2c_adapter adapter;
	struct i2c_algo_dp_aux_data algo;
59
	bool is_pch_edp;
60 61
	uint8_t	train_set[4];
	uint8_t link_status[DP_LINK_STATUS_SIZE];
62 63
};

64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
/**
 * is_edp - is the given port attached to an eDP panel (either CPU or PCH)
 * @intel_dp: DP struct
 *
 * If a CPU or PCH DP output is attached to an eDP panel, this function
 * will return true, and false otherwise.
 */
static bool is_edp(struct intel_dp *intel_dp)
{
	return intel_dp->base.type == INTEL_OUTPUT_EDP;
}

/**
 * is_pch_edp - is the port on the PCH and attached to an eDP panel?
 * @intel_dp: DP struct
 *
 * Returns true if the given DP struct corresponds to a PCH DP port attached
 * to an eDP panel, false otherwise.  Helpful for determining whether we
 * may need FDI resources for a given DP output or not.
 */
static bool is_pch_edp(struct intel_dp *intel_dp)
{
	return intel_dp->is_pch_edp;
}

C
Chris Wilson 已提交
89 90
static struct intel_dp *enc_to_intel_dp(struct drm_encoder *encoder)
{
91
	return container_of(encoder, struct intel_dp, base.base);
C
Chris Wilson 已提交
92
}
93

94 95 96 97 98 99
static struct intel_dp *intel_attached_dp(struct drm_connector *connector)
{
	return container_of(intel_attached_encoder(connector),
			    struct intel_dp, base);
}

100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118
/**
 * intel_encoder_is_pch_edp - is the given encoder a PCH attached eDP?
 * @encoder: DRM encoder
 *
 * Return true if @encoder corresponds to a PCH attached eDP panel.  Needed
 * by intel_display.c.
 */
bool intel_encoder_is_pch_edp(struct drm_encoder *encoder)
{
	struct intel_dp *intel_dp;

	if (!encoder)
		return false;

	intel_dp = enc_to_intel_dp(encoder);

	return is_pch_edp(intel_dp);
}

119 120
static void intel_dp_start_link_train(struct intel_dp *intel_dp);
static void intel_dp_complete_link_train(struct intel_dp *intel_dp);
C
Chris Wilson 已提交
121
static void intel_dp_link_down(struct intel_dp *intel_dp);
122

123
void
124
intel_edp_link_config(struct intel_encoder *intel_encoder,
C
Chris Wilson 已提交
125
		       int *lane_num, int *link_bw)
126
{
C
Chris Wilson 已提交
127
	struct intel_dp *intel_dp = container_of(intel_encoder, struct intel_dp, base);
128

C
Chris Wilson 已提交
129 130
	*lane_num = intel_dp->lane_count;
	if (intel_dp->link_bw == DP_LINK_BW_1_62)
131
		*link_bw = 162000;
C
Chris Wilson 已提交
132
	else if (intel_dp->link_bw == DP_LINK_BW_2_7)
133 134 135
		*link_bw = 270000;
}

136
static int
C
Chris Wilson 已提交
137
intel_dp_max_lane_count(struct intel_dp *intel_dp)
138 139 140
{
	int max_lane_count = 4;

141 142
	if (intel_dp->dpcd[DP_DPCD_REV] >= 0x11) {
		max_lane_count = intel_dp->dpcd[DP_MAX_LANE_COUNT] & 0x1f;
143 144 145 146 147 148 149 150 151 152 153
		switch (max_lane_count) {
		case 1: case 2: case 4:
			break;
		default:
			max_lane_count = 4;
		}
	}
	return max_lane_count;
}

static int
C
Chris Wilson 已提交
154
intel_dp_max_link_bw(struct intel_dp *intel_dp)
155
{
156
	int max_link_bw = intel_dp->dpcd[DP_MAX_LINK_RATE];
157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179

	switch (max_link_bw) {
	case DP_LINK_BW_1_62:
	case DP_LINK_BW_2_7:
		break;
	default:
		max_link_bw = DP_LINK_BW_1_62;
		break;
	}
	return max_link_bw;
}

static int
intel_dp_link_clock(uint8_t link_bw)
{
	if (link_bw == DP_LINK_BW_2_7)
		return 270000;
	else
		return 162000;
}

/* I think this is a fiction */
static int
C
Chris Wilson 已提交
180
intel_dp_link_required(struct drm_device *dev, struct intel_dp *intel_dp, int pixel_clock)
181
{
182 183 184
	struct drm_crtc *crtc = intel_dp->base.base.crtc;
	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
	int bpp = 24;
185

186 187 188 189
	if (intel_crtc)
		bpp = intel_crtc->bpp;

	return (pixel_clock * bpp + 7) / 8;
190 191
}

192 193 194 195 196 197
static int
intel_dp_max_data_rate(int max_link_clock, int max_lanes)
{
	return (max_link_clock * max_lanes * 8) / 10;
}

198 199 200 201
static int
intel_dp_mode_valid(struct drm_connector *connector,
		    struct drm_display_mode *mode)
{
202
	struct intel_dp *intel_dp = intel_attached_dp(connector);
203 204
	struct drm_device *dev = connector->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
C
Chris Wilson 已提交
205 206
	int max_link_clock = intel_dp_link_clock(intel_dp_max_link_bw(intel_dp));
	int max_lanes = intel_dp_max_lane_count(intel_dp);
207

208
	if (is_edp(intel_dp) && dev_priv->panel_fixed_mode) {
209 210 211 212 213 214 215
		if (mode->hdisplay > dev_priv->panel_fixed_mode->hdisplay)
			return MODE_PANEL;

		if (mode->vdisplay > dev_priv->panel_fixed_mode->vdisplay)
			return MODE_PANEL;
	}

L
Lucas De Marchi 已提交
216
	/* only refuse the mode on non eDP since we have seen some weird eDP panels
217
	   which are outside spec tolerances but somehow work by magic */
218
	if (!is_edp(intel_dp) &&
C
Chris Wilson 已提交
219
	    (intel_dp_link_required(connector->dev, intel_dp, mode->clock)
220
	     > intel_dp_max_data_rate(max_link_clock, max_lanes)))
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251
		return MODE_CLOCK_HIGH;

	if (mode->clock < 10000)
		return MODE_CLOCK_LOW;

	return MODE_OK;
}

static uint32_t
pack_aux(uint8_t *src, int src_bytes)
{
	int	i;
	uint32_t v = 0;

	if (src_bytes > 4)
		src_bytes = 4;
	for (i = 0; i < src_bytes; i++)
		v |= ((uint32_t) src[i]) << ((3-i) * 8);
	return v;
}

static void
unpack_aux(uint32_t src, uint8_t *dst, int dst_bytes)
{
	int i;
	if (dst_bytes > 4)
		dst_bytes = 4;
	for (i = 0; i < dst_bytes; i++)
		dst[i] = src >> ((3-i) * 8);
}

252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281
/* hrawclock is 1/4 the FSB frequency */
static int
intel_hrawclk(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	uint32_t clkcfg;

	clkcfg = I915_READ(CLKCFG);
	switch (clkcfg & CLKCFG_FSB_MASK) {
	case CLKCFG_FSB_400:
		return 100;
	case CLKCFG_FSB_533:
		return 133;
	case CLKCFG_FSB_667:
		return 166;
	case CLKCFG_FSB_800:
		return 200;
	case CLKCFG_FSB_1067:
		return 266;
	case CLKCFG_FSB_1333:
		return 333;
	/* these two are just a guess; one of them might be right */
	case CLKCFG_FSB_1600:
	case CLKCFG_FSB_1600_ALT:
		return 400;
	default:
		return 133;
	}
}

282
static int
C
Chris Wilson 已提交
283
intel_dp_aux_ch(struct intel_dp *intel_dp,
284 285 286
		uint8_t *send, int send_bytes,
		uint8_t *recv, int recv_size)
{
C
Chris Wilson 已提交
287
	uint32_t output_reg = intel_dp->output_reg;
288
	struct drm_device *dev = intel_dp->base.base.dev;
289 290 291 292 293 294
	struct drm_i915_private *dev_priv = dev->dev_private;
	uint32_t ch_ctl = output_reg + 0x10;
	uint32_t ch_data = ch_ctl + 4;
	int i;
	int recv_bytes;
	uint32_t status;
295
	uint32_t aux_clock_divider;
296
	int try, precharge;
297 298

	/* The clock divider is based off the hrawclk,
299 300
	 * and would like to run at 2MHz. So, take the
	 * hrawclk value and divide by 2 and use that
301 302 303
	 *
	 * Note that PCH attached eDP panels should use a 125MHz input
	 * clock divider.
304
	 */
305
	if (is_edp(intel_dp) && !is_pch_edp(intel_dp)) {
306 307 308 309 310
		if (IS_GEN6(dev))
			aux_clock_divider = 200; /* SNB eDP input clock at 400Mhz */
		else
			aux_clock_divider = 225; /* eDP input clock at 450Mhz */
	} else if (HAS_PCH_SPLIT(dev))
311
		aux_clock_divider = 62; /* IRL input clock fixed at 125Mhz */
312 313 314
	else
		aux_clock_divider = intel_hrawclk(dev) / 2;

315 316 317 318 319
	if (IS_GEN6(dev))
		precharge = 3;
	else
		precharge = 5;

320 321 322 323 324 325 326 327 328 329 330
	/* Try to wait for any previous AUX channel activity */
	for (try = 0; try < 3; try++) {
		status = I915_READ(ch_ctl);
		if ((status & DP_AUX_CH_CTL_SEND_BUSY) == 0)
			break;
		msleep(1);
	}

	if (try == 3) {
		WARN(1, "dp_aux_ch not started status 0x%08x\n",
		     I915_READ(ch_ctl));
331 332 333
		return -EBUSY;
	}

334 335 336
	/* Must try at least 3 times according to DP spec */
	for (try = 0; try < 5; try++) {
		/* Load the send data into the aux channel data registers */
337 338 339
		for (i = 0; i < send_bytes; i += 4)
			I915_WRITE(ch_data + i,
				   pack_aux(send + i, send_bytes - i));
340

341
		/* Send the command and wait for it to complete */
342 343 344 345 346 347 348 349 350
		I915_WRITE(ch_ctl,
			   DP_AUX_CH_CTL_SEND_BUSY |
			   DP_AUX_CH_CTL_TIME_OUT_400us |
			   (send_bytes << DP_AUX_CH_CTL_MESSAGE_SIZE_SHIFT) |
			   (precharge << DP_AUX_CH_CTL_PRECHARGE_2US_SHIFT) |
			   (aux_clock_divider << DP_AUX_CH_CTL_BIT_CLOCK_2X_SHIFT) |
			   DP_AUX_CH_CTL_DONE |
			   DP_AUX_CH_CTL_TIME_OUT_ERROR |
			   DP_AUX_CH_CTL_RECEIVE_ERROR);
351 352 353 354
		for (;;) {
			status = I915_READ(ch_ctl);
			if ((status & DP_AUX_CH_CTL_SEND_BUSY) == 0)
				break;
355
			udelay(100);
356
		}
357

358
		/* Clear done status and any errors */
359 360 361 362 363 364
		I915_WRITE(ch_ctl,
			   status |
			   DP_AUX_CH_CTL_DONE |
			   DP_AUX_CH_CTL_TIME_OUT_ERROR |
			   DP_AUX_CH_CTL_RECEIVE_ERROR);
		if (status & DP_AUX_CH_CTL_DONE)
365 366 367 368
			break;
	}

	if ((status & DP_AUX_CH_CTL_DONE) == 0) {
369
		DRM_ERROR("dp_aux_ch not done status 0x%08x\n", status);
370
		return -EBUSY;
371 372 373 374 375
	}

	/* Check for timeout or receive error.
	 * Timeouts occur when the sink is not connected
	 */
376
	if (status & DP_AUX_CH_CTL_RECEIVE_ERROR) {
377
		DRM_ERROR("dp_aux_ch receive error status 0x%08x\n", status);
378 379
		return -EIO;
	}
380 381 382

	/* Timeouts occur when the device isn't connected, so they're
	 * "normal" -- don't fill the kernel log with these */
383
	if (status & DP_AUX_CH_CTL_TIME_OUT_ERROR) {
384
		DRM_DEBUG_KMS("dp_aux_ch timeout status 0x%08x\n", status);
385
		return -ETIMEDOUT;
386 387 388 389 390 391 392
	}

	/* Unload any bytes sent back from the other side */
	recv_bytes = ((status & DP_AUX_CH_CTL_MESSAGE_SIZE_MASK) >>
		      DP_AUX_CH_CTL_MESSAGE_SIZE_SHIFT);
	if (recv_bytes > recv_size)
		recv_bytes = recv_size;
393

394 395 396
	for (i = 0; i < recv_bytes; i += 4)
		unpack_aux(I915_READ(ch_data + i),
			   recv + i, recv_bytes - i);
397 398 399 400 401 402

	return recv_bytes;
}

/* Write data to the aux channel in native mode */
static int
C
Chris Wilson 已提交
403
intel_dp_aux_native_write(struct intel_dp *intel_dp,
404 405 406 407 408 409 410 411 412 413 414
			  uint16_t address, uint8_t *send, int send_bytes)
{
	int ret;
	uint8_t	msg[20];
	int msg_bytes;
	uint8_t	ack;

	if (send_bytes > 16)
		return -1;
	msg[0] = AUX_NATIVE_WRITE << 4;
	msg[1] = address >> 8;
415
	msg[2] = address & 0xff;
416 417 418 419
	msg[3] = send_bytes - 1;
	memcpy(&msg[4], send, send_bytes);
	msg_bytes = send_bytes + 4;
	for (;;) {
C
Chris Wilson 已提交
420
		ret = intel_dp_aux_ch(intel_dp, msg, msg_bytes, &ack, 1);
421 422 423 424 425 426 427
		if (ret < 0)
			return ret;
		if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_ACK)
			break;
		else if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_DEFER)
			udelay(100);
		else
428
			return -EIO;
429 430 431 432 433 434
	}
	return send_bytes;
}

/* Write a single byte to the aux channel in native mode */
static int
C
Chris Wilson 已提交
435
intel_dp_aux_native_write_1(struct intel_dp *intel_dp,
436 437
			    uint16_t address, uint8_t byte)
{
C
Chris Wilson 已提交
438
	return intel_dp_aux_native_write(intel_dp, address, &byte, 1);
439 440 441 442
}

/* read bytes from a native aux channel */
static int
C
Chris Wilson 已提交
443
intel_dp_aux_native_read(struct intel_dp *intel_dp,
444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
			 uint16_t address, uint8_t *recv, int recv_bytes)
{
	uint8_t msg[4];
	int msg_bytes;
	uint8_t reply[20];
	int reply_bytes;
	uint8_t ack;
	int ret;

	msg[0] = AUX_NATIVE_READ << 4;
	msg[1] = address >> 8;
	msg[2] = address & 0xff;
	msg[3] = recv_bytes - 1;

	msg_bytes = 4;
	reply_bytes = recv_bytes + 1;

	for (;;) {
C
Chris Wilson 已提交
462
		ret = intel_dp_aux_ch(intel_dp, msg, msg_bytes,
463
				      reply, reply_bytes);
464 465 466
		if (ret == 0)
			return -EPROTO;
		if (ret < 0)
467 468 469 470 471 472 473 474 475
			return ret;
		ack = reply[0];
		if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_ACK) {
			memcpy(recv, reply + 1, ret - 1);
			return ret - 1;
		}
		else if ((ack & AUX_NATIVE_REPLY_MASK) == AUX_NATIVE_REPLY_DEFER)
			udelay(100);
		else
476
			return -EIO;
477 478 479 480
	}
}

static int
481 482
intel_dp_i2c_aux_ch(struct i2c_adapter *adapter, int mode,
		    uint8_t write_byte, uint8_t *read_byte)
483
{
484
	struct i2c_algo_dp_aux_data *algo_data = adapter->algo_data;
C
Chris Wilson 已提交
485 486 487
	struct intel_dp *intel_dp = container_of(adapter,
						struct intel_dp,
						adapter);
488 489 490
	uint16_t address = algo_data->address;
	uint8_t msg[5];
	uint8_t reply[2];
491
	unsigned retry;
492 493 494 495 496 497 498 499 500 501 502 503
	int msg_bytes;
	int reply_bytes;
	int ret;

	/* Set up the command byte */
	if (mode & MODE_I2C_READ)
		msg[0] = AUX_I2C_READ << 4;
	else
		msg[0] = AUX_I2C_WRITE << 4;

	if (!(mode & MODE_I2C_STOP))
		msg[0] |= AUX_I2C_MOT << 4;
504

505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525
	msg[1] = address >> 8;
	msg[2] = address;

	switch (mode) {
	case MODE_I2C_WRITE:
		msg[3] = 0;
		msg[4] = write_byte;
		msg_bytes = 5;
		reply_bytes = 1;
		break;
	case MODE_I2C_READ:
		msg[3] = 0;
		msg_bytes = 4;
		reply_bytes = 2;
		break;
	default:
		msg_bytes = 3;
		reply_bytes = 1;
		break;
	}

526 527 528 529
	for (retry = 0; retry < 5; retry++) {
		ret = intel_dp_aux_ch(intel_dp,
				      msg, msg_bytes,
				      reply, reply_bytes);
530
		if (ret < 0) {
531
			DRM_DEBUG_KMS("aux_ch failed %d\n", ret);
532 533
			return ret;
		}
534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552

		switch (reply[0] & AUX_NATIVE_REPLY_MASK) {
		case AUX_NATIVE_REPLY_ACK:
			/* I2C-over-AUX Reply field is only valid
			 * when paired with AUX ACK.
			 */
			break;
		case AUX_NATIVE_REPLY_NACK:
			DRM_DEBUG_KMS("aux_ch native nack\n");
			return -EREMOTEIO;
		case AUX_NATIVE_REPLY_DEFER:
			udelay(100);
			continue;
		default:
			DRM_ERROR("aux_ch invalid native reply 0x%02x\n",
				  reply[0]);
			return -EREMOTEIO;
		}

553 554 555 556 557 558 559
		switch (reply[0] & AUX_I2C_REPLY_MASK) {
		case AUX_I2C_REPLY_ACK:
			if (mode == MODE_I2C_READ) {
				*read_byte = reply[1];
			}
			return reply_bytes - 1;
		case AUX_I2C_REPLY_NACK:
560
			DRM_DEBUG_KMS("aux_i2c nack\n");
561 562
			return -EREMOTEIO;
		case AUX_I2C_REPLY_DEFER:
563
			DRM_DEBUG_KMS("aux_i2c defer\n");
564 565 566
			udelay(100);
			break;
		default:
567
			DRM_ERROR("aux_i2c invalid reply 0x%02x\n", reply[0]);
568 569 570
			return -EREMOTEIO;
		}
	}
571 572 573

	DRM_ERROR("too many retries, giving up\n");
	return -EREMOTEIO;
574 575 576
}

static int
C
Chris Wilson 已提交
577
intel_dp_i2c_init(struct intel_dp *intel_dp,
578
		  struct intel_connector *intel_connector, const char *name)
579
{
Z
Zhenyu Wang 已提交
580
	DRM_DEBUG_KMS("i2c_init %s\n", name);
C
Chris Wilson 已提交
581 582 583 584
	intel_dp->algo.running = false;
	intel_dp->algo.address = 0;
	intel_dp->algo.aux_ch = intel_dp_i2c_aux_ch;

585
	memset(&intel_dp->adapter, '\0', sizeof(intel_dp->adapter));
C
Chris Wilson 已提交
586 587
	intel_dp->adapter.owner = THIS_MODULE;
	intel_dp->adapter.class = I2C_CLASS_DDC;
588
	strncpy(intel_dp->adapter.name, name, sizeof(intel_dp->adapter.name) - 1);
C
Chris Wilson 已提交
589 590 591 592 593
	intel_dp->adapter.name[sizeof(intel_dp->adapter.name) - 1] = '\0';
	intel_dp->adapter.algo_data = &intel_dp->algo;
	intel_dp->adapter.dev.parent = &intel_connector->base.kdev;

	return i2c_dp_aux_add_bus(&intel_dp->adapter);
594 595 596 597 598 599
}

static bool
intel_dp_mode_fixup(struct drm_encoder *encoder, struct drm_display_mode *mode,
		    struct drm_display_mode *adjusted_mode)
{
600 601
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
C
Chris Wilson 已提交
602
	struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
603
	int lane_count, clock;
C
Chris Wilson 已提交
604 605
	int max_lane_count = intel_dp_max_lane_count(intel_dp);
	int max_clock = intel_dp_max_link_bw(intel_dp) == DP_LINK_BW_2_7 ? 1 : 0;
606 607
	static int bws[2] = { DP_LINK_BW_1_62, DP_LINK_BW_2_7 };

608
	if (is_edp(intel_dp) && dev_priv->panel_fixed_mode) {
609 610 611
		intel_fixed_panel_mode(dev_priv->panel_fixed_mode, adjusted_mode);
		intel_pch_panel_fitting(dev, DRM_MODE_SCALE_FULLSCREEN,
					mode, adjusted_mode);
612 613 614 615 616 617 618
		/*
		 * the mode->clock is used to calculate the Data&Link M/N
		 * of the pipe. For the eDP the fixed clock should be used.
		 */
		mode->clock = dev_priv->panel_fixed_mode->clock;
	}

619 620
	for (lane_count = 1; lane_count <= max_lane_count; lane_count <<= 1) {
		for (clock = 0; clock <= max_clock; clock++) {
621
			int link_avail = intel_dp_max_data_rate(intel_dp_link_clock(bws[clock]), lane_count);
622

C
Chris Wilson 已提交
623
			if (intel_dp_link_required(encoder->dev, intel_dp, mode->clock)
624
					<= link_avail) {
C
Chris Wilson 已提交
625 626 627
				intel_dp->link_bw = bws[clock];
				intel_dp->lane_count = lane_count;
				adjusted_mode->clock = intel_dp_link_clock(intel_dp->link_bw);
628 629
				DRM_DEBUG_KMS("Display port link bw %02x lane "
						"count %d clock %d\n",
C
Chris Wilson 已提交
630
				       intel_dp->link_bw, intel_dp->lane_count,
631 632 633 634 635
				       adjusted_mode->clock);
				return true;
			}
		}
	}
636

637 638 639 640 641 642 643 644 645 646 647 648 649
	if (is_edp(intel_dp)) {
		/* okay we failed just pick the highest */
		intel_dp->lane_count = max_lane_count;
		intel_dp->link_bw = bws[max_clock];
		adjusted_mode->clock = intel_dp_link_clock(intel_dp->link_bw);
		DRM_DEBUG_KMS("Force picking display port link bw %02x lane "
			      "count %d clock %d\n",
			      intel_dp->link_bw, intel_dp->lane_count,
			      adjusted_mode->clock);

		return true;
	}

650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670
	return false;
}

struct intel_dp_m_n {
	uint32_t	tu;
	uint32_t	gmch_m;
	uint32_t	gmch_n;
	uint32_t	link_m;
	uint32_t	link_n;
};

static void
intel_reduce_ratio(uint32_t *num, uint32_t *den)
{
	while (*num > 0xffffff || *den > 0xffffff) {
		*num >>= 1;
		*den >>= 1;
	}
}

static void
671
intel_dp_compute_m_n(int bpp,
672 673 674 675 676 677
		     int nlanes,
		     int pixel_clock,
		     int link_clock,
		     struct intel_dp_m_n *m_n)
{
	m_n->tu = 64;
678
	m_n->gmch_m = (pixel_clock * bpp) >> 3;
679 680 681 682 683 684 685 686 687 688 689 690 691
	m_n->gmch_n = link_clock * nlanes;
	intel_reduce_ratio(&m_n->gmch_m, &m_n->gmch_n);
	m_n->link_m = pixel_clock;
	m_n->link_n = link_clock;
	intel_reduce_ratio(&m_n->link_m, &m_n->link_n);
}

void
intel_dp_set_m_n(struct drm_crtc *crtc, struct drm_display_mode *mode,
		 struct drm_display_mode *adjusted_mode)
{
	struct drm_device *dev = crtc->dev;
	struct drm_mode_config *mode_config = &dev->mode_config;
692
	struct drm_encoder *encoder;
693 694
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
695
	int lane_count = 4;
696
	struct intel_dp_m_n m_n;
697
	int pipe = intel_crtc->pipe;
698 699

	/*
700
	 * Find the lane count in the intel_encoder private
701
	 */
702
	list_for_each_entry(encoder, &mode_config->encoder_list, head) {
C
Chris Wilson 已提交
703
		struct intel_dp *intel_dp;
704

705
		if (encoder->crtc != crtc)
706 707
			continue;

C
Chris Wilson 已提交
708 709 710
		intel_dp = enc_to_intel_dp(encoder);
		if (intel_dp->base.type == INTEL_OUTPUT_DISPLAYPORT) {
			lane_count = intel_dp->lane_count;
711 712 713
			break;
		} else if (is_edp(intel_dp)) {
			lane_count = dev_priv->edp.lanes;
714 715 716 717 718 719 720 721 722
			break;
		}
	}

	/*
	 * Compute the GMCH and Link ratios. The '3' here is
	 * the number of bytes_per_pixel post-LUT, which we always
	 * set up for 8-bits of R/G/B, or 3 bytes total.
	 */
723
	intel_dp_compute_m_n(intel_crtc->bpp, lane_count,
724 725
			     mode->clock, adjusted_mode->clock, &m_n);

726
	if (HAS_PCH_SPLIT(dev)) {
727 728 729 730 731 732
		I915_WRITE(TRANSDATA_M1(pipe),
			   ((m_n.tu - 1) << PIPE_GMCH_DATA_M_TU_SIZE_SHIFT) |
			   m_n.gmch_m);
		I915_WRITE(TRANSDATA_N1(pipe), m_n.gmch_n);
		I915_WRITE(TRANSDPLINK_M1(pipe), m_n.link_m);
		I915_WRITE(TRANSDPLINK_N1(pipe), m_n.link_n);
733
	} else {
734 735 736 737 738 739
		I915_WRITE(PIPE_GMCH_DATA_M(pipe),
			   ((m_n.tu - 1) << PIPE_GMCH_DATA_M_TU_SIZE_SHIFT) |
			   m_n.gmch_m);
		I915_WRITE(PIPE_GMCH_DATA_N(pipe), m_n.gmch_n);
		I915_WRITE(PIPE_DP_LINK_M(pipe), m_n.link_m);
		I915_WRITE(PIPE_DP_LINK_N(pipe), m_n.link_n);
740 741 742 743 744 745 746
	}
}

static void
intel_dp_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
		  struct drm_display_mode *adjusted_mode)
{
747
	struct drm_device *dev = encoder->dev;
C
Chris Wilson 已提交
748
	struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
749
	struct drm_crtc *crtc = intel_dp->base.base.crtc;
750 751
	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);

752 753
	intel_dp->DP = DP_VOLTAGE_0_4 | DP_PRE_EMPHASIS_0;
	intel_dp->DP |= intel_dp->color_range;
754 755

	if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
C
Chris Wilson 已提交
756
		intel_dp->DP |= DP_SYNC_HS_HIGH;
757
	if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
C
Chris Wilson 已提交
758
		intel_dp->DP |= DP_SYNC_VS_HIGH;
759

760
	if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
C
Chris Wilson 已提交
761
		intel_dp->DP |= DP_LINK_TRAIN_OFF_CPT;
762
	else
C
Chris Wilson 已提交
763
		intel_dp->DP |= DP_LINK_TRAIN_OFF;
764

C
Chris Wilson 已提交
765
	switch (intel_dp->lane_count) {
766
	case 1:
C
Chris Wilson 已提交
767
		intel_dp->DP |= DP_PORT_WIDTH_1;
768 769
		break;
	case 2:
C
Chris Wilson 已提交
770
		intel_dp->DP |= DP_PORT_WIDTH_2;
771 772
		break;
	case 4:
C
Chris Wilson 已提交
773
		intel_dp->DP |= DP_PORT_WIDTH_4;
774 775
		break;
	}
776 777 778
	if (intel_dp->has_audio) {
		DRM_DEBUG_DRIVER("Enabling DP audio on pipe %c\n",
				 pipe_name(intel_crtc->pipe));
C
Chris Wilson 已提交
779
		intel_dp->DP |= DP_AUDIO_OUTPUT_ENABLE;
780 781
		intel_write_eld(encoder, adjusted_mode);
	}
782

C
Chris Wilson 已提交
783 784 785
	memset(intel_dp->link_configuration, 0, DP_LINK_CONFIGURATION_SIZE);
	intel_dp->link_configuration[0] = intel_dp->link_bw;
	intel_dp->link_configuration[1] = intel_dp->lane_count;
786
	intel_dp->link_configuration[8] = DP_SET_ANSI_8B10B;
787 788

	/*
789
	 * Check for DPCD version > 1.1 and enhanced framing support
790
	 */
791 792
	if (intel_dp->dpcd[DP_DPCD_REV] >= 0x11 &&
	    (intel_dp->dpcd[DP_MAX_LANE_COUNT] & DP_ENHANCED_FRAME_CAP)) {
C
Chris Wilson 已提交
793 794
		intel_dp->link_configuration[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN;
		intel_dp->DP |= DP_ENHANCED_FRAMING;
795 796
	}

797 798
	/* CPT DP's pipe select is decided in TRANS_DP_CTL */
	if (intel_crtc->pipe == 1 && !HAS_PCH_CPT(dev))
C
Chris Wilson 已提交
799
		intel_dp->DP |= DP_PIPEB_SELECT;
800

801
	if (is_edp(intel_dp) && !is_pch_edp(intel_dp)) {
802
		/* don't miss out required setting for eDP */
C
Chris Wilson 已提交
803
		intel_dp->DP |= DP_PLL_ENABLE;
804
		if (adjusted_mode->clock < 200000)
C
Chris Wilson 已提交
805
			intel_dp->DP |= DP_PLL_FREQ_160MHZ;
806
		else
C
Chris Wilson 已提交
807
			intel_dp->DP |= DP_PLL_FREQ_270MHZ;
808
	}
809 810
}

811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844
static void ironlake_edp_panel_vdd_on(struct intel_dp *intel_dp)
{
	struct drm_device *dev = intel_dp->base.base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 pp;

	/*
	 * If the panel wasn't on, make sure there's not a currently
	 * active PP sequence before enabling AUX VDD.
	 */
	if (!(I915_READ(PCH_PP_STATUS) & PP_ON))
		msleep(dev_priv->panel_t3);

	pp = I915_READ(PCH_PP_CONTROL);
	pp |= EDP_FORCE_VDD;
	I915_WRITE(PCH_PP_CONTROL, pp);
	POSTING_READ(PCH_PP_CONTROL);
}

static void ironlake_edp_panel_vdd_off(struct intel_dp *intel_dp)
{
	struct drm_device *dev = intel_dp->base.base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 pp;

	pp = I915_READ(PCH_PP_CONTROL);
	pp &= ~EDP_FORCE_VDD;
	I915_WRITE(PCH_PP_CONTROL, pp);
	POSTING_READ(PCH_PP_CONTROL);

	/* Make sure sequencer is idle before allowing subsequent activity */
	msleep(dev_priv->panel_t12);
}

J
Jesse Barnes 已提交
845
/* Returns true if the panel was already on when called */
846
static bool ironlake_edp_panel_on(struct intel_dp *intel_dp)
847
{
848
	struct drm_device *dev = intel_dp->base.base.dev;
849
	struct drm_i915_private *dev_priv = dev->dev_private;
850
	u32 pp, idle_on_mask = PP_ON | PP_SEQUENCE_STATE_ON_IDLE;
851

852
	if (I915_READ(PCH_PP_STATUS) & PP_ON)
J
Jesse Barnes 已提交
853
		return true;
854 855

	pp = I915_READ(PCH_PP_CONTROL);
856 857 858 859 860 861

	/* ILK workaround: disable reset around power sequence */
	pp &= ~PANEL_POWER_RESET;
	I915_WRITE(PCH_PP_CONTROL, pp);
	POSTING_READ(PCH_PP_CONTROL);

862
	pp |= PANEL_UNLOCK_REGS | POWER_TARGET_ON;
863
	I915_WRITE(PCH_PP_CONTROL, pp);
864
	POSTING_READ(PCH_PP_CONTROL);
865

866 867
	if (wait_for((I915_READ(PCH_PP_STATUS) & idle_on_mask) == idle_on_mask,
		     5000))
868 869
		DRM_ERROR("panel on wait timed out: 0x%08x\n",
			  I915_READ(PCH_PP_STATUS));
870

871
	pp |= PANEL_POWER_RESET; /* restore panel reset bit */
872
	I915_WRITE(PCH_PP_CONTROL, pp);
873
	POSTING_READ(PCH_PP_CONTROL);
J
Jesse Barnes 已提交
874 875

	return false;
876 877
}

878
static void ironlake_edp_panel_off(struct drm_device *dev)
879 880
{
	struct drm_i915_private *dev_priv = dev->dev_private;
881 882
	u32 pp, idle_off_mask = PP_ON | PP_SEQUENCE_MASK |
		PP_CYCLE_DELAY_ACTIVE | PP_SEQUENCE_STATE_MASK;
883 884

	pp = I915_READ(PCH_PP_CONTROL);
885 886 887 888 889 890

	/* ILK workaround: disable reset around power sequence */
	pp &= ~PANEL_POWER_RESET;
	I915_WRITE(PCH_PP_CONTROL, pp);
	POSTING_READ(PCH_PP_CONTROL);

891 892
	pp &= ~POWER_TARGET_ON;
	I915_WRITE(PCH_PP_CONTROL, pp);
893
	POSTING_READ(PCH_PP_CONTROL);
894

895
	if (wait_for((I915_READ(PCH_PP_STATUS) & idle_off_mask) == 0, 5000))
896 897
		DRM_ERROR("panel off wait timed out: 0x%08x\n",
			  I915_READ(PCH_PP_STATUS));
898

899
	pp |= PANEL_POWER_RESET; /* restore panel reset bit */
900
	I915_WRITE(PCH_PP_CONTROL, pp);
901
	POSTING_READ(PCH_PP_CONTROL);
902 903
}

904
static void ironlake_edp_backlight_on(struct drm_device *dev)
905 906 907 908
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 pp;

909
	DRM_DEBUG_KMS("\n");
910 911 912 913 914 915 916
	/*
	 * If we enable the backlight right away following a panel power
	 * on, we may see slight flicker as the panel syncs with the eDP
	 * link.  So delay a bit to make sure the image is solid before
	 * allowing it to appear.
	 */
	msleep(300);
917 918 919 920 921
	pp = I915_READ(PCH_PP_CONTROL);
	pp |= EDP_BLC_ENABLE;
	I915_WRITE(PCH_PP_CONTROL, pp);
}

922
static void ironlake_edp_backlight_off(struct drm_device *dev)
923 924 925 926
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 pp;

927
	DRM_DEBUG_KMS("\n");
928 929 930 931
	pp = I915_READ(PCH_PP_CONTROL);
	pp &= ~EDP_BLC_ENABLE;
	I915_WRITE(PCH_PP_CONTROL, pp);
}
932

933 934 935 936 937 938 939 940
static void ironlake_edp_pll_on(struct drm_encoder *encoder)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 dpa_ctl;

	DRM_DEBUG_KMS("\n");
	dpa_ctl = I915_READ(DP_A);
941
	dpa_ctl |= DP_PLL_ENABLE;
942
	I915_WRITE(DP_A, dpa_ctl);
943 944
	POSTING_READ(DP_A);
	udelay(200);
945 946 947 948 949 950 951 952 953
}

static void ironlake_edp_pll_off(struct drm_encoder *encoder)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 dpa_ctl;

	dpa_ctl = I915_READ(DP_A);
954
	dpa_ctl &= ~DP_PLL_ENABLE;
955
	I915_WRITE(DP_A, dpa_ctl);
956
	POSTING_READ(DP_A);
957 958 959
	udelay(200);
}

960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989
/* If the sink supports it, try to set the power state appropriately */
static void intel_dp_sink_dpms(struct intel_dp *intel_dp, int mode)
{
	int ret, i;

	/* Should have a valid DPCD by this point */
	if (intel_dp->dpcd[DP_DPCD_REV] < 0x11)
		return;

	if (mode != DRM_MODE_DPMS_ON) {
		ret = intel_dp_aux_native_write_1(intel_dp, DP_SET_POWER,
						  DP_SET_POWER_D3);
		if (ret != 1)
			DRM_DEBUG_DRIVER("failed to write sink power state\n");
	} else {
		/*
		 * When turning on, we need to retry for 1ms to give the sink
		 * time to wake up.
		 */
		for (i = 0; i < 3; i++) {
			ret = intel_dp_aux_native_write_1(intel_dp,
							  DP_SET_POWER,
							  DP_SET_POWER_D0);
			if (ret == 1)
				break;
			msleep(1);
		}
	}
}

990 991 992 993 994
static void intel_dp_prepare(struct drm_encoder *encoder)
{
	struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
	struct drm_device *dev = encoder->dev;

995 996 997
	/* Wake up the sink first */
	intel_dp_sink_dpms(intel_dp, DRM_MODE_DPMS_ON);

998
	if (is_edp(intel_dp)) {
999
		ironlake_edp_backlight_off(dev);
1000
		ironlake_edp_panel_off(dev);
1001 1002 1003 1004
		if (!is_pch_edp(intel_dp))
			ironlake_edp_pll_on(encoder);
		else
			ironlake_edp_pll_off(encoder);
1005
	}
1006
	intel_dp_link_down(intel_dp);
1007 1008 1009 1010 1011 1012 1013
}

static void intel_dp_commit(struct drm_encoder *encoder)
{
	struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
	struct drm_device *dev = encoder->dev;

1014 1015 1016
	if (is_edp(intel_dp))
		ironlake_edp_panel_vdd_on(intel_dp);

1017 1018
	intel_dp_start_link_train(intel_dp);

1019
	if (is_edp(intel_dp)) {
1020
		ironlake_edp_panel_on(intel_dp);
1021 1022
		ironlake_edp_panel_vdd_off(intel_dp);
	}
1023 1024 1025

	intel_dp_complete_link_train(intel_dp);

1026
	if (is_edp(intel_dp))
1027
		ironlake_edp_backlight_on(dev);
1028 1029

	intel_dp->dpms_mode = DRM_MODE_DPMS_ON;
1030 1031
}

1032 1033 1034
static void
intel_dp_dpms(struct drm_encoder *encoder, int mode)
{
C
Chris Wilson 已提交
1035
	struct intel_dp *intel_dp = enc_to_intel_dp(encoder);
1036
	struct drm_device *dev = encoder->dev;
1037
	struct drm_i915_private *dev_priv = dev->dev_private;
C
Chris Wilson 已提交
1038
	uint32_t dp_reg = I915_READ(intel_dp->output_reg);
1039 1040

	if (mode != DRM_MODE_DPMS_ON) {
1041
		if (is_edp(intel_dp))
1042
			ironlake_edp_backlight_off(dev);
1043
		intel_dp_sink_dpms(intel_dp, mode);
1044
		intel_dp_link_down(intel_dp);
1045
		if (is_edp(intel_dp))
1046 1047
			ironlake_edp_panel_off(dev);
		if (is_edp(intel_dp) && !is_pch_edp(intel_dp))
1048
			ironlake_edp_pll_off(encoder);
1049
	} else {
1050
		if (is_edp(intel_dp))
1051
			ironlake_edp_panel_vdd_on(intel_dp);
1052
		intel_dp_sink_dpms(intel_dp, mode);
1053
		if (!(dp_reg & DP_PORT_EN)) {
1054
			intel_dp_start_link_train(intel_dp);
1055 1056 1057 1058
			if (is_edp(intel_dp)) {
				ironlake_edp_panel_on(intel_dp);
				ironlake_edp_panel_vdd_off(intel_dp);
			}
1059
			intel_dp_complete_link_train(intel_dp);
1060
		}
1061 1062
		if (is_edp(intel_dp))
			ironlake_edp_backlight_on(dev);
1063
	}
1064
	intel_dp->dpms_mode = mode;
1065 1066 1067
}

/*
1068 1069
 * Native read with retry for link status and receiver capability reads for
 * cases where the sink may still be asleep.
1070 1071
 */
static bool
1072 1073
intel_dp_aux_native_read_retry(struct intel_dp *intel_dp, uint16_t address,
			       uint8_t *recv, int recv_bytes)
1074
{
1075 1076
	int ret, i;

1077 1078 1079 1080
	/*
	 * Sinks are *supposed* to come up within 1ms from an off state,
	 * but we're also supposed to retry 3 times per the spec.
	 */
1081
	for (i = 0; i < 3; i++) {
1082 1083 1084
		ret = intel_dp_aux_native_read(intel_dp, address, recv,
					       recv_bytes);
		if (ret == recv_bytes)
1085 1086 1087
			return true;
		msleep(1);
	}
1088

1089
	return false;
1090 1091 1092 1093 1094 1095 1096
}

/*
 * Fetch AUX CH registers 0x202 - 0x207 which contain
 * link status information
 */
static bool
1097
intel_dp_get_link_status(struct intel_dp *intel_dp)
1098
{
1099 1100 1101 1102
	return intel_dp_aux_native_read_retry(intel_dp,
					      DP_LANE0_1_STATUS,
					      intel_dp->link_status,
					      DP_LINK_STATUS_SIZE);
1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173
}

static uint8_t
intel_dp_link_status(uint8_t link_status[DP_LINK_STATUS_SIZE],
		     int r)
{
	return link_status[r - DP_LANE0_1_STATUS];
}

static uint8_t
intel_get_adjust_request_voltage(uint8_t link_status[DP_LINK_STATUS_SIZE],
				 int lane)
{
	int	    i = DP_ADJUST_REQUEST_LANE0_1 + (lane >> 1);
	int	    s = ((lane & 1) ?
			 DP_ADJUST_VOLTAGE_SWING_LANE1_SHIFT :
			 DP_ADJUST_VOLTAGE_SWING_LANE0_SHIFT);
	uint8_t l = intel_dp_link_status(link_status, i);

	return ((l >> s) & 3) << DP_TRAIN_VOLTAGE_SWING_SHIFT;
}

static uint8_t
intel_get_adjust_request_pre_emphasis(uint8_t link_status[DP_LINK_STATUS_SIZE],
				      int lane)
{
	int	    i = DP_ADJUST_REQUEST_LANE0_1 + (lane >> 1);
	int	    s = ((lane & 1) ?
			 DP_ADJUST_PRE_EMPHASIS_LANE1_SHIFT :
			 DP_ADJUST_PRE_EMPHASIS_LANE0_SHIFT);
	uint8_t l = intel_dp_link_status(link_status, i);

	return ((l >> s) & 3) << DP_TRAIN_PRE_EMPHASIS_SHIFT;
}


#if 0
static char	*voltage_names[] = {
	"0.4V", "0.6V", "0.8V", "1.2V"
};
static char	*pre_emph_names[] = {
	"0dB", "3.5dB", "6dB", "9.5dB"
};
static char	*link_train_names[] = {
	"pattern 1", "pattern 2", "idle", "off"
};
#endif

/*
 * These are source-specific values; current Intel hardware supports
 * a maximum voltage of 800mV and a maximum pre-emphasis of 6dB
 */
#define I830_DP_VOLTAGE_MAX	    DP_TRAIN_VOLTAGE_SWING_800

static uint8_t
intel_dp_pre_emphasis_max(uint8_t voltage_swing)
{
	switch (voltage_swing & DP_TRAIN_VOLTAGE_SWING_MASK) {
	case DP_TRAIN_VOLTAGE_SWING_400:
		return DP_TRAIN_PRE_EMPHASIS_6;
	case DP_TRAIN_VOLTAGE_SWING_600:
		return DP_TRAIN_PRE_EMPHASIS_6;
	case DP_TRAIN_VOLTAGE_SWING_800:
		return DP_TRAIN_PRE_EMPHASIS_3_5;
	case DP_TRAIN_VOLTAGE_SWING_1200:
	default:
		return DP_TRAIN_PRE_EMPHASIS_0;
	}
}

static void
1174
intel_get_adjust_train(struct intel_dp *intel_dp)
1175 1176 1177 1178 1179
{
	uint8_t v = 0;
	uint8_t p = 0;
	int lane;

1180 1181 1182
	for (lane = 0; lane < intel_dp->lane_count; lane++) {
		uint8_t this_v = intel_get_adjust_request_voltage(intel_dp->link_status, lane);
		uint8_t this_p = intel_get_adjust_request_pre_emphasis(intel_dp->link_status, lane);
1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196

		if (this_v > v)
			v = this_v;
		if (this_p > p)
			p = this_p;
	}

	if (v >= I830_DP_VOLTAGE_MAX)
		v = I830_DP_VOLTAGE_MAX | DP_TRAIN_MAX_SWING_REACHED;

	if (p >= intel_dp_pre_emphasis_max(v))
		p = intel_dp_pre_emphasis_max(v) | DP_TRAIN_MAX_PRE_EMPHASIS_REACHED;

	for (lane = 0; lane < 4; lane++)
1197
		intel_dp->train_set[lane] = v | p;
1198 1199 1200
}

static uint32_t
1201
intel_dp_signal_levels(uint8_t train_set, int lane_count)
1202
{
1203
	uint32_t	signal_levels = 0;
1204

1205
	switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) {
1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219
	case DP_TRAIN_VOLTAGE_SWING_400:
	default:
		signal_levels |= DP_VOLTAGE_0_4;
		break;
	case DP_TRAIN_VOLTAGE_SWING_600:
		signal_levels |= DP_VOLTAGE_0_6;
		break;
	case DP_TRAIN_VOLTAGE_SWING_800:
		signal_levels |= DP_VOLTAGE_0_8;
		break;
	case DP_TRAIN_VOLTAGE_SWING_1200:
		signal_levels |= DP_VOLTAGE_1_2;
		break;
	}
1220
	switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) {
1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237
	case DP_TRAIN_PRE_EMPHASIS_0:
	default:
		signal_levels |= DP_PRE_EMPHASIS_0;
		break;
	case DP_TRAIN_PRE_EMPHASIS_3_5:
		signal_levels |= DP_PRE_EMPHASIS_3_5;
		break;
	case DP_TRAIN_PRE_EMPHASIS_6:
		signal_levels |= DP_PRE_EMPHASIS_6;
		break;
	case DP_TRAIN_PRE_EMPHASIS_9_5:
		signal_levels |= DP_PRE_EMPHASIS_9_5;
		break;
	}
	return signal_levels;
}

1238 1239 1240 1241
/* Gen6's DP voltage swing and pre-emphasis control */
static uint32_t
intel_gen6_edp_signal_levels(uint8_t train_set)
{
1242 1243 1244
	int signal_levels = train_set & (DP_TRAIN_VOLTAGE_SWING_MASK |
					 DP_TRAIN_PRE_EMPHASIS_MASK);
	switch (signal_levels) {
1245
	case DP_TRAIN_VOLTAGE_SWING_400 | DP_TRAIN_PRE_EMPHASIS_0:
1246 1247 1248 1249
	case DP_TRAIN_VOLTAGE_SWING_600 | DP_TRAIN_PRE_EMPHASIS_0:
		return EDP_LINK_TRAIN_400_600MV_0DB_SNB_B;
	case DP_TRAIN_VOLTAGE_SWING_400 | DP_TRAIN_PRE_EMPHASIS_3_5:
		return EDP_LINK_TRAIN_400MV_3_5DB_SNB_B;
1250
	case DP_TRAIN_VOLTAGE_SWING_400 | DP_TRAIN_PRE_EMPHASIS_6:
1251 1252
	case DP_TRAIN_VOLTAGE_SWING_600 | DP_TRAIN_PRE_EMPHASIS_6:
		return EDP_LINK_TRAIN_400_600MV_6DB_SNB_B;
1253
	case DP_TRAIN_VOLTAGE_SWING_600 | DP_TRAIN_PRE_EMPHASIS_3_5:
1254 1255
	case DP_TRAIN_VOLTAGE_SWING_800 | DP_TRAIN_PRE_EMPHASIS_3_5:
		return EDP_LINK_TRAIN_600_800MV_3_5DB_SNB_B;
1256
	case DP_TRAIN_VOLTAGE_SWING_800 | DP_TRAIN_PRE_EMPHASIS_0:
1257 1258
	case DP_TRAIN_VOLTAGE_SWING_1200 | DP_TRAIN_PRE_EMPHASIS_0:
		return EDP_LINK_TRAIN_800_1200MV_0DB_SNB_B;
1259
	default:
1260 1261 1262
		DRM_DEBUG_KMS("Unsupported voltage swing/pre-emphasis level:"
			      "0x%x\n", signal_levels);
		return EDP_LINK_TRAIN_400_600MV_0DB_SNB_B;
1263 1264 1265
	}
}

1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
static uint8_t
intel_get_lane_status(uint8_t link_status[DP_LINK_STATUS_SIZE],
		      int lane)
{
	int i = DP_LANE0_1_STATUS + (lane >> 1);
	int s = (lane & 1) * 4;
	uint8_t l = intel_dp_link_status(link_status, i);

	return (l >> s) & 0xf;
}

/* Check for clock recovery is done on all channels */
static bool
intel_clock_recovery_ok(uint8_t link_status[DP_LINK_STATUS_SIZE], int lane_count)
{
	int lane;
	uint8_t lane_status;

	for (lane = 0; lane < lane_count; lane++) {
		lane_status = intel_get_lane_status(link_status, lane);
		if ((lane_status & DP_LANE_CR_DONE) == 0)
			return false;
	}
	return true;
}

/* Check to see if channel eq is done on all channels */
#define CHANNEL_EQ_BITS (DP_LANE_CR_DONE|\
			 DP_LANE_CHANNEL_EQ_DONE|\
			 DP_LANE_SYMBOL_LOCKED)
static bool
1297
intel_channel_eq_ok(struct intel_dp *intel_dp)
1298 1299 1300 1301 1302
{
	uint8_t lane_align;
	uint8_t lane_status;
	int lane;

1303
	lane_align = intel_dp_link_status(intel_dp->link_status,
1304 1305 1306
					  DP_LANE_ALIGN_STATUS_UPDATED);
	if ((lane_align & DP_INTERLANE_ALIGN_DONE) == 0)
		return false;
1307 1308
	for (lane = 0; lane < intel_dp->lane_count; lane++) {
		lane_status = intel_get_lane_status(intel_dp->link_status, lane);
1309 1310 1311 1312 1313 1314 1315
		if ((lane_status & CHANNEL_EQ_BITS) != CHANNEL_EQ_BITS)
			return false;
	}
	return true;
}

static bool
C
Chris Wilson 已提交
1316
intel_dp_set_link_train(struct intel_dp *intel_dp,
1317
			uint32_t dp_reg_value,
1318
			uint8_t dp_train_pat)
1319
{
1320
	struct drm_device *dev = intel_dp->base.base.dev;
1321 1322 1323
	struct drm_i915_private *dev_priv = dev->dev_private;
	int ret;

C
Chris Wilson 已提交
1324 1325
	I915_WRITE(intel_dp->output_reg, dp_reg_value);
	POSTING_READ(intel_dp->output_reg);
1326

C
Chris Wilson 已提交
1327
	intel_dp_aux_native_write_1(intel_dp,
1328 1329 1330
				    DP_TRAINING_PATTERN_SET,
				    dp_train_pat);

C
Chris Wilson 已提交
1331
	ret = intel_dp_aux_native_write(intel_dp,
1332 1333
					DP_TRAINING_LANE0_SET,
					intel_dp->train_set, 4);
1334 1335 1336 1337 1338 1339
	if (ret != 4)
		return false;

	return true;
}

1340
/* Enable corresponding port and start training pattern 1 */
1341
static void
1342
intel_dp_start_link_train(struct intel_dp *intel_dp)
1343
{
1344
	struct drm_device *dev = intel_dp->base.base.dev;
1345
	struct drm_i915_private *dev_priv = dev->dev_private;
1346
	struct intel_crtc *intel_crtc = to_intel_crtc(intel_dp->base.base.crtc);
1347 1348 1349 1350
	int i;
	uint8_t voltage;
	bool clock_recovery = false;
	int tries;
1351
	u32 reg;
C
Chris Wilson 已提交
1352
	uint32_t DP = intel_dp->DP;
1353

1354 1355 1356 1357 1358 1359 1360 1361 1362 1363
	/*
	 * On CPT we have to enable the port in training pattern 1, which
	 * will happen below in intel_dp_set_link_train.  Otherwise, enable
	 * the port and wait for it to become active.
	 */
	if (!HAS_PCH_CPT(dev)) {
		I915_WRITE(intel_dp->output_reg, intel_dp->DP);
		POSTING_READ(intel_dp->output_reg);
		intel_wait_for_vblank(dev, intel_crtc->pipe);
	}
1364

1365 1366 1367 1368
	/* Write the link configuration data */
	intel_dp_aux_native_write(intel_dp, DP_LINK_BW_SET,
				  intel_dp->link_configuration,
				  DP_LINK_CONFIGURATION_SIZE);
1369 1370

	DP |= DP_PORT_EN;
1371
	if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
1372 1373 1374
		DP &= ~DP_LINK_TRAIN_MASK_CPT;
	else
		DP &= ~DP_LINK_TRAIN_MASK;
1375
	memset(intel_dp->train_set, 0, 4);
1376 1377 1378 1379
	voltage = 0xff;
	tries = 0;
	clock_recovery = false;
	for (;;) {
1380
		/* Use intel_dp->train_set[0] to set the voltage and pre emphasis values */
1381
		uint32_t    signal_levels;
1382
		if (IS_GEN6(dev) && is_edp(intel_dp)) {
1383
			signal_levels = intel_gen6_edp_signal_levels(intel_dp->train_set[0]);
1384 1385
			DP = (DP & ~EDP_LINK_TRAIN_VOL_EMP_MASK_SNB) | signal_levels;
		} else {
1386
			signal_levels = intel_dp_signal_levels(intel_dp->train_set[0], intel_dp->lane_count);
1387 1388
			DP = (DP & ~(DP_VOLTAGE_MASK|DP_PRE_EMPHASIS_MASK)) | signal_levels;
		}
1389

1390
		if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
1391 1392 1393 1394
			reg = DP | DP_LINK_TRAIN_PAT_1_CPT;
		else
			reg = DP | DP_LINK_TRAIN_PAT_1;

C
Chris Wilson 已提交
1395
		if (!intel_dp_set_link_train(intel_dp, reg,
1396 1397
					     DP_TRAINING_PATTERN_1 |
					     DP_LINK_SCRAMBLING_DISABLE))
1398 1399 1400
			break;
		/* Set training pattern 1 */

1401 1402
		udelay(100);
		if (!intel_dp_get_link_status(intel_dp))
1403 1404
			break;

1405 1406 1407 1408 1409 1410 1411 1412
		if (intel_clock_recovery_ok(intel_dp->link_status, intel_dp->lane_count)) {
			clock_recovery = true;
			break;
		}

		/* Check to see if we've tried the max voltage */
		for (i = 0; i < intel_dp->lane_count; i++)
			if ((intel_dp->train_set[i] & DP_TRAIN_MAX_SWING_REACHED) == 0)
1413
				break;
1414 1415
		if (i == intel_dp->lane_count)
			break;
1416

1417 1418 1419 1420
		/* Check to see if we've tried the same voltage 5 times */
		if ((intel_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK) == voltage) {
			++tries;
			if (tries == 5)
1421
				break;
1422 1423 1424
		} else
			tries = 0;
		voltage = intel_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK;
1425

1426 1427
		/* Compute new intel_dp->train_set as requested by target */
		intel_get_adjust_train(intel_dp);
1428 1429
	}

1430 1431 1432 1433 1434 1435
	intel_dp->DP = DP;
}

static void
intel_dp_complete_link_train(struct intel_dp *intel_dp)
{
1436
	struct drm_device *dev = intel_dp->base.base.dev;
1437 1438
	struct drm_i915_private *dev_priv = dev->dev_private;
	bool channel_eq = false;
1439
	int tries, cr_tries;
1440 1441 1442
	u32 reg;
	uint32_t DP = intel_dp->DP;

1443 1444
	/* channel equalization */
	tries = 0;
1445
	cr_tries = 0;
1446 1447
	channel_eq = false;
	for (;;) {
1448
		/* Use intel_dp->train_set[0] to set the voltage and pre emphasis values */
1449 1450
		uint32_t    signal_levels;

1451 1452 1453 1454 1455 1456
		if (cr_tries > 5) {
			DRM_ERROR("failed to train DP, aborting\n");
			intel_dp_link_down(intel_dp);
			break;
		}

1457
		if (IS_GEN6(dev) && is_edp(intel_dp)) {
1458
			signal_levels = intel_gen6_edp_signal_levels(intel_dp->train_set[0]);
1459 1460
			DP = (DP & ~EDP_LINK_TRAIN_VOL_EMP_MASK_SNB) | signal_levels;
		} else {
1461
			signal_levels = intel_dp_signal_levels(intel_dp->train_set[0], intel_dp->lane_count);
1462 1463 1464
			DP = (DP & ~(DP_VOLTAGE_MASK|DP_PRE_EMPHASIS_MASK)) | signal_levels;
		}

1465
		if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
1466 1467 1468
			reg = DP | DP_LINK_TRAIN_PAT_2_CPT;
		else
			reg = DP | DP_LINK_TRAIN_PAT_2;
1469 1470

		/* channel eq pattern */
C
Chris Wilson 已提交
1471
		if (!intel_dp_set_link_train(intel_dp, reg,
1472 1473
					     DP_TRAINING_PATTERN_2 |
					     DP_LINK_SCRAMBLING_DISABLE))
1474 1475
			break;

1476 1477
		udelay(400);
		if (!intel_dp_get_link_status(intel_dp))
1478 1479
			break;

1480 1481 1482 1483 1484 1485 1486
		/* Make sure clock is still ok */
		if (!intel_clock_recovery_ok(intel_dp->link_status, intel_dp->lane_count)) {
			intel_dp_start_link_train(intel_dp);
			cr_tries++;
			continue;
		}

1487 1488 1489 1490
		if (intel_channel_eq_ok(intel_dp)) {
			channel_eq = true;
			break;
		}
1491

1492 1493 1494 1495 1496 1497 1498 1499
		/* Try 5 times, then try clock recovery if that fails */
		if (tries > 5) {
			intel_dp_link_down(intel_dp);
			intel_dp_start_link_train(intel_dp);
			tries = 0;
			cr_tries++;
			continue;
		}
1500

1501 1502 1503
		/* Compute new intel_dp->train_set as requested by target */
		intel_get_adjust_train(intel_dp);
		++tries;
1504
	}
1505

1506
	if (HAS_PCH_CPT(dev) && !is_edp(intel_dp))
1507 1508 1509 1510
		reg = DP | DP_LINK_TRAIN_OFF_CPT;
	else
		reg = DP | DP_LINK_TRAIN_OFF;

C
Chris Wilson 已提交
1511 1512 1513
	I915_WRITE(intel_dp->output_reg, reg);
	POSTING_READ(intel_dp->output_reg);
	intel_dp_aux_native_write_1(intel_dp,
1514 1515 1516 1517
				    DP_TRAINING_PATTERN_SET, DP_TRAINING_PATTERN_DISABLE);
}

static void
C
Chris Wilson 已提交
1518
intel_dp_link_down(struct intel_dp *intel_dp)
1519
{
1520
	struct drm_device *dev = intel_dp->base.base.dev;
1521
	struct drm_i915_private *dev_priv = dev->dev_private;
C
Chris Wilson 已提交
1522
	uint32_t DP = intel_dp->DP;
1523

1524 1525 1526
	if ((I915_READ(intel_dp->output_reg) & DP_PORT_EN) == 0)
		return;

1527
	DRM_DEBUG_KMS("\n");
1528

1529
	if (is_edp(intel_dp)) {
1530
		DP &= ~DP_PLL_ENABLE;
C
Chris Wilson 已提交
1531 1532
		I915_WRITE(intel_dp->output_reg, DP);
		POSTING_READ(intel_dp->output_reg);
1533 1534 1535
		udelay(100);
	}

1536
	if (HAS_PCH_CPT(dev) && !is_edp(intel_dp)) {
1537
		DP &= ~DP_LINK_TRAIN_MASK_CPT;
C
Chris Wilson 已提交
1538
		I915_WRITE(intel_dp->output_reg, DP | DP_LINK_TRAIN_PAT_IDLE_CPT);
1539 1540
	} else {
		DP &= ~DP_LINK_TRAIN_MASK;
C
Chris Wilson 已提交
1541
		I915_WRITE(intel_dp->output_reg, DP | DP_LINK_TRAIN_PAT_IDLE);
1542
	}
1543
	POSTING_READ(intel_dp->output_reg);
1544

1545
	msleep(17);
1546

1547
	if (is_edp(intel_dp))
1548
		DP |= DP_LINK_TRAIN_OFF;
1549

1550 1551
	if (!HAS_PCH_CPT(dev) &&
	    I915_READ(intel_dp->output_reg) & DP_PIPEB_SELECT) {
1552 1553
		struct drm_crtc *crtc = intel_dp->base.base.crtc;

1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567
		/* Hardware workaround: leaving our transcoder select
		 * set to transcoder B while it's off will prevent the
		 * corresponding HDMI output on transcoder A.
		 *
		 * Combine this with another hardware workaround:
		 * transcoder select bit can only be cleared while the
		 * port is enabled.
		 */
		DP &= ~DP_PIPEB_SELECT;
		I915_WRITE(intel_dp->output_reg, DP);

		/* Changes to enable or select take place the vblank
		 * after being written.
		 */
1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580
		if (crtc == NULL) {
			/* We can arrive here never having been attached
			 * to a CRTC, for instance, due to inheriting
			 * random state from the BIOS.
			 *
			 * If the pipe is not running, play safe and
			 * wait for the clocks to stabilise before
			 * continuing.
			 */
			POSTING_READ(intel_dp->output_reg);
			msleep(50);
		} else
			intel_wait_for_vblank(dev, to_intel_crtc(crtc)->pipe);
1581 1582
	}

C
Chris Wilson 已提交
1583 1584
	I915_WRITE(intel_dp->output_reg, DP & ~DP_PORT_EN);
	POSTING_READ(intel_dp->output_reg);
1585 1586
}

1587 1588
static bool
intel_dp_get_dpcd(struct intel_dp *intel_dp)
1589 1590
{
	if (intel_dp_aux_native_read_retry(intel_dp, 0x000, intel_dp->dpcd,
1591
					   sizeof(intel_dp->dpcd)) &&
1592
	    (intel_dp->dpcd[DP_DPCD_REV] != 0)) {
1593
		return true;
1594 1595
	}

1596
	return false;
1597 1598
}

1599 1600 1601 1602 1603 1604 1605 1606 1607 1608
/*
 * According to DP spec
 * 5.1.2:
 *  1. Read DPCD
 *  2. Configure link according to Receiver Capabilities
 *  3. Use Link Training from 2.5.3.3 and 3.5.1.3
 *  4. Check link status on receipt of hot-plug interrupt
 */

static void
C
Chris Wilson 已提交
1609
intel_dp_check_link_status(struct intel_dp *intel_dp)
1610
{
1611 1612
	if (intel_dp->dpms_mode != DRM_MODE_DPMS_ON)
		return;
1613

1614
	if (!intel_dp->base.base.crtc)
1615 1616
		return;

1617
	/* Try to read receiver status if the link appears to be up */
1618
	if (!intel_dp_get_link_status(intel_dp)) {
C
Chris Wilson 已提交
1619
		intel_dp_link_down(intel_dp);
1620 1621 1622
		return;
	}

1623
	/* Now read the DPCD to see if it's actually running */
1624
	if (!intel_dp_get_dpcd(intel_dp)) {
1625 1626 1627 1628
		intel_dp_link_down(intel_dp);
		return;
	}

1629
	if (!intel_channel_eq_ok(intel_dp)) {
1630 1631
		DRM_DEBUG_KMS("%s: channel EQ not ok, retraining\n",
			      drm_get_encoder_name(&intel_dp->base.base));
1632 1633 1634
		intel_dp_start_link_train(intel_dp);
		intel_dp_complete_link_train(intel_dp);
	}
1635 1636
}

1637
static enum drm_connector_status
1638
intel_dp_detect_dpcd(struct intel_dp *intel_dp)
1639
{
1640 1641 1642
	if (intel_dp_get_dpcd(intel_dp))
		return connector_status_connected;
	return connector_status_disconnected;
1643 1644
}

1645
static enum drm_connector_status
Z
Zhenyu Wang 已提交
1646
ironlake_dp_detect(struct intel_dp *intel_dp)
1647 1648 1649
{
	enum drm_connector_status status;

1650 1651 1652 1653 1654 1655 1656
	/* Can't disconnect eDP, but you can close the lid... */
	if (is_edp(intel_dp)) {
		status = intel_panel_detect(intel_dp->base.base.dev);
		if (status == connector_status_unknown)
			status = connector_status_connected;
		return status;
	}
1657

1658
	return intel_dp_detect_dpcd(intel_dp);
1659 1660
}

1661
static enum drm_connector_status
Z
Zhenyu Wang 已提交
1662
g4x_dp_detect(struct intel_dp *intel_dp)
1663
{
1664
	struct drm_device *dev = intel_dp->base.base.dev;
1665
	struct drm_i915_private *dev_priv = dev->dev_private;
Z
Zhenyu Wang 已提交
1666
	uint32_t temp, bit;
1667

C
Chris Wilson 已提交
1668
	switch (intel_dp->output_reg) {
1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686
	case DP_B:
		bit = DPB_HOTPLUG_INT_STATUS;
		break;
	case DP_C:
		bit = DPC_HOTPLUG_INT_STATUS;
		break;
	case DP_D:
		bit = DPD_HOTPLUG_INT_STATUS;
		break;
	default:
		return connector_status_unknown;
	}

	temp = I915_READ(PORT_HOTPLUG_STAT);

	if ((temp & bit) == 0)
		return connector_status_disconnected;

1687
	return intel_dp_detect_dpcd(intel_dp);
Z
Zhenyu Wang 已提交
1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709
}

/**
 * Uses CRT_HOTPLUG_EN and CRT_HOTPLUG_STAT to detect DP connection.
 *
 * \return true if DP port is connected.
 * \return false if DP port is disconnected.
 */
static enum drm_connector_status
intel_dp_detect(struct drm_connector *connector, bool force)
{
	struct intel_dp *intel_dp = intel_attached_dp(connector);
	struct drm_device *dev = intel_dp->base.base.dev;
	enum drm_connector_status status;
	struct edid *edid = NULL;

	intel_dp->has_audio = false;

	if (HAS_PCH_SPLIT(dev))
		status = ironlake_dp_detect(intel_dp);
	else
		status = g4x_dp_detect(intel_dp);
1710

1711 1712 1713 1714
	DRM_DEBUG_KMS("DPCD: %02hx%02hx%02hx%02hx%02hx%02hx%02hx%02hx\n",
		      intel_dp->dpcd[0], intel_dp->dpcd[1], intel_dp->dpcd[2],
		      intel_dp->dpcd[3], intel_dp->dpcd[4], intel_dp->dpcd[5],
		      intel_dp->dpcd[6], intel_dp->dpcd[7]);
1715

Z
Zhenyu Wang 已提交
1716 1717 1718
	if (status != connector_status_connected)
		return status;

1719 1720 1721 1722 1723 1724 1725 1726 1727
	if (intel_dp->force_audio) {
		intel_dp->has_audio = intel_dp->force_audio > 0;
	} else {
		edid = drm_get_edid(connector, &intel_dp->adapter);
		if (edid) {
			intel_dp->has_audio = drm_detect_monitor_audio(edid);
			connector->display_info.raw_edid = NULL;
			kfree(edid);
		}
Z
Zhenyu Wang 已提交
1728 1729 1730
	}

	return connector_status_connected;
1731 1732 1733 1734
}

static int intel_dp_get_modes(struct drm_connector *connector)
{
1735
	struct intel_dp *intel_dp = intel_attached_dp(connector);
1736
	struct drm_device *dev = intel_dp->base.base.dev;
1737 1738
	struct drm_i915_private *dev_priv = dev->dev_private;
	int ret;
1739 1740 1741 1742

	/* We should parse the EDID data and find out if it has an audio sink
	 */

1743
	ret = intel_ddc_get_modes(connector, &intel_dp->adapter);
1744
	if (ret) {
1745
		if (is_edp(intel_dp) && !dev_priv->panel_fixed_mode) {
1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756
			struct drm_display_mode *newmode;
			list_for_each_entry(newmode, &connector->probed_modes,
					    head) {
				if (newmode->type & DRM_MODE_TYPE_PREFERRED) {
					dev_priv->panel_fixed_mode =
						drm_mode_duplicate(dev, newmode);
					break;
				}
			}
		}

1757
		return ret;
1758
	}
1759 1760

	/* if eDP has no EDID, try to use fixed panel mode from VBT */
1761
	if (is_edp(intel_dp)) {
1762 1763 1764 1765 1766 1767 1768 1769
		if (dev_priv->panel_fixed_mode != NULL) {
			struct drm_display_mode *mode;
			mode = drm_mode_duplicate(dev, dev_priv->panel_fixed_mode);
			drm_mode_probed_add(connector, mode);
			return 1;
		}
	}
	return 0;
1770 1771
}

1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789
static bool
intel_dp_detect_audio(struct drm_connector *connector)
{
	struct intel_dp *intel_dp = intel_attached_dp(connector);
	struct edid *edid;
	bool has_audio = false;

	edid = drm_get_edid(connector, &intel_dp->adapter);
	if (edid) {
		has_audio = drm_detect_monitor_audio(edid);

		connector->display_info.raw_edid = NULL;
		kfree(edid);
	}

	return has_audio;
}

1790 1791 1792 1793 1794
static int
intel_dp_set_property(struct drm_connector *connector,
		      struct drm_property *property,
		      uint64_t val)
{
1795
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
1796 1797 1798 1799 1800 1801 1802
	struct intel_dp *intel_dp = intel_attached_dp(connector);
	int ret;

	ret = drm_connector_property_set_value(connector, property, val);
	if (ret)
		return ret;

1803
	if (property == dev_priv->force_audio_property) {
1804 1805 1806 1807
		int i = val;
		bool has_audio;

		if (i == intel_dp->force_audio)
1808 1809
			return 0;

1810
		intel_dp->force_audio = i;
1811

1812 1813 1814 1815 1816 1817
		if (i == 0)
			has_audio = intel_dp_detect_audio(connector);
		else
			has_audio = i > 0;

		if (has_audio == intel_dp->has_audio)
1818 1819
			return 0;

1820
		intel_dp->has_audio = has_audio;
1821 1822 1823
		goto done;
	}

1824 1825 1826 1827 1828 1829 1830 1831
	if (property == dev_priv->broadcast_rgb_property) {
		if (val == !!intel_dp->color_range)
			return 0;

		intel_dp->color_range = val ? DP_COLOR_RANGE_16_235 : 0;
		goto done;
	}

1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844
	return -EINVAL;

done:
	if (intel_dp->base.base.crtc) {
		struct drm_crtc *crtc = intel_dp->base.base.crtc;
		drm_crtc_helper_set_mode(crtc, &crtc->mode,
					 crtc->x, crtc->y,
					 crtc->fb);
	}

	return 0;
}

1845
static void
1846
intel_dp_destroy(struct drm_connector *connector)
1847
{
1848 1849 1850 1851 1852
	struct drm_device *dev = connector->dev;

	if (intel_dpd_is_edp(dev))
		intel_panel_destroy_backlight(dev);

1853 1854
	drm_sysfs_connector_remove(connector);
	drm_connector_cleanup(connector);
1855
	kfree(connector);
1856 1857
}

1858 1859 1860 1861 1862 1863 1864 1865 1866
static void intel_dp_encoder_destroy(struct drm_encoder *encoder)
{
	struct intel_dp *intel_dp = enc_to_intel_dp(encoder);

	i2c_del_adapter(&intel_dp->adapter);
	drm_encoder_cleanup(encoder);
	kfree(intel_dp);
}

1867 1868 1869
static const struct drm_encoder_helper_funcs intel_dp_helper_funcs = {
	.dpms = intel_dp_dpms,
	.mode_fixup = intel_dp_mode_fixup,
1870
	.prepare = intel_dp_prepare,
1871
	.mode_set = intel_dp_mode_set,
1872
	.commit = intel_dp_commit,
1873 1874 1875 1876 1877 1878
};

static const struct drm_connector_funcs intel_dp_connector_funcs = {
	.dpms = drm_helper_connector_dpms,
	.detect = intel_dp_detect,
	.fill_modes = drm_helper_probe_single_connector_modes,
1879
	.set_property = intel_dp_set_property,
1880 1881 1882 1883 1884 1885
	.destroy = intel_dp_destroy,
};

static const struct drm_connector_helper_funcs intel_dp_connector_helper_funcs = {
	.get_modes = intel_dp_get_modes,
	.mode_valid = intel_dp_mode_valid,
1886
	.best_encoder = intel_best_encoder,
1887 1888 1889
};

static const struct drm_encoder_funcs intel_dp_enc_funcs = {
1890
	.destroy = intel_dp_encoder_destroy,
1891 1892
};

1893
static void
1894
intel_dp_hot_plug(struct intel_encoder *intel_encoder)
1895
{
C
Chris Wilson 已提交
1896
	struct intel_dp *intel_dp = container_of(intel_encoder, struct intel_dp, base);
1897

1898
	intel_dp_check_link_status(intel_dp);
1899
}
1900

1901 1902
/* Return which DP Port should be selected for Transcoder DP control */
int
1903
intel_trans_dp_port_sel(struct drm_crtc *crtc)
1904 1905 1906 1907 1908 1909
{
	struct drm_device *dev = crtc->dev;
	struct drm_mode_config *mode_config = &dev->mode_config;
	struct drm_encoder *encoder;

	list_for_each_entry(encoder, &mode_config->encoder_list, head) {
C
Chris Wilson 已提交
1910 1911
		struct intel_dp *intel_dp;

1912
		if (encoder->crtc != crtc)
1913 1914
			continue;

C
Chris Wilson 已提交
1915 1916 1917
		intel_dp = enc_to_intel_dp(encoder);
		if (intel_dp->base.type == INTEL_OUTPUT_DISPLAYPORT)
			return intel_dp->output_reg;
1918
	}
C
Chris Wilson 已提交
1919

1920 1921 1922
	return -1;
}

1923
/* check the VBT to see whether the eDP is on DP-D port */
1924
bool intel_dpd_is_edp(struct drm_device *dev)
1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct child_device_config *p_child;
	int i;

	if (!dev_priv->child_dev_num)
		return false;

	for (i = 0; i < dev_priv->child_dev_num; i++) {
		p_child = dev_priv->child_dev + i;

		if (p_child->dvo_port == PORT_IDPD &&
		    p_child->device_type == DEVICE_TYPE_eDP)
			return true;
	}
	return false;
}

1943 1944 1945
static void
intel_dp_add_properties(struct intel_dp *intel_dp, struct drm_connector *connector)
{
1946
	intel_attach_force_audio_property(connector);
1947
	intel_attach_broadcast_rgb_property(connector);
1948 1949
}

1950 1951 1952 1953 1954
void
intel_dp_init(struct drm_device *dev, int output_reg)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct drm_connector *connector;
C
Chris Wilson 已提交
1955
	struct intel_dp *intel_dp;
1956
	struct intel_encoder *intel_encoder;
1957
	struct intel_connector *intel_connector;
1958
	const char *name = NULL;
1959
	int type;
1960

C
Chris Wilson 已提交
1961 1962
	intel_dp = kzalloc(sizeof(struct intel_dp), GFP_KERNEL);
	if (!intel_dp)
1963 1964
		return;

1965
	intel_dp->output_reg = output_reg;
1966
	intel_dp->dpms_mode = -1;
1967

1968 1969
	intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
	if (!intel_connector) {
C
Chris Wilson 已提交
1970
		kfree(intel_dp);
1971 1972
		return;
	}
C
Chris Wilson 已提交
1973
	intel_encoder = &intel_dp->base;
1974

C
Chris Wilson 已提交
1975
	if (HAS_PCH_SPLIT(dev) && output_reg == PCH_DP_D)
1976
		if (intel_dpd_is_edp(dev))
C
Chris Wilson 已提交
1977
			intel_dp->is_pch_edp = true;
1978

1979
	if (output_reg == DP_A || is_pch_edp(intel_dp)) {
1980 1981 1982 1983 1984 1985 1986
		type = DRM_MODE_CONNECTOR_eDP;
		intel_encoder->type = INTEL_OUTPUT_EDP;
	} else {
		type = DRM_MODE_CONNECTOR_DisplayPort;
		intel_encoder->type = INTEL_OUTPUT_DISPLAYPORT;
	}

1987
	connector = &intel_connector->base;
1988
	drm_connector_init(dev, connector, &intel_dp_connector_funcs, type);
1989 1990
	drm_connector_helper_add(connector, &intel_dp_connector_helper_funcs);

1991 1992
	connector->polled = DRM_CONNECTOR_POLL_HPD;

1993
	if (output_reg == DP_B || output_reg == PCH_DP_B)
1994
		intel_encoder->clone_mask = (1 << INTEL_DP_B_CLONE_BIT);
1995
	else if (output_reg == DP_C || output_reg == PCH_DP_C)
1996
		intel_encoder->clone_mask = (1 << INTEL_DP_C_CLONE_BIT);
1997
	else if (output_reg == DP_D || output_reg == PCH_DP_D)
1998
		intel_encoder->clone_mask = (1 << INTEL_DP_D_CLONE_BIT);
1999

2000
	if (is_edp(intel_dp))
2001
		intel_encoder->clone_mask = (1 << INTEL_EDP_CLONE_BIT);
Z
Zhenyu Wang 已提交
2002

2003
	intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
2004 2005 2006
	connector->interlace_allowed = true;
	connector->doublescan_allowed = 0;

2007
	drm_encoder_init(dev, &intel_encoder->base, &intel_dp_enc_funcs,
2008
			 DRM_MODE_ENCODER_TMDS);
2009
	drm_encoder_helper_add(&intel_encoder->base, &intel_dp_helper_funcs);
2010

2011
	intel_connector_attach_encoder(intel_connector, intel_encoder);
2012 2013 2014
	drm_sysfs_connector_add(connector);

	/* Set up the DDC bus. */
2015
	switch (output_reg) {
2016 2017 2018
		case DP_A:
			name = "DPDDC-A";
			break;
2019 2020
		case DP_B:
		case PCH_DP_B:
2021 2022
			dev_priv->hotplug_supported_mask |=
				HDMIB_HOTPLUG_INT_STATUS;
2023 2024 2025 2026
			name = "DPDDC-B";
			break;
		case DP_C:
		case PCH_DP_C:
2027 2028
			dev_priv->hotplug_supported_mask |=
				HDMIC_HOTPLUG_INT_STATUS;
2029 2030 2031 2032
			name = "DPDDC-C";
			break;
		case DP_D:
		case PCH_DP_D:
2033 2034
			dev_priv->hotplug_supported_mask |=
				HDMID_HOTPLUG_INT_STATUS;
2035 2036 2037 2038
			name = "DPDDC-D";
			break;
	}

C
Chris Wilson 已提交
2039
	intel_dp_i2c_init(intel_dp, intel_connector, name);
2040

J
Jesse Barnes 已提交
2041 2042
	/* Cache some DPCD data in the eDP case */
	if (is_edp(intel_dp)) {
2043
		bool ret;
2044 2045 2046 2047
		u32 pp_on, pp_div;

		pp_on = I915_READ(PCH_PP_ON_DELAYS);
		pp_div = I915_READ(PCH_PP_DIVISOR);
J
Jesse Barnes 已提交
2048

2049 2050 2051 2052 2053 2054 2055
		/* Get T3 & T12 values (note: VESA not bspec terminology) */
		dev_priv->panel_t3 = (pp_on & 0x1fff0000) >> 16;
		dev_priv->panel_t3 /= 10; /* t3 in 100us units */
		dev_priv->panel_t12 = pp_div & 0xf;
		dev_priv->panel_t12 *= 100; /* t12 in 100ms units */

		ironlake_edp_panel_vdd_on(intel_dp);
2056
		ret = intel_dp_get_dpcd(intel_dp);
2057
		ironlake_edp_panel_vdd_off(intel_dp);
2058
		if (ret) {
2059 2060 2061
			if (intel_dp->dpcd[DP_DPCD_REV] >= 0x11)
				dev_priv->no_aux_handshake =
					intel_dp->dpcd[DP_MAX_DOWNSPREAD] &
J
Jesse Barnes 已提交
2062 2063
					DP_NO_AUX_HANDSHAKE_LINK_TRAINING;
		} else {
2064
			/* if this fails, presume the device is a ghost */
2065
			DRM_INFO("failed to retrieve link info, disabling eDP\n");
2066
			intel_dp_encoder_destroy(&intel_dp->base.base);
2067
			intel_dp_destroy(&intel_connector->base);
2068
			return;
J
Jesse Barnes 已提交
2069 2070 2071
		}
	}

2072
	intel_encoder->hot_plug = intel_dp_hot_plug;
2073

2074
	if (is_edp(intel_dp)) {
2075 2076 2077 2078 2079 2080 2081 2082 2083
		/* initialize panel mode from VBT if available for eDP */
		if (dev_priv->lfp_lvds_vbt_mode) {
			dev_priv->panel_fixed_mode =
				drm_mode_duplicate(dev, dev_priv->lfp_lvds_vbt_mode);
			if (dev_priv->panel_fixed_mode) {
				dev_priv->panel_fixed_mode->type |=
					DRM_MODE_TYPE_PREFERRED;
			}
		}
2084 2085
		dev_priv->int_edp_connector = connector;
		intel_panel_setup_backlight(dev);
2086 2087
	}

2088 2089
	intel_dp_add_properties(intel_dp, connector);

2090 2091 2092 2093 2094 2095 2096 2097 2098
	/* For G4X desktop chip, PEG_BAND_GAP_DATA 3:0 must first be written
	 * 0xd.  Failure to do so will result in spurious interrupts being
	 * generated on the port when a cable is not attached.
	 */
	if (IS_G4X(dev) && !IS_GM45(dev)) {
		u32 temp = I915_READ(PEG_BAND_GAP_DATA);
		I915_WRITE(PEG_BAND_GAP_DATA, (temp & ~0xf) | 0xd);
	}
}