drm/amd/display: Add helper for blanking all dp displays

[Why & How]
The codes to blank all dp display have been called many times,
so add a helper in dc_link to make it more concise.

Reviewed-by: Aric Cyr <Aric.Cyr@amd.com>
Acked-by: Solomon Chiu <solomon.chiu@amd.com>
Signed-off-by: Leo (Hanghong) Ma <hanghong.ma@amd.com>
Signed-off-by: Alex Deucher <alexander.deucher@amd.com>

diff --git a/drivers/gpu/drm/amd/display/dc/core/dc_link.c b/drivers/gpu/drm/amd/display/dc/core/dc_link.c
index 02c7a18c095f03696183296c03837731a035e884..74da226efffeec5f8fadd52897e75d3e64f0c08e 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/core/dc_link.c
+++ b/drivers/gpu/drm/amd/display/dc/core/dc_link.c
@@ -1906,6 +1906,51 @@ static enum dc_status enable_link_dp_mst(
        return enable_link_dp(state, pipe_ctx);
 }
 
+void blank_all_dp_displays(struct dc *dc, bool hw_init)
+{
+       unsigned int i, j, fe;
+       uint8_t dpcd_power_state = '\0';
+       enum dc_status status = DC_ERROR_UNEXPECTED;
+
+       for (i = 0; i < dc->link_count; i++) {
+               enum signal_type signal = dc->links[i]->connector_signal;
+
+               if ((signal == SIGNAL_TYPE_EDP) ||
+                       (signal == SIGNAL_TYPE_DISPLAY_PORT)) {
+                       if (hw_init && signal != SIGNAL_TYPE_EDP) {
+                               /* DP 2.0 spec requires that we read LTTPR caps first */
+                               dp_retrieve_lttpr_cap(dc->links[i]);
+                               /* if any of the displays are lit up turn them off */
+                               status = core_link_read_dpcd(dc->links[i], DP_SET_POWER,
+                                                       &dpcd_power_state, sizeof(dpcd_power_state));
+                       }
+
+                       if ((signal != SIGNAL_TYPE_EDP && status == DC_OK && dpcd_power_state == DP_POWER_STATE_D0) ||
+                               (!hw_init && dc->links[i]->link_enc->funcs->is_dig_enabled(dc->links[i]->link_enc))) {
+                               if (dc->links[i]->ep_type == DISPLAY_ENDPOINT_PHY &&
+                                               dc->links[i]->link_enc->funcs->get_dig_frontend) {
+                                       fe = dc->links[i]->link_enc->funcs->get_dig_frontend(dc->links[i]->link_enc);
+                                       if (fe == ENGINE_ID_UNKNOWN)
+                                               continue;
+
+                                       for (j = 0; j < dc->res_pool->stream_enc_count; j++) {
+                                               if (fe == dc->res_pool->stream_enc[j]->id) {
+                                                       dc->res_pool->stream_enc[j]->funcs->dp_blank(dc->links[i],
+                                                                       dc->res_pool->stream_enc[j]);
+                                                       break;
+                                               }
+                                       }
+                               }
+
+                               if (!dc->links[i]->wa_flags.dp_keep_receiver_powered ||
+                                       (hw_init && signal != SIGNAL_TYPE_EDP))
+                                       dp_receiver_power_ctrl(dc->links[i], false);
+                       }
+               }
+       }
+
+}
+
 static bool get_ext_hdmi_settings(struct pipe_ctx *pipe_ctx,
                enum engine_id eng_id,
                struct ext_hdmi_settings *settings)

diff --git a/drivers/gpu/drm/amd/display/dc/dc_link.h b/drivers/gpu/drm/amd/display/dc/dc_link.h
index a73d64b1fd3347d6ac86b47782286a66a678a267..69b008bafbbcd480cafab63f2e146ad8f557eb47 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/dc_link.h
+++ b/drivers/gpu/drm/amd/display/dc/dc_link.h
@@ -277,6 +277,7 @@ bool dc_link_setup_psr(struct dc_link *dc_link,
                struct psr_context *psr_context);
 
 void dc_link_get_psr_residency(const struct dc_link *link, uint32_t *residency);
