This patch process phy compliance request by programming requested
vswing, pre-emphasis and test pattern.

Signed-off-by: Animesh Manna <[email protected]>
---
 drivers/gpu/drm/i915/display/intel_ddi.c     | 14 ++++
 drivers/gpu/drm/i915/display/intel_display.c |  5 ++
 drivers/gpu/drm/i915/display/intel_dp.c      | 77 ++++++++++++++++++++
 drivers/gpu/drm/i915/display/intel_dp.h      |  2 +
 drivers/gpu/drm/i915/i915_drv.h              |  2 +
 5 files changed, 100 insertions(+)

diff --git a/drivers/gpu/drm/i915/display/intel_ddi.c 
b/drivers/gpu/drm/i915/display/intel_ddi.c
index 8f817de34460..c12d4ebbd352 100644
--- a/drivers/gpu/drm/i915/display/intel_ddi.c
+++ b/drivers/gpu/drm/i915/display/intel_ddi.c
@@ -3700,8 +3700,17 @@ static void intel_ddi_pre_enable(struct intel_encoder 
*encoder,
 {
        struct intel_crtc *crtc = to_intel_crtc(crtc_state->uapi.crtc);
        struct drm_i915_private *dev_priv = to_i915(crtc->base.dev);
+       struct intel_digital_port *dig_port = enc_to_dig_port(&encoder->base);
        enum pipe pipe = crtc->pipe;
 
+       if (encoder->type == INTEL_OUTPUT_DP) {
+               if (dig_port->dp.compliance.test_type ==
+                   DP_TEST_LINK_PHY_TEST_PATTERN) {
+                       intel_dp_process_phy_request(&dig_port->dp);
+                       return;
+               }
+       }
+
        /*
         * When called from DP MST code:
         * - conn_state will be NULL
@@ -4147,6 +4156,11 @@ intel_ddi_pre_pll_enable(struct intel_encoder *encoder,
        enum phy phy = intel_port_to_phy(dev_priv, encoder->port);
        bool is_tc_port = intel_phy_is_tc(dev_priv, phy);
 
+       if (encoder->type == INTEL_OUTPUT_DP)
+               if (dig_port->dp.compliance.test_type ==
+                   DP_TEST_LINK_PHY_TEST_PATTERN)
+                       return;
+
        if (is_tc_port)
                intel_tc_port_get_link(dig_port, crtc_state->lane_count);
 
diff --git a/drivers/gpu/drm/i915/display/intel_display.c 
b/drivers/gpu/drm/i915/display/intel_display.c
index adf50c4b38ad..4ad11df55f07 100644
--- a/drivers/gpu/drm/i915/display/intel_display.c
+++ b/drivers/gpu/drm/i915/display/intel_display.c
@@ -545,6 +545,11 @@ icl_wa_scalerclkgating(struct drm_i915_private *dev_priv, 
enum pipe pipe,
 static bool
 needs_modeset(const struct intel_crtc_state *state)
 {
+       struct drm_i915_private *dev_priv = to_i915(state->uapi.crtc->dev);
+
+       if (dev_priv->dp_phy_comp)
+               return true;
+
        return drm_atomic_crtc_needs_modeset(&state->uapi);
 }
 
diff --git a/drivers/gpu/drm/i915/display/intel_dp.c 
b/drivers/gpu/drm/i915/display/intel_dp.c
index df31278a1619..2c3d4b6c6036 100644
--- a/drivers/gpu/drm/i915/display/intel_dp.c
+++ b/drivers/gpu/drm/i915/display/intel_dp.c
@@ -5010,14 +5010,91 @@ static inline void intel_dp_phy_pattern_update(struct 
intel_dp *intel_dp)
        }
 }
 
+static void
+intel_dp_autotest_phy_ddi_disable(struct intel_dp *intel_dp)
+{
+       struct intel_digital_port *intel_dig_port = dp_to_dig_port(intel_dp);
+       struct drm_device *dev = intel_dig_port->base.base.dev;
+       struct drm_i915_private *dev_priv = to_i915(dev);
+       enum port port = intel_dig_port->base.port;
+       u32 ddi_buf_ctl_value, dp_tp_ctl_value, trans_ddi_func_ctl_value;
+
+       ddi_buf_ctl_value = I915_READ(DDI_BUF_CTL(port));
+       dp_tp_ctl_value = I915_READ(TGL_DP_TP_CTL(port));
+       trans_ddi_func_ctl_value = I915_READ(TRANS_DDI_FUNC_CTL(port));
+
+       ddi_buf_ctl_value        &= ~(DDI_BUF_CTL_ENABLE | DDI_PORT_WIDTH_MASK);
+       dp_tp_ctl_value          &= ~DP_TP_CTL_ENABLE;
+       trans_ddi_func_ctl_value &= ~(TRANS_DDI_FUNC_ENABLE |
+                                     DDI_PORT_WIDTH_MASK);
+
+       I915_WRITE(DDI_BUF_CTL(port), ddi_buf_ctl_value);
+       I915_WRITE(TGL_DP_TP_CTL(port), dp_tp_ctl_value);
+       I915_WRITE(TRANS_DDI_FUNC_CTL(port), trans_ddi_func_ctl_value);
+}
+
+static void
+intel_dp_autotest_phy_ddi_enable(struct intel_dp *intel_dp, uint8_t lane_cnt)
+{
+       struct intel_digital_port *intel_dig_port = dp_to_dig_port(intel_dp);
+       struct drm_device *dev = intel_dig_port->base.base.dev;
+       struct drm_i915_private *dev_priv = to_i915(dev);
+       enum port port = intel_dig_port->base.port;
+       u32 ddi_buf_ctl_value, dp_tp_ctl_value, trans_ddi_func_ctl_value;
+
+       ddi_buf_ctl_value = I915_READ(DDI_BUF_CTL(port));
+       dp_tp_ctl_value = I915_READ(TGL_DP_TP_CTL(port));
+       trans_ddi_func_ctl_value = I915_READ(TRANS_DDI_FUNC_CTL(port));
+
+       ddi_buf_ctl_value        |= DDI_BUF_CTL_ENABLE |
+                                   DDI_PORT_WIDTH(lane_cnt);
+       dp_tp_ctl_value          |= DP_TP_CTL_ENABLE;
+       trans_ddi_func_ctl_value |= TRANS_DDI_FUNC_ENABLE |
+                                   DDI_PORT_WIDTH(lane_cnt);
+
+       I915_WRITE(TRANS_DDI_FUNC_CTL(port), trans_ddi_func_ctl_value);
+       I915_WRITE(TGL_DP_TP_CTL(port), dp_tp_ctl_value);
+       I915_WRITE(DDI_BUF_CTL(port), ddi_buf_ctl_value);
+}
+
+void intel_dp_process_phy_request(struct intel_dp *intel_dp)
+{
+       struct drm_dp_phy_test_params *data =
+               &intel_dp->compliance.test_data.phytest;
+       u8 link_status[DP_LINK_STATUS_SIZE];
+
+       if (!intel_dp_get_link_status(intel_dp, link_status)) {
+               DRM_DEBUG_KMS("failed to get link status\n");
+               return;
+       }
+
+       /* retrieve vswing & pre-emphasis setting */
+       intel_get_adjust_train(intel_dp, link_status);
+
+       intel_dp_autotest_phy_ddi_disable(intel_dp);
+
+       intel_dp_set_signal_levels(intel_dp);
+
+       intel_dp_phy_pattern_update(intel_dp);
+
+       intel_dp_autotest_phy_ddi_enable(intel_dp, data->num_lanes);
+
+       drm_dp_set_phy_test_pattern(&intel_dp->aux, data);
+}
+
 static u8 intel_dp_autotest_phy_pattern(struct intel_dp *intel_dp)
 {
        u8 test_result = DP_TEST_NAK;
+       struct drm_i915_private *dev_priv = dp_to_i915(intel_dp);
 
        test_result = intel_dp_prepare_phytest(intel_dp);
        if (test_result != DP_TEST_ACK)
                DRM_ERROR("Phy test preparation failed\n");
 
+       /* Set test active flag here so userspace doesn't interrupt things */
+       intel_dp->compliance.test_active = 1;
+       dev_priv->dp_phy_comp = true;
+
        return test_result;
 }
 
diff --git a/drivers/gpu/drm/i915/display/intel_dp.h 
b/drivers/gpu/drm/i915/display/intel_dp.h
index 0d0cb692f701..b1274ecffc7f 100644
--- a/drivers/gpu/drm/i915/display/intel_dp.h
+++ b/drivers/gpu/drm/i915/display/intel_dp.h
@@ -120,6 +120,8 @@ void intel_dp_hdr_metadata_enable(struct intel_dp *intel_dp,
                                  const struct intel_crtc_state *crtc_state,
                                  const struct drm_connector_state *conn_state);
 bool intel_digital_port_connected(struct intel_encoder *encoder);
+void intel_dp_process_phy_request(struct intel_dp *intel_dp);
+
 
 static inline unsigned int intel_dp_unused_lane_mask(int lane_count)
 {
diff --git a/drivers/gpu/drm/i915/i915_drv.h b/drivers/gpu/drm/i915/i915_drv.h
index 1779f600fcfb..232e0dfb9d8e 100644
--- a/drivers/gpu/drm/i915/i915_drv.h
+++ b/drivers/gpu/drm/i915/i915_drv.h
@@ -1285,6 +1285,8 @@ struct drm_i915_private {
 
        I915_SELFTEST_DECLARE(struct i915_selftest_stash selftest;)
 
+       bool dp_phy_comp;
+
        /*
         * NOTE: This is the dri1/ums dungeon, don't add stuff here. Your patch
         * will be rejected. Instead look for a better place.
-- 
2.22.0

_______________________________________________
Intel-gfx mailing list
[email protected]
https://lists.freedesktop.org/mailman/listinfo/intel-gfx

Reply via email to