drm/amd/display: add function to convert hw to dpcd lane settings

[why]
Unify the code which handles the conversion between hw lane setting
and dpcd lane setting.

v2: squash in unused variable fixes (Alex)

Reviewed-by: Jun Lei <Jun.Lei@amd.com>
Acked-by: Anson Jacob <Anson.Jacob@amd.com>
Signed-off-by: Wenjing Liu <wenjing.liu@amd.com>
Tested-by: Daniel Wheeler <daniel.wheeler@amd.com>
Signed-off-by: Alex Deucher <alexander.deucher@amd.com>

diff --git a/drivers/gpu/drm/amd/display/dc/core/dc_link_dp.c b/drivers/gpu/drm/amd/display/dc/core/dc_link_dp.c
index d24c00e..d5d75c1 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/core/dc_link_dp.c
+++ b/drivers/gpu/drm/amd/display/dc/core/dc_link_dp.c
@@ -520,7 +520,6 @@ static void dpcd_set_lt_pattern_and_lane_settings(
 
        uint8_t dpcd_lt_buffer[5] = {0};
        union dpcd_training_pattern dpcd_pattern = { {0} };
-       uint32_t lane;
        uint32_t size_in_bytes;
        bool edp_workaround = false; /* TODO link_prop.INTERNAL */
        dpcd_base_lt_offset = DP_TRAINING_PATTERN_SET;
@@ -553,45 +552,8 @@ static void dpcd_set_lt_pattern_and_lane_settings(
                        dpcd_base_lt_offset,
                        dpcd_pattern.v1_4.TRAINING_PATTERN_SET);
        }
-       /*****************************************************************
-       * DpcdAddress_Lane0Set -> DpcdAddress_Lane3Set
-       *****************************************************************/
-       for (lane = 0; lane <
-               (uint32_t)(lt_settings->link_settings.lane_count); lane++) {
-
-#if defined(CONFIG_DRM_AMD_DC_DCN)
-               if (dp_get_link_encoding_format(&lt_settings->link_settings) ==
-                               DP_128b_132b_ENCODING) {
-                       dpcd_lane[lane].tx_ffe.PRESET_VALUE =
-                                       lt_settings->lane_settings[lane].FFE_PRESET.settings.level;
-               } else if (dp_get_link_encoding_format(&lt_settings->link_settings) ==
-                               DP_8b_10b_ENCODING) {
-                       dpcd_lane[lane].bits.VOLTAGE_SWING_SET =
-                                       (uint8_t)(lt_settings->lane_settings[lane].VOLTAGE_SWING);
-                       dpcd_lane[lane].bits.PRE_EMPHASIS_SET =
-                                       (uint8_t)(lt_settings->lane_settings[lane].PRE_EMPHASIS);
 
-                       dpcd_lane[lane].bits.MAX_SWING_REACHED =
-                                       (lt_settings->lane_settings[lane].VOLTAGE_SWING ==
-                                                       VOLTAGE_SWING_MAX_LEVEL ? 1 : 0);
-                       dpcd_lane[lane].bits.MAX_PRE_EMPHASIS_REACHED =
-                                       (lt_settings->lane_settings[lane].PRE_EMPHASIS ==
-                                                       PRE_EMPHASIS_MAX_LEVEL ? 1 : 0);
-               }
-#else
-               dpcd_lane[lane].bits.VOLTAGE_SWING_SET =
-               (uint8_t)(lt_settings->lane_settings[lane].VOLTAGE_SWING);
-               dpcd_lane[lane].bits.PRE_EMPHASIS_SET =
-               (uint8_t)(lt_settings->lane_settings[lane].PRE_EMPHASIS);
-
-               dpcd_lane[lane].bits.MAX_SWING_REACHED =
-               (lt_settings->lane_settings[lane].VOLTAGE_SWING ==
-               VOLTAGE_SWING_MAX_LEVEL ? 1 : 0);
-               dpcd_lane[lane].bits.MAX_PRE_EMPHASIS_REACHED =
-               (lt_settings->lane_settings[lane].PRE_EMPHASIS ==
-               PRE_EMPHASIS_MAX_LEVEL ? 1 : 0);
-#endif
-       }
+       dp_hw_to_dpcd_lane_settings(lt_settings, lt_settings->lane_settings, dpcd_lane);
 
        /* concatenate everything into one buffer*/
 
@@ -717,6 +679,37 @@ bool dp_is_interlane_aligned(union lane_align_status_updated align_status)
        return align_status.bits.INTERLANE_ALIGN_DONE == 1;
 }
 
