intel_hdmi.c 52.2 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 29
/*
 * Copyright 2006 Dave Airlie <airlied@linux.ie>
 * Copyright © 2006-2009 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:
 *	Eric Anholt <eric@anholt.net>
 *	Jesse Barnes <jesse.barnes@intel.com>
 */

#include <linux/i2c.h>
30
#include <linux/slab.h>
31
#include <linux/delay.h>
32
#include <linux/hdmi.h>
33 34 35
#include <drm/drmP.h>
#include <drm/drm_crtc.h>
#include <drm/drm_edid.h>
36
#include "intel_drv.h"
37
#include <drm/i915_drm.h>
38 39
#include "i915_drv.h"

40 41
static struct drm_device *intel_hdmi_to_dev(struct intel_hdmi *intel_hdmi)
{
42
	return hdmi_to_dig_port(intel_hdmi)->base.base.dev;
43 44
}

45 46 47
static void
assert_hdmi_port_disabled(struct intel_hdmi *intel_hdmi)
{
48
	struct drm_device *dev = intel_hdmi_to_dev(intel_hdmi);
49 50 51
	struct drm_i915_private *dev_priv = dev->dev_private;
	uint32_t enabled_bits;

P
Paulo Zanoni 已提交
52
	enabled_bits = HAS_DDI(dev) ? DDI_BUF_CTL_ENABLE : SDVO_ENABLE;
53

54
	WARN(I915_READ(intel_hdmi->hdmi_reg) & enabled_bits,
55 56 57
	     "HDMI port enabled, expecting disabled\n");
}

58
struct intel_hdmi *enc_to_intel_hdmi(struct drm_encoder *encoder)
C
Chris Wilson 已提交
59
{
60 61 62
	struct intel_digital_port *intel_dig_port =
		container_of(encoder, struct intel_digital_port, base.base);
	return &intel_dig_port->hdmi;
C
Chris Wilson 已提交
63 64
}

65 66
static struct intel_hdmi *intel_attached_hdmi(struct drm_connector *connector)
{
67
	return enc_to_intel_hdmi(&intel_attached_encoder(connector)->base);
68 69
}

70
static u32 g4x_infoframe_index(enum hdmi_infoframe_type type)
71
{
72 73
	switch (type) {
	case HDMI_INFOFRAME_TYPE_AVI:
74
		return VIDEO_DIP_SELECT_AVI;
75
	case HDMI_INFOFRAME_TYPE_SPD:
76
		return VIDEO_DIP_SELECT_SPD;
77 78
	case HDMI_INFOFRAME_TYPE_VENDOR:
		return VIDEO_DIP_SELECT_VENDOR;
79
	default:
80
		DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
81
		return 0;
82 83 84
	}
}

85
static u32 g4x_infoframe_enable(enum hdmi_infoframe_type type)
86
{
87 88
	switch (type) {
	case HDMI_INFOFRAME_TYPE_AVI:
89
		return VIDEO_DIP_ENABLE_AVI;
90
	case HDMI_INFOFRAME_TYPE_SPD:
91
		return VIDEO_DIP_ENABLE_SPD;
92 93
	case HDMI_INFOFRAME_TYPE_VENDOR:
		return VIDEO_DIP_ENABLE_VENDOR;
94
	default:
95
		DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
96
		return 0;
97 98 99
	}
}

100
static u32 hsw_infoframe_enable(enum hdmi_infoframe_type type)
101
{
102 103
	switch (type) {
	case HDMI_INFOFRAME_TYPE_AVI:
104
		return VIDEO_DIP_ENABLE_AVI_HSW;
105
	case HDMI_INFOFRAME_TYPE_SPD:
106
		return VIDEO_DIP_ENABLE_SPD_HSW;
107 108
	case HDMI_INFOFRAME_TYPE_VENDOR:
		return VIDEO_DIP_ENABLE_VS_HSW;
109
	default:
110
		DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
111 112 113 114
		return 0;
	}
}

115
static u32 hsw_infoframe_data_reg(enum hdmi_infoframe_type type,
116 117
				  enum transcoder cpu_transcoder,
				  struct drm_i915_private *dev_priv)
118
{
119 120
	switch (type) {
	case HDMI_INFOFRAME_TYPE_AVI:
121
		return HSW_TVIDEO_DIP_AVI_DATA(cpu_transcoder);
122
	case HDMI_INFOFRAME_TYPE_SPD:
123
		return HSW_TVIDEO_DIP_SPD_DATA(cpu_transcoder);
124 125
	case HDMI_INFOFRAME_TYPE_VENDOR:
		return HSW_TVIDEO_DIP_VS_DATA(cpu_transcoder);
126
	default:
127
		DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
128 129 130 131
		return 0;
	}
}

132
static void g4x_write_infoframe(struct drm_encoder *encoder,
133
				enum hdmi_infoframe_type type,
134
				const void *frame, ssize_t len)
135
{
136
	const uint32_t *data = frame;
137 138
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
139
	u32 val = I915_READ(VIDEO_DIP_CTL);
140
	int i;
141

142 143
	WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");

144
	val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
145
	val |= g4x_infoframe_index(type);
146

147
	val &= ~g4x_infoframe_enable(type);
148

149
	I915_WRITE(VIDEO_DIP_CTL, val);
150

151
	mmiowb();
152
	for (i = 0; i < len; i += 4) {
153 154 155
		I915_WRITE(VIDEO_DIP_DATA, *data);
		data++;
	}
156 157 158
	/* Write every possible data byte to force correct ECC calculation. */
	for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
		I915_WRITE(VIDEO_DIP_DATA, 0);
159
	mmiowb();
160

161
	val |= g4x_infoframe_enable(type);
162
	val &= ~VIDEO_DIP_FREQ_MASK;
163
	val |= VIDEO_DIP_FREQ_VSYNC;
164

165
	I915_WRITE(VIDEO_DIP_CTL, val);
166
	POSTING_READ(VIDEO_DIP_CTL);
167 168
}

169 170 171 172 173 174 175 176 177
static bool g4x_infoframe_enabled(struct drm_encoder *encoder)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 val = I915_READ(VIDEO_DIP_CTL);

	return val & VIDEO_DIP_ENABLE;
}

178
static void ibx_write_infoframe(struct drm_encoder *encoder,
179
				enum hdmi_infoframe_type type,
180
				const void *frame, ssize_t len)
181
{
182
	const uint32_t *data = frame;
183 184
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
185
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
186
	int i, reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
187 188
	u32 val = I915_READ(reg);

189 190
	WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");

191
	val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
192
	val |= g4x_infoframe_index(type);
193

194
	val &= ~g4x_infoframe_enable(type);
195 196 197

	I915_WRITE(reg, val);

198
	mmiowb();
199 200 201 202
	for (i = 0; i < len; i += 4) {
		I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), *data);
		data++;
	}
203 204 205
	/* Write every possible data byte to force correct ECC calculation. */
	for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
		I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), 0);
206
	mmiowb();
207

208
	val |= g4x_infoframe_enable(type);
209
	val &= ~VIDEO_DIP_FREQ_MASK;
210
	val |= VIDEO_DIP_FREQ_VSYNC;
211 212

	I915_WRITE(reg, val);
213
	POSTING_READ(reg);
214 215
}

216 217 218 219 220 221 222 223 224 225 226
static bool ibx_infoframe_enabled(struct drm_encoder *encoder)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	int reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
	u32 val = I915_READ(reg);

	return val & VIDEO_DIP_ENABLE;
}

227
static void cpt_write_infoframe(struct drm_encoder *encoder,
228
				enum hdmi_infoframe_type type,
229
				const void *frame, ssize_t len)
230
{
231
	const uint32_t *data = frame;
232 233
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
234
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
235
	int i, reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
236
	u32 val = I915_READ(reg);
237

238 239
	WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");

240
	val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
241
	val |= g4x_infoframe_index(type);
242

243 244
	/* The DIP control register spec says that we need to update the AVI
	 * infoframe without clearing its enable bit */
245 246
	if (type != HDMI_INFOFRAME_TYPE_AVI)
		val &= ~g4x_infoframe_enable(type);
247

248
	I915_WRITE(reg, val);
249

250
	mmiowb();
251
	for (i = 0; i < len; i += 4) {
252 253 254
		I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), *data);
		data++;
	}
255 256 257
	/* Write every possible data byte to force correct ECC calculation. */
	for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
		I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), 0);
258
	mmiowb();
259

260
	val |= g4x_infoframe_enable(type);
261
	val &= ~VIDEO_DIP_FREQ_MASK;
262
	val |= VIDEO_DIP_FREQ_VSYNC;
263

264
	I915_WRITE(reg, val);
265
	POSTING_READ(reg);
266
}
267

268 269 270 271 272 273 274 275 276 277 278
static bool cpt_infoframe_enabled(struct drm_encoder *encoder)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	int reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
	u32 val = I915_READ(reg);

	return val & VIDEO_DIP_ENABLE;
}