+void blank_all_dp_displays(struct dc *dc, bool hw_init);
 
 /* Request DC to detect if there is a Panel connected.
  * boot - If this call is during initial boot.

diff --git a/drivers/gpu/drm/amd/display/dc/dce110/dce110_hw_sequencer.c b/drivers/gpu/drm/amd/display/dc/dce110/dce110_hw_sequencer.c
index af3e68d3e74760b890b4e1b38fd86428272ece4b..8108f9ae263874a8862e630ad5d9e2bde7b1c28f 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/dce110/dce110_hw_sequencer.c
+++ b/drivers/gpu/drm/amd/display/dc/dce110/dce110_hw_sequencer.c
@@ -1649,31 +1649,13 @@ static enum dc_status apply_single_controller_ctx_to_hw(
 
 static void power_down_encoders(struct dc *dc)
 {
-       int i, j;
+       int i;
+
+       blank_all_dp_displays(dc, false);
 
        for (i = 0; i < dc->link_count; i++) {
                enum signal_type signal = dc->links[i]->connector_signal;
 
-               if ((signal == SIGNAL_TYPE_EDP) ||
-                       (signal == SIGNAL_TYPE_DISPLAY_PORT)) {
-                       if (dc->links[i]->link_enc->funcs->get_dig_frontend &&
-                               dc->links[i]->link_enc->funcs->is_dig_enabled(dc->links[i]->link_enc)) {
-                               unsigned int fe = dc->links[i]->link_enc->funcs->get_dig_frontend(
-                                                                       dc->links[i]->link_enc);
-
-                               for (j = 0; j < dc->res_pool->stream_enc_count; j++) {
-                                       if (fe == dc->res_pool->stream_enc[j]->id) {
-                                               dc->res_pool->stream_enc[j]->funcs->dp_blank(dc->links[i],
-                                                                       dc->res_pool->stream_enc[j]);
-                                               break;
-                                       }
-                               }
-                       }
-
-                       if (!dc->links[i]->wa_flags.dp_keep_receiver_powered)
-                               dp_receiver_power_ctrl(dc->links[i], false);
-               }
-
                if (signal != SIGNAL_TYPE_EDP)
                        signal = SIGNAL_TYPE_NONE;
 

diff --git a/drivers/gpu/drm/amd/display/dc/dcn10/dcn10_hw_sequencer.c b/drivers/gpu/drm/amd/display/dc/dcn10/dcn10_hw_sequencer.c
index c5e2b4f138fd991b9c09ca92668aa255783b6be0..bc3ec05bf34b5a351876f54bab9660db0e339786 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/dcn10/dcn10_hw_sequencer.c
+++ b/drivers/gpu/drm/amd/display/dc/dcn10/dcn10_hw_sequencer.c
@@ -1366,7 +1366,7 @@ void dcn10_init_pipes(struct dc *dc, struct dc_state *context)
 
 void dcn10_init_hw(struct dc *dc)
 {
-       int i, j;
+       int i;
        struct abm *abm = dc->res_pool->abm;
        struct dmcu *dmcu = dc->res_pool->dmcu;
        struct dce_hwseq *hws = dc->hwseq;
@@ -1462,43 +1462,8 @@ void dcn10_init_hw(struct dc *dc)
                dmub_enable_outbox_notification(dc);
 
        /* we want to turn off all dp displays before doing detection */
