From: Ovidiu Bunea <ovidiu.bu...@amd.com>

[why]
The current PG & RCG programming in driver has some gaps and incorrect
sequences.

[how]
Added delays after ungating clocks to allow ramp up, increased polling
to allow more time for power up, and removed the incorrect sequences.

Cc: Mario Limonciello <mario.limoncie...@amd.com>
Cc: Alex Deucher <alexander.deuc...@amd.com>
Cc: sta...@vger.kernel.org
Reviewed-by: Charlene Liu <charlene....@amd.com>
Signed-off-by: Ovidiu Bunea <ovidiu.bu...@amd.com>
Signed-off-by: Wayne Lin <wayne....@amd.com>
---
 drivers/gpu/drm/amd/display/dc/dc.h           |   1 +
 .../amd/display/dc/dccg/dcn35/dcn35_dccg.c    |  74 +++++------
 .../amd/display/dc/hwss/dcn35/dcn35_hwseq.c   | 115 +++---------------
 .../amd/display/dc/hwss/dcn35/dcn35_init.c    |   3 -
 .../amd/display/dc/hwss/dcn351/dcn351_init.c  |   3 -
 .../gpu/drm/amd/display/dc/inc/hw/pg_cntl.h   |   1 +
 .../amd/display/dc/pg/dcn35/dcn35_pg_cntl.c   |  78 +++++++-----
 7 files changed, 111 insertions(+), 164 deletions(-)

diff --git a/drivers/gpu/drm/amd/display/dc/dc.h 
b/drivers/gpu/drm/amd/display/dc/dc.h
index b41e66c31e6a..09d705cf5c9b 100644
--- a/drivers/gpu/drm/amd/display/dc/dc.h
+++ b/drivers/gpu/drm/amd/display/dc/dc.h
@@ -1162,6 +1162,7 @@ struct dc_debug_options {
        unsigned int auxless_alpm_lfps_silence_ns;
        unsigned int auxless_alpm_lfps_t1t2_us;
        short auxless_alpm_lfps_t1t2_offset_us;
+       bool enable_pg_cntl_debug_logs;
 };
 
 
diff --git a/drivers/gpu/drm/amd/display/dc/dccg/dcn35/dcn35_dccg.c 
b/drivers/gpu/drm/amd/display/dc/dccg/dcn35/dcn35_dccg.c
index 58c84f555c0f..0ce9489ac6b7 100644
--- a/drivers/gpu/drm/amd/display/dc/dccg/dcn35/dcn35_dccg.c
+++ b/drivers/gpu/drm/amd/display/dc/dccg/dcn35/dcn35_dccg.c
@@ -133,30 +133,34 @@ enum dsc_clk_source {
 };
 
 
-static void dccg35_set_dsc_clk_rcg(struct dccg *dccg, int inst, bool enable)
+static void dccg35_set_dsc_clk_rcg(struct dccg *dccg, int inst, bool allow_rcg)
 {
        struct dcn_dccg *dccg_dcn = TO_DCN_DCCG(dccg);
 
-       if (!dccg->ctx->dc->debug.root_clock_optimization.bits.dsc && enable)
+       if (!dccg->ctx->dc->debug.root_clock_optimization.bits.dsc && allow_rcg)
                return;
 
        switch (inst) {
        case 0:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK0_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK0_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        case 1:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK1_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK1_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        case 2:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK2_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK2_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        case 3:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK3_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK3_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        default:
                BREAK_TO_DEBUGGER();
                return;
        }
+
+       /* Wait for clock to ramp */
+       if (!allow_rcg)
+               udelay(10);
 }
 
 static void dccg35_set_symclk32_se_rcg(
@@ -385,35 +389,34 @@ static void dccg35_set_dtbclk_p_rcg(struct dccg *dccg, 
int inst, bool enable)
        }
 }
 
-static void dccg35_set_dppclk_rcg(struct dccg *dccg,
-                                                                               
                int inst, bool enable)