+void dp_hw_to_dpcd_lane_settings(
+               const struct link_training_settings *lt_settings,
+               const struct dc_lane_settings hw_lane_settings[LANE_COUNT_DP_MAX],
+               union dpcd_training_lane dpcd_lane_settings[LANE_COUNT_DP_MAX])
+{
+       uint8_t lane = 0;
+
+       for (lane = 0; lane < LANE_COUNT_DP_MAX; lane++) {
+               if (dp_get_link_encoding_format(&lt_settings->link_settings) ==
+                               DP_8b_10b_ENCODING) {
+                       dpcd_lane_settings[lane].bits.VOLTAGE_SWING_SET =
+                                       (uint8_t)(hw_lane_settings[lane].VOLTAGE_SWING);
+                       dpcd_lane_settings[lane].bits.PRE_EMPHASIS_SET =
+                                       (uint8_t)(hw_lane_settings[lane].PRE_EMPHASIS);
+                       dpcd_lane_settings[lane].bits.MAX_SWING_REACHED =
+                                       (hw_lane_settings[lane].VOLTAGE_SWING ==
+                                                       VOLTAGE_SWING_MAX_LEVEL ? 1 : 0);
+                       dpcd_lane_settings[lane].bits.MAX_PRE_EMPHASIS_REACHED =
+                                       (hw_lane_settings[lane].PRE_EMPHASIS ==
+                                                       PRE_EMPHASIS_MAX_LEVEL ? 1 : 0);
+               }
+#if defined(CONFIG_DRM_AMD_DC_DCN)
+               else if (dp_get_link_encoding_format(&lt_settings->link_settings) ==
+                               DP_128b_132b_ENCODING) {
+                       dpcd_lane_settings[lane].tx_ffe.PRESET_VALUE =
+                                       hw_lane_settings[lane].FFE_PRESET.settings.level;
+               }
+#endif
+       }
+}
+
 void dp_update_drive_settings(
                struct link_training_settings *dest,
                struct link_training_settings src)
@@ -1026,7 +1019,6 @@ enum dc_status dpcd_set_lane_settings(
        uint32_t offset)
 {
        union dpcd_training_lane dpcd_lane[LANE_COUNT_DP_MAX] = {{{0}}};
-       uint32_t lane;
        unsigned int lane0_set_address;
        enum dc_status status;
 
@@ -1036,46 +1028,9 @@ enum dc_status dpcd_set_lane_settings(
                lane0_set_address = DP_TRAINING_LANE0_SET_PHY_REPEATER1 +
                ((DP_REPEATER_CONFIGURATION_AND_STATUS_SIZE) * (offset - 1));
 
-       for (lane = 0; lane <
-               (uint32_t)(link_training_setting->
-               link_settings.lane_count);
-               lane++) {
-#if defined(CONFIG_DRM_AMD_DC_DCN)
-               if (dp_get_link_encoding_format(&link_training_setting->link_settings) ==
-                               DP_128b_132b_ENCODING) {
-                       dpcd_lane[lane].tx_ffe.PRESET_VALUE =
-                                       link_training_setting->lane_settings[lane].FFE_PRESET.settings.level;
-               } else if (dp_get_link_encoding_format(&link_training_setting->link_settings) ==
-                               DP_8b_10b_ENCODING) {
-                       dpcd_lane[lane].bits.VOLTAGE_SWING_SET =
-                                       (uint8_t)(link_training_setting->lane_settings[lane].VOLTAGE_SWING);
-                       dpcd_lane[lane].bits.PRE_EMPHASIS_SET =
-                                       (uint8_t)(link_training_setting->lane_settings[lane].PRE_EMPHASIS);
-
-                       dpcd_lane[lane].bits.MAX_SWING_REACHED =
-                                       (link_training_setting->lane_settings[lane].VOLTAGE_SWING ==
-                                                       VOLTAGE_SWING_MAX_LEVEL ? 1 : 0);
-                       dpcd_lane[lane].bits.MAX_PRE_EMPHASIS_REACHED =
-                                       (link_training_setting->lane_settings[lane].PRE_EMPHASIS ==
-                                                       PRE_EMPHASIS_MAX_LEVEL ? 1 : 0);
-               }
-#else
-               dpcd_lane[lane].bits.VOLTAGE_SWING_SET =
-                       (uint8_t)(link_training_setting->
-                       lane_settings[lane].VOLTAGE_SWING);
-               dpcd_lane[lane].bits.PRE_EMPHASIS_SET =
-                       (uint8_t)(link_training_setting->
-                       lane_settings[lane].PRE_EMPHASIS);
-               dpcd_lane[lane].bits.MAX_SWING_REACHED =
-                       (link_training_setting->
-                       lane_settings[lane].VOLTAGE_SWING ==
-                       VOLTAGE_SWING_MAX_LEVEL ? 1 : 0);
-               dpcd_lane[lane].bits.MAX_PRE_EMPHASIS_REACHED =
-                       (link_training_setting->
-                       lane_settings[lane].PRE_EMPHASIS ==
-                       PRE_EMPHASIS_MAX_LEVEL ? 1 : 0);
-#endif
-       }
+       dp_hw_to_dpcd_lane_settings(link_training_setting,
+                       link_training_setting->lane_settings,
+                       dpcd_lane);
 
        status = core_link_write_dpcd(link,
                lane0_set_address,

diff --git a/drivers/gpu/drm/amd/display/dc/inc/dc_link_dp.h b/drivers/gpu/drm/amd/display/dc/inc/dc_link_dp.h
index cb8e785..c703751 100644 (file)
--- a/drivers/gpu/drm/amd/display/dc/inc/dc_link_dp.h
+++ b/drivers/gpu/drm/amd/display/dc/inc/dc_link_dp.h
@@ -147,7 +147,10 @@ bool dp_is_interlane_aligned(union lane_align_status_updated align_status);
 
 bool dp_is_max_vs_reached(
        const struct link_training_settings *lt_settings);
-
+void dp_hw_to_dpcd_lane_settings(
+       const struct link_training_settings *lt_settings,
+       const struct dc_lane_settings hw_lane_settings[LANE_COUNT_DP_MAX],
+       union dpcd_training_lane dpcd_lane_settings[LANE_COUNT_DP_MAX]);
 void dp_update_drive_settings(
        struct link_training_settings *dest,
        struct link_training_settings src);