279
static void vlv_write_infoframe(struct drm_encoder *encoder,
280
				enum hdmi_infoframe_type type,
281
				const void *frame, ssize_t len)
282
{
283
	const uint32_t *data = frame;
284 285
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
286
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
287
	int i, reg = VLV_TVIDEO_DIP_CTL(intel_crtc->pipe);
288
	u32 val = I915_READ(reg);
289

290 291
	WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");

292
	val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
293
	val |= g4x_infoframe_index(type);
294

295
	val &= ~g4x_infoframe_enable(type);
296

297
	I915_WRITE(reg, val);
298

299
	mmiowb();
300 301 302 303
	for (i = 0; i < len; i += 4) {
		I915_WRITE(VLV_TVIDEO_DIP_DATA(intel_crtc->pipe), *data);
		data++;
	}
304 305 306
	/* Write every possible data byte to force correct ECC calculation. */
	for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
		I915_WRITE(VLV_TVIDEO_DIP_DATA(intel_crtc->pipe), 0);
307
	mmiowb();
308

309
	val |= g4x_infoframe_enable(type);
310
	val &= ~VIDEO_DIP_FREQ_MASK;
311
	val |= VIDEO_DIP_FREQ_VSYNC;
312

313
	I915_WRITE(reg, val);
314
	POSTING_READ(reg);
315 316
}

317 318 319 320 321 322 323 324 325 326 327
static bool vlv_infoframe_enabled(struct drm_encoder *encoder)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	int reg = VLV_TVIDEO_DIP_CTL(intel_crtc->pipe);
	u32 val = I915_READ(reg);

	return val & VIDEO_DIP_ENABLE;
}

328
static void hsw_write_infoframe(struct drm_encoder *encoder,
329
				enum hdmi_infoframe_type type,
330
				const void *frame, ssize_t len)
331
{
332
	const uint32_t *data = frame;
333 334 335
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
336
	u32 ctl_reg = HSW_TVIDEO_DIP_CTL(intel_crtc->config.cpu_transcoder);
337 338
	u32 data_reg;
	int i;
339
	u32 val = I915_READ(ctl_reg);
340

341
	data_reg = hsw_infoframe_data_reg(type,
342 343
					  intel_crtc->config.cpu_transcoder,
					  dev_priv);
344 345 346
	if (data_reg == 0)
		return;

347
	val &= ~hsw_infoframe_enable(type);
348 349
	I915_WRITE(ctl_reg, val);

350
	mmiowb();
351 352 353 354
	for (i = 0; i < len; i += 4) {
		I915_WRITE(data_reg + i, *data);
		data++;
	}
355 356 357
	/* Write every possible data byte to force correct ECC calculation. */
	for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
		I915_WRITE(data_reg + i, 0);
358
	mmiowb();
359

360
	val |= hsw_infoframe_enable(type);
361
	I915_WRITE(ctl_reg, val);
362
	POSTING_READ(ctl_reg);
363 364
}

365 366 367 368 369 370 371 372 373 374 375 376
static bool hsw_infoframe_enabled(struct drm_encoder *encoder)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	u32 ctl_reg = HSW_TVIDEO_DIP_CTL(intel_crtc->config.cpu_transcoder);
	u32 val = I915_READ(ctl_reg);

	return val & (VIDEO_DIP_ENABLE_AVI_HSW | VIDEO_DIP_ENABLE_SPD_HSW |
		      VIDEO_DIP_ENABLE_VS_HSW);
}

377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393
/*
 * The data we write to the DIP data buffer registers is 1 byte bigger than the
 * HDMI infoframe size because of an ECC/reserved byte at position 3 (starting
 * at 0). It's also a byte used by DisplayPort so the same DIP registers can be
 * used for both technologies.
 *
 * DW0: Reserved/ECC/DP | HB2 | HB1 | HB0
 * DW1:       DB3       | DB2 | DB1 | DB0
 * DW2:       DB7       | DB6 | DB5 | DB4
 * DW3: ...
 *
 * (HB is Header Byte, DB is Data Byte)
 *
 * The hdmi pack() functions don't know about that hardware specific hole so we
 * trick them by giving an offset into the buffer and moving back the header
 * bytes by one.
 */
394 395
static void intel_write_infoframe(struct drm_encoder *encoder,
				  union hdmi_infoframe *frame)
396 397
{
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
398 399
	uint8_t buffer[VIDEO_DIP_DATA_SIZE];
	ssize_t len;
400

401 402 403 404 405 406 407 408 409 410 411
	/* see comment above for the reason for this offset */
	len = hdmi_infoframe_pack(frame, buffer + 1, sizeof(buffer) - 1);
	if (len < 0)
		return;

	/* Insert the 'hole' (see big comment above) at position 3 */
	buffer[0] = buffer[1];
	buffer[1] = buffer[2];
	buffer[2] = buffer[3];
	buffer[3] = 0;
	len++;
412

413
	intel_hdmi->write_infoframe(encoder, frame->any.type, buffer, len);
414 415
}

416
static void intel_hdmi_set_avi_infoframe(struct drm_encoder *encoder,
P
Paulo Zanoni 已提交
417
					 struct drm_display_mode *adjusted_mode)
418
{
419
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
420
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
421 422
	union hdmi_infoframe frame;
	int ret;
423

424 425 426
	/* Set user selected PAR to incoming mode's member */
	adjusted_mode->picture_aspect_ratio = intel_hdmi->aspect_ratio;

427 428 429 430 431 432
	ret = drm_hdmi_avi_infoframe_from_display_mode(&frame.avi,
						       adjusted_mode);
	if (ret < 0) {
		DRM_ERROR("couldn't fill AVI infoframe\n");
		return;
	}
P
Paulo Zanoni 已提交
433

434
	if (intel_hdmi->rgb_quant_range_selectable) {
435
		if (intel_crtc->config.limited_color_range)
436 437
			frame.avi.quantization_range =
				HDMI_QUANTIZATION_RANGE_LIMITED;
438
		else
439 440
			frame.avi.quantization_range =
				HDMI_QUANTIZATION_RANGE_FULL;
441 442
	}

443
	intel_write_infoframe(encoder, &frame);
444 445
}

446
static void intel_hdmi_set_spd_infoframe(struct drm_encoder *encoder)
447
{
448 449 450 451 452 453 454 455
	union hdmi_infoframe frame;
	int ret;

	ret = hdmi_spd_infoframe_init(&frame.spd, "Intel", "Integrated gfx");
	if (ret < 0) {
		DRM_ERROR("couldn't fill SPD infoframe\n");
		return;
	}
456

457
	frame.spd.sdi = HDMI_SPD_SDI_PC;
458

459
	intel_write_infoframe(encoder, &frame);
460 461
}

462 463 464 465 466 467 468 469 470 471 472 473 474 475 476
static void
intel_hdmi_set_hdmi_infoframe(struct drm_encoder *encoder,
			      struct drm_display_mode *adjusted_mode)
{
	union hdmi_infoframe frame;
	int ret;

	ret = drm_hdmi_vendor_infoframe_from_display_mode(&frame.vendor.hdmi,
							  adjusted_mode);
	if (ret < 0)
		return;

	intel_write_infoframe(encoder, &frame);
}

477
static void g4x_set_infoframes(struct drm_encoder *encoder,
478
			       bool enable,
479 480
			       struct drm_display_mode *adjusted_mode)
{
481
	struct drm_i915_private *dev_priv = encoder->dev->dev_private;
482 483
	struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
	struct intel_hdmi *intel_hdmi = &intel_dig_port->hdmi;
484 485
	u32 reg = VIDEO_DIP_CTL;
	u32 val = I915_READ(reg);
486
	u32 port = VIDEO_DIP_PORT(intel_dig_port->port);
487

488 489
	assert_hdmi_port_disabled(intel_hdmi);

490 491 492 493 494 495 496 497 498 499 500
	/* If the registers were not initialized yet, they might be zeroes,
	 * which means we're selecting the AVI DIP and we're setting its
	 * frequency to once. This seems to really confuse the HW and make
	 * things stop working (the register spec says the AVI always needs to
	 * be sent every VSync). So here we avoid writing to the register more
	 * than we need and also explicitly select the AVI DIP and explicitly
	 * set its frequency to every VSync. Avoiding to write it twice seems to
	 * be enough to solve the problem, but being defensive shouldn't hurt us
	 * either. */
	val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;

501
	if (!enable) {
502 503 504 505
		if (!(val & VIDEO_DIP_ENABLE))
			return;
		val &= ~VIDEO_DIP_ENABLE;
		I915_WRITE(reg, val);
506
		POSTING_READ(reg);
507 508 509
		return;
	}

510 511 512 513
	if (port != (val & VIDEO_DIP_PORT_MASK)) {
		if (val & VIDEO_DIP_ENABLE) {
			val &= ~VIDEO_DIP_ENABLE;
			I915_WRITE(reg, val);
514
			POSTING_READ(reg);
515 516 517 518 519
		}
		val &= ~VIDEO_DIP_PORT_MASK;
		val |= port;
	}

520
	val |= VIDEO_DIP_ENABLE;
521
	val &= ~VIDEO_DIP_ENABLE_VENDOR;
522

523
	I915_WRITE(reg, val);
524
	POSTING_READ(reg);
525

526 527
	intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
	intel_hdmi_set_spd_infoframe(encoder);
528
	intel_hdmi_set_hdmi_infoframe(encoder, adjusted_mode);
529 530 531
}