+static void dccg35_set_dppclk_rcg(struct dccg *dccg, int inst, bool allow_rcg)
 {
-
        struct dcn_dccg *dccg_dcn = TO_DCN_DCCG(dccg);
 
-
-       if (!dccg->ctx->dc->debug.root_clock_optimization.bits.dpp && enable)
+       if (!dccg->ctx->dc->debug.root_clock_optimization.bits.dpp && allow_rcg)
                return;
 
        switch (inst) {
        case 0:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK0_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK0_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        case 1:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK1_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK1_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        case 2:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK2_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK2_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        case 3:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK3_ROOT_GATE_DISABLE, 
enable ? 0 : 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK3_ROOT_GATE_DISABLE, 
allow_rcg ? 0 : 1);
                break;
        default:
        BREAK_TO_DEBUGGER();
                break;
        }
-       //DC_LOG_DEBUG("%s: inst(%d) DPPCLK rcg_disable: %d\n", __func__, inst, 
enable ? 0 : 1);
 
+       /* Wait for clock to ramp */
+       if (!allow_rcg)
+               udelay(10);
 }
 
 static void dccg35_set_dpstreamclk_rcg(
@@ -1177,32 +1180,34 @@ static void dccg35_update_dpp_dto(struct dccg *dccg, 
int dpp_inst,
 }
 
 static void dccg35_set_dppclk_root_clock_gating(struct dccg *dccg,
-                uint32_t dpp_inst, uint32_t enable)
+                uint32_t dpp_inst, uint32_t disallow_rcg)
 {
        struct dcn_dccg *dccg_dcn = TO_DCN_DCCG(dccg);
 
-       if (!dccg->ctx->dc->debug.root_clock_optimization.bits.dpp)
+       if (!dccg->ctx->dc->debug.root_clock_optimization.bits.dpp && 
!disallow_rcg)
                return;
 
 
        switch (dpp_inst) {
        case 0:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK0_ROOT_GATE_DISABLE, 
enable);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK0_ROOT_GATE_DISABLE, 
disallow_rcg);
                break;
        case 1:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK1_ROOT_GATE_DISABLE, 
enable);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK1_ROOT_GATE_DISABLE, 
disallow_rcg);
                break;
        case 2:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK2_ROOT_GATE_DISABLE, 
enable);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK2_ROOT_GATE_DISABLE, 
disallow_rcg);
                break;
        case 3:
-               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK3_ROOT_GATE_DISABLE, 
enable);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DPPCLK3_ROOT_GATE_DISABLE, 
disallow_rcg);
                break;
        default:
                break;
        }
-       //DC_LOG_DEBUG("%s: dpp_inst(%d) rcg: %d\n", __func__, dpp_inst, 
enable);
 
+       /* Wait for clock to ramp */
+       if (disallow_rcg)
+               udelay(10);
 }
 
 static void dccg35_get_pixel_rate_div(
@@ -1782,8 +1787,7 @@ static void dccg35_enable_dscclk(struct dccg *dccg, int 
inst)
        //Disable DTO
        switch (inst) {
        case 0:
-               if (dccg->ctx->dc->debug.root_clock_optimization.bits.dsc)
-                       REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, 
DSCCLK0_ROOT_GATE_DISABLE, 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK0_ROOT_GATE_DISABLE, 
1);
 
                REG_UPDATE_2(DSCCLK0_DTO_PARAM,
                                DSCCLK0_DTO_PHASE, 0,
@@ -1791,8 +1795,7 @@ static void dccg35_enable_dscclk(struct dccg *dccg, int 
inst)
                REG_UPDATE(DSCCLK_DTO_CTRL,     DSCCLK0_EN, 1);
                break;
        case 1:
-               if (dccg->ctx->dc->debug.root_clock_optimization.bits.dsc)
-                       REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, 
DSCCLK1_ROOT_GATE_DISABLE, 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK1_ROOT_GATE_DISABLE, 
1);
 
                REG_UPDATE_2(DSCCLK1_DTO_PARAM,
                                DSCCLK1_DTO_PHASE, 0,
@@ -1800,8 +1803,7 @@ static void dccg35_enable_dscclk(struct dccg *dccg, int 
inst)
                REG_UPDATE(DSCCLK_DTO_CTRL, DSCCLK1_EN, 1);
                break;
        case 2:
-               if (dccg->ctx->dc->debug.root_clock_optimization.bits.dsc)
-                       REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, 
DSCCLK2_ROOT_GATE_DISABLE, 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK2_ROOT_GATE_DISABLE, 
1);
 
                REG_UPDATE_2(DSCCLK2_DTO_PARAM,
                                DSCCLK2_DTO_PHASE, 0,
@@ -1809,8 +1811,7 @@ static void dccg35_enable_dscclk(struct dccg *dccg, int 
inst)
                REG_UPDATE(DSCCLK_DTO_CTRL, DSCCLK2_EN, 1);
                break;
        case 3:
-               if (dccg->ctx->dc->debug.root_clock_optimization.bits.dsc)
-                       REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, 
DSCCLK3_ROOT_GATE_DISABLE, 1);
+               REG_UPDATE(DCCG_GATE_DISABLE_CNTL6, DSCCLK3_ROOT_GATE_DISABLE, 
1);
 
                REG_UPDATE_2(DSCCLK3_DTO_PARAM,
                                DSCCLK3_DTO_PHASE, 0,
@@ -1821,6 +1822,9 @@ static void dccg35_enable_dscclk(struct dccg *dccg, int 
inst)
                BREAK_TO_DEBUGGER();
                return;
        }
+
+       /* Wait for clock to ramp */
+       udelay(10);
 }
 
 static void dccg35_disable_dscclk(struct dccg *dccg,
@@ -1864,6 +1868,9 @@ static void dccg35_disable_dscclk(struct dccg *dccg,
        default:
                return;
        }
+
+       /* Wait for clock ramp */
+       udelay(10);
 }
 
 static void dccg35_enable_symclk_se(struct dccg *dccg, uint32_t 
stream_enc_inst, uint32_t link_enc_inst)
@@ -2349,10 +2356,7 @@ static void dccg35_disable_symclk_se_cb(
 
 void dccg35_root_gate_disable_control(struct dccg *dccg, uint32_t pipe_idx, 
uint32_t disable_clock_gating)
 {
-
-       if (dccg->ctx->dc->debug.root_clock_optimization.bits.dpp) {
-               dccg35_set_dppclk_root_clock_gating(dccg, pipe_idx, 
disable_clock_gating);
-       }
+       dccg35_set_dppclk_root_clock_gating(dccg, pipe_idx, 
disable_clock_gating);
 }
 
 static const struct dccg_funcs dccg35_funcs_new = {
diff --git a/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_hwseq.c 
b/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_hwseq.c
index a267f574b619..764eff6a4ec6 100644
--- a/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_hwseq.c
+++ b/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_hwseq.c
@@ -113,6 +113,14 @@ static void enable_memory_low_power(struct dc *dc)
 }
 #endif
 
+static void print_pg_status(struct dc *dc, const char *debug_func, const char 
*debug_log)
+{
+       if (dc->debug.enable_pg_cntl_debug_logs && dc->res_pool->pg_cntl) {
+               if (dc->res_pool->pg_cntl->funcs->print_pg_status)
+                       
dc->res_pool->pg_cntl->funcs->print_pg_status(dc->res_pool->pg_cntl, 
debug_func, debug_log);
+       }
+}
+
 void dcn35_set_dmu_fgcg(struct dce_hwseq *hws, bool enable)
 {
        REG_UPDATE_3(DMU_CLK_CNTL,
@@ -137,6 +145,8 @@ void dcn35_init_hw(struct dc *dc)
        uint32_t user_level = MAX_BACKLIGHT_LEVEL;
        int i;
 
+       print_pg_status(dc, __func__, ": start");
+
        if (dc->clk_mgr && dc->clk_mgr->funcs->init_clocks)
                dc->clk_mgr->funcs->init_clocks(dc->clk_mgr);
 
@@ -200,10 +210,7 @@ void dcn35_init_hw(struct dc *dc)
 
        /* we want to turn off all dp displays before doing detection */
        dc->link_srv->blank_all_dp_displays(dc);
-/*
-       if (hws->funcs.enable_power_gating_plane)
-               hws->funcs.enable_power_gating_plane(dc->hwseq, true);
-*/
+
        if (res_pool->hubbub && res_pool->hubbub->funcs->dchubbub_init)
                res_pool->hubbub->funcs->dchubbub_init(dc->res_pool->hubbub);
        /* If taking control over from VBIOS, we may want to optimize our first
@@ -236,6 +243,8 @@ void dcn35_init_hw(struct dc *dc)
                }
 
                hws->funcs.init_pipes(dc, dc->current_state);
+               print_pg_status(dc, __func__, ": after init_pipes");
+
                if (dc->res_pool->hubbub->funcs->allow_self_refresh_control &&
                        !dc->res_pool->hubbub->ctx->dc->debug.disable_stutter)
                        
dc->res_pool->hubbub->funcs->allow_self_refresh_control(dc->res_pool->hubbub,
@@ -312,6 +321,7 @@ void dcn35_init_hw(struct dc *dc)
                if (dc->res_pool->pg_cntl->funcs->init_pg_status)
                        
dc->res_pool->pg_cntl->funcs->init_pg_status(dc->res_pool->pg_cntl);
        }
+       print_pg_status(dc, __func__, ": after init_pg_status");
 }
 
 static void update_dsc_on_stream(struct pipe_ctx *pipe_ctx, bool enable)
@@ -500,97 +510,6 @@ void dcn35_physymclk_root_clock_control(struct dce_hwseq 
*hws, unsigned int phy_
        }
 }
 
-void dcn35_dsc_pg_control(
-               struct dce_hwseq *hws,
-               unsigned int dsc_inst,
-               bool power_on)
-{
-       uint32_t power_gate = power_on ? 0 : 1;
-       uint32_t pwr_status = power_on ? 0 : 2;
-       uint32_t org_ip_request_cntl = 0;
-
-       if (hws->ctx->dc->debug.disable_dsc_power_gate)
-               return;
-       if (hws->ctx->dc->debug.ignore_pg)
-               return;
-       REG_GET(DC_IP_REQUEST_CNTL, IP_REQUEST_EN, &org_ip_request_cntl);
-       if (org_ip_request_cntl == 0)
-               REG_SET(DC_IP_REQUEST_CNTL, 0, IP_REQUEST_EN, 1);
-
-       switch (dsc_inst) {
-       case 0: /* DSC0 */
-               REG_UPDATE(DOMAIN16_PG_CONFIG,
-                               DOMAIN_POWER_GATE, power_gate);
-
-               REG_WAIT(DOMAIN16_PG_STATUS,
-                               DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
-               break;
-       case 1: /* DSC1 */
-               REG_UPDATE(DOMAIN17_PG_CONFIG,
-                               DOMAIN_POWER_GATE, power_gate);
-
-               REG_WAIT(DOMAIN17_PG_STATUS,
-                               DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
-               break;
-       case 2: /* DSC2 */
-               REG_UPDATE(DOMAIN18_PG_CONFIG,
-                               DOMAIN_POWER_GATE, power_gate);
-
-               REG_WAIT(DOMAIN18_PG_STATUS,
-                               DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
-               break;
-       case 3: /* DSC3 */
-               REG_UPDATE(DOMAIN19_PG_CONFIG,
-                               DOMAIN_POWER_GATE, power_gate);
-
-               REG_WAIT(DOMAIN19_PG_STATUS,
-                               DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
-               break;
-       default:
-               BREAK_TO_DEBUGGER();
-               break;
-       }
-
-       if (org_ip_request_cntl == 0)
-               REG_SET(DC_IP_REQUEST_CNTL, 0, IP_REQUEST_EN, 0);
-}
-
-void dcn35_enable_power_gating_plane(struct dce_hwseq *hws, bool enable)
-{
-       bool force_on = true; /* disable power gating */
-       uint32_t org_ip_request_cntl = 0;
-
-       if (hws->ctx->dc->debug.disable_hubp_power_gate)
-               return;
-       if (hws->ctx->dc->debug.ignore_pg)
-               return;
-       REG_GET(DC_IP_REQUEST_CNTL, IP_REQUEST_EN, &org_ip_request_cntl);
-       if (org_ip_request_cntl == 0)
-               REG_SET(DC_IP_REQUEST_CNTL, 0, IP_REQUEST_EN, 1);
-       /* DCHUBP0/1/2/3/4/5 */
-       REG_UPDATE(DOMAIN0_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-       REG_UPDATE(DOMAIN2_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-       /* DPP0/1/2/3/4/5 */
-       REG_UPDATE(DOMAIN1_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-       REG_UPDATE(DOMAIN3_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-
-       force_on = true; /* disable power gating */
-       if (enable && !hws->ctx->dc->debug.disable_dsc_power_gate)
-               force_on = false;
-
-       /* DCS0/1/2/3/4 */
-       REG_UPDATE(DOMAIN16_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-       REG_UPDATE(DOMAIN17_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-       REG_UPDATE(DOMAIN18_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-       REG_UPDATE(DOMAIN19_PG_CONFIG, DOMAIN_POWER_FORCEON, force_on);
-
-
-}
-
 /* In headless boot cases, DIG may be turned
  * on which causes HW/SW discrepancies.
  * To avoid this, power down hardware on boot
@@ -1453,6 +1372,8 @@ void dcn35_prepare_bandwidth(
        }
 
        dcn20_prepare_bandwidth(dc, context);
+
+       print_pg_status(dc, __func__, ": after rcg and power up");
 }
 
 void dcn35_optimize_bandwidth(
@@ -1461,6 +1382,8 @@ void dcn35_optimize_bandwidth(
 {
        struct pg_block_update pg_update_state;
 
+       print_pg_status(dc, __func__, ": before rcg and power up");
+
        dcn20_optimize_bandwidth(dc, context);
 
        if (dc->hwss.calc_blocks_to_gate) {
@@ -1472,6 +1395,8 @@ void dcn35_optimize_bandwidth(
                if (dc->hwss.root_clock_control)
                        dc->hwss.root_clock_control(dc, &pg_update_state, 
false);
        }
+
+       print_pg_status(dc, __func__, ": after rcg and power up");
 }
 
 void dcn35_set_drr(struct pipe_ctx **pipe_ctx,
diff --git a/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_init.c 
b/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_init.c
index 52cc488416ac..f2f16a0bdb4f 100644
--- a/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_init.c
+++ b/drivers/gpu/drm/amd/display/dc/hwss/dcn35/dcn35_init.c
@@ -115,7 +115,6 @@ static const struct hw_sequencer_funcs dcn35_funcs = {
        .exit_optimized_pwr_state = dcn21_exit_optimized_pwr_state,
        .update_visual_confirm_color = dcn10_update_visual_confirm_color,
        .apply_idle_power_optimizations = dcn35_apply_idle_power_optimizations,
-       .update_dsc_pg = dcn32_update_dsc_pg,
        .calc_blocks_to_gate = dcn35_calc_blocks_to_gate,
        .calc_blocks_to_ungate = dcn35_calc_blocks_to_ungate,
        .hw_block_power_up = dcn35_hw_block_power_up,
@@ -151,7 +150,6 @@ static const struct hwseq_private_funcs dcn35_private_funcs 
= {
        .plane_atomic_disable = dcn35_plane_atomic_disable,
        //.plane_atomic_disable = dcn20_plane_atomic_disable,/*todo*/
        //.hubp_pg_control = dcn35_hubp_pg_control,
-       .enable_power_gating_plane = dcn35_enable_power_gating_plane,
        .dpp_root_clock_control = dcn35_dpp_root_clock_control,
        .dpstream_root_clock_control = dcn35_dpstream_root_clock_control,
        .physymclk_root_clock_control = dcn35_physymclk_root_clock_control,
@@ -166,7 +164,6 @@ static const struct hwseq_private_funcs dcn35_private_funcs 
= {
        .calculate_dccg_k1_k2_values = dcn32_calculate_dccg_k1_k2_values,
        .resync_fifo_dccg_dio = dcn314_resync_fifo_dccg_dio,
        .is_dp_dig_pixel_rate_div_policy = 
dcn35_is_dp_dig_pixel_rate_div_policy,
-       .dsc_pg_control = dcn35_dsc_pg_control,
        .dsc_pg_status = dcn32_dsc_pg_status,
        .enable_plane = dcn35_enable_plane,
        .wait_for_pipe_update_if_needed = dcn10_wait_for_pipe_update_if_needed,
diff --git a/drivers/gpu/drm/amd/display/dc/hwss/dcn351/dcn351_init.c 
b/drivers/gpu/drm/amd/display/dc/hwss/dcn351/dcn351_init.c
index e34efcb7bde5..09e60158f0b5 100644
--- a/drivers/gpu/drm/amd/display/dc/hwss/dcn351/dcn351_init.c
+++ b/drivers/gpu/drm/amd/display/dc/hwss/dcn351/dcn351_init.c
@@ -114,7 +114,6 @@ static const struct hw_sequencer_funcs dcn351_funcs = {
        .exit_optimized_pwr_state = dcn21_exit_optimized_pwr_state,
        .update_visual_confirm_color = dcn10_update_visual_confirm_color,
        .apply_idle_power_optimizations = dcn35_apply_idle_power_optimizations,
-       .update_dsc_pg = dcn32_update_dsc_pg,
        .calc_blocks_to_gate = dcn351_calc_blocks_to_gate,
        .calc_blocks_to_ungate = dcn351_calc_blocks_to_ungate,
        .hw_block_power_up = dcn351_hw_block_power_up,
@@ -146,7 +145,6 @@ static const struct hwseq_private_funcs 
dcn351_private_funcs = {
        .plane_atomic_disable = dcn35_plane_atomic_disable,
        //.plane_atomic_disable = dcn20_plane_atomic_disable,/*todo*/
        //.hubp_pg_control = dcn35_hubp_pg_control,
-       .enable_power_gating_plane = dcn35_enable_power_gating_plane,
        .dpp_root_clock_control = dcn35_dpp_root_clock_control,
        .dpstream_root_clock_control = dcn35_dpstream_root_clock_control,
        .physymclk_root_clock_control = dcn35_physymclk_root_clock_control,
@@ -160,7 +158,6 @@ static const struct hwseq_private_funcs 
dcn351_private_funcs = {
        .setup_hpo_hw_control = dcn35_setup_hpo_hw_control,
        .calculate_dccg_k1_k2_values = dcn32_calculate_dccg_k1_k2_values,
        .is_dp_dig_pixel_rate_div_policy = 
dcn35_is_dp_dig_pixel_rate_div_policy,
-       .dsc_pg_control = dcn35_dsc_pg_control,
        .dsc_pg_status = dcn32_dsc_pg_status,
        .enable_plane = dcn35_enable_plane,
        .wait_for_pipe_update_if_needed = dcn10_wait_for_pipe_update_if_needed,
diff --git a/drivers/gpu/drm/amd/display/dc/inc/hw/pg_cntl.h 
b/drivers/gpu/drm/amd/display/dc/inc/hw/pg_cntl.h
index 44f86cc2d1d6..227e3f8d7e5f 100644
--- a/drivers/gpu/drm/amd/display/dc/inc/hw/pg_cntl.h
+++ b/drivers/gpu/drm/amd/display/dc/inc/hw/pg_cntl.h
@@ -49,6 +49,7 @@ struct pg_cntl_funcs {
        void (*mem_pg_control)(struct pg_cntl *pg_cntl, bool power_on);
        void (*dio_pg_control)(struct pg_cntl *pg_cntl, bool power_on);
        void (*init_pg_status)(struct pg_cntl *pg_cntl);
+       void (*print_pg_status)(struct pg_cntl *pg_cntl, const char 
*debug_func, const char *debug_log);
 };
 
 #endif //__DC_PG_CNTL_H__
diff --git a/drivers/gpu/drm/amd/display/dc/pg/dcn35/dcn35_pg_cntl.c 
b/drivers/gpu/drm/amd/display/dc/pg/dcn35/dcn35_pg_cntl.c
index af21c0a27f86..72bd43f9bbe2 100644
--- a/drivers/gpu/drm/amd/display/dc/pg/dcn35/dcn35_pg_cntl.c
+++ b/drivers/gpu/drm/amd/display/dc/pg/dcn35/dcn35_pg_cntl.c
@@ -79,16 +79,12 @@ void pg_cntl35_dsc_pg_control(struct pg_cntl *pg_cntl, 
unsigned int dsc_inst, bo
        uint32_t power_gate = power_on ? 0 : 1;
        uint32_t pwr_status = power_on ? 0 : 2;
        uint32_t org_ip_request_cntl = 0;
-       bool block_enabled;
-
-       /*need to enable dscclk regardless DSC_PG*/
-       if (pg_cntl->ctx->dc->res_pool->dccg->funcs->enable_dsc && power_on)
-               pg_cntl->ctx->dc->res_pool->dccg->funcs->enable_dsc(
-                               pg_cntl->ctx->dc->res_pool->dccg, dsc_inst);
+       bool block_enabled = false;
+       bool skip_pg = pg_cntl->ctx->dc->debug.ignore_pg ||
+                      pg_cntl->ctx->dc->debug.disable_dsc_power_gate ||
+                      pg_cntl->ctx->dc->idle_optimizations_allowed;
 
-       if (pg_cntl->ctx->dc->debug.ignore_pg ||
-               pg_cntl->ctx->dc->debug.disable_dsc_power_gate ||
-               pg_cntl->ctx->dc->idle_optimizations_allowed)
+       if (skip_pg && !power_on)
                return;
 
        block_enabled = pg_cntl35_dsc_pg_status(pg_cntl, dsc_inst);
@@ -111,7 +107,7 @@ void pg_cntl35_dsc_pg_control(struct pg_cntl *pg_cntl, 
unsigned int dsc_inst, bo
 
                REG_WAIT(DOMAIN16_PG_STATUS,
                                DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
+                               1, 10000);
                break;
        case 1: /* DSC1 */
                REG_UPDATE(DOMAIN17_PG_CONFIG,
@@ -119,7 +115,7 @@ void pg_cntl35_dsc_pg_control(struct pg_cntl *pg_cntl, 
unsigned int dsc_inst, bo
 
                REG_WAIT(DOMAIN17_PG_STATUS,
                                DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
+                               1, 10000);
                break;
        case 2: /* DSC2 */
                REG_UPDATE(DOMAIN18_PG_CONFIG,
@@ -127,7 +123,7 @@ void pg_cntl35_dsc_pg_control(struct pg_cntl *pg_cntl, 
unsigned int dsc_inst, bo
 
                REG_WAIT(DOMAIN18_PG_STATUS,
                                DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
+                               1, 10000);
                break;
        case 3: /* DSC3 */
                REG_UPDATE(DOMAIN19_PG_CONFIG,
@@ -135,7 +131,7 @@ void pg_cntl35_dsc_pg_control(struct pg_cntl *pg_cntl, 
unsigned int dsc_inst, bo
 
                REG_WAIT(DOMAIN19_PG_STATUS,
                                DOMAIN_PGFSM_PWR_STATUS, pwr_status,
-                               1, 1000);
+                               1, 10000);
                break;
        default:
                BREAK_TO_DEBUGGER();
@@ -144,12 +140,6 @@ void pg_cntl35_dsc_pg_control(struct pg_cntl *pg_cntl, 
unsigned int dsc_inst, bo
 
        if (dsc_inst < MAX_PIPES)
                pg_cntl->pg_pipe_res_enable[PG_DSC][dsc_inst] = power_on;
-
-       if (pg_cntl->ctx->dc->res_pool->dccg->funcs->disable_dsc && !power_on) {
-               /*this is to disable dscclk*/
-               pg_cntl->ctx->dc->res_pool->dccg->funcs->disable_dsc(
-                       pg_cntl->ctx->dc->res_pool->dccg, dsc_inst);
-       }
 }
 
 static bool pg_cntl35_hubp_dpp_pg_status(struct pg_cntl *pg_cntl, unsigned int 
hubp_dpp_inst)
@@ -189,11 +179,12 @@ void pg_cntl35_hubp_dpp_pg_control(struct pg_cntl 
*pg_cntl, unsigned int hubp_dp
        uint32_t pwr_status = power_on ? 0 : 2;
        uint32_t org_ip_request_cntl;
        bool block_enabled;
+       bool skip_pg = pg_cntl->ctx->dc->debug.ignore_pg ||
+                      pg_cntl->ctx->dc->debug.disable_hubp_power_gate ||
+                      pg_cntl->ctx->dc->debug.disable_dpp_power_gate ||
+                      pg_cntl->ctx->dc->idle_optimizations_allowed;
 
-       if (pg_cntl->ctx->dc->debug.ignore_pg ||
-               pg_cntl->ctx->dc->debug.disable_hubp_power_gate ||
-               pg_cntl->ctx->dc->debug.disable_dpp_power_gate ||
-               pg_cntl->ctx->dc->idle_optimizations_allowed)
+       if (skip_pg && !power_on)
                return;
 
        block_enabled = pg_cntl35_hubp_dpp_pg_status(pg_cntl, hubp_dpp_inst);
@@ -213,22 +204,22 @@ void pg_cntl35_hubp_dpp_pg_control(struct pg_cntl 
*pg_cntl, unsigned int hubp_dp
        case 0:
                /* DPP0 & HUBP0 */
                REG_UPDATE(DOMAIN0_PG_CONFIG, DOMAIN_POWER_GATE, power_gate);
-               REG_WAIT(DOMAIN0_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 1000);
+               REG_WAIT(DOMAIN0_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 10000);
                break;
        case 1:
                /* DPP1 & HUBP1 */
                REG_UPDATE(DOMAIN1_PG_CONFIG, DOMAIN_POWER_GATE, power_gate);
-               REG_WAIT(DOMAIN1_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 1000);
+               REG_WAIT(DOMAIN1_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 10000);
                break;
        case 2:
                /* DPP2 & HUBP2 */
                REG_UPDATE(DOMAIN2_PG_CONFIG, DOMAIN_POWER_GATE, power_gate);
-               REG_WAIT(DOMAIN2_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 1000);
+               REG_WAIT(DOMAIN2_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 10000);
                break;
        case 3:
                /* DPP3 & HUBP3 */
                REG_UPDATE(DOMAIN3_PG_CONFIG, DOMAIN_POWER_GATE, power_gate);
-               REG_WAIT(DOMAIN3_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 1000);
+               REG_WAIT(DOMAIN3_PG_STATUS, DOMAIN_PGFSM_PWR_STATUS, 
pwr_status, 1, 10000);
                break;
        default:
                BREAK_TO_DEBUGGER();
@@ -501,6 +492,36 @@ void pg_cntl35_init_pg_status(struct pg_cntl *pg_cntl)
        pg_cntl->pg_res_enable[PG_DWB] = block_enabled;
 }
 
+static void pg_cntl35_print_pg_status(struct pg_cntl *pg_cntl, const char 
*debug_func, const char *debug_log)
+{
+       int i = 0;
+       bool block_enabled = false;
+
+       DC_LOG_DEBUG("%s: %s", debug_func, debug_log);
+
+       DC_LOG_DEBUG("PG_CNTL status:\n");
+
+       block_enabled = pg_cntl35_io_clk_status(pg_cntl);
+       DC_LOG_DEBUG("ONO0=%d (DCCG, DIO, DCIO)\n", block_enabled ? 1 : 0);
+
+       block_enabled = pg_cntl35_mem_status(pg_cntl);
+       DC_LOG_DEBUG("ONO1=%d (DCHUBBUB, DCHVM, DCHUBBUBMEM)\n", block_enabled 
? 1 : 0);
+
+       block_enabled = pg_cntl35_plane_otg_status(pg_cntl);
+       DC_LOG_DEBUG("ONO2=%d (MPC, OPP, OPTC, DWB)\n", block_enabled ? 1 : 0);
+
+       block_enabled = pg_cntl35_hpo_pg_status(pg_cntl);
+       DC_LOG_DEBUG("ONO3=%d (HPO)\n", block_enabled ? 1 : 0);
+
+       for (i = 0; i < pg_cntl->ctx->dc->res_pool->pipe_count; i++) {
+               block_enabled = pg_cntl35_hubp_dpp_pg_status(pg_cntl, i);
+               DC_LOG_DEBUG("ONO%d=%d (DCHUBP%d, DPP%d)\n", 4 + i * 2, 
block_enabled ? 1 : 0, i, i);
+
+               block_enabled = pg_cntl35_dsc_pg_status(pg_cntl, i);
+               DC_LOG_DEBUG("ONO%d=%d (DSC%d)\n", 5 + i * 2, block_enabled ? 1 
: 0, i);
+       }
+}
+
 static const struct pg_cntl_funcs pg_cntl35_funcs = {
        .init_pg_status = pg_cntl35_init_pg_status,
        .dsc_pg_control = pg_cntl35_dsc_pg_control,
@@ -511,7 +532,8 @@ static const struct pg_cntl_funcs pg_cntl35_funcs = {
        .mpcc_pg_control = pg_cntl35_mpcc_pg_control,
        .opp_pg_control = pg_cntl35_opp_pg_control,
        .optc_pg_control = pg_cntl35_optc_pg_control,
-       .dwb_pg_control = pg_cntl35_dwb_pg_control
+       .dwb_pg_control = pg_cntl35_dwb_pg_control,
+       .print_pg_status = pg_cntl35_print_pg_status
 };
 
 struct pg_cntl *pg_cntl35_create(
-- 
2.43.0

Reply via email to