-       if (dc->config.power_down_display_on_boot) {
-               uint8_t dpcd_power_state = '\0';
-               enum dc_status status = DC_ERROR_UNEXPECTED;
-
-               for (i = 0; i < dc->link_count; i++) {
-                       if (dc->links[i]->connector_signal != SIGNAL_TYPE_DISPLAY_PORT)
-                               continue;
-
-                       /* DP 2.0 requires that LTTPR Caps be read first */
-                       dp_retrieve_lttpr_cap(dc->links[i]);
-
-                       /*
-                        * If any of the displays are lit up turn them off.
-                        * The reason is that some MST hubs cannot be turned off
-                        * completely until we tell them to do so.
-                        * If not turned off, then displays connected to MST hub
-                        * won't light up.
-                        */
-                       status = core_link_read_dpcd(dc->links[i], DP_SET_POWER,
-                                                       &dpcd_power_state, sizeof(dpcd_power_state));
-                       if (status == DC_OK && dpcd_power_state == DP_POWER_STATE_D0) {
-                               /* blank dp stream before power off receiver*/
-                               if (dc->links[i]->link_enc->funcs->get_dig_frontend) {
-                                       unsigned int fe = dc->links[i]->link_enc->funcs->get_dig_frontend(dc->links[i]->link_enc);
-
-                                       for (j = 0; j < dc->res_pool->stream_enc_count; j++) {
-                                               if (fe == dc->res_pool->stream_enc[j]->id) {
-                                                       dc->res_pool->stream_enc[j]->funcs->dp_blank(dc->links[i],
-                                                                               dc->res_pool->stream_enc[j]);
-                                                       break;
-                                               }
-                                       }
-                               }
-                               dp_receiver_power_ctrl(dc->links[i], false);
-                       }
-               }
-       }
+       if (dc->config.power_down_display_on_boot)
+               blank_all_dp_displays(dc, true);
 
        /* If taking control over from VBIOS, we may want to optimize our first
         * mode set, so we need to skip powering down pipes until we know which

diff --git a/drivers/gpu/drm/amd/display/dc/dcn30/dcn30_hwseq.c b/drivers/gpu/drm/amd/display/dc/dcn30/dcn30_hwseq.c
index b132ebed09d4a32eeb6b2074c9879bdc8a3fb282..01a90badd173a3ea7ce6a6e734a61fca7a4ef770 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/dcn30/dcn30_hwseq.c
+++ b/drivers/gpu/drm/amd/display/dc/dcn30/dcn30_hwseq.c
@@ -437,7 +437,7 @@ void dcn30_init_hw(struct dc *dc)
        struct dce_hwseq *hws = dc->hwseq;
        struct dc_bios *dcb = dc->ctx->dc_bios;
        struct resource_pool *res_pool = dc->res_pool;
-       int i, j;
+       int i;
        int edp_num;
        uint32_t backlight = MAX_BACKLIGHT_LEVEL;
 
@@ -534,41 +534,8 @@ void dcn30_init_hw(struct dc *dc)
                        hws->funcs.dsc_pg_control(hws, res_pool->dscs[i]->inst, false);
 
        /* we want to turn off all dp displays before doing detection */
