![Ma Ling](/assets/img/avatar_default.png)
We detect HDMI output connection status by writing to HOT Plug Interrupt Detect Enable bit in PORT_HOTPLUG_EN. The behavior will generate a specified interrupt, which is caught by audio driver, but during one detection driver set all Detect Enable bits of HDMIB, HDMIC HDMID, and generate wrong interrupt signals for current output, according to the signals audio driver misunderstand device status. The patch intends to handle corresponding output precisely. It fixed freedesktop.org bug #21371 Signed-off-by: Ma Ling <ling.ma@intel.com> Signed-off-by: Eric Anholt <eric@anholt.net>
305 lines
8.6 KiB
C
305 lines
8.6 KiB
C
/*
|
|
* 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>
|
|
#include <linux/delay.h>
|
|
#include "drmP.h"
|
|
#include "drm.h"
|
|
#include "drm_crtc.h"
|
|
#include "intel_drv.h"
|
|
#include "i915_drm.h"
|
|
#include "i915_drv.h"
|
|
|
|
struct intel_hdmi_priv {
|
|
u32 sdvox_reg;
|
|
u32 save_SDVOX;
|
|
bool has_hdmi_sink;
|
|
};
|
|
|
|
static void intel_hdmi_mode_set(struct drm_encoder *encoder,
|
|
struct drm_display_mode *mode,
|
|
struct drm_display_mode *adjusted_mode)
|
|
{
|
|
struct drm_device *dev = encoder->dev;
|
|
struct drm_i915_private *dev_priv = dev->dev_private;
|
|
struct drm_crtc *crtc = encoder->crtc;
|
|
struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
|
|
struct intel_output *intel_output = enc_to_intel_output(encoder);
|
|
struct intel_hdmi_priv *hdmi_priv = intel_output->dev_priv;
|
|
u32 sdvox;
|
|
|
|
sdvox = SDVO_ENCODING_HDMI |
|
|
SDVO_BORDER_ENABLE |
|
|
SDVO_VSYNC_ACTIVE_HIGH |
|
|
SDVO_HSYNC_ACTIVE_HIGH;
|
|
|
|
if (hdmi_priv->has_hdmi_sink)
|
|
sdvox |= SDVO_AUDIO_ENABLE;
|
|
|
|
if (intel_crtc->pipe == 1)
|
|
sdvox |= SDVO_PIPE_B_SELECT;
|
|
|
|
I915_WRITE(hdmi_priv->sdvox_reg, sdvox);
|
|
POSTING_READ(hdmi_priv->sdvox_reg);
|
|
}
|
|
|
|
static void intel_hdmi_dpms(struct drm_encoder *encoder, int mode)
|
|
{
|
|
struct drm_device *dev = encoder->dev;
|
|
struct drm_i915_private *dev_priv = dev->dev_private;
|
|
struct intel_output *intel_output = enc_to_intel_output(encoder);
|
|
struct intel_hdmi_priv *hdmi_priv = intel_output->dev_priv;
|
|
u32 temp;
|
|
|
|
if (mode != DRM_MODE_DPMS_ON) {
|
|
temp = I915_READ(hdmi_priv->sdvox_reg);
|
|
I915_WRITE(hdmi_priv->sdvox_reg, temp & ~SDVO_ENABLE);
|
|
} else {
|
|
temp = I915_READ(hdmi_priv->sdvox_reg);
|
|
I915_WRITE(hdmi_priv->sdvox_reg, temp | SDVO_ENABLE);
|
|
}
|
|
POSTING_READ(hdmi_priv->sdvox_reg);
|
|
}
|
|
|
|
static void intel_hdmi_save(struct drm_connector *connector)
|
|
{
|
|
struct drm_device *dev = connector->dev;
|
|
struct drm_i915_private *dev_priv = dev->dev_private;
|
|
struct intel_output *intel_output = to_intel_output(connector);
|
|
struct intel_hdmi_priv *hdmi_priv = intel_output->dev_priv;
|
|
|
|
hdmi_priv->save_SDVOX = I915_READ(hdmi_priv->sdvox_reg);
|
|
}
|
|
|
|
static void intel_hdmi_restore(struct drm_connector *connector)
|
|
{
|
|
struct drm_device *dev = connector->dev;
|
|
struct drm_i915_private *dev_priv = dev->dev_private;
|
|
struct intel_output *intel_output = to_intel_output(connector);
|
|
struct intel_hdmi_priv *hdmi_priv = intel_output->dev_priv;
|
|
|
|
I915_WRITE(hdmi_priv->sdvox_reg, hdmi_priv->save_SDVOX);
|
|
POSTING_READ(hdmi_priv->sdvox_reg);
|
|
}
|
|
|
|
static int intel_hdmi_mode_valid(struct drm_connector *connector,
|
|
struct drm_display_mode *mode)
|
|
{
|
|
if (mode->clock > 165000)
|
|
return MODE_CLOCK_HIGH;
|
|
if (mode->clock < 20000)
|
|
return MODE_CLOCK_HIGH;
|
|
|
|
if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
|
|
return MODE_NO_DBLESCAN;
|
|
|
|
return MODE_OK;
|
|
}
|
|
|
|
static bool intel_hdmi_mode_fixup(struct drm_encoder *encoder,
|
|
struct drm_display_mode *mode,
|
|
struct drm_display_mode *adjusted_mode)
|
|
{
|
|
return true;
|
|
}
|
|
|
|
static void
|
|
intel_hdmi_sink_detect(struct drm_connector *connector)
|
|
{
|
|
struct intel_output *intel_output = to_intel_output(connector);
|
|
struct intel_hdmi_priv *hdmi_priv = intel_output->dev_priv;
|
|
struct edid *edid = NULL;
|
|
|
|
edid = drm_get_edid(&intel_output->base,
|
|
&intel_output->ddc_bus->adapter);
|
|
if (edid != NULL) {
|
|
hdmi_priv->has_hdmi_sink = drm_detect_hdmi_monitor(edid);
|
|
kfree(edid);
|
|
intel_output->base.display_info.raw_edid = NULL;
|
|
}
|
|
}
|
|
|
|
static enum drm_connector_status
|
|
intel_hdmi_detect(struct drm_connector *connector)
|
|
{
|
|
struct drm_device *dev = connector->dev;
|
|
struct drm_i915_private *dev_priv = dev->dev_private;
|
|
struct intel_output *intel_output = to_intel_output(connector);
|
|
struct intel_hdmi_priv *hdmi_priv = intel_output->dev_priv;
|
|
u32 temp, bit;
|
|
|
|
temp = I915_READ(PORT_HOTPLUG_EN);
|
|
|
|
switch (hdmi_priv->sdvox_reg) {
|
|
case SDVOB:
|
|
temp |= HDMIB_HOTPLUG_INT_EN;
|
|
break;
|
|
case SDVOC:
|
|
temp |= HDMIC_HOTPLUG_INT_EN;
|
|
break;
|
|
default:
|
|
return connector_status_unknown;
|
|
}
|
|
|
|
I915_WRITE(PORT_HOTPLUG_EN, temp);
|
|
|
|
POSTING_READ(PORT_HOTPLUG_EN);
|
|
|
|
switch (hdmi_priv->sdvox_reg) {
|
|
case SDVOB:
|
|
bit = HDMIB_HOTPLUG_INT_STATUS;
|
|
break;
|
|
case SDVOC:
|
|
bit = HDMIC_HOTPLUG_INT_STATUS;
|
|
break;
|
|
default:
|
|
return connector_status_unknown;
|
|
}
|
|
|
|
if ((I915_READ(PORT_HOTPLUG_STAT) & bit) != 0) {
|
|
intel_hdmi_sink_detect(connector);
|
|
return connector_status_connected;
|
|
} else
|
|
return connector_status_disconnected;
|
|
}
|
|
|
|
static int intel_hdmi_get_modes(struct drm_connector *connector)
|
|
{
|
|
struct intel_output *intel_output = to_intel_output(connector);
|
|
|
|
/* We should parse the EDID data and find out if it's an HDMI sink so
|
|
* we can send audio to it.
|
|
*/
|
|
|
|
return intel_ddc_get_modes(intel_output);
|
|
}
|
|
|
|
static void intel_hdmi_destroy(struct drm_connector *connector)
|
|
{
|
|
struct intel_output *intel_output = to_intel_output(connector);
|
|
|
|
if (intel_output->i2c_bus)
|
|
intel_i2c_destroy(intel_output->i2c_bus);
|
|
drm_sysfs_connector_remove(connector);
|
|
drm_connector_cleanup(connector);
|
|
kfree(intel_output);
|
|
}
|
|
|
|
static const struct drm_encoder_helper_funcs intel_hdmi_helper_funcs = {
|
|
.dpms = intel_hdmi_dpms,
|
|
.mode_fixup = intel_hdmi_mode_fixup,
|
|
.prepare = intel_encoder_prepare,
|
|
.mode_set = intel_hdmi_mode_set,
|
|
.commit = intel_encoder_commit,
|
|
};
|
|
|
|
static const struct drm_connector_funcs intel_hdmi_connector_funcs = {
|
|
.save = intel_hdmi_save,
|
|
.restore = intel_hdmi_restore,
|
|
.detect = intel_hdmi_detect,
|
|
.fill_modes = drm_helper_probe_single_connector_modes,
|
|
.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,
|
|
.best_encoder = intel_best_encoder,
|
|
};
|
|
|
|
static void intel_hdmi_enc_destroy(struct drm_encoder *encoder)
|
|
{
|
|
drm_encoder_cleanup(encoder);
|
|
}
|
|
|
|
static const struct drm_encoder_funcs intel_hdmi_enc_funcs = {
|
|
.destroy = intel_hdmi_enc_destroy,
|
|
};
|
|
|
|
|
|
void intel_hdmi_init(struct drm_device *dev, int sdvox_reg)
|
|
{
|
|
struct drm_i915_private *dev_priv = dev->dev_private;
|
|
struct drm_connector *connector;
|
|
struct intel_output *intel_output;
|
|
struct intel_hdmi_priv *hdmi_priv;
|
|
|
|
intel_output = kcalloc(sizeof(struct intel_output) +
|
|
sizeof(struct intel_hdmi_priv), 1, GFP_KERNEL);
|
|
if (!intel_output)
|
|
return;
|
|
hdmi_priv = (struct intel_hdmi_priv *)(intel_output + 1);
|
|
|
|
connector = &intel_output->base;
|
|
drm_connector_init(dev, connector, &intel_hdmi_connector_funcs,
|
|
DRM_MODE_CONNECTOR_DVID);
|
|
drm_connector_helper_add(connector, &intel_hdmi_connector_helper_funcs);
|
|
|
|
intel_output->type = INTEL_OUTPUT_HDMI;
|
|
|
|
connector->interlace_allowed = 0;
|
|
connector->doublescan_allowed = 0;
|
|
|
|
/* Set up the DDC bus. */
|
|
if (sdvox_reg == SDVOB)
|
|
intel_output->ddc_bus = intel_i2c_create(dev, GPIOE, "HDMIB");
|
|
else
|
|
intel_output->ddc_bus = intel_i2c_create(dev, GPIOD, "HDMIC");
|
|
|
|
if (!intel_output->ddc_bus)
|
|
goto err_connector;
|
|
|
|
hdmi_priv->sdvox_reg = sdvox_reg;
|
|
intel_output->dev_priv = hdmi_priv;
|
|
|
|
drm_encoder_init(dev, &intel_output->enc, &intel_hdmi_enc_funcs,
|
|
DRM_MODE_ENCODER_TMDS);
|
|
drm_encoder_helper_add(&intel_output->enc, &intel_hdmi_helper_funcs);
|
|
|
|
drm_mode_connector_attach_encoder(&intel_output->base,
|
|
&intel_output->enc);
|
|
drm_sysfs_connector_add(connector);
|
|
|
|
/* 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);
|
|
}
|
|
|
|
return;
|
|
|
|
err_connector:
|
|
drm_connector_cleanup(connector);
|
|
kfree(intel_output);
|
|
|
|
return;
|
|
}
|