LCOV - code coverage report
Current view: top level - drivers/gpu/drm/amd/display/dc/dcn32 - dcn32_hubbub.c (source / functions) Hit Total Coverage
Test: coverage.info Lines: 0 450 0.0 %
Date: 2022-12-09 01:23:36 Functions: 0 13 0.0 %

          Line data    Source code
       1             : /*
       2             :  * Copyright 2021 Advanced Micro Devices, Inc.
       3             :  *
       4             :  * Permission is hereby granted, free of charge, to any person obtaining a
       5             :  * copy of this software and associated documentation files (the "Software"),
       6             :  * to deal in the Software without restriction, including without limitation
       7             :  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
       8             :  * and/or sell copies of the Software, and to permit persons to whom the
       9             :  * Software is furnished to do so, subject to the following conditions:
      10             :  *
      11             :  * The above copyright notice and this permission notice shall be included in
      12             :  * all copies or substantial portions of the Software.
      13             :  *
      14             :  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
      15             :  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
      16             :  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
      17             :  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
      18             :  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
      19             :  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
      20             :  * OTHER DEALINGS IN THE SOFTWARE.
      21             :  *
      22             :  * Authors: AMD
      23             :  *
      24             :  */
      25             : 
      26             : 
      27             : #include "dcn30/dcn30_hubbub.h"
      28             : #include "dcn32_hubbub.h"
      29             : #include "dm_services.h"
      30             : #include "reg_helper.h"
      31             : 
      32             : 
      33             : #define CTX \
      34             :         hubbub2->base.ctx
      35             : #define DC_LOGGER \
      36             :         hubbub2->base.ctx->logger
      37             : #define REG(reg)\
      38             :         hubbub2->regs->reg
      39             : 
      40             : #undef FN
      41             : #define FN(reg_name, field_name) \
      42             :         hubbub2->shifts->field_name, hubbub2->masks->field_name
      43             : 
      44             : #define DCN32_CRB_SEGMENT_SIZE_KB 64
      45             : 
      46           0 : static void dcn32_init_crb(struct hubbub *hubbub)
      47             : {
      48           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
      49             : 
      50           0 :         REG_GET(DCHUBBUB_DET0_CTRL, DET0_SIZE_CURRENT,
      51             :                 &hubbub2->det0_size);
      52             : 
      53           0 :         REG_GET(DCHUBBUB_DET1_CTRL, DET1_SIZE_CURRENT,
      54             :                 &hubbub2->det1_size);
      55             : 
      56           0 :         REG_GET(DCHUBBUB_DET2_CTRL, DET2_SIZE_CURRENT,
      57             :                 &hubbub2->det2_size);
      58             : 
      59           0 :         REG_GET(DCHUBBUB_DET3_CTRL, DET3_SIZE_CURRENT,
      60             :                 &hubbub2->det3_size);
      61             : 
      62           0 :         REG_GET(DCHUBBUB_COMPBUF_CTRL, COMPBUF_SIZE_CURRENT,
      63             :                 &hubbub2->compbuf_size_segments);
      64             : 
      65           0 :         REG_SET_2(COMPBUF_RESERVED_SPACE, 0,
      66             :                         COMPBUF_RESERVED_SPACE_64B, hubbub2->pixel_chunk_size / 32,
      67             :                         COMPBUF_RESERVED_SPACE_ZS, hubbub2->pixel_chunk_size / 128);
      68           0 :         REG_UPDATE(DCHUBBUB_DEBUG_CTRL_0, DET_DEPTH, 0x47F);
      69           0 : }
      70             : 
      71           0 : static void dcn32_program_det_size(struct hubbub *hubbub, int hubp_inst, unsigned int det_buffer_size_in_kbyte)
      72             : {
      73           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
      74             : 
      75           0 :         unsigned int det_size_segments = (det_buffer_size_in_kbyte + DCN32_CRB_SEGMENT_SIZE_KB - 1) / DCN32_CRB_SEGMENT_SIZE_KB;
      76             : 
      77           0 :         switch (hubp_inst) {
      78             :         case 0:
      79           0 :                 REG_UPDATE(DCHUBBUB_DET0_CTRL,
      80             :                                         DET0_SIZE, det_size_segments);
      81           0 :                 hubbub2->det0_size = det_size_segments;
      82           0 :                 break;
      83             :         case 1:
      84           0 :                 REG_UPDATE(DCHUBBUB_DET1_CTRL,
      85             :                                         DET1_SIZE, det_size_segments);
      86           0 :                 hubbub2->det1_size = det_size_segments;
      87           0 :                 break;
      88             :         case 2:
      89           0 :                 REG_UPDATE(DCHUBBUB_DET2_CTRL,
      90             :                                         DET2_SIZE, det_size_segments);
      91           0 :                 hubbub2->det2_size = det_size_segments;
      92           0 :                 break;
      93             :         case 3:
      94           0 :                 REG_UPDATE(DCHUBBUB_DET3_CTRL,
      95             :                                         DET3_SIZE, det_size_segments);
      96           0 :                 hubbub2->det3_size = det_size_segments;
      97           0 :                 break;
      98             :         default:
      99             :                 break;
     100             :         }
     101             :         /* Should never be hit, if it is we have an erroneous hw config*/
     102           0 :         ASSERT(hubbub2->det0_size + hubbub2->det1_size + hubbub2->det2_size
     103             :                         + hubbub2->det3_size + hubbub2->compbuf_size_segments <= hubbub2->crb_size_segs);
     104           0 : }
     105             : 
     106           0 : static void dcn32_program_compbuf_size(struct hubbub *hubbub, unsigned int compbuf_size_kb, bool safe_to_increase)
     107             : {
     108           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     109           0 :         unsigned int compbuf_size_segments = (compbuf_size_kb + DCN32_CRB_SEGMENT_SIZE_KB - 1) / DCN32_CRB_SEGMENT_SIZE_KB;
     110             : 
     111           0 :         if (safe_to_increase || compbuf_size_segments <= hubbub2->compbuf_size_segments) {
     112           0 :                 if (compbuf_size_segments > hubbub2->compbuf_size_segments) {
     113           0 :                         REG_WAIT(DCHUBBUB_DET0_CTRL, DET0_SIZE_CURRENT, hubbub2->det0_size, 1, 100);
     114           0 :                         REG_WAIT(DCHUBBUB_DET1_CTRL, DET1_SIZE_CURRENT, hubbub2->det1_size, 1, 100);
     115           0 :                         REG_WAIT(DCHUBBUB_DET2_CTRL, DET2_SIZE_CURRENT, hubbub2->det2_size, 1, 100);
     116           0 :                         REG_WAIT(DCHUBBUB_DET3_CTRL, DET3_SIZE_CURRENT, hubbub2->det3_size, 1, 100);
     117             :                 }
     118             :                 /* Should never be hit, if it is we have an erroneous hw config*/
     119           0 :                 ASSERT(hubbub2->det0_size + hubbub2->det1_size + hubbub2->det2_size
     120             :                                 + hubbub2->det3_size + compbuf_size_segments <= hubbub2->crb_size_segs);
     121           0 :                 REG_UPDATE(DCHUBBUB_COMPBUF_CTRL, COMPBUF_SIZE, compbuf_size_segments);
     122           0 :                 hubbub2->compbuf_size_segments = compbuf_size_segments;
     123           0 :                 ASSERT(REG_GET(DCHUBBUB_COMPBUF_CTRL, CONFIG_ERROR, &compbuf_size_segments) && !compbuf_size_segments);
     124             :         }
     125           0 : }
     126             : 
     127             : static uint32_t convert_and_clamp(
     128             :         uint32_t wm_ns,
     129             :         uint32_t refclk_mhz,
     130             :         uint32_t clamp_value)
     131             : {
     132           0 :         uint32_t ret_val = 0;
     133           0 :         ret_val = wm_ns * refclk_mhz;
     134             : 
     135           0 :         ret_val /= 1000;
     136             : 
     137           0 :         if (ret_val > clamp_value)
     138           0 :                 ret_val = clamp_value;
     139             : 
     140             :         return ret_val;
     141             : }
     142             : 
     143           0 : static bool hubbub32_program_urgent_watermarks(
     144             :                 struct hubbub *hubbub,
     145             :                 struct dcn_watermark_set *watermarks,
     146             :                 unsigned int refclk_mhz,
     147             :                 bool safe_to_lower)
     148             : {
     149           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     150             :         uint32_t prog_wm_value;
     151           0 :         bool wm_pending = false;
     152             : 
     153             :         /* Repeat for water mark set A, B, C and D. */
     154             :         /* clock state A */
     155           0 :         if (safe_to_lower || watermarks->a.urgent_ns > hubbub2->watermarks.a.urgent_ns) {
     156           0 :                 hubbub2->watermarks.a.urgent_ns = watermarks->a.urgent_ns;
     157           0 :                 prog_wm_value = convert_and_clamp(watermarks->a.urgent_ns,
     158             :                                 refclk_mhz, 0x3fff);
     159           0 :                 REG_SET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_A, 0,
     160             :                                 DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_A, prog_wm_value);
     161             : 
     162           0 :                 DC_LOG_BANDWIDTH_CALCS("URGENCY_WATERMARK_A calculated =%d\n"
     163             :                         "HW register value = 0x%x\n",
     164             :                         watermarks->a.urgent_ns, prog_wm_value);
     165           0 :         } else if (watermarks->a.urgent_ns < hubbub2->watermarks.a.urgent_ns)
     166           0 :                 wm_pending = true;
     167             : 
     168             :         /* determine the transfer time for a quantity of data for a particular requestor.*/
     169           0 :         if (safe_to_lower || watermarks->a.frac_urg_bw_flip
     170           0 :                         > hubbub2->watermarks.a.frac_urg_bw_flip) {
     171           0 :                 hubbub2->watermarks.a.frac_urg_bw_flip = watermarks->a.frac_urg_bw_flip;
     172             : 
     173           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_A, 0,
     174             :                                 DCHUBBUB_ARB_FRAC_URG_BW_FLIP_A, watermarks->a.frac_urg_bw_flip);
     175           0 :         } else if (watermarks->a.frac_urg_bw_flip
     176             :                         < hubbub2->watermarks.a.frac_urg_bw_flip)
     177           0 :                 wm_pending = true;
     178             : 
     179           0 :         if (safe_to_lower || watermarks->a.frac_urg_bw_nom
     180           0 :                         > hubbub2->watermarks.a.frac_urg_bw_nom) {
     181           0 :                 hubbub2->watermarks.a.frac_urg_bw_nom = watermarks->a.frac_urg_bw_nom;
     182             : 
     183           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_NOM_A, 0,
     184             :                                 DCHUBBUB_ARB_FRAC_URG_BW_NOM_A, watermarks->a.frac_urg_bw_nom);
     185           0 :         } else if (watermarks->a.frac_urg_bw_nom
     186             :                         < hubbub2->watermarks.a.frac_urg_bw_nom)
     187           0 :                 wm_pending = true;
     188             : 
     189           0 :         if (safe_to_lower || watermarks->a.urgent_latency_ns > hubbub2->watermarks.a.urgent_latency_ns) {
     190           0 :                 hubbub2->watermarks.a.urgent_latency_ns = watermarks->a.urgent_latency_ns;
     191           0 :                 prog_wm_value = convert_and_clamp(watermarks->a.urgent_latency_ns,
     192             :                                 refclk_mhz, 0x3fff);
     193           0 :                 REG_SET(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_A, 0,
     194             :                                 DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_A, prog_wm_value);
     195           0 :         } else if (watermarks->a.urgent_latency_ns < hubbub2->watermarks.a.urgent_latency_ns)
     196           0 :                 wm_pending = true;
     197             : 
     198             :         /* clock state B */
     199           0 :         if (safe_to_lower || watermarks->b.urgent_ns > hubbub2->watermarks.b.urgent_ns) {
     200           0 :                 hubbub2->watermarks.b.urgent_ns = watermarks->b.urgent_ns;
     201           0 :                 prog_wm_value = convert_and_clamp(watermarks->b.urgent_ns,
     202             :                                 refclk_mhz, 0x3fff);
     203           0 :                 REG_SET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_B, 0,
     204             :                                 DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_B, prog_wm_value);
     205             : 
     206           0 :                 DC_LOG_BANDWIDTH_CALCS("URGENCY_WATERMARK_B calculated =%d\n"
     207             :                         "HW register value = 0x%x\n",
     208             :                         watermarks->b.urgent_ns, prog_wm_value);
     209           0 :         } else if (watermarks->b.urgent_ns < hubbub2->watermarks.b.urgent_ns)
     210           0 :                 wm_pending = true;
     211             : 
     212             :         /* determine the transfer time for a quantity of data for a particular requestor.*/
     213           0 :         if (safe_to_lower || watermarks->b.frac_urg_bw_flip
     214           0 :                         > hubbub2->watermarks.b.frac_urg_bw_flip) {
     215           0 :                 hubbub2->watermarks.b.frac_urg_bw_flip = watermarks->b.frac_urg_bw_flip;
     216             : 
     217           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_B, 0,
     218             :                                 DCHUBBUB_ARB_FRAC_URG_BW_FLIP_B, watermarks->b.frac_urg_bw_flip);
     219           0 :         } else if (watermarks->b.frac_urg_bw_flip
     220             :                         < hubbub2->watermarks.b.frac_urg_bw_flip)
     221           0 :                 wm_pending = true;
     222             : 
     223           0 :         if (safe_to_lower || watermarks->b.frac_urg_bw_nom
     224           0 :                         > hubbub2->watermarks.b.frac_urg_bw_nom) {
     225           0 :                 hubbub2->watermarks.b.frac_urg_bw_nom = watermarks->b.frac_urg_bw_nom;
     226             : 
     227           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_NOM_B, 0,
     228             :                                 DCHUBBUB_ARB_FRAC_URG_BW_NOM_B, watermarks->b.frac_urg_bw_nom);
     229           0 :         } else if (watermarks->b.frac_urg_bw_nom
     230             :                         < hubbub2->watermarks.b.frac_urg_bw_nom)
     231           0 :                 wm_pending = true;
     232             : 
     233           0 :         if (safe_to_lower || watermarks->b.urgent_latency_ns > hubbub2->watermarks.b.urgent_latency_ns) {
     234           0 :                 hubbub2->watermarks.b.urgent_latency_ns = watermarks->b.urgent_latency_ns;
     235           0 :                 prog_wm_value = convert_and_clamp(watermarks->b.urgent_latency_ns,
     236             :                                 refclk_mhz, 0x3fff);
     237           0 :                 REG_SET(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_B, 0,
     238             :                                 DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_B, prog_wm_value);
     239           0 :         } else if (watermarks->b.urgent_latency_ns < hubbub2->watermarks.b.urgent_latency_ns)
     240           0 :                 wm_pending = true;
     241             : 
     242             :         /* clock state C */
     243           0 :         if (safe_to_lower || watermarks->c.urgent_ns > hubbub2->watermarks.c.urgent_ns) {
     244           0 :                 hubbub2->watermarks.c.urgent_ns = watermarks->c.urgent_ns;
     245           0 :                 prog_wm_value = convert_and_clamp(watermarks->c.urgent_ns,
     246             :                                 refclk_mhz, 0x3fff);
     247           0 :                 REG_SET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_C, 0,
     248             :                                 DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_C, prog_wm_value);
     249             : 
     250           0 :                 DC_LOG_BANDWIDTH_CALCS("URGENCY_WATERMARK_C calculated =%d\n"
     251             :                         "HW register value = 0x%x\n",
     252             :                         watermarks->c.urgent_ns, prog_wm_value);
     253           0 :         } else if (watermarks->c.urgent_ns < hubbub2->watermarks.c.urgent_ns)
     254           0 :                 wm_pending = true;
     255             : 
     256             :         /* determine the transfer time for a quantity of data for a particular requestor.*/
     257           0 :         if (safe_to_lower || watermarks->c.frac_urg_bw_flip
     258           0 :                         > hubbub2->watermarks.c.frac_urg_bw_flip) {
     259           0 :                 hubbub2->watermarks.c.frac_urg_bw_flip = watermarks->c.frac_urg_bw_flip;
     260             : 
     261           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_C, 0,
     262             :                                 DCHUBBUB_ARB_FRAC_URG_BW_FLIP_C, watermarks->c.frac_urg_bw_flip);
     263           0 :         } else if (watermarks->c.frac_urg_bw_flip
     264             :                         < hubbub2->watermarks.c.frac_urg_bw_flip)
     265           0 :                 wm_pending = true;
     266             : 
     267           0 :         if (safe_to_lower || watermarks->c.frac_urg_bw_nom
     268           0 :                         > hubbub2->watermarks.c.frac_urg_bw_nom) {
     269           0 :                 hubbub2->watermarks.c.frac_urg_bw_nom = watermarks->c.frac_urg_bw_nom;
     270             : 
     271           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_NOM_C, 0,
     272             :                                 DCHUBBUB_ARB_FRAC_URG_BW_NOM_C, watermarks->c.frac_urg_bw_nom);
     273           0 :         } else if (watermarks->c.frac_urg_bw_nom
     274             :                         < hubbub2->watermarks.c.frac_urg_bw_nom)
     275           0 :                 wm_pending = true;
     276             : 
     277           0 :         if (safe_to_lower || watermarks->c.urgent_latency_ns > hubbub2->watermarks.c.urgent_latency_ns) {
     278           0 :                 hubbub2->watermarks.c.urgent_latency_ns = watermarks->c.urgent_latency_ns;
     279           0 :                 prog_wm_value = convert_and_clamp(watermarks->c.urgent_latency_ns,
     280             :                                 refclk_mhz, 0x3fff);
     281           0 :                 REG_SET(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_C, 0,
     282             :                                 DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_C, prog_wm_value);
     283           0 :         } else if (watermarks->c.urgent_latency_ns < hubbub2->watermarks.c.urgent_latency_ns)
     284           0 :                 wm_pending = true;
     285             : 
     286             :         /* clock state D */
     287           0 :         if (safe_to_lower || watermarks->d.urgent_ns > hubbub2->watermarks.d.urgent_ns) {
     288           0 :                 hubbub2->watermarks.d.urgent_ns = watermarks->d.urgent_ns;
     289           0 :                 prog_wm_value = convert_and_clamp(watermarks->d.urgent_ns,
     290             :                                 refclk_mhz, 0x3fff);
     291           0 :                 REG_SET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_D, 0,
     292             :                                 DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_D, prog_wm_value);
     293             : 
     294           0 :                 DC_LOG_BANDWIDTH_CALCS("URGENCY_WATERMARK_D calculated =%d\n"
     295             :                         "HW register value = 0x%x\n",
     296             :                         watermarks->d.urgent_ns, prog_wm_value);
     297           0 :         } else if (watermarks->d.urgent_ns < hubbub2->watermarks.d.urgent_ns)
     298           0 :                 wm_pending = true;
     299             : 
     300             :         /* determine the transfer time for a quantity of data for a particular requestor.*/
     301           0 :         if (safe_to_lower || watermarks->d.frac_urg_bw_flip
     302           0 :                         > hubbub2->watermarks.d.frac_urg_bw_flip) {
     303           0 :                 hubbub2->watermarks.d.frac_urg_bw_flip = watermarks->d.frac_urg_bw_flip;
     304             : 
     305           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_D, 0,
     306             :                                 DCHUBBUB_ARB_FRAC_URG_BW_FLIP_D, watermarks->d.frac_urg_bw_flip);
     307           0 :         } else if (watermarks->d.frac_urg_bw_flip
     308             :                         < hubbub2->watermarks.d.frac_urg_bw_flip)
     309           0 :                 wm_pending = true;
     310             : 
     311           0 :         if (safe_to_lower || watermarks->d.frac_urg_bw_nom
     312           0 :                         > hubbub2->watermarks.d.frac_urg_bw_nom) {
     313           0 :                 hubbub2->watermarks.d.frac_urg_bw_nom = watermarks->d.frac_urg_bw_nom;
     314             : 
     315           0 :                 REG_SET(DCHUBBUB_ARB_FRAC_URG_BW_NOM_D, 0,
     316             :                                 DCHUBBUB_ARB_FRAC_URG_BW_NOM_D, watermarks->d.frac_urg_bw_nom);
     317           0 :         } else if (watermarks->d.frac_urg_bw_nom
     318             :                         < hubbub2->watermarks.d.frac_urg_bw_nom)
     319           0 :                 wm_pending = true;
     320             : 
     321           0 :         if (safe_to_lower || watermarks->d.urgent_latency_ns > hubbub2->watermarks.d.urgent_latency_ns) {
     322           0 :                 hubbub2->watermarks.d.urgent_latency_ns = watermarks->d.urgent_latency_ns;
     323           0 :                 prog_wm_value = convert_and_clamp(watermarks->d.urgent_latency_ns,
     324             :                                 refclk_mhz, 0x3fff);
     325           0 :                 REG_SET(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_D, 0,
     326             :                                 DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_D, prog_wm_value);
     327           0 :         } else if (watermarks->d.urgent_latency_ns < hubbub2->watermarks.d.urgent_latency_ns)
     328           0 :                 wm_pending = true;
     329             : 
     330           0 :         return wm_pending;
     331             : }
     332             : 
     333           0 : static bool hubbub32_program_stutter_watermarks(
     334             :                 struct hubbub *hubbub,
     335             :                 struct dcn_watermark_set *watermarks,
     336             :                 unsigned int refclk_mhz,
     337             :                 bool safe_to_lower)
     338             : {
     339           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     340             :         uint32_t prog_wm_value;
     341           0 :         bool wm_pending = false;
     342             : 
     343             :         /* clock state A */
     344           0 :         if (safe_to_lower || watermarks->a.cstate_pstate.cstate_enter_plus_exit_ns
     345           0 :                         > hubbub2->watermarks.a.cstate_pstate.cstate_enter_plus_exit_ns) {
     346           0 :                 hubbub2->watermarks.a.cstate_pstate.cstate_enter_plus_exit_ns =
     347           0 :                                 watermarks->a.cstate_pstate.cstate_enter_plus_exit_ns;
     348           0 :                 prog_wm_value = convert_and_clamp(
     349             :                                 watermarks->a.cstate_pstate.cstate_enter_plus_exit_ns,
     350             :                                 refclk_mhz, 0xffff);
     351           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_A, 0,
     352             :                                 DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_A, prog_wm_value);
     353           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_ENTER_EXIT_WATERMARK_A calculated =%d\n"
     354             :                         "HW register value = 0x%x\n",
     355             :                         watermarks->a.cstate_pstate.cstate_enter_plus_exit_ns, prog_wm_value);
     356           0 :         } else if (watermarks->a.cstate_pstate.cstate_enter_plus_exit_ns
     357             :                         < hubbub2->watermarks.a.cstate_pstate.cstate_enter_plus_exit_ns)
     358           0 :                 wm_pending = true;
     359             : 
     360           0 :         if (safe_to_lower || watermarks->a.cstate_pstate.cstate_exit_ns
     361           0 :                         > hubbub2->watermarks.a.cstate_pstate.cstate_exit_ns) {
     362           0 :                 hubbub2->watermarks.a.cstate_pstate.cstate_exit_ns =
     363           0 :                                 watermarks->a.cstate_pstate.cstate_exit_ns;
     364           0 :                 prog_wm_value = convert_and_clamp(
     365             :                                 watermarks->a.cstate_pstate.cstate_exit_ns,
     366             :                                 refclk_mhz, 0xffff);
     367           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_A, 0,
     368             :                                 DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_A, prog_wm_value);
     369           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_EXIT_WATERMARK_A calculated =%d\n"
     370             :                         "HW register value = 0x%x\n",
     371             :                         watermarks->a.cstate_pstate.cstate_exit_ns, prog_wm_value);
     372           0 :         } else if (watermarks->a.cstate_pstate.cstate_exit_ns
     373             :                         < hubbub2->watermarks.a.cstate_pstate.cstate_exit_ns)
     374           0 :                 wm_pending = true;
     375             : 
     376             :         /* clock state B */
     377           0 :         if (safe_to_lower || watermarks->b.cstate_pstate.cstate_enter_plus_exit_ns
     378           0 :                         > hubbub2->watermarks.b.cstate_pstate.cstate_enter_plus_exit_ns) {
     379           0 :                 hubbub2->watermarks.b.cstate_pstate.cstate_enter_plus_exit_ns =
     380           0 :                                 watermarks->b.cstate_pstate.cstate_enter_plus_exit_ns;
     381           0 :                 prog_wm_value = convert_and_clamp(
     382             :                                 watermarks->b.cstate_pstate.cstate_enter_plus_exit_ns,
     383             :                                 refclk_mhz, 0xffff);
     384           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_B, 0,
     385             :                                 DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_B, prog_wm_value);
     386           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_ENTER_EXIT_WATERMARK_B calculated =%d\n"
     387             :                         "HW register value = 0x%x\n",
     388             :                         watermarks->b.cstate_pstate.cstate_enter_plus_exit_ns, prog_wm_value);
     389           0 :         } else if (watermarks->b.cstate_pstate.cstate_enter_plus_exit_ns
     390             :                         < hubbub2->watermarks.b.cstate_pstate.cstate_enter_plus_exit_ns)
     391           0 :                 wm_pending = true;
     392             : 
     393           0 :         if (safe_to_lower || watermarks->b.cstate_pstate.cstate_exit_ns
     394           0 :                         > hubbub2->watermarks.b.cstate_pstate.cstate_exit_ns) {
     395           0 :                 hubbub2->watermarks.b.cstate_pstate.cstate_exit_ns =
     396           0 :                                 watermarks->b.cstate_pstate.cstate_exit_ns;
     397           0 :                 prog_wm_value = convert_and_clamp(
     398             :                                 watermarks->b.cstate_pstate.cstate_exit_ns,
     399             :                                 refclk_mhz, 0xffff);
     400           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_B, 0,
     401             :                                 DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_B, prog_wm_value);
     402           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_EXIT_WATERMARK_B calculated =%d\n"
     403             :                         "HW register value = 0x%x\n",
     404             :                         watermarks->b.cstate_pstate.cstate_exit_ns, prog_wm_value);
     405           0 :         } else if (watermarks->b.cstate_pstate.cstate_exit_ns
     406             :                         < hubbub2->watermarks.b.cstate_pstate.cstate_exit_ns)
     407           0 :                 wm_pending = true;
     408             : 
     409             :         /* clock state C */
     410           0 :         if (safe_to_lower || watermarks->c.cstate_pstate.cstate_enter_plus_exit_ns
     411           0 :                         > hubbub2->watermarks.c.cstate_pstate.cstate_enter_plus_exit_ns) {
     412           0 :                 hubbub2->watermarks.c.cstate_pstate.cstate_enter_plus_exit_ns =
     413           0 :                                 watermarks->c.cstate_pstate.cstate_enter_plus_exit_ns;
     414           0 :                 prog_wm_value = convert_and_clamp(
     415             :                                 watermarks->c.cstate_pstate.cstate_enter_plus_exit_ns,
     416             :                                 refclk_mhz, 0xffff);
     417           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_C, 0,
     418             :                                 DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_C, prog_wm_value);
     419           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_ENTER_EXIT_WATERMARK_C calculated =%d\n"
     420             :                         "HW register value = 0x%x\n",
     421             :                         watermarks->c.cstate_pstate.cstate_enter_plus_exit_ns, prog_wm_value);
     422           0 :         } else if (watermarks->c.cstate_pstate.cstate_enter_plus_exit_ns
     423             :                         < hubbub2->watermarks.c.cstate_pstate.cstate_enter_plus_exit_ns)
     424           0 :                 wm_pending = true;
     425             : 
     426           0 :         if (safe_to_lower || watermarks->c.cstate_pstate.cstate_exit_ns
     427           0 :                         > hubbub2->watermarks.c.cstate_pstate.cstate_exit_ns) {
     428           0 :                 hubbub2->watermarks.c.cstate_pstate.cstate_exit_ns =
     429           0 :                                 watermarks->c.cstate_pstate.cstate_exit_ns;
     430           0 :                 prog_wm_value = convert_and_clamp(
     431             :                                 watermarks->c.cstate_pstate.cstate_exit_ns,
     432             :                                 refclk_mhz, 0xffff);
     433           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_C, 0,
     434             :                                 DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_C, prog_wm_value);
     435           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_EXIT_WATERMARK_C calculated =%d\n"
     436             :                         "HW register value = 0x%x\n",
     437             :                         watermarks->c.cstate_pstate.cstate_exit_ns, prog_wm_value);
     438           0 :         } else if (watermarks->c.cstate_pstate.cstate_exit_ns
     439             :                         < hubbub2->watermarks.c.cstate_pstate.cstate_exit_ns)
     440           0 :                 wm_pending = true;
     441             : 
     442             :         /* clock state D */
     443           0 :         if (safe_to_lower || watermarks->d.cstate_pstate.cstate_enter_plus_exit_ns
     444           0 :                         > hubbub2->watermarks.d.cstate_pstate.cstate_enter_plus_exit_ns) {
     445           0 :                 hubbub2->watermarks.d.cstate_pstate.cstate_enter_plus_exit_ns =
     446           0 :                                 watermarks->d.cstate_pstate.cstate_enter_plus_exit_ns;
     447           0 :                 prog_wm_value = convert_and_clamp(
     448             :                                 watermarks->d.cstate_pstate.cstate_enter_plus_exit_ns,
     449             :                                 refclk_mhz, 0xffff);
     450           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_D, 0,
     451             :                                 DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_D, prog_wm_value);
     452           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_ENTER_EXIT_WATERMARK_D calculated =%d\n"
     453             :                         "HW register value = 0x%x\n",
     454             :                         watermarks->d.cstate_pstate.cstate_enter_plus_exit_ns, prog_wm_value);
     455           0 :         } else if (watermarks->d.cstate_pstate.cstate_enter_plus_exit_ns
     456             :                         < hubbub2->watermarks.d.cstate_pstate.cstate_enter_plus_exit_ns)
     457           0 :                 wm_pending = true;
     458             : 
     459           0 :         if (safe_to_lower || watermarks->d.cstate_pstate.cstate_exit_ns
     460           0 :                         > hubbub2->watermarks.d.cstate_pstate.cstate_exit_ns) {
     461           0 :                 hubbub2->watermarks.d.cstate_pstate.cstate_exit_ns =
     462           0 :                                 watermarks->d.cstate_pstate.cstate_exit_ns;
     463           0 :                 prog_wm_value = convert_and_clamp(
     464             :                                 watermarks->d.cstate_pstate.cstate_exit_ns,
     465             :                                 refclk_mhz, 0xffff);
     466           0 :                 REG_SET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_D, 0,
     467             :                                 DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_D, prog_wm_value);
     468           0 :                 DC_LOG_BANDWIDTH_CALCS("SR_EXIT_WATERMARK_D calculated =%d\n"
     469             :                         "HW register value = 0x%x\n",
     470             :                         watermarks->d.cstate_pstate.cstate_exit_ns, prog_wm_value);
     471           0 :         } else if (watermarks->d.cstate_pstate.cstate_exit_ns
     472             :                         < hubbub2->watermarks.d.cstate_pstate.cstate_exit_ns)
     473           0 :                 wm_pending = true;
     474             : 
     475           0 :         return wm_pending;
     476             : }
     477             : 
     478             : 
     479           0 : static bool hubbub32_program_pstate_watermarks(
     480             :                 struct hubbub *hubbub,
     481             :                 struct dcn_watermark_set *watermarks,
     482             :                 unsigned int refclk_mhz,
     483             :                 bool safe_to_lower)
     484             : {
     485           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     486             :         uint32_t prog_wm_value;
     487             : 
     488           0 :         bool wm_pending = false;
     489             : 
     490             :         /* Section for UCLK_PSTATE_CHANGE_WATERMARKS */
     491             :         /* clock state A */
     492           0 :         if (safe_to_lower || watermarks->a.cstate_pstate.pstate_change_ns
     493           0 :                         > hubbub2->watermarks.a.cstate_pstate.pstate_change_ns) {
     494           0 :                 hubbub2->watermarks.a.cstate_pstate.pstate_change_ns =
     495           0 :                                 watermarks->a.cstate_pstate.pstate_change_ns;
     496           0 :                 prog_wm_value = convert_and_clamp(
     497             :                                 watermarks->a.cstate_pstate.pstate_change_ns,
     498             :                                 refclk_mhz, 0xffff);
     499           0 :                 REG_SET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_A, 0,
     500             :                                 DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_A, prog_wm_value);
     501           0 :                 DC_LOG_BANDWIDTH_CALCS("DRAM_CLK_CHANGE_WATERMARK_A calculated =%d\n"
     502             :                         "HW register value = 0x%x\n\n",
     503             :                         watermarks->a.cstate_pstate.pstate_change_ns, prog_wm_value);
     504           0 :         } else if (watermarks->a.cstate_pstate.pstate_change_ns
     505             :                         < hubbub2->watermarks.a.cstate_pstate.pstate_change_ns)
     506           0 :                 wm_pending = true;
     507             : 
     508             :         /* clock state B */
     509           0 :         if (safe_to_lower || watermarks->b.cstate_pstate.pstate_change_ns
     510           0 :                         > hubbub2->watermarks.b.cstate_pstate.pstate_change_ns) {
     511           0 :                 hubbub2->watermarks.b.cstate_pstate.pstate_change_ns =
     512           0 :                                 watermarks->b.cstate_pstate.pstate_change_ns;
     513           0 :                 prog_wm_value = convert_and_clamp(
     514             :                                 watermarks->b.cstate_pstate.pstate_change_ns,
     515             :                                 refclk_mhz, 0xffff);
     516           0 :                 REG_SET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_B, 0,
     517             :                                 DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_B, prog_wm_value);
     518           0 :                 DC_LOG_BANDWIDTH_CALCS("DRAM_CLK_CHANGE_WATERMARK_B calculated =%d\n"
     519             :                         "HW register value = 0x%x\n\n",
     520             :                         watermarks->b.cstate_pstate.pstate_change_ns, prog_wm_value);
     521           0 :         } else if (watermarks->b.cstate_pstate.pstate_change_ns
     522             :                         < hubbub2->watermarks.b.cstate_pstate.pstate_change_ns)
     523           0 :                 wm_pending = true;
     524             : 
     525             :         /* clock state C */
     526           0 :         if (safe_to_lower || watermarks->c.cstate_pstate.pstate_change_ns
     527           0 :                         > hubbub2->watermarks.c.cstate_pstate.pstate_change_ns) {
     528           0 :                 hubbub2->watermarks.c.cstate_pstate.pstate_change_ns =
     529           0 :                                 watermarks->c.cstate_pstate.pstate_change_ns;
     530           0 :                 prog_wm_value = convert_and_clamp(
     531             :                                 watermarks->c.cstate_pstate.pstate_change_ns,
     532             :                                 refclk_mhz, 0xffff);
     533           0 :                 REG_SET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_C, 0,
     534             :                                 DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_C, prog_wm_value);
     535           0 :                 DC_LOG_BANDWIDTH_CALCS("DRAM_CLK_CHANGE_WATERMARK_C calculated =%d\n"
     536             :                         "HW register value = 0x%x\n\n",
     537             :                         watermarks->c.cstate_pstate.pstate_change_ns, prog_wm_value);
     538           0 :         } else if (watermarks->c.cstate_pstate.pstate_change_ns
     539             :                         < hubbub2->watermarks.c.cstate_pstate.pstate_change_ns)
     540           0 :                 wm_pending = true;
     541             : 
     542             :         /* clock state D */
     543           0 :         if (safe_to_lower || watermarks->d.cstate_pstate.pstate_change_ns
     544           0 :                         > hubbub2->watermarks.d.cstate_pstate.pstate_change_ns) {
     545           0 :                 hubbub2->watermarks.d.cstate_pstate.pstate_change_ns =
     546           0 :                                 watermarks->d.cstate_pstate.pstate_change_ns;
     547           0 :                 prog_wm_value = convert_and_clamp(
     548             :                                 watermarks->d.cstate_pstate.pstate_change_ns,
     549             :                                 refclk_mhz, 0xffff);
     550           0 :                 REG_SET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_D, 0,
     551             :                                 DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_D, prog_wm_value);
     552           0 :                 DC_LOG_BANDWIDTH_CALCS("DRAM_CLK_CHANGE_WATERMARK_D calculated =%d\n"
     553             :                         "HW register value = 0x%x\n\n",
     554             :                         watermarks->d.cstate_pstate.pstate_change_ns, prog_wm_value);
     555           0 :         } else if (watermarks->d.cstate_pstate.pstate_change_ns
     556             :                         < hubbub2->watermarks.d.cstate_pstate.pstate_change_ns)
     557           0 :                 wm_pending = true;
     558             : 
     559             :         /* Section for FCLK_PSTATE_CHANGE_WATERMARKS */
     560             :         /* clock state A */
     561           0 :         if (safe_to_lower || watermarks->a.cstate_pstate.fclk_pstate_change_ns
     562           0 :                         > hubbub2->watermarks.a.cstate_pstate.fclk_pstate_change_ns) {
     563           0 :                 hubbub2->watermarks.a.cstate_pstate.fclk_pstate_change_ns =
     564           0 :                                 watermarks->a.cstate_pstate.fclk_pstate_change_ns;
     565           0 :                 prog_wm_value = convert_and_clamp(
     566             :                                 watermarks->a.cstate_pstate.fclk_pstate_change_ns,
     567             :                                 refclk_mhz, 0xffff);
     568           0 :                 REG_SET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_A, 0,
     569             :                                 DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_A, prog_wm_value);
     570           0 :                 DC_LOG_BANDWIDTH_CALCS("FCLK_CHANGE_WATERMARK_A calculated =%d\n"
     571             :                         "HW register value = 0x%x\n\n",
     572             :                         watermarks->a.cstate_pstate.fclk_pstate_change_ns, prog_wm_value);
     573           0 :         } else if (watermarks->a.cstate_pstate.fclk_pstate_change_ns
     574             :                         < hubbub2->watermarks.a.cstate_pstate.fclk_pstate_change_ns)
     575           0 :                 wm_pending = true;
     576             : 
     577             :         /* clock state B */
     578           0 :         if (safe_to_lower || watermarks->b.cstate_pstate.fclk_pstate_change_ns
     579           0 :                         > hubbub2->watermarks.b.cstate_pstate.fclk_pstate_change_ns) {
     580           0 :                 hubbub2->watermarks.b.cstate_pstate.fclk_pstate_change_ns =
     581           0 :                                 watermarks->b.cstate_pstate.fclk_pstate_change_ns;
     582           0 :                 prog_wm_value = convert_and_clamp(
     583             :                                 watermarks->b.cstate_pstate.fclk_pstate_change_ns,
     584             :                                 refclk_mhz, 0xffff);
     585           0 :                 REG_SET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_B, 0,
     586             :                                 DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_B, prog_wm_value);
     587           0 :                 DC_LOG_BANDWIDTH_CALCS("FCLK_CHANGE_WATERMARK_B calculated =%d\n"
     588             :                         "HW register value = 0x%x\n\n",
     589             :                         watermarks->b.cstate_pstate.fclk_pstate_change_ns, prog_wm_value);
     590           0 :         } else if (watermarks->b.cstate_pstate.fclk_pstate_change_ns
     591             :                         < hubbub2->watermarks.b.cstate_pstate.fclk_pstate_change_ns)
     592           0 :                 wm_pending = true;
     593             : 
     594             :         /* clock state C */
     595           0 :         if (safe_to_lower || watermarks->c.cstate_pstate.fclk_pstate_change_ns
     596           0 :                         > hubbub2->watermarks.c.cstate_pstate.fclk_pstate_change_ns) {
     597           0 :                 hubbub2->watermarks.c.cstate_pstate.fclk_pstate_change_ns =
     598           0 :                                 watermarks->c.cstate_pstate.fclk_pstate_change_ns;
     599           0 :                 prog_wm_value = convert_and_clamp(
     600             :                                 watermarks->c.cstate_pstate.fclk_pstate_change_ns,
     601             :                                 refclk_mhz, 0xffff);
     602           0 :                 REG_SET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_C, 0,
     603             :                                 DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_C, prog_wm_value);
     604           0 :                 DC_LOG_BANDWIDTH_CALCS("FCLK_CHANGE_WATERMARK_C calculated =%d\n"
     605             :                         "HW register value = 0x%x\n\n",
     606             :                         watermarks->c.cstate_pstate.fclk_pstate_change_ns, prog_wm_value);
     607           0 :         } else if (watermarks->c.cstate_pstate.fclk_pstate_change_ns
     608             :                         < hubbub2->watermarks.c.cstate_pstate.fclk_pstate_change_ns)
     609           0 :                 wm_pending = true;
     610             : 
     611             :         /* clock state D */
     612           0 :         if (safe_to_lower || watermarks->d.cstate_pstate.fclk_pstate_change_ns
     613           0 :                         > hubbub2->watermarks.d.cstate_pstate.fclk_pstate_change_ns) {
     614           0 :                 hubbub2->watermarks.d.cstate_pstate.fclk_pstate_change_ns =
     615           0 :                                 watermarks->d.cstate_pstate.fclk_pstate_change_ns;
     616           0 :                 prog_wm_value = convert_and_clamp(
     617             :                                 watermarks->d.cstate_pstate.fclk_pstate_change_ns,
     618             :                                 refclk_mhz, 0xffff);
     619           0 :                 REG_SET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_D, 0,
     620             :                                 DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_D, prog_wm_value);
     621           0 :                 DC_LOG_BANDWIDTH_CALCS("FCLK_CHANGE_WATERMARK_D calculated =%d\n"
     622             :                         "HW register value = 0x%x\n\n",
     623             :                         watermarks->d.cstate_pstate.fclk_pstate_change_ns, prog_wm_value);
     624           0 :         } else if (watermarks->d.cstate_pstate.fclk_pstate_change_ns
     625             :                         < hubbub2->watermarks.d.cstate_pstate.fclk_pstate_change_ns)
     626           0 :                 wm_pending = true;
     627             : 
     628           0 :         return wm_pending;
     629             : }
     630             : 
     631             : 
     632           0 : static bool hubbub32_program_usr_watermarks(
     633             :                 struct hubbub *hubbub,
     634             :                 struct dcn_watermark_set *watermarks,
     635             :                 unsigned int refclk_mhz,
     636             :                 bool safe_to_lower)
     637             : {
     638           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     639             :         uint32_t prog_wm_value;
     640             : 
     641           0 :         bool wm_pending = false;
     642             : 
     643             :         /* clock state A */
     644           0 :         if (safe_to_lower || watermarks->a.usr_retraining_ns
     645           0 :                         > hubbub2->watermarks.a.usr_retraining_ns) {
     646           0 :                 hubbub2->watermarks.a.usr_retraining_ns = watermarks->a.usr_retraining_ns;
     647           0 :                 prog_wm_value = convert_and_clamp(
     648             :                                 watermarks->a.usr_retraining_ns,
     649             :                                 refclk_mhz, 0x3fff);
     650           0 :                 REG_SET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_A, 0,
     651             :                                 DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_A, prog_wm_value);
     652           0 :                 DC_LOG_BANDWIDTH_CALCS("USR_RETRAINING_WATERMARK_A calculated =%d\n"
     653             :                         "HW register value = 0x%x\n\n",
     654             :                         watermarks->a.usr_retraining_ns, prog_wm_value);
     655           0 :         } else if (watermarks->a.usr_retraining_ns
     656             :                         < hubbub2->watermarks.a.usr_retraining_ns)
     657           0 :                 wm_pending = true;
     658             : 
     659             :         /* clock state B */
     660           0 :         if (safe_to_lower || watermarks->b.usr_retraining_ns
     661           0 :                         > hubbub2->watermarks.b.usr_retraining_ns) {
     662           0 :                 hubbub2->watermarks.b.usr_retraining_ns = watermarks->b.usr_retraining_ns;
     663           0 :                 prog_wm_value = convert_and_clamp(
     664             :                                 watermarks->b.usr_retraining_ns,
     665             :                                 refclk_mhz, 0x3fff);
     666           0 :                 REG_SET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_B, 0,
     667             :                                 DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_B, prog_wm_value);
     668           0 :                 DC_LOG_BANDWIDTH_CALCS("USR_RETRAINING_WATERMARK_B calculated =%d\n"
     669             :                         "HW register value = 0x%x\n\n",
     670             :                         watermarks->b.usr_retraining_ns, prog_wm_value);
     671           0 :         } else if (watermarks->b.usr_retraining_ns
     672             :                         < hubbub2->watermarks.b.usr_retraining_ns)
     673           0 :                 wm_pending = true;
     674             : 
     675             :         /* clock state C */
     676           0 :         if (safe_to_lower || watermarks->c.usr_retraining_ns
     677           0 :                         > hubbub2->watermarks.c.usr_retraining_ns) {
     678           0 :                 hubbub2->watermarks.c.usr_retraining_ns =
     679           0 :                                 watermarks->c.usr_retraining_ns;
     680           0 :                 prog_wm_value = convert_and_clamp(
     681             :                                 watermarks->c.usr_retraining_ns,
     682             :                                 refclk_mhz, 0x3fff);
     683           0 :                 REG_SET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_C, 0,
     684             :                                 DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_C, prog_wm_value);
     685           0 :                 DC_LOG_BANDWIDTH_CALCS("USR_RETRAINING_WATERMARK_C calculated =%d\n"
     686             :                         "HW register value = 0x%x\n\n",
     687             :                         watermarks->c.usr_retraining_ns, prog_wm_value);
     688           0 :         } else if (watermarks->c.usr_retraining_ns
     689             :                         < hubbub2->watermarks.c.usr_retraining_ns)
     690           0 :                 wm_pending = true;
     691             : 
     692             :         /* clock state D */
     693           0 :         if (safe_to_lower || watermarks->d.usr_retraining_ns
     694           0 :                         > hubbub2->watermarks.d.usr_retraining_ns) {
     695           0 :                 hubbub2->watermarks.d.usr_retraining_ns =
     696           0 :                                 watermarks->d.usr_retraining_ns;
     697           0 :                 prog_wm_value = convert_and_clamp(
     698             :                                 watermarks->d.usr_retraining_ns,
     699             :                                 refclk_mhz, 0x3fff);
     700           0 :                 REG_SET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_D, 0,
     701             :                                 DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_D, prog_wm_value);
     702           0 :                 DC_LOG_BANDWIDTH_CALCS("USR_RETRAINING_WATERMARK_D calculated =%d\n"
     703             :                         "HW register value = 0x%x\n\n",
     704             :                         watermarks->d.usr_retraining_ns, prog_wm_value);
     705           0 :         } else if (watermarks->d.usr_retraining_ns
     706             :                         < hubbub2->watermarks.d.usr_retraining_ns)
     707           0 :                 wm_pending = true;
     708             : 
     709           0 :         return wm_pending;
     710             : }
     711             : 
     712           0 : void hubbub32_force_usr_retraining_allow(struct hubbub *hubbub, bool allow)
     713             : {
     714           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     715             : 
     716             :         /*
     717             :          * DCHUBBUB_ARB_ALLOW_USR_RETRAINING_FORCE_ENABLE = 1 means enabling forcing value
     718             :          * DCHUBBUB_ARB_ALLOW_USR_RETRAINING_FORCE_VALUE = 1 or 0,  means value to be forced when force enable
     719             :          */
     720             : 
     721           0 :         REG_UPDATE_2(DCHUBBUB_ARB_USR_RETRAINING_CNTL,
     722             :                         DCHUBBUB_ARB_ALLOW_USR_RETRAINING_FORCE_VALUE, allow,
     723             :                         DCHUBBUB_ARB_ALLOW_USR_RETRAINING_FORCE_ENABLE, allow);
     724           0 : }
     725             : 
     726           0 : static bool hubbub32_program_watermarks(
     727             :                 struct hubbub *hubbub,
     728             :                 struct dcn_watermark_set *watermarks,
     729             :                 unsigned int refclk_mhz,
     730             :                 bool safe_to_lower)
     731             : {
     732           0 :         bool wm_pending = false;
     733             : 
     734           0 :         if (hubbub32_program_urgent_watermarks(hubbub, watermarks, refclk_mhz, safe_to_lower))
     735           0 :                 wm_pending = true;
     736             : 
     737           0 :         if (hubbub32_program_stutter_watermarks(hubbub, watermarks, refclk_mhz, safe_to_lower))
     738           0 :                 wm_pending = true;
     739             : 
     740           0 :         if (hubbub32_program_pstate_watermarks(hubbub, watermarks, refclk_mhz, safe_to_lower))
     741           0 :                 wm_pending = true;
     742             : 
     743           0 :         if (hubbub32_program_usr_watermarks(hubbub, watermarks, refclk_mhz, safe_to_lower))
     744           0 :                 wm_pending = true;
     745             : 
     746             :         /*
     747             :          * The DCHub arbiter has a mechanism to dynamically rate limit the DCHub request stream to the fabric.
     748             :          * If the memory controller is fully utilized and the DCHub requestors are
     749             :          * well ahead of their amortized schedule, then it is safe to prevent the next winner
     750             :          * from being committed and sent to the fabric.
     751             :          * The utilization of the memory controller is approximated by ensuring that
     752             :          * the number of outstanding requests is greater than a threshold specified
     753             :          * by the ARB_MIN_REQ_OUTSTANDING. To determine that the DCHub requestors are well ahead of the amortized schedule,
     754             :          * the slack of the next winner is compared with the ARB_SAT_LEVEL in DLG RefClk cycles.
     755             :          *
     756             :          * TODO: Revisit request limit after figure out right number. request limit for RM isn't decided yet, set maximum value (0x1FF)
     757             :          * to turn off it for now.
     758             :          */
     759             :         /*REG_SET(DCHUBBUB_ARB_SAT_LEVEL, 0,
     760             :                         DCHUBBUB_ARB_SAT_LEVEL, 60 * refclk_mhz);
     761             :         REG_UPDATE(DCHUBBUB_ARB_DF_REQ_OUTSTAND,
     762             :                         DCHUBBUB_ARB_MIN_REQ_OUTSTAND, 0x1FF);*/
     763             : 
     764           0 :         hubbub1_allow_self_refresh_control(hubbub, !hubbub->ctx->dc->debug.disable_stutter);
     765             : 
     766           0 :         hubbub32_force_usr_retraining_allow(hubbub, hubbub->ctx->dc->debug.force_usr_allow);
     767             : 
     768           0 :         return wm_pending;
     769             : }
     770             : 
     771             : /* Copy values from WM set A to all other sets */
     772           0 : void hubbub32_init_watermarks(struct hubbub *hubbub)
     773             : {
     774           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     775             :         uint32_t reg;
     776             : 
     777           0 :         reg = REG_READ(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_A);
     778           0 :         REG_WRITE(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_B, reg);
     779           0 :         REG_WRITE(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_C, reg);
     780           0 :         REG_WRITE(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_D, reg);
     781             : 
     782           0 :         reg = REG_READ(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_A);
     783           0 :         REG_WRITE(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_B, reg);
     784           0 :         REG_WRITE(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_C, reg);
     785           0 :         REG_WRITE(DCHUBBUB_ARB_FRAC_URG_BW_FLIP_D, reg);
     786             : 
     787           0 :         reg = REG_READ(DCHUBBUB_ARB_FRAC_URG_BW_NOM_A);
     788           0 :         REG_WRITE(DCHUBBUB_ARB_FRAC_URG_BW_NOM_B, reg);
     789           0 :         REG_WRITE(DCHUBBUB_ARB_FRAC_URG_BW_NOM_C, reg);
     790           0 :         REG_WRITE(DCHUBBUB_ARB_FRAC_URG_BW_NOM_D, reg);
     791             : 
     792           0 :         reg = REG_READ(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_A);
     793           0 :         REG_WRITE(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_B, reg);
     794           0 :         REG_WRITE(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_C, reg);
     795           0 :         REG_WRITE(DCHUBBUB_ARB_REFCYC_PER_TRIP_TO_MEMORY_D, reg);
     796             : 
     797           0 :         reg = REG_READ(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_A);
     798           0 :         REG_WRITE(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_B, reg);
     799           0 :         REG_WRITE(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_C, reg);
     800           0 :         REG_WRITE(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_D, reg);
     801             : 
     802           0 :         reg = REG_READ(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_A);
     803           0 :         REG_WRITE(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_B, reg);
     804           0 :         REG_WRITE(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_C, reg);
     805           0 :         REG_WRITE(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_D, reg);
     806             : 
     807           0 :         reg = REG_READ(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_A);
     808           0 :         REG_WRITE(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_B, reg);
     809           0 :         REG_WRITE(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_C, reg);
     810           0 :         REG_WRITE(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_D, reg);
     811             : 
     812           0 :         reg = REG_READ(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_A);
     813           0 :         REG_WRITE(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_B, reg);
     814           0 :         REG_WRITE(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_C, reg);
     815           0 :         REG_WRITE(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_D, reg);
     816             : 
     817           0 :         reg = REG_READ(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_A);
     818           0 :         REG_WRITE(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_B, reg);
     819           0 :         REG_WRITE(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_C, reg);
     820           0 :         REG_WRITE(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_D, reg);
     821           0 : }
     822             : 
     823           0 : void hubbub32_wm_read_state(struct hubbub *hubbub,
     824             :                 struct dcn_hubbub_wm *wm)
     825             : {
     826           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     827             :         struct dcn_hubbub_wm_set *s;
     828             : 
     829           0 :         memset(wm, 0, sizeof(struct dcn_hubbub_wm));
     830             : 
     831           0 :         s = &wm->sets[0];
     832           0 :         s->wm_set = 0;
     833           0 :         REG_GET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_A,
     834             :                         DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_A, &s->data_urgent);
     835             : 
     836           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_A,
     837             :                         DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_A, &s->sr_enter);
     838             : 
     839           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_A,
     840             :                         DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_A, &s->sr_exit);
     841             : 
     842           0 :         REG_GET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_A,
     843             :                          DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_A, &s->dram_clk_chanage);
     844             : 
     845           0 :         REG_GET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_A,
     846             :                          DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_A, &s->usr_retrain);
     847             : 
     848           0 :         REG_GET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_A,
     849             :                          DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_A, &s->fclk_pstate_change);
     850             : 
     851           0 :         s = &wm->sets[1];
     852           0 :         s->wm_set = 1;
     853           0 :         REG_GET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_B,
     854             :                         DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_B, &s->data_urgent);
     855             : 
     856           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_B,
     857             :                         DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_B, &s->sr_enter);
     858             : 
     859           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_B,
     860             :                         DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_B, &s->sr_exit);
     861             : 
     862           0 :         REG_GET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_B,
     863             :                         DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_B, &s->dram_clk_chanage);
     864             : 
     865           0 :         REG_GET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_B,
     866             :                          DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_B, &s->usr_retrain);
     867             : 
     868           0 :         REG_GET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_B,
     869             :                         DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_B, &s->fclk_pstate_change);
     870             : 
     871           0 :         s = &wm->sets[2];
     872           0 :         s->wm_set = 2;
     873           0 :         REG_GET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_C,
     874             :                         DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_C, &s->data_urgent);
     875             : 
     876           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_C,
     877             :                         DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_C, &s->sr_enter);
     878             : 
     879           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_C,
     880             :                         DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_C, &s->sr_exit);
     881             : 
     882           0 :         REG_GET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_C,
     883             :                         DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_C, &s->dram_clk_chanage);
     884             : 
     885           0 :         REG_GET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_C,
     886             :                          DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_C, &s->usr_retrain);
     887             : 
     888           0 :         REG_GET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_C,
     889             :                         DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_C, &s->fclk_pstate_change);
     890             : 
     891           0 :         s = &wm->sets[3];
     892           0 :         s->wm_set = 3;
     893           0 :         REG_GET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_D,
     894             :                         DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_D, &s->data_urgent);
     895             : 
     896           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_D,
     897             :                         DCHUBBUB_ARB_ALLOW_SR_ENTER_WATERMARK_D, &s->sr_enter);
     898             : 
     899           0 :         REG_GET(DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_D,
     900             :                         DCHUBBUB_ARB_ALLOW_SR_EXIT_WATERMARK_D, &s->sr_exit);
     901             : 
     902           0 :         REG_GET(DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_D,
     903             :                         DCHUBBUB_ARB_UCLK_PSTATE_CHANGE_WATERMARK_D, &s->dram_clk_chanage);
     904             : 
     905           0 :         REG_GET(DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_D,
     906             :                          DCHUBBUB_ARB_USR_RETRAINING_WATERMARK_D, &s->usr_retrain);
     907             : 
     908           0 :         REG_GET(DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_D,
     909             :                         DCHUBBUB_ARB_FCLK_PSTATE_CHANGE_WATERMARK_D, &s->fclk_pstate_change);
     910           0 : }
     911             : 
     912           0 : void hubbub32_force_wm_propagate_to_pipes(struct hubbub *hubbub)
     913             : {
     914           0 :         struct dcn20_hubbub *hubbub2 = TO_DCN20_HUBBUB(hubbub);
     915           0 :         uint32_t refclk_mhz = hubbub->ctx->dc->res_pool->ref_clocks.dchub_ref_clock_inKhz / 1000;
     916           0 :         uint32_t prog_wm_value = convert_and_clamp(hubbub2->watermarks.a.urgent_ns,
     917             :                         refclk_mhz, 0x3fff);
     918             : 
     919           0 :         REG_SET(DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_A, 0,
     920             :                         DCHUBBUB_ARB_DATA_URGENCY_WATERMARK_A, prog_wm_value);
     921           0 : }
     922             : 
     923             : static const struct hubbub_funcs hubbub32_funcs = {
     924             :         .update_dchub = hubbub2_update_dchub,
     925             :         .init_dchub_sys_ctx = hubbub3_init_dchub_sys_ctx,
     926             :         .init_vm_ctx = hubbub2_init_vm_ctx,
     927             :         .dcc_support_swizzle = hubbub3_dcc_support_swizzle,
     928             :         .dcc_support_pixel_format = hubbub2_dcc_support_pixel_format,
     929             :         .get_dcc_compression_cap = hubbub3_get_dcc_compression_cap,
     930             :         .wm_read_state = hubbub32_wm_read_state,
     931             :         .get_dchub_ref_freq = hubbub2_get_dchub_ref_freq,
     932             :         .program_watermarks = hubbub32_program_watermarks,
     933             :         .allow_self_refresh_control = hubbub1_allow_self_refresh_control,
     934             :         .is_allow_self_refresh_enabled = hubbub1_is_allow_self_refresh_enabled,
     935             :         .force_wm_propagate_to_pipes = hubbub32_force_wm_propagate_to_pipes,
     936             :         .force_pstate_change_control = hubbub3_force_pstate_change_control,
     937             :         .init_watermarks = hubbub32_init_watermarks,
     938             :         .program_det_size = dcn32_program_det_size,
     939             :         .program_compbuf_size = dcn32_program_compbuf_size,
     940             :         .init_crb = dcn32_init_crb,
     941             :         .hubbub_read_state = hubbub2_read_state,
     942             :         .force_usr_retraining_allow = hubbub32_force_usr_retraining_allow,
     943             : };
     944             : 
     945           0 : void hubbub32_construct(struct dcn20_hubbub *hubbub2,
     946             :         struct dc_context *ctx,
     947             :         const struct dcn_hubbub_registers *hubbub_regs,
     948             :         const struct dcn_hubbub_shift *hubbub_shift,
     949             :         const struct dcn_hubbub_mask *hubbub_mask,
     950             :         int det_size_kb,
     951             :         int pixel_chunk_size_kb,
     952             :         int config_return_buffer_size_kb)
     953             : {
     954           0 :         hubbub2->base.ctx = ctx;
     955           0 :         hubbub2->base.funcs = &hubbub32_funcs;
     956           0 :         hubbub2->regs = hubbub_regs;
     957           0 :         hubbub2->shifts = hubbub_shift;
     958           0 :         hubbub2->masks = hubbub_mask;
     959             : 
     960           0 :         hubbub2->debug_test_index_pstate = 0xB;
     961           0 :         hubbub2->detile_buf_size = det_size_kb * 1024;
     962           0 :         hubbub2->pixel_chunk_size = pixel_chunk_size_kb * 1024;
     963           0 :         hubbub2->crb_size_segs = config_return_buffer_size_kb / DCN32_CRB_SEGMENT_SIZE_KB;
     964           0 : }

Generated by: LCOV version 1.14