-       if (dc->config.power_down_display_on_boot) {
-               uint8_t dpcd_power_state = '\0';
-               enum dc_status status = DC_ERROR_UNEXPECTED;
-
-               for (i = 0; i < dc->link_count; i++) {
-                       if (dc->links[i]->connector_signal != SIGNAL_TYPE_DISPLAY_PORT)
-                               continue;
-                       /* DP 2.0 states that LTTPR regs must be read first */
-                       dp_retrieve_lttpr_cap(dc->links[i]);
-
-                       /* if any of the displays are lit up turn them off */
-                       status = core_link_read_dpcd(dc->links[i], DP_SET_POWER,
-                                                    &dpcd_power_state, sizeof(dpcd_power_state));
-                       if (status == DC_OK && dpcd_power_state == DP_POWER_STATE_D0) {
-                               /* blank dp stream before power off receiver*/
-                               if (dc->links[i]->link_enc->funcs->get_dig_frontend) {
-                                       unsigned int fe;
-
-                                       fe = dc->links[i]->link_enc->funcs->get_dig_frontend(
-                                                                               dc->links[i]->link_enc);
-                                       if (fe == ENGINE_ID_UNKNOWN)
-                                               continue;
-
-                                       for (j = 0; j < dc->res_pool->stream_enc_count; j++) {
-                                               if (fe == dc->res_pool->stream_enc[j]->id) {
-                                                       dc->res_pool->stream_enc[j]->funcs->dp_blank(dc->links[i],
-                                                                               dc->res_pool->stream_enc[j]);
-                                                       break;
-                                               }
-                                       }
-                               }
-                               dp_receiver_power_ctrl(dc->links[i], false);
-                       }
-               }
-       }
+       if (dc->config.power_down_display_on_boot)
+               blank_all_dp_displays(dc, true);
 
        /* If taking control over from VBIOS, we may want to optimize our first
         * mode set, so we need to skip powering down pipes until we know which

diff --git a/drivers/gpu/drm/amd/display/dc/dcn31/dcn31_hwseq.c b/drivers/gpu/drm/amd/display/dc/dcn31/dcn31_hwseq.c
index 0713910a3aa9f19b223b5a6abbab3335c27e78bc..80f06ceccea8b96c6eebb6b3435f6ac9ba9262a5 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/dcn31/dcn31_hwseq.c
+++ b/drivers/gpu/drm/amd/display/dc/dcn31/dcn31_hwseq.c
@@ -71,7 +71,7 @@ void dcn31_init_hw(struct dc *dc)
        struct dc_bios *dcb = dc->ctx->dc_bios;
        struct resource_pool *res_pool = dc->res_pool;
        uint32_t backlight = MAX_BACKLIGHT_LEVEL;
-       int i, j;
+       int i;
        int edp_num;
 
        if (dc->clk_mgr && dc->clk_mgr->funcs->init_clocks)
@@ -175,40 +175,9 @@ void dcn31_init_hw(struct dc *dc)
                        hws->funcs.dsc_pg_control(hws, res_pool->dscs[i]->inst, false);
 
        /* we want to turn off all dp displays before doing detection */
-       if (dc->config.power_down_display_on_boot) {
-               uint8_t dpcd_power_state = '\0';
-               enum dc_status status = DC_ERROR_UNEXPECTED;
-
-               for (i = 0; i < dc->link_count; i++) {
-                       if (dc->links[i]->connector_signal != SIGNAL_TYPE_DISPLAY_PORT)
-                               continue;
-
-                       /* if any of the displays are lit up turn them off */
-                       status = core_link_read_dpcd(dc->links[i], DP_SET_POWER,
-                                                    &dpcd_power_state, sizeof(dpcd_power_state));
-                       if (status == DC_OK && dpcd_power_state == DP_POWER_STATE_D0) {
-                               /* blank dp stream before power off receiver*/
-                               if (dc->links[i]->ep_type == DISPLAY_ENDPOINT_PHY &&
-                                               dc->links[i]->link_enc->funcs->get_dig_frontend) {
-                                       unsigned int fe;
-
-                                       fe = dc->links[i]->link_enc->funcs->get_dig_frontend(
-                                                                               dc->links[i]->link_enc);
-                                       if (fe == ENGINE_ID_UNKNOWN)
-                                               continue;
-
-                                       for (j = 0; j < dc->res_pool->stream_enc_count; j++) {
-                                               if (fe == dc->res_pool->stream_enc[j]->id) {
-                                                       dc->res_pool->stream_enc[j]->funcs->dp_blank(dc->links[i],
-                                                                               dc->res_pool->stream_enc[j]);
-                                                       break;
-                                               }
-                                       }
-                               }
-                               dp_receiver_power_ctrl(dc->links[i], false);
-                       }
-               }
-       }
+       if (dc->config.power_down_display_on_boot)
+               blank_all_dp_displays(dc, true);
+
 
        /* If taking control over from VBIOS, we may want to optimize our first
         * mode set, so we need to skip powering down pipes until we know which