2 * Copyright 2006 Dave Airlie <airlied@linux.ie>
3 * Copyright © 2006-2009 Intel Corporation
5 * Permission is hereby granted, free of charge, to any person obtaining a
6 * copy of this software and associated documentation files (the "Software"),
7 * to deal in the Software without restriction, including without limitation
8 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
9 * and/or sell copies of the Software, and to permit persons to whom the
10 * Software is furnished to do so, subject to the following conditions:
12 * The above copyright notice and this permission notice (including the next
13 * paragraph) shall be included in all copies or substantial portions of the
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
21 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
22 * DEALINGS IN THE SOFTWARE.
25 * Eric Anholt <eric@anholt.net>
26 * Jesse Barnes <jesse.barnes@intel.com>
29 #include <linux/i2c.h>
30 #include <linux/slab.h>
31 #include <linux/delay.h>
33 #include <drm/drm_crtc.h>
34 #include <drm/drm_edid.h>
35 #include "intel_drv.h"
36 #include <drm/i915_drm.h>
39 static struct drm_device
*intel_hdmi_to_dev(struct intel_hdmi
*intel_hdmi
)
41 return hdmi_to_dig_port(intel_hdmi
)->base
.base
.dev
;
45 assert_hdmi_port_disabled(struct intel_hdmi
*intel_hdmi
)
47 struct drm_device
*dev
= intel_hdmi_to_dev(intel_hdmi
);
48 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
49 uint32_t enabled_bits
;
51 enabled_bits
= IS_HASWELL(dev
) ? DDI_BUF_CTL_ENABLE
: SDVO_ENABLE
;
53 WARN(I915_READ(intel_hdmi
->sdvox_reg
) & enabled_bits
,
54 "HDMI port enabled, expecting disabled\n");
57 struct intel_hdmi
*enc_to_intel_hdmi(struct drm_encoder
*encoder
)
59 struct intel_digital_port
*intel_dig_port
=
60 container_of(encoder
, struct intel_digital_port
, base
.base
);
61 return &intel_dig_port
->hdmi
;
64 static struct intel_hdmi
*intel_attached_hdmi(struct drm_connector
*connector
)
66 return enc_to_intel_hdmi(&intel_attached_encoder(connector
)->base
);
69 void intel_dip_infoframe_csum(struct dip_infoframe
*frame
)
71 uint8_t *data
= (uint8_t *)frame
;
78 for (i
= 0; i
< frame
->len
+ DIP_HEADER_SIZE
; i
++)
81 frame
->checksum
= 0x100 - sum
;
84 static u32
g4x_infoframe_index(struct dip_infoframe
*frame
)
86 switch (frame
->type
) {
88 return VIDEO_DIP_SELECT_AVI
;
90 return VIDEO_DIP_SELECT_SPD
;
92 DRM_DEBUG_DRIVER("unknown info frame type %d\n", frame
->type
);
97 static u32
g4x_infoframe_enable(struct dip_infoframe
*frame
)
99 switch (frame
->type
) {
101 return VIDEO_DIP_ENABLE_AVI
;
103 return VIDEO_DIP_ENABLE_SPD
;
105 DRM_DEBUG_DRIVER("unknown info frame type %d\n", frame
->type
);
110 static u32
hsw_infoframe_enable(struct dip_infoframe
*frame
)
112 switch (frame
->type
) {
114 return VIDEO_DIP_ENABLE_AVI_HSW
;
116 return VIDEO_DIP_ENABLE_SPD_HSW
;
118 DRM_DEBUG_DRIVER("unknown info frame type %d\n", frame
->type
);
123 static u32
hsw_infoframe_data_reg(struct dip_infoframe
*frame
, enum pipe pipe
)
125 switch (frame
->type
) {
127 return HSW_TVIDEO_DIP_AVI_DATA(pipe
);
129 return HSW_TVIDEO_DIP_SPD_DATA(pipe
);
131 DRM_DEBUG_DRIVER("unknown info frame type %d\n", frame
->type
);
136 static void g4x_write_infoframe(struct drm_encoder
*encoder
,
137 struct dip_infoframe
*frame
)
139 uint32_t *data
= (uint32_t *)frame
;
140 struct drm_device
*dev
= encoder
->dev
;
141 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
142 u32 val
= I915_READ(VIDEO_DIP_CTL
);
143 unsigned i
, len
= DIP_HEADER_SIZE
+ frame
->len
;
145 WARN(!(val
& VIDEO_DIP_ENABLE
), "Writing DIP with CTL reg disabled\n");
147 val
&= ~(VIDEO_DIP_SELECT_MASK
| 0xf); /* clear DIP data offset */
148 val
|= g4x_infoframe_index(frame
);
150 val
&= ~g4x_infoframe_enable(frame
);
152 I915_WRITE(VIDEO_DIP_CTL
, val
);
155 for (i
= 0; i
< len
; i
+= 4) {
156 I915_WRITE(VIDEO_DIP_DATA
, *data
);
159 /* Write every possible data byte to force correct ECC calculation. */
160 for (; i
< VIDEO_DIP_DATA_SIZE
; i
+= 4)
161 I915_WRITE(VIDEO_DIP_DATA
, 0);
164 val
|= g4x_infoframe_enable(frame
);
165 val
&= ~VIDEO_DIP_FREQ_MASK
;
166 val
|= VIDEO_DIP_FREQ_VSYNC
;
168 I915_WRITE(VIDEO_DIP_CTL
, val
);
169 POSTING_READ(VIDEO_DIP_CTL
);
172 static void ibx_write_infoframe(struct drm_encoder
*encoder
,
173 struct dip_infoframe
*frame
)
175 uint32_t *data
= (uint32_t *)frame
;
176 struct drm_device
*dev
= encoder
->dev
;
177 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
178 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
179 int reg
= TVIDEO_DIP_CTL(intel_crtc
->pipe
);
180 unsigned i
, len
= DIP_HEADER_SIZE
+ frame
->len
;
181 u32 val
= I915_READ(reg
);
183 WARN(!(val
& VIDEO_DIP_ENABLE
), "Writing DIP with CTL reg disabled\n");
185 val
&= ~(VIDEO_DIP_SELECT_MASK
| 0xf); /* clear DIP data offset */
186 val
|= g4x_infoframe_index(frame
);
188 val
&= ~g4x_infoframe_enable(frame
);
190 I915_WRITE(reg
, val
);
193 for (i
= 0; i
< len
; i
+= 4) {
194 I915_WRITE(TVIDEO_DIP_DATA(intel_crtc
->pipe
), *data
);
197 /* Write every possible data byte to force correct ECC calculation. */
198 for (; i
< VIDEO_DIP_DATA_SIZE
; i
+= 4)
199 I915_WRITE(TVIDEO_DIP_DATA(intel_crtc
->pipe
), 0);
202 val
|= g4x_infoframe_enable(frame
);
203 val
&= ~VIDEO_DIP_FREQ_MASK
;
204 val
|= VIDEO_DIP_FREQ_VSYNC
;
206 I915_WRITE(reg
, val
);
210 static void cpt_write_infoframe(struct drm_encoder
*encoder
,
211 struct dip_infoframe
*frame
)
213 uint32_t *data
= (uint32_t *)frame
;
214 struct drm_device
*dev
= encoder
->dev
;
215 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
216 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
217 int reg
= TVIDEO_DIP_CTL(intel_crtc
->pipe
);
218 unsigned i
, len
= DIP_HEADER_SIZE
+ frame
->len
;
219 u32 val
= I915_READ(reg
);
221 WARN(!(val
& VIDEO_DIP_ENABLE
), "Writing DIP with CTL reg disabled\n");
223 val
&= ~(VIDEO_DIP_SELECT_MASK
| 0xf); /* clear DIP data offset */
224 val
|= g4x_infoframe_index(frame
);
226 /* The DIP control register spec says that we need to update the AVI
227 * infoframe without clearing its enable bit */
228 if (frame
->type
!= DIP_TYPE_AVI
)
229 val
&= ~g4x_infoframe_enable(frame
);
231 I915_WRITE(reg
, val
);
234 for (i
= 0; i
< len
; i
+= 4) {
235 I915_WRITE(TVIDEO_DIP_DATA(intel_crtc
->pipe
), *data
);
238 /* Write every possible data byte to force correct ECC calculation. */
239 for (; i
< VIDEO_DIP_DATA_SIZE
; i
+= 4)
240 I915_WRITE(TVIDEO_DIP_DATA(intel_crtc
->pipe
), 0);
243 val
|= g4x_infoframe_enable(frame
);
244 val
&= ~VIDEO_DIP_FREQ_MASK
;
245 val
|= VIDEO_DIP_FREQ_VSYNC
;
247 I915_WRITE(reg
, val
);
251 static void vlv_write_infoframe(struct drm_encoder
*encoder
,
252 struct dip_infoframe
*frame
)
254 uint32_t *data
= (uint32_t *)frame
;
255 struct drm_device
*dev
= encoder
->dev
;
256 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
257 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
258 int reg
= VLV_TVIDEO_DIP_CTL(intel_crtc
->pipe
);
259 unsigned i
, len
= DIP_HEADER_SIZE
+ frame
->len
;
260 u32 val
= I915_READ(reg
);
262 WARN(!(val
& VIDEO_DIP_ENABLE
), "Writing DIP with CTL reg disabled\n");
264 val
&= ~(VIDEO_DIP_SELECT_MASK
| 0xf); /* clear DIP data offset */
265 val
|= g4x_infoframe_index(frame
);
267 val
&= ~g4x_infoframe_enable(frame
);
269 I915_WRITE(reg
, val
);
272 for (i
= 0; i
< len
; i
+= 4) {
273 I915_WRITE(VLV_TVIDEO_DIP_DATA(intel_crtc
->pipe
), *data
);
276 /* Write every possible data byte to force correct ECC calculation. */
277 for (; i
< VIDEO_DIP_DATA_SIZE
; i
+= 4)
278 I915_WRITE(VLV_TVIDEO_DIP_DATA(intel_crtc
->pipe
), 0);
281 val
|= g4x_infoframe_enable(frame
);
282 val
&= ~VIDEO_DIP_FREQ_MASK
;
283 val
|= VIDEO_DIP_FREQ_VSYNC
;
285 I915_WRITE(reg
, val
);
289 static void hsw_write_infoframe(struct drm_encoder
*encoder
,
290 struct dip_infoframe
*frame
)
292 uint32_t *data
= (uint32_t *)frame
;
293 struct drm_device
*dev
= encoder
->dev
;
294 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
295 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
296 u32 ctl_reg
= HSW_TVIDEO_DIP_CTL(intel_crtc
->pipe
);
297 u32 data_reg
= hsw_infoframe_data_reg(frame
, intel_crtc
->pipe
);
298 unsigned int i
, len
= DIP_HEADER_SIZE
+ frame
->len
;
299 u32 val
= I915_READ(ctl_reg
);
304 val
&= ~hsw_infoframe_enable(frame
);
305 I915_WRITE(ctl_reg
, val
);
308 for (i
= 0; i
< len
; i
+= 4) {
309 I915_WRITE(data_reg
+ i
, *data
);
312 /* Write every possible data byte to force correct ECC calculation. */
313 for (; i
< VIDEO_DIP_DATA_SIZE
; i
+= 4)
314 I915_WRITE(data_reg
+ i
, 0);
317 val
|= hsw_infoframe_enable(frame
);
318 I915_WRITE(ctl_reg
, val
);
319 POSTING_READ(ctl_reg
);
322 static void intel_set_infoframe(struct drm_encoder
*encoder
,
323 struct dip_infoframe
*frame
)
325 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(encoder
);
327 intel_dip_infoframe_csum(frame
);
328 intel_hdmi
->write_infoframe(encoder
, frame
);
331 static void intel_hdmi_set_avi_infoframe(struct drm_encoder
*encoder
,
332 struct drm_display_mode
*adjusted_mode
)
334 struct dip_infoframe avi_if
= {
335 .type
= DIP_TYPE_AVI
,
336 .ver
= DIP_VERSION_AVI
,
340 if (adjusted_mode
->flags
& DRM_MODE_FLAG_DBLCLK
)
341 avi_if
.body
.avi
.YQ_CN_PR
|= DIP_AVI_PR_2
;
343 intel_set_infoframe(encoder
, &avi_if
);
346 static void intel_hdmi_set_spd_infoframe(struct drm_encoder
*encoder
)
348 struct dip_infoframe spd_if
;
350 memset(&spd_if
, 0, sizeof(spd_if
));
351 spd_if
.type
= DIP_TYPE_SPD
;
352 spd_if
.ver
= DIP_VERSION_SPD
;
353 spd_if
.len
= DIP_LEN_SPD
;
354 strcpy(spd_if
.body
.spd
.vn
, "Intel");
355 strcpy(spd_if
.body
.spd
.pd
, "Integrated gfx");
356 spd_if
.body
.spd
.sdi
= DIP_SPD_PC
;
358 intel_set_infoframe(encoder
, &spd_if
);
361 static void g4x_set_infoframes(struct drm_encoder
*encoder
,
362 struct drm_display_mode
*adjusted_mode
)
364 struct drm_i915_private
*dev_priv
= encoder
->dev
->dev_private
;
365 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(encoder
);
366 u32 reg
= VIDEO_DIP_CTL
;
367 u32 val
= I915_READ(reg
);
370 assert_hdmi_port_disabled(intel_hdmi
);
372 /* If the registers were not initialized yet, they might be zeroes,
373 * which means we're selecting the AVI DIP and we're setting its
374 * frequency to once. This seems to really confuse the HW and make
375 * things stop working (the register spec says the AVI always needs to
376 * be sent every VSync). So here we avoid writing to the register more
377 * than we need and also explicitly select the AVI DIP and explicitly
378 * set its frequency to every VSync. Avoiding to write it twice seems to
379 * be enough to solve the problem, but being defensive shouldn't hurt us
381 val
|= VIDEO_DIP_SELECT_AVI
| VIDEO_DIP_FREQ_VSYNC
;
383 if (!intel_hdmi
->has_hdmi_sink
) {
384 if (!(val
& VIDEO_DIP_ENABLE
))
386 val
&= ~VIDEO_DIP_ENABLE
;
387 I915_WRITE(reg
, val
);
392 switch (intel_hdmi
->sdvox_reg
) {
394 port
= VIDEO_DIP_PORT_B
;
397 port
= VIDEO_DIP_PORT_C
;
404 if (port
!= (val
& VIDEO_DIP_PORT_MASK
)) {
405 if (val
& VIDEO_DIP_ENABLE
) {
406 val
&= ~VIDEO_DIP_ENABLE
;
407 I915_WRITE(reg
, val
);
410 val
&= ~VIDEO_DIP_PORT_MASK
;
414 val
|= VIDEO_DIP_ENABLE
;
415 val
&= ~VIDEO_DIP_ENABLE_VENDOR
;
417 I915_WRITE(reg
, val
);
420 intel_hdmi_set_avi_infoframe(encoder
, adjusted_mode
);
421 intel_hdmi_set_spd_infoframe(encoder
);
424 static void ibx_set_infoframes(struct drm_encoder
*encoder
,
425 struct drm_display_mode
*adjusted_mode
)
427 struct drm_i915_private
*dev_priv
= encoder
->dev
->dev_private
;
428 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
429 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(encoder
);
430 u32 reg
= TVIDEO_DIP_CTL(intel_crtc
->pipe
);
431 u32 val
= I915_READ(reg
);
434 assert_hdmi_port_disabled(intel_hdmi
);
436 /* See the big comment in g4x_set_infoframes() */
437 val
|= VIDEO_DIP_SELECT_AVI
| VIDEO_DIP_FREQ_VSYNC
;
439 if (!intel_hdmi
->has_hdmi_sink
) {
440 if (!(val
& VIDEO_DIP_ENABLE
))
442 val
&= ~VIDEO_DIP_ENABLE
;
443 I915_WRITE(reg
, val
);
448 switch (intel_hdmi
->sdvox_reg
) {
450 port
= VIDEO_DIP_PORT_B
;
453 port
= VIDEO_DIP_PORT_C
;
456 port
= VIDEO_DIP_PORT_D
;
463 if (port
!= (val
& VIDEO_DIP_PORT_MASK
)) {
464 if (val
& VIDEO_DIP_ENABLE
) {
465 val
&= ~VIDEO_DIP_ENABLE
;
466 I915_WRITE(reg
, val
);
469 val
&= ~VIDEO_DIP_PORT_MASK
;
473 val
|= VIDEO_DIP_ENABLE
;
474 val
&= ~(VIDEO_DIP_ENABLE_VENDOR
| VIDEO_DIP_ENABLE_GAMUT
|
475 VIDEO_DIP_ENABLE_GCP
);
477 I915_WRITE(reg
, val
);
480 intel_hdmi_set_avi_infoframe(encoder
, adjusted_mode
);
481 intel_hdmi_set_spd_infoframe(encoder
);
484 static void cpt_set_infoframes(struct drm_encoder
*encoder
,
485 struct drm_display_mode
*adjusted_mode
)
487 struct drm_i915_private
*dev_priv
= encoder
->dev
->dev_private
;
488 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
489 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(encoder
);
490 u32 reg
= TVIDEO_DIP_CTL(intel_crtc
->pipe
);
491 u32 val
= I915_READ(reg
);
493 assert_hdmi_port_disabled(intel_hdmi
);
495 /* See the big comment in g4x_set_infoframes() */
496 val
|= VIDEO_DIP_SELECT_AVI
| VIDEO_DIP_FREQ_VSYNC
;
498 if (!intel_hdmi
->has_hdmi_sink
) {
499 if (!(val
& VIDEO_DIP_ENABLE
))
501 val
&= ~(VIDEO_DIP_ENABLE
| VIDEO_DIP_ENABLE_AVI
);
502 I915_WRITE(reg
, val
);
507 /* Set both together, unset both together: see the spec. */
508 val
|= VIDEO_DIP_ENABLE
| VIDEO_DIP_ENABLE_AVI
;
509 val
&= ~(VIDEO_DIP_ENABLE_VENDOR
| VIDEO_DIP_ENABLE_GAMUT
|
510 VIDEO_DIP_ENABLE_GCP
);
512 I915_WRITE(reg
, val
);
515 intel_hdmi_set_avi_infoframe(encoder
, adjusted_mode
);
516 intel_hdmi_set_spd_infoframe(encoder
);
519 static void vlv_set_infoframes(struct drm_encoder
*encoder
,
520 struct drm_display_mode
*adjusted_mode
)
522 struct drm_i915_private
*dev_priv
= encoder
->dev
->dev_private
;
523 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
524 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(encoder
);
525 u32 reg
= VLV_TVIDEO_DIP_CTL(intel_crtc
->pipe
);
526 u32 val
= I915_READ(reg
);
528 assert_hdmi_port_disabled(intel_hdmi
);
530 /* See the big comment in g4x_set_infoframes() */
531 val
|= VIDEO_DIP_SELECT_AVI
| VIDEO_DIP_FREQ_VSYNC
;
533 if (!intel_hdmi
->has_hdmi_sink
) {
534 if (!(val
& VIDEO_DIP_ENABLE
))
536 val
&= ~VIDEO_DIP_ENABLE
;
537 I915_WRITE(reg
, val
);
542 val
|= VIDEO_DIP_ENABLE
;
543 val
&= ~(VIDEO_DIP_ENABLE_VENDOR
| VIDEO_DIP_ENABLE_GAMUT
|
544 VIDEO_DIP_ENABLE_GCP
);
546 I915_WRITE(reg
, val
);
549 intel_hdmi_set_avi_infoframe(encoder
, adjusted_mode
);
550 intel_hdmi_set_spd_infoframe(encoder
);
553 static void hsw_set_infoframes(struct drm_encoder
*encoder
,
554 struct drm_display_mode
*adjusted_mode
)
556 struct drm_i915_private
*dev_priv
= encoder
->dev
->dev_private
;
557 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
558 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(encoder
);
559 u32 reg
= HSW_TVIDEO_DIP_CTL(intel_crtc
->pipe
);
560 u32 val
= I915_READ(reg
);
562 assert_hdmi_port_disabled(intel_hdmi
);
564 if (!intel_hdmi
->has_hdmi_sink
) {
570 val
&= ~(VIDEO_DIP_ENABLE_VSC_HSW
| VIDEO_DIP_ENABLE_GCP_HSW
|
571 VIDEO_DIP_ENABLE_VS_HSW
| VIDEO_DIP_ENABLE_GMP_HSW
);
573 I915_WRITE(reg
, val
);
576 intel_hdmi_set_avi_infoframe(encoder
, adjusted_mode
);
577 intel_hdmi_set_spd_infoframe(encoder
);
580 static void intel_hdmi_mode_set(struct drm_encoder
*encoder
,
581 struct drm_display_mode
*mode
,
582 struct drm_display_mode
*adjusted_mode
)
584 struct drm_device
*dev
= encoder
->dev
;
585 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
586 struct intel_crtc
*intel_crtc
= to_intel_crtc(encoder
->crtc
);
587 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(encoder
);
590 sdvox
= SDVO_ENCODING_HDMI
;
591 if (!HAS_PCH_SPLIT(dev
))
592 sdvox
|= intel_hdmi
->color_range
;
593 if (adjusted_mode
->flags
& DRM_MODE_FLAG_PVSYNC
)
594 sdvox
|= SDVO_VSYNC_ACTIVE_HIGH
;
595 if (adjusted_mode
->flags
& DRM_MODE_FLAG_PHSYNC
)
596 sdvox
|= SDVO_HSYNC_ACTIVE_HIGH
;
598 if (intel_crtc
->bpp
> 24)
599 sdvox
|= COLOR_FORMAT_12bpc
;
601 sdvox
|= COLOR_FORMAT_8bpc
;
603 /* Required on CPT */
604 if (intel_hdmi
->has_hdmi_sink
&& HAS_PCH_CPT(dev
))
605 sdvox
|= HDMI_MODE_SELECT
;
607 if (intel_hdmi
->has_audio
) {
608 DRM_DEBUG_DRIVER("Enabling HDMI audio on pipe %c\n",
609 pipe_name(intel_crtc
->pipe
));
610 sdvox
|= SDVO_AUDIO_ENABLE
;
611 sdvox
|= SDVO_NULL_PACKETS_DURING_VSYNC
;
612 intel_write_eld(encoder
, adjusted_mode
);
615 if (HAS_PCH_CPT(dev
))
616 sdvox
|= PORT_TRANS_SEL_CPT(intel_crtc
->pipe
);
617 else if (intel_crtc
->pipe
== PIPE_B
)
618 sdvox
|= SDVO_PIPE_B_SELECT
;
620 I915_WRITE(intel_hdmi
->sdvox_reg
, sdvox
);
621 POSTING_READ(intel_hdmi
->sdvox_reg
);
623 intel_hdmi
->set_infoframes(encoder
, adjusted_mode
);
626 static bool intel_hdmi_get_hw_state(struct intel_encoder
*encoder
,
629 struct drm_device
*dev
= encoder
->base
.dev
;
630 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
631 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(&encoder
->base
);
634 tmp
= I915_READ(intel_hdmi
->sdvox_reg
);
636 if (!(tmp
& SDVO_ENABLE
))
639 if (HAS_PCH_CPT(dev
))
640 *pipe
= PORT_TO_PIPE_CPT(tmp
);
642 *pipe
= PORT_TO_PIPE(tmp
);
647 static void intel_enable_hdmi(struct intel_encoder
*encoder
)
649 struct drm_device
*dev
= encoder
->base
.dev
;
650 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
651 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(&encoder
->base
);
653 u32 enable_bits
= SDVO_ENABLE
;
655 if (intel_hdmi
->has_audio
)
656 enable_bits
|= SDVO_AUDIO_ENABLE
;
658 temp
= I915_READ(intel_hdmi
->sdvox_reg
);
660 /* HW workaround for IBX, we need to move the port to transcoder A
661 * before disabling it. */
662 if (HAS_PCH_IBX(dev
)) {
663 struct drm_crtc
*crtc
= encoder
->base
.crtc
;
664 int pipe
= crtc
? to_intel_crtc(crtc
)->pipe
: -1;
666 /* Restore the transcoder select bit. */
668 enable_bits
|= SDVO_PIPE_B_SELECT
;
671 /* HW workaround, need to toggle enable bit off and on for 12bpc, but
672 * we do this anyway which shows more stable in testing.
674 if (HAS_PCH_SPLIT(dev
)) {
675 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
& ~SDVO_ENABLE
);
676 POSTING_READ(intel_hdmi
->sdvox_reg
);
681 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
);
682 POSTING_READ(intel_hdmi
->sdvox_reg
);
684 /* HW workaround, need to write this twice for issue that may result
685 * in first write getting masked.
687 if (HAS_PCH_SPLIT(dev
)) {
688 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
);
689 POSTING_READ(intel_hdmi
->sdvox_reg
);
693 static void intel_disable_hdmi(struct intel_encoder
*encoder
)
695 struct drm_device
*dev
= encoder
->base
.dev
;
696 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
697 struct intel_hdmi
*intel_hdmi
= enc_to_intel_hdmi(&encoder
->base
);
699 u32 enable_bits
= SDVO_ENABLE
| SDVO_AUDIO_ENABLE
;
701 temp
= I915_READ(intel_hdmi
->sdvox_reg
);
703 /* HW workaround for IBX, we need to move the port to transcoder A
704 * before disabling it. */
705 if (HAS_PCH_IBX(dev
)) {
706 struct drm_crtc
*crtc
= encoder
->base
.crtc
;
707 int pipe
= crtc
? to_intel_crtc(crtc
)->pipe
: -1;
709 if (temp
& SDVO_PIPE_B_SELECT
) {
710 temp
&= ~SDVO_PIPE_B_SELECT
;
711 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
);
712 POSTING_READ(intel_hdmi
->sdvox_reg
);
714 /* Again we need to write this twice. */
715 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
);
716 POSTING_READ(intel_hdmi
->sdvox_reg
);
718 /* Transcoder selection bits only update
719 * effectively on vblank. */
721 intel_wait_for_vblank(dev
, pipe
);
727 /* HW workaround, need to toggle enable bit off and on for 12bpc, but
728 * we do this anyway which shows more stable in testing.
730 if (HAS_PCH_SPLIT(dev
)) {
731 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
& ~SDVO_ENABLE
);
732 POSTING_READ(intel_hdmi
->sdvox_reg
);
735 temp
&= ~enable_bits
;
737 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
);
738 POSTING_READ(intel_hdmi
->sdvox_reg
);
740 /* HW workaround, need to write this twice for issue that may result
741 * in first write getting masked.
743 if (HAS_PCH_SPLIT(dev
)) {
744 I915_WRITE(intel_hdmi
->sdvox_reg
, temp
);
745 POSTING_READ(intel_hdmi
->sdvox_reg
);
749 static int intel_hdmi_mode_valid(struct drm_connector
*connector
,
750 struct drm_display_mode
*mode
)
752 if (mode
->clock
> 165000)
753 return MODE_CLOCK_HIGH
;
754 if (mode
->clock
< 20000)
755 return MODE_CLOCK_LOW
;
757 if (mode
->flags
& DRM_MODE_FLAG_DBLSCAN
)
758 return MODE_NO_DBLESCAN
;
763 bool intel_hdmi_mode_fixup(struct drm_encoder
*encoder
,
764 const struct drm_display_mode
*mode
,
765 struct drm_display_mode
*adjusted_mode
)
770 static bool g4x_hdmi_connected(struct intel_hdmi
*intel_hdmi
)
772 struct drm_device
*dev
= intel_hdmi_to_dev(intel_hdmi
);
773 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
776 switch (intel_hdmi
->sdvox_reg
) {
778 bit
= HDMIB_HOTPLUG_LIVE_STATUS
;
781 bit
= HDMIC_HOTPLUG_LIVE_STATUS
;
788 return I915_READ(PORT_HOTPLUG_STAT
) & bit
;
791 static enum drm_connector_status
792 intel_hdmi_detect(struct drm_connector
*connector
, bool force
)
794 struct intel_hdmi
*intel_hdmi
= intel_attached_hdmi(connector
);
795 struct intel_digital_port
*intel_dig_port
=
796 hdmi_to_dig_port(intel_hdmi
);
797 struct intel_encoder
*intel_encoder
= &intel_dig_port
->base
;
798 struct drm_i915_private
*dev_priv
= connector
->dev
->dev_private
;
800 enum drm_connector_status status
= connector_status_disconnected
;
802 if (IS_G4X(connector
->dev
) && !g4x_hdmi_connected(intel_hdmi
))
805 intel_hdmi
->has_hdmi_sink
= false;
806 intel_hdmi
->has_audio
= false;
807 edid
= drm_get_edid(connector
,
808 intel_gmbus_get_adapter(dev_priv
,
809 intel_hdmi
->ddc_bus
));
812 if (edid
->input
& DRM_EDID_INPUT_DIGITAL
) {
813 status
= connector_status_connected
;
814 if (intel_hdmi
->force_audio
!= HDMI_AUDIO_OFF_DVI
)
815 intel_hdmi
->has_hdmi_sink
=
816 drm_detect_hdmi_monitor(edid
);
817 intel_hdmi
->has_audio
= drm_detect_monitor_audio(edid
);
822 if (status
== connector_status_connected
) {
823 if (intel_hdmi
->force_audio
!= HDMI_AUDIO_AUTO
)
824 intel_hdmi
->has_audio
=
825 (intel_hdmi
->force_audio
== HDMI_AUDIO_ON
);
826 intel_encoder
->type
= INTEL_OUTPUT_HDMI
;
832 static int intel_hdmi_get_modes(struct drm_connector
*connector
)
834 struct intel_hdmi
*intel_hdmi
= intel_attached_hdmi(connector
);
835 struct drm_i915_private
*dev_priv
= connector
->dev
->dev_private
;
837 /* We should parse the EDID data and find out if it's an HDMI sink so
838 * we can send audio to it.
841 return intel_ddc_get_modes(connector
,
842 intel_gmbus_get_adapter(dev_priv
,
843 intel_hdmi
->ddc_bus
));
847 intel_hdmi_detect_audio(struct drm_connector
*connector
)
849 struct intel_hdmi
*intel_hdmi
= intel_attached_hdmi(connector
);
850 struct drm_i915_private
*dev_priv
= connector
->dev
->dev_private
;
852 bool has_audio
= false;
854 edid
= drm_get_edid(connector
,
855 intel_gmbus_get_adapter(dev_priv
,
856 intel_hdmi
->ddc_bus
));
858 if (edid
->input
& DRM_EDID_INPUT_DIGITAL
)
859 has_audio
= drm_detect_monitor_audio(edid
);
867 intel_hdmi_set_property(struct drm_connector
*connector
,
868 struct drm_property
*property
,
871 struct intel_hdmi
*intel_hdmi
= intel_attached_hdmi(connector
);
872 struct intel_digital_port
*intel_dig_port
=
873 hdmi_to_dig_port(intel_hdmi
);
874 struct drm_i915_private
*dev_priv
= connector
->dev
->dev_private
;
877 ret
= drm_object_property_set_value(&connector
->base
, property
, val
);
881 if (property
== dev_priv
->force_audio_property
) {
882 enum hdmi_force_audio i
= val
;
885 if (i
== intel_hdmi
->force_audio
)
888 intel_hdmi
->force_audio
= i
;
890 if (i
== HDMI_AUDIO_AUTO
)
891 has_audio
= intel_hdmi_detect_audio(connector
);
893 has_audio
= (i
== HDMI_AUDIO_ON
);
895 if (i
== HDMI_AUDIO_OFF_DVI
)
896 intel_hdmi
->has_hdmi_sink
= 0;
898 intel_hdmi
->has_audio
= has_audio
;
902 if (property
== dev_priv
->broadcast_rgb_property
) {
903 if (val
== !!intel_hdmi
->color_range
)
906 intel_hdmi
->color_range
= val
? SDVO_COLOR_RANGE_16_235
: 0;
913 if (intel_dig_port
->base
.base
.crtc
) {
914 struct drm_crtc
*crtc
= intel_dig_port
->base
.base
.crtc
;
915 intel_set_mode(crtc
, &crtc
->mode
,
916 crtc
->x
, crtc
->y
, crtc
->fb
);
922 static void intel_hdmi_destroy(struct drm_connector
*connector
)
924 drm_sysfs_connector_remove(connector
);
925 drm_connector_cleanup(connector
);
929 static const struct drm_encoder_helper_funcs intel_hdmi_helper_funcs
= {
930 .mode_fixup
= intel_hdmi_mode_fixup
,
931 .mode_set
= intel_hdmi_mode_set
,
932 .disable
= intel_encoder_noop
,
935 static const struct drm_connector_funcs intel_hdmi_connector_funcs
= {
936 .dpms
= intel_connector_dpms
,
937 .detect
= intel_hdmi_detect
,
938 .fill_modes
= drm_helper_probe_single_connector_modes
,
939 .set_property
= intel_hdmi_set_property
,
940 .destroy
= intel_hdmi_destroy
,
943 static const struct drm_connector_helper_funcs intel_hdmi_connector_helper_funcs
= {
944 .get_modes
= intel_hdmi_get_modes
,
945 .mode_valid
= intel_hdmi_mode_valid
,
946 .best_encoder
= intel_best_encoder
,
949 static const struct drm_encoder_funcs intel_hdmi_enc_funcs
= {
950 .destroy
= intel_encoder_destroy
,
954 intel_hdmi_add_properties(struct intel_hdmi
*intel_hdmi
, struct drm_connector
*connector
)
956 intel_attach_force_audio_property(connector
);
957 intel_attach_broadcast_rgb_property(connector
);
960 void intel_hdmi_init_connector(struct intel_digital_port
*intel_dig_port
,
961 struct intel_connector
*intel_connector
)
963 struct drm_connector
*connector
= &intel_connector
->base
;
964 struct intel_hdmi
*intel_hdmi
= &intel_dig_port
->hdmi
;
965 struct intel_encoder
*intel_encoder
= &intel_dig_port
->base
;
966 struct drm_device
*dev
= intel_encoder
->base
.dev
;
967 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
968 enum port port
= intel_dig_port
->port
;
970 drm_connector_init(dev
, connector
, &intel_hdmi_connector_funcs
,
971 DRM_MODE_CONNECTOR_HDMIA
);
972 drm_connector_helper_add(connector
, &intel_hdmi_connector_helper_funcs
);
974 connector
->polled
= DRM_CONNECTOR_POLL_HPD
;
975 connector
->interlace_allowed
= 1;
976 connector
->doublescan_allowed
= 0;
980 intel_hdmi
->ddc_bus
= GMBUS_PORT_DPB
;
981 dev_priv
->hotplug_supported_mask
|= HDMIB_HOTPLUG_INT_STATUS
;
984 intel_hdmi
->ddc_bus
= GMBUS_PORT_DPC
;
985 dev_priv
->hotplug_supported_mask
|= HDMIC_HOTPLUG_INT_STATUS
;
988 intel_hdmi
->ddc_bus
= GMBUS_PORT_DPD
;
989 dev_priv
->hotplug_supported_mask
|= HDMID_HOTPLUG_INT_STATUS
;
992 /* Internal port only for eDP. */
997 if (!HAS_PCH_SPLIT(dev
)) {
998 intel_hdmi
->write_infoframe
= g4x_write_infoframe
;
999 intel_hdmi
->set_infoframes
= g4x_set_infoframes
;
1000 } else if (IS_VALLEYVIEW(dev
)) {
1001 intel_hdmi
->write_infoframe
= vlv_write_infoframe
;
1002 intel_hdmi
->set_infoframes
= vlv_set_infoframes
;
1003 } else if (IS_HASWELL(dev
)) {
1004 intel_hdmi
->write_infoframe
= hsw_write_infoframe
;
1005 intel_hdmi
->set_infoframes
= hsw_set_infoframes
;
1006 } else if (HAS_PCH_IBX(dev
)) {
1007 intel_hdmi
->write_infoframe
= ibx_write_infoframe
;
1008 intel_hdmi
->set_infoframes
= ibx_set_infoframes
;
1010 intel_hdmi
->write_infoframe
= cpt_write_infoframe
;
1011 intel_hdmi
->set_infoframes
= cpt_set_infoframes
;
1014 if (IS_HASWELL(dev
))
1015 intel_connector
->get_hw_state
= intel_ddi_connector_get_hw_state
;
1017 intel_connector
->get_hw_state
= intel_connector_get_hw_state
;
1019 intel_hdmi_add_properties(intel_hdmi
, connector
);
1021 intel_connector_attach_encoder(intel_connector
, intel_encoder
);
1022 drm_sysfs_connector_add(connector
);
1024 /* For G4X desktop chip, PEG_BAND_GAP_DATA 3:0 must first be written
1025 * 0xd. Failure to do so will result in spurious interrupts being
1026 * generated on the port when a cable is not attached.
1028 if (IS_G4X(dev
) && !IS_GM45(dev
)) {
1029 u32 temp
= I915_READ(PEG_BAND_GAP_DATA
);
1030 I915_WRITE(PEG_BAND_GAP_DATA
, (temp
& ~0xf) | 0xd);
1034 void intel_hdmi_init(struct drm_device
*dev
, int sdvox_reg
, enum port port
)
1036 struct intel_digital_port
*intel_dig_port
;
1037 struct intel_encoder
*intel_encoder
;
1038 struct drm_encoder
*encoder
;
1039 struct intel_connector
*intel_connector
;
1041 intel_dig_port
= kzalloc(sizeof(struct intel_digital_port
), GFP_KERNEL
);
1042 if (!intel_dig_port
)
1045 intel_connector
= kzalloc(sizeof(struct intel_connector
), GFP_KERNEL
);
1046 if (!intel_connector
) {
1047 kfree(intel_dig_port
);
1051 intel_encoder
= &intel_dig_port
->base
;
1052 encoder
= &intel_encoder
->base
;
1054 drm_encoder_init(dev
, &intel_encoder
->base
, &intel_hdmi_enc_funcs
,
1055 DRM_MODE_ENCODER_TMDS
);
1056 drm_encoder_helper_add(&intel_encoder
->base
, &intel_hdmi_helper_funcs
);
1058 intel_encoder
->enable
= intel_enable_hdmi
;
1059 intel_encoder
->disable
= intel_disable_hdmi
;
1060 intel_encoder
->get_hw_state
= intel_hdmi_get_hw_state
;
1062 intel_encoder
->type
= INTEL_OUTPUT_HDMI
;
1063 intel_encoder
->crtc_mask
= (1 << 0) | (1 << 1) | (1 << 2);
1064 intel_encoder
->cloneable
= false;
1066 intel_dig_port
->port
= port
;
1067 intel_dig_port
->hdmi
.sdvox_reg
= sdvox_reg
;
1068 intel_dig_port
->dp
.output_reg
= 0;
1070 intel_hdmi_init_connector(intel_dig_port
, intel_connector
);