static void ibx_set_infoframes(struct drm_encoder *encoder,
532
			       bool enable,
533 534
			       struct drm_display_mode *adjusted_mode)
{
535 536
	struct drm_i915_private *dev_priv = encoder->dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
537 538
	struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
	struct intel_hdmi *intel_hdmi = &intel_dig_port->hdmi;
539 540
	u32 reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
	u32 val = I915_READ(reg);
541
	u32 port = VIDEO_DIP_PORT(intel_dig_port->port);
542

543 544
	assert_hdmi_port_disabled(intel_hdmi);

545 546 547
	/* See the big comment in g4x_set_infoframes() */
	val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;

548
	if (!enable) {
549 550 551 552
		if (!(val & VIDEO_DIP_ENABLE))
			return;
		val &= ~VIDEO_DIP_ENABLE;
		I915_WRITE(reg, val);
553
		POSTING_READ(reg);
554 555 556
		return;
	}

557 558 559 560
	if (port != (val & VIDEO_DIP_PORT_MASK)) {
		if (val & VIDEO_DIP_ENABLE) {
			val &= ~VIDEO_DIP_ENABLE;
			I915_WRITE(reg, val);
561
			POSTING_READ(reg);
562 563 564 565 566
		}
		val &= ~VIDEO_DIP_PORT_MASK;
		val |= port;
	}

567
	val |= VIDEO_DIP_ENABLE;
568 569
	val &= ~(VIDEO_DIP_ENABLE_VENDOR | VIDEO_DIP_ENABLE_GAMUT |
		 VIDEO_DIP_ENABLE_GCP);
570

571
	I915_WRITE(reg, val);
572
	POSTING_READ(reg);
573

574 575
	intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
	intel_hdmi_set_spd_infoframe(encoder);
576
	intel_hdmi_set_hdmi_infoframe(encoder, adjusted_mode);
577 578 579
}

static void cpt_set_infoframes(struct drm_encoder *encoder,
580
			       bool enable,
581 582
			       struct drm_display_mode *adjusted_mode)
{
583 584 585 586 587 588
	struct drm_i915_private *dev_priv = encoder->dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
	u32 reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
	u32 val = I915_READ(reg);

589 590
	assert_hdmi_port_disabled(intel_hdmi);

591 592 593
	/* See the big comment in g4x_set_infoframes() */
	val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;

594
	if (!enable) {
595 596 597 598
		if (!(val & VIDEO_DIP_ENABLE))
			return;
		val &= ~(VIDEO_DIP_ENABLE | VIDEO_DIP_ENABLE_AVI);
		I915_WRITE(reg, val);
599
		POSTING_READ(reg);
600 601 602
		return;
	}

603 604
	/* Set both together, unset both together: see the spec. */
	val |= VIDEO_DIP_ENABLE | VIDEO_DIP_ENABLE_AVI;
605 606
	val &= ~(VIDEO_DIP_ENABLE_VENDOR | VIDEO_DIP_ENABLE_GAMUT |
		 VIDEO_DIP_ENABLE_GCP);
607 608

	I915_WRITE(reg, val);
609
	POSTING_READ(reg);
610

611 612
	intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
	intel_hdmi_set_spd_infoframe(encoder);
613
	intel_hdmi_set_hdmi_infoframe(encoder, adjusted_mode);
614 615 616
}

static void vlv_set_infoframes(struct drm_encoder *encoder,
617
			       bool enable,
618 619
			       struct drm_display_mode *adjusted_mode)
{
620
	struct drm_i915_private *dev_priv = encoder->dev->dev_private;
621
	struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
622 623 624 625
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
	u32 reg = VLV_TVIDEO_DIP_CTL(intel_crtc->pipe);
	u32 val = I915_READ(reg);
626
	u32 port = VIDEO_DIP_PORT(intel_dig_port->port);
627

628 629
	assert_hdmi_port_disabled(intel_hdmi);

630 631 632
	/* See the big comment in g4x_set_infoframes() */
	val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;

633
	if (!enable) {
634 635 636 637
		if (!(val & VIDEO_DIP_ENABLE))
			return;
		val &= ~VIDEO_DIP_ENABLE;
		I915_WRITE(reg, val);
638
		POSTING_READ(reg);
639 640 641
		return;
	}

642 643 644 645 646 647 648 649 650 651
	if (port != (val & VIDEO_DIP_PORT_MASK)) {
		if (val & VIDEO_DIP_ENABLE) {
			val &= ~VIDEO_DIP_ENABLE;
			I915_WRITE(reg, val);
			POSTING_READ(reg);
		}
		val &= ~VIDEO_DIP_PORT_MASK;
		val |= port;
	}

652
	val |= VIDEO_DIP_ENABLE;
653 654
	val &= ~(VIDEO_DIP_ENABLE_AVI | VIDEO_DIP_ENABLE_VENDOR |
		 VIDEO_DIP_ENABLE_GAMUT | VIDEO_DIP_ENABLE_GCP);
655 656

	I915_WRITE(reg, val);
657
	POSTING_READ(reg);
658

659 660
	intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
	intel_hdmi_set_spd_infoframe(encoder);
661
	intel_hdmi_set_hdmi_infoframe(encoder, adjusted_mode);
662 663 664
}

static void hsw_set_infoframes(struct drm_encoder *encoder,
665
			       bool enable,
666 667
			       struct drm_display_mode *adjusted_mode)
{
668 669 670
	struct drm_i915_private *dev_priv = encoder->dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
671
	u32 reg = HSW_TVIDEO_DIP_CTL(intel_crtc->config.cpu_transcoder);
672
	u32 val = I915_READ(reg);
673

674 675
	assert_hdmi_port_disabled(intel_hdmi);

676
	if (!enable) {
677
		I915_WRITE(reg, 0);
678
		POSTING_READ(reg);
679 680 681
		return;
	}

682 683 684 685
	val &= ~(VIDEO_DIP_ENABLE_VSC_HSW | VIDEO_DIP_ENABLE_GCP_HSW |
		 VIDEO_DIP_ENABLE_VS_HSW | VIDEO_DIP_ENABLE_GMP_HSW);

	I915_WRITE(reg, val);
686
	POSTING_READ(reg);
687

688 689
	intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
	intel_hdmi_set_spd_infoframe(encoder);
690
	intel_hdmi_set_hdmi_infoframe(encoder, adjusted_mode);
691 692
}

693
static void intel_hdmi_prepare(struct intel_encoder *encoder)
694
{
695
	struct drm_device *dev = encoder->base.dev;
696
	struct drm_i915_private *dev_priv = dev->dev_private;
697 698 699
	struct intel_crtc *crtc = to_intel_crtc(encoder->base.crtc);
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
	struct drm_display_mode *adjusted_mode = &crtc->config.adjusted_mode;
700
	u32 hdmi_val;
701

702
	hdmi_val = SDVO_ENCODING_HDMI;
703
	if (!HAS_PCH_SPLIT(dev))
704
		hdmi_val |= intel_hdmi->color_range;
705
	if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
706
		hdmi_val |= SDVO_VSYNC_ACTIVE_HIGH;
707
	if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
708
		hdmi_val |= SDVO_HSYNC_ACTIVE_HIGH;
709

710
	if (crtc->config.pipe_bpp > 24)
711
		hdmi_val |= HDMI_COLOR_FORMAT_12bpc;
712
	else
713
		hdmi_val |= SDVO_COLOR_FORMAT_8bpc;
714

715
	if (crtc->config.has_hdmi_sink)
716
		hdmi_val |= HDMI_MODE_SELECT_HDMI;
717

718
	if (HAS_PCH_CPT(dev))
719
		hdmi_val |= SDVO_PIPE_SEL_CPT(crtc->pipe);
720 721
	else if (IS_CHERRYVIEW(dev))
		hdmi_val |= SDVO_PIPE_SEL_CHV(crtc->pipe);
722
	else
723
		hdmi_val |= SDVO_PIPE_SEL(crtc->pipe);
724

725 726
	I915_WRITE(intel_hdmi->hdmi_reg, hdmi_val);
	POSTING_READ(intel_hdmi->hdmi_reg);
727 728
}

729 730
static bool intel_hdmi_get_hw_state(struct intel_encoder *encoder,
				    enum pipe *pipe)
