2 * Copyright © 2006-2007 Intel Corporation
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
11 * The above copyright notice and this permission notice (including the next
12 * paragraph) shall be included in all copies or substantial portions of the
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21 * DEALINGS IN THE SOFTWARE.
24 * Eric Anholt <eric@anholt.net>
27 #include <linux/i2c.h>
28 #include <linux/slab.h>
32 #include "drm_crtc_helper.h"
33 #include "intel_drv.h"
37 static void intel_crt_dpms(struct drm_encoder *encoder, int mode)
39 struct drm_device *dev = encoder->dev;
40 struct drm_i915_private *dev_priv = dev->dev_private;
43 if (HAS_PCH_SPLIT(dev))
48 temp = I915_READ(reg);
49 temp &= ~(ADPA_HSYNC_CNTL_DISABLE | ADPA_VSYNC_CNTL_DISABLE);
50 temp &= ~ADPA_DAC_ENABLE;
53 case DRM_MODE_DPMS_ON:
54 temp |= ADPA_DAC_ENABLE;
56 case DRM_MODE_DPMS_STANDBY:
57 temp |= ADPA_DAC_ENABLE | ADPA_HSYNC_CNTL_DISABLE;
59 case DRM_MODE_DPMS_SUSPEND:
60 temp |= ADPA_DAC_ENABLE | ADPA_VSYNC_CNTL_DISABLE;
62 case DRM_MODE_DPMS_OFF:
63 temp |= ADPA_HSYNC_CNTL_DISABLE | ADPA_VSYNC_CNTL_DISABLE;
67 I915_WRITE(reg, temp);
70 static int intel_crt_mode_valid(struct drm_connector *connector,
71 struct drm_display_mode *mode)
73 struct drm_device *dev = connector->dev;
76 if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
77 return MODE_NO_DBLESCAN;
79 if (mode->clock < 25000)
80 return MODE_CLOCK_LOW;
86 if (mode->clock > max_clock)
87 return MODE_CLOCK_HIGH;
92 static bool intel_crt_mode_fixup(struct drm_encoder *encoder,
93 struct drm_display_mode *mode,
94 struct drm_display_mode *adjusted_mode)
99 static void intel_crt_mode_set(struct drm_encoder *encoder,
100 struct drm_display_mode *mode,
101 struct drm_display_mode *adjusted_mode)
104 struct drm_device *dev = encoder->dev;
105 struct drm_crtc *crtc = encoder->crtc;
106 struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
107 struct drm_i915_private *dev_priv = dev->dev_private;
112 if (intel_crtc->pipe == 0)
113 dpll_md_reg = DPLL_A_MD;
115 dpll_md_reg = DPLL_B_MD;
117 if (HAS_PCH_SPLIT(dev))
123 * Disable separate mode multiplier used when cloning SDVO to CRT
124 * XXX this needs to be adjusted when we really are cloning
126 if (IS_I965G(dev) && !HAS_PCH_SPLIT(dev)) {
127 dpll_md = I915_READ(dpll_md_reg);
128 I915_WRITE(dpll_md_reg,
129 dpll_md & ~DPLL_MD_UDI_MULTIPLIER_MASK);
133 if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
134 adpa |= ADPA_HSYNC_ACTIVE_HIGH;
135 if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
136 adpa |= ADPA_VSYNC_ACTIVE_HIGH;
138 if (intel_crtc->pipe == 0) {
139 if (HAS_PCH_CPT(dev))
140 adpa |= PORT_TRANS_A_SEL_CPT;
142 adpa |= ADPA_PIPE_A_SELECT;
143 if (!HAS_PCH_SPLIT(dev))
144 I915_WRITE(BCLRPAT_A, 0);
146 if (HAS_PCH_CPT(dev))
147 adpa |= PORT_TRANS_B_SEL_CPT;
149 adpa |= ADPA_PIPE_B_SELECT;
150 if (!HAS_PCH_SPLIT(dev))
151 I915_WRITE(BCLRPAT_B, 0);
154 I915_WRITE(adpa_reg, adpa);
157 static bool intel_ironlake_crt_detect_hotplug(struct drm_connector *connector)
159 struct drm_device *dev = connector->dev;
160 struct drm_i915_private *dev_priv = dev->dev_private;
164 temp = adpa = I915_READ(PCH_ADPA);
166 if (HAS_PCH_CPT(dev)) {
167 /* Disable DAC before force detect */
168 I915_WRITE(PCH_ADPA, adpa & ~ADPA_DAC_ENABLE);
169 (void)I915_READ(PCH_ADPA);
171 adpa &= ~ADPA_CRT_HOTPLUG_MASK;
172 /* disable HPD first */
173 I915_WRITE(PCH_ADPA, adpa);
174 (void)I915_READ(PCH_ADPA);
177 adpa |= (ADPA_CRT_HOTPLUG_PERIOD_128 |
178 ADPA_CRT_HOTPLUG_WARMUP_10MS |
179 ADPA_CRT_HOTPLUG_SAMPLE_4S |
180 ADPA_CRT_HOTPLUG_VOLTAGE_50 | /* default */
181 ADPA_CRT_HOTPLUG_VOLREF_325MV |
182 ADPA_CRT_HOTPLUG_ENABLE |
183 ADPA_CRT_HOTPLUG_FORCE_TRIGGER);
185 DRM_DEBUG_KMS("pch crt adpa 0x%x", adpa);
186 I915_WRITE(PCH_ADPA, adpa);
188 while ((I915_READ(PCH_ADPA) & ADPA_CRT_HOTPLUG_FORCE_TRIGGER) != 0)
191 if (HAS_PCH_CPT(dev)) {
192 I915_WRITE(PCH_ADPA, temp);
193 (void)I915_READ(PCH_ADPA);
196 /* Check the status to see if both blue and green are on now */
197 adpa = I915_READ(PCH_ADPA);
198 adpa &= ADPA_CRT_HOTPLUG_MONITOR_MASK;
199 if ((adpa == ADPA_CRT_HOTPLUG_MONITOR_COLOR) ||
200 (adpa == ADPA_CRT_HOTPLUG_MONITOR_MONO))
209 * Uses CRT_HOTPLUG_EN and CRT_HOTPLUG_STAT to detect CRT presence.
211 * Not for i915G/i915GM
213 * \return true if CRT is connected.
214 * \return false if CRT is disconnected.
216 static bool intel_crt_detect_hotplug(struct drm_connector *connector)
218 struct drm_device *dev = connector->dev;
219 struct drm_i915_private *dev_priv = dev->dev_private;
220 u32 hotplug_en, orig, stat;
224 if (HAS_PCH_SPLIT(dev))
225 return intel_ironlake_crt_detect_hotplug(connector);
228 * On 4 series desktop, CRT detect sequence need to be done twice
229 * to get a reliable result.
232 if (IS_G4X(dev) && !IS_GM45(dev))
236 hotplug_en = orig = I915_READ(PORT_HOTPLUG_EN);
237 hotplug_en |= CRT_HOTPLUG_FORCE_DETECT;
239 for (i = 0; i < tries ; i++) {
240 unsigned long timeout;
241 /* turn on the FORCE_DETECT */
242 I915_WRITE(PORT_HOTPLUG_EN, hotplug_en);
243 timeout = jiffies + msecs_to_jiffies(1000);
244 /* wait for FORCE_DETECT to go off */
246 if (!(I915_READ(PORT_HOTPLUG_EN) &
247 CRT_HOTPLUG_FORCE_DETECT))
250 } while (time_after(timeout, jiffies));
253 stat = I915_READ(PORT_HOTPLUG_STAT);
254 if ((stat & CRT_HOTPLUG_MONITOR_MASK) != CRT_HOTPLUG_MONITOR_NONE)
257 /* clear the interrupt we just generated, if any */
258 I915_WRITE(PORT_HOTPLUG_STAT, CRT_HOTPLUG_INT_STATUS);
260 /* and put the bits back */
261 I915_WRITE(PORT_HOTPLUG_EN, orig);
266 static bool intel_crt_detect_ddc(struct drm_encoder *encoder)
268 struct intel_encoder *intel_encoder = enc_to_intel_encoder(encoder);
270 /* CRT should always be at 0, but check anyway */
271 if (intel_encoder->type != INTEL_OUTPUT_ANALOG)
274 return intel_ddc_probe(intel_encoder);
277 static enum drm_connector_status
278 intel_crt_load_detect(struct drm_crtc *crtc, struct intel_encoder *intel_encoder)
280 struct drm_encoder *encoder = &intel_encoder->enc;
281 struct drm_device *dev = encoder->dev;
282 struct drm_i915_private *dev_priv = dev->dev_private;
283 struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
284 uint32_t pipe = intel_crtc->pipe;
285 uint32_t save_bclrpat;
286 uint32_t save_vtotal;
287 uint32_t vtotal, vactive;
289 uint32_t vblank, vblank_start, vblank_end;
291 uint32_t bclrpat_reg;
295 uint32_t pipeconf_reg;
296 uint32_t pipe_dsl_reg;
298 enum drm_connector_status status;
301 bclrpat_reg = BCLRPAT_A;
302 vtotal_reg = VTOTAL_A;
303 vblank_reg = VBLANK_A;
305 pipeconf_reg = PIPEACONF;
306 pipe_dsl_reg = PIPEADSL;
308 bclrpat_reg = BCLRPAT_B;
309 vtotal_reg = VTOTAL_B;
310 vblank_reg = VBLANK_B;
312 pipeconf_reg = PIPEBCONF;
313 pipe_dsl_reg = PIPEBDSL;
316 save_bclrpat = I915_READ(bclrpat_reg);
317 save_vtotal = I915_READ(vtotal_reg);
318 vblank = I915_READ(vblank_reg);
320 vtotal = ((save_vtotal >> 16) & 0xfff) + 1;
321 vactive = (save_vtotal & 0x7ff) + 1;
323 vblank_start = (vblank & 0xfff) + 1;
324 vblank_end = ((vblank >> 16) & 0xfff) + 1;
326 /* Set the border color to purple. */
327 I915_WRITE(bclrpat_reg, 0x500050);
330 uint32_t pipeconf = I915_READ(pipeconf_reg);
331 I915_WRITE(pipeconf_reg, pipeconf | PIPECONF_FORCE_BORDER);
332 /* Wait for next Vblank to substitue
333 * border color for Color info */
334 intel_wait_for_vblank(dev);
335 st00 = I915_READ8(VGA_MSR_WRITE);
336 status = ((st00 & (1 << 4)) != 0) ?
337 connector_status_connected :
338 connector_status_disconnected;
340 I915_WRITE(pipeconf_reg, pipeconf);
342 bool restore_vblank = false;
346 * If there isn't any border, add some.
347 * Yes, this will flicker
349 if (vblank_start <= vactive && vblank_end >= vtotal) {
350 uint32_t vsync = I915_READ(vsync_reg);
351 uint32_t vsync_start = (vsync & 0xffff) + 1;
353 vblank_start = vsync_start;
354 I915_WRITE(vblank_reg,
356 ((vblank_end - 1) << 16));
357 restore_vblank = true;
359 /* sample in the vertical border, selecting the larger one */
360 if (vblank_start - vactive >= vtotal - vblank_end)
361 vsample = (vblank_start + vactive) >> 1;
363 vsample = (vtotal + vblank_end) >> 1;
366 * Wait for the border to be displayed
368 while (I915_READ(pipe_dsl_reg) >= vactive)
370 while ((dsl = I915_READ(pipe_dsl_reg)) <= vsample)
373 * Watch ST00 for an entire scanline
379 /* Read the ST00 VGA status register */
380 st00 = I915_READ8(VGA_MSR_WRITE);
383 } while ((I915_READ(pipe_dsl_reg) == dsl));
385 /* restore vblank if necessary */
387 I915_WRITE(vblank_reg, vblank);
389 * If more than 3/4 of the scanline detected a monitor,
390 * then it is assumed to be present. This works even on i830,
391 * where there isn't any way to force the border color across
394 status = detect * 4 > count * 3 ?
395 connector_status_connected :
396 connector_status_disconnected;
399 /* Restore previous settings */
400 I915_WRITE(bclrpat_reg, save_bclrpat);
405 static enum drm_connector_status intel_crt_detect(struct drm_connector *connector)
407 struct drm_device *dev = connector->dev;
408 struct drm_encoder *encoder = intel_attached_encoder(connector);
409 struct intel_encoder *intel_encoder = enc_to_intel_encoder(encoder);
410 struct drm_crtc *crtc;
412 enum drm_connector_status status;
414 if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
415 if (intel_crt_detect_hotplug(connector))
416 return connector_status_connected;
418 return connector_status_disconnected;
421 if (intel_crt_detect_ddc(encoder))
422 return connector_status_connected;
424 /* for pre-945g platforms use load detect */
425 if (encoder->crtc && encoder->crtc->enabled) {
426 status = intel_crt_load_detect(encoder->crtc, intel_encoder);
428 crtc = intel_get_load_detect_pipe(intel_encoder, connector,
431 status = intel_crt_load_detect(crtc, intel_encoder);
432 intel_release_load_detect_pipe(intel_encoder,
433 connector, dpms_mode);
435 status = connector_status_unknown;
441 static void intel_crt_destroy(struct drm_connector *connector)
443 drm_sysfs_connector_remove(connector);
444 drm_connector_cleanup(connector);
448 static int intel_crt_get_modes(struct drm_connector *connector)
451 struct drm_encoder *encoder = intel_attached_encoder(connector);
452 struct intel_encoder *intel_encoder = enc_to_intel_encoder(encoder);
453 struct i2c_adapter *ddc_bus;
454 struct drm_device *dev = connector->dev;
457 ret = intel_ddc_get_modes(connector, intel_encoder->ddc_bus);
458 if (ret || !IS_G4X(dev))
461 /* Try to probe digital port for output in DVI-I -> VGA mode. */
462 ddc_bus = intel_i2c_create(connector->dev, GPIOD, "CRTDDC_D");
465 dev_printk(KERN_ERR, &connector->dev->pdev->dev,
466 "DDC bus registration failed for CRTDDC_D.\n");
469 /* Try to get modes by GPIOD port */
470 ret = intel_ddc_get_modes(connector, ddc_bus);
471 intel_i2c_destroy(ddc_bus);
478 static int intel_crt_set_property(struct drm_connector *connector,
479 struct drm_property *property,
486 * Routines for controlling stuff on the analog port
489 static const struct drm_encoder_helper_funcs intel_crt_helper_funcs = {
490 .dpms = intel_crt_dpms,
491 .mode_fixup = intel_crt_mode_fixup,
492 .prepare = intel_encoder_prepare,
493 .commit = intel_encoder_commit,
494 .mode_set = intel_crt_mode_set,
497 static const struct drm_connector_funcs intel_crt_connector_funcs = {
498 .dpms = drm_helper_connector_dpms,
499 .detect = intel_crt_detect,
500 .fill_modes = drm_helper_probe_single_connector_modes,
501 .destroy = intel_crt_destroy,
502 .set_property = intel_crt_set_property,
505 static const struct drm_connector_helper_funcs intel_crt_connector_helper_funcs = {
506 .mode_valid = intel_crt_mode_valid,
507 .get_modes = intel_crt_get_modes,
508 .best_encoder = intel_attached_encoder,
511 static void intel_crt_enc_destroy(struct drm_encoder *encoder)
513 struct intel_encoder *intel_encoder = enc_to_intel_encoder(encoder);
515 intel_i2c_destroy(intel_encoder->ddc_bus);
516 drm_encoder_cleanup(encoder);
517 kfree(intel_encoder);
520 static const struct drm_encoder_funcs intel_crt_enc_funcs = {
521 .destroy = intel_crt_enc_destroy,
524 void intel_crt_init(struct drm_device *dev)
526 struct drm_connector *connector;
527 struct intel_encoder *intel_encoder;
528 struct intel_connector *intel_connector;
529 struct drm_i915_private *dev_priv = dev->dev_private;
532 intel_encoder = kzalloc(sizeof(struct intel_encoder), GFP_KERNEL);
536 intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
537 if (!intel_connector) {
538 kfree(intel_encoder);
542 connector = &intel_connector->base;
543 drm_connector_init(dev, &intel_connector->base,
544 &intel_crt_connector_funcs, DRM_MODE_CONNECTOR_VGA);
546 drm_encoder_init(dev, &intel_encoder->enc, &intel_crt_enc_funcs,
547 DRM_MODE_ENCODER_DAC);
549 drm_mode_connector_attach_encoder(&intel_connector->base,
550 &intel_encoder->enc);
552 /* Set up the DDC bus. */
553 if (HAS_PCH_SPLIT(dev))
557 /* Use VBT information for CRT DDC if available */
558 if (dev_priv->crt_ddc_bus != 0)
559 i2c_reg = dev_priv->crt_ddc_bus;
561 intel_encoder->ddc_bus = intel_i2c_create(dev, i2c_reg, "CRTDDC_A");
562 if (!intel_encoder->ddc_bus) {
563 dev_printk(KERN_ERR, &dev->pdev->dev, "DDC bus registration "
568 intel_encoder->type = INTEL_OUTPUT_ANALOG;
569 intel_encoder->clone_mask = (1 << INTEL_SDVO_NON_TV_CLONE_BIT) |
570 (1 << INTEL_ANALOG_CLONE_BIT) |
571 (1 << INTEL_SDVO_LVDS_CLONE_BIT);
572 intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
573 connector->interlace_allowed = 1;
574 connector->doublescan_allowed = 0;
576 drm_encoder_helper_add(&intel_encoder->enc, &intel_crt_helper_funcs);
577 drm_connector_helper_add(connector, &intel_crt_connector_helper_funcs);
579 drm_sysfs_connector_add(connector);
581 if (I915_HAS_HOTPLUG(dev))
582 connector->polled = DRM_CONNECTOR_POLL_HPD;
584 connector->polled = DRM_CONNECTOR_POLL_CONNECT;
586 dev_priv->hotplug_supported_mask |= CRT_HOTPLUG_INT_STATUS;