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                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] Unsupported IGP table: %d %d\n", frev, crev);
 332                 return -EINVAL;
 333         }
 334
 335         if (info == NULL) {
 336                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_INFO "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] cz_initialize_dpm_defaults failed\n");
1165                 return result;
1166         }
1167
1168         result = cz_get_system_info_data(hwmgr);
1169         if (result != 0) {
1170                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] 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                 printk(KERN_ERR "[ powerplay ] 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 && hwmgr->backend != NULL) {
1221                 kfree(hwmgr->backend);
1222                 kfree(hwmgr);
1223         }
1224         return 0;
1225 }
1226
1227 static int cz_phm_force_dpm_highest(struct pp_hwmgr *hwmgr)
1228 {
1229         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1230
1231         if (cz_hwmgr->sclk_dpm.soft_min_clk !=
1232                                 cz_hwmgr->sclk_dpm.soft_max_clk)
1233                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1234                                                 PPSMC_MSG_SetSclkSoftMin,
1235                                                 cz_get_sclk_level(hwmgr,
1236                                                 cz_hwmgr->sclk_dpm.soft_max_clk,
1237                                                 PPSMC_MSG_SetSclkSoftMin));
1238         return 0;
1239 }
1240
1241 static int cz_phm_unforce_dpm_levels(struct pp_hwmgr *hwmgr)
1242 {
1243         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1244         struct phm_clock_voltage_dependency_table *table =
1245                                 hwmgr->dyn_state.vddc_dependency_on_sclk;
1246         unsigned long clock = 0, level;
1247
1248         if (NULL == table || table->count <= 0)
1249                 return -EINVAL;
1250
1251         cz_hwmgr->sclk_dpm.soft_min_clk = table->entries[0].clk;
1252         cz_hwmgr->sclk_dpm.hard_min_clk = table->entries[0].clk;
1253
1254         level = cz_get_max_sclk_level(hwmgr) - 1;
1255
1256         if (level < table->count)
1257                 clock = table->entries[level].clk;
1258         else
1259                 clock = table->entries[table->count - 1].clk;
1260
1261         cz_hwmgr->sclk_dpm.soft_max_clk = clock;
1262         cz_hwmgr->sclk_dpm.hard_max_clk = clock;
1263
1264         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1265                                 PPSMC_MSG_SetSclkSoftMin,
1266                                 cz_get_sclk_level(hwmgr,
1267                                 cz_hwmgr->sclk_dpm.soft_min_clk,
1268                                 PPSMC_MSG_SetSclkSoftMin));
1269
1270         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1271                                 PPSMC_MSG_SetSclkSoftMax,
1272                                 cz_get_sclk_level(hwmgr,
1273                                 cz_hwmgr->sclk_dpm.soft_max_clk,
1274                                 PPSMC_MSG_SetSclkSoftMax));
1275
1276         return 0;
1277 }
1278
1279 static int cz_phm_force_dpm_lowest(struct pp_hwmgr *hwmgr)
1280 {
1281         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1282
1283         if (cz_hwmgr->sclk_dpm.soft_min_clk !=
1284                                 cz_hwmgr->sclk_dpm.soft_max_clk) {
1285                 cz_hwmgr->sclk_dpm.soft_max_clk =
1286                         cz_hwmgr->sclk_dpm.soft_min_clk;
1287
1288                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1289                                 PPSMC_MSG_SetSclkSoftMax,
1290                                 cz_get_sclk_level(hwmgr,
1291                                 cz_hwmgr->sclk_dpm.soft_max_clk,
1292                                 PPSMC_MSG_SetSclkSoftMax));
1293         }
1294
1295         return 0;
1296 }
1297
1298 static int cz_dpm_force_dpm_level(struct pp_hwmgr *hwmgr,
1299                                 enum amd_dpm_forced_level level)
1300 {
1301         int ret = 0;
1302
1303         switch (level) {
1304         case AMD_DPM_FORCED_LEVEL_HIGH:
1305                 ret = cz_phm_force_dpm_highest(hwmgr);
1306                 if (ret)
1307                         return ret;
1308                 break;
1309         case AMD_DPM_FORCED_LEVEL_LOW:
1310                 ret = cz_phm_force_dpm_lowest(hwmgr);
1311                 if (ret)
1312                         return ret;
1313                 break;
1314         case AMD_DPM_FORCED_LEVEL_AUTO:
1315                 ret = cz_phm_unforce_dpm_levels(hwmgr);
1316                 if (ret)
1317                         return ret;
1318                 break;
1319         default:
1320                 break;
1321         }
1322
1323         hwmgr->dpm_level = level;
1324
1325         return ret;
1326 }
1327
1328 int cz_dpm_powerdown_uvd(struct pp_hwmgr *hwmgr)
1329 {
1330         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1331                                          PHM_PlatformCaps_UVDPowerGating))
1332                 return smum_send_msg_to_smc(hwmgr->smumgr,
1333                                                      PPSMC_MSG_UVDPowerOFF);
1334         return 0;
1335 }
1336
1337 int cz_dpm_powerup_uvd(struct pp_hwmgr *hwmgr)
1338 {
1339         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1340                                          PHM_PlatformCaps_UVDPowerGating)) {
1341                 if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1342                                   PHM_PlatformCaps_UVDDynamicPowerGating)) {
1343                         return smum_send_msg_to_smc_with_parameter(
1344                                                                 hwmgr->smumgr,
1345                                                    PPSMC_MSG_UVDPowerON, 1);
1346                 } else {
1347                         return smum_send_msg_to_smc_with_parameter(
1348                                                                 hwmgr->smumgr,
1349                                                    PPSMC_MSG_UVDPowerON, 0);
1350                 }
1351         }
1352
1353         return 0;
1354 }
1355
1356 int cz_dpm_update_uvd_dpm(struct pp_hwmgr *hwmgr, bool bgate)
1357 {
1358         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1359         struct phm_uvd_clock_voltage_dependency_table *ptable =
1360                 hwmgr->dyn_state.uvd_clock_voltage_dependency_table;
1361
1362         if (!bgate) {
1363                 /* Stable Pstate is enabled and we need to set the UVD DPM to highest level */
1364                 if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1365                                          PHM_PlatformCaps_StablePState)) {
1366                         cz_hwmgr->uvd_dpm.hard_min_clk =
1367                                    ptable->entries[ptable->count - 1].vclk;
1368
1369                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1370                                                      PPSMC_MSG_SetUvdHardMin,
1371                                                       cz_get_uvd_level(hwmgr,
1372                                              cz_hwmgr->uvd_dpm.hard_min_clk,
1373                                                    PPSMC_MSG_SetUvdHardMin));
1374
1375                         cz_enable_disable_uvd_dpm(hwmgr, true);
1376                 } else {
1377                         cz_enable_disable_uvd_dpm(hwmgr, true);
1378                 }
1379         } else {
1380                 cz_enable_disable_uvd_dpm(hwmgr, false);
1381         }
1382
1383         return 0;
1384 }
1385
1386 int  cz_dpm_update_vce_dpm(struct pp_hwmgr *hwmgr)
1387 {
1388         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1389         struct phm_vce_clock_voltage_dependency_table *ptable =
1390                 hwmgr->dyn_state.vce_clock_voltage_dependency_table;
1391
1392         /* Stable Pstate is enabled and we need to set the VCE DPM to highest level */
1393         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1394                                          PHM_PlatformCaps_StablePState)) {
1395                 cz_hwmgr->vce_dpm.hard_min_clk =
1396                                   ptable->entries[ptable->count - 1].ecclk;
1397
1398                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1399                                         PPSMC_MSG_SetEclkHardMin,
1400                                         cz_get_eclk_level(hwmgr,
1401                                              cz_hwmgr->vce_dpm.hard_min_clk,
1402                                                 PPSMC_MSG_SetEclkHardMin));
1403         } else {
1404                 /*Program HardMin based on the vce_arbiter.ecclk */
1405                 if (hwmgr->vce_arbiter.ecclk == 0) {
1406                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1407                                             PPSMC_MSG_SetEclkHardMin, 0);
1408                 /* disable ECLK DPM 0. Otherwise VCE could hang if
1409                  * switching SCLK from DPM 0 to 6/7 */
1410                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1411                                         PPSMC_MSG_SetEclkSoftMin, 1);
1412                 } else {
1413                         cz_hwmgr->vce_dpm.hard_min_clk = hwmgr->vce_arbiter.ecclk;
1414                         smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1415                                                 PPSMC_MSG_SetEclkHardMin,
1416                                                 cz_get_eclk_level(hwmgr,
1417                                                 cz_hwmgr->vce_dpm.hard_min_clk,
1418                                                 PPSMC_MSG_SetEclkHardMin));
1419                 }
1420         }
1421         return 0;
1422 }
1423
1424 int cz_dpm_powerdown_vce(struct pp_hwmgr *hwmgr)
1425 {
1426         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1427                                          PHM_PlatformCaps_VCEPowerGating))
1428                 return smum_send_msg_to_smc(hwmgr->smumgr,
1429                                                      PPSMC_MSG_VCEPowerOFF);
1430         return 0;
1431 }
1432
1433 int cz_dpm_powerup_vce(struct pp_hwmgr *hwmgr)
1434 {
1435         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps,
1436                                          PHM_PlatformCaps_VCEPowerGating))
1437                 return smum_send_msg_to_smc(hwmgr->smumgr,
1438                                                      PPSMC_MSG_VCEPowerON);
1439         return 0;
1440 }
1441
1442 static int cz_dpm_get_mclk(struct pp_hwmgr *hwmgr, bool low)
1443 {
1444         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1445
1446         return cz_hwmgr->sys_info.bootup_uma_clock;
1447 }
1448
1449 static int cz_dpm_get_sclk(struct pp_hwmgr *hwmgr, bool low)
1450 {
1451         struct pp_power_state  *ps;
1452         struct cz_power_state  *cz_ps;
1453
1454         if (hwmgr == NULL)
1455                 return -EINVAL;
1456
1457         ps = hwmgr->request_ps;
1458
1459         if (ps == NULL)
1460                 return -EINVAL;
1461
1462         cz_ps = cast_PhwCzPowerState(&ps->hardware);
1463
1464         if (low)
1465                 return cz_ps->levels[0].engineClock;
1466         else
1467                 return cz_ps->levels[cz_ps->level-1].engineClock;
1468 }
1469
1470 static int cz_dpm_patch_boot_state(struct pp_hwmgr *hwmgr,
1471                                         struct pp_hw_power_state *hw_ps)
1472 {
1473         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1474         struct cz_power_state *cz_ps = cast_PhwCzPowerState(hw_ps);
1475
1476         cz_ps->level = 1;
1477         cz_ps->nbps_flags = 0;
1478         cz_ps->bapm_flags = 0;
1479         cz_ps->levels[0] = cz_hwmgr->boot_power_level;
1480
1481         return 0;
1482 }
1483
1484 static int cz_dpm_get_pp_table_entry_callback(
1485                                                      struct pp_hwmgr *hwmgr,
1486                                            struct pp_hw_power_state *hw_ps,
1487                                                           unsigned int index,
1488                                                      const void *clock_info)
1489 {
1490         struct cz_power_state *cz_ps = cast_PhwCzPowerState(hw_ps);
1491
1492         const ATOM_PPLIB_CZ_CLOCK_INFO *cz_clock_info = clock_info;
1493
1494         struct phm_clock_voltage_dependency_table *table =
1495                                     hwmgr->dyn_state.vddc_dependency_on_sclk;
1496         uint8_t clock_info_index = cz_clock_info->index;
1497
1498         if (clock_info_index > (uint8_t)(hwmgr->platform_descriptor.hardwareActivityPerformanceLevels - 1))
1499                 clock_info_index = (uint8_t)(hwmgr->platform_descriptor.hardwareActivityPerformanceLevels - 1);
1500
1501         cz_ps->levels[index].engineClock = table->entries[clock_info_index].clk;
1502         cz_ps->levels[index].vddcIndex = (uint8_t)table->entries[clock_info_index].v;
1503
1504         cz_ps->level = index + 1;
1505
1506         if (phm_cap_enabled(hwmgr->platform_descriptor.platformCaps, PHM_PlatformCaps_SclkDeepSleep)) {
1507                 cz_ps->levels[index].dsDividerIndex = 5;
1508                 cz_ps->levels[index].ssDividerIndex = 5;
1509         }
1510
1511         return 0;
1512 }
1513
1514 static int cz_dpm_get_num_of_pp_table_entries(struct pp_hwmgr *hwmgr)
1515 {
1516         int result;
1517         unsigned long ret = 0;
1518
1519         result = pp_tables_get_num_of_entries(hwmgr, &ret);
1520
1521         return result ? 0 : ret;
1522 }
1523
1524 static int cz_dpm_get_pp_table_entry(struct pp_hwmgr *hwmgr,
1525                     unsigned long entry, struct pp_power_state *ps)
1526 {
1527         int result;
1528         struct cz_power_state *cz_ps;
1529
1530         ps->hardware.magic = PhwCz_Magic;
1531
1532         cz_ps = cast_PhwCzPowerState(&(ps->hardware));
1533
1534         result = pp_tables_get_entry(hwmgr, entry, ps,
1535                         cz_dpm_get_pp_table_entry_callback);
1536
1537         cz_ps->uvd_clocks.vclk = ps->uvd_clocks.VCLK;
1538         cz_ps->uvd_clocks.dclk = ps->uvd_clocks.DCLK;
1539
1540         return result;
1541 }
1542
1543 static int cz_get_power_state_size(struct pp_hwmgr *hwmgr)
1544 {
1545         return sizeof(struct cz_power_state);
1546 }
1547
1548 static void cz_hw_print_display_cfg(
1549         const struct cc6_settings *cc6_settings)
1550 {
1551         PP_DBG_LOG("New Display Configuration:\n");
1552
1553         PP_DBG_LOG("   cpu_cc6_disable: %d\n",
1554                         cc6_settings->cpu_cc6_disable);
1555         PP_DBG_LOG("   cpu_pstate_disable: %d\n",
1556                         cc6_settings->cpu_pstate_disable);
1557         PP_DBG_LOG("   nb_pstate_switch_disable: %d\n",
1558                         cc6_settings->nb_pstate_switch_disable);
1559         PP_DBG_LOG("   cpu_pstate_separation_time: %d\n\n",
1560                         cc6_settings->cpu_pstate_separation_time);
1561 }
1562
1563  static int cz_set_cpu_power_state(struct pp_hwmgr *hwmgr)
1564 {
1565         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
1566         uint32_t data = 0;
1567
1568         if (hw_data->cc6_settings.cc6_setting_changed) {
1569
1570                 hw_data->cc6_settings.cc6_setting_changed = false;
1571
1572                 cz_hw_print_display_cfg(&hw_data->cc6_settings);
1573
1574                 data |= (hw_data->cc6_settings.cpu_pstate_separation_time
1575                         & PWRMGT_SEPARATION_TIME_MASK)
1576                         << PWRMGT_SEPARATION_TIME_SHIFT;
1577
1578                 data |= (hw_data->cc6_settings.cpu_cc6_disable ? 0x1 : 0x0)
1579                         << PWRMGT_DISABLE_CPU_CSTATES_SHIFT;
1580
1581                 data |= (hw_data->cc6_settings.cpu_pstate_disable ? 0x1 : 0x0)
1582                         << PWRMGT_DISABLE_CPU_PSTATES_SHIFT;
1583
1584                 PP_DBG_LOG("SetDisplaySizePowerParams data: 0x%X\n",
1585                         data);
1586
1587                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1588                                                 PPSMC_MSG_SetDisplaySizePowerParams,
1589                                                 data);
1590         }
1591
1592         return 0;
1593 }
1594
1595
1596 static int cz_store_cc6_data(struct pp_hwmgr *hwmgr, uint32_t separation_time,
1597                         bool cc6_disable, bool pstate_disable, bool pstate_switch_disable)
1598 {
1599         struct cz_hwmgr *hw_data = (struct cz_hwmgr *)(hwmgr->backend);
1600
1601         if (separation_time !=
1602             hw_data->cc6_settings.cpu_pstate_separation_time ||
1603             cc6_disable != hw_data->cc6_settings.cpu_cc6_disable ||
1604             pstate_disable != hw_data->cc6_settings.cpu_pstate_disable ||
1605             pstate_switch_disable != hw_data->cc6_settings.nb_pstate_switch_disable) {
1606
1607                 hw_data->cc6_settings.cc6_setting_changed = true;
1608
1609                 hw_data->cc6_settings.cpu_pstate_separation_time =
1610                         separation_time;
1611                 hw_data->cc6_settings.cpu_cc6_disable =
1612                         cc6_disable;
1613                 hw_data->cc6_settings.cpu_pstate_disable =
1614                         pstate_disable;
1615                 hw_data->cc6_settings.nb_pstate_switch_disable =
1616                         pstate_switch_disable;
1617
1618         }
1619
1620         return 0;
1621 }
1622
1623 static int cz_get_dal_power_level(struct pp_hwmgr *hwmgr,
1624                 struct amd_pp_simple_clock_info *info)
1625 {
1626         uint32_t i;
1627         const struct phm_clock_voltage_dependency_table *table =
1628                         hwmgr->dyn_state.vddc_dep_on_dal_pwrl;
1629         const struct phm_clock_and_voltage_limits *limits =
1630                         &hwmgr->dyn_state.max_clock_voltage_on_ac;
1631
1632         info->engine_max_clock = limits->sclk;
1633         info->memory_max_clock = limits->mclk;
1634
1635         for (i = table->count - 1; i > 0; i--) {
1636                 if (limits->vddc >= table->entries[i].v) {
1637                         info->level = table->entries[i].clk;
1638                         return 0;
1639                 }
1640         }
1641         return -EINVAL;
1642 }
1643
1644 static int cz_force_clock_level(struct pp_hwmgr *hwmgr,
1645                 enum pp_clock_type type, uint32_t mask)
1646 {
1647         if (hwmgr->dpm_level != AMD_DPM_FORCED_LEVEL_MANUAL)
1648                 return -EINVAL;
1649
1650         switch (type) {
1651         case PP_SCLK:
1652                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1653                                 PPSMC_MSG_SetSclkSoftMin,
1654                                 mask);
1655                 smum_send_msg_to_smc_with_parameter(hwmgr->smumgr,
1656                                 PPSMC_MSG_SetSclkSoftMax,
1657                                 mask);
1658                 break;
1659         default:
1660                 break;
1661         }
1662
1663         return 0;
1664 }
1665
1666 static int cz_print_clock_levels(struct pp_hwmgr *hwmgr,
1667                 enum pp_clock_type type, char *buf)
1668 {
1669         struct phm_clock_voltage_dependency_table *sclk_table =
1670                         hwmgr->dyn_state.vddc_dependency_on_sclk;
1671         int i, now, size = 0;
1672
1673         switch (type) {
1674         case PP_SCLK:
1675                 now = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device,
1676                                 CGS_IND_REG__SMC,
1677                                 ixTARGET_AND_CURRENT_PROFILE_INDEX),
1678                                 TARGET_AND_CURRENT_PROFILE_INDEX,
1679                                 CURR_SCLK_INDEX);
1680
1681                 for (i = 0; i < sclk_table->count; i++)
1682                         size += sprintf(buf + size, "%d: %uMhz %s\n",
1683                                         i, sclk_table->entries[i].clk / 100,
1684                                         (i == now) ? "*" : "");
1685                 break;
1686         default:
1687                 break;
1688         }
1689         return size;
1690 }
1691
1692 static int cz_get_performance_level(struct pp_hwmgr *hwmgr, const struct pp_hw_power_state *state,
1693                                 PHM_PerformanceLevelDesignation designation, uint32_t index,
1694                                 PHM_PerformanceLevel *level)
1695 {
1696         const struct cz_power_state *ps;
1697         struct cz_hwmgr *data;
1698         uint32_t level_index;
1699         uint32_t i;
1700
1701         if (level == NULL || hwmgr == NULL || state == NULL)
1702                 return -EINVAL;
1703
1704         data = (struct cz_hwmgr *)(hwmgr->backend);
1705         ps = cast_const_PhwCzPowerState(state);
1706
1707         level_index = index > ps->level - 1 ? ps->level - 1 : index;
1708         level->coreClock = ps->levels[level_index].engineClock;
1709
1710         if (designation == PHM_PerformanceLevelDesignation_PowerContainment) {
1711                 for (i = 1; i < ps->level; i++) {
1712                         if (ps->levels[i].engineClock > data->dce_slow_sclk_threshold) {
1713                                 level->coreClock = ps->levels[i].engineClock;
1714                                 break;
1715                         }
1716                 }
1717         }
1718
1719         if (level_index == 0)
1720                 level->memory_clock = data->sys_info.nbp_memory_clock[CZ_NUM_NBPMEMORYCLOCK - 1];
1721         else
1722                 level->memory_clock = data->sys_info.nbp_memory_clock[0];
1723
1724         level->vddc = (cz_convert_8Bit_index_to_voltage(hwmgr, ps->levels[level_index].vddcIndex) + 2) / 4;
1725         level->nonLocalMemoryFreq = 0;
1726         level->nonLocalMemoryWidth = 0;
1727
1728         return 0;
1729 }
1730
1731 static int cz_get_current_shallow_sleep_clocks(struct pp_hwmgr *hwmgr,
1732         const struct pp_hw_power_state *state, struct pp_clock_info *clock_info)
1733 {
1734         const struct cz_power_state *ps = cast_const_PhwCzPowerState(state);
1735
1736         clock_info->min_eng_clk = ps->levels[0].engineClock / (1 << (ps->levels[0].ssDividerIndex));
1737         clock_info->max_eng_clk = ps->levels[ps->level - 1].engineClock / (1 << (ps->levels[ps->level - 1].ssDividerIndex));
1738
1739         return 0;
1740 }
1741
1742 static int cz_get_clock_by_type(struct pp_hwmgr *hwmgr, enum amd_pp_clock_type type,
1743                                                 struct amd_pp_clocks *clocks)
1744 {
1745         struct cz_hwmgr *data = (struct cz_hwmgr *)(hwmgr->backend);
1746         int i;
1747         struct phm_clock_voltage_dependency_table *table;
1748
1749         clocks->count = cz_get_max_sclk_level(hwmgr);
1750         switch (type) {
1751         case amd_pp_disp_clock:
1752                 for (i = 0; i < clocks->count; i++)
1753                         clocks->clock[i] = data->sys_info.display_clock[i];
1754                 break;
1755         case amd_pp_sys_clock:
1756                 table = hwmgr->dyn_state.vddc_dependency_on_sclk;
1757                 for (i = 0; i < clocks->count; i++)
1758                         clocks->clock[i] = table->entries[i].clk;
1759                 break;
1760         case amd_pp_mem_clock:
1761                 clocks->count = CZ_NUM_NBPMEMORYCLOCK;
1762                 for (i = 0; i < clocks->count; i++)
1763                         clocks->clock[i] = data->sys_info.nbp_memory_clock[clocks->count - 1 - i];
1764                 break;
1765         default:
1766                 return -1;
1767         }
1768
1769         return 0;
1770 }
1771
1772 static int cz_get_max_high_clocks(struct pp_hwmgr *hwmgr, struct amd_pp_simple_clock_info *clocks)
1773 {
1774         struct phm_clock_voltage_dependency_table *table =
1775                                         hwmgr->dyn_state.vddc_dependency_on_sclk;
1776         unsigned long level;
1777         const struct phm_clock_and_voltage_limits *limits =
1778                         &hwmgr->dyn_state.max_clock_voltage_on_ac;
1779
1780         if ((NULL == table) || (table->count <= 0) || (clocks == NULL))
1781                 return -EINVAL;
1782
1783         level = cz_get_max_sclk_level(hwmgr) - 1;
1784
1785         if (level < table->count)
1786                 clocks->engine_max_clock = table->entries[level].clk;
1787         else
1788                 clocks->engine_max_clock = table->entries[table->count - 1].clk;
1789
1790         clocks->memory_max_clock = limits->mclk;
1791
1792         return 0;
1793 }
1794
1795 static int cz_thermal_get_temperature(struct pp_hwmgr *hwmgr)
1796 {
1797         int actual_temp = 0;
1798         uint32_t val = cgs_read_ind_register(hwmgr->device,
1799                                              CGS_IND_REG__SMC, ixTHM_TCON_CUR_TMP);
1800         uint32_t temp = PHM_GET_FIELD(val, THM_TCON_CUR_TMP, CUR_TEMP);
1801
1802         if (PHM_GET_FIELD(val, THM_TCON_CUR_TMP, CUR_TEMP_RANGE_SEL))
1803                 actual_temp = ((temp / 8) - 49) * PP_TEMPERATURE_UNITS_PER_CENTIGRADES;
1804         else
1805                 actual_temp = (temp / 8) * PP_TEMPERATURE_UNITS_PER_CENTIGRADES;
1806
1807         return actual_temp;
1808 }
1809
1810 static int cz_read_sensor(struct pp_hwmgr *hwmgr, int idx, int32_t *value)
1811 {
1812         struct cz_hwmgr *cz_hwmgr = (struct cz_hwmgr *)(hwmgr->backend);
1813
1814         struct phm_clock_voltage_dependency_table *table =
1815                                 hwmgr->dyn_state.vddc_dependency_on_sclk;
1816
1817         struct phm_vce_clock_voltage_dependency_table *vce_table =
1818                 hwmgr->dyn_state.vce_clock_voltage_dependency_table;
1819
1820         struct phm_uvd_clock_voltage_dependency_table *uvd_table =
1821                 hwmgr->dyn_state.uvd_clock_voltage_dependency_table;
1822
1823         uint32_t sclk_index = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixTARGET_AND_CURRENT_PROFILE_INDEX),
1824                                         TARGET_AND_CURRENT_PROFILE_INDEX, CURR_SCLK_INDEX);
1825         uint32_t uvd_index = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixTARGET_AND_CURRENT_PROFILE_INDEX_2),
1826                                         TARGET_AND_CURRENT_PROFILE_INDEX_2, CURR_UVD_INDEX);
1827         uint32_t vce_index = PHM_GET_FIELD(cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixTARGET_AND_CURRENT_PROFILE_INDEX_2),
1828                                         TARGET_AND_CURRENT_PROFILE_INDEX_2, CURR_VCE_INDEX);
1829
1830         uint32_t sclk, vclk, dclk, ecclk, tmp, activity_percent;
1831         uint16_t vddnb, vddgfx;
1832         int result;
1833
1834         switch (idx) {
1835         case AMDGPU_PP_SENSOR_GFX_SCLK:
1836                 if (sclk_index < NUM_SCLK_LEVELS) {
1837                         sclk = table->entries[sclk_index].clk;
1838                         *value = sclk;
1839                         return 0;
1840                 }
1841                 return -EINVAL;
1842         case AMDGPU_PP_SENSOR_VDDNB:
1843                 tmp = (cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixSMUSVI_NB_CURRENTVID) &
1844                         CURRENT_NB_VID_MASK) >> CURRENT_NB_VID__SHIFT;
1845                 vddnb = cz_convert_8Bit_index_to_voltage(hwmgr, tmp);
1846                 *value = vddnb;
1847                 return 0;
1848         case AMDGPU_PP_SENSOR_VDDGFX:
1849                 tmp = (cgs_read_ind_register(hwmgr->device, CGS_IND_REG__SMC, ixSMUSVI_GFX_CURRENTVID) &
1850                         CURRENT_GFX_VID_MASK) >> CURRENT_GFX_VID__SHIFT;
1851                 vddgfx = cz_convert_8Bit_index_to_voltage(hwmgr, (u16)tmp);
1852                 *value = vddgfx;
1853                 return 0;
1854         case AMDGPU_PP_SENSOR_UVD_VCLK:
1855                 if (!cz_hwmgr->uvd_power_gated) {
1856                         if (uvd_index >= CZ_MAX_HARDWARE_POWERLEVELS) {
1857                                 return -EINVAL;
1858                         } else {
1859                                 vclk = uvd_table->entries[uvd_index].vclk;
1860                                 *value = vclk;
1861                                 return 0;
1862                         }
1863                 }
1864                 *value = 0;
1865                 return 0;
1866         case AMDGPU_PP_SENSOR_UVD_DCLK:
1867                 if (!cz_hwmgr->uvd_power_gated) {
1868                         if (uvd_index >= CZ_MAX_HARDWARE_POWERLEVELS) {
1869                                 return -EINVAL;
1870                         } else {
1871                                 dclk = uvd_table->entries[uvd_index].dclk;
1872                                 *value = dclk;
1873                                 return 0;
1874                         }
1875                 }
1876                 *value = 0;
1877                 return 0;
1878         case AMDGPU_PP_SENSOR_VCE_ECCLK:
1879                 if (!cz_hwmgr->vce_power_gated) {
1880                         if (vce_index >= CZ_MAX_HARDWARE_POWERLEVELS) {
1881                                 return -EINVAL;
1882                         } else {
1883                                 ecclk = vce_table->entries[vce_index].ecclk;
1884                                 *value = ecclk;
1885                                 return 0;
1886                         }
1887                 }
1888                 *value = 0;
1889                 return 0;
1890         case AMDGPU_PP_SENSOR_GPU_LOAD:
1891                 result = smum_send_msg_to_smc(hwmgr->smumgr, PPSMC_MSG_GetAverageGraphicsActivity);
1892                 if (0 == result) {
1893                         activity_percent = cgs_read_register(hwmgr->device, mmSMU_MP1_SRBM2P_ARG_0);
1894                         activity_percent = activity_percent > 100 ? 100 : activity_percent;
1895                 } else {
1896                         activity_percent = 50;
1897                 }
1898                 *value = activity_percent;
1899                 return 0;
1900         case AMDGPU_PP_SENSOR_UVD_POWER:
1901                 *value = cz_hwmgr->uvd_power_gated ? 0 : 1;
1902                 return 0;
1903         case AMDGPU_PP_SENSOR_VCE_POWER:
1904                 *value = cz_hwmgr->vce_power_gated ? 0 : 1;
1905                 return 0;
1906         case AMDGPU_PP_SENSOR_GPU_TEMP:
1907                 *value = cz_thermal_get_temperature(hwmgr);
1908                 return 0;
1909         default:
1910                 return -EINVAL;
1911         }
1912 }
1913
1914 static const struct pp_hwmgr_func cz_hwmgr_funcs = {
1915         .backend_init = cz_hwmgr_backend_init,
1916         .backend_fini = cz_hwmgr_backend_fini,
1917         .asic_setup = NULL,
1918         .apply_state_adjust_rules = cz_apply_state_adjust_rules,
1919         .force_dpm_level = cz_dpm_force_dpm_level,
1920         .get_power_state_size = cz_get_power_state_size,
1921         .powerdown_uvd = cz_dpm_powerdown_uvd,
1922         .powergate_uvd = cz_dpm_powergate_uvd,
1923         .powergate_vce = cz_dpm_powergate_vce,
1924         .get_mclk = cz_dpm_get_mclk,
1925         .get_sclk = cz_dpm_get_sclk,
1926         .patch_boot_state = cz_dpm_patch_boot_state,
1927         .get_pp_table_entry = cz_dpm_get_pp_table_entry,
1928         .get_num_of_pp_table_entries = cz_dpm_get_num_of_pp_table_entries,
1929         .set_cpu_power_state = cz_set_cpu_power_state,
1930         .store_cc6_data = cz_store_cc6_data,
1931         .force_clock_level = cz_force_clock_level,
1932         .print_clock_levels = cz_print_clock_levels,
1933         .get_dal_power_level = cz_get_dal_power_level,
1934         .get_performance_level = cz_get_performance_level,
1935         .get_current_shallow_sleep_clocks = cz_get_current_shallow_sleep_clocks,
1936         .get_clock_by_type = cz_get_clock_by_type,
1937         .get_max_high_clocks = cz_get_max_high_clocks,
1938         .read_sensor = cz_read_sensor,
1939 };
1940
1941 int cz_hwmgr_init(struct pp_hwmgr *hwmgr)
1942 {
1943         hwmgr->hwmgr_func = &cz_hwmgr_funcs;
1944         hwmgr->pptable_func = &pptable_funcs;
1945         return 0;
1946 }