731
{
732
	struct drm_device *dev = encoder->base.dev;
733
	struct drm_i915_private *dev_priv = dev->dev_private;
734
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
735
	enum intel_display_power_domain power_domain;
736 737
	u32 tmp;

738
	power_domain = intel_display_port_power_domain(encoder);
739
	if (!intel_display_power_is_enabled(dev_priv, power_domain))
740 741
		return false;

742
	tmp = I915_READ(intel_hdmi->hdmi_reg);
743 744 745 746 747 748

	if (!(tmp & SDVO_ENABLE))
		return false;

	if (HAS_PCH_CPT(dev))
		*pipe = PORT_TO_PIPE_CPT(tmp);
749 750
	else if (IS_CHERRYVIEW(dev))
		*pipe = SDVO_PORT_TO_PIPE_CHV(tmp);
751 752 753 754 755 756
	else
		*pipe = PORT_TO_PIPE(tmp);

	return true;
}

757 758 759 760
static void intel_hdmi_get_config(struct intel_encoder *encoder,
				  struct intel_crtc_config *pipe_config)
{
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
761 762
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
763
	u32 tmp, flags = 0;
764
	int dotclock;
765 766 767 768 769 770 771 772 773 774 775 776 777

	tmp = I915_READ(intel_hdmi->hdmi_reg);

	if (tmp & SDVO_HSYNC_ACTIVE_HIGH)
		flags |= DRM_MODE_FLAG_PHSYNC;
	else
		flags |= DRM_MODE_FLAG_NHSYNC;

	if (tmp & SDVO_VSYNC_ACTIVE_HIGH)
		flags |= DRM_MODE_FLAG_PVSYNC;
	else
		flags |= DRM_MODE_FLAG_NVSYNC;

778 779 780
	if (tmp & HDMI_MODE_SELECT_HDMI)
		pipe_config->has_hdmi_sink = true;

781 782 783
	if (intel_hdmi->infoframe_enabled(&encoder->base))
		pipe_config->has_infoframe = true;

784
	if (tmp & SDVO_AUDIO_ENABLE)
785 786
		pipe_config->has_audio = true;

787 788 789 790
	if (!HAS_PCH_SPLIT(dev) &&
	    tmp & HDMI_COLOR_RANGE_16_235)
		pipe_config->limited_color_range = true;

791
	pipe_config->adjusted_mode.flags |= flags;
792 793 794 795 796 797 798 799 800

	if ((tmp & SDVO_COLOR_FORMAT_MASK) == HDMI_COLOR_FORMAT_12bpc)
		dotclock = pipe_config->port_clock * 2 / 3;
	else
		dotclock = pipe_config->port_clock;

	if (HAS_PCH_SPLIT(dev_priv->dev))
		ironlake_check_encoder_dotclock(pipe_config, dotclock);

801
	pipe_config->adjusted_mode.crtc_clock = dotclock;
802 803
}

804
static void intel_enable_hdmi(struct intel_encoder *encoder)
805
{
806
	struct drm_device *dev = encoder->base.dev;
807
	struct drm_i915_private *dev_priv = dev->dev_private;
808
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
809
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
810
	u32 temp;
811 812
	u32 enable_bits = SDVO_ENABLE;

813
	if (intel_crtc->config.has_audio)
814
		enable_bits |= SDVO_AUDIO_ENABLE;
815

816
	temp = I915_READ(intel_hdmi->hdmi_reg);
817

818
	/* HW workaround for IBX, we need to move the port to transcoder A
819 820 821
	 * before disabling it, so restore the transcoder select bit here. */
	if (HAS_PCH_IBX(dev))
		enable_bits |= SDVO_PIPE_SEL(intel_crtc->pipe);
822

823 824 825
	/* HW workaround, need to toggle enable bit off and on for 12bpc, but
	 * we do this anyway which shows more stable in testing.
	 */
826
	if (HAS_PCH_SPLIT(dev)) {
827 828
		I915_WRITE(intel_hdmi->hdmi_reg, temp & ~SDVO_ENABLE);
		POSTING_READ(intel_hdmi->hdmi_reg);
829 830
	}

831 832
	temp |= enable_bits;

833 834
	I915_WRITE(intel_hdmi->hdmi_reg, temp);
	POSTING_READ(intel_hdmi->hdmi_reg);
835 836 837 838 839

	/* HW workaround, need to write this twice for issue that may result
	 * in first write getting masked.
	 */
	if (HAS_PCH_SPLIT(dev)) {
840 841
		I915_WRITE(intel_hdmi->hdmi_reg, temp);
		POSTING_READ(intel_hdmi->hdmi_reg);
842
	}
843 844 845 846 847 848 849

	if (intel_crtc->config.has_audio) {
		WARN_ON(!intel_crtc->config.has_hdmi_sink);
		DRM_DEBUG_DRIVER("Enabling HDMI audio on pipe %c\n",
				 pipe_name(intel_crtc->pipe));
		intel_audio_codec_enable(encoder);
	}
850
}
851

852 853
static void vlv_enable_hdmi(struct intel_encoder *encoder)
{
854 855 856 857 858 859 860
}

static void intel_disable_hdmi(struct intel_encoder *encoder)
{
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
861
	struct intel_crtc *crtc = to_intel_crtc(encoder->base.crtc);
862
	u32 temp;
863
	u32 enable_bits = SDVO_ENABLE | SDVO_AUDIO_ENABLE;
864

865 866 867
	if (crtc->config.has_audio)
		intel_audio_codec_disable(encoder);

868
	temp = I915_READ(intel_hdmi->hdmi_reg);
869 870 871 872 873 874 875 876 877

	/* HW workaround for IBX, we need to move the port to transcoder A
	 * before disabling it. */
	if (HAS_PCH_IBX(dev)) {
		struct drm_crtc *crtc = encoder->base.crtc;
		int pipe = crtc ? to_intel_crtc(crtc)->pipe : -1;

		if (temp & SDVO_PIPE_B_SELECT) {
			temp &= ~SDVO_PIPE_B_SELECT;
878 879
			I915_WRITE(intel_hdmi->hdmi_reg, temp);
			POSTING_READ(intel_hdmi->hdmi_reg);
880 881

			/* Again we need to write this twice. */
882 883
			I915_WRITE(intel_hdmi->hdmi_reg, temp);
			POSTING_READ(intel_hdmi->hdmi_reg);
884 885 886 887 888 889 890 891

			/* Transcoder selection bits only update
			 * effectively on vblank. */
			if (crtc)
				intel_wait_for_vblank(dev, pipe);
			else
				msleep(50);
		}
892
	}
893

894 895 896 897
	/* HW workaround, need to toggle enable bit off and on for 12bpc, but
	 * we do this anyway which shows more stable in testing.
	 */
	if (HAS_PCH_SPLIT(dev)) {
898 899
		I915_WRITE(intel_hdmi->hdmi_reg, temp & ~SDVO_ENABLE);
		POSTING_READ(intel_hdmi->hdmi_reg);
900 901 902
	}

	temp &= ~enable_bits;
903

904 905
	I915_WRITE(intel_hdmi->hdmi_reg, temp);
	POSTING_READ(intel_hdmi->hdmi_reg);
906 907 908 909

	/* HW workaround, need to write this twice for issue that may result
	 * in first write getting masked.
	 */
910
	if (HAS_PCH_SPLIT(dev)) {
911 912
		I915_WRITE(intel_hdmi->hdmi_reg, temp);
		POSTING_READ(intel_hdmi->hdmi_reg);
913
	}
914 915
}

916
static int hdmi_portclock_limit(struct intel_hdmi *hdmi, bool respect_dvi_limit)
917 918 919
{
	struct drm_device *dev = intel_hdmi_to_dev(hdmi);

920
	if ((respect_dvi_limit && !hdmi->has_hdmi_sink) || IS_G4X(dev))
921
		return 165000;
922
	else if (IS_HASWELL(dev) || INTEL_INFO(dev)->gen >= 8)
923 924 925 926 927
		return 300000;
	else
		return 225000;
}

928 929 930
static enum drm_mode_status
intel_hdmi_mode_valid(struct drm_connector *connector,
		      struct drm_display_mode *mode)
931
{
932 933 934 935 936 937 938
	int clock = mode->clock;

	if (mode->flags & DRM_MODE_FLAG_DBLCLK)
		clock *= 2;

	if (clock > hdmi_portclock_limit(intel_attached_hdmi(connector),
					 true))
939
		return MODE_CLOCK_HIGH;
940
	if (clock < 20000)
941
		return MODE_CLOCK_LOW;
942 943 944 945 946 947 948

	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
		return MODE_NO_DBLESCAN;

	return MODE_OK;
}

