From: Swati Sharma <swati2.sha...@intel.com>

In this patch enables support for detecting link failures between
PCON and HDMI sink in i915 driver. HDMI link loss indication to
upstream DP source is indicated via IRQ_HPD. This is followed by
reading of HDMI link configuration status (HDMI_TX_LINK_ACTIVE_STATUS).
If the PCON → HDMI 2.1 link status is off; reinitiate frl link
training to recover. Also, report HDMI FRL link error count range for
each individual FRL active lane is indicated by
DOWNSTREAM_HDMI_ERROR_STATUS_LN registers.

v2: Checked for dpcd read and write failures and added debug message.
(Uma Shankar)
v3: rearranged code to re-start FRL link training or fall back to
TMDS mode.

Signed-off-by: Swati Sharma <swati2.sha...@intel.com>
Signed-off-by: Ankit Nautiyal <ankit.k.nauti...@intel.com>
Reviewed-by: Uma Shankar <uma.shan...@intel.com>
---
 drivers/gpu/drm/i915/display/intel_dp.c | 68 +++++++++++++++++++++++--
 1 file changed, 65 insertions(+), 3 deletions(-)

diff --git a/drivers/gpu/drm/i915/display/intel_dp.c 
b/drivers/gpu/drm/i915/display/intel_dp.c
index f8f82fe8c52a..0616779d858e 100644
--- a/drivers/gpu/drm/i915/display/intel_dp.c
+++ b/drivers/gpu/drm/i915/display/intel_dp.c
@@ -6032,6 +6032,43 @@ intel_dp_check_mst_status(struct intel_dp *intel_dp)
        return link_ok;
 }
 
+static void
+intel_dp_handle_hdmi_link_status_change(struct intel_dp *intel_dp)
+{
+       bool is_active;
+       u8 buf = 0;
+       struct drm_i915_private *dev_priv = dp_to_i915(intel_dp);
+
+       is_active = drm_dp_pcon_hdmi_link_active(&intel_dp->aux);
+       if (intel_dp->frl.is_trained && !is_active) {
+               if (drm_dp_dpcd_readb(&intel_dp->aux, 
DP_PCON_HDMI_LINK_CONFIG_1, &buf) < 0)
+                       return;
+
+               buf &=  ~DP_PCON_ENABLE_HDMI_LINK;
+               if (drm_dp_dpcd_writeb(&intel_dp->aux, 
DP_PCON_HDMI_LINK_CONFIG_1, buf) < 0)
+                       return;
+
+               drm_dp_pcon_hdmi_frl_link_error_count(&intel_dp->aux, 
&intel_dp->attached_connector->base);
+
+               intel_dp->frl.is_trained = false;
+               intel_dp->frl.trained_rate_gbps = 0;
+
+               /* Restart FRL training or fall back to TMDS mode */
+               if (intel_dp_pcon_start_frl_training(intel_dp) < 0) {
+                       int ret, mode;
+
+                       drm_dbg(&dev_priv->drm, "Couldnt restart FRL, 
continuing with TMDS mode\n");
+                       ret = drm_dp_pcon_reset_frl_config(&intel_dp->aux);
+                       mode = drm_dp_pcon_hdmi_link_mode(&intel_dp->aux, NULL);
+
+                       if (ret < 0 || mode != DP_PCON_HDMI_MODE_TMDS)
+                       drm_dbg(&dev_priv->drm, "Issue with PCON, cannot set 
TMDS mode\n");
+               } else {
+                       drm_dbg(&dev_priv->drm, "FRL Re-training Completed\n");
+               }
+       }
+}
+
 static bool
 intel_dp_needs_link_retrain(struct intel_dp *intel_dp)
 {
@@ -6397,7 +6434,7 @@ intel_dp_hotplug(struct intel_encoder *encoder,
        return state;
 }
 
-static void intel_dp_check_service_irq(struct intel_dp *intel_dp)
+static void intel_dp_check_device_service_irq(struct intel_dp *intel_dp)
 {
        struct drm_i915_private *i915 = dp_to_i915(intel_dp);
        u8 val;
@@ -6421,6 +6458,30 @@ static void intel_dp_check_service_irq(struct intel_dp 
*intel_dp)
                drm_dbg_kms(&i915->drm, "Sink specific irq unhandled\n");
 }
 
+static void intel_dp_check_link_service_irq(struct intel_dp *intel_dp)
+{
+       struct drm_i915_private *i915 = dp_to_i915(intel_dp);
+       u8 val;
+
+       if (intel_dp->dpcd[DP_DPCD_REV] < 0x11)
+               return;
+
+       if (drm_dp_dpcd_readb(&intel_dp->aux,
+                             DP_LINK_SERVICE_IRQ_VECTOR_ESI0, &val) != 1 || 
!val) {
+               drm_dbg_kms(&i915->drm, "Error in reading link service irq 
vector\n");
+               return;
+       }
+
+       if (drm_dp_dpcd_writeb(&intel_dp->aux,
+                              DP_LINK_SERVICE_IRQ_VECTOR_ESI0, val) != 1) {
+               drm_dbg_kms(&i915->drm, "Error in writing link service irq 
vector\n");
+               return;
+       }
+
+       if (val & HDMI_LINK_STATUS_CHANGED)
+               intel_dp_handle_hdmi_link_status_change(intel_dp);
+}
+
 /*
  * According to DP spec
  * 5.1.2:
@@ -6460,7 +6521,8 @@ intel_dp_short_pulse(struct intel_dp *intel_dp)
                return false;
        }
 
-       intel_dp_check_service_irq(intel_dp);
+       intel_dp_check_device_service_irq(intel_dp);
+       intel_dp_check_link_service_irq(intel_dp);
 
        /* Handle CEC interrupts, if any */
        drm_dp_cec_irq(&intel_dp->aux);
@@ -6894,7 +6956,7 @@ intel_dp_detect(struct drm_connector *connector,
            to_intel_connector(connector)->detect_edid)
                status = connector_status_connected;
 
-       intel_dp_check_service_irq(intel_dp);
+       intel_dp_check_device_service_irq(intel_dp);
 
 out:
        if (status != connector_status_connected && !intel_dp->is_mst)
-- 
2.17.1

_______________________________________________
Intel-gfx mailing list
Intel-gfx@lists.freedesktop.org
https://lists.freedesktop.org/mailman/listinfo/intel-gfx

Reply via email to