drivers/gpu/drm/amd/amdgpu/kv_dpm.c

   1 /*
   2  * Copyright 2013 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
  24 #include <drm/drmP.h>
  25 #include "amdgpu.h"
  26 #include "amdgpu_pm.h"
  27 #include "cikd.h"
  28 #include "atom.h"
  29 #include "amdgpu_atombios.h"
  30 #include "amdgpu_dpm.h"
  31 #include "kv_dpm.h"
  32 #include "gfx_v7_0.h"
  33 #include <linux/seq_file.h>
  34
  35 #include "smu/smu_7_0_0_d.h"
  36 #include "smu/smu_7_0_0_sh_mask.h"
  37
  38 #include "gca/gfx_7_2_d.h"
  39 #include "gca/gfx_7_2_sh_mask.h"
  40
  41 #define KV_MAX_DEEPSLEEP_DIVIDER_ID     5
  42 #define KV_MINIMUM_ENGINE_CLOCK         800
  43 #define SMC_RAM_END                     0x40000
  44
  45 static const struct amd_pm_funcs kv_dpm_funcs;
  46
  47 static void kv_dpm_set_irq_funcs(struct amdgpu_device *adev);
  48 static int kv_enable_nb_dpm(struct amdgpu_device *adev,
  49                             bool enable);
  50 static void kv_init_graphics_levels(struct amdgpu_device *adev);
  51 static int kv_calculate_ds_divider(struct amdgpu_device *adev);
  52 static int kv_calculate_nbps_level_settings(struct amdgpu_device *adev);
  53 static int kv_calculate_dpm_settings(struct amdgpu_device *adev);
  54 static void kv_enable_new_levels(struct amdgpu_device *adev);
  55 static void kv_program_nbps_index_settings(struct amdgpu_device *adev,
  56                                            struct amdgpu_ps *new_rps);
  57 static int kv_set_enabled_level(struct amdgpu_device *adev, u32 level);
  58 static int kv_set_enabled_levels(struct amdgpu_device *adev);
  59 static int kv_force_dpm_highest(struct amdgpu_device *adev);
  60 static int kv_force_dpm_lowest(struct amdgpu_device *adev);
  61 static void kv_apply_state_adjust_rules(struct amdgpu_device *adev,
  62                                         struct amdgpu_ps *new_rps,
  63                                         struct amdgpu_ps *old_rps);
  64 static int kv_set_thermal_temperature_range(struct amdgpu_device *adev,
  65                                             int min_temp, int max_temp);
  66 static int kv_init_fps_limits(struct amdgpu_device *adev);
  67
  68 static void kv_dpm_powergate_uvd(void *handle, bool gate);
  69 static void kv_dpm_powergate_vce(struct amdgpu_device *adev, bool gate);
  70 static void kv_dpm_powergate_samu(struct amdgpu_device *adev, bool gate);
  71 static void kv_dpm_powergate_acp(struct amdgpu_device *adev, bool gate);
  72
  73
  74 static u32 kv_convert_vid2_to_vid7(struct amdgpu_device *adev,
  75                                    struct sumo_vid_mapping_table *vid_mapping_table,
  76                                    u32 vid_2bit)
  77 {
  78         struct amdgpu_clock_voltage_dependency_table *vddc_sclk_table =
  79                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
  80         u32 i;
  81
  82         if (vddc_sclk_table && vddc_sclk_table->count) {
  83                 if (vid_2bit < vddc_sclk_table->count)
  84                         return vddc_sclk_table->entries[vid_2bit].v;
  85                 else
  86                         return vddc_sclk_table->entries[vddc_sclk_table->count - 1].v;
  87         } else {
  88                 for (i = 0; i < vid_mapping_table->num_entries; i++) {
  89                         if (vid_mapping_table->entries[i].vid_2bit == vid_2bit)
  90                                 return vid_mapping_table->entries[i].vid_7bit;
  91                 }
  92                 return vid_mapping_table->entries[vid_mapping_table->num_entries - 1].vid_7bit;
  93         }
  94 }
  95
  96 static u32 kv_convert_vid7_to_vid2(struct amdgpu_device *adev,
  97                                    struct sumo_vid_mapping_table *vid_mapping_table,
  98                                    u32 vid_7bit)
  99 {
 100         struct amdgpu_clock_voltage_dependency_table *vddc_sclk_table =
 101                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
 102         u32 i;
 103
 104         if (vddc_sclk_table && vddc_sclk_table->count) {
 105                 for (i = 0; i < vddc_sclk_table->count; i++) {
 106                         if (vddc_sclk_table->entries[i].v == vid_7bit)
 107                                 return i;
 108                 }
 109                 return vddc_sclk_table->count - 1;
 110         } else {
 111                 for (i = 0; i < vid_mapping_table->num_entries; i++) {
 112                         if (vid_mapping_table->entries[i].vid_7bit == vid_7bit)
 113                                 return vid_mapping_table->entries[i].vid_2bit;
 114                 }
 115
 116                 return vid_mapping_table->entries[vid_mapping_table->num_entries - 1].vid_2bit;
 117         }
 118 }
 119
 120 static void sumo_take_smu_control(struct amdgpu_device *adev, bool enable)
 121 {
 122 /* This bit selects who handles display phy powergating.
 123  * Clear the bit to let atom handle it.
 124  * Set it to let the driver handle it.
 125  * For now we just let atom handle it.
 126  */
 127 #if 0
 128         u32 v = RREG32(mmDOUT_SCRATCH3);
 129
 130         if (enable)
 131                 v |= 0x4;
 132         else
 133                 v &= 0xFFFFFFFB;
 134
 135         WREG32(mmDOUT_SCRATCH3, v);
 136 #endif
 137 }
 138
 139 static void sumo_construct_sclk_voltage_mapping_table(struct amdgpu_device *adev,
 140                                                       struct sumo_sclk_voltage_mapping_table *sclk_voltage_mapping_table,
 141                                                       ATOM_AVAILABLE_SCLK_LIST *table)
 142 {
 143         u32 i;
 144         u32 n = 0;
 145         u32 prev_sclk = 0;
 146
 147         for (i = 0; i < SUMO_MAX_HARDWARE_POWERLEVELS; i++) {
 148                 if (table[i].ulSupportedSCLK > prev_sclk) {
 149                         sclk_voltage_mapping_table->entries[n].sclk_frequency =
 150                                 table[i].ulSupportedSCLK;
 151                         sclk_voltage_mapping_table->entries[n].vid_2bit =
 152                                 table[i].usVoltageIndex;
 153                         prev_sclk = table[i].ulSupportedSCLK;
 154                         n++;
 155                 }
 156         }
 157
 158         sclk_voltage_mapping_table->num_max_dpm_entries = n;
 159 }
 160
 161 static void sumo_construct_vid_mapping_table(struct amdgpu_device *adev,
 162                                              struct sumo_vid_mapping_table *vid_mapping_table,
 163                                              ATOM_AVAILABLE_SCLK_LIST *table)
 164 {
 165         u32 i, j;
 166
 167         for (i = 0; i < SUMO_MAX_HARDWARE_POWERLEVELS; i++) {
 168                 if (table[i].ulSupportedSCLK != 0) {
 169                         vid_mapping_table->entries[table[i].usVoltageIndex].vid_7bit =
 170                                 table[i].usVoltageID;
 171                         vid_mapping_table->entries[table[i].usVoltageIndex].vid_2bit =
 172                                 table[i].usVoltageIndex;
 173                 }
 174         }
 175
 176         for (i = 0; i < SUMO_MAX_NUMBER_VOLTAGES; i++) {
 177                 if (vid_mapping_table->entries[i].vid_7bit == 0) {
 178                         for (j = i + 1; j < SUMO_MAX_NUMBER_VOLTAGES; j++) {
 179                                 if (vid_mapping_table->entries[j].vid_7bit != 0) {
 180                                         vid_mapping_table->entries[i] =
 181                                                 vid_mapping_table->entries[j];
 182                                         vid_mapping_table->entries[j].vid_7bit = 0;
 183                                         break;
 184                                 }
 185                         }
 186
 187                         if (j == SUMO_MAX_NUMBER_VOLTAGES)
 188                                 break;
 189                 }
 190         }
 191
 192         vid_mapping_table->num_entries = i;
 193 }
 194
 195 #if 0
 196 static const struct kv_lcac_config_values sx_local_cac_cfg_kv[] =
 197 {
 198         {  0,       4,        1    },
 199         {  1,       4,        1    },
 200         {  2,       5,        1    },
 201         {  3,       4,        2    },
 202         {  4,       1,        1    },
 203         {  5,       5,        2    },
 204         {  6,       6,        1    },
 205         {  7,       9,        2    },
 206         { 0xffffffff }
 207 };
 208
 209 static const struct kv_lcac_config_values mc0_local_cac_cfg_kv[] =
 210 {
 211         {  0,       4,        1    },
 212         { 0xffffffff }
 213 };
 214
 215 static const struct kv_lcac_config_values mc1_local_cac_cfg_kv[] =
 216 {
 217         {  0,       4,        1    },
 218         { 0xffffffff }
 219 };
 220
 221 static const struct kv_lcac_config_values mc2_local_cac_cfg_kv[] =
 222 {
 223         {  0,       4,        1    },
 224         { 0xffffffff }
 225 };
 226
 227 static const struct kv_lcac_config_values mc3_local_cac_cfg_kv[] =
 228 {
 229         {  0,       4,        1    },
 230         { 0xffffffff }
 231 };
 232
 233 static const struct kv_lcac_config_values cpl_local_cac_cfg_kv[] =
 234 {
 235         {  0,       4,        1    },
 236         {  1,       4,        1    },
 237         {  2,       5,        1    },
 238         {  3,       4,        1    },
 239         {  4,       1,        1    },
 240         {  5,       5,        1    },
 241         {  6,       6,        1    },
 242         {  7,       9,        1    },
 243         {  8,       4,        1    },
 244         {  9,       2,        1    },
 245         {  10,      3,        1    },
 246         {  11,      6,        1    },
 247         {  12,      8,        2    },
 248         {  13,      1,        1    },
 249         {  14,      2,        1    },
 250         {  15,      3,        1    },
 251         {  16,      1,        1    },
 252         {  17,      4,        1    },
 253         {  18,      3,        1    },
 254         {  19,      1,        1    },
 255         {  20,      8,        1    },
 256         {  21,      5,        1    },
 257         {  22,      1,        1    },
 258         {  23,      1,        1    },
 259         {  24,      4,        1    },
 260         {  27,      6,        1    },
 261         {  28,      1,        1    },
 262         { 0xffffffff }
 263 };
 264
 265 static const struct kv_lcac_config_reg sx0_cac_config_reg[] =
 266 {
 267         { 0xc0400d00, 0x003e0000, 17, 0x3fc00000, 22, 0x0001fffe, 1, 0x00000001, 0 }
 268 };
 269
 270 static const struct kv_lcac_config_reg mc0_cac_config_reg[] =
 271 {
 272         { 0xc0400d30, 0x003e0000, 17, 0x3fc00000, 22, 0x0001fffe, 1, 0x00000001, 0 }
 273 };
 274
 275 static const struct kv_lcac_config_reg mc1_cac_config_reg[] =
 276 {
 277         { 0xc0400d3c, 0x003e0000, 17, 0x3fc00000, 22, 0x0001fffe, 1, 0x00000001, 0 }
 278 };
 279
 280 static const struct kv_lcac_config_reg mc2_cac_config_reg[] =
 281 {
 282         { 0xc0400d48, 0x003e0000, 17, 0x3fc00000, 22, 0x0001fffe, 1, 0x00000001, 0 }
 283 };
 284
 285 static const struct kv_lcac_config_reg mc3_cac_config_reg[] =
 286 {
 287         { 0xc0400d54, 0x003e0000, 17, 0x3fc00000, 22, 0x0001fffe, 1, 0x00000001, 0 }
 288 };
 289
 290 static const struct kv_lcac_config_reg cpl_cac_config_reg[] =
 291 {
 292         { 0xc0400d80, 0x003e0000, 17, 0x3fc00000, 22, 0x0001fffe, 1, 0x00000001, 0 }
 293 };
 294 #endif
 295
 296 static const struct kv_pt_config_reg didt_config_kv[] =
 297 {
 298         { 0x10, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 299         { 0x10, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 300         { 0x10, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 301         { 0x10, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 302         { 0x11, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 303         { 0x11, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 304         { 0x11, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 305         { 0x11, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 306         { 0x12, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 307         { 0x12, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 308         { 0x12, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 309         { 0x12, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 310         { 0x2, 0x00003fff, 0, 0x4, KV_CONFIGREG_DIDT_IND },
 311         { 0x2, 0x03ff0000, 16, 0x80, KV_CONFIGREG_DIDT_IND },
 312         { 0x2, 0x78000000, 27, 0x3, KV_CONFIGREG_DIDT_IND },
 313         { 0x1, 0x0000ffff, 0, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 314         { 0x1, 0xffff0000, 16, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 315         { 0x0, 0x00000001, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 316         { 0x30, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 317         { 0x30, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 318         { 0x30, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 319         { 0x30, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 320         { 0x31, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 321         { 0x31, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 322         { 0x31, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 323         { 0x31, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 324         { 0x32, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 325         { 0x32, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 326         { 0x32, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 327         { 0x32, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 328         { 0x22, 0x00003fff, 0, 0x4, KV_CONFIGREG_DIDT_IND },
 329         { 0x22, 0x03ff0000, 16, 0x80, KV_CONFIGREG_DIDT_IND },
 330         { 0x22, 0x78000000, 27, 0x3, KV_CONFIGREG_DIDT_IND },
 331         { 0x21, 0x0000ffff, 0, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 332         { 0x21, 0xffff0000, 16, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 333         { 0x20, 0x00000001, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 334         { 0x50, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 335         { 0x50, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 336         { 0x50, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 337         { 0x50, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 338         { 0x51, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 339         { 0x51, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 340         { 0x51, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 341         { 0x51, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 342         { 0x52, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 343         { 0x52, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 344         { 0x52, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 345         { 0x52, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 346         { 0x42, 0x00003fff, 0, 0x4, KV_CONFIGREG_DIDT_IND },
 347         { 0x42, 0x03ff0000, 16, 0x80, KV_CONFIGREG_DIDT_IND },
 348         { 0x42, 0x78000000, 27, 0x3, KV_CONFIGREG_DIDT_IND },
 349         { 0x41, 0x0000ffff, 0, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 350         { 0x41, 0xffff0000, 16, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 351         { 0x40, 0x00000001, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 352         { 0x70, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 353         { 0x70, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 354         { 0x70, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 355         { 0x70, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 356         { 0x71, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 357         { 0x71, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 358         { 0x71, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 359         { 0x71, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 360         { 0x72, 0x000000ff, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 361         { 0x72, 0x0000ff00, 8, 0x0, KV_CONFIGREG_DIDT_IND },
 362         { 0x72, 0x00ff0000, 16, 0x0, KV_CONFIGREG_DIDT_IND },
 363         { 0x72, 0xff000000, 24, 0x0, KV_CONFIGREG_DIDT_IND },
 364         { 0x62, 0x00003fff, 0, 0x4, KV_CONFIGREG_DIDT_IND },
 365         { 0x62, 0x03ff0000, 16, 0x80, KV_CONFIGREG_DIDT_IND },
 366         { 0x62, 0x78000000, 27, 0x3, KV_CONFIGREG_DIDT_IND },
 367         { 0x61, 0x0000ffff, 0, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 368         { 0x61, 0xffff0000, 16, 0x3FFF, KV_CONFIGREG_DIDT_IND },
 369         { 0x60, 0x00000001, 0, 0x0, KV_CONFIGREG_DIDT_IND },
 370         { 0xFFFFFFFF }
 371 };
 372
 373 static struct kv_ps *kv_get_ps(struct amdgpu_ps *rps)
 374 {
 375         struct kv_ps *ps = rps->ps_priv;
 376
 377         return ps;
 378 }
 379
 380 static struct kv_power_info *kv_get_pi(struct amdgpu_device *adev)
 381 {
 382         struct kv_power_info *pi = adev->pm.dpm.priv;
 383
 384         return pi;
 385 }
 386
 387 #if 0
 388 static void kv_program_local_cac_table(struct amdgpu_device *adev,
 389                                        const struct kv_lcac_config_values *local_cac_table,
 390                                        const struct kv_lcac_config_reg *local_cac_reg)
 391 {
 392         u32 i, count, data;
 393         const struct kv_lcac_config_values *values = local_cac_table;
 394
 395         while (values->block_id != 0xffffffff) {
 396                 count = values->signal_id;
 397                 for (i = 0; i < count; i++) {
 398                         data = ((values->block_id << local_cac_reg->block_shift) &
 399                                 local_cac_reg->block_mask);
 400                         data |= ((i << local_cac_reg->signal_shift) &
 401                                  local_cac_reg->signal_mask);
 402                         data |= ((values->t << local_cac_reg->t_shift) &
 403                                  local_cac_reg->t_mask);
 404                         data |= ((1 << local_cac_reg->enable_shift) &
 405                                  local_cac_reg->enable_mask);
 406                         WREG32_SMC(local_cac_reg->cntl, data);
 407                 }
 408                 values++;
 409         }
 410 }
 411 #endif
 412
 413 static int kv_program_pt_config_registers(struct amdgpu_device *adev,
 414                                           const struct kv_pt_config_reg *cac_config_regs)
 415 {
 416         const struct kv_pt_config_reg *config_regs = cac_config_regs;
 417         u32 data;
 418         u32 cache = 0;
 419
 420         if (config_regs == NULL)
 421                 return -EINVAL;
 422
 423         while (config_regs->offset != 0xFFFFFFFF) {
 424                 if (config_regs->type == KV_CONFIGREG_CACHE) {
 425                         cache |= ((config_regs->value << config_regs->shift) & config_regs->mask);
 426                 } else {
 427                         switch (config_regs->type) {
 428                         case KV_CONFIGREG_SMC_IND:
 429                                 data = RREG32_SMC(config_regs->offset);
 430                                 break;
 431                         case KV_CONFIGREG_DIDT_IND:
 432                                 data = RREG32_DIDT(config_regs->offset);
 433                                 break;
 434                         default:
 435                                 data = RREG32(config_regs->offset);
 436                                 break;
 437                         }
 438
 439                         data &= ~config_regs->mask;
 440                         data |= ((config_regs->value << config_regs->shift) & config_regs->mask);
 441                         data |= cache;
 442                         cache = 0;
 443
 444                         switch (config_regs->type) {
 445                         case KV_CONFIGREG_SMC_IND:
 446                                 WREG32_SMC(config_regs->offset, data);
 447                                 break;
 448                         case KV_CONFIGREG_DIDT_IND:
 449                                 WREG32_DIDT(config_regs->offset, data);
 450                                 break;
 451                         default:
 452                                 WREG32(config_regs->offset, data);
 453                                 break;
 454                         }
 455                 }
 456                 config_regs++;
 457         }
 458
 459         return 0;
 460 }
 461
 462 static void kv_do_enable_didt(struct amdgpu_device *adev, bool enable)
 463 {
 464         struct kv_power_info *pi = kv_get_pi(adev);
 465         u32 data;
 466
 467         if (pi->caps_sq_ramping) {
 468                 data = RREG32_DIDT(ixDIDT_SQ_CTRL0);
 469                 if (enable)
 470                         data |= DIDT_SQ_CTRL0__DIDT_CTRL_EN_MASK;
 471                 else
 472                         data &= ~DIDT_SQ_CTRL0__DIDT_CTRL_EN_MASK;
 473                 WREG32_DIDT(ixDIDT_SQ_CTRL0, data);
 474         }
 475
 476         if (pi->caps_db_ramping) {
 477                 data = RREG32_DIDT(ixDIDT_DB_CTRL0);
 478                 if (enable)
 479                         data |= DIDT_DB_CTRL0__DIDT_CTRL_EN_MASK;
 480                 else
 481                         data &= ~DIDT_DB_CTRL0__DIDT_CTRL_EN_MASK;
 482                 WREG32_DIDT(ixDIDT_DB_CTRL0, data);
 483         }
 484
 485         if (pi->caps_td_ramping) {
 486                 data = RREG32_DIDT(ixDIDT_TD_CTRL0);
 487                 if (enable)
 488                         data |= DIDT_TD_CTRL0__DIDT_CTRL_EN_MASK;
 489                 else
 490                         data &= ~DIDT_TD_CTRL0__DIDT_CTRL_EN_MASK;
 491                 WREG32_DIDT(ixDIDT_TD_CTRL0, data);
 492         }
 493
 494         if (pi->caps_tcp_ramping) {
 495                 data = RREG32_DIDT(ixDIDT_TCP_CTRL0);
 496                 if (enable)
 497                         data |= DIDT_TCP_CTRL0__DIDT_CTRL_EN_MASK;
 498                 else
 499                         data &= ~DIDT_TCP_CTRL0__DIDT_CTRL_EN_MASK;
 500                 WREG32_DIDT(ixDIDT_TCP_CTRL0, data);
 501         }
 502 }
 503
 504 static int kv_enable_didt(struct amdgpu_device *adev, bool enable)
 505 {
 506         struct kv_power_info *pi = kv_get_pi(adev);
 507         int ret;
 508
 509         if (pi->caps_sq_ramping ||
 510             pi->caps_db_ramping ||
 511             pi->caps_td_ramping ||
 512             pi->caps_tcp_ramping) {
 513                 adev->gfx.rlc.funcs->enter_safe_mode(adev);
 514
 515                 if (enable) {
 516                         ret = kv_program_pt_config_registers(adev, didt_config_kv);
 517                         if (ret) {
 518                                 adev->gfx.rlc.funcs->exit_safe_mode(adev);
 519                                 return ret;
 520                         }
 521                 }
 522
 523                 kv_do_enable_didt(adev, enable);
 524
 525                 adev->gfx.rlc.funcs->exit_safe_mode(adev);
 526         }
 527
 528         return 0;
 529 }
 530
 531 #if 0
 532 static void kv_initialize_hardware_cac_manager(struct amdgpu_device *adev)
 533 {
 534         struct kv_power_info *pi = kv_get_pi(adev);
 535
 536         if (pi->caps_cac) {
 537                 WREG32_SMC(ixLCAC_SX0_OVR_SEL, 0);
 538                 WREG32_SMC(ixLCAC_SX0_OVR_VAL, 0);
 539                 kv_program_local_cac_table(adev, sx_local_cac_cfg_kv, sx0_cac_config_reg);
 540
 541                 WREG32_SMC(ixLCAC_MC0_OVR_SEL, 0);
 542                 WREG32_SMC(ixLCAC_MC0_OVR_VAL, 0);
 543                 kv_program_local_cac_table(adev, mc0_local_cac_cfg_kv, mc0_cac_config_reg);
 544
 545                 WREG32_SMC(ixLCAC_MC1_OVR_SEL, 0);
 546                 WREG32_SMC(ixLCAC_MC1_OVR_VAL, 0);
 547                 kv_program_local_cac_table(adev, mc1_local_cac_cfg_kv, mc1_cac_config_reg);
 548
 549                 WREG32_SMC(ixLCAC_MC2_OVR_SEL, 0);
 550                 WREG32_SMC(ixLCAC_MC2_OVR_VAL, 0);
 551                 kv_program_local_cac_table(adev, mc2_local_cac_cfg_kv, mc2_cac_config_reg);
 552
 553                 WREG32_SMC(ixLCAC_MC3_OVR_SEL, 0);
 554                 WREG32_SMC(ixLCAC_MC3_OVR_VAL, 0);
 555                 kv_program_local_cac_table(adev, mc3_local_cac_cfg_kv, mc3_cac_config_reg);
 556
 557                 WREG32_SMC(ixLCAC_CPL_OVR_SEL, 0);
 558                 WREG32_SMC(ixLCAC_CPL_OVR_VAL, 0);
 559                 kv_program_local_cac_table(adev, cpl_local_cac_cfg_kv, cpl_cac_config_reg);
 560         }
 561 }
 562 #endif
 563
 564 static int kv_enable_smc_cac(struct amdgpu_device *adev, bool enable)
 565 {
 566         struct kv_power_info *pi = kv_get_pi(adev);
 567         int ret = 0;
 568
 569         if (pi->caps_cac) {
 570                 if (enable) {
 571                         ret = amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_EnableCac);
 572                         if (ret)
 573                                 pi->cac_enabled = false;
 574                         else
 575                                 pi->cac_enabled = true;
 576                 } else if (pi->cac_enabled) {
 577                         amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_DisableCac);
 578                         pi->cac_enabled = false;
 579                 }
 580         }
 581
 582         return ret;
 583 }
 584
 585 static int kv_process_firmware_header(struct amdgpu_device *adev)
 586 {
 587         struct kv_power_info *pi = kv_get_pi(adev);
 588         u32 tmp;
 589         int ret;
 590
 591         ret = amdgpu_kv_read_smc_sram_dword(adev, SMU7_FIRMWARE_HEADER_LOCATION +
 592                                      offsetof(SMU7_Firmware_Header, DpmTable),
 593                                      &tmp, pi->sram_end);
 594
 595         if (ret == 0)
 596                 pi->dpm_table_start = tmp;
 597
 598         ret = amdgpu_kv_read_smc_sram_dword(adev, SMU7_FIRMWARE_HEADER_LOCATION +
 599                                      offsetof(SMU7_Firmware_Header, SoftRegisters),
 600                                      &tmp, pi->sram_end);
 601
 602         if (ret == 0)
 603                 pi->soft_regs_start = tmp;
 604
 605         return ret;
 606 }
 607
 608 static int kv_enable_dpm_voltage_scaling(struct amdgpu_device *adev)
 609 {
 610         struct kv_power_info *pi = kv_get_pi(adev);
 611         int ret;
 612
 613         pi->graphics_voltage_change_enable = 1;
 614
 615         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 616                                    pi->dpm_table_start +
 617                                    offsetof(SMU7_Fusion_DpmTable, GraphicsVoltageChangeEnable),
 618                                    &pi->graphics_voltage_change_enable,
 619                                    sizeof(u8), pi->sram_end);
 620
 621         return ret;
 622 }
 623
 624 static int kv_set_dpm_interval(struct amdgpu_device *adev)
 625 {
 626         struct kv_power_info *pi = kv_get_pi(adev);
 627         int ret;
 628
 629         pi->graphics_interval = 1;
 630
 631         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 632                                    pi->dpm_table_start +
 633                                    offsetof(SMU7_Fusion_DpmTable, GraphicsInterval),
 634                                    &pi->graphics_interval,
 635                                    sizeof(u8), pi->sram_end);
 636
 637         return ret;
 638 }
 639
 640 static int kv_set_dpm_boot_state(struct amdgpu_device *adev)
 641 {
 642         struct kv_power_info *pi = kv_get_pi(adev);
 643         int ret;
 644
 645         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 646                                    pi->dpm_table_start +
 647                                    offsetof(SMU7_Fusion_DpmTable, GraphicsBootLevel),
 648                                    &pi->graphics_boot_level,
 649                                    sizeof(u8), pi->sram_end);
 650
 651         return ret;
 652 }
 653
 654 static void kv_program_vc(struct amdgpu_device *adev)
 655 {
 656         WREG32_SMC(ixCG_FREQ_TRAN_VOTING_0, 0x3FFFC100);
 657 }
 658
 659 static void kv_clear_vc(struct amdgpu_device *adev)
 660 {
 661         WREG32_SMC(ixCG_FREQ_TRAN_VOTING_0, 0);
 662 }
 663
 664 static int kv_set_divider_value(struct amdgpu_device *adev,
 665                                 u32 index, u32 sclk)
 666 {
 667         struct kv_power_info *pi = kv_get_pi(adev);
 668         struct atom_clock_dividers dividers;
 669         int ret;
 670
 671         ret = amdgpu_atombios_get_clock_dividers(adev, COMPUTE_ENGINE_PLL_PARAM,
 672                                                  sclk, false, &dividers);
 673         if (ret)
 674                 return ret;
 675
 676         pi->graphics_level[index].SclkDid = (u8)dividers.post_div;
 677         pi->graphics_level[index].SclkFrequency = cpu_to_be32(sclk);
 678
 679         return 0;
 680 }
 681
 682 static u16 kv_convert_8bit_index_to_voltage(struct amdgpu_device *adev,
 683                                             u16 voltage)
 684 {
 685         return 6200 - (voltage * 25);
 686 }
 687
 688 static u16 kv_convert_2bit_index_to_voltage(struct amdgpu_device *adev,
 689                                             u32 vid_2bit)
 690 {
 691         struct kv_power_info *pi = kv_get_pi(adev);
 692         u32 vid_8bit = kv_convert_vid2_to_vid7(adev,
 693                                                &pi->sys_info.vid_mapping_table,
 694                                                vid_2bit);
 695
 696         return kv_convert_8bit_index_to_voltage(adev, (u16)vid_8bit);
 697 }
 698
 699
 700 static int kv_set_vid(struct amdgpu_device *adev, u32 index, u32 vid)
 701 {
 702         struct kv_power_info *pi = kv_get_pi(adev);
 703
 704         pi->graphics_level[index].VoltageDownH = (u8)pi->voltage_drop_t;
 705         pi->graphics_level[index].MinVddNb =
 706                 cpu_to_be32(kv_convert_2bit_index_to_voltage(adev, vid));
 707
 708         return 0;
 709 }
 710
 711 static int kv_set_at(struct amdgpu_device *adev, u32 index, u32 at)
 712 {
 713         struct kv_power_info *pi = kv_get_pi(adev);
 714
 715         pi->graphics_level[index].AT = cpu_to_be16((u16)at);
 716
 717         return 0;
 718 }
 719
 720 static void kv_dpm_power_level_enable(struct amdgpu_device *adev,
 721                                       u32 index, bool enable)
 722 {
 723         struct kv_power_info *pi = kv_get_pi(adev);
 724
 725         pi->graphics_level[index].EnabledForActivity = enable ? 1 : 0;
 726 }
 727
 728 static void kv_start_dpm(struct amdgpu_device *adev)
 729 {
 730         u32 tmp = RREG32_SMC(ixGENERAL_PWRMGT);
 731
 732         tmp |= GENERAL_PWRMGT__GLOBAL_PWRMGT_EN_MASK;
 733         WREG32_SMC(ixGENERAL_PWRMGT, tmp);
 734
 735         amdgpu_kv_smc_dpm_enable(adev, true);
 736 }
 737
 738 static void kv_stop_dpm(struct amdgpu_device *adev)
 739 {
 740         amdgpu_kv_smc_dpm_enable(adev, false);
 741 }
 742
 743 static void kv_start_am(struct amdgpu_device *adev)
 744 {
 745         u32 sclk_pwrmgt_cntl = RREG32_SMC(ixSCLK_PWRMGT_CNTL);
 746
 747         sclk_pwrmgt_cntl &= ~(SCLK_PWRMGT_CNTL__RESET_SCLK_CNT_MASK |
 748                         SCLK_PWRMGT_CNTL__RESET_BUSY_CNT_MASK);
 749         sclk_pwrmgt_cntl |= SCLK_PWRMGT_CNTL__DYNAMIC_PM_EN_MASK;
 750
 751         WREG32_SMC(ixSCLK_PWRMGT_CNTL, sclk_pwrmgt_cntl);
 752 }
 753
 754 static void kv_reset_am(struct amdgpu_device *adev)
 755 {
 756         u32 sclk_pwrmgt_cntl = RREG32_SMC(ixSCLK_PWRMGT_CNTL);
 757
 758         sclk_pwrmgt_cntl |= (SCLK_PWRMGT_CNTL__RESET_SCLK_CNT_MASK |
 759                         SCLK_PWRMGT_CNTL__RESET_BUSY_CNT_MASK);
 760
 761         WREG32_SMC(ixSCLK_PWRMGT_CNTL, sclk_pwrmgt_cntl);
 762 }
 763
 764 static int kv_freeze_sclk_dpm(struct amdgpu_device *adev, bool freeze)
 765 {
 766         return amdgpu_kv_notify_message_to_smu(adev, freeze ?
 767                                         PPSMC_MSG_SCLKDPM_FreezeLevel : PPSMC_MSG_SCLKDPM_UnfreezeLevel);
 768 }
 769
 770 static int kv_force_lowest_valid(struct amdgpu_device *adev)
 771 {
 772         return kv_force_dpm_lowest(adev);
 773 }
 774
 775 static int kv_unforce_levels(struct amdgpu_device *adev)
 776 {
 777         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS)
 778                 return amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_NoForcedLevel);
 779         else
 780                 return kv_set_enabled_levels(adev);
 781 }
 782
 783 static int kv_update_sclk_t(struct amdgpu_device *adev)
 784 {
 785         struct kv_power_info *pi = kv_get_pi(adev);
 786         u32 low_sclk_interrupt_t = 0;
 787         int ret = 0;
 788
 789         if (pi->caps_sclk_throttle_low_notification) {
 790                 low_sclk_interrupt_t = cpu_to_be32(pi->low_sclk_interrupt_t);
 791
 792                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
 793                                            pi->dpm_table_start +
 794                                            offsetof(SMU7_Fusion_DpmTable, LowSclkInterruptT),
 795                                            (u8 *)&low_sclk_interrupt_t,
 796                                            sizeof(u32), pi->sram_end);
 797         }
 798         return ret;
 799 }
 800
 801 static int kv_program_bootup_state(struct amdgpu_device *adev)
 802 {
 803         struct kv_power_info *pi = kv_get_pi(adev);
 804         u32 i;
 805         struct amdgpu_clock_voltage_dependency_table *table =
 806                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
 807
 808         if (table && table->count) {
 809                 for (i = pi->graphics_dpm_level_count - 1; i > 0; i--) {
 810                         if (table->entries[i].clk == pi->boot_pl.sclk)
 811                                 break;
 812                 }
 813
 814                 pi->graphics_boot_level = (u8)i;
 815                 kv_dpm_power_level_enable(adev, i, true);
 816         } else {
 817                 struct sumo_sclk_voltage_mapping_table *table =
 818                         &pi->sys_info.sclk_voltage_mapping_table;
 819
 820                 if (table->num_max_dpm_entries == 0)
 821                         return -EINVAL;
 822
 823                 for (i = pi->graphics_dpm_level_count - 1; i > 0; i--) {
 824                         if (table->entries[i].sclk_frequency == pi->boot_pl.sclk)
 825                                 break;
 826                 }
 827
 828                 pi->graphics_boot_level = (u8)i;
 829                 kv_dpm_power_level_enable(adev, i, true);
 830         }
 831         return 0;
 832 }
 833
 834 static int kv_enable_auto_thermal_throttling(struct amdgpu_device *adev)
 835 {
 836         struct kv_power_info *pi = kv_get_pi(adev);
 837         int ret;
 838
 839         pi->graphics_therm_throttle_enable = 1;
 840
 841         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 842                                    pi->dpm_table_start +
 843                                    offsetof(SMU7_Fusion_DpmTable, GraphicsThermThrottleEnable),
 844                                    &pi->graphics_therm_throttle_enable,
 845                                    sizeof(u8), pi->sram_end);
 846
 847         return ret;
 848 }
 849
 850 static int kv_upload_dpm_settings(struct amdgpu_device *adev)
 851 {
 852         struct kv_power_info *pi = kv_get_pi(adev);
 853         int ret;
 854
 855         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 856                                    pi->dpm_table_start +
 857                                    offsetof(SMU7_Fusion_DpmTable, GraphicsLevel),
 858                                    (u8 *)&pi->graphics_level,
 859                                    sizeof(SMU7_Fusion_GraphicsLevel) * SMU7_MAX_LEVELS_GRAPHICS,
 860                                    pi->sram_end);
 861
 862         if (ret)
 863                 return ret;
 864
 865         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 866                                    pi->dpm_table_start +
 867                                    offsetof(SMU7_Fusion_DpmTable, GraphicsDpmLevelCount),
 868                                    &pi->graphics_dpm_level_count,
 869                                    sizeof(u8), pi->sram_end);
 870
 871         return ret;
 872 }
 873
 874 static u32 kv_get_clock_difference(u32 a, u32 b)
 875 {
 876         return (a >= b) ? a - b : b - a;
 877 }
 878
 879 static u32 kv_get_clk_bypass(struct amdgpu_device *adev, u32 clk)
 880 {
 881         struct kv_power_info *pi = kv_get_pi(adev);
 882         u32 value;
 883
 884         if (pi->caps_enable_dfs_bypass) {
 885                 if (kv_get_clock_difference(clk, 40000) < 200)
 886                         value = 3;
 887                 else if (kv_get_clock_difference(clk, 30000) < 200)
 888                         value = 2;
 889                 else if (kv_get_clock_difference(clk, 20000) < 200)
 890                         value = 7;
 891                 else if (kv_get_clock_difference(clk, 15000) < 200)
 892                         value = 6;
 893                 else if (kv_get_clock_difference(clk, 10000) < 200)
 894                         value = 8;
 895                 else
 896                         value = 0;
 897         } else {
 898                 value = 0;
 899         }
 900
 901         return value;
 902 }
 903
 904 static int kv_populate_uvd_table(struct amdgpu_device *adev)
 905 {
 906         struct kv_power_info *pi = kv_get_pi(adev);
 907         struct amdgpu_uvd_clock_voltage_dependency_table *table =
 908                 &adev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table;
 909         struct atom_clock_dividers dividers;
 910         int ret;
 911         u32 i;
 912
 913         if (table == NULL || table->count == 0)
 914                 return 0;
 915
 916         pi->uvd_level_count = 0;
 917         for (i = 0; i < table->count; i++) {
 918                 if (pi->high_voltage_t &&
 919                     (pi->high_voltage_t < table->entries[i].v))
 920                         break;
 921
 922                 pi->uvd_level[i].VclkFrequency = cpu_to_be32(table->entries[i].vclk);
 923                 pi->uvd_level[i].DclkFrequency = cpu_to_be32(table->entries[i].dclk);
 924                 pi->uvd_level[i].MinVddNb = cpu_to_be16(table->entries[i].v);
 925
 926                 pi->uvd_level[i].VClkBypassCntl =
 927                         (u8)kv_get_clk_bypass(adev, table->entries[i].vclk);
 928                 pi->uvd_level[i].DClkBypassCntl =
 929                         (u8)kv_get_clk_bypass(adev, table->entries[i].dclk);
 930
 931                 ret = amdgpu_atombios_get_clock_dividers(adev, COMPUTE_ENGINE_PLL_PARAM,
 932                                                          table->entries[i].vclk, false, &dividers);
 933                 if (ret)
 934                         return ret;
 935                 pi->uvd_level[i].VclkDivider = (u8)dividers.post_div;
 936
 937                 ret = amdgpu_atombios_get_clock_dividers(adev, COMPUTE_ENGINE_PLL_PARAM,
 938                                                          table->entries[i].dclk, false, &dividers);
 939                 if (ret)
 940                         return ret;
 941                 pi->uvd_level[i].DclkDivider = (u8)dividers.post_div;
 942
 943                 pi->uvd_level_count++;
 944         }
 945
 946         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 947                                    pi->dpm_table_start +
 948                                    offsetof(SMU7_Fusion_DpmTable, UvdLevelCount),
 949                                    (u8 *)&pi->uvd_level_count,
 950                                    sizeof(u8), pi->sram_end);
 951         if (ret)
 952                 return ret;
 953
 954         pi->uvd_interval = 1;
 955
 956         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 957                                    pi->dpm_table_start +
 958                                    offsetof(SMU7_Fusion_DpmTable, UVDInterval),
 959                                    &pi->uvd_interval,
 960                                    sizeof(u8), pi->sram_end);
 961         if (ret)
 962                 return ret;
 963
 964         ret = amdgpu_kv_copy_bytes_to_smc(adev,
 965                                    pi->dpm_table_start +
 966                                    offsetof(SMU7_Fusion_DpmTable, UvdLevel),
 967                                    (u8 *)&pi->uvd_level,
 968                                    sizeof(SMU7_Fusion_UvdLevel) * SMU7_MAX_LEVELS_UVD,
 969                                    pi->sram_end);
 970
 971         return ret;
 972
 973 }
 974
 975 static int kv_populate_vce_table(struct amdgpu_device *adev)
 976 {
 977         struct kv_power_info *pi = kv_get_pi(adev);
 978         int ret;
 979         u32 i;
 980         struct amdgpu_vce_clock_voltage_dependency_table *table =
 981                 &adev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table;
 982         struct atom_clock_dividers dividers;
 983
 984         if (table == NULL || table->count == 0)
 985                 return 0;
 986
 987         pi->vce_level_count = 0;
 988         for (i = 0; i < table->count; i++) {
 989                 if (pi->high_voltage_t &&
 990                     pi->high_voltage_t < table->entries[i].v)
 991                         break;
 992
 993                 pi->vce_level[i].Frequency = cpu_to_be32(table->entries[i].evclk);
 994                 pi->vce_level[i].MinVoltage = cpu_to_be16(table->entries[i].v);
 995
 996                 pi->vce_level[i].ClkBypassCntl =
 997                         (u8)kv_get_clk_bypass(adev, table->entries[i].evclk);
 998
 999                 ret = amdgpu_atombios_get_clock_dividers(adev, COMPUTE_ENGINE_PLL_PARAM,
1000                                                          table->entries[i].evclk, false, &dividers);
1001                 if (ret)
1002                         return ret;
1003                 pi->vce_level[i].Divider = (u8)dividers.post_div;
1004
1005                 pi->vce_level_count++;
1006         }
1007
1008         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1009                                    pi->dpm_table_start +
1010                                    offsetof(SMU7_Fusion_DpmTable, VceLevelCount),
1011                                    (u8 *)&pi->vce_level_count,
1012                                    sizeof(u8),
1013                                    pi->sram_end);
1014         if (ret)
1015                 return ret;
1016
1017         pi->vce_interval = 1;
1018
1019         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1020                                    pi->dpm_table_start +
1021                                    offsetof(SMU7_Fusion_DpmTable, VCEInterval),
1022                                    (u8 *)&pi->vce_interval,
1023                                    sizeof(u8),
1024                                    pi->sram_end);
1025         if (ret)
1026                 return ret;
1027
1028         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1029                                    pi->dpm_table_start +
1030                                    offsetof(SMU7_Fusion_DpmTable, VceLevel),
1031                                    (u8 *)&pi->vce_level,
1032                                    sizeof(SMU7_Fusion_ExtClkLevel) * SMU7_MAX_LEVELS_VCE,
1033                                    pi->sram_end);
1034
1035         return ret;
1036 }
1037
1038 static int kv_populate_samu_table(struct amdgpu_device *adev)
1039 {
1040         struct kv_power_info *pi = kv_get_pi(adev);
1041         struct amdgpu_clock_voltage_dependency_table *table =
1042                 &adev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table;
1043         struct atom_clock_dividers dividers;
1044         int ret;
1045         u32 i;
1046
1047         if (table == NULL || table->count == 0)
1048                 return 0;
1049
1050         pi->samu_level_count = 0;
1051         for (i = 0; i < table->count; i++) {
1052                 if (pi->high_voltage_t &&
1053                     pi->high_voltage_t < table->entries[i].v)
1054                         break;
1055
1056                 pi->samu_level[i].Frequency = cpu_to_be32(table->entries[i].clk);
1057                 pi->samu_level[i].MinVoltage = cpu_to_be16(table->entries[i].v);
1058
1059                 pi->samu_level[i].ClkBypassCntl =
1060                         (u8)kv_get_clk_bypass(adev, table->entries[i].clk);
1061
1062                 ret = amdgpu_atombios_get_clock_dividers(adev, COMPUTE_ENGINE_PLL_PARAM,
1063                                                          table->entries[i].clk, false, &dividers);
1064                 if (ret)
1065                         return ret;
1066                 pi->samu_level[i].Divider = (u8)dividers.post_div;
1067
1068                 pi->samu_level_count++;
1069         }
1070
1071         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1072                                    pi->dpm_table_start +
1073                                    offsetof(SMU7_Fusion_DpmTable, SamuLevelCount),
1074                                    (u8 *)&pi->samu_level_count,
1075                                    sizeof(u8),
1076                                    pi->sram_end);
1077         if (ret)
1078                 return ret;
1079
1080         pi->samu_interval = 1;
1081
1082         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1083                                    pi->dpm_table_start +
1084                                    offsetof(SMU7_Fusion_DpmTable, SAMUInterval),
1085                                    (u8 *)&pi->samu_interval,
1086                                    sizeof(u8),
1087                                    pi->sram_end);
1088         if (ret)
1089                 return ret;
1090
1091         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1092                                    pi->dpm_table_start +
1093                                    offsetof(SMU7_Fusion_DpmTable, SamuLevel),
1094                                    (u8 *)&pi->samu_level,
1095                                    sizeof(SMU7_Fusion_ExtClkLevel) * SMU7_MAX_LEVELS_SAMU,
1096                                    pi->sram_end);
1097         if (ret)
1098                 return ret;
1099
1100         return ret;
1101 }
1102
1103
1104 static int kv_populate_acp_table(struct amdgpu_device *adev)
1105 {
1106         struct kv_power_info *pi = kv_get_pi(adev);
1107         struct amdgpu_clock_voltage_dependency_table *table =
1108                 &adev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table;
1109         struct atom_clock_dividers dividers;
1110         int ret;
1111         u32 i;
1112
1113         if (table == NULL || table->count == 0)
1114                 return 0;
1115
1116         pi->acp_level_count = 0;
1117         for (i = 0; i < table->count; i++) {
1118                 pi->acp_level[i].Frequency = cpu_to_be32(table->entries[i].clk);
1119                 pi->acp_level[i].MinVoltage = cpu_to_be16(table->entries[i].v);
1120
1121                 ret = amdgpu_atombios_get_clock_dividers(adev, COMPUTE_ENGINE_PLL_PARAM,
1122                                                          table->entries[i].clk, false, &dividers);
1123                 if (ret)
1124                         return ret;
1125                 pi->acp_level[i].Divider = (u8)dividers.post_div;
1126
1127                 pi->acp_level_count++;
1128         }
1129
1130         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1131                                    pi->dpm_table_start +
1132                                    offsetof(SMU7_Fusion_DpmTable, AcpLevelCount),
1133                                    (u8 *)&pi->acp_level_count,
1134                                    sizeof(u8),
1135                                    pi->sram_end);
1136         if (ret)
1137                 return ret;
1138
1139         pi->acp_interval = 1;
1140
1141         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1142                                    pi->dpm_table_start +
1143                                    offsetof(SMU7_Fusion_DpmTable, ACPInterval),
1144                                    (u8 *)&pi->acp_interval,
1145                                    sizeof(u8),
1146                                    pi->sram_end);
1147         if (ret)
1148                 return ret;
1149
1150         ret = amdgpu_kv_copy_bytes_to_smc(adev,
1151                                    pi->dpm_table_start +
1152                                    offsetof(SMU7_Fusion_DpmTable, AcpLevel),
1153                                    (u8 *)&pi->acp_level,
1154                                    sizeof(SMU7_Fusion_ExtClkLevel) * SMU7_MAX_LEVELS_ACP,
1155                                    pi->sram_end);
1156         if (ret)
1157                 return ret;
1158
1159         return ret;
1160 }
1161
1162 static void kv_calculate_dfs_bypass_settings(struct amdgpu_device *adev)
1163 {
1164         struct kv_power_info *pi = kv_get_pi(adev);
1165         u32 i;
1166         struct amdgpu_clock_voltage_dependency_table *table =
1167                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
1168
1169         if (table && table->count) {
1170                 for (i = 0; i < pi->graphics_dpm_level_count; i++) {
1171                         if (pi->caps_enable_dfs_bypass) {
1172                                 if (kv_get_clock_difference(table->entries[i].clk, 40000) < 200)
1173                                         pi->graphics_level[i].ClkBypassCntl = 3;
1174                                 else if (kv_get_clock_difference(table->entries[i].clk, 30000) < 200)
1175                                         pi->graphics_level[i].ClkBypassCntl = 2;
1176                                 else if (kv_get_clock_difference(table->entries[i].clk, 26600) < 200)
1177                                         pi->graphics_level[i].ClkBypassCntl = 7;
1178                                 else if (kv_get_clock_difference(table->entries[i].clk , 20000) < 200)
1179                                         pi->graphics_level[i].ClkBypassCntl = 6;
1180                                 else if (kv_get_clock_difference(table->entries[i].clk , 10000) < 200)
1181                                         pi->graphics_level[i].ClkBypassCntl = 8;
1182                                 else
1183                                         pi->graphics_level[i].ClkBypassCntl = 0;
1184                         } else {
1185                                 pi->graphics_level[i].ClkBypassCntl = 0;
1186                         }
1187                 }
1188         } else {
1189                 struct sumo_sclk_voltage_mapping_table *table =
1190                         &pi->sys_info.sclk_voltage_mapping_table;
1191                 for (i = 0; i < pi->graphics_dpm_level_count; i++) {
1192                         if (pi->caps_enable_dfs_bypass) {
1193                                 if (kv_get_clock_difference(table->entries[i].sclk_frequency, 40000) < 200)
1194                                         pi->graphics_level[i].ClkBypassCntl = 3;
1195                                 else if (kv_get_clock_difference(table->entries[i].sclk_frequency, 30000) < 200)
1196                                         pi->graphics_level[i].ClkBypassCntl = 2;
1197                                 else if (kv_get_clock_difference(table->entries[i].sclk_frequency, 26600) < 200)
1198                                         pi->graphics_level[i].ClkBypassCntl = 7;
1199                                 else if (kv_get_clock_difference(table->entries[i].sclk_frequency, 20000) < 200)
1200                                         pi->graphics_level[i].ClkBypassCntl = 6;
1201                                 else if (kv_get_clock_difference(table->entries[i].sclk_frequency, 10000) < 200)
1202                                         pi->graphics_level[i].ClkBypassCntl = 8;
1203                                 else
1204                                         pi->graphics_level[i].ClkBypassCntl = 0;
1205                         } else {
1206                                 pi->graphics_level[i].ClkBypassCntl = 0;
1207                         }
1208                 }
1209         }
1210 }
1211
1212 static int kv_enable_ulv(struct amdgpu_device *adev, bool enable)
1213 {
1214         return amdgpu_kv_notify_message_to_smu(adev, enable ?
1215                                         PPSMC_MSG_EnableULV : PPSMC_MSG_DisableULV);
1216 }
1217
1218 static void kv_reset_acp_boot_level(struct amdgpu_device *adev)
1219 {
1220         struct kv_power_info *pi = kv_get_pi(adev);
1221
1222         pi->acp_boot_level = 0xff;
1223 }
1224
1225 static void kv_update_current_ps(struct amdgpu_device *adev,
1226                                  struct amdgpu_ps *rps)
1227 {
1228         struct kv_ps *new_ps = kv_get_ps(rps);
1229         struct kv_power_info *pi = kv_get_pi(adev);
1230
1231         pi->current_rps = *rps;
1232         pi->current_ps = *new_ps;
1233         pi->current_rps.ps_priv = &pi->current_ps;
1234         adev->pm.dpm.current_ps = &pi->current_rps;
1235 }
1236
1237 static void kv_update_requested_ps(struct amdgpu_device *adev,
1238                                    struct amdgpu_ps *rps)
1239 {
1240         struct kv_ps *new_ps = kv_get_ps(rps);
1241         struct kv_power_info *pi = kv_get_pi(adev);
1242
1243         pi->requested_rps = *rps;
1244         pi->requested_ps = *new_ps;
1245         pi->requested_rps.ps_priv = &pi->requested_ps;
1246         adev->pm.dpm.requested_ps = &pi->requested_rps;
1247 }
1248
1249 static void kv_dpm_enable_bapm(void *handle, bool enable)
1250 {
1251         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1252         struct kv_power_info *pi = kv_get_pi(adev);
1253         int ret;
1254
1255         if (pi->bapm_enable) {
1256                 ret = amdgpu_kv_smc_bapm_enable(adev, enable);
1257                 if (ret)
1258                         DRM_ERROR("amdgpu_kv_smc_bapm_enable failed\n");
1259         }
1260 }
1261
1262 static int kv_dpm_enable(struct amdgpu_device *adev)
1263 {
1264         struct kv_power_info *pi = kv_get_pi(adev);
1265         int ret;
1266
1267         ret = kv_process_firmware_header(adev);
1268         if (ret) {
1269                 DRM_ERROR("kv_process_firmware_header failed\n");
1270                 return ret;
1271         }
1272         kv_init_fps_limits(adev);
1273         kv_init_graphics_levels(adev);
1274         ret = kv_program_bootup_state(adev);
1275         if (ret) {
1276                 DRM_ERROR("kv_program_bootup_state failed\n");
1277                 return ret;
1278         }
1279         kv_calculate_dfs_bypass_settings(adev);
1280         ret = kv_upload_dpm_settings(adev);
1281         if (ret) {
1282                 DRM_ERROR("kv_upload_dpm_settings failed\n");
1283                 return ret;
1284         }
1285         ret = kv_populate_uvd_table(adev);
1286         if (ret) {
1287                 DRM_ERROR("kv_populate_uvd_table failed\n");
1288                 return ret;
1289         }
1290         ret = kv_populate_vce_table(adev);
1291         if (ret) {
1292                 DRM_ERROR("kv_populate_vce_table failed\n");
1293                 return ret;
1294         }
1295         ret = kv_populate_samu_table(adev);
1296         if (ret) {
1297                 DRM_ERROR("kv_populate_samu_table failed\n");
1298                 return ret;
1299         }
1300         ret = kv_populate_acp_table(adev);
1301         if (ret) {
1302                 DRM_ERROR("kv_populate_acp_table failed\n");
1303                 return ret;
1304         }
1305         kv_program_vc(adev);
1306 #if 0
1307         kv_initialize_hardware_cac_manager(adev);
1308 #endif
1309         kv_start_am(adev);
1310         if (pi->enable_auto_thermal_throttling) {
1311                 ret = kv_enable_auto_thermal_throttling(adev);
1312                 if (ret) {
1313                         DRM_ERROR("kv_enable_auto_thermal_throttling failed\n");
1314                         return ret;
1315                 }
1316         }
1317         ret = kv_enable_dpm_voltage_scaling(adev);
1318         if (ret) {
1319                 DRM_ERROR("kv_enable_dpm_voltage_scaling failed\n");
1320                 return ret;
1321         }
1322         ret = kv_set_dpm_interval(adev);
1323         if (ret) {
1324                 DRM_ERROR("kv_set_dpm_interval failed\n");
1325                 return ret;
1326         }
1327         ret = kv_set_dpm_boot_state(adev);
1328         if (ret) {
1329                 DRM_ERROR("kv_set_dpm_boot_state failed\n");
1330                 return ret;
1331         }
1332         ret = kv_enable_ulv(adev, true);
1333         if (ret) {
1334                 DRM_ERROR("kv_enable_ulv failed\n");
1335                 return ret;
1336         }
1337         kv_start_dpm(adev);
1338         ret = kv_enable_didt(adev, true);
1339         if (ret) {
1340                 DRM_ERROR("kv_enable_didt failed\n");
1341                 return ret;
1342         }
1343         ret = kv_enable_smc_cac(adev, true);
1344         if (ret) {
1345                 DRM_ERROR("kv_enable_smc_cac failed\n");
1346                 return ret;
1347         }
1348
1349         kv_reset_acp_boot_level(adev);
1350
1351         ret = amdgpu_kv_smc_bapm_enable(adev, false);
1352         if (ret) {
1353                 DRM_ERROR("amdgpu_kv_smc_bapm_enable failed\n");
1354                 return ret;
1355         }
1356
1357         kv_update_current_ps(adev, adev->pm.dpm.boot_ps);
1358
1359         if (adev->irq.installed &&
1360             amdgpu_is_internal_thermal_sensor(adev->pm.int_thermal_type)) {
1361                 ret = kv_set_thermal_temperature_range(adev, KV_TEMP_RANGE_MIN, KV_TEMP_RANGE_MAX);
1362                 if (ret) {
1363                         DRM_ERROR("kv_set_thermal_temperature_range failed\n");
1364                         return ret;
1365                 }
1366                 amdgpu_irq_get(adev, &adev->pm.dpm.thermal.irq,
1367                                AMDGPU_THERMAL_IRQ_LOW_TO_HIGH);
1368                 amdgpu_irq_get(adev, &adev->pm.dpm.thermal.irq,
1369                                AMDGPU_THERMAL_IRQ_HIGH_TO_LOW);
1370         }
1371
1372         return ret;
1373 }
1374
1375 static void kv_dpm_disable(struct amdgpu_device *adev)
1376 {
1377         amdgpu_irq_put(adev, &adev->pm.dpm.thermal.irq,
1378                        AMDGPU_THERMAL_IRQ_LOW_TO_HIGH);
1379         amdgpu_irq_put(adev, &adev->pm.dpm.thermal.irq,
1380                        AMDGPU_THERMAL_IRQ_HIGH_TO_LOW);
1381
1382         amdgpu_kv_smc_bapm_enable(adev, false);
1383
1384         if (adev->asic_type == CHIP_MULLINS)
1385                 kv_enable_nb_dpm(adev, false);
1386
1387         /* powerup blocks */
1388         kv_dpm_powergate_acp(adev, false);
1389         kv_dpm_powergate_samu(adev, false);
1390         kv_dpm_powergate_vce(adev, false);
1391         kv_dpm_powergate_uvd(adev, false);
1392
1393         kv_enable_smc_cac(adev, false);
1394         kv_enable_didt(adev, false);
1395         kv_clear_vc(adev);
1396         kv_stop_dpm(adev);
1397         kv_enable_ulv(adev, false);
1398         kv_reset_am(adev);
1399
1400         kv_update_current_ps(adev, adev->pm.dpm.boot_ps);
1401 }
1402
1403 #if 0
1404 static int kv_write_smc_soft_register(struct amdgpu_device *adev,
1405                                       u16 reg_offset, u32 value)
1406 {
1407         struct kv_power_info *pi = kv_get_pi(adev);
1408
1409         return amdgpu_kv_copy_bytes_to_smc(adev, pi->soft_regs_start + reg_offset,
1410                                     (u8 *)&value, sizeof(u16), pi->sram_end);
1411 }
1412
1413 static int kv_read_smc_soft_register(struct amdgpu_device *adev,
1414                                      u16 reg_offset, u32 *value)
1415 {
1416         struct kv_power_info *pi = kv_get_pi(adev);
1417
1418         return amdgpu_kv_read_smc_sram_dword(adev, pi->soft_regs_start + reg_offset,
1419                                       value, pi->sram_end);
1420 }
1421 #endif
1422
1423 static void kv_init_sclk_t(struct amdgpu_device *adev)
1424 {
1425         struct kv_power_info *pi = kv_get_pi(adev);
1426
1427         pi->low_sclk_interrupt_t = 0;
1428 }
1429
1430 static int kv_init_fps_limits(struct amdgpu_device *adev)
1431 {
1432         struct kv_power_info *pi = kv_get_pi(adev);
1433         int ret = 0;
1434
1435         if (pi->caps_fps) {
1436                 u16 tmp;
1437
1438                 tmp = 45;
1439                 pi->fps_high_t = cpu_to_be16(tmp);
1440                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
1441                                            pi->dpm_table_start +
1442                                            offsetof(SMU7_Fusion_DpmTable, FpsHighT),
1443                                            (u8 *)&pi->fps_high_t,
1444                                            sizeof(u16), pi->sram_end);
1445
1446                 tmp = 30;
1447                 pi->fps_low_t = cpu_to_be16(tmp);
1448
1449                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
1450                                            pi->dpm_table_start +
1451                                            offsetof(SMU7_Fusion_DpmTable, FpsLowT),
1452                                            (u8 *)&pi->fps_low_t,
1453                                            sizeof(u16), pi->sram_end);
1454
1455         }
1456         return ret;
1457 }
1458
1459 static void kv_init_powergate_state(struct amdgpu_device *adev)
1460 {
1461         struct kv_power_info *pi = kv_get_pi(adev);
1462
1463         pi->uvd_power_gated = false;
1464         pi->vce_power_gated = false;
1465         pi->samu_power_gated = false;
1466         pi->acp_power_gated = false;
1467
1468 }
1469
1470 static int kv_enable_uvd_dpm(struct amdgpu_device *adev, bool enable)
1471 {
1472         return amdgpu_kv_notify_message_to_smu(adev, enable ?
1473                                         PPSMC_MSG_UVDDPM_Enable : PPSMC_MSG_UVDDPM_Disable);
1474 }
1475
1476 static int kv_enable_vce_dpm(struct amdgpu_device *adev, bool enable)
1477 {
1478         return amdgpu_kv_notify_message_to_smu(adev, enable ?
1479                                         PPSMC_MSG_VCEDPM_Enable : PPSMC_MSG_VCEDPM_Disable);
1480 }
1481
1482 static int kv_enable_samu_dpm(struct amdgpu_device *adev, bool enable)
1483 {
1484         return amdgpu_kv_notify_message_to_smu(adev, enable ?
1485                                         PPSMC_MSG_SAMUDPM_Enable : PPSMC_MSG_SAMUDPM_Disable);
1486 }
1487
1488 static int kv_enable_acp_dpm(struct amdgpu_device *adev, bool enable)
1489 {
1490         return amdgpu_kv_notify_message_to_smu(adev, enable ?
1491                                         PPSMC_MSG_ACPDPM_Enable : PPSMC_MSG_ACPDPM_Disable);
1492 }
1493
1494 static int kv_update_uvd_dpm(struct amdgpu_device *adev, bool gate)
1495 {
1496         struct kv_power_info *pi = kv_get_pi(adev);
1497         struct amdgpu_uvd_clock_voltage_dependency_table *table =
1498                 &adev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table;
1499         int ret;
1500         u32 mask;
1501
1502         if (!gate) {
1503                 if (table->count)
1504                         pi->uvd_boot_level = table->count - 1;
1505                 else
1506                         pi->uvd_boot_level = 0;
1507
1508                 if (!pi->caps_uvd_dpm || pi->caps_stable_p_state) {
1509                         mask = 1 << pi->uvd_boot_level;
1510                 } else {
1511                         mask = 0x1f;
1512                 }
1513
1514                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
1515                                            pi->dpm_table_start +
1516                                            offsetof(SMU7_Fusion_DpmTable, UvdBootLevel),
1517                                            (uint8_t *)&pi->uvd_boot_level,
1518                                            sizeof(u8), pi->sram_end);
1519                 if (ret)
1520                         return ret;
1521
1522                 amdgpu_kv_send_msg_to_smc_with_parameter(adev,
1523                                                   PPSMC_MSG_UVDDPM_SetEnabledMask,
1524                                                   mask);
1525         }
1526
1527         return kv_enable_uvd_dpm(adev, !gate);
1528 }
1529
1530 static u8 kv_get_vce_boot_level(struct amdgpu_device *adev, u32 evclk)
1531 {
1532         u8 i;
1533         struct amdgpu_vce_clock_voltage_dependency_table *table =
1534                 &adev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table;
1535
1536         for (i = 0; i < table->count; i++) {
1537                 if (table->entries[i].evclk >= evclk)
1538                         break;
1539         }
1540
1541         return i;
1542 }
1543
1544 static int kv_update_vce_dpm(struct amdgpu_device *adev,
1545                              struct amdgpu_ps *amdgpu_new_state,
1546                              struct amdgpu_ps *amdgpu_current_state)
1547 {
1548         struct kv_power_info *pi = kv_get_pi(adev);
1549         struct amdgpu_vce_clock_voltage_dependency_table *table =
1550                 &adev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table;
1551         int ret;
1552
1553         if (amdgpu_new_state->evclk > 0 && amdgpu_current_state->evclk == 0) {
1554                 kv_dpm_powergate_vce(adev, false);
1555                 if (pi->caps_stable_p_state)
1556                         pi->vce_boot_level = table->count - 1;
1557                 else
1558                         pi->vce_boot_level = kv_get_vce_boot_level(adev, amdgpu_new_state->evclk);
1559
1560                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
1561                                            pi->dpm_table_start +
1562                                            offsetof(SMU7_Fusion_DpmTable, VceBootLevel),
1563                                            (u8 *)&pi->vce_boot_level,
1564                                            sizeof(u8),
1565                                            pi->sram_end);
1566                 if (ret)
1567                         return ret;
1568
1569                 if (pi->caps_stable_p_state)
1570                         amdgpu_kv_send_msg_to_smc_with_parameter(adev,
1571                                                           PPSMC_MSG_VCEDPM_SetEnabledMask,
1572                                                           (1 << pi->vce_boot_level));
1573                 kv_enable_vce_dpm(adev, true);
1574         } else if (amdgpu_new_state->evclk == 0 && amdgpu_current_state->evclk > 0) {
1575                 kv_enable_vce_dpm(adev, false);
1576                 kv_dpm_powergate_vce(adev, true);
1577         }
1578
1579         return 0;
1580 }
1581
1582 static int kv_update_samu_dpm(struct amdgpu_device *adev, bool gate)
1583 {
1584         struct kv_power_info *pi = kv_get_pi(adev);
1585         struct amdgpu_clock_voltage_dependency_table *table =
1586                 &adev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table;
1587         int ret;
1588
1589         if (!gate) {
1590                 if (pi->caps_stable_p_state)
1591                         pi->samu_boot_level = table->count - 1;
1592                 else
1593                         pi->samu_boot_level = 0;
1594
1595                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
1596                                            pi->dpm_table_start +
1597                                            offsetof(SMU7_Fusion_DpmTable, SamuBootLevel),
1598                                            (u8 *)&pi->samu_boot_level,
1599                                            sizeof(u8),
1600                                            pi->sram_end);
1601                 if (ret)
1602                         return ret;
1603
1604                 if (pi->caps_stable_p_state)
1605                         amdgpu_kv_send_msg_to_smc_with_parameter(adev,
1606                                                           PPSMC_MSG_SAMUDPM_SetEnabledMask,
1607                                                           (1 << pi->samu_boot_level));
1608         }
1609
1610         return kv_enable_samu_dpm(adev, !gate);
1611 }
1612
1613 static u8 kv_get_acp_boot_level(struct amdgpu_device *adev)
1614 {
1615         u8 i;
1616         struct amdgpu_clock_voltage_dependency_table *table =
1617                 &adev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table;
1618
1619         for (i = 0; i < table->count; i++) {
1620                 if (table->entries[i].clk >= 0) /* XXX */
1621                         break;
1622         }
1623
1624         if (i >= table->count)
1625                 i = table->count - 1;
1626
1627         return i;
1628 }
1629
1630 static void kv_update_acp_boot_level(struct amdgpu_device *adev)
1631 {
1632         struct kv_power_info *pi = kv_get_pi(adev);
1633         u8 acp_boot_level;
1634
1635         if (!pi->caps_stable_p_state) {
1636                 acp_boot_level = kv_get_acp_boot_level(adev);
1637                 if (acp_boot_level != pi->acp_boot_level) {
1638                         pi->acp_boot_level = acp_boot_level;
1639                         amdgpu_kv_send_msg_to_smc_with_parameter(adev,
1640                                                           PPSMC_MSG_ACPDPM_SetEnabledMask,
1641                                                           (1 << pi->acp_boot_level));
1642                 }
1643         }
1644 }
1645
1646 static int kv_update_acp_dpm(struct amdgpu_device *adev, bool gate)
1647 {
1648         struct kv_power_info *pi = kv_get_pi(adev);
1649         struct amdgpu_clock_voltage_dependency_table *table =
1650                 &adev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table;
1651         int ret;
1652
1653         if (!gate) {
1654                 if (pi->caps_stable_p_state)
1655                         pi->acp_boot_level = table->count - 1;
1656                 else
1657                         pi->acp_boot_level = kv_get_acp_boot_level(adev);
1658
1659                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
1660                                            pi->dpm_table_start +
1661                                            offsetof(SMU7_Fusion_DpmTable, AcpBootLevel),
1662                                            (u8 *)&pi->acp_boot_level,
1663                                            sizeof(u8),
1664                                            pi->sram_end);
1665                 if (ret)
1666                         return ret;
1667
1668                 if (pi->caps_stable_p_state)
1669                         amdgpu_kv_send_msg_to_smc_with_parameter(adev,
1670                                                           PPSMC_MSG_ACPDPM_SetEnabledMask,
1671                                                           (1 << pi->acp_boot_level));
1672         }
1673
1674         return kv_enable_acp_dpm(adev, !gate);
1675 }
1676
1677 static void kv_dpm_powergate_uvd(void *handle, bool gate)
1678 {
1679         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1680         struct kv_power_info *pi = kv_get_pi(adev);
1681         int ret;
1682
1683         pi->uvd_power_gated = gate;
1684
1685         if (gate) {
1686                 /* stop the UVD block */
1687                 ret = amdgpu_device_ip_set_powergating_state(adev, AMD_IP_BLOCK_TYPE_UVD,
1688                                                              AMD_PG_STATE_GATE);
1689                 kv_update_uvd_dpm(adev, gate);
1690                 if (pi->caps_uvd_pg)
1691                         /* power off the UVD block */
1692                         amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_UVDPowerOFF);
1693         } else {
1694                 if (pi->caps_uvd_pg)
1695                         /* power on the UVD block */
1696                         amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_UVDPowerON);
1697                         /* re-init the UVD block */
1698                 kv_update_uvd_dpm(adev, gate);
1699
1700                 ret = amdgpu_device_ip_set_powergating_state(adev, AMD_IP_BLOCK_TYPE_UVD,
1701                                                              AMD_PG_STATE_UNGATE);
1702         }
1703 }
1704
1705 static void kv_dpm_powergate_vce(struct amdgpu_device *adev, bool gate)
1706 {
1707         struct kv_power_info *pi = kv_get_pi(adev);
1708
1709         if (pi->vce_power_gated == gate)
1710                 return;
1711
1712         pi->vce_power_gated = gate;
1713
1714         if (!pi->caps_vce_pg)
1715                 return;
1716
1717         if (gate)
1718                 amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_VCEPowerOFF);
1719         else
1720                 amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_VCEPowerON);
1721 }
1722
1723 static void kv_dpm_powergate_samu(struct amdgpu_device *adev, bool gate)
1724 {
1725         struct kv_power_info *pi = kv_get_pi(adev);
1726
1727         if (pi->samu_power_gated == gate)
1728                 return;
1729
1730         pi->samu_power_gated = gate;
1731
1732         if (gate) {
1733                 kv_update_samu_dpm(adev, true);
1734                 if (pi->caps_samu_pg)
1735                         amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_SAMPowerOFF);
1736         } else {
1737                 if (pi->caps_samu_pg)
1738                         amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_SAMPowerON);
1739                 kv_update_samu_dpm(adev, false);
1740         }
1741 }
1742
1743 static void kv_dpm_powergate_acp(struct amdgpu_device *adev, bool gate)
1744 {
1745         struct kv_power_info *pi = kv_get_pi(adev);
1746
1747         if (pi->acp_power_gated == gate)
1748                 return;
1749
1750         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS)
1751                 return;
1752
1753         pi->acp_power_gated = gate;
1754
1755         if (gate) {
1756                 kv_update_acp_dpm(adev, true);
1757                 if (pi->caps_acp_pg)
1758                         amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_ACPPowerOFF);
1759         } else {
1760                 if (pi->caps_acp_pg)
1761                         amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_ACPPowerON);
1762                 kv_update_acp_dpm(adev, false);
1763         }
1764 }
1765
1766 static void kv_set_valid_clock_range(struct amdgpu_device *adev,
1767                                      struct amdgpu_ps *new_rps)
1768 {
1769         struct kv_ps *new_ps = kv_get_ps(new_rps);
1770         struct kv_power_info *pi = kv_get_pi(adev);
1771         u32 i;
1772         struct amdgpu_clock_voltage_dependency_table *table =
1773                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
1774
1775         if (table && table->count) {
1776                 for (i = 0; i < pi->graphics_dpm_level_count; i++) {
1777                         if ((table->entries[i].clk >= new_ps->levels[0].sclk) ||
1778                             (i == (pi->graphics_dpm_level_count - 1))) {
1779                                 pi->lowest_valid = i;
1780                                 break;
1781                         }
1782                 }
1783
1784                 for (i = pi->graphics_dpm_level_count - 1; i > 0; i--) {
1785                         if (table->entries[i].clk <= new_ps->levels[new_ps->num_levels - 1].sclk)
1786                                 break;
1787                 }
1788                 pi->highest_valid = i;
1789
1790                 if (pi->lowest_valid > pi->highest_valid) {
1791                         if ((new_ps->levels[0].sclk - table->entries[pi->highest_valid].clk) >
1792                             (table->entries[pi->lowest_valid].clk - new_ps->levels[new_ps->num_levels - 1].sclk))
1793                                 pi->highest_valid = pi->lowest_valid;
1794                         else
1795                                 pi->lowest_valid =  pi->highest_valid;
1796                 }
1797         } else {
1798                 struct sumo_sclk_voltage_mapping_table *table =
1799                         &pi->sys_info.sclk_voltage_mapping_table;
1800
1801                 for (i = 0; i < (int)pi->graphics_dpm_level_count; i++) {
1802                         if (table->entries[i].sclk_frequency >= new_ps->levels[0].sclk ||
1803                             i == (int)(pi->graphics_dpm_level_count - 1)) {
1804                                 pi->lowest_valid = i;
1805                                 break;
1806                         }
1807                 }
1808
1809                 for (i = pi->graphics_dpm_level_count - 1; i > 0; i--) {
1810                         if (table->entries[i].sclk_frequency <=
1811                             new_ps->levels[new_ps->num_levels - 1].sclk)
1812                                 break;
1813                 }
1814                 pi->highest_valid = i;
1815
1816                 if (pi->lowest_valid > pi->highest_valid) {
1817                         if ((new_ps->levels[0].sclk -
1818                              table->entries[pi->highest_valid].sclk_frequency) >
1819                             (table->entries[pi->lowest_valid].sclk_frequency -
1820                              new_ps->levels[new_ps->num_levels -1].sclk))
1821                                 pi->highest_valid = pi->lowest_valid;
1822                         else
1823                                 pi->lowest_valid =  pi->highest_valid;
1824                 }
1825         }
1826 }
1827
1828 static int kv_update_dfs_bypass_settings(struct amdgpu_device *adev,
1829                                          struct amdgpu_ps *new_rps)
1830 {
1831         struct kv_ps *new_ps = kv_get_ps(new_rps);
1832         struct kv_power_info *pi = kv_get_pi(adev);
1833         int ret = 0;
1834         u8 clk_bypass_cntl;
1835
1836         if (pi->caps_enable_dfs_bypass) {
1837                 clk_bypass_cntl = new_ps->need_dfs_bypass ?
1838                         pi->graphics_level[pi->graphics_boot_level].ClkBypassCntl : 0;
1839                 ret = amdgpu_kv_copy_bytes_to_smc(adev,
1840                                            (pi->dpm_table_start +
1841                                             offsetof(SMU7_Fusion_DpmTable, GraphicsLevel) +
1842                                             (pi->graphics_boot_level * sizeof(SMU7_Fusion_GraphicsLevel)) +
1843                                             offsetof(SMU7_Fusion_GraphicsLevel, ClkBypassCntl)),
1844                                            &clk_bypass_cntl,
1845                                            sizeof(u8), pi->sram_end);
1846         }
1847
1848         return ret;
1849 }
1850
1851 static int kv_enable_nb_dpm(struct amdgpu_device *adev,
1852                             bool enable)
1853 {
1854         struct kv_power_info *pi = kv_get_pi(adev);
1855         int ret = 0;
1856
1857         if (enable) {
1858                 if (pi->enable_nb_dpm && !pi->nb_dpm_enabled) {
1859                         ret = amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_NBDPM_Enable);
1860                         if (ret == 0)
1861                                 pi->nb_dpm_enabled = true;
1862                 }
1863         } else {
1864                 if (pi->enable_nb_dpm && pi->nb_dpm_enabled) {
1865                         ret = amdgpu_kv_notify_message_to_smu(adev, PPSMC_MSG_NBDPM_Disable);
1866                         if (ret == 0)
1867                                 pi->nb_dpm_enabled = false;
1868                 }
1869         }
1870
1871         return ret;
1872 }
1873
1874 static int kv_dpm_force_performance_level(void *handle,
1875                                           enum amd_dpm_forced_level level)
1876 {
1877         int ret;
1878         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1879
1880         if (level == AMD_DPM_FORCED_LEVEL_HIGH) {
1881                 ret = kv_force_dpm_highest(adev);
1882                 if (ret)
1883                         return ret;
1884         } else if (level == AMD_DPM_FORCED_LEVEL_LOW) {
1885                 ret = kv_force_dpm_lowest(adev);
1886                 if (ret)
1887                         return ret;
1888         } else if (level == AMD_DPM_FORCED_LEVEL_AUTO) {
1889                 ret = kv_unforce_levels(adev);
1890                 if (ret)
1891                         return ret;
1892         }
1893
1894         adev->pm.dpm.forced_level = level;
1895
1896         return 0;
1897 }
1898
1899 static int kv_dpm_pre_set_power_state(void *handle)
1900 {
1901         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1902         struct kv_power_info *pi = kv_get_pi(adev);
1903         struct amdgpu_ps requested_ps = *adev->pm.dpm.requested_ps;
1904         struct amdgpu_ps *new_ps = &requested_ps;
1905
1906         kv_update_requested_ps(adev, new_ps);
1907
1908         kv_apply_state_adjust_rules(adev,
1909                                     &pi->requested_rps,
1910                                     &pi->current_rps);
1911
1912         return 0;
1913 }
1914
1915 static int kv_dpm_set_power_state(void *handle)
1916 {
1917         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1918         struct kv_power_info *pi = kv_get_pi(adev);
1919         struct amdgpu_ps *new_ps = &pi->requested_rps;
1920         struct amdgpu_ps *old_ps = &pi->current_rps;
1921         int ret;
1922
1923         if (pi->bapm_enable) {
1924                 ret = amdgpu_kv_smc_bapm_enable(adev, adev->pm.dpm.ac_power);
1925                 if (ret) {
1926                         DRM_ERROR("amdgpu_kv_smc_bapm_enable failed\n");
1927                         return ret;
1928                 }
1929         }
1930
1931         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS) {
1932                 if (pi->enable_dpm) {
1933                         kv_set_valid_clock_range(adev, new_ps);
1934                         kv_update_dfs_bypass_settings(adev, new_ps);
1935                         ret = kv_calculate_ds_divider(adev);
1936                         if (ret) {
1937                                 DRM_ERROR("kv_calculate_ds_divider failed\n");
1938                                 return ret;
1939                         }
1940                         kv_calculate_nbps_level_settings(adev);
1941                         kv_calculate_dpm_settings(adev);
1942                         kv_force_lowest_valid(adev);
1943                         kv_enable_new_levels(adev);
1944                         kv_upload_dpm_settings(adev);
1945                         kv_program_nbps_index_settings(adev, new_ps);
1946                         kv_unforce_levels(adev);
1947                         kv_set_enabled_levels(adev);
1948                         kv_force_lowest_valid(adev);
1949                         kv_unforce_levels(adev);
1950
1951                         ret = kv_update_vce_dpm(adev, new_ps, old_ps);
1952                         if (ret) {
1953                                 DRM_ERROR("kv_update_vce_dpm failed\n");
1954                                 return ret;
1955                         }
1956                         kv_update_sclk_t(adev);
1957                         if (adev->asic_type == CHIP_MULLINS)
1958                                 kv_enable_nb_dpm(adev, true);
1959                 }
1960         } else {
1961                 if (pi->enable_dpm) {
1962                         kv_set_valid_clock_range(adev, new_ps);
1963                         kv_update_dfs_bypass_settings(adev, new_ps);
1964                         ret = kv_calculate_ds_divider(adev);
1965                         if (ret) {
1966                                 DRM_ERROR("kv_calculate_ds_divider failed\n");
1967                                 return ret;
1968                         }
1969                         kv_calculate_nbps_level_settings(adev);
1970                         kv_calculate_dpm_settings(adev);
1971                         kv_freeze_sclk_dpm(adev, true);
1972                         kv_upload_dpm_settings(adev);
1973                         kv_program_nbps_index_settings(adev, new_ps);
1974                         kv_freeze_sclk_dpm(adev, false);
1975                         kv_set_enabled_levels(adev);
1976                         ret = kv_update_vce_dpm(adev, new_ps, old_ps);
1977                         if (ret) {
1978                                 DRM_ERROR("kv_update_vce_dpm failed\n");
1979                                 return ret;
1980                         }
1981                         kv_update_acp_boot_level(adev);
1982                         kv_update_sclk_t(adev);
1983                         kv_enable_nb_dpm(adev, true);
1984                 }
1985         }
1986
1987         return 0;
1988 }
1989
1990 static void kv_dpm_post_set_power_state(void *handle)
1991 {
1992         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1993         struct kv_power_info *pi = kv_get_pi(adev);
1994         struct amdgpu_ps *new_ps = &pi->requested_rps;
1995
1996         kv_update_current_ps(adev, new_ps);
1997 }
1998
1999 static void kv_dpm_setup_asic(struct amdgpu_device *adev)
2000 {
2001         sumo_take_smu_control(adev, true);
2002         kv_init_powergate_state(adev);
2003         kv_init_sclk_t(adev);
2004 }
2005
2006 #if 0
2007 static void kv_dpm_reset_asic(struct amdgpu_device *adev)
2008 {
2009         struct kv_power_info *pi = kv_get_pi(adev);
2010
2011         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS) {
2012                 kv_force_lowest_valid(adev);
2013                 kv_init_graphics_levels(adev);
2014                 kv_program_bootup_state(adev);
2015                 kv_upload_dpm_settings(adev);
2016                 kv_force_lowest_valid(adev);
2017                 kv_unforce_levels(adev);
2018         } else {
2019                 kv_init_graphics_levels(adev);
2020                 kv_program_bootup_state(adev);
2021                 kv_freeze_sclk_dpm(adev, true);
2022                 kv_upload_dpm_settings(adev);
2023                 kv_freeze_sclk_dpm(adev, false);
2024                 kv_set_enabled_level(adev, pi->graphics_boot_level);
2025         }
2026 }
2027 #endif
2028
2029 static void kv_construct_max_power_limits_table(struct amdgpu_device *adev,
2030                                                 struct amdgpu_clock_and_voltage_limits *table)
2031 {
2032         struct kv_power_info *pi = kv_get_pi(adev);
2033
2034         if (pi->sys_info.sclk_voltage_mapping_table.num_max_dpm_entries > 0) {
2035                 int idx = pi->sys_info.sclk_voltage_mapping_table.num_max_dpm_entries - 1;
2036                 table->sclk =
2037                         pi->sys_info.sclk_voltage_mapping_table.entries[idx].sclk_frequency;
2038                 table->vddc =
2039                         kv_convert_2bit_index_to_voltage(adev,
2040                                                          pi->sys_info.sclk_voltage_mapping_table.entries[idx].vid_2bit);
2041         }
2042
2043         table->mclk = pi->sys_info.nbp_memory_clock[0];
2044 }
2045
2046 static void kv_patch_voltage_values(struct amdgpu_device *adev)
2047 {
2048         int i;
2049         struct amdgpu_uvd_clock_voltage_dependency_table *uvd_table =
2050                 &adev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table;
2051         struct amdgpu_vce_clock_voltage_dependency_table *vce_table =
2052                 &adev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table;
2053         struct amdgpu_clock_voltage_dependency_table *samu_table =
2054                 &adev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table;
2055         struct amdgpu_clock_voltage_dependency_table *acp_table =
2056                 &adev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table;
2057
2058         if (uvd_table->count) {
2059                 for (i = 0; i < uvd_table->count; i++)
2060                         uvd_table->entries[i].v =
2061                                 kv_convert_8bit_index_to_voltage(adev,
2062                                                                  uvd_table->entries[i].v);
2063         }
2064
2065         if (vce_table->count) {
2066                 for (i = 0; i < vce_table->count; i++)
2067                         vce_table->entries[i].v =
2068                                 kv_convert_8bit_index_to_voltage(adev,
2069                                                                  vce_table->entries[i].v);
2070         }
2071
2072         if (samu_table->count) {
2073                 for (i = 0; i < samu_table->count; i++)
2074                         samu_table->entries[i].v =
2075                                 kv_convert_8bit_index_to_voltage(adev,
2076                                                                  samu_table->entries[i].v);
2077         }
2078
2079         if (acp_table->count) {
2080                 for (i = 0; i < acp_table->count; i++)
2081                         acp_table->entries[i].v =
2082                                 kv_convert_8bit_index_to_voltage(adev,
2083                                                                  acp_table->entries[i].v);
2084         }
2085
2086 }
2087
2088 static void kv_construct_boot_state(struct amdgpu_device *adev)
2089 {
2090         struct kv_power_info *pi = kv_get_pi(adev);
2091
2092         pi->boot_pl.sclk = pi->sys_info.bootup_sclk;
2093         pi->boot_pl.vddc_index = pi->sys_info.bootup_nb_voltage_index;
2094         pi->boot_pl.ds_divider_index = 0;
2095         pi->boot_pl.ss_divider_index = 0;
2096         pi->boot_pl.allow_gnb_slow = 1;
2097         pi->boot_pl.force_nbp_state = 0;
2098         pi->boot_pl.display_wm = 0;
2099         pi->boot_pl.vce_wm = 0;
2100 }
2101
2102 static int kv_force_dpm_highest(struct amdgpu_device *adev)
2103 {
2104         int ret;
2105         u32 enable_mask, i;
2106
2107         ret = amdgpu_kv_dpm_get_enable_mask(adev, &enable_mask);
2108         if (ret)
2109                 return ret;
2110
2111         for (i = SMU7_MAX_LEVELS_GRAPHICS - 1; i > 0; i--) {
2112                 if (enable_mask & (1 << i))
2113                         break;
2114         }
2115
2116         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS)
2117                 return amdgpu_kv_send_msg_to_smc_with_parameter(adev, PPSMC_MSG_DPM_ForceState, i);
2118         else
2119                 return kv_set_enabled_level(adev, i);
2120 }
2121
2122 static int kv_force_dpm_lowest(struct amdgpu_device *adev)
2123 {
2124         int ret;
2125         u32 enable_mask, i;
2126
2127         ret = amdgpu_kv_dpm_get_enable_mask(adev, &enable_mask);
2128         if (ret)
2129                 return ret;
2130
2131         for (i = 0; i < SMU7_MAX_LEVELS_GRAPHICS; i++) {
2132                 if (enable_mask & (1 << i))
2133                         break;
2134         }
2135
2136         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS)
2137                 return amdgpu_kv_send_msg_to_smc_with_parameter(adev, PPSMC_MSG_DPM_ForceState, i);
2138         else
2139                 return kv_set_enabled_level(adev, i);
2140 }
2141
2142 static u8 kv_get_sleep_divider_id_from_clock(struct amdgpu_device *adev,
2143                                              u32 sclk, u32 min_sclk_in_sr)
2144 {
2145         struct kv_power_info *pi = kv_get_pi(adev);
2146         u32 i;
2147         u32 temp;
2148         u32 min = max(min_sclk_in_sr, (u32)KV_MINIMUM_ENGINE_CLOCK);
2149
2150         if (sclk < min)
2151                 return 0;
2152
2153         if (!pi->caps_sclk_ds)
2154                 return 0;
2155
2156         for (i = KV_MAX_DEEPSLEEP_DIVIDER_ID; i > 0; i--) {
2157                 temp = sclk >> i;
2158                 if (temp >= min)
2159                         break;
2160         }
2161
2162         return (u8)i;
2163 }
2164
2165 static int kv_get_high_voltage_limit(struct amdgpu_device *adev, int *limit)
2166 {
2167         struct kv_power_info *pi = kv_get_pi(adev);
2168         struct amdgpu_clock_voltage_dependency_table *table =
2169                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
2170         int i;
2171
2172         if (table && table->count) {
2173                 for (i = table->count - 1; i >= 0; i--) {
2174                         if (pi->high_voltage_t &&
2175                             (kv_convert_8bit_index_to_voltage(adev, table->entries[i].v) <=
2176                              pi->high_voltage_t)) {
2177                                 *limit = i;
2178                                 return 0;
2179                         }
2180                 }
2181         } else {
2182                 struct sumo_sclk_voltage_mapping_table *table =
2183                         &pi->sys_info.sclk_voltage_mapping_table;
2184
2185                 for (i = table->num_max_dpm_entries - 1; i >= 0; i--) {
2186                         if (pi->high_voltage_t &&
2187                             (kv_convert_2bit_index_to_voltage(adev, table->entries[i].vid_2bit) <=
2188                              pi->high_voltage_t)) {
2189                                 *limit = i;
2190                                 return 0;
2191                         }
2192                 }
2193         }
2194
2195         *limit = 0;
2196         return 0;
2197 }
2198
2199 static void kv_apply_state_adjust_rules(struct amdgpu_device *adev,
2200                                         struct amdgpu_ps *new_rps,
2201                                         struct amdgpu_ps *old_rps)
2202 {
2203         struct kv_ps *ps = kv_get_ps(new_rps);
2204         struct kv_power_info *pi = kv_get_pi(adev);
2205         u32 min_sclk = 10000; /* ??? */
2206         u32 sclk, mclk = 0;
2207         int i, limit;
2208         bool force_high;
2209         struct amdgpu_clock_voltage_dependency_table *table =
2210                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
2211         u32 stable_p_state_sclk = 0;
2212         struct amdgpu_clock_and_voltage_limits *max_limits =
2213                 &adev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
2214
2215         if (new_rps->vce_active) {
2216                 new_rps->evclk = adev->pm.dpm.vce_states[adev->pm.dpm.vce_level].evclk;
2217                 new_rps->ecclk = adev->pm.dpm.vce_states[adev->pm.dpm.vce_level].ecclk;
2218         } else {
2219                 new_rps->evclk = 0;
2220                 new_rps->ecclk = 0;
2221         }
2222
2223         mclk = max_limits->mclk;
2224         sclk = min_sclk;
2225
2226         if (pi->caps_stable_p_state) {
2227                 stable_p_state_sclk = (max_limits->sclk * 75) / 100;
2228
2229                 for (i = table->count - 1; i >= 0; i--) {
2230                         if (stable_p_state_sclk >= table->entries[i].clk) {
2231                                 stable_p_state_sclk = table->entries[i].clk;
2232                                 break;
2233                         }
2234                 }
2235
2236                 if (i > 0)
2237                         stable_p_state_sclk = table->entries[0].clk;
2238
2239                 sclk = stable_p_state_sclk;
2240         }
2241
2242         if (new_rps->vce_active) {
2243                 if (sclk < adev->pm.dpm.vce_states[adev->pm.dpm.vce_level].sclk)
2244                         sclk = adev->pm.dpm.vce_states[adev->pm.dpm.vce_level].sclk;
2245         }
2246
2247         ps->need_dfs_bypass = true;
2248
2249         for (i = 0; i < ps->num_levels; i++) {
2250                 if (ps->levels[i].sclk < sclk)
2251                         ps->levels[i].sclk = sclk;
2252         }
2253
2254         if (table && table->count) {
2255                 for (i = 0; i < ps->num_levels; i++) {
2256                         if (pi->high_voltage_t &&
2257                             (pi->high_voltage_t <
2258                              kv_convert_8bit_index_to_voltage(adev, ps->levels[i].vddc_index))) {
2259                                 kv_get_high_voltage_limit(adev, &limit);
2260                                 ps->levels[i].sclk = table->entries[limit].clk;
2261                         }
2262                 }
2263         } else {
2264                 struct sumo_sclk_voltage_mapping_table *table =
2265                         &pi->sys_info.sclk_voltage_mapping_table;
2266
2267                 for (i = 0; i < ps->num_levels; i++) {
2268                         if (pi->high_voltage_t &&
2269                             (pi->high_voltage_t <
2270                              kv_convert_8bit_index_to_voltage(adev, ps->levels[i].vddc_index))) {
2271                                 kv_get_high_voltage_limit(adev, &limit);
2272                                 ps->levels[i].sclk = table->entries[limit].sclk_frequency;
2273                         }
2274                 }
2275         }
2276
2277         if (pi->caps_stable_p_state) {
2278                 for (i = 0; i < ps->num_levels; i++) {
2279                         ps->levels[i].sclk = stable_p_state_sclk;
2280                 }
2281         }
2282
2283         pi->video_start = new_rps->dclk || new_rps->vclk ||
2284                 new_rps->evclk || new_rps->ecclk;
2285
2286         if ((new_rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) ==
2287             ATOM_PPLIB_CLASSIFICATION_UI_BATTERY)
2288                 pi->battery_state = true;
2289         else
2290                 pi->battery_state = false;
2291
2292         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS) {
2293                 ps->dpm0_pg_nb_ps_lo = 0x1;
2294                 ps->dpm0_pg_nb_ps_hi = 0x0;
2295                 ps->dpmx_nb_ps_lo = 0x1;
2296                 ps->dpmx_nb_ps_hi = 0x0;
2297         } else {
2298                 ps->dpm0_pg_nb_ps_lo = 0x3;
2299                 ps->dpm0_pg_nb_ps_hi = 0x0;
2300                 ps->dpmx_nb_ps_lo = 0x3;
2301                 ps->dpmx_nb_ps_hi = 0x0;
2302
2303                 if (pi->sys_info.nb_dpm_enable) {
2304                         force_high = (mclk >= pi->sys_info.nbp_memory_clock[3]) ||
2305                                 pi->video_start || (adev->pm.dpm.new_active_crtc_count >= 3) ||
2306                                 pi->disable_nb_ps3_in_battery;
2307                         ps->dpm0_pg_nb_ps_lo = force_high ? 0x2 : 0x3;
2308                         ps->dpm0_pg_nb_ps_hi = 0x2;
2309                         ps->dpmx_nb_ps_lo = force_high ? 0x2 : 0x3;
2310                         ps->dpmx_nb_ps_hi = 0x2;
2311                 }
2312         }
2313 }
2314
2315 static void kv_dpm_power_level_enabled_for_throttle(struct amdgpu_device *adev,
2316                                                     u32 index, bool enable)
2317 {
2318         struct kv_power_info *pi = kv_get_pi(adev);
2319
2320         pi->graphics_level[index].EnabledForThrottle = enable ? 1 : 0;
2321 }
2322
2323 static int kv_calculate_ds_divider(struct amdgpu_device *adev)
2324 {
2325         struct kv_power_info *pi = kv_get_pi(adev);
2326         u32 sclk_in_sr = 10000; /* ??? */
2327         u32 i;
2328
2329         if (pi->lowest_valid > pi->highest_valid)
2330                 return -EINVAL;
2331
2332         for (i = pi->lowest_valid; i <= pi->highest_valid; i++) {
2333                 pi->graphics_level[i].DeepSleepDivId =
2334                         kv_get_sleep_divider_id_from_clock(adev,
2335                                                            be32_to_cpu(pi->graphics_level[i].SclkFrequency),
2336                                                            sclk_in_sr);
2337         }
2338         return 0;
2339 }
2340
2341 static int kv_calculate_nbps_level_settings(struct amdgpu_device *adev)
2342 {
2343         struct kv_power_info *pi = kv_get_pi(adev);
2344         u32 i;
2345         bool force_high;
2346         struct amdgpu_clock_and_voltage_limits *max_limits =
2347                 &adev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
2348         u32 mclk = max_limits->mclk;
2349
2350         if (pi->lowest_valid > pi->highest_valid)
2351                 return -EINVAL;
2352
2353         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS) {
2354                 for (i = pi->lowest_valid; i <= pi->highest_valid; i++) {
2355                         pi->graphics_level[i].GnbSlow = 1;
2356                         pi->graphics_level[i].ForceNbPs1 = 0;
2357                         pi->graphics_level[i].UpH = 0;
2358                 }
2359
2360                 if (!pi->sys_info.nb_dpm_enable)
2361                         return 0;
2362
2363                 force_high = ((mclk >= pi->sys_info.nbp_memory_clock[3]) ||
2364                               (adev->pm.dpm.new_active_crtc_count >= 3) || pi->video_start);
2365
2366                 if (force_high) {
2367                         for (i = pi->lowest_valid; i <= pi->highest_valid; i++)
2368                                 pi->graphics_level[i].GnbSlow = 0;
2369                 } else {
2370                         if (pi->battery_state)
2371                                 pi->graphics_level[0].ForceNbPs1 = 1;
2372
2373                         pi->graphics_level[1].GnbSlow = 0;
2374                         pi->graphics_level[2].GnbSlow = 0;
2375                         pi->graphics_level[3].GnbSlow = 0;
2376                         pi->graphics_level[4].GnbSlow = 0;
2377                 }
2378         } else {
2379                 for (i = pi->lowest_valid; i <= pi->highest_valid; i++) {
2380                         pi->graphics_level[i].GnbSlow = 1;
2381                         pi->graphics_level[i].ForceNbPs1 = 0;
2382                         pi->graphics_level[i].UpH = 0;
2383                 }
2384
2385                 if (pi->sys_info.nb_dpm_enable && pi->battery_state) {
2386                         pi->graphics_level[pi->lowest_valid].UpH = 0x28;
2387                         pi->graphics_level[pi->lowest_valid].GnbSlow = 0;
2388                         if (pi->lowest_valid != pi->highest_valid)
2389                                 pi->graphics_level[pi->lowest_valid].ForceNbPs1 = 1;
2390                 }
2391         }
2392         return 0;
2393 }
2394
2395 static int kv_calculate_dpm_settings(struct amdgpu_device *adev)
2396 {
2397         struct kv_power_info *pi = kv_get_pi(adev);
2398         u32 i;
2399
2400         if (pi->lowest_valid > pi->highest_valid)
2401                 return -EINVAL;
2402
2403         for (i = pi->lowest_valid; i <= pi->highest_valid; i++)
2404                 pi->graphics_level[i].DisplayWatermark = (i == pi->highest_valid) ? 1 : 0;
2405
2406         return 0;
2407 }
2408
2409 static void kv_init_graphics_levels(struct amdgpu_device *adev)
2410 {
2411         struct kv_power_info *pi = kv_get_pi(adev);
2412         u32 i;
2413         struct amdgpu_clock_voltage_dependency_table *table =
2414                 &adev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
2415
2416         if (table && table->count) {
2417                 u32 vid_2bit;
2418
2419                 pi->graphics_dpm_level_count = 0;
2420                 for (i = 0; i < table->count; i++) {
2421                         if (pi->high_voltage_t &&
2422                             (pi->high_voltage_t <
2423                              kv_convert_8bit_index_to_voltage(adev, table->entries[i].v)))
2424                                 break;
2425
2426                         kv_set_divider_value(adev, i, table->entries[i].clk);
2427                         vid_2bit = kv_convert_vid7_to_vid2(adev,
2428                                                            &pi->sys_info.vid_mapping_table,
2429                                                            table->entries[i].v);
2430                         kv_set_vid(adev, i, vid_2bit);
2431                         kv_set_at(adev, i, pi->at[i]);
2432                         kv_dpm_power_level_enabled_for_throttle(adev, i, true);
2433                         pi->graphics_dpm_level_count++;
2434                 }
2435         } else {
2436                 struct sumo_sclk_voltage_mapping_table *table =
2437                         &pi->sys_info.sclk_voltage_mapping_table;
2438
2439                 pi->graphics_dpm_level_count = 0;
2440                 for (i = 0; i < table->num_max_dpm_entries; i++) {
2441                         if (pi->high_voltage_t &&
2442                             pi->high_voltage_t <
2443                             kv_convert_2bit_index_to_voltage(adev, table->entries[i].vid_2bit))
2444                                 break;
2445
2446                         kv_set_divider_value(adev, i, table->entries[i].sclk_frequency);
2447                         kv_set_vid(adev, i, table->entries[i].vid_2bit);
2448                         kv_set_at(adev, i, pi->at[i]);
2449                         kv_dpm_power_level_enabled_for_throttle(adev, i, true);
2450                         pi->graphics_dpm_level_count++;
2451                 }
2452         }
2453
2454         for (i = 0; i < SMU7_MAX_LEVELS_GRAPHICS; i++)
2455                 kv_dpm_power_level_enable(adev, i, false);
2456 }
2457
2458 static void kv_enable_new_levels(struct amdgpu_device *adev)
2459 {
2460         struct kv_power_info *pi = kv_get_pi(adev);
2461         u32 i;
2462
2463         for (i = 0; i < SMU7_MAX_LEVELS_GRAPHICS; i++) {
2464                 if (i >= pi->lowest_valid && i <= pi->highest_valid)
2465                         kv_dpm_power_level_enable(adev, i, true);
2466         }
2467 }
2468
2469 static int kv_set_enabled_level(struct amdgpu_device *adev, u32 level)
2470 {
2471         u32 new_mask = (1 << level);
2472
2473         return amdgpu_kv_send_msg_to_smc_with_parameter(adev,
2474                                                  PPSMC_MSG_SCLKDPM_SetEnabledMask,
2475                                                  new_mask);
2476 }
2477
2478 static int kv_set_enabled_levels(struct amdgpu_device *adev)
2479 {
2480         struct kv_power_info *pi = kv_get_pi(adev);
2481         u32 i, new_mask = 0;
2482
2483         for (i = pi->lowest_valid; i <= pi->highest_valid; i++)
2484                 new_mask |= (1 << i);
2485
2486         return amdgpu_kv_send_msg_to_smc_with_parameter(adev,
2487                                                  PPSMC_MSG_SCLKDPM_SetEnabledMask,
2488                                                  new_mask);
2489 }
2490
2491 static void kv_program_nbps_index_settings(struct amdgpu_device *adev,
2492                                            struct amdgpu_ps *new_rps)
2493 {
2494         struct kv_ps *new_ps = kv_get_ps(new_rps);
2495         struct kv_power_info *pi = kv_get_pi(adev);
2496         u32 nbdpmconfig1;
2497
2498         if (adev->asic_type == CHIP_KABINI || adev->asic_type == CHIP_MULLINS)
2499                 return;
2500
2501         if (pi->sys_info.nb_dpm_enable) {
2502                 nbdpmconfig1 = RREG32_SMC(ixNB_DPM_CONFIG_1);
2503                 nbdpmconfig1 &= ~(NB_DPM_CONFIG_1__Dpm0PgNbPsLo_MASK |
2504                                 NB_DPM_CONFIG_1__Dpm0PgNbPsHi_MASK |
2505                                 NB_DPM_CONFIG_1__DpmXNbPsLo_MASK |
2506                                 NB_DPM_CONFIG_1__DpmXNbPsHi_MASK);
2507                 nbdpmconfig1 |= (new_ps->dpm0_pg_nb_ps_lo << NB_DPM_CONFIG_1__Dpm0PgNbPsLo__SHIFT) |
2508                                 (new_ps->dpm0_pg_nb_ps_hi << NB_DPM_CONFIG_1__Dpm0PgNbPsHi__SHIFT) |
2509                                 (new_ps->dpmx_nb_ps_lo << NB_DPM_CONFIG_1__DpmXNbPsLo__SHIFT) |
2510                                 (new_ps->dpmx_nb_ps_hi << NB_DPM_CONFIG_1__DpmXNbPsHi__SHIFT);
2511                 WREG32_SMC(ixNB_DPM_CONFIG_1, nbdpmconfig1);
2512         }
2513 }
2514
2515 static int kv_set_thermal_temperature_range(struct amdgpu_device *adev,
2516                                             int min_temp, int max_temp)
2517 {
2518         int low_temp = 0 * 1000;
2519         int high_temp = 255 * 1000;
2520         u32 tmp;
2521
2522         if (low_temp < min_temp)
2523                 low_temp = min_temp;
2524         if (high_temp > max_temp)
2525                 high_temp = max_temp;
2526         if (high_temp < low_temp) {
2527                 DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
2528                 return -EINVAL;
2529         }
2530
2531         tmp = RREG32_SMC(ixCG_THERMAL_INT_CTRL);
2532         tmp &= ~(CG_THERMAL_INT_CTRL__DIG_THERM_INTH_MASK |
2533                 CG_THERMAL_INT_CTRL__DIG_THERM_INTL_MASK);
2534         tmp |= ((49 + (high_temp / 1000)) << CG_THERMAL_INT_CTRL__DIG_THERM_INTH__SHIFT) |
2535                 ((49 + (low_temp / 1000)) << CG_THERMAL_INT_CTRL__DIG_THERM_INTL__SHIFT);
2536         WREG32_SMC(ixCG_THERMAL_INT_CTRL, tmp);
2537
2538         adev->pm.dpm.thermal.min_temp = low_temp;
2539         adev->pm.dpm.thermal.max_temp = high_temp;
2540
2541         return 0;
2542 }
2543
2544 union igp_info {
2545         struct _ATOM_INTEGRATED_SYSTEM_INFO info;
2546         struct _ATOM_INTEGRATED_SYSTEM_INFO_V2 info_2;
2547         struct _ATOM_INTEGRATED_SYSTEM_INFO_V5 info_5;
2548         struct _ATOM_INTEGRATED_SYSTEM_INFO_V6 info_6;
2549         struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_7 info_7;
2550         struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_8 info_8;
2551 };
2552
2553 static int kv_parse_sys_info_table(struct amdgpu_device *adev)
2554 {
2555         struct kv_power_info *pi = kv_get_pi(adev);
2556         struct amdgpu_mode_info *mode_info = &adev->mode_info;
2557         int index = GetIndexIntoMasterTable(DATA, IntegratedSystemInfo);
2558         union igp_info *igp_info;
2559         u8 frev, crev;
2560         u16 data_offset;
2561         int i;
2562
2563         if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
2564                                    &frev, &crev, &data_offset)) {
2565                 igp_info = (union igp_info *)(mode_info->atom_context->bios +
2566                                               data_offset);
2567
2568                 if (crev != 8) {
2569                         DRM_ERROR("Unsupported IGP table: %d %d\n", frev, crev);
2570                         return -EINVAL;
2571                 }
2572                 pi->sys_info.bootup_sclk = le32_to_cpu(igp_info->info_8.ulBootUpEngineClock);
2573                 pi->sys_info.bootup_uma_clk = le32_to_cpu(igp_info->info_8.ulBootUpUMAClock);
2574                 pi->sys_info.bootup_nb_voltage_index =
2575                         le16_to_cpu(igp_info->info_8.usBootUpNBVoltage);
2576                 if (igp_info->info_8.ucHtcTmpLmt == 0)
2577                         pi->sys_info.htc_tmp_lmt = 203;
2578                 else
2579                         pi->sys_info.htc_tmp_lmt = igp_info->info_8.ucHtcTmpLmt;
2580                 if (igp_info->info_8.ucHtcHystLmt == 0)
2581                         pi->sys_info.htc_hyst_lmt = 5;
2582                 else
2583                         pi->sys_info.htc_hyst_lmt = igp_info->info_8.ucHtcHystLmt;
2584                 if (pi->sys_info.htc_tmp_lmt <= pi->sys_info.htc_hyst_lmt) {
2585                         DRM_ERROR("The htcTmpLmt should be larger than htcHystLmt.\n");
2586                 }
2587
2588                 if (le32_to_cpu(igp_info->info_8.ulSystemConfig) & (1 << 3))
2589                         pi->sys_info.nb_dpm_enable = true;
2590                 else
2591                         pi->sys_info.nb_dpm_enable = false;
2592
2593                 for (i = 0; i < KV_NUM_NBPSTATES; i++) {
2594                         pi->sys_info.nbp_memory_clock[i] =
2595                                 le32_to_cpu(igp_info->info_8.ulNbpStateMemclkFreq[i]);
2596                         pi->sys_info.nbp_n_clock[i] =
2597                                 le32_to_cpu(igp_info->info_8.ulNbpStateNClkFreq[i]);
2598                 }
2599                 if (le32_to_cpu(igp_info->info_8.ulGPUCapInfo) &
2600                     SYS_INFO_GPUCAPS__ENABEL_DFS_BYPASS)
2601                         pi->caps_enable_dfs_bypass = true;
2602
2603                 sumo_construct_sclk_voltage_mapping_table(adev,
2604                                                           &pi->sys_info.sclk_voltage_mapping_table,
2605                                                           igp_info->info_8.sAvail_SCLK);
2606
2607                 sumo_construct_vid_mapping_table(adev,
2608                                                  &pi->sys_info.vid_mapping_table,
2609                                                  igp_info->info_8.sAvail_SCLK);
2610
2611                 kv_construct_max_power_limits_table(adev,
2612                                                     &adev->pm.dpm.dyn_state.max_clock_voltage_on_ac);
2613         }
2614         return 0;
2615 }
2616
2617 union power_info {
2618         struct _ATOM_POWERPLAY_INFO info;
2619         struct _ATOM_POWERPLAY_INFO_V2 info_2;
2620         struct _ATOM_POWERPLAY_INFO_V3 info_3;
2621         struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
2622         struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
2623         struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
2624 };
2625
2626 union pplib_clock_info {
2627         struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
2628         struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
2629         struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
2630         struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
2631 };
2632
2633 union pplib_power_state {
2634         struct _ATOM_PPLIB_STATE v1;
2635         struct _ATOM_PPLIB_STATE_V2 v2;
2636 };
2637
2638 static void kv_patch_boot_state(struct amdgpu_device *adev,
2639                                 struct kv_ps *ps)
2640 {
2641         struct kv_power_info *pi = kv_get_pi(adev);
2642
2643         ps->num_levels = 1;
2644         ps->levels[0] = pi->boot_pl;
2645 }
2646
2647 static void kv_parse_pplib_non_clock_info(struct amdgpu_device *adev,
2648                                           struct amdgpu_ps *rps,
2649                                           struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
2650                                           u8 table_rev)
2651 {
2652         struct kv_ps *ps = kv_get_ps(rps);
2653
2654         rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
2655         rps->class = le16_to_cpu(non_clock_info->usClassification);
2656         rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
2657
2658         if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
2659                 rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
2660                 rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
2661         } else {
2662                 rps->vclk = 0;
2663                 rps->dclk = 0;
2664         }
2665
2666         if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
2667                 adev->pm.dpm.boot_ps = rps;
2668                 kv_patch_boot_state(adev, ps);
2669         }
2670         if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
2671                 adev->pm.dpm.uvd_ps = rps;
2672 }
2673
2674 static void kv_parse_pplib_clock_info(struct amdgpu_device *adev,
2675                                       struct amdgpu_ps *rps, int index,
2676                                         union pplib_clock_info *clock_info)
2677 {
2678         struct kv_power_info *pi = kv_get_pi(adev);
2679         struct kv_ps *ps = kv_get_ps(rps);
2680         struct kv_pl *pl = &ps->levels[index];
2681         u32 sclk;
2682
2683         sclk = le16_to_cpu(clock_info->sumo.usEngineClockLow);
2684         sclk |= clock_info->sumo.ucEngineClockHigh << 16;
2685         pl->sclk = sclk;
2686         pl->vddc_index = clock_info->sumo.vddcIndex;
2687
2688         ps->num_levels = index + 1;
2689
2690         if (pi->caps_sclk_ds) {
2691                 pl->ds_divider_index = 5;
2692                 pl->ss_divider_index = 5;
2693         }
2694 }
2695
2696 static int kv_parse_power_table(struct amdgpu_device *adev)
2697 {
2698         struct amdgpu_mode_info *mode_info = &adev->mode_info;
2699         struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
2700         union pplib_power_state *power_state;
2701         int i, j, k, non_clock_array_index, clock_array_index;
2702         union pplib_clock_info *clock_info;
2703         struct _StateArray *state_array;
2704         struct _ClockInfoArray *clock_info_array;
2705         struct _NonClockInfoArray *non_clock_info_array;
2706         union power_info *power_info;
2707         int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
2708         u16 data_offset;
2709         u8 frev, crev;
2710         u8 *power_state_offset;
2711         struct kv_ps *ps;
2712
2713         if (!amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
2714                                    &frev, &crev, &data_offset))
2715                 return -EINVAL;
2716         power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
2717
2718         amdgpu_add_thermal_controller(adev);
2719
2720         state_array = (struct _StateArray *)
2721                 (mode_info->atom_context->bios + data_offset +
2722                  le16_to_cpu(power_info->pplib.usStateArrayOffset));
2723         clock_info_array = (struct _ClockInfoArray *)
2724                 (mode_info->atom_context->bios + data_offset +
2725                  le16_to_cpu(power_info->pplib.usClockInfoArrayOffset));
2726         non_clock_info_array = (struct _NonClockInfoArray *)
2727                 (mode_info->atom_context->bios + data_offset +
2728                  le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset));
2729
2730         adev->pm.dpm.ps = kzalloc(sizeof(struct amdgpu_ps) *
2731                                   state_array->ucNumEntries, GFP_KERNEL);
2732         if (!adev->pm.dpm.ps)
2733                 return -ENOMEM;
2734         power_state_offset = (u8 *)state_array->states;
2735         for (i = 0; i < state_array->ucNumEntries; i++) {
2736                 u8 *idx;
2737                 power_state = (union pplib_power_state *)power_state_offset;
2738                 non_clock_array_index = power_state->v2.nonClockInfoIndex;
2739                 non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
2740                         &non_clock_info_array->nonClockInfo[non_clock_array_index];
2741                 ps = kzalloc(sizeof(struct kv_ps), GFP_KERNEL);
2742                 if (ps == NULL) {
2743                         kfree(adev->pm.dpm.ps);
2744                         return -ENOMEM;
2745                 }
2746                 adev->pm.dpm.ps[i].ps_priv = ps;
2747                 k = 0;
2748                 idx = (u8 *)&power_state->v2.clockInfoIndex[0];
2749                 for (j = 0; j < power_state->v2.ucNumDPMLevels; j++) {
2750                         clock_array_index = idx[j];
2751                         if (clock_array_index >= clock_info_array->ucNumEntries)
2752                                 continue;
2753                         if (k >= SUMO_MAX_HARDWARE_POWERLEVELS)
2754                                 break;
2755                         clock_info = (union pplib_clock_info *)
2756                                 ((u8 *)&clock_info_array->clockInfo[0] +
2757                                  (clock_array_index * clock_info_array->ucEntrySize));
2758                         kv_parse_pplib_clock_info(adev,
2759                                                   &adev->pm.dpm.ps[i], k,
2760                                                   clock_info);
2761                         k++;
2762                 }
2763                 kv_parse_pplib_non_clock_info(adev, &adev->pm.dpm.ps[i],
2764                                               non_clock_info,
2765                                               non_clock_info_array->ucEntrySize);
2766                 power_state_offset += 2 + power_state->v2.ucNumDPMLevels;
2767         }
2768         adev->pm.dpm.num_ps = state_array->ucNumEntries;
2769
2770         /* fill in the vce power states */
2771         for (i = 0; i < adev->pm.dpm.num_of_vce_states; i++) {
2772                 u32 sclk;
2773                 clock_array_index = adev->pm.dpm.vce_states[i].clk_idx;
2774                 clock_info = (union pplib_clock_info *)
2775                         &clock_info_array->clockInfo[clock_array_index * clock_info_array->ucEntrySize];
2776                 sclk = le16_to_cpu(clock_info->sumo.usEngineClockLow);
2777                 sclk |= clock_info->sumo.ucEngineClockHigh << 16;
2778                 adev->pm.dpm.vce_states[i].sclk = sclk;
2779                 adev->pm.dpm.vce_states[i].mclk = 0;
2780         }
2781
2782         return 0;
2783 }
2784
2785 static int kv_dpm_init(struct amdgpu_device *adev)
2786 {
2787         struct kv_power_info *pi;
2788         int ret, i;
2789
2790         pi = kzalloc(sizeof(struct kv_power_info), GFP_KERNEL);
2791         if (pi == NULL)
2792                 return -ENOMEM;
2793         adev->pm.dpm.priv = pi;
2794
2795         ret = amdgpu_get_platform_caps(adev);
2796         if (ret)
2797                 return ret;
2798
2799         ret = amdgpu_parse_extended_power_table(adev);
2800         if (ret)
2801                 return ret;
2802
2803         for (i = 0; i < SUMO_MAX_HARDWARE_POWERLEVELS; i++)
2804                 pi->at[i] = TRINITY_AT_DFLT;
2805
2806         pi->sram_end = SMC_RAM_END;
2807
2808         pi->enable_nb_dpm = true;
2809
2810         pi->caps_power_containment = true;
2811         pi->caps_cac = true;
2812         pi->enable_didt = false;
2813         if (pi->enable_didt) {
2814                 pi->caps_sq_ramping = true;
2815                 pi->caps_db_ramping = true;
2816                 pi->caps_td_ramping = true;
2817                 pi->caps_tcp_ramping = true;
2818         }
2819
2820         if (amdgpu_pp_feature_mask & SCLK_DEEP_SLEEP_MASK)
2821                 pi->caps_sclk_ds = true;
2822         else
2823                 pi->caps_sclk_ds = false;
2824
2825         pi->enable_auto_thermal_throttling = true;
2826         pi->disable_nb_ps3_in_battery = false;
2827         if (amdgpu_bapm == 0)
2828                 pi->bapm_enable = false;
2829         else
2830                 pi->bapm_enable = true;
2831         pi->voltage_drop_t = 0;
2832         pi->caps_sclk_throttle_low_notification = false;
2833         pi->caps_fps = false; /* true? */
2834         pi->caps_uvd_pg = (adev->pg_flags & AMD_PG_SUPPORT_UVD) ? true : false;
2835         pi->caps_uvd_dpm = true;
2836         pi->caps_vce_pg = (adev->pg_flags & AMD_PG_SUPPORT_VCE) ? true : false;
2837         pi->caps_samu_pg = (adev->pg_flags & AMD_PG_SUPPORT_SAMU) ? true : false;
2838         pi->caps_acp_pg = (adev->pg_flags & AMD_PG_SUPPORT_ACP) ? true : false;
2839         pi->caps_stable_p_state = false;
2840
2841         ret = kv_parse_sys_info_table(adev);
2842         if (ret)
2843                 return ret;
2844
2845         kv_patch_voltage_values(adev);
2846         kv_construct_boot_state(adev);
2847
2848         ret = kv_parse_power_table(adev);
2849         if (ret)
2850                 return ret;
2851
2852         pi->enable_dpm = true;
2853
2854         return 0;
2855 }
2856
2857 static void
2858 kv_dpm_debugfs_print_current_performance_level(void *handle,
2859                                                struct seq_file *m)
2860 {
2861         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2862         struct kv_power_info *pi = kv_get_pi(adev);
2863         u32 current_index =
2864                 (RREG32_SMC(ixTARGET_AND_CURRENT_PROFILE_INDEX) &
2865                 TARGET_AND_CURRENT_PROFILE_INDEX__CURR_SCLK_INDEX_MASK) >>
2866                 TARGET_AND_CURRENT_PROFILE_INDEX__CURR_SCLK_INDEX__SHIFT;
2867         u32 sclk, tmp;
2868         u16 vddc;
2869
2870         if (current_index >= SMU__NUM_SCLK_DPM_STATE) {
2871                 seq_printf(m, "invalid dpm profile %d\n", current_index);
2872         } else {
2873                 sclk = be32_to_cpu(pi->graphics_level[current_index].SclkFrequency);
2874                 tmp = (RREG32_SMC(ixSMU_VOLTAGE_STATUS) &
2875                         SMU_VOLTAGE_STATUS__SMU_VOLTAGE_CURRENT_LEVEL_MASK) >>
2876                         SMU_VOLTAGE_STATUS__SMU_VOLTAGE_CURRENT_LEVEL__SHIFT;
2877                 vddc = kv_convert_8bit_index_to_voltage(adev, (u16)tmp);
2878                 seq_printf(m, "uvd    %sabled\n", pi->uvd_power_gated ? "dis" : "en");
2879                 seq_printf(m, "vce    %sabled\n", pi->vce_power_gated ? "dis" : "en");
2880                 seq_printf(m, "power level %d    sclk: %u vddc: %u\n",
2881                            current_index, sclk, vddc);
2882         }
2883 }
2884
2885 static void
2886 kv_dpm_print_power_state(void *handle, void *request_ps)
2887 {
2888         int i;
2889         struct amdgpu_ps *rps = (struct amdgpu_ps *)request_ps;
2890         struct kv_ps *ps = kv_get_ps(rps);
2891         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2892
2893         amdgpu_dpm_print_class_info(rps->class, rps->class2);
2894         amdgpu_dpm_print_cap_info(rps->caps);
2895         printk("\tuvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
2896         for (i = 0; i < ps->num_levels; i++) {
2897                 struct kv_pl *pl = &ps->levels[i];
2898                 printk("\t\tpower level %d    sclk: %u vddc: %u\n",
2899                        i, pl->sclk,
2900                        kv_convert_8bit_index_to_voltage(adev, pl->vddc_index));
2901         }
2902         amdgpu_dpm_print_ps_status(adev, rps);
2903 }
2904
2905 static void kv_dpm_fini(struct amdgpu_device *adev)
2906 {
2907         int i;
2908
2909         for (i = 0; i < adev->pm.dpm.num_ps; i++) {
2910                 kfree(adev->pm.dpm.ps[i].ps_priv);
2911         }
2912         kfree(adev->pm.dpm.ps);
2913         kfree(adev->pm.dpm.priv);
2914         amdgpu_free_extended_power_table(adev);
2915 }
2916
2917 static void kv_dpm_display_configuration_changed(void *handle)
2918 {
2919
2920 }
2921
2922 static u32 kv_dpm_get_sclk(void *handle, bool low)
2923 {
2924         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2925         struct kv_power_info *pi = kv_get_pi(adev);
2926         struct kv_ps *requested_state = kv_get_ps(&pi->requested_rps);
2927
2928         if (low)
2929                 return requested_state->levels[0].sclk;
2930         else
2931                 return requested_state->levels[requested_state->num_levels - 1].sclk;
2932 }
2933
2934 static u32 kv_dpm_get_mclk(void *handle, bool low)
2935 {
2936         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2937         struct kv_power_info *pi = kv_get_pi(adev);
2938
2939         return pi->sys_info.bootup_uma_clk;
2940 }
2941
2942 /* get temperature in millidegrees */
2943 static int kv_dpm_get_temp(void *handle)
2944 {
2945         u32 temp;
2946         int actual_temp = 0;
2947         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2948
2949         temp = RREG32_SMC(0xC0300E0C);
2950
2951         if (temp)
2952                 actual_temp = (temp / 8) - 49;
2953         else
2954                 actual_temp = 0;
2955
2956         actual_temp = actual_temp * 1000;
2957
2958         return actual_temp;
2959 }
2960
2961 static int kv_dpm_early_init(void *handle)
2962 {
2963         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2964
2965         adev->powerplay.pp_funcs = &kv_dpm_funcs;
2966         adev->powerplay.pp_handle = adev;
2967         kv_dpm_set_irq_funcs(adev);
2968
2969         return 0;
2970 }
2971
2972 static int kv_dpm_late_init(void *handle)
2973 {
2974         /* powerdown unused blocks for now */
2975         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2976
2977         if (!amdgpu_dpm)
2978                 return 0;
2979
2980         kv_dpm_powergate_acp(adev, true);
2981         kv_dpm_powergate_samu(adev, true);
2982
2983         return 0;
2984 }
2985
2986 static int kv_dpm_sw_init(void *handle)
2987 {
2988         int ret;
2989         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2990
2991         ret = amdgpu_irq_add_id(adev, AMDGPU_IH_CLIENTID_LEGACY, 230,
2992                                 &adev->pm.dpm.thermal.irq);
2993         if (ret)
2994                 return ret;
2995
2996         ret = amdgpu_irq_add_id(adev, AMDGPU_IH_CLIENTID_LEGACY, 231,
2997                                 &adev->pm.dpm.thermal.irq);
2998         if (ret)
2999                 return ret;
3000
3001         /* default to balanced state */
3002         adev->pm.dpm.state = POWER_STATE_TYPE_BALANCED;
3003         adev->pm.dpm.user_state = POWER_STATE_TYPE_BALANCED;
3004         adev->pm.dpm.forced_level = AMD_DPM_FORCED_LEVEL_AUTO;
3005         adev->pm.default_sclk = adev->clock.default_sclk;
3006         adev->pm.default_mclk = adev->clock.default_mclk;
3007         adev->pm.current_sclk = adev->clock.default_sclk;
3008         adev->pm.current_mclk = adev->clock.default_mclk;
3009         adev->pm.int_thermal_type = THERMAL_TYPE_NONE;
3010
3011         if (amdgpu_dpm == 0)
3012                 return 0;
3013
3014         INIT_WORK(&adev->pm.dpm.thermal.work, amdgpu_dpm_thermal_work_handler);
3015         mutex_lock(&adev->pm.mutex);
3016         ret = kv_dpm_init(adev);
3017         if (ret)
3018                 goto dpm_failed;
3019         adev->pm.dpm.current_ps = adev->pm.dpm.requested_ps = adev->pm.dpm.boot_ps;
3020         if (amdgpu_dpm == 1)
3021                 amdgpu_pm_print_power_states(adev);
3022         mutex_unlock(&adev->pm.mutex);
3023         DRM_INFO("amdgpu: dpm initialized\n");
3024
3025         return 0;
3026
3027 dpm_failed:
3028         kv_dpm_fini(adev);
3029         mutex_unlock(&adev->pm.mutex);
3030         DRM_ERROR("amdgpu: dpm initialization failed\n");
3031         return ret;
3032 }
3033
3034 static int kv_dpm_sw_fini(void *handle)
3035 {
3036         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3037
3038         flush_work(&adev->pm.dpm.thermal.work);
3039
3040         mutex_lock(&adev->pm.mutex);
3041         kv_dpm_fini(adev);
3042         mutex_unlock(&adev->pm.mutex);
3043
3044         return 0;
3045 }
3046
3047 static int kv_dpm_hw_init(void *handle)
3048 {
3049         int ret;
3050         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3051
3052         if (!amdgpu_dpm)
3053                 return 0;
3054
3055         mutex_lock(&adev->pm.mutex);
3056         kv_dpm_setup_asic(adev);
3057         ret = kv_dpm_enable(adev);
3058         if (ret)
3059                 adev->pm.dpm_enabled = false;
3060         else
3061                 adev->pm.dpm_enabled = true;
3062         mutex_unlock(&adev->pm.mutex);
3063
3064         return ret;
3065 }
3066
3067 static int kv_dpm_hw_fini(void *handle)
3068 {
3069         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3070
3071         if (adev->pm.dpm_enabled) {
3072                 mutex_lock(&adev->pm.mutex);
3073                 kv_dpm_disable(adev);
3074                 mutex_unlock(&adev->pm.mutex);
3075         }
3076
3077         return 0;
3078 }
3079
3080 static int kv_dpm_suspend(void *handle)
3081 {
3082         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3083
3084         if (adev->pm.dpm_enabled) {
3085                 mutex_lock(&adev->pm.mutex);
3086                 /* disable dpm */
3087                 kv_dpm_disable(adev);
3088                 /* reset the power state */
3089                 adev->pm.dpm.current_ps = adev->pm.dpm.requested_ps = adev->pm.dpm.boot_ps;
3090                 mutex_unlock(&adev->pm.mutex);
3091         }
3092         return 0;
3093 }
3094
3095 static int kv_dpm_resume(void *handle)
3096 {
3097         int ret;
3098         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3099
3100         if (adev->pm.dpm_enabled) {
3101                 /* asic init will reset to the boot state */
3102                 mutex_lock(&adev->pm.mutex);
3103                 kv_dpm_setup_asic(adev);
3104                 ret = kv_dpm_enable(adev);
3105                 if (ret)
3106                         adev->pm.dpm_enabled = false;
3107                 else
3108                         adev->pm.dpm_enabled = true;
3109                 mutex_unlock(&adev->pm.mutex);
3110                 if (adev->pm.dpm_enabled)
3111                         amdgpu_pm_compute_clocks(adev);
3112         }
3113         return 0;
3114 }
3115
3116 static bool kv_dpm_is_idle(void *handle)
3117 {
3118         return true;
3119 }
3120
3121 static int kv_dpm_wait_for_idle(void *handle)
3122 {
3123         return 0;
3124 }
3125
3126
3127 static int kv_dpm_soft_reset(void *handle)
3128 {
3129         return 0;
3130 }
3131
3132 static int kv_dpm_set_interrupt_state(struct amdgpu_device *adev,
3133                                       struct amdgpu_irq_src *src,
3134                                       unsigned type,
3135                                       enum amdgpu_interrupt_state state)
3136 {
3137         u32 cg_thermal_int;
3138
3139         switch (type) {
3140         case AMDGPU_THERMAL_IRQ_LOW_TO_HIGH:
3141                 switch (state) {
3142                 case AMDGPU_IRQ_STATE_DISABLE:
3143                         cg_thermal_int = RREG32_SMC(ixCG_THERMAL_INT_CTRL);
3144                         cg_thermal_int &= ~CG_THERMAL_INT_CTRL__THERM_INTH_MASK_MASK;
3145                         WREG32_SMC(ixCG_THERMAL_INT_CTRL, cg_thermal_int);
3146                         break;
3147                 case AMDGPU_IRQ_STATE_ENABLE:
3148                         cg_thermal_int = RREG32_SMC(ixCG_THERMAL_INT_CTRL);
3149                         cg_thermal_int |= CG_THERMAL_INT_CTRL__THERM_INTH_MASK_MASK;
3150                         WREG32_SMC(ixCG_THERMAL_INT_CTRL, cg_thermal_int);
3151                         break;
3152                 default:
3153                         break;
3154                 }
3155                 break;
3156
3157         case AMDGPU_THERMAL_IRQ_HIGH_TO_LOW:
3158                 switch (state) {
3159                 case AMDGPU_IRQ_STATE_DISABLE:
3160                         cg_thermal_int = RREG32_SMC(ixCG_THERMAL_INT_CTRL);
3161                         cg_thermal_int &= ~CG_THERMAL_INT_CTRL__THERM_INTL_MASK_MASK;
3162                         WREG32_SMC(ixCG_THERMAL_INT_CTRL, cg_thermal_int);
3163                         break;
3164                 case AMDGPU_IRQ_STATE_ENABLE:
3165                         cg_thermal_int = RREG32_SMC(ixCG_THERMAL_INT_CTRL);
3166                         cg_thermal_int |= CG_THERMAL_INT_CTRL__THERM_INTL_MASK_MASK;
3167                         WREG32_SMC(ixCG_THERMAL_INT_CTRL, cg_thermal_int);
3168                         break;
3169                 default:
3170                         break;
3171                 }
3172                 break;
3173
3174         default:
3175                 break;
3176         }
3177         return 0;
3178 }
3179
3180 static int kv_dpm_process_interrupt(struct amdgpu_device *adev,
3181                                     struct amdgpu_irq_src *source,
3182                                     struct amdgpu_iv_entry *entry)
3183 {
3184         bool queue_thermal = false;
3185
3186         if (entry == NULL)
3187                 return -EINVAL;
3188
3189         switch (entry->src_id) {
3190         case 230: /* thermal low to high */
3191                 DRM_DEBUG("IH: thermal low to high\n");
3192                 adev->pm.dpm.thermal.high_to_low = false;
3193                 queue_thermal = true;
3194                 break;
3195         case 231: /* thermal high to low */
3196                 DRM_DEBUG("IH: thermal high to low\n");
3197                 adev->pm.dpm.thermal.high_to_low = true;
3198                 queue_thermal = true;
3199                 break;
3200         default:
3201                 break;
3202         }
3203
3204         if (queue_thermal)
3205                 schedule_work(&adev->pm.dpm.thermal.work);
3206
3207         return 0;
3208 }
3209
3210 static int kv_dpm_set_clockgating_state(void *handle,
3211                                           enum amd_clockgating_state state)
3212 {
3213         return 0;
3214 }
3215
3216 static int kv_dpm_set_powergating_state(void *handle,
3217                                           enum amd_powergating_state state)
3218 {
3219         return 0;
3220 }
3221
3222 static inline bool kv_are_power_levels_equal(const struct kv_pl *kv_cpl1,
3223                                                 const struct kv_pl *kv_cpl2)
3224 {
3225         return ((kv_cpl1->sclk == kv_cpl2->sclk) &&
3226                   (kv_cpl1->vddc_index == kv_cpl2->vddc_index) &&
3227                   (kv_cpl1->ds_divider_index == kv_cpl2->ds_divider_index) &&
3228                   (kv_cpl1->force_nbp_state == kv_cpl2->force_nbp_state));
3229 }
3230
3231 static int kv_check_state_equal(void *handle,
3232                                 void *current_ps,
3233                                 void *request_ps,
3234                                 bool *equal)
3235 {
3236         struct kv_ps *kv_cps;
3237         struct kv_ps *kv_rps;
3238         int i;
3239         struct amdgpu_ps *cps = (struct amdgpu_ps *)current_ps;
3240         struct amdgpu_ps *rps = (struct amdgpu_ps *)request_ps;
3241         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3242
3243         if (adev == NULL || cps == NULL || rps == NULL || equal == NULL)
3244                 return -EINVAL;
3245
3246         kv_cps = kv_get_ps(cps);
3247         kv_rps = kv_get_ps(rps);
3248
3249         if (kv_cps == NULL) {
3250                 *equal = false;
3251                 return 0;
3252         }
3253
3254         if (kv_cps->num_levels != kv_rps->num_levels) {
3255                 *equal = false;
3256                 return 0;
3257         }
3258
3259         for (i = 0; i < kv_cps->num_levels; i++) {
3260                 if (!kv_are_power_levels_equal(&(kv_cps->levels[i]),
3261                                         &(kv_rps->levels[i]))) {
3262                         *equal = false;
3263                         return 0;
3264                 }
3265         }
3266
3267         /* If all performance levels are the same try to use the UVD clocks to break the tie.*/
3268         *equal = ((cps->vclk == rps->vclk) && (cps->dclk == rps->dclk));
3269         *equal &= ((cps->evclk == rps->evclk) && (cps->ecclk == rps->ecclk));
3270
3271         return 0;
3272 }
3273
3274 static int kv_dpm_read_sensor(void *handle, int idx,
3275                               void *value, int *size)
3276 {
3277         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3278         struct kv_power_info *pi = kv_get_pi(adev);
3279         uint32_t sclk;
3280         u32 pl_index =
3281                 (RREG32_SMC(ixTARGET_AND_CURRENT_PROFILE_INDEX) &
3282                 TARGET_AND_CURRENT_PROFILE_INDEX__CURR_SCLK_INDEX_MASK) >>
3283                 TARGET_AND_CURRENT_PROFILE_INDEX__CURR_SCLK_INDEX__SHIFT;
3284
3285         /* size must be at least 4 bytes for all sensors */
3286         if (*size < 4)
3287                 return -EINVAL;
3288
3289         switch (idx) {
3290         case AMDGPU_PP_SENSOR_GFX_SCLK:
3291                 if (pl_index < SMU__NUM_SCLK_DPM_STATE) {
3292                         sclk = be32_to_cpu(
3293                                 pi->graphics_level[pl_index].SclkFrequency);
3294                         *((uint32_t *)value) = sclk;
3295                         *size = 4;
3296                         return 0;
3297                 }
3298                 return -EINVAL;
3299         case AMDGPU_PP_SENSOR_GPU_TEMP:
3300                 *((uint32_t *)value) = kv_dpm_get_temp(adev);
3301                 *size = 4;
3302                 return 0;
3303         default:
3304                 return -EINVAL;
3305         }
3306 }
3307
3308 static const struct amd_ip_funcs kv_dpm_ip_funcs = {
3309         .name = "kv_dpm",
3310         .early_init = kv_dpm_early_init,
3311         .late_init = kv_dpm_late_init,
3312         .sw_init = kv_dpm_sw_init,
3313         .sw_fini = kv_dpm_sw_fini,
3314         .hw_init = kv_dpm_hw_init,
3315         .hw_fini = kv_dpm_hw_fini,
3316         .suspend = kv_dpm_suspend,
3317         .resume = kv_dpm_resume,
3318         .is_idle = kv_dpm_is_idle,
3319         .wait_for_idle = kv_dpm_wait_for_idle,
3320         .soft_reset = kv_dpm_soft_reset,
3321         .set_clockgating_state = kv_dpm_set_clockgating_state,
3322         .set_powergating_state = kv_dpm_set_powergating_state,
3323 };
3324
3325 const struct amdgpu_ip_block_version kv_smu_ip_block =
3326 {
3327         .type = AMD_IP_BLOCK_TYPE_SMC,
3328         .major = 1,
3329         .minor = 0,
3330         .rev = 0,
3331         .funcs = &kv_dpm_ip_funcs,
3332 };
3333
3334 static const struct amd_pm_funcs kv_dpm_funcs = {
3335         .pre_set_power_state = &kv_dpm_pre_set_power_state,
3336         .set_power_state = &kv_dpm_set_power_state,
3337         .post_set_power_state = &kv_dpm_post_set_power_state,
3338         .display_configuration_changed = &kv_dpm_display_configuration_changed,
3339         .get_sclk = &kv_dpm_get_sclk,
3340         .get_mclk = &kv_dpm_get_mclk,
3341         .print_power_state = &kv_dpm_print_power_state,
3342         .debugfs_print_current_performance_level = &kv_dpm_debugfs_print_current_performance_level,
3343         .force_performance_level = &kv_dpm_force_performance_level,
3344         .powergate_uvd = &kv_dpm_powergate_uvd,
3345         .enable_bapm = &kv_dpm_enable_bapm,
3346         .get_vce_clock_state = amdgpu_get_vce_clock_state,
3347         .check_state_equal = kv_check_state_equal,
3348         .read_sensor = &kv_dpm_read_sensor,
3349 };
3350
3351 static const struct amdgpu_irq_src_funcs kv_dpm_irq_funcs = {
3352         .set = kv_dpm_set_interrupt_state,
3353         .process = kv_dpm_process_interrupt,
3354 };
3355
3356 static void kv_dpm_set_irq_funcs(struct amdgpu_device *adev)
3357 {
3358         adev->pm.dpm.thermal.irq.num_types = AMDGPU_THERMAL_IRQ_LAST;
3359         adev->pm.dpm.thermal.irq.funcs = &kv_dpm_irq_funcs;
3360 }