949 950 951 952 953 954
static bool hdmi_12bpc_possible(struct intel_crtc *crtc)
{
	struct drm_device *dev = crtc->base.dev;
	struct intel_encoder *encoder;
	int count = 0, count_hdmi = 0;

955
	if (HAS_GMCH_DISPLAY(dev))
956 957
		return false;

958
	for_each_intel_encoder(dev, encoder) {
959 960 961 962 963 964 965 966 967 968 969 970 971 972
		if (encoder->new_crtc != crtc)
			continue;

		count_hdmi += encoder->type == INTEL_OUTPUT_HDMI;
		count++;
	}

	/*
	 * HDMI 12bpc affects the clocks, so it's only possible
	 * when not cloning with other encoder types.
	 */
	return count_hdmi > 0 && count_hdmi == count;
}

973 974
bool intel_hdmi_compute_config(struct intel_encoder *encoder,
			       struct intel_crtc_config *pipe_config)
975
{
976 977 978
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
	struct drm_device *dev = encoder->base.dev;
	struct drm_display_mode *adjusted_mode = &pipe_config->adjusted_mode;
979
	int clock_12bpc = pipe_config->adjusted_mode.crtc_clock * 3 / 2;
980
	int portclock_limit = hdmi_portclock_limit(intel_hdmi, false);
981
	int desired_bpp;
982

983 984
	pipe_config->has_hdmi_sink = intel_hdmi->has_hdmi_sink;

985 986 987
	if (pipe_config->has_hdmi_sink)
		pipe_config->has_infoframe = true;

988 989
	if (intel_hdmi->color_range_auto) {
		/* See CEA-861-E - 5.1 Default Encoding Parameters */
990
		if (pipe_config->has_hdmi_sink &&
991
		    drm_match_cea_mode(adjusted_mode) > 1)
992
			intel_hdmi->color_range = HDMI_COLOR_RANGE_16_235;
993 994 995 996
		else
			intel_hdmi->color_range = 0;
	}

997 998 999 1000
	if (adjusted_mode->flags & DRM_MODE_FLAG_DBLCLK) {
		pipe_config->pixel_multiplier = 2;
	}

1001
	if (intel_hdmi->color_range)
1002
		pipe_config->limited_color_range = true;
1003

1004 1005 1006
	if (HAS_PCH_SPLIT(dev) && !HAS_DDI(dev))
		pipe_config->has_pch_encoder = true;

1007 1008 1009
	if (pipe_config->has_hdmi_sink && intel_hdmi->has_audio)
		pipe_config->has_audio = true;

1010 1011 1012
	/*
	 * HDMI is either 12 or 8, so if the display lets 10bpc sneak
	 * through, clamp it down. Note that g4x/vlv don't support 12bpc hdmi
1013 1014
	 * outputs. We also need to check that the higher clock still fits
	 * within limits.
1015
	 */
1016
	if (pipe_config->pipe_bpp > 8*3 && pipe_config->has_hdmi_sink &&
1017 1018
	    clock_12bpc <= portclock_limit &&
	    hdmi_12bpc_possible(encoder->new_crtc)) {
1019 1020
		DRM_DEBUG_KMS("picking bpc to 12 for HDMI output\n");
		desired_bpp = 12*3;
1021 1022

		/* Need to adjust the port link by 1.5x for 12bpc. */
1023
		pipe_config->port_clock = clock_12bpc;
1024
	} else {
1025 1026 1027 1028 1029 1030 1031
		DRM_DEBUG_KMS("picking bpc to 8 for HDMI output\n");
		desired_bpp = 8*3;
	}

	if (!pipe_config->bw_constrained) {
		DRM_DEBUG_KMS("forcing pipe bpc to %i for HDMI\n", desired_bpp);
		pipe_config->pipe_bpp = desired_bpp;
1032 1033
	}

1034
	if (adjusted_mode->crtc_clock > portclock_limit) {
1035 1036 1037 1038
		DRM_DEBUG_KMS("too high HDMI clock, rejecting mode\n");
		return false;
	}

1039 1040 1041
	return true;
}

1042 1043
static void
intel_hdmi_unset_edid(struct drm_connector *connector)
1044
{
1045
	struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
1046

1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064
	intel_hdmi->has_hdmi_sink = false;
	intel_hdmi->has_audio = false;
	intel_hdmi->rgb_quant_range_selectable = false;

	kfree(to_intel_connector(connector)->detect_edid);
	to_intel_connector(connector)->detect_edid = NULL;
}

static bool
intel_hdmi_set_edid(struct drm_connector *connector)
{
	struct drm_i915_private *dev_priv = to_i915(connector->dev);
	struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
	struct intel_encoder *intel_encoder =
		&hdmi_to_dig_port(intel_hdmi)->base;
	enum intel_display_power_domain power_domain;
	struct edid *edid;
	bool connected = false;
1065

1066 1067 1068
	power_domain = intel_display_port_power_domain(intel_encoder);
	intel_display_power_get(dev_priv, power_domain);

1069
	edid = drm_get_edid(connector,
1070 1071
			    intel_gmbus_get_adapter(dev_priv,
						    intel_hdmi->ddc_bus));
1072

1073
	intel_display_power_put(dev_priv, power_domain);
1074

1075 1076 1077 1078 1079 1080
	to_intel_connector(connector)->detect_edid = edid;
	if (edid && edid->input & DRM_EDID_INPUT_DIGITAL) {
		intel_hdmi->rgb_quant_range_selectable =
			drm_rgb_quant_range_selectable(edid);

		intel_hdmi->has_audio = drm_detect_monitor_audio(edid);
1081 1082
		if (intel_hdmi->force_audio != HDMI_AUDIO_AUTO)
			intel_hdmi->has_audio =
1083 1084 1085 1086 1087 1088 1089
				intel_hdmi->force_audio == HDMI_AUDIO_ON;

		if (intel_hdmi->force_audio != HDMI_AUDIO_OFF_DVI)
			intel_hdmi->has_hdmi_sink =
				drm_detect_hdmi_monitor(edid);

		connected = true;
1090 1091
	}

1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111
	return connected;
}

static enum drm_connector_status
intel_hdmi_detect(struct drm_connector *connector, bool force)
{
	enum drm_connector_status status;

	DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n",
		      connector->base.id, connector->name);

	intel_hdmi_unset_edid(connector);

	if (intel_hdmi_set_edid(connector)) {
		struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);

		hdmi_to_dig_port(intel_hdmi)->base.type = INTEL_OUTPUT_HDMI;
		status = connector_status_connected;
	} else
		status = connector_status_disconnected;
1112

1113
	return status;
1114 1115
}

1116 1117
static void
intel_hdmi_force(struct drm_connector *connector)
1118
{
1119
	struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
1120

1121 1122
	DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n",
		      connector->base.id, connector->name);
1123

1124
	intel_hdmi_unset_edid(connector);
1125

1126 1127
	if (connector->status != connector_status_connected)
		return;
1128

1129 1130 1131
	intel_hdmi_set_edid(connector);
	hdmi_to_dig_port(intel_hdmi)->base.type = INTEL_OUTPUT_HDMI;
}
1132

1133 1134 1135 1136 1137 1138 1139
static int intel_hdmi_get_modes(struct drm_connector *connector)
{
	struct edid *edid;

	edid = to_intel_connector(connector)->detect_edid;
	if (edid == NULL)
		return 0;
1140

1141
	return intel_connector_update_modes(connector, edid);
1142 1143
}

1144 1145 1146 1147
static bool
intel_hdmi_detect_audio(struct drm_connector *connector)
{
	bool has_audio = false;
1148
	struct edid *edid;
1149

1150 1151 1152
	edid = to_intel_connector(connector)->detect_edid;
	if (edid && edid->input & DRM_EDID_INPUT_DIGITAL)
		has_audio = drm_detect_monitor_audio(edid);
1153

1154 1155 1156
	return has_audio;
}

1157 1158
static int
intel_hdmi_set_property(struct drm_connector *connector,
1159 1160
			struct drm_property *property,
			uint64_t val)
1161 1162
{
	struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
1163 1164
	struct intel_digital_port *intel_dig_port =
		hdmi_to_dig_port(intel_hdmi);
1165
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
1166 1167
	int ret;

1168
	ret = drm_object_property_set_value(&connector->base, property, val);
1169 1170 1171
	if (ret)
		return ret;

1172
	if (property == dev_priv->force_audio_property) {
1173
		enum hdmi_force_audio i = val;
1174 1175 1176
		bool has_audio;

		if (i == intel_hdmi->force_audio)
1177 1178
			return 0;

1179
		intel_hdmi->force_audio = i;
1180

1181
		if (i == HDMI_AUDIO_AUTO)
1182 1183
			has_audio = intel_hdmi_detect_audio(connector);
		else
1184
			has_audio = (i == HDMI_AUDIO_ON);
1185

1186 1187
		if (i == HDMI_AUDIO_OFF_DVI)
			intel_hdmi->has_hdmi_sink = 0;
1188

1189
		intel_hdmi->has_audio = has_audio;
1190 1191 1192
		goto done;
	}

1193
	if (property == dev_priv->broadcast_rgb_property) {
1194 1195 1196
		bool old_auto = intel_hdmi->color_range_auto;
		uint32_t old_range = intel_hdmi->color_range;

1197 1198 1199 1200 1201 1202 1203 1204 1205 1206
		switch (val) {
		case INTEL_BROADCAST_RGB_AUTO:
			intel_hdmi->color_range_auto = true;
			break;
		case INTEL_BROADCAST_RGB_FULL:
			intel_hdmi->color_range_auto = false;
			intel_hdmi->color_range = 0;
			break;
		case INTEL_BROADCAST_RGB_LIMITED:
			intel_hdmi->color_range_auto = false;
1207
			intel_hdmi->color_range = HDMI_COLOR_RANGE_16_235;
1208 1209 1210 1211
			break;
		default:
			return -EINVAL;
		}
1212 1213 1214 1215 1216

		if (old_auto == intel_hdmi->color_range_auto &&
		    old_range == intel_hdmi->color_range)
			return 0;

1217 1218 1219
		goto done;
	}

1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236
	if (property == connector->dev->mode_config.aspect_ratio_property) {
		switch (val) {
		case DRM_MODE_PICTURE_ASPECT_NONE:
			intel_hdmi->aspect_ratio = HDMI_PICTURE_ASPECT_NONE;
			break;
		case DRM_MODE_PICTURE_ASPECT_4_3:
			intel_hdmi->aspect_ratio = HDMI_PICTURE_ASPECT_4_3;
			break;
		case DRM_MODE_PICTURE_ASPECT_16_9:
			intel_hdmi->aspect_ratio = HDMI_PICTURE_ASPECT_16_9;
			break;
		default:
			return -EINVAL;
		}
		goto done;
	}

1237 1238 1239
	return -EINVAL;

done:
1240 1241
	if (intel_dig_port->base.base.crtc)
		intel_crtc_restore_mode(intel_dig_port->base.base.crtc);
1242 1243 1244 1245

	return 0;
}

1246 1247 1248 1249 1250 1251 1252
static void intel_hdmi_pre_enable(struct intel_encoder *encoder)
{
	struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
	struct drm_display_mode *adjusted_mode =
		&intel_crtc->config.adjusted_mode;

1253 1254
	intel_hdmi_prepare(encoder);

1255 1256 1257
	intel_hdmi->set_infoframes(&encoder->base,
				   intel_crtc->config.has_hdmi_sink,
				   adjusted_mode);
1258 1259
}

1260
static void vlv_hdmi_pre_enable(struct intel_encoder *encoder)
1261 1262
{
	struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
1263
	struct intel_hdmi *intel_hdmi = &dport->hdmi;
1264 1265 1266 1267
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc =
		to_intel_crtc(encoder->base.crtc);
1268 1269
	struct drm_display_mode *adjusted_mode =
		&intel_crtc->config.adjusted_mode;
1270
	enum dpio_channel port = vlv_dport_to_channel(dport);
1271 1272 1273 1274
	int pipe = intel_crtc->pipe;
	u32 val;

	/* Enable clock channels for this port */
1275
	mutex_lock(&dev_priv->dpio_lock);
1276
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW8(port));
1277 1278 1279 1280 1281 1282
	val = 0;
	if (pipe)
		val |= (1<<21);
	else
		val &= ~(1<<21);
	val |= 0x001000c4;
1283
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW8(port), val);
1284 1285

	/* HDMI 1.0V-2dB */
1286 1287 1288 1289 1290 1291 1292 1293
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW5(port), 0);
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW4(port), 0x2b245f5f);
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW2(port), 0x5578b83a);
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW3(port), 0x0c782040);
	vlv_dpio_write(dev_priv, pipe, VLV_TX3_DW4(port), 0x2b247878);
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW11(port), 0x00030000);
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW9(port), 0x00002000);
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW5(port), DPIO_TX_OCALINIT_EN);
1294 1295

	/* Program lane clock */
1296 1297
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW14(port), 0x00760018);
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW23(port), 0x00400888);
1298
	mutex_unlock(&dev_priv->dpio_lock);
1299

1300 1301 1302
	intel_hdmi->set_infoframes(&encoder->base,
				   intel_crtc->config.has_hdmi_sink,
				   adjusted_mode);
1303

1304 1305
	intel_enable_hdmi(encoder);

1306
	vlv_wait_port_ready(dev_priv, dport);
1307 1308
}

1309
static void vlv_hdmi_pre_pll_enable(struct intel_encoder *encoder)
1310 1311 1312 1313
{
	struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
1314 1315
	struct intel_crtc *intel_crtc =
		to_intel_crtc(encoder->base.crtc);
1316
	enum dpio_channel port = vlv_dport_to_channel(dport);
1317
	int pipe = intel_crtc->pipe;
1318

1319 1320
	intel_hdmi_prepare(encoder);

1321
	/* Program Tx lane resets to default */
1322
	mutex_lock(&dev_priv->dpio_lock);
1323
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW0(port),
1324 1325
			 DPIO_PCS_TX_LANE2_RESET |
			 DPIO_PCS_TX_LANE1_RESET);
1326
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW1(port),
1327 1328 1329 1330 1331 1332
			 DPIO_PCS_CLK_CRI_RXEB_EIOS_EN |
			 DPIO_PCS_CLK_CRI_RXDIGFILTSG_EN |
			 (1<<DPIO_PCS_CLK_DATAWIDTH_SHIFT) |
			 DPIO_PCS_CLK_SOFT_RESET);

	/* Fix up inter-pair skew failure */
1333 1334 1335 1336 1337 1338
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW12(port), 0x00750f00);
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW11(port), 0x00001500);
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW14(port), 0x40400000);

	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW9(port), 0x00002000);
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW5(port), DPIO_TX_OCALINIT_EN);
1339
	mutex_unlock(&dev_priv->dpio_lock);
1340 1341
}

1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352
static void chv_hdmi_pre_pll_enable(struct intel_encoder *encoder)
{
	struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc =
		to_intel_crtc(encoder->base.crtc);
	enum dpio_channel ch = vlv_dport_to_channel(dport);
	enum pipe pipe = intel_crtc->pipe;
	u32 val;

1353 1354
	intel_hdmi_prepare(encoder);

1355 1356
	mutex_lock(&dev_priv->dpio_lock);

1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375
	/* program left/right clock distribution */
	if (pipe != PIPE_B) {
		val = vlv_dpio_read(dev_priv, pipe, _CHV_CMN_DW5_CH0);
		val &= ~(CHV_BUFLEFTENA1_MASK | CHV_BUFRIGHTENA1_MASK);
		if (ch == DPIO_CH0)
			val |= CHV_BUFLEFTENA1_FORCE;
		if (ch == DPIO_CH1)
			val |= CHV_BUFRIGHTENA1_FORCE;
		vlv_dpio_write(dev_priv, pipe, _CHV_CMN_DW5_CH0, val);
	} else {
		val = vlv_dpio_read(dev_priv, pipe, _CHV_CMN_DW1_CH1);
		val &= ~(CHV_BUFLEFTENA2_MASK | CHV_BUFRIGHTENA2_MASK);
		if (ch == DPIO_CH0)
			val |= CHV_BUFLEFTENA2_FORCE;
		if (ch == DPIO_CH1)
			val |= CHV_BUFRIGHTENA2_FORCE;
		vlv_dpio_write(dev_priv, pipe, _CHV_CMN_DW1_CH1, val);
	}

1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407
	/* program clock channel usage */
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW8(ch));
	val |= CHV_PCS_USEDCLKCHANNEL_OVRRIDE;
	if (pipe != PIPE_B)
		val &= ~CHV_PCS_USEDCLKCHANNEL;
	else
		val |= CHV_PCS_USEDCLKCHANNEL;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW8(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW8(ch));
	val |= CHV_PCS_USEDCLKCHANNEL_OVRRIDE;
	if (pipe != PIPE_B)
		val &= ~CHV_PCS_USEDCLKCHANNEL;
	else
		val |= CHV_PCS_USEDCLKCHANNEL;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW8(ch), val);

	/*
	 * This a a bit weird since generally CL
	 * matches the pipe, but here we need to
	 * pick the CL based on the port.
	 */
	val = vlv_dpio_read(dev_priv, pipe, CHV_CMN_DW19(ch));
	if (pipe != PIPE_B)
		val &= ~CHV_CMN_USEDCLKCHANNEL;
	else
		val |= CHV_CMN_USEDCLKCHANNEL;
	vlv_dpio_write(dev_priv, pipe, CHV_CMN_DW19(ch), val);

	mutex_unlock(&dev_priv->dpio_lock);
}

1408
static void vlv_hdmi_post_disable(struct intel_encoder *encoder)
1409 1410 1411
{
	struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
1412 1413
	struct intel_crtc *intel_crtc =
		to_intel_crtc(encoder->base.crtc);
1414
	enum dpio_channel port = vlv_dport_to_channel(dport);
1415
	int pipe = intel_crtc->pipe;
1416 1417 1418

	/* Reset lanes to avoid HDMI flicker (VLV w/a) */
	mutex_lock(&dev_priv->dpio_lock);
1419 1420
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW0(port), 0x00000000);
	vlv_dpio_write(dev_priv, pipe, VLV_PCS_DW1(port), 0x00e00060);
