drivers/gpu/drm/amd/powerplay/hwmgr/cz_hwmgr.c

   1 /*
   2  * Copyright 2015 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  */
  23 #include "pp_debug.h"
  24 #include <linux/types.h>
  25 #include <linux/kernel.h>
  26 #include <linux/slab.h>
  27 #include "atom-types.h"
  28 #include "atombios.h"
  29 #include "processpptables.h"
  30 #include "cgs_common.h"
  31 #include "smu/smu_8_0_d.h"
  32 #include "smu8_fusion.h"
  33 #include "smu/smu_8_0_sh_mask.h"
  34 #include "smumgr.h"
  35 #include "hwmgr.h"
  36 #include "hardwaremanager.h"
  37 #include "cz_ppsmc.h"
  38 #include "cz_hwmgr.h"
  39 #include "power_state.h"
  40 #include "cz_clockpowergating.h"
  41
  42 #define ixSMUSVI_NB_CURRENTVID 0xD8230044
  43 #define CURRENT_NB_VID_MASK 0xff000000
  44 #define CURRENT_NB_VID__SHIFT 24
  45 #define ixSMUSVI_GFX_CURRENTVID  0xD8230048
  46 #define CURRENT_GFX_VID_MASK 0xff000000
  47 #define CURRENT_GFX_VID__SHIFT 24
  48
  49 static const unsigned long PhwCz_Magic = (unsigned long) PHM_Cz_Magic;
  50
  51 static struct cz_power_state *cast_PhwCzPowerState(struct pp_hw_power_state *hw_ps)
  52 {
  53         if (PhwCz_Magic != hw_ps->magic)
  54                 return NULL;
  55
  56         return (struct cz_power_state *)hw_ps;
  57 }
  58
  59 static const struct cz_power_state *cast_const_PhwCzPowerState(
  60                                 const struct pp_hw_power_state *hw_ps)
  61 {
  62         if (PhwCz_Magic != hw_ps->magic)
  63                 return NULL;
  64
  65         return (struct cz_power_state *)hw_ps;
  66 }
  67
  68 static uint32_t cz_get_eclk_level(struct pp_hwmgr *hwmgr,
  69                                         uint32_t clock, uint32_t msg)
  70 {
  71         int i = 0;
  72         struct phm_vce_clock_voltage_dependency_table *ptable =
  73                 hwmgr->dyn_state.vce_clock_voltage_dependency_table;
  74
  75         switch (msg) {
  76         case PPSMC_MSG_SetEclkSoftMin:
  77         case PPSMC_MSG_SetEclkHardMin:
  78                 for (i = 0; i < (int)ptable->count; i++) {
  79                         if (clock <= ptable->entries[i].ecclk)
  80                                 break;
  81                 }
  82                 break;
  83
  84         case PPSMC_MSG_SetEclkSoftMax:
  85         case PPSMC_MSG_SetEclkHardMax:
  86                 for (i = ptable->count - 1; i >= 0; i--) {
  87                         if (clock >= ptable->entries[i].ecclk)
  88                                 break;
  89                 }
  90                 break;
  91
  92         default:
  93                 break;
  94         }
  95
  96         return i;
  97 }
  98
  99 static uint32_t cz_get_sclk_level(struct pp_hwmgr *hwmgr,
 100                                 uint32_t clock, uint32_t msg)
 101 {
 102         int i = 0;
 103         struct phm_clock_voltage_dependency_table *table =
 104                                 hwmgr->dyn_state.vddc_dependency_on_sclk;
 105
 106         switch (msg) {
 107         case PPSMC_MSG_SetSclkSoftMin:
 108         case PPSMC_MSG_SetSclkHardMin:
 109                 for (i = 0; i < (int)table->count; i++) {
 110                         if (clock <= table->entries[i].clk)
 111                                 break;
 112                 }
 113                 break;
 114
 115         case PPSMC_MSG_SetSclkSoftMax:
 116         case PPSMC_MSG_SetSclkHardMax:
 117                 for (i = table->count - 1; i >= 0; i--) {
 118                         if (clock >= table->entries[i].clk)
 119                                 break;
 120                 }
 121                 break;
 122
 123         default:
 124                 break;
 125         }
 126         return i;
 127 }
 128
 129 static uint32_t cz_get_uvd_level(struct pp_hwmgr *hwmgr,
 130                                         uint32_t clock, uint32_t msg)
 131 {
 132         int i = 0;
 133         struct phm_uvd_clock_voltage_dependency_table *ptable =
 134                 hwmgr->dyn_state.uvd_clock_voltage_dependency_table;
 135
 136         switch (msg) {
 137         case PPSMC_MSG_SetUvdSoftMin:
 138         case PPSMC_MSG_SetUvdHardMin:
 139                 for (i = 0; i < (int)ptable->count; i++) {
 140                         if (clock <= ptable->entries[i].vclk)
 141                                 break;
 142                 }
 143                 break;
 144
 145         case PPSMC_MSG_SetUvdSoftMax:
 146         case PPSMC_MSG_SetUvdHardMax:
 147                 for (i = ptable->count - 1; i >= 0; i--) {
 148                         if (clock >= ptable->entries[i].vclk)
 149                                 break;
 150                 }
 151                 break;
 152
 153         default:
 154                 break;
 155         }
 156
 157         return i;
 158 }
 159
 160 static uint32_t cz_get_max_sclk_level(struct pp_hwmgr *hwmgr)
 161 {
 162         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 163
 164         if (cz_hwmgr->max_sclk_level == 0) {
 165                 smum_send_msg_to_smc(hwmgr->smumgr, PPSMC_MSG_GetMaxSclkLevel);
 166                 cz_hwmgr->max_sclk_level = smum_get_argument(hwmgr->smumgr) + 1;
 167         }
 168
 169         return cz_hwmgr->max_sclk_level;
 170 }
 171
 172 static int cz_initialize_dpm_defaults(struct pp_hwmgr *hwmgr)
 173 {
 174         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 175         uint32_t i;
 176         struct cgs_system_info sys_info = {0};
 177         int result;
 178
 179         cz_hwmgr->gfx_ramp_step = 256*25/100;
 180         cz_hwmgr->gfx_ramp_delay = 1; /* by default, we delay 1us */
 181
 182         for (i = 0; i < CZ_MAX_HARDWARE_POWERLEVELS; i++)
 183                 cz_hwmgr->activity_target[i] = CZ_AT_DFLT;
 184
 185         cz_hwmgr->mgcg_cgtt_local0 = 0x00000000;
 186         cz_hwmgr->mgcg_cgtt_local1 = 0x00000000;
 187         cz_hwmgr->clock_slow_down_freq = 25000;
 188         cz_hwmgr->skip_clock_slow_down = 1;
 189         cz_hwmgr->enable_nb_ps_policy = 1; /* disable until UNB is ready, Enabled */
 190         cz_hwmgr->voltage_drop_in_dce_power_gating = 0; /* disable until fully verified */
 191         cz_hwmgr->voting_rights_clients = 0x00C00033;
 192         cz_hwmgr->static_screen_threshold = 8;
 193         cz_hwmgr->ddi_power_gating_disabled = 0;
 194         cz_hwmgr->bapm_enabled = 1;
 195         cz_hwmgr->voltage_drop_threshold = 0;
 196         cz_hwmgr->gfx_power_gating_threshold = 500;
 197         cz_hwmgr->vce_slow_sclk_threshold = 20000;
 198         cz_hwmgr->dce_slow_sclk_threshold = 30000;
 199         cz_hwmgr->disable_driver_thermal_policy = 1;
 200         cz_hwmgr->disable_nb_ps3_in_battery = 0;
 201
 202         phm_cap_unset(hwmgr->platform_descriptor.platformCaps,
 203                                                         PHM_PlatformCaps_ABM);
 204
 205         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 206                                     PHM_PlatformCaps_NonABMSupportInPPLib);
 207
 208         phm_cap_unset(hwmgr->platform_descriptor.platformCaps,
 209                                         PHM_PlatformCaps_DynamicM3Arbiter);
 210
 211         cz_hwmgr->override_dynamic_mgpg = 1;
 212
 213         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 214                                   PHM_PlatformCaps_DynamicPatchPowerState);
 215
 216         cz_hwmgr->thermal_auto_throttling_treshold = 0;
 217         cz_hwmgr->tdr_clock = 0;
 218         cz_hwmgr->disable_gfx_power_gating_in_uvd = 0;
 219
 220         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 221                                         PHM_PlatformCaps_DynamicUVDState);
 222
 223         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 224                         PHM_PlatformCaps_UVDDPM);
 225         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 226                         PHM_PlatformCaps_VCEDPM);
 227
 228         cz_hwmgr->cc6_settings.cpu_cc6_disable = false;
 229         cz_hwmgr->cc6_settings.cpu_pstate_disable = false;
 230         cz_hwmgr->cc6_settings.nb_pstate_switch_disable = false;
 231         cz_hwmgr->cc6_settings.cpu_pstate_separation_time = 0;
 232
 233         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 234                                    PHM_PlatformCaps_DisableVoltageIsland);
 235
 236         phm_cap_unset(hwmgr->platform_descriptor.platformCaps,
 237                       PHM_PlatformCaps_UVDPowerGating);
 238         phm_cap_unset(hwmgr->platform_descriptor.platformCaps,
 239                       PHM_PlatformCaps_VCEPowerGating);
 240         sys_info.size = sizeof(struct cgs_system_info);
 241         sys_info.info_id = CGS_SYSTEM_INFO_PG_FLAGS;
 242         result = cgs_query_system_info(hwmgr->device, &sys_info);
 243         if (!result) {
 244                 if (sys_info.value & AMD_PG_SUPPORT_UVD)
 245                         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 246                                       PHM_PlatformCaps_UVDPowerGating);
 247                 if (sys_info.value & AMD_PG_SUPPORT_VCE)
 248                         phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 249                                       PHM_PlatformCaps_VCEPowerGating);
 250         }
 251
 252         return 0;
 253 }
 254
 255 static uint32_t cz_convert_8Bit_index_to_voltage(
 256                         struct pp_hwmgr *hwmgr, uint16_t voltage)
 257 {
 258         return 6200 - (voltage * 25);
 259 }
 260
 261 static int cz_construct_max_power_limits_table(struct pp_hwmgr *hwmgr,
 262                         struct phm_clock_and_voltage_limits *table)
 263 {
 264         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)hwmgr->backend;
 265         struct cz_sys_info *sys_info = &cz_hwmgr->sys_info;
 266         struct phm_clock_voltage_dependency_table *dep_table =
 267                                 hwmgr->dyn_state.vddc_dependency_on_sclk;
 268
 269         if (dep_table->count > 0) {
 270                 table->sclk = dep_table->entries[dep_table->count-1].clk;
 271                 table->vddc = cz_convert_8Bit_index_to_voltage(hwmgr,
 272                    (uint16_t)dep_table->entries[dep_table->count-1].v);
 273         }
 274         table->mclk = sys_info->nbp_memory_clock[0];
 275         return 0;
 276 }
 277
 278 static int cz_init_dynamic_state_adjustment_rule_settings(
 279                         struct pp_hwmgr *hwmgr,
 280                         ATOM_CLK_VOLT_CAPABILITY *disp_voltage_table)
 281 {
 282         uint32_t table_size =
 283                 sizeof(struct phm_clock_voltage_dependency_table) +
 284                 (7 * sizeof(struct phm_clock_voltage_dependency_record));
 285
 286         struct phm_clock_voltage_dependency_table *table_clk_vlt =
 287                                         kzalloc(table_size, GFP_KERNEL);
 288
 289         if (NULL == table_clk_vlt) {
 290                 pr_err("Can not allocate memory!\n");
 291                 return -ENOMEM;
 292         }
 293
 294         table_clk_vlt->count = 8;
 295         table_clk_vlt->entries[0].clk = PP_DAL_POWERLEVEL_0;
 296         table_clk_vlt->entries[0].v = 0;
 297         table_clk_vlt->entries[1].clk = PP_DAL_POWERLEVEL_1;
 298         table_clk_vlt->entries[1].v = 1;
 299         table_clk_vlt->entries[2].clk = PP_DAL_POWERLEVEL_2;
 300         table_clk_vlt->entries[2].v = 2;
 301         table_clk_vlt->entries[3].clk = PP_DAL_POWERLEVEL_3;
 302         table_clk_vlt->entries[3].v = 3;
 303         table_clk_vlt->entries[4].clk = PP_DAL_POWERLEVEL_4;
 304         table_clk_vlt->entries[4].v = 4;
 305         table_clk_vlt->entries[5].clk = PP_DAL_POWERLEVEL_5;
 306         table_clk_vlt->entries[5].v = 5;
 307         table_clk_vlt->entries[6].clk = PP_DAL_POWERLEVEL_6;
 308         table_clk_vlt->entries[6].v = 6;
 309         table_clk_vlt->entries[7].clk = PP_DAL_POWERLEVEL_7;
 310         table_clk_vlt->entries[7].v = 7;
 311         hwmgr->dyn_state.vddc_dep_on_dal_pwrl = table_clk_vlt;
 312
 313         return 0;
 314 }
 315
 316 static int cz_get_system_info_data(struct pp_hwmgr *hwmgr)
 317 {
 318         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)hwmgr->backend;
 319         ATOM_INTEGRATED_SYSTEM_INFO_V1_9 *info = NULL;
 320         uint32_t i;
 321         int result = 0;
 322         uint8_t frev, crev;
 323         uint16_t size;
 324
 325         info = (ATOM_INTEGRATED_SYSTEM_INFO_V1_9 *) cgs_atom_get_data_table(
 326                         hwmgr->device,
 327                         GetIndexIntoMasterTable(DATA, IntegratedSystemInfo),
 328                         &size, &frev, &crev);
 329
 330         if (crev != 9) {
 331                 pr_err("Unsupported IGP table: %d %d\n", frev, crev);
 332                 return -EINVAL;
 333         }
 334
 335         if (info == NULL) {
 336                 pr_err("Could not retrieve the Integrated System Info Table!\n");
 337                 return -EINVAL;
 338         }
 339
 340         cz_hwmgr->sys_info.bootup_uma_clock =
 341                                    le32_to_cpu(info->ulBootUpUMAClock);
 342
 343         cz_hwmgr->sys_info.bootup_engine_clock =
 344                                 le32_to_cpu(info->ulBootUpEngineClock);
 345
 346         cz_hwmgr->sys_info.dentist_vco_freq =
 347                                    le32_to_cpu(info->ulDentistVCOFreq);
 348
 349         cz_hwmgr->sys_info.system_config =
 350                                      le32_to_cpu(info->ulSystemConfig);
 351
 352         cz_hwmgr->sys_info.bootup_nb_voltage_index =
 353                                   le16_to_cpu(info->usBootUpNBVoltage);
 354
 355         cz_hwmgr->sys_info.htc_hyst_lmt =
 356                         (info->ucHtcHystLmt == 0) ? 5 : info->ucHtcHystLmt;
 357
 358         cz_hwmgr->sys_info.htc_tmp_lmt =
 359                         (info->ucHtcTmpLmt == 0) ? 203 : info->ucHtcTmpLmt;
 360
 361         if (cz_hwmgr->sys_info.htc_tmp_lmt <=
 362                         cz_hwmgr->sys_info.htc_hyst_lmt) {
 363                 pr_err("The htcTmpLmt should be larger than htcHystLmt.\n");
 364                 return -EINVAL;
 365         }
 366
 367         cz_hwmgr->sys_info.nb_dpm_enable =
 368                                 cz_hwmgr->enable_nb_ps_policy &&
 369                                 (le32_to_cpu(info->ulSystemConfig) >> 3 & 0x1);
 370
 371         for (i = 0; i < CZ_NUM_NBPSTATES; i++) {
 372                 if (i < CZ_NUM_NBPMEMORYCLOCK) {
 373                         cz_hwmgr->sys_info.nbp_memory_clock[i] =
 374                           le32_to_cpu(info->ulNbpStateMemclkFreq[i]);
 375                 }
 376                 cz_hwmgr->sys_info.nbp_n_clock[i] =
 377                             le32_to_cpu(info->ulNbpStateNClkFreq[i]);
 378         }
 379
 380         for (i = 0; i < MAX_DISPLAY_CLOCK_LEVEL; i++) {
 381                 cz_hwmgr->sys_info.display_clock[i] =
 382                                         le32_to_cpu(info->sDispClkVoltageMapping[i].ulMaximumSupportedCLK);
 383         }
 384
 385         /* Here use 4 levels, make sure not exceed */
 386         for (i = 0; i < CZ_NUM_NBPSTATES; i++) {
 387                 cz_hwmgr->sys_info.nbp_voltage_index[i] =
 388                              le16_to_cpu(info->usNBPStateVoltage[i]);
 389         }
 390
 391         if (!cz_hwmgr->sys_info.nb_dpm_enable) {
 392                 for (i = 1; i < CZ_NUM_NBPSTATES; i++) {
 393                         if (i < CZ_NUM_NBPMEMORYCLOCK) {
 394                                 cz_hwmgr->sys_info.nbp_memory_clock[i] =
 395                                     cz_hwmgr->sys_info.nbp_memory_clock[0];
 396                         }
 397                         cz_hwmgr->sys_info.nbp_n_clock[i] =
 398                                     cz_hwmgr->sys_info.nbp_n_clock[0];
 399                         cz_hwmgr->sys_info.nbp_voltage_index[i] =
 400                                     cz_hwmgr->sys_info.nbp_voltage_index[0];
 401                 }
 402         }
 403
 404         if (le32_to_cpu(info->ulGPUCapInfo) &
 405                 SYS_INFO_GPUCAPS__ENABEL_DFS_BYPASS) {
 406                 phm_cap_set(hwmgr->platform_descriptor.platformCaps,
 407                                     PHM_PlatformCaps_EnableDFSBypass);
 408         }
 409
 410         cz_hwmgr->sys_info.uma_channel_number = info->ucUMAChannelNumber;
 411
 412         cz_construct_max_power_limits_table (hwmgr,
 413                                     &hwmgr->dyn_state.max_clock_voltage_on_ac);
 414
 415         cz_init_dynamic_state_adjustment_rule_settings(hwmgr,
 416                                     &info->sDISPCLK_Voltage[0]);
 417
 418         return result;
 419 }
 420
 421 static int cz_construct_boot_state(struct pp_hwmgr *hwmgr)
 422 {
 423         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 424
 425         cz_hwmgr->boot_power_level.engineClock =
 426                                 cz_hwmgr->sys_info.bootup_engine_clock;
 427
 428         cz_hwmgr->boot_power_level.vddcIndex =
 429                         (uint8_t)cz_hwmgr->sys_info.bootup_nb_voltage_index;
 430
 431         cz_hwmgr->boot_power_level.dsDividerIndex = 0;
 432         cz_hwmgr->boot_power_level.ssDividerIndex = 0;
 433         cz_hwmgr->boot_power_level.allowGnbSlow = 1;
 434         cz_hwmgr->boot_power_level.forceNBPstate = 0;
 435         cz_hwmgr->boot_power_level.hysteresis_up = 0;
 436         cz_hwmgr->boot_power_level.numSIMDToPowerDown = 0;
 437         cz_hwmgr->boot_power_level.display_wm = 0;
 438         cz_hwmgr->boot_power_level.vce_wm = 0;
 439
 440         return 0;
 441 }
 442
 443 static int cz_tf_reset_active_process_mask(struct pp_hwmgr *hwmgr, void *input,
 444                                         void *output, void *storage, int result)
 445 {
 446         return 0;
 447 }
 448
 449 static int cz_tf_upload_pptable_to_smu(struct pp_hwmgr *hwmgr, void *input,
 450                                        void *output, void *storage, int result)
 451 {
 452         struct SMU8_Fusion_ClkTable *clock_table;
 453         int ret;
 454         uint32_t i;
 455         void *table = NULL;
 456         pp_atomctrl_clock_dividers_kong dividers;
 457
 458         struct phm_clock_voltage_dependency_table *vddc_table =
 459                 hwmgr->dyn_state.vddc_dependency_on_sclk;
 460         struct phm_clock_voltage_dependency_table *vdd_gfx_table =
 461                 hwmgr->dyn_state.vdd_gfx_dependency_on_sclk;
 462         struct phm_acp_clock_voltage_dependency_table *acp_table =
 463                 hwmgr->dyn_state.acp_clock_voltage_dependency_table;
 464         struct phm_uvd_clock_voltage_dependency_table *uvd_table =
 465                 hwmgr->dyn_state.uvd_clock_voltage_dependency_table;
 466         struct phm_vce_clock_voltage_dependency_table *vce_table =
 467                 hwmgr->dyn_state.vce_clock_voltage_dependency_table;
 468
 469         if (!hwmgr->need_pp_table_upload)
 470                 return 0;
 471
 472         ret = smum_download_powerplay_table(hwmgr->smumgr, &table);
 473
 474         PP_ASSERT_WITH_CODE((0 == ret && NULL != table),
 475                             "Fail to get clock table from SMU!", return -EINVAL;);
 476
 477         clock_table = (struct SMU8_Fusion_ClkTable *)table;
 478
 479         /* patch clock table */
 480         PP_ASSERT_WITH_CODE((vddc_table->count <= CZ_MAX_HARDWARE_POWERLEVELS),
 481                             "Dependency table entry exceeds max limit!", return -EINVAL;);
 482         PP_ASSERT_WITH_CODE((vdd_gfx_table->count <= CZ_MAX_HARDWARE_POWERLEVELS),
 483                             "Dependency table entry exceeds max limit!", return -EINVAL;);
 484         PP_ASSERT_WITH_CODE((acp_table->count <= CZ_MAX_HARDWARE_POWERLEVELS),
 485                             "Dependency table entry exceeds max limit!", return -EINVAL;);
 486         PP_ASSERT_WITH_CODE((uvd_table->count <= CZ_MAX_HARDWARE_POWERLEVELS),
 487                             "Dependency table entry exceeds max limit!", return -EINVAL;);
 488         PP_ASSERT_WITH_CODE((vce_table->count <= CZ_MAX_HARDWARE_POWERLEVELS),
 489                             "Dependency table entry exceeds max limit!", return -EINVAL;);
 490
 491         for (i = 0; i < CZ_MAX_HARDWARE_POWERLEVELS; i++) {
 492
 493                 /* vddc_sclk */
 494                 clock_table->SclkBreakdownTable.ClkLevel[i].GnbVid =
 495                         (i < vddc_table->count) ? (uint8_t)vddc_table->entries[i].v : 0;
 496                 clock_table->SclkBreakdownTable.ClkLevel[i].Frequency =
 497                         (i < vddc_table->count) ? vddc_table->entries[i].clk : 0;
 498
 499                 atomctrl_get_engine_pll_dividers_kong(hwmgr,
 500                                                       clock_table->SclkBreakdownTable.ClkLevel[i].Frequency,
 501                                                       &dividers);
 502
 503                 clock_table->SclkBreakdownTable.ClkLevel[i].DfsDid =
 504                         (uint8_t)dividers.pll_post_divider;
 505
 506                 /* vddgfx_sclk */
 507                 clock_table->SclkBreakdownTable.ClkLevel[i].GfxVid =
 508                         (i < vdd_gfx_table->count) ? (uint8_t)vdd_gfx_table->entries[i].v : 0;
 509
 510                 /* acp breakdown */
 511                 clock_table->AclkBreakdownTable.ClkLevel[i].GfxVid =
 512                         (i < acp_table->count) ? (uint8_t)acp_table->entries[i].v : 0;
 513                 clock_table->AclkBreakdownTable.ClkLevel[i].Frequency =
 514                         (i < acp_table->count) ? acp_table->entries[i].acpclk : 0;
 515
 516                 atomctrl_get_engine_pll_dividers_kong(hwmgr,
 517                                                       clock_table->AclkBreakdownTable.ClkLevel[i].Frequency,
 518                                                       &dividers);
 519
 520                 clock_table->AclkBreakdownTable.ClkLevel[i].DfsDid =
 521                         (uint8_t)dividers.pll_post_divider;
 522
 523
 524                 /* uvd breakdown */
 525                 clock_table->VclkBreakdownTable.ClkLevel[i].GfxVid =
 526                         (i < uvd_table->count) ? (uint8_t)uvd_table->entries[i].v : 0;
 527                 clock_table->VclkBreakdownTable.ClkLevel[i].Frequency =
 528                         (i < uvd_table->count) ? uvd_table->entries[i].vclk : 0;
 529
 530                 atomctrl_get_engine_pll_dividers_kong(hwmgr,
 531                                                       clock_table->VclkBreakdownTable.ClkLevel[i].Frequency,
 532                                                       &dividers);
 533
 534                 clock_table->VclkBreakdownTable.ClkLevel[i].DfsDid =
 535                         (uint8_t)dividers.pll_post_divider;
 536
 537                 clock_table->DclkBreakdownTable.ClkLevel[i].GfxVid =
 538                         (i < uvd_table->count) ? (uint8_t)uvd_table->entries[i].v : 0;
 539                 clock_table->DclkBreakdownTable.ClkLevel[i].Frequency =
 540                         (i < uvd_table->count) ? uvd_table->entries[i].dclk : 0;
 541
 542                 atomctrl_get_engine_pll_dividers_kong(hwmgr,
 543                                                       clock_table->DclkBreakdownTable.ClkLevel[i].Frequency,
 544                                                       &dividers);
 545
 546                 clock_table->DclkBreakdownTable.ClkLevel[i].DfsDid =
 547                         (uint8_t)dividers.pll_post_divider;
 548
 549                 /* vce breakdown */
 550                 clock_table->EclkBreakdownTable.ClkLevel[i].GfxVid =
 551                         (i < vce_table->count) ? (uint8_t)vce_table->entries[i].v : 0;
 552                 clock_table->EclkBreakdownTable.ClkLevel[i].Frequency =
 553                         (i < vce_table->count) ? vce_table->entries[i].ecclk : 0;
 554
 555
 556                 atomctrl_get_engine_pll_dividers_kong(hwmgr,
 557                                                       clock_table->EclkBreakdownTable.ClkLevel[i].Frequency,
 558                                                       &dividers);
 559
 560                 clock_table->EclkBreakdownTable.ClkLevel[i].DfsDid =
 561                         (uint8_t)dividers.pll_post_divider;
 562
 563         }
 564         ret = smum_upload_powerplay_table(hwmgr->smumgr);
 565
 566         return ret;
 567 }
 568
 569 static int cz_tf_init_sclk_limit(struct pp_hwmgr *hwmgr, void *input,
 570                                  void *output, void *storage, int result)
 571 {
 572         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 573         struct phm_clock_voltage_dependency_table *table =
 574                                         hwmgr->dyn_state.vddc_dependency_on_sclk;
 575         unsigned long clock = 0, level;
 576
 577         if (NULL == table || table->count <= 0)
 578                 return -EINVAL;
 579
 580         cz_hwmgr->sclk_dpm.soft_min_clk = table->entries[0].clk;
 581         cz_hwmgr->sclk_dpm.hard_min_clk = table->entries[0].clk;
 582
 583         level = cz_get_max_sclk_level(hwmgr) - 1;
 584
 585         if (level < table->count)
 586                 clock = table->entries[level].clk;
 587         else
 588                 clock = table->entries[table->count - 1].clk;
 589
 590         cz_hwmgr->sclk_dpm.soft_max_clk = clock;
 591         cz_hwmgr->sclk_dpm.hard_max_clk = clock;
 592
 593         return 0;
 594 }
 595
 596 static int cz_tf_init_uvd_limit(struct pp_hwmgr *hwmgr, void *input,
 597                                 void *output, void *storage, int result)
 598 {
 599         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 600         struct phm_uvd_clock_voltage_dependency_table *table =
 601                                 hwmgr->dyn_state.uvd_clock_voltage_dependency_table;
 602         unsigned long clock = 0, level;
 603
 604         if (NULL == table || table->count <= 0)
 605                 return -EINVAL;
 606
 607         cz_hwmgr->uvd_dpm.soft_min_clk = 0;
 608         cz_hwmgr->uvd_dpm.hard_min_clk = 0;
 609
 610         smum_send_msg_to_smc(hwmgr->smumgr, PPSMC_MSG_GetMaxUvdLevel);
 611         level = smum_get_argument(hwmgr->smumgr);
 612
 613         if (level < table->count)
 614                 clock = table->entries[level].vclk;
 615         else
 616                 clock = table->entries[table->count - 1].vclk;
 617
 618         cz_hwmgr->uvd_dpm.soft_max_clk = clock;
 619         cz_hwmgr->uvd_dpm.hard_max_clk = clock;
 620
 621         return 0;
 622 }
 623
 624 static int cz_tf_init_vce_limit(struct pp_hwmgr *hwmgr, void *input,
 625                                 void *output, void *storage, int result)
 626 {
 627         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 628         struct phm_vce_clock_voltage_dependency_table *table =
 629                                 hwmgr->dyn_state.vce_clock_voltage_dependency_table;
 630         unsigned long clock = 0, level;
 631
 632         if (NULL == table || table->count <= 0)
 633                 return -EINVAL;
 634
 635         cz_hwmgr->vce_dpm.soft_min_clk = 0;
 636         cz_hwmgr->vce_dpm.hard_min_clk = 0;
 637
 638         smum_send_msg_to_smc(hwmgr->smumgr, PPSMC_MSG_GetMaxEclkLevel);
 639         level = smum_get_argument(hwmgr->smumgr);
 640
 641         if (level < table->count)
 642                 clock = table->entries[level].ecclk;
 643         else
 644                 clock = table->entries[table->count - 1].ecclk;
 645
 646         cz_hwmgr->vce_dpm.soft_max_clk = clock;
 647         cz_hwmgr->vce_dpm.hard_max_clk = clock;
 648
 649         return 0;
 650 }
 651
 652 static int cz_tf_init_acp_limit(struct pp_hwmgr *hwmgr, void *input,
 653                                 void *output, void *storage, int result)
 654 {
 655         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 656         struct phm_acp_clock_voltage_dependency_table *table =
 657                                 hwmgr->dyn_state.acp_clock_voltage_dependency_table;
 658         unsigned long clock = 0, level;
 659
 660         if (NULL == table || table->count <= 0)
 661                 return -EINVAL;
 662
 663         cz_hwmgr->acp_dpm.soft_min_clk = 0;
 664         cz_hwmgr->acp_dpm.hard_min_clk = 0;
 665
 666         smum_send_msg_to_smc(hwmgr->smumgr, PPSMC_MSG_GetMaxAclkLevel);
 667         level = smum_get_argument(hwmgr->smumgr);
 668
 669         if (level < table->count)
 670                 clock = table->entries[level].acpclk;
 671         else
 672                 clock = table->entries[table->count - 1].acpclk;
 673
 674         cz_hwmgr->acp_dpm.soft_max_clk = clock;
 675         cz_hwmgr->acp_dpm.hard_max_clk = clock;
 676         return 0;
 677 }
 678
 679 static int cz_tf_init_power_gate_state(struct pp_hwmgr *hwmgr, void *input,
 680                                 void *output, void *storage, int result)
 681 {
 682         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 683
 684         cz_hwmgr->uvd_power_gated = false;
 685         cz_hwmgr->vce_power_gated = false;
 686         cz_hwmgr->samu_power_gated = false;
 687         cz_hwmgr->acp_power_gated = false;
 688         cz_hwmgr->pgacpinit = true;
 689
 690         return 0;
 691 }
 692
 693 static int cz_tf_init_sclk_threshold(struct pp_hwmgr *hwmgr, void *input,
 694                                 void *output, void *storage, int result)
 695 {
 696         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 697
 698         cz_hwmgr->low_sclk_interrupt_threshold = 0;
 699
 700         return 0;
 701 }
 702 static int cz_tf_update_sclk_limit(struct pp_hwmgr *hwmgr,
 703                                         void *input, void *output,
 704                                         void *storage, int result)
 705 {
 706         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 707         struct phm_clock_voltage_dependency_table *table =
 708                                         hwmgr->dyn_state.vddc_dependency_on_sclk;
 709
 710         unsigned long clock = 0;
 711         unsigned long level;
 712         unsigned long stable_pstate_sclk;
 713         unsigned long percentage;
 714
 715         cz_hwmgr->sclk_dpm.soft_min_clk = table->entries[0].clk;
 716         level = cz_get_max_sclk_level(hwmgr) - 1;
 717
 718         if (level < table->count)
 719                 cz_hwmgr->sclk_dpm.soft_max_clk  = table->entries[level].clk;
 720         else
 721                 cz_hwmgr->sclk_dpm.soft_max_clk  = table->entries[table->count - 1].clk;
 722
 723         clock = hwmgr->display_config.min_core_set_clock;
 724         if (clock == 0)
 725                 pr_info("min_core_set_clock not set\n");
 726
 727         if (cz_hwmgr->sclk_dpm.hard_min_clk != clock) {
 728                 cz_hwmgr->sclk_dpm.hard_min_clk = clock;
 729
 730                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 731                                                 PPSMC_MSG_SetSclkHardMin,
 732                                                  cz_get_sclk_level(hwmgr,
 733                                         cz_hwmgr->sclk_dpm.hard_min_clk,
 734                                              PPSMC_MSG_SetSclkHardMin));
 735         }
 736
 737         clock = cz_hwmgr->sclk_dpm.soft_min_clk;
 738
 739         /* update minimum clocks for Stable P-State feature */
 740         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
 741                                      PHM_PlatformCaps_StablePState)) {
 742                 percentage = 75;
 743                 /*Sclk - calculate sclk value based on percentage and find FLOOR sclk from VddcDependencyOnSCLK table  */
 744                 stable_pstate_sclk = (hwmgr->dyn_state.max_clock_voltage_on_ac.mclk *
 745                                         percentage) / 100;
 746
 747                 if (clock < stable_pstate_sclk)
 748                         clock = stable_pstate_sclk;
 749         } else {
 750                 if (clock < hwmgr->gfx_arbiter.sclk)
 751                         clock = hwmgr->gfx_arbiter.sclk;
 752         }
 753
 754         if (cz_hwmgr->sclk_dpm.soft_min_clk != clock) {
 755                 cz_hwmgr->sclk_dpm.soft_min_clk = clock;
 756                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 757                                                 PPSMC_MSG_SetSclkSoftMin,
 758                                                 cz_get_sclk_level(hwmgr,
 759                                         cz_hwmgr->sclk_dpm.soft_min_clk,
 760                                              PPSMC_MSG_SetSclkSoftMin));
 761         }
 762
 763         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
 764                                     PHM_PlatformCaps_StablePState) &&
 765                          cz_hwmgr->sclk_dpm.soft_max_clk != clock) {
 766                 cz_hwmgr->sclk_dpm.soft_max_clk = clock;
 767                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 768                                                 PPSMC_MSG_SetSclkSoftMax,
 769                                                 cz_get_sclk_level(hwmgr,
 770                                         cz_hwmgr->sclk_dpm.soft_max_clk,
 771                                         PPSMC_MSG_SetSclkSoftMax));
 772         }
 773
 774         return 0;
 775 }
 776
 777 static int cz_tf_set_deep_sleep_sclk_threshold(struct pp_hwmgr *hwmgr,
 778                                         void *input, void *output,
 779                                         void *storage, int result)
 780 {
 781         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
 782                                 PHM_PlatformCaps_SclkDeepSleep)) {
 783                 uint32_t clks = hwmgr->display_config.min_core_set_clock_in_sr;
 784                 if (clks == 0)
 785                         clks = CZ_MIN_DEEP_SLEEP_SCLK;
 786
 787                 PP_DBG_LOG("Setting Deep Sleep Clock: %d\n", clks);
 788
 789                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 790                                 PPSMC_MSG_SetMinDeepSleepSclk,
 791                                 clks);
 792         }
 793
 794         return 0;
 795 }
 796
 797 static int cz_tf_set_watermark_threshold(struct pp_hwmgr *hwmgr,
 798                                         void *input, void *output,
 799                                         void *storage, int result)
 800 {
 801         struct cz_hwmgr *cz_hwmgr =
 802                                   (struct cz_hwmgr *)(hwmgr->backend);
 803
 804         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 805                                         PPSMC_MSG_SetWatermarkFrequency,
 806                                         cz_hwmgr->sclk_dpm.soft_max_clk);
 807
 808         return 0;
 809 }
 810
 811 static int cz_tf_set_enabled_levels(struct pp_hwmgr *hwmgr,
 812                                         void *input, void *output,
 813                                         void *storage, int result)
 814 {
 815         return 0;
 816 }
 817
 818
 819 static int cz_tf_enable_nb_dpm(struct pp_hwmgr *hwmgr,
 820                                         void *input, void *output,
 821                                         void *storage, int result)
 822 {
 823         int ret = 0;
 824
 825         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 826         unsigned long dpm_features = 0;
 827
 828         if (!cz_hwmgr->is_nb_dpm_enabled) {
 829                 PP_DBG_LOG("enabling ALL SMU features.\n");
 830                 dpm_features |= NB_DPM_MASK;
 831                 ret = smum_send_msg_to_smc_with_parameter(
 832                                                           hwmgr->smumgr,
 833                                                           PPSMC_MSG_EnableAllSmuFeatures,
 834                                                           dpm_features);
 835                 if (ret == 0)
 836                         cz_hwmgr->is_nb_dpm_enabled = true;
 837         }
 838
 839         return ret;
 840 }
 841
 842 static int cz_nbdpm_pstate_enable_disable(struct pp_hwmgr *hwmgr, bool enable, bool lock)
 843 {
 844         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
 845
 846         if (hw_data->is_nb_dpm_enabled) {
 847                 if (enable) {
 848                         PP_DBG_LOG("enable Low Memory PState.\n");
 849
 850                         return smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 851                                                 PPSMC_MSG_EnableLowMemoryPstate,
 852                                                 (lock ? 1 : 0));
 853                 } else {
 854                         PP_DBG_LOG("disable Low Memory PState.\n");
 855
 856                         return smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 857                                                 PPSMC_MSG_DisableLowMemoryPstate,
 858                                                 (lock ? 1 : 0));
 859                 }
 860         }
 861
 862         return 0;
 863 }
 864
 865 static int cz_tf_update_low_mem_pstate(struct pp_hwmgr *hwmgr,
 866                                         void *input, void *output,
 867                                         void *storage, int result)
 868 {
 869         bool disable_switch;
 870         bool enable_low_mem_state;
 871         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
 872         const struct phm_set_power_state_input *states = (struct phm_set_power_state_input *)input;
 873         const struct cz_power_state *pnew_state = cast_const_PhwCzPowerState(states->pnew_state);
 874
 875         if (hw_data->sys_info.nb_dpm_enable) {
 876                 disable_switch = hw_data->cc6_settings.nb_pstate_switch_disable ? true : false;
 877                 enable_low_mem_state = hw_data->cc6_settings.nb_pstate_switch_disable ? false : true;
 878
 879                 if (pnew_state->action == FORCE_HIGH)
 880                         cz_nbdpm_pstate_enable_disable(hwmgr, false, disable_switch);
 881                 else if (pnew_state->action == CANCEL_FORCE_HIGH)
 882                         cz_nbdpm_pstate_enable_disable(hwmgr, true, disable_switch);
 883                 else
 884                         cz_nbdpm_pstate_enable_disable(hwmgr, enable_low_mem_state, disable_switch);
 885         }
 886         return 0;
 887 }
 888
 889 static const struct phm_master_table_item cz_set_power_state_list[] = {
 890         { .tableFunction = cz_tf_update_sclk_limit },
 891         { .tableFunction = cz_tf_set_deep_sleep_sclk_threshold },
 892         { .tableFunction = cz_tf_set_watermark_threshold },
 893         { .tableFunction = cz_tf_set_enabled_levels },
 894         { .tableFunction = cz_tf_enable_nb_dpm },
 895         { .tableFunction = cz_tf_update_low_mem_pstate },
 896         { }
 897 };
 898
 899 static const struct phm_master_table_header cz_set_power_state_master = {
 900         0,
 901         PHM_MasterTableFlag_None,
 902         cz_set_power_state_list
 903 };
 904
 905 static const struct phm_master_table_item cz_setup_asic_list[] = {
 906         { .tableFunction = cz_tf_reset_active_process_mask },
 907         { .tableFunction = cz_tf_upload_pptable_to_smu },
 908         { .tableFunction = cz_tf_init_sclk_limit },
 909         { .tableFunction = cz_tf_init_uvd_limit },
 910         { .tableFunction = cz_tf_init_vce_limit },
 911         { .tableFunction = cz_tf_init_acp_limit },
 912         { .tableFunction = cz_tf_init_power_gate_state },
 913         { .tableFunction = cz_tf_init_sclk_threshold },
 914         { }
 915 };
 916
 917 static const struct phm_master_table_header cz_setup_asic_master = {
 918         0,
 919         PHM_MasterTableFlag_None,
 920         cz_setup_asic_list
 921 };
 922
 923 static int cz_tf_power_up_display_clock_sys_pll(struct pp_hwmgr *hwmgr,
 924                                         void *input, void *output,
 925                                         void *storage, int result)
 926 {
 927         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
 928         hw_data->disp_clk_bypass_pending = false;
 929         hw_data->disp_clk_bypass = false;
 930
 931         return 0;
 932 }
 933
 934 static int cz_tf_clear_nb_dpm_flag(struct pp_hwmgr *hwmgr,
 935                                         void *input, void *output,
 936                                         void *storage, int result)
 937 {
 938         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
 939         hw_data->is_nb_dpm_enabled = false;
 940
 941         return 0;
 942 }
 943
 944 static int cz_tf_reset_cc6_data(struct pp_hwmgr *hwmgr,
 945                                         void *input, void *output,
 946                                         void *storage, int result)
 947 {
 948         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
 949
 950         hw_data->cc6_settings.cc6_setting_changed = false;
 951         hw_data->cc6_settings.cpu_pstate_separation_time = 0;
 952         hw_data->cc6_settings.cpu_cc6_disable = false;
 953         hw_data->cc6_settings.cpu_pstate_disable = false;
 954
 955         return 0;
 956 }
 957
 958 static const struct phm_master_table_item cz_power_down_asic_list[] = {
 959         { .tableFunction = cz_tf_power_up_display_clock_sys_pll },
 960         { .tableFunction = cz_tf_clear_nb_dpm_flag },
 961         { .tableFunction = cz_tf_reset_cc6_data },
 962         { }
 963 };
 964
 965 static const struct phm_master_table_header cz_power_down_asic_master = {
 966         0,
 967         PHM_MasterTableFlag_None,
 968         cz_power_down_asic_list
 969 };
 970
 971 static int cz_tf_program_voting_clients(struct pp_hwmgr *hwmgr, void *input,
 972                                 void *output, void *storage, int result)
 973 {
 974         PHMCZ_WRITE_SMC_REGISTER(hwmgr->device, CG_FREQ_TRAN_VOTING_0,
 975                                 PPCZ_VOTINGRIGHTSCLIENTS_DFLT0);
 976         return 0;
 977 }
 978
 979 static int cz_tf_start_dpm(struct pp_hwmgr *hwmgr, void *input, void *output,
 980                            void *storage, int result)
 981 {
 982         int res = 0xff;
 983         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
 984         unsigned long dpm_features = 0;
 985
 986         cz_hwmgr->dpm_flags |= DPMFlags_SCLK_Enabled;
 987         dpm_features |= SCLK_DPM_MASK;
 988
 989         res = smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
 990                                 PPSMC_MSG_EnableAllSmuFeatures,
 991                                 dpm_features);
 992
 993         return res;
 994 }
 995
 996 static int cz_tf_program_bootup_state(struct pp_hwmgr *hwmgr, void *input,
 997                                 void *output, void *storage, int result)
 998 {
 999         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1000
1001         cz_hwmgr->sclk_dpm.soft_min_clk = cz_hwmgr->sys_info.bootup_engine_clock;
1002         cz_hwmgr->sclk_dpm.soft_max_clk = cz_hwmgr->sys_info.bootup_engine_clock;
1003
1004         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1005                                 PPSMC_MSG_SetSclkSoftMin,
1006                                 cz_get_sclk_level(hwmgr,
1007                                 cz_hwmgr->sclk_dpm.soft_min_clk,
1008                                 PPSMC_MSG_SetSclkSoftMin));
1009
1010         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1011                                 PPSMC_MSG_SetSclkSoftMax,
1012                                 cz_get_sclk_level(hwmgr,
1013                                 cz_hwmgr->sclk_dpm.soft_max_clk,
1014                                 PPSMC_MSG_SetSclkSoftMax));
1015
1016         return 0;
1017 }
1018
1019 static int cz_tf_reset_acp_boot_level(struct pp_hwmgr *hwmgr, void *input,
1020                                 void *output, void *storage, int result)
1021 {
1022         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1023
1024         cz_hwmgr->acp_boot_level = 0xff;
1025         return 0;
1026 }
1027
1028 static bool cz_dpm_check_smu_features(struct pp_hwmgr *hwmgr,
1029                                 unsigned long check_feature)
1030 {
1031         int result;
1032         unsigned long features;
1033
1034         result = smum_send_msg_to_smc_with_parameter(hwmgr->smumgr, PPSMC_MSG_GetFeatureStatus, 0);
1035         if (result == 0) {
1036                 features = smum_get_argument(hwmgr->smumgr);
1037                 if (features & check_feature)
1038                         return true;
1039         }
1040
1041         return result;
1042 }
1043
1044 static int cz_tf_check_for_dpm_disabled(struct pp_hwmgr *hwmgr, void *input,
1045                                 void *output, void *storage, int result)
1046 {
1047         if (cz_dpm_check_smu_features(hwmgr, SMU_EnabledFeatureScoreboard_SclkDpmOn))
1048                 return PP_Result_TableImmediateExit;
1049         return 0;
1050 }
1051
1052 static int cz_tf_enable_didt(struct pp_hwmgr *hwmgr, void *input,
1053                                 void *output, void *storage, int result)
1054 {
1055         /* TO DO */
1056         return 0;
1057 }
1058
1059 static int cz_tf_check_for_dpm_enabled(struct pp_hwmgr *hwmgr,
1060                                                 void *input, void *output,
1061                                                 void *storage, int result)
1062 {
1063         if (!cz_dpm_check_smu_features(hwmgr,
1064                              SMU_EnabledFeatureScoreboard_SclkDpmOn))
1065                 return PP_Result_TableImmediateExit;
1066         return 0;
1067 }
1068
1069 static const struct phm_master_table_item cz_disable_dpm_list[] = {
1070         { .tableFunction = cz_tf_check_for_dpm_enabled },
1071         { },
1072 };
1073
1074
1075 static const struct phm_master_table_header cz_disable_dpm_master = {
1076         0,
1077         PHM_MasterTableFlag_None,
1078         cz_disable_dpm_list
1079 };
1080
1081 static const struct phm_master_table_item cz_enable_dpm_list[] = {
1082         { .tableFunction = cz_tf_check_for_dpm_disabled },
1083         { .tableFunction = cz_tf_program_voting_clients },
1084         { .tableFunction = cz_tf_start_dpm },
1085         { .tableFunction = cz_tf_program_bootup_state },
1086         { .tableFunction = cz_tf_enable_didt },
1087         { .tableFunction = cz_tf_reset_acp_boot_level },
1088         { },
1089 };
1090
1091 static const struct phm_master_table_header cz_enable_dpm_master = {
1092         0,
1093         PHM_MasterTableFlag_None,
1094         cz_enable_dpm_list
1095 };
1096
1097 static int cz_apply_state_adjust_rules(struct pp_hwmgr *hwmgr,
1098                                 struct pp_power_state  *prequest_ps,
1099                         const struct pp_power_state *pcurrent_ps)
1100 {
1101         struct cz_power_state *cz_ps =
1102                                 cast_PhwCzPowerState(&prequest_ps->hardware);
1103
1104         const struct cz_power_state *cz_current_ps =
1105                                 cast_const_PhwCzPowerState(&pcurrent_ps->hardware);
1106
1107         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1108         struct PP_Clocks clocks = {0, 0, 0, 0};
1109         bool force_high;
1110         uint32_t  num_of_active_displays = 0;
1111         struct cgs_display_info info = {0};
1112
1113         cz_ps->evclk = hwmgr->vce_arbiter.evclk;
1114         cz_ps->ecclk = hwmgr->vce_arbiter.ecclk;
1115
1116         cz_ps->need_dfs_bypass = true;
1117
1118         cz_hwmgr->video_start = (hwmgr->uvd_arbiter.vclk != 0 || hwmgr->uvd_arbiter.dclk != 0 ||
1119                                 hwmgr->vce_arbiter.evclk != 0 || hwmgr->vce_arbiter.ecclk != 0);
1120
1121         cz_hwmgr->battery_state = (PP_StateUILabel_Battery == prequest_ps->classification.ui_label);
1122
1123         clocks.memoryClock = hwmgr->display_config.min_mem_set_clock != 0 ?
1124                                 hwmgr->display_config.min_mem_set_clock :
1125                                 cz_hwmgr->sys_info.nbp_memory_clock[1];
1126
1127         cgs_get_active_displays_info(hwmgr->device, &info);
1128         num_of_active_displays = info.display_count;
1129
1130         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps, PHM_PlatformCaps_StablePState))
1131                 clocks.memoryClock = hwmgr->dyn_state.max_clock_voltage_on_ac.mclk;
1132
1133         if (clocks.memoryClock < hwmgr->gfx_arbiter.mclk)
1134                 clocks.memoryClock = hwmgr->gfx_arbiter.mclk;
1135
1136         force_high = (clocks.memoryClock > cz_hwmgr->sys_info.nbp_memory_clock[CZ_NUM_NBPMEMORYCLOCK - 1])
1137                         || (num_of_active_displays >= 3);
1138
1139         cz_ps->action = cz_current_ps->action;
1140
1141         if (!force_high && (cz_ps->action == FORCE_HIGH))
1142                 cz_ps->action = CANCEL_FORCE_HIGH;
1143         else if (force_high && (cz_ps->action != FORCE_HIGH))
1144                 cz_ps->action = FORCE_HIGH;
1145         else
1146                 cz_ps->action = DO_NOTHING;
1147
1148         return 0;
1149 }
1150
1151 static int cz_hwmgr_backend_init(struct pp_hwmgr *hwmgr)
1152 {
1153         int result = 0;
1154         struct cz_hwmgr *data;
1155
1156         data = kzalloc(sizeof(struct cz_hwmgr), GFP_KERNEL);
1157         if (data == NULL)
1158                 return -ENOMEM;
1159
1160         hwmgr->backend = data;
1161
1162         result = cz_initialize_dpm_defaults(hwmgr);
1163         if (result != 0) {
1164                 pr_err("cz_initialize_dpm_defaults failed\n");
1165                 return result;
1166         }
1167
1168         result = cz_get_system_info_data(hwmgr);
1169         if (result != 0) {
1170                 pr_err("cz_get_system_info_data failed\n");
1171                 return result;
1172         }
1173
1174         cz_construct_boot_state(hwmgr);
1175
1176         result = phm_construct_table(hwmgr, &cz_setup_asic_master,
1177                                 &(hwmgr->setup_asic));
1178         if (result != 0) {
1179                 pr_err("Fail to construct setup ASIC\n");
1180                 return result;
1181         }
1182
1183         result = phm_construct_table(hwmgr, &cz_power_down_asic_master,
1184                                 &(hwmgr->power_down_asic));
1185         if (result != 0) {
1186                 pr_err("Fail to construct power down ASIC\n");
1187                 return result;
1188         }
1189
1190         result = phm_construct_table(hwmgr, &cz_disable_dpm_master,
1191                                 &(hwmgr->disable_dynamic_state_management));
1192         if (result != 0) {
1193                 pr_err("Fail to disable_dynamic_state\n");
1194                 return result;
1195         }
1196         result = phm_construct_table(hwmgr, &cz_enable_dpm_master,
1197                                 &(hwmgr->enable_dynamic_state_management));
1198         if (result != 0) {
1199                 pr_err("Fail to enable_dynamic_state\n");
1200                 return result;
1201         }
1202         result = phm_construct_table(hwmgr, &cz_set_power_state_master,
1203                                 &(hwmgr->set_power_state));
1204         if (result != 0) {
1205                 pr_err("Fail to construct set_power_state\n");
1206                 return result;
1207         }
1208         hwmgr->platform_descriptor.hardwareActivityPerformanceLevels =  CZ_MAX_HARDWARE_POWERLEVELS;
1209
1210         result = phm_construct_table(hwmgr, &cz_phm_enable_clock_power_gatings_master, &(hwmgr->enable_clock_power_gatings));
1211         if (result != 0) {
1212                 pr_err("Fail to construct enable_clock_power_gatings\n");
1213                 return result;
1214         }
1215         return result;
1216 }
1217
1218 static int cz_hwmgr_backend_fini(struct pp_hwmgr *hwmgr)
1219 {
1220         if (hwmgr != NULL) {
1221                 phm_destroy_table(hwmgr, &(hwmgr->enable_clock_power_gatings));
1222                 phm_destroy_table(hwmgr, &(hwmgr->set_power_state));
1223                 phm_destroy_table(hwmgr, &(hwmgr->enable_dynamic_state_management));
1224                 phm_destroy_table(hwmgr, &(hwmgr->disable_dynamic_state_management));
1225                 phm_destroy_table(hwmgr, &(hwmgr->power_down_asic));
1226                 phm_destroy_table(hwmgr, &(hwmgr->setup_asic));
1227                 kfree(hwmgr->backend);
1228                 hwmgr->backend = NULL;
1229         }
1230         return 0;
1231 }
1232
1233 static int cz_phm_force_dpm_highest(struct pp_hwmgr *hwmgr)
1234 {
1235         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1236
1237         if (cz_hwmgr->sclk_dpm.soft_min_clk !=
1238                                 cz_hwmgr->sclk_dpm.soft_max_clk)
1239                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1240                                                 PPSMC_MSG_SetSclkSoftMin,
1241                                                 cz_get_sclk_level(hwmgr,
1242                                                 cz_hwmgr->sclk_dpm.soft_max_clk,
1243                                                 PPSMC_MSG_SetSclkSoftMin));
1244         return 0;
1245 }
1246
1247 static int cz_phm_unforce_dpm_levels(struct pp_hwmgr *hwmgr)
1248 {
1249         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1250         struct phm_clock_voltage_dependency_table *table =
1251                                 hwmgr->dyn_state.vddc_dependency_on_sclk;
1252         unsigned long clock = 0, level;
1253
1254         if (NULL == table || table->count <= 0)
1255                 return -EINVAL;
1256
1257         cz_hwmgr->sclk_dpm.soft_min_clk = table->entries[0].clk;
1258         cz_hwmgr->sclk_dpm.hard_min_clk = table->entries[0].clk;
1259
1260         level = cz_get_max_sclk_level(hwmgr) - 1;
1261
1262         if (level < table->count)
1263                 clock = table->entries[level].clk;
1264         else
1265                 clock = table->entries[table->count - 1].clk;
1266
1267         cz_hwmgr->sclk_dpm.soft_max_clk = clock;
1268         cz_hwmgr->sclk_dpm.hard_max_clk = clock;
1269
1270         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1271                                 PPSMC_MSG_SetSclkSoftMin,
1272                                 cz_get_sclk_level(hwmgr,
1273                                 cz_hwmgr->sclk_dpm.soft_min_clk,
1274                                 PPSMC_MSG_SetSclkSoftMin));
1275
1276         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1277                                 PPSMC_MSG_SetSclkSoftMax,
1278                                 cz_get_sclk_level(hwmgr,
1279                                 cz_hwmgr->sclk_dpm.soft_max_clk,
1280                                 PPSMC_MSG_SetSclkSoftMax));
1281
1282         return 0;
1283 }
1284
1285 static int cz_phm_force_dpm_lowest(struct pp_hwmgr *hwmgr)
1286 {
1287         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1288
1289         if (cz_hwmgr->sclk_dpm.soft_min_clk !=
1290                                 cz_hwmgr->sclk_dpm.soft_max_clk) {
1291                 cz_hwmgr->sclk_dpm.soft_max_clk =
1292                         cz_hwmgr->sclk_dpm.soft_min_clk;
1293
1294                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1295                                 PPSMC_MSG_SetSclkSoftMax,
1296                                 cz_get_sclk_level(hwmgr,
1297                                 cz_hwmgr->sclk_dpm.soft_max_clk,
1298                                 PPSMC_MSG_SetSclkSoftMax));
1299         }
1300
1301         return 0;
1302 }
1303
1304 static int cz_dpm_force_dpm_level(struct pp_hwmgr *hwmgr,
1305                                 enum amd_dpm_forced_level level)
1306 {
1307         int ret = 0;
1308
1309         switch (level) {
1310         case AMD_DPM_FORCED_LEVEL_HIGH:
1311                 ret = cz_phm_force_dpm_highest(hwmgr);
1312                 if (ret)
1313                         return ret;
1314                 break;
1315         case AMD_DPM_FORCED_LEVEL_LOW:
1316                 ret = cz_phm_force_dpm_lowest(hwmgr);
1317                 if (ret)
1318                         return ret;
1319                 break;
1320         case AMD_DPM_FORCED_LEVEL_AUTO:
1321                 ret = cz_phm_unforce_dpm_levels(hwmgr);
1322                 if (ret)
1323                         return ret;
1324                 break;
1325         default:
1326                 break;
1327         }
1328
1329         hwmgr->dpm_level = level;
1330
1331         return ret;
1332 }
1333
1334 int cz_dpm_powerdown_uvd(struct pp_hwmgr *hwmgr)
1335 {
1336         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1337                                          PHM_PlatformCaps_UVDPowerGating))
1338                 return smum_send_msg_to_smc(hwmgr->smumgr,
1339                                                      PPSMC_MSG_UVDPowerOFF);
1340         return 0;
1341 }
1342
1343 int cz_dpm_powerup_uvd(struct pp_hwmgr *hwmgr)
1344 {
1345         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1346                                          PHM_PlatformCaps_UVDPowerGating)) {
1347                 if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1348                                   PHM_PlatformCaps_UVDDynamicPowerGating)) {
1349                         return smum_send_msg_to_smc_with_parameter(
1350                                                                 hwmgr->smumgr,
1351                                                    PPSMC_MSG_UVDPowerON, 1);
1352                 } else {
1353                         return smum_send_msg_to_smc_with_parameter(
1354                                                                 hwmgr->smumgr,
1355                                                    PPSMC_MSG_UVDPowerON, 0);
1356                 }
1357         }
1358
1359         return 0;
1360 }
1361
1362 int cz_dpm_update_uvd_dpm(struct pp_hwmgr *hwmgr, bool bgate)
1363 {
1364         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1365         struct phm_uvd_clock_voltage_dependency_table *ptable =
1366                 hwmgr->dyn_state.uvd_clock_voltage_dependency_table;
1367
1368         if (!bgate) {
1369                 /* Stable Pstate is enabled and we need to set the UVD DPM to highest level */
1370                 if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1371                                          PHM_PlatformCaps_StablePState)) {
1372                         cz_hwmgr->uvd_dpm.hard_min_clk =
1373                                    ptable->entries[ptable->count - 1].vclk;
1374
1375                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1376                                                      PPSMC_MSG_SetUvdHardMin,
1377                                                       cz_get_uvd_level(hwmgr,
1378                                              cz_hwmgr->uvd_dpm.hard_min_clk,
1379                                                    PPSMC_MSG_SetUvdHardMin));
1380
1381                         cz_enable_disable_uvd_dpm(hwmgr, true);
1382                 } else {
1383                         cz_enable_disable_uvd_dpm(hwmgr, true);
1384                 }
1385         } else {
1386                 cz_enable_disable_uvd_dpm(hwmgr, false);
1387         }
1388
1389         return 0;
1390 }
1391
1392 int  cz_dpm_update_vce_dpm(struct pp_hwmgr *hwmgr)
1393 {
1394         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1395         struct phm_vce_clock_voltage_dependency_table *ptable =
1396                 hwmgr->dyn_state.vce_clock_voltage_dependency_table;
1397
1398         /* Stable Pstate is enabled and we need to set the VCE DPM to highest level */
1399         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1400                                          PHM_PlatformCaps_StablePState)) {
1401                 cz_hwmgr->vce_dpm.hard_min_clk =
1402                                   ptable->entries[ptable->count - 1].ecclk;
1403
1404                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1405                                         PPSMC_MSG_SetEclkHardMin,
1406                                         cz_get_eclk_level(hwmgr,
1407                                              cz_hwmgr->vce_dpm.hard_min_clk,
1408                                                 PPSMC_MSG_SetEclkHardMin));
1409         } else {
1410                 /*Program HardMin based on the vce_arbiter.ecclk */
1411                 if (hwmgr->vce_arbiter.ecclk == 0) {
1412                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1413                                             PPSMC_MSG_SetEclkHardMin, 0);
1414                 /* disable ECLK DPM 0. Otherwise VCE could hang if
1415                  * switching SCLK from DPM 0 to 6/7 */
1416                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1417                                         PPSMC_MSG_SetEclkSoftMin, 1);
1418                 } else {
1419                         cz_hwmgr->vce_dpm.hard_min_clk = hwmgr->vce_arbiter.ecclk;
1420                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1421                                                 PPSMC_MSG_SetEclkHardMin,
1422                                                 cz_get_eclk_level(hwmgr,
1423                                                 cz_hwmgr->vce_dpm.hard_min_clk,
1424                                                 PPSMC_MSG_SetEclkHardMin));
1425                 }
1426         }
1427         return 0;
1428 }
1429
1430 int cz_dpm_powerdown_vce(struct pp_hwmgr *hwmgr)
1431 {
1432         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1433                                          PHM_PlatformCaps_VCEPowerGating))
1434                 return smum_send_msg_to_smc(hwmgr->smumgr,
1435                                                      PPSMC_MSG_VCEPowerOFF);
1436         return 0;
1437 }
1438
1439 int cz_dpm_powerup_vce(struct pp_hwmgr *hwmgr)
1440 {
1441         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1442                                          PHM_PlatformCaps_VCEPowerGating))
1443                 return smum_send_msg_to_smc(hwmgr->smumgr,
1444                                                      PPSMC_MSG_VCEPowerON);
1445         return 0;
1446 }
1447
1448 static int cz_dpm_get_mclk(struct pp_hwmgr *hwmgr, bool low)
1449 {
1450         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1451
1452         return cz_hwmgr->sys_info.bootup_uma_clock;
1453 }
1454
1455 static int cz_dpm_get_sclk(struct pp_hwmgr *hwmgr, bool low)
1456 {
1457         struct pp_power_state  *ps;
1458         struct cz_power_state  *cz_ps;
1459
1460         if (hwmgr == NULL)
1461                 return -EINVAL;
1462
1463         ps = hwmgr->request_ps;
1464
1465         if (ps == NULL)
1466                 return -EINVAL;
1467
1468         cz_ps = cast_PhwCzPowerState(&ps->hardware);
1469
1470         if (low)
1471                 return cz_ps->levels[0].engineClock;
1472         else
1473                 return cz_ps->levels[cz_ps->level-1].engineClock;
1474 }
1475
1476 static int cz_dpm_patch_boot_state(struct pp_hwmgr *hwmgr,
1477                                         struct pp_hw_power_state *hw_ps)
1478 {
1479         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1480         struct cz_power_state *cz_ps = cast_PhwCzPowerState(hw_ps);
1481
1482         cz_ps->level = 1;
1483         cz_ps->nbps_flags = 0;
1484         cz_ps->bapm_flags = 0;
1485         cz_ps->levels[0] = cz_hwmgr->boot_power_level;
1486
1487         return 0;
1488 }
1489
1490 static int cz_dpm_get_pp_table_entry_callback(
1491                                                      struct pp_hwmgr *hwmgr,
1492                                            struct pp_hw_power_state *hw_ps,
1493                                                           unsigned int index,
1494                                                      const void *clock_info)
1495 {
1496         struct cz_power_state *cz_ps = cast_PhwCzPowerState(hw_ps);
1497
1498         const ATOM_PPLIB_CZ_CLOCK_INFO *cz_clock_info = clock_info;
1499
1500         struct phm_clock_voltage_dependency_table *table =
1501                                     hwmgr->dyn_state.vddc_dependency_on_sclk;
1502         uint8_t clock_info_index = cz_clock_info->index;
1503
1504         if (clock_info_index > (uint8_t)(hwmgr->platform_descriptor.hardwareActivityPerformanceLevels - 1))
1505                 clock_info_index = (uint8_t)(hwmgr->platform_descriptor.hardwareActivityPerformanceLevels - 1);
1506
1507         cz_ps->levels[index].engineClock = table->entries[clock_info_index].clk;
1508         cz_ps->levels[index].vddcIndex = (uint8_t)table->entries[clock_info_index].v;
1509
1510         cz_ps->level = index + 1;
1511
1512         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps, PHM_PlatformCaps_SclkDeepSleep)) {
1513                 cz_ps->levels[index].dsDividerIndex = 5;
1514                 cz_ps->levels[index].ssDividerIndex = 5;
1515         }
1516
1517         return 0;
1518 }
1519
1520 static int cz_dpm_get_num_of_pp_table_entries(struct pp_hwmgr *hwmgr)
1521 {
1522         int result;
1523         unsigned long ret = 0;
1524
1525         result = pp_tables_get_num_of_entries(hwmgr, &ret);
1526
1527         return result ? 0 : ret;
1528 }
1529
1530 static int cz_dpm_get_pp_table_entry(struct pp_hwmgr *hwmgr,
1531                     unsigned long entry, struct pp_power_state *ps)
1532 {
1533         int result;
1534         struct cz_power_state *cz_ps;
1535
1536         ps->hardware.magic = PhwCz_Magic;
1537
1538         cz_ps = cast_PhwCzPowerState(&(ps->hardware));
1539
1540         result = pp_tables_get_entry(hwmgr, entry, ps,
1541                         cz_dpm_get_pp_table_entry_callback);
1542
1543         cz_ps->uvd_clocks.vclk = ps->uvd_clocks.VCLK;
1544         cz_ps->uvd_clocks.dclk = ps->uvd_clocks.DCLK;
1545
1546         return result;
1547 }
1548
1549 static int cz_get_power_state_size(struct pp_hwmgr *hwmgr)
1550 {
1551         return sizeof(struct cz_power_state);
1552 }
1553
1554 static void cz_hw_print_display_cfg(
1555         const struct cc6_settings *cc6_settings)
1556 {
1557         PP_DBG_LOG("New Display Configuration:\n");
1558
1559         PP_DBG_LOG("   cpu_cc6_disable: %d\n",
1560                         cc6_settings->cpu_cc6_disable);
1561         PP_DBG_LOG("   cpu_pstate_disable: %d\n",
1562                         cc6_settings->cpu_pstate_disable);
1563         PP_DBG_LOG("   nb_pstate_switch_disable: %d\n",
1564                         cc6_settings->nb_pstate_switch_disable);
1565         PP_DBG_LOG("   cpu_pstate_separation_time: %d\n\n",
1566                         cc6_settings->cpu_pstate_separation_time);
1567 }
1568
1569  static int cz_set_cpu_power_state(struct pp_hwmgr *hwmgr)
1570 {
1571         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
1572         uint32_t data = 0;
1573
1574         if (hw_data->cc6_settings.cc6_setting_changed) {
1575
1576                 hw_data->cc6_settings.cc6_setting_changed = false;
1577
1578                 cz_hw_print_display_cfg(&hw_data->cc6_settings);
1579
1580                 data |= (hw_data->cc6_settings.cpu_pstate_separation_time
1581                         & PWRMGT_SEPARATION_TIME_MASK)
1582                         << PWRMGT_SEPARATION_TIME_SHIFT;
1583
1584                 data |= (hw_data->cc6_settings.cpu_cc6_disable ? 0x1 : 0x0)
1585                         << PWRMGT_DISABLE_CPU_CSTATES_SHIFT;
1586
1587                 data |= (hw_data->cc6_settings.cpu_pstate_disable ? 0x1 : 0x0)
1588                         << PWRMGT_DISABLE_CPU_PSTATES_SHIFT;
1589
1590                 PP_DBG_LOG("SetDisplaySizePowerParams data: 0x%X\n",
1591                         data);
1592
1593                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1594                                                 PPSMC_MSG_SetDisplaySizePowerParams,
1595                                                 data);
1596         }
1597
1598         return 0;
1599 }
1600
1601
1602 static int cz_store_cc6_data(struct pp_hwmgr *hwmgr, uint32_t separation_time,
1603                         bool cc6_disable, bool pstate_disable, bool pstate_switch_disable)
1604 {
1605         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
1606
1607         if (separation_time !=
1608             hw_data->cc6_settings.cpu_pstate_separation_time ||
1609             cc6_disable != hw_data->cc6_settings.cpu_cc6_disable ||
1610             pstate_disable != hw_data->cc6_settings.cpu_pstate_disable ||
1611             pstate_switch_disable != hw_data->cc6_settings.nb_pstate_switch_disable) {
1612
1613                 hw_data->cc6_settings.cc6_setting_changed = true;
1614
1615                 hw_data->cc6_settings.cpu_pstate_separation_time =
1616                         separation_time;
1617                 hw_data->cc6_settings.cpu_cc6_disable =
1618                         cc6_disable;
1619                 hw_data->cc6_settings.cpu_pstate_disable =
1620                         pstate_disable;
1621                 hw_data->cc6_settings.nb_pstate_switch_disable =
1622                         pstate_switch_disable;
1623
1624         }
1625
1626         return 0;
1627 }
1628
1629 static int cz_get_dal_power_level(struct pp_hwmgr *hwmgr,
1630                 struct amd_pp_simple_clock_info *info)
1631 {
1632         uint32_t i;
1633         const struct phm_clock_voltage_dependency_table *table =
1634                         hwmgr->dyn_state.vddc_dep_on_dal_pwrl;
1635         const struct phm_clock_and_voltage_limits *limits =
1636                         &hwmgr->dyn_state.max_clock_voltage_on_ac;
1637
1638         info->engine_max_clock = limits->sclk;
1639         info->memory_max_clock = limits->mclk;
1640
1641         for (i = table->count - 1; i > 0; i--) {
1642                 if (limits->vddc >= table->entries[i].v) {
1643                         info->level = table->entries[i].clk;
1644                         return 0;
1645                 }
1646         }
1647         return -EINVAL;
1648 }
1649
1650 static int cz_force_clock_level(struct pp_hwmgr *hwmgr,
1651                 enum pp_clock_type type, uint32_t mask)
1652 {
1653         if (hwmgr->dpm_level != AMD_DPM_FORCED_LEVEL_MANUAL)
1654                 return -EINVAL;
1655
1656         switch (type) {
1657         case PP_SCLK:
1658                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1659                                 PPSMC_MSG_SetSclkSoftMin,
1660                                 mask);
1661                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1662                                 PPSMC_MSG_SetSclkSoftMax,
1663                                 mask);
1664                 break;
1665         default:
1666                 break;
1667         }
1668
1669         return 0;
1670 }
1671
1672 static int cz_print_clock_levels(struct pp_hwmgr *hwmgr,
1673                 enum pp_clock_type type, char *buf)
1674 {
1675         struct phm_clock_voltage_dependency_table *sclk_table =
1676                         hwmgr->dyn_state.vddc_dependency_on_sclk;
1677         int i, now, size = 0;
1678
1679         switch (type) {
1680         case PP_SCLK:
1681                 now = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device,
1682                                 CGS_IND_REG__SMC,
1683                                 ixTARGET_AND_CURRENT_PROFILE_INDEX),
1684                                 TARGET_AND_CURRENT_PROFILE_INDEX,
1685                                 CURR_SCLK_INDEX);
1686
1687                 for (i = 0; i < sclk_table->count; i++)
1688                         size += sprintf(buf + size, "%d: %uMhz %s\n",
1689                                         i, sclk_table->entries[i].clk / 100,
1690                                         (i == now) ? "*" : "");
1691                 break;
1692         default:
1693                 break;
1694         }
1695         return size;
1696 }
1697
1698 static int cz_get_performance_level(struct pp_hwmgr *hwmgr, const struct pp_hw_power_state *state,
1699                                 PHM_PerformanceLevelDesignation designation, uint32_t index,
1700                                 PHM_PerformanceLevel *level)
1701 {
1702         const struct cz_power_state *ps;
1703         struct cz_hwmgr *data;
1704         uint32_t level_index;
1705         uint32_t i;
1706
1707         if (level == NULL || hwmgr == NULL || state == NULL)
1708                 return -EINVAL;
1709
1710         data = (struct cz_hwmgr *)(hwmgr->backend);
1711         ps = cast_const_PhwCzPowerState(state);
1712
1713         level_index = index > ps->level - 1 ? ps->level - 1 : index;
1714         level->coreClock = ps->levels[level_index].engineClock;
1715
1716         if (designation == PHM_PerformanceLevelDesignation_PowerContainment) {
1717                 for (i = 1; i < ps->level; i++) {
1718                         if (ps->levels[i].engineClock > data->dce_slow_sclk_threshold) {
1719                                 level->coreClock = ps->levels[i].engineClock;
1720                                 break;
1721                         }
1722                 }
1723         }
1724
1725         if (level_index == 0)
1726                 level->memory_clock = data->sys_info.nbp_memory_clock[CZ_NUM_NBPMEMORYCLOCK - 1];
1727         else
1728                 level->memory_clock = data->sys_info.nbp_memory_clock[0];
1729
1730         level->vddc = (cz_convert_8Bit_index_to_voltage(hwmgr, ps->levels[level_index].vddcIndex) + 2) / 4;
1731         level->nonLocalMemoryFreq = 0;
1732         level->nonLocalMemoryWidth = 0;
1733
1734         return 0;
1735 }
1736
1737 static int cz_get_current_shallow_sleep_clocks(struct pp_hwmgr *hwmgr,
1738         const struct pp_hw_power_state *state, struct pp_clock_info *clock_info)
1739 {
1740         const struct cz_power_state *ps = cast_const_PhwCzPowerState(state);
1741
1742         clock_info->min_eng_clk = ps->levels[0].engineClock / (1 << (ps->levels[0].ssDividerIndex));
1743         clock_info->max_eng_clk = ps->levels[ps->level - 1].engineClock / (1 << (ps->levels[ps->level - 1].ssDividerIndex));
1744
1745         return 0;
1746 }
1747
1748 static int cz_get_clock_by_type(struct pp_hwmgr *hwmgr, enum amd_pp_clock_type type,
1749                                                 struct amd_pp_clocks *clocks)
1750 {
1751         struct cz_hwmgr *data = (struct cz_hwmgr *)(hwmgr->backend);
1752         int i;
1753         struct phm_clock_voltage_dependency_table *table;
1754
1755         clocks->count = cz_get_max_sclk_level(hwmgr);
1756         switch (type) {
1757         case amd_pp_disp_clock:
1758                 for (i = 0; i < clocks->count; i++)
1759                         clocks->clock[i] = data->sys_info.display_clock[i];
1760                 break;
1761         case amd_pp_sys_clock:
1762                 table = hwmgr->dyn_state.vddc_dependency_on_sclk;
1763                 for (i = 0; i < clocks->count; i++)
1764                         clocks->clock[i] = table->entries[i].clk;
1765                 break;
1766         case amd_pp_mem_clock:
1767                 clocks->count = CZ_NUM_NBPMEMORYCLOCK;
1768                 for (i = 0; i < clocks->count; i++)
1769                         clocks->clock[i] = data->sys_info.nbp_memory_clock[clocks->count - 1 - i];
1770                 break;
1771         default:
1772                 return -1;
1773         }
1774
1775         return 0;
1776 }
1777
1778 static int cz_get_max_high_clocks(struct pp_hwmgr *hwmgr, struct amd_pp_simple_clock_info *clocks)
1779 {
1780         struct phm_clock_voltage_dependency_table *table =
1781                                         hwmgr->dyn_state.vddc_dependency_on_sclk;
1782         unsigned long level;
1783         const struct phm_clock_and_voltage_limits *limits =
1784                         &hwmgr->dyn_state.max_clock_voltage_on_ac;
1785
1786         if ((NULL == table) || (table->count <= 0) || (clocks == NULL))
1787                 return -EINVAL;
1788
1789         level = cz_get_max_sclk_level(hwmgr) - 1;
1790
1791         if (level < table->count)
1792                 clocks->engine_max_clock = table->entries[level].clk;
1793         else
1794                 clocks->engine_max_clock = table->entries[table->count - 1].clk;
1795
1796         clocks->memory_max_clock = limits->mclk;
1797
1798         return 0;
1799 }
1800
1801 static int cz_thermal_get_temperature(struct pp_hwmgr *hwmgr)
1802 {
1803         int actual_temp = 0;
1804         uint32_t val = cgs_read_ind_register(hwmgr->device,
1805                                              CGS_IND_REG__SMC, ixTHM_TCON_CUR_TMP);
1806         uint32_t temp = PHM_GET_FIELD(val, THM_TCON_CUR_TMP, CUR_TEMP);
1807
1808         if (PHM_GET_FIELD(val, THM_TCON_CUR_TMP, CUR_TEMP_RANGE_SEL))
1809                 actual_temp = ((temp / 8) - 49) * PP_TEMPERATURE_UNITS_PER_CENTIGRADES;
1810         else
1811                 actual_temp = (temp / 8) * PP_TEMPERATURE_UNITS_PER_CENTIGRADES;
1812
1813         return actual_temp;
1814 }
1815
1816 static int cz_read_sensor(struct pp_hwmgr *hwmgr, int idx,
1817                           void *value, int *size)
1818 {
1819         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1820
1821         struct phm_clock_voltage_dependency_table *table =
1822                                 hwmgr->dyn_state.vddc_dependency_on_sclk;
1823
1824         struct phm_vce_clock_voltage_dependency_table *vce_table =
1825                 hwmgr->dyn_state.vce_clock_voltage_dependency_table;
1826
1827         struct phm_uvd_clock_voltage_dependency_table *uvd_table =
1828                 hwmgr->dyn_state.uvd_clock_voltage_dependency_table;
1829
1830         uint32_t sclk_index = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixTARGET_AND_CURRENT_PROFILE_INDEX),
1831                                         TARGET_AND_CURRENT_PROFILE_INDEX, CURR_SCLK_INDEX);
1832         uint32_t uvd_index = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixTARGET_AND_CURRENT_PROFILE_INDEX_2),
1833                                         TARGET_AND_CURRENT_PROFILE_INDEX_2, CURR_UVD_INDEX);
1834         uint32_t vce_index = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixTARGET_AND_CURRENT_PROFILE_INDEX_2),
1835                                         TARGET_AND_CURRENT_PROFILE_INDEX_2, CURR_VCE_INDEX);
1836
1837         uint32_t sclk, vclk, dclk, ecclk, tmp, activity_percent;
1838         uint16_t vddnb, vddgfx;
1839         int result;
1840
1841         /* size must be at least 4 bytes for all sensors */
1842         if (*size < 4)
1843                 return -EINVAL;
1844         *size = 4;
1845
1846         switch (idx) {
1847         case AMDGPU_PP_SENSOR_GFX_SCLK:
1848                 if (sclk_index < NUM_SCLK_LEVELS) {
1849                         sclk = table->entries[sclk_index].clk;
1850                         *((uint32_t *)value) = sclk;
1851                         return 0;
1852                 }
1853                 return -EINVAL;
1854         case AMDGPU_PP_SENSOR_VDDNB:
1855                 tmp = (cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixSMUSVI_NB_CURRENTVID) &
1856                         CURRENT_NB_VID_MASK) >> CURRENT_NB_VID__SHIFT;
1857                 vddnb = cz_convert_8Bit_index_to_voltage(hwmgr, tmp);
1858                 *((uint32_t *)value) = vddnb;
1859                 return 0;
1860         case AMDGPU_PP_SENSOR_VDDGFX:
1861                 tmp = (cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixSMUSVI_GFX_CURRENTVID) &
1862                         CURRENT_GFX_VID_MASK) >> CURRENT_GFX_VID__SHIFT;
1863                 vddgfx = cz_convert_8Bit_index_to_voltage(hwmgr, (u16)tmp);
1864                 *((uint32_t *)value) = vddgfx;
1865                 return 0;
1866         case AMDGPU_PP_SENSOR_UVD_VCLK:
1867                 if (!cz_hwmgr->uvd_power_gated) {
1868                         if (uvd_index >= CZ_MAX_HARDWARE_POWERLEVELS) {
1869                                 return -EINVAL;
1870                         } else {
1871                                 vclk = uvd_table->entries[uvd_index].vclk;
1872                                 *((uint32_t *)value) = vclk;
1873                                 return 0;
1874                         }
1875                 }
1876                 *((uint32_t *)value) = 0;
1877                 return 0;
1878         case AMDGPU_PP_SENSOR_UVD_DCLK:
1879                 if (!cz_hwmgr->uvd_power_gated) {
1880                         if (uvd_index >= CZ_MAX_HARDWARE_POWERLEVELS) {
1881                                 return -EINVAL;
1882                         } else {
1883                                 dclk = uvd_table->entries[uvd_index].dclk;
1884                                 *((uint32_t *)value) = dclk;
1885                                 return 0;
1886                         }
1887                 }
1888                 *((uint32_t *)value) = 0;
1889                 return 0;
1890         case AMDGPU_PP_SENSOR_VCE_ECCLK:
1891                 if (!cz_hwmgr->vce_power_gated) {
1892                         if (vce_index >= CZ_MAX_HARDWARE_POWERLEVELS) {
1893                                 return -EINVAL;
1894                         } else {
1895                                 ecclk = vce_table->entries[vce_index].ecclk;
1896                                 *((uint32_t *)value) = ecclk;
1897                                 return 0;
1898                         }
1899                 }
1900                 *((uint32_t *)value) = 0;
1901                 return 0;
1902         case AMDGPU_PP_SENSOR_GPU_LOAD:
1903                 result = smum_send_msg_to_smc(hwmgr->smumgr, PPSMC_MSG_GetAverageGraphicsActivity);
1904                 if (0 == result) {
1905                         activity_percent = cgs_read_register(hwmgr->device, mmSMU_MP1_SRBM2P_ARG_0);
1906                         activity_percent = activity_percent > 100 ? 100 : activity_percent;
1907                 } else {
1908                         activity_percent = 50;
1909                 }
1910                 *((uint32_t *)value) = activity_percent;
1911                 return 0;
1912         case AMDGPU_PP_SENSOR_UVD_POWER:
1913                 *((uint32_t *)value) = cz_hwmgr->uvd_power_gated ? 0 : 1;
1914                 return 0;
1915         case AMDGPU_PP_SENSOR_VCE_POWER:
1916                 *((uint32_t *)value) = cz_hwmgr->vce_power_gated ? 0 : 1;
1917                 return 0;
1918         case AMDGPU_PP_SENSOR_GPU_TEMP:
1919                 *((uint32_t *)value) = cz_thermal_get_temperature(hwmgr);
1920                 return 0;
1921         default:
1922                 return -EINVAL;
1923         }
1924 }
1925
1926 static const struct pp_hwmgr_func cz_hwmgr_funcs = {
1927         .backend_init = cz_hwmgr_backend_init,
1928         .backend_fini = cz_hwmgr_backend_fini,
1929         .asic_setup = NULL,
1930         .apply_state_adjust_rules = cz_apply_state_adjust_rules,
1931         .force_dpm_level = cz_dpm_force_dpm_level,
1932         .get_power_state_size = cz_get_power_state_size,
1933         .powerdown_uvd = cz_dpm_powerdown_uvd,
1934         .powergate_uvd = cz_dpm_powergate_uvd,
1935         .powergate_vce = cz_dpm_powergate_vce,
1936         .get_mclk = cz_dpm_get_mclk,
1937         .get_sclk = cz_dpm_get_sclk,
1938         .patch_boot_state = cz_dpm_patch_boot_state,
1939         .get_pp_table_entry = cz_dpm_get_pp_table_entry,
1940         .get_num_of_pp_table_entries = cz_dpm_get_num_of_pp_table_entries,
1941         .set_cpu_power_state = cz_set_cpu_power_state,
1942         .store_cc6_data = cz_store_cc6_data,
1943         .force_clock_level = cz_force_clock_level,
1944         .print_clock_levels = cz_print_clock_levels,
1945         .get_dal_power_level = cz_get_dal_power_level,
1946         .get_performance_level = cz_get_performance_level,
1947         .get_current_shallow_sleep_clocks = cz_get_current_shallow_sleep_clocks,
1948         .get_clock_by_type = cz_get_clock_by_type,
1949         .get_max_high_clocks = cz_get_max_high_clocks,
1950         .read_sensor = cz_read_sensor,
1951 };
1952
1953 int cz_init_function_pointers(struct pp_hwmgr *hwmgr)
1954 {
1955         hwmgr->hwmgr_func = &cz_hwmgr_funcs;
1956         hwmgr->pptable_func = &pptable_funcs;
1957         return 0;
1958 }