1421 1422 1423
	mutex_unlock(&dev_priv->dpio_lock);
}

1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437
static void chv_hdmi_post_disable(struct intel_encoder *encoder)
{
	struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc =
		to_intel_crtc(encoder->base.crtc);
	enum dpio_channel ch = vlv_dport_to_channel(dport);
	enum pipe pipe = intel_crtc->pipe;
	u32 val;

	mutex_lock(&dev_priv->dpio_lock);

	/* Propagate soft reset to data lane reset */
1438
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW1(ch));
1439
	val |= CHV_PCS_REQ_SOFTRESET_EN;
1440
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW1(ch), val);
1441

1442 1443 1444 1445 1446 1447 1448 1449 1450
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW1(ch));
	val |= CHV_PCS_REQ_SOFTRESET_EN;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW1(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW0(ch));
	val &= ~(DPIO_PCS_TX_LANE2_RESET | DPIO_PCS_TX_LANE1_RESET);
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW0(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW0(ch));
1451
	val &= ~(DPIO_PCS_TX_LANE2_RESET | DPIO_PCS_TX_LANE1_RESET);
1452
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW0(ch), val);
1453 1454 1455 1456

	mutex_unlock(&dev_priv->dpio_lock);
}

1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469
static void chv_hdmi_pre_enable(struct intel_encoder *encoder)
{
	struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc =
		to_intel_crtc(encoder->base.crtc);
	enum dpio_channel ch = vlv_dport_to_channel(dport);
	int pipe = intel_crtc->pipe;
	int data, i;
	u32 val;

	mutex_lock(&dev_priv->dpio_lock);
1470

1471 1472 1473 1474 1475 1476 1477 1478 1479
	/* allow hardware to manage TX FIFO reset source */
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW11(ch));
	val &= ~DPIO_LANEDESKEW_STRAP_OVRD;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW11(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW11(ch));
	val &= ~DPIO_LANEDESKEW_STRAP_OVRD;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW11(ch), val);

1480
	/* Deassert soft data lane reset*/
1481
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW1(ch));
1482
	val |= CHV_PCS_REQ_SOFTRESET_EN;
1483 1484 1485 1486 1487 1488 1489 1490 1491
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW1(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW1(ch));
	val |= CHV_PCS_REQ_SOFTRESET_EN;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW1(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW0(ch));
	val |= (DPIO_PCS_TX_LANE2_RESET | DPIO_PCS_TX_LANE1_RESET);
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW0(ch), val);
1492

1493
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW0(ch));
1494
	val |= (DPIO_PCS_TX_LANE2_RESET | DPIO_PCS_TX_LANE1_RESET);
1495
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW0(ch), val);
1496 1497

	/* Program Tx latency optimal setting */
1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513
	for (i = 0; i < 4; i++) {
		/* Set the latency optimal bit */
		data = (i == 1) ? 0x0 : 0x6;
		vlv_dpio_write(dev_priv, pipe, CHV_TX_DW11(ch, i),
				data << DPIO_FRC_LATENCY_SHFIT);

		/* Set the upar bit */
		data = (i == 1) ? 0x0 : 0x1;
		vlv_dpio_write(dev_priv, pipe, CHV_TX_DW14(ch, i),
				data << DPIO_UPAR_SHIFT);
	}

	/* Data lane stagger programming */
	/* FIXME: Fix up value only after power analysis */

	/* Clear calc init */
1514 1515
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW10(ch));
	val &= ~(DPIO_PCS_SWING_CALC_TX0_TX2 | DPIO_PCS_SWING_CALC_TX1_TX3);
1516 1517
	val &= ~(DPIO_PCS_TX1DEEMP_MASK | DPIO_PCS_TX2DEEMP_MASK);
	val |= DPIO_PCS_TX1DEEMP_9P5 | DPIO_PCS_TX2DEEMP_9P5;
1518 1519 1520 1521
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW10(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW10(ch));
	val &= ~(DPIO_PCS_SWING_CALC_TX0_TX2 | DPIO_PCS_SWING_CALC_TX1_TX3);
1522 1523
	val &= ~(DPIO_PCS_TX1DEEMP_MASK | DPIO_PCS_TX2DEEMP_MASK);
	val |= DPIO_PCS_TX1DEEMP_9P5 | DPIO_PCS_TX2DEEMP_9P5;
1524
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW10(ch), val);
1525

1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW9(ch));
	val &= ~(DPIO_PCS_TX1MARGIN_MASK | DPIO_PCS_TX2MARGIN_MASK);
	val |= DPIO_PCS_TX1MARGIN_000 | DPIO_PCS_TX2MARGIN_000;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW9(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW9(ch));
	val &= ~(DPIO_PCS_TX1MARGIN_MASK | DPIO_PCS_TX2MARGIN_MASK);
	val |= DPIO_PCS_TX1MARGIN_000 | DPIO_PCS_TX2MARGIN_000;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW9(ch), val);

1536 1537
	/* FIXME: Program the support xxx V-dB */
	/* Use 800mV-0dB */
1538 1539 1540 1541 1542 1543
	for (i = 0; i < 4; i++) {
		val = vlv_dpio_read(dev_priv, pipe, CHV_TX_DW4(ch, i));
		val &= ~DPIO_SWING_DEEMPH9P5_MASK;
		val |= 128 << DPIO_SWING_DEEMPH9P5_SHIFT;
		vlv_dpio_write(dev_priv, pipe, CHV_TX_DW4(ch, i), val);
	}
1544

1545 1546
	for (i = 0; i < 4; i++) {
		val = vlv_dpio_read(dev_priv, pipe, CHV_TX_DW2(ch, i));
1547 1548
		val &= ~DPIO_SWING_MARGIN000_MASK;
		val |= 102 << DPIO_SWING_MARGIN000_SHIFT;
1549 1550
		vlv_dpio_write(dev_priv, pipe, CHV_TX_DW2(ch, i), val);
	}
1551 1552

	/* Disable unique transition scale */
1553 1554 1555 1556 1557
	for (i = 0; i < 4; i++) {
		val = vlv_dpio_read(dev_priv, pipe, CHV_TX_DW3(ch, i));
		val &= ~DPIO_TX_UNIQ_TRANS_SCALE_EN;
		vlv_dpio_write(dev_priv, pipe, CHV_TX_DW3(ch, i), val);
	}
1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572

	/* Additional steps for 1200mV-0dB */
#if 0
	val = vlv_dpio_read(dev_priv, pipe, VLV_TX_DW3(ch));
	if (ch)
		val |= DPIO_TX_UNIQ_TRANS_SCALE_CH1;
	else
		val |= DPIO_TX_UNIQ_TRANS_SCALE_CH0;
	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW3(ch), val);

	vlv_dpio_write(dev_priv, pipe, VLV_TX_DW2(ch),
			vlv_dpio_read(dev_priv, pipe, VLV_TX_DW2(ch)) |
				(0x9a << DPIO_UNIQ_TRANS_SCALE_SHIFT));
#endif
	/* Start swing calculation */
1573 1574 1575 1576 1577 1578 1579
	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS01_DW10(ch));
	val |= DPIO_PCS_SWING_CALC_TX0_TX2 | DPIO_PCS_SWING_CALC_TX1_TX3;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS01_DW10(ch), val);

	val = vlv_dpio_read(dev_priv, pipe, VLV_PCS23_DW10(ch));
	val |= DPIO_PCS_SWING_CALC_TX0_TX2 | DPIO_PCS_SWING_CALC_TX1_TX3;
	vlv_dpio_write(dev_priv, pipe, VLV_PCS23_DW10(ch), val);
1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592

	/* LRC Bypass */
	val = vlv_dpio_read(dev_priv, pipe, CHV_CMN_DW30);
	val |= DPIO_LRC_BYPASS;
	vlv_dpio_write(dev_priv, pipe, CHV_CMN_DW30, val);

	mutex_unlock(&dev_priv->dpio_lock);

	intel_enable_hdmi(encoder);

	vlv_wait_port_ready(dev_priv, dport);
}

1593 1594
static void intel_hdmi_destroy(struct drm_connector *connector)
{
1595
	kfree(to_intel_connector(connector)->detect_edid);
1596
	drm_connector_cleanup(connector);
1597
	kfree(connector);
1598 1599 1600
}

static const struct drm_connector_funcs intel_hdmi_connector_funcs = {
1601
	.dpms = intel_connector_dpms,
1602
	.detect = intel_hdmi_detect,
1603
	.force = intel_hdmi_force,
1604
	.fill_modes = drm_helper_probe_single_connector_modes,
1605
	.set_property = intel_hdmi_set_property,
1606 1607 1608 1609 1610 1611
	.destroy = intel_hdmi_destroy,
};

static const struct drm_connector_helper_funcs intel_hdmi_connector_helper_funcs = {
	.get_modes = intel_hdmi_get_modes,
	.mode_valid = intel_hdmi_mode_valid,
1612
	.best_encoder = intel_best_encoder,
1613 1614 1615
};

static const struct drm_encoder_funcs intel_hdmi_enc_funcs = {
C
Chris Wilson 已提交
1616
	.destroy = intel_encoder_destroy,
1617 1618
};

1619 1620 1621 1622 1623 1624 1625 1626 1627
static void
intel_attach_aspect_ratio_property(struct drm_connector *connector)
{
	if (!drm_mode_create_aspect_ratio_property(connector->dev))
		drm_object_attach_property(&connector->base,
			connector->dev->mode_config.aspect_ratio_property,
			DRM_MODE_PICTURE_ASPECT_NONE);
}

1628 1629 1630
static void
intel_hdmi_add_properties(struct intel_hdmi *intel_hdmi, struct drm_connector *connector)
{
1631
	intel_attach_force_audio_property(connector);
1632
	intel_attach_broadcast_rgb_property(connector);
1633
	intel_hdmi->color_range_auto = true;
1634 1635
	intel_attach_aspect_ratio_property(connector);
	intel_hdmi->aspect_ratio = HDMI_PICTURE_ASPECT_NONE;
1636 1637
}

P
Paulo Zanoni 已提交
1638 1639
void intel_hdmi_init_connector(struct intel_digital_port *intel_dig_port,
			       struct intel_connector *intel_connector)
1640
{
1641 1642 1643 1644
	struct drm_connector *connector = &intel_connector->base;
	struct intel_hdmi *intel_hdmi = &intel_dig_port->hdmi;
	struct intel_encoder *intel_encoder = &intel_dig_port->base;
	struct drm_device *dev = intel_encoder->base.dev;
1645
	struct drm_i915_private *dev_priv = dev->dev_private;
1646
	enum port port = intel_dig_port->port;
1647

1648
	drm_connector_init(dev, connector, &intel_hdmi_connector_funcs,
1649
			   DRM_MODE_CONNECTOR_HDMIA);
1650 1651
	drm_connector_helper_add(connector, &intel_hdmi_connector_helper_funcs);

1652
	connector->interlace_allowed = 1;
1653
	connector->doublescan_allowed = 0;
1654
	connector->stereo_allowed = 1;
1655

1656 1657
	switch (port) {
	case PORT_B:
1658
		intel_hdmi->ddc_bus = GMBUS_PORT_DPB;
1659
		intel_encoder->hpd_pin = HPD_PORT_B;
1660 1661
		break;
	case PORT_C:
1662
		intel_hdmi->ddc_bus = GMBUS_PORT_DPC;
1663
		intel_encoder->hpd_pin = HPD_PORT_C;
1664 1665
		break;
	case PORT_D:
1666 1667 1668 1669
		if (IS_CHERRYVIEW(dev))
			intel_hdmi->ddc_bus = GMBUS_PORT_DPD_CHV;
		else
			intel_hdmi->ddc_bus = GMBUS_PORT_DPD;
1670
		intel_encoder->hpd_pin = HPD_PORT_D;
1671 1672
		break;
	case PORT_A:
1673
		intel_encoder->hpd_pin = HPD_PORT_A;
1674 1675
		/* Internal port only for eDP. */
	default:
1676
		BUG();
1677
	}
1678

1679
	if (IS_VALLEYVIEW(dev)) {
1680
		intel_hdmi->write_infoframe = vlv_write_infoframe;
1681
		intel_hdmi->set_infoframes = vlv_set_infoframes;
1682
		intel_hdmi->infoframe_enabled = vlv_infoframe_enabled;
1683
	} else if (IS_G4X(dev)) {
1684 1685
		intel_hdmi->write_infoframe = g4x_write_infoframe;
		intel_hdmi->set_infoframes = g4x_set_infoframes;
1686
		intel_hdmi->infoframe_enabled = g4x_infoframe_enabled;
1687
	} else if (HAS_DDI(dev)) {
1688
		intel_hdmi->write_infoframe = hsw_write_infoframe;
1689
		intel_hdmi->set_infoframes = hsw_set_infoframes;
1690
		intel_hdmi->infoframe_enabled = hsw_infoframe_enabled;
1691 1692
	} else if (HAS_PCH_IBX(dev)) {
		intel_hdmi->write_infoframe = ibx_write_infoframe;
1693
		intel_hdmi->set_infoframes = ibx_set_infoframes;
1694
		intel_hdmi->infoframe_enabled = ibx_infoframe_enabled;
1695 1696
	} else {
		intel_hdmi->write_infoframe = cpt_write_infoframe;
1697
		intel_hdmi->set_infoframes = cpt_set_infoframes;
1698
		intel_hdmi->infoframe_enabled = cpt_infoframe_enabled;
1699
	}
1700

P
Paulo Zanoni 已提交
1701
	if (HAS_DDI(dev))
1702 1703 1704
		intel_connector->get_hw_state = intel_ddi_connector_get_hw_state;
	else
		intel_connector->get_hw_state = intel_connector_get_hw_state;
1705
	intel_connector->unregister = intel_connector_unregister;
1706 1707 1708 1709

	intel_hdmi_add_properties(intel_hdmi, connector);

	intel_connector_attach_encoder(intel_connector, intel_encoder);
1710
	drm_connector_register(connector);
1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721

	/* 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);
	}
}

1722
void intel_hdmi_init(struct drm_device *dev, int hdmi_reg, enum port port)
1723 1724 1725 1726 1727
{
	struct intel_digital_port *intel_dig_port;
	struct intel_encoder *intel_encoder;
	struct intel_connector *intel_connector;

1728
	intel_dig_port = kzalloc(sizeof(*intel_dig_port), GFP_KERNEL);
1729 1730 1731
	if (!intel_dig_port)
		return;

1732
	intel_connector = kzalloc(sizeof(*intel_connector), GFP_KERNEL);
1733 1734 1735 1736 1737 1738 1739 1740 1741
	if (!intel_connector) {
		kfree(intel_dig_port);
		return;
	}

	intel_encoder = &intel_dig_port->base;

	drm_encoder_init(dev, &intel_encoder->base, &intel_hdmi_enc_funcs,
			 DRM_MODE_ENCODER_TMDS);
P
Paulo Zanoni 已提交
1742

1743
	intel_encoder->compute_config = intel_hdmi_compute_config;
P
Paulo Zanoni 已提交
1744 1745
	intel_encoder->disable = intel_disable_hdmi;
	intel_encoder->get_hw_state = intel_hdmi_get_hw_state;
1746
	intel_encoder->get_config = intel_hdmi_get_config;
1747
	if (IS_CHERRYVIEW(dev)) {
1748
		intel_encoder->pre_pll_enable = chv_hdmi_pre_pll_enable;
1749 1750
		intel_encoder->pre_enable = chv_hdmi_pre_enable;
		intel_encoder->enable = vlv_enable_hdmi;
1751
		intel_encoder->post_disable = chv_hdmi_post_disable;
1752
	} else if (IS_VALLEYVIEW(dev)) {
1753 1754
		intel_encoder->pre_pll_enable = vlv_hdmi_pre_pll_enable;
		intel_encoder->pre_enable = vlv_hdmi_pre_enable;
1755
		intel_encoder->enable = vlv_enable_hdmi;
1756
		intel_encoder->post_disable = vlv_hdmi_post_disable;
1757
	} else {
1758
		intel_encoder->pre_enable = intel_hdmi_pre_enable;
1759
		intel_encoder->enable = intel_enable_hdmi;
1760
	}
1761

1762
	intel_encoder->type = INTEL_OUTPUT_HDMI;
1763 1764 1765 1766 1767 1768 1769 1770
	if (IS_CHERRYVIEW(dev)) {
		if (port == PORT_D)
			intel_encoder->crtc_mask = 1 << 2;
		else
			intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
	} else {
		intel_encoder->crtc_mask = (1 << 0) | (1 << 1) | (1 << 2);
	}
1771
	intel_encoder->cloneable = 1 << INTEL_OUTPUT_ANALOG;
1772 1773 1774 1775 1776 1777 1778
	/*
	 * BSpec is unclear about HDMI+HDMI cloning on g4x, but it seems
	 * to work on real hardware. And since g4x can send infoframes to
	 * only one port anyway, nothing is lost by allowing it.
	 */
	if (IS_G4X(dev))
		intel_encoder->cloneable |= 1 << INTEL_OUTPUT_HDMI;
1779

1780
	intel_dig_port->port = port;
1781
	intel_dig_port->hdmi.hdmi_reg = hdmi_reg;
1782
	intel_dig_port->dp.output_reg = 0;
1783

1784
	intel_hdmi_init_connector(intel_dig_port, intel_connector);
1785
}