1/*
   2 * Copyright 2012 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 <linux/pci.h>
  25#include <linux/seq_file.h>
  26
  27#include "r600_dpm.h"
  28#include "radeon.h"
  29#include "radeon_asic.h"
  30#include "trinity_dpm.h"
  31#include "trinityd.h"
  32#include "vce.h"
  33
  34#define TRINITY_MAX_DEEPSLEEP_DIVIDER_ID 5
  35#define TRINITY_MINIMUM_ENGINE_CLOCK 800
  36#define SCLK_MIN_DIV_INTV_SHIFT     12
  37#define TRINITY_DISPCLK_BYPASS_THRESHOLD 10000
  38
  39#ifndef TRINITY_MGCG_SEQUENCE
  40#define TRINITY_MGCG_SEQUENCE  100
  41
  42static const u32 trinity_mgcg_shls_default[] = {
 
  43	/* Register, Value, Mask */
  44	0x0000802c, 0xc0000000, 0xffffffff,
  45	0x00003fc4, 0xc0000000, 0xffffffff,
  46	0x00005448, 0x00000100, 0xffffffff,
  47	0x000055e4, 0x00000100, 0xffffffff,
  48	0x0000160c, 0x00000100, 0xffffffff,
  49	0x00008984, 0x06000100, 0xffffffff,
  50	0x0000c164, 0x00000100, 0xffffffff,
  51	0x00008a18, 0x00000100, 0xffffffff,
  52	0x0000897c, 0x06000100, 0xffffffff,
  53	0x00008b28, 0x00000100, 0xffffffff,
  54	0x00009144, 0x00800200, 0xffffffff,
  55	0x00009a60, 0x00000100, 0xffffffff,
  56	0x00009868, 0x00000100, 0xffffffff,
  57	0x00008d58, 0x00000100, 0xffffffff,
  58	0x00009510, 0x00000100, 0xffffffff,
  59	0x0000949c, 0x00000100, 0xffffffff,
  60	0x00009654, 0x00000100, 0xffffffff,
  61	0x00009030, 0x00000100, 0xffffffff,
  62	0x00009034, 0x00000100, 0xffffffff,
  63	0x00009038, 0x00000100, 0xffffffff,
  64	0x0000903c, 0x00000100, 0xffffffff,
  65	0x00009040, 0x00000100, 0xffffffff,
  66	0x0000a200, 0x00000100, 0xffffffff,
  67	0x0000a204, 0x00000100, 0xffffffff,
  68	0x0000a208, 0x00000100, 0xffffffff,
  69	0x0000a20c, 0x00000100, 0xffffffff,
  70	0x00009744, 0x00000100, 0xffffffff,
  71	0x00003f80, 0x00000100, 0xffffffff,
  72	0x0000a210, 0x00000100, 0xffffffff,
  73	0x0000a214, 0x00000100, 0xffffffff,
  74	0x000004d8, 0x00000100, 0xffffffff,
  75	0x00009664, 0x00000100, 0xffffffff,
  76	0x00009698, 0x00000100, 0xffffffff,
  77	0x000004d4, 0x00000200, 0xffffffff,
  78	0x000004d0, 0x00000000, 0xffffffff,
  79	0x000030cc, 0x00000104, 0xffffffff,
  80	0x0000d0c0, 0x00000100, 0xffffffff,
  81	0x0000d8c0, 0x00000100, 0xffffffff,
  82	0x0000951c, 0x00010000, 0xffffffff,
  83	0x00009160, 0x00030002, 0xffffffff,
  84	0x00009164, 0x00050004, 0xffffffff,
  85	0x00009168, 0x00070006, 0xffffffff,
  86	0x00009178, 0x00070000, 0xffffffff,
  87	0x0000917c, 0x00030002, 0xffffffff,
  88	0x00009180, 0x00050004, 0xffffffff,
  89	0x0000918c, 0x00010006, 0xffffffff,
  90	0x00009190, 0x00090008, 0xffffffff,
  91	0x00009194, 0x00070000, 0xffffffff,
  92	0x00009198, 0x00030002, 0xffffffff,
  93	0x0000919c, 0x00050004, 0xffffffff,
  94	0x000091a8, 0x00010006, 0xffffffff,
  95	0x000091ac, 0x00090008, 0xffffffff,
  96	0x000091b0, 0x00070000, 0xffffffff,
  97	0x000091b4, 0x00030002, 0xffffffff,
  98	0x000091b8, 0x00050004, 0xffffffff,
  99	0x000091c4, 0x00010006, 0xffffffff,
 100	0x000091c8, 0x00090008, 0xffffffff,
 101	0x000091cc, 0x00070000, 0xffffffff,
 102	0x000091d0, 0x00030002, 0xffffffff,
 103	0x000091d4, 0x00050004, 0xffffffff,
 104	0x000091e0, 0x00010006, 0xffffffff,
 105	0x000091e4, 0x00090008, 0xffffffff,
 106	0x000091e8, 0x00000000, 0xffffffff,
 107	0x000091ec, 0x00070000, 0xffffffff,
 108	0x000091f0, 0x00030002, 0xffffffff,
 109	0x000091f4, 0x00050004, 0xffffffff,
 110	0x00009200, 0x00010006, 0xffffffff,
 111	0x00009204, 0x00090008, 0xffffffff,
 112	0x00009208, 0x00070000, 0xffffffff,
 113	0x0000920c, 0x00030002, 0xffffffff,
 114	0x00009210, 0x00050004, 0xffffffff,
 115	0x0000921c, 0x00010006, 0xffffffff,
 116	0x00009220, 0x00090008, 0xffffffff,
 117	0x00009294, 0x00000000, 0xffffffff
 118};
 119#endif
 120
 121#ifndef TRINITY_SYSLS_SEQUENCE
 122#define TRINITY_SYSLS_SEQUENCE  100
 123
 124static const u32 trinity_sysls_disable[] = {
 
 125	/* Register, Value, Mask */
 126	0x0000d0c0, 0x00000000, 0xffffffff,
 127	0x0000d8c0, 0x00000000, 0xffffffff,
 128	0x000055e8, 0x00000000, 0xffffffff,
 129	0x0000d0bc, 0x00000000, 0xffffffff,
 130	0x0000d8bc, 0x00000000, 0xffffffff,
 131	0x000015c0, 0x00041401, 0xffffffff,
 132	0x0000264c, 0x00040400, 0xffffffff,
 133	0x00002648, 0x00040400, 0xffffffff,
 134	0x00002650, 0x00040400, 0xffffffff,
 135	0x000020b8, 0x00040400, 0xffffffff,
 136	0x000020bc, 0x00040400, 0xffffffff,
 137	0x000020c0, 0x00040c80, 0xffffffff,
 138	0x0000f4a0, 0x000000c0, 0xffffffff,
 139	0x0000f4a4, 0x00680000, 0xffffffff,
 140	0x00002f50, 0x00000404, 0xffffffff,
 141	0x000004c8, 0x00000001, 0xffffffff,
 142	0x0000641c, 0x00007ffd, 0xffffffff,
 143	0x00000c7c, 0x0000ff00, 0xffffffff,
 144	0x00006dfc, 0x0000007f, 0xffffffff
 145};
 146
 147static const u32 trinity_sysls_enable[] = {
 
 148	/* Register, Value, Mask */
 149	0x000055e8, 0x00000001, 0xffffffff,
 150	0x0000d0bc, 0x00000100, 0xffffffff,
 151	0x0000d8bc, 0x00000100, 0xffffffff,
 152	0x000015c0, 0x000c1401, 0xffffffff,
 153	0x0000264c, 0x000c0400, 0xffffffff,
 154	0x00002648, 0x000c0400, 0xffffffff,
 155	0x00002650, 0x000c0400, 0xffffffff,
 156	0x000020b8, 0x000c0400, 0xffffffff,
 157	0x000020bc, 0x000c0400, 0xffffffff,
 158	0x000020c0, 0x000c0c80, 0xffffffff,
 159	0x0000f4a0, 0x000000c0, 0xffffffff,
 160	0x0000f4a4, 0x00680fff, 0xffffffff,
 161	0x00002f50, 0x00000903, 0xffffffff,
 162	0x000004c8, 0x00000000, 0xffffffff,
 163	0x0000641c, 0x00000000, 0xffffffff,
 164	0x00000c7c, 0x00000000, 0xffffffff,
 165	0x00006dfc, 0x00000000, 0xffffffff
 166};
 167#endif
 168
 169static const u32 trinity_override_mgpg_sequences[] = {
 
 170	/* Register, Value */
 171	0x00000200, 0xE030032C,
 172	0x00000204, 0x00000FFF,
 173	0x00000200, 0xE0300058,
 174	0x00000204, 0x00030301,
 175	0x00000200, 0xE0300054,
 176	0x00000204, 0x500010FF,
 177	0x00000200, 0xE0300074,
 178	0x00000204, 0x00030301,
 179	0x00000200, 0xE0300070,
 180	0x00000204, 0x500010FF,
 181	0x00000200, 0xE0300090,
 182	0x00000204, 0x00030301,
 183	0x00000200, 0xE030008C,
 184	0x00000204, 0x500010FF,
 185	0x00000200, 0xE03000AC,
 186	0x00000204, 0x00030301,
 187	0x00000200, 0xE03000A8,
 188	0x00000204, 0x500010FF,
 189	0x00000200, 0xE03000C8,
 190	0x00000204, 0x00030301,
 191	0x00000200, 0xE03000C4,
 192	0x00000204, 0x500010FF,
 193	0x00000200, 0xE03000E4,
 194	0x00000204, 0x00030301,
 195	0x00000200, 0xE03000E0,
 196	0x00000204, 0x500010FF,
 197	0x00000200, 0xE0300100,
 198	0x00000204, 0x00030301,
 199	0x00000200, 0xE03000FC,
 200	0x00000204, 0x500010FF,
 201	0x00000200, 0xE0300058,
 202	0x00000204, 0x00030303,
 203	0x00000200, 0xE0300054,
 204	0x00000204, 0x600010FF,
 205	0x00000200, 0xE0300074,
 206	0x00000204, 0x00030303,
 207	0x00000200, 0xE0300070,
 208	0x00000204, 0x600010FF,
 209	0x00000200, 0xE0300090,
 210	0x00000204, 0x00030303,
 211	0x00000200, 0xE030008C,
 212	0x00000204, 0x600010FF,
 213	0x00000200, 0xE03000AC,
 214	0x00000204, 0x00030303,
 215	0x00000200, 0xE03000A8,
 216	0x00000204, 0x600010FF,
 217	0x00000200, 0xE03000C8,
 218	0x00000204, 0x00030303,
 219	0x00000200, 0xE03000C4,
 220	0x00000204, 0x600010FF,
 221	0x00000200, 0xE03000E4,
 222	0x00000204, 0x00030303,
 223	0x00000200, 0xE03000E0,
 224	0x00000204, 0x600010FF,
 225	0x00000200, 0xE0300100,
 226	0x00000204, 0x00030303,
 227	0x00000200, 0xE03000FC,
 228	0x00000204, 0x600010FF,
 229	0x00000200, 0xE0300058,
 230	0x00000204, 0x00030303,
 231	0x00000200, 0xE0300054,
 232	0x00000204, 0x700010FF,
 233	0x00000200, 0xE0300074,
 234	0x00000204, 0x00030303,
 235	0x00000200, 0xE0300070,
 236	0x00000204, 0x700010FF,
 237	0x00000200, 0xE0300090,
 238	0x00000204, 0x00030303,
 239	0x00000200, 0xE030008C,
 240	0x00000204, 0x700010FF,
 241	0x00000200, 0xE03000AC,
 242	0x00000204, 0x00030303,
 243	0x00000200, 0xE03000A8,
 244	0x00000204, 0x700010FF,
 245	0x00000200, 0xE03000C8,
 246	0x00000204, 0x00030303,
 247	0x00000200, 0xE03000C4,
 248	0x00000204, 0x700010FF,
 249	0x00000200, 0xE03000E4,
 250	0x00000204, 0x00030303,
 251	0x00000200, 0xE03000E0,
 252	0x00000204, 0x700010FF,
 253	0x00000200, 0xE0300100,
 254	0x00000204, 0x00030303,
 255	0x00000200, 0xE03000FC,
 256	0x00000204, 0x700010FF,
 257	0x00000200, 0xE0300058,
 258	0x00000204, 0x00010303,
 259	0x00000200, 0xE0300054,
 260	0x00000204, 0x800010FF,
 261	0x00000200, 0xE0300074,
 262	0x00000204, 0x00010303,
 263	0x00000200, 0xE0300070,
 264	0x00000204, 0x800010FF,
 265	0x00000200, 0xE0300090,
 266	0x00000204, 0x00010303,
 267	0x00000200, 0xE030008C,
 268	0x00000204, 0x800010FF,
 269	0x00000200, 0xE03000AC,
 270	0x00000204, 0x00010303,
 271	0x00000200, 0xE03000A8,
 272	0x00000204, 0x800010FF,
 273	0x00000200, 0xE03000C4,
 274	0x00000204, 0x800010FF,
 275	0x00000200, 0xE03000C8,
 276	0x00000204, 0x00010303,
 277	0x00000200, 0xE03000E4,
 278	0x00000204, 0x00010303,
 279	0x00000200, 0xE03000E0,
 280	0x00000204, 0x800010FF,
 281	0x00000200, 0xE0300100,
 282	0x00000204, 0x00010303,
 283	0x00000200, 0xE03000FC,
 284	0x00000204, 0x800010FF,
 285	0x00000200, 0x0001f198,
 286	0x00000204, 0x0003ffff,
 287	0x00000200, 0x0001f19C,
 288	0x00000204, 0x3fffffff,
 289	0x00000200, 0xE030032C,
 290	0x00000204, 0x00000000,
 291};
 292
 293static void trinity_program_clk_gating_hw_sequence(struct radeon_device *rdev,
 294						   const u32 *seq, u32 count);
 295static void trinity_override_dynamic_mg_powergating(struct radeon_device *rdev);
 296static void trinity_apply_state_adjust_rules(struct radeon_device *rdev,
 297					     struct radeon_ps *new_rps,
 298					     struct radeon_ps *old_rps);
 299
 300static struct trinity_ps *trinity_get_ps(struct radeon_ps *rps)
 301{
 302	struct trinity_ps *ps = rps->ps_priv;
 303
 304	return ps;
 305}
 306
 307static struct trinity_power_info *trinity_get_pi(struct radeon_device *rdev)
 308{
 309	struct trinity_power_info *pi = rdev->pm.dpm.priv;
 310
 311	return pi;
 312}
 313
 314static void trinity_gfx_powergating_initialize(struct radeon_device *rdev)
 315{
 316	struct trinity_power_info *pi = trinity_get_pi(rdev);
 317	u32 p, u;
 318	u32 value;
 319	struct atom_clock_dividers dividers;
 320	u32 xclk = radeon_get_xclk(rdev);
 321	u32 sssd = 1;
 322	int ret;
 323	u32 hw_rev = (RREG32(HW_REV) & ATI_REV_ID_MASK) >> ATI_REV_ID_SHIFT;
 324
 325	ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
 326					     25000, false, &dividers);
 327	if (ret)
 328		return;
 329
 330	value = RREG32_SMC(GFX_POWER_GATING_CNTL);
 331	value &= ~(SSSD_MASK | PDS_DIV_MASK);
 332	if (sssd)
 333		value |= SSSD(1);
 334	value |= PDS_DIV(dividers.post_div);
 335	WREG32_SMC(GFX_POWER_GATING_CNTL, value);
 336
 337	r600_calculate_u_and_p(500, xclk, 16, &p, &u);
 338
 339	WREG32(CG_PG_CTRL, SP(p) | SU(u));
 340
 341	WREG32_P(CG_GIPOTS, CG_GIPOT(p), ~CG_GIPOT_MASK);
 342
 343	/* XXX double check hw_rev */
 344	if (pi->override_dynamic_mgpg && (hw_rev == 0))
 345		trinity_override_dynamic_mg_powergating(rdev);
 346
 347}
 348
 349#define CGCG_CGTT_LOCAL0_MASK       0xFFFF33FF
 350#define CGCG_CGTT_LOCAL1_MASK       0xFFFB0FFE
 351#define CGTS_SM_CTRL_REG_DISABLE    0x00600000
 352#define CGTS_SM_CTRL_REG_ENABLE     0x96944200
 353
 354static void trinity_mg_clockgating_enable(struct radeon_device *rdev,
 355					  bool enable)
 356{
 357	u32 local0;
 358	u32 local1;
 359
 360	if (enable) {
 361		local0 = RREG32_CG(CG_CGTT_LOCAL_0);
 362		local1 = RREG32_CG(CG_CGTT_LOCAL_1);
 363
 364		WREG32_CG(CG_CGTT_LOCAL_0,
 365			  (0x00380000 & CGCG_CGTT_LOCAL0_MASK) | (local0 & ~CGCG_CGTT_LOCAL0_MASK));
 366		WREG32_CG(CG_CGTT_LOCAL_1,
 367			  (0x0E000000 & CGCG_CGTT_LOCAL1_MASK) | (local1 & ~CGCG_CGTT_LOCAL1_MASK));
 368
 369		WREG32(CGTS_SM_CTRL_REG, CGTS_SM_CTRL_REG_ENABLE);
 370	} else {
 371		WREG32(CGTS_SM_CTRL_REG, CGTS_SM_CTRL_REG_DISABLE);
 372
 373		local0 = RREG32_CG(CG_CGTT_LOCAL_0);
 374		local1 = RREG32_CG(CG_CGTT_LOCAL_1);
 375
 376		WREG32_CG(CG_CGTT_LOCAL_0,
 377			  CGCG_CGTT_LOCAL0_MASK | (local0 & ~CGCG_CGTT_LOCAL0_MASK));
 378		WREG32_CG(CG_CGTT_LOCAL_1,
 379			  CGCG_CGTT_LOCAL1_MASK | (local1 & ~CGCG_CGTT_LOCAL1_MASK));
 380	}
 381}
 382
 383static void trinity_mg_clockgating_initialize(struct radeon_device *rdev)
 384{
 385	u32 count;
 386	const u32 *seq = NULL;
 387
 388	seq = &trinity_mgcg_shls_default[0];
 389	count = sizeof(trinity_mgcg_shls_default) / (3 * sizeof(u32));
 390
 391	trinity_program_clk_gating_hw_sequence(rdev, seq, count);
 392}
 393
 394static void trinity_gfx_clockgating_enable(struct radeon_device *rdev,
 395					   bool enable)
 396{
 397	if (enable) {
 398		WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
 399	} else {
 400		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
 401		WREG32_P(SCLK_PWRMGT_CNTL, GFX_CLK_FORCE_ON, ~GFX_CLK_FORCE_ON);
 402		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~GFX_CLK_FORCE_ON);
 403		RREG32(GB_ADDR_CONFIG);
 404	}
 405}
 406
 407static void trinity_program_clk_gating_hw_sequence(struct radeon_device *rdev,
 408						   const u32 *seq, u32 count)
 409{
 410	u32 i, length = count * 3;
 411
 412	for (i = 0; i < length; i += 3)
 413		WREG32_P(seq[i], seq[i+1], ~seq[i+2]);
 414}
 415
 416static void trinity_program_override_mgpg_sequences(struct radeon_device *rdev,
 417						    const u32 *seq, u32 count)
 418{
 419	u32  i, length = count * 2;
 420
 421	for (i = 0; i < length; i += 2)
 422		WREG32(seq[i], seq[i+1]);
 423
 424}
 425
 426static void trinity_override_dynamic_mg_powergating(struct radeon_device *rdev)
 427{
 428	u32 count;
 429	const u32 *seq = NULL;
 430
 431	seq = &trinity_override_mgpg_sequences[0];
 432	count = sizeof(trinity_override_mgpg_sequences) / (2 * sizeof(u32));
 433
 434	trinity_program_override_mgpg_sequences(rdev, seq, count);
 435}
 436
 437static void trinity_ls_clockgating_enable(struct radeon_device *rdev,
 438					  bool enable)
 439{
 440	u32 count;
 441	const u32 *seq = NULL;
 442
 443	if (enable) {
 444		seq = &trinity_sysls_enable[0];
 445		count = sizeof(trinity_sysls_enable) / (3 * sizeof(u32));
 446	} else {
 447		seq = &trinity_sysls_disable[0];
 448		count = sizeof(trinity_sysls_disable) / (3 * sizeof(u32));
 449	}
 450
 451	trinity_program_clk_gating_hw_sequence(rdev, seq, count);
 452}
 453
 454static void trinity_gfx_powergating_enable(struct radeon_device *rdev,
 455					   bool enable)
 456{
 457	if (enable) {
 458		if (RREG32_SMC(CC_SMU_TST_EFUSE1_MISC) & RB_BACKEND_DISABLE_MASK)
 459			WREG32_SMC(SMU_SCRATCH_A, (RREG32_SMC(SMU_SCRATCH_A) | 0x01));
 460
 461		WREG32_P(SCLK_PWRMGT_CNTL, DYN_PWR_DOWN_EN, ~DYN_PWR_DOWN_EN);
 462	} else {
 463		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_PWR_DOWN_EN);
 464		RREG32(GB_ADDR_CONFIG);
 465	}
 466}
 467
 468static void trinity_gfx_dynamic_mgpg_enable(struct radeon_device *rdev,
 469					    bool enable)
 470{
 471	u32 value;
 472
 473	if (enable) {
 474		value = RREG32_SMC(PM_I_CNTL_1);
 475		value &= ~DS_PG_CNTL_MASK;
 476		value |= DS_PG_CNTL(1);
 477		WREG32_SMC(PM_I_CNTL_1, value);
 478
 479		value = RREG32_SMC(SMU_S_PG_CNTL);
 480		value &= ~DS_PG_EN_MASK;
 481		value |= DS_PG_EN(1);
 482		WREG32_SMC(SMU_S_PG_CNTL, value);
 483	} else {
 484		value = RREG32_SMC(SMU_S_PG_CNTL);
 485		value &= ~DS_PG_EN_MASK;
 486		WREG32_SMC(SMU_S_PG_CNTL, value);
 487
 488		value = RREG32_SMC(PM_I_CNTL_1);
 489		value &= ~DS_PG_CNTL_MASK;
 490		WREG32_SMC(PM_I_CNTL_1, value);
 491	}
 492
 493	trinity_gfx_dynamic_mgpg_config(rdev);
 494
 495}
 496
 497static void trinity_enable_clock_power_gating(struct radeon_device *rdev)
 498{
 499	struct trinity_power_info *pi = trinity_get_pi(rdev);
 500
 501	if (pi->enable_gfx_clock_gating)
 502		sumo_gfx_clockgating_initialize(rdev);
 503	if (pi->enable_mg_clock_gating)
 504		trinity_mg_clockgating_initialize(rdev);
 505	if (pi->enable_gfx_power_gating)
 506		trinity_gfx_powergating_initialize(rdev);
 507	if (pi->enable_mg_clock_gating) {
 508		trinity_ls_clockgating_enable(rdev, true);
 509		trinity_mg_clockgating_enable(rdev, true);
 510	}
 511	if (pi->enable_gfx_clock_gating)
 512		trinity_gfx_clockgating_enable(rdev, true);
 513	if (pi->enable_gfx_dynamic_mgpg)
 514		trinity_gfx_dynamic_mgpg_enable(rdev, true);
 515	if (pi->enable_gfx_power_gating)
 516		trinity_gfx_powergating_enable(rdev, true);
 517}
 518
 519static void trinity_disable_clock_power_gating(struct radeon_device *rdev)
 520{
 521	struct trinity_power_info *pi = trinity_get_pi(rdev);
 522
 523	if (pi->enable_gfx_power_gating)
 524		trinity_gfx_powergating_enable(rdev, false);
 525	if (pi->enable_gfx_dynamic_mgpg)
 526		trinity_gfx_dynamic_mgpg_enable(rdev, false);
 527	if (pi->enable_gfx_clock_gating)
 528		trinity_gfx_clockgating_enable(rdev, false);
 529	if (pi->enable_mg_clock_gating) {
 530		trinity_mg_clockgating_enable(rdev, false);
 531		trinity_ls_clockgating_enable(rdev, false);
 532	}
 533}
 534
 535static void trinity_set_divider_value(struct radeon_device *rdev,
 536				      u32 index, u32 sclk)
 537{
 538	struct atom_clock_dividers  dividers;
 539	int ret;
 540	u32 value;
 541	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 542
 543	ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
 544					     sclk, false, &dividers);
 545	if (ret)
 546		return;
 547
 548	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix);
 549	value &= ~CLK_DIVIDER_MASK;
 550	value |= CLK_DIVIDER(dividers.post_div);
 551	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix, value);
 552
 553	ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
 554					     sclk/2, false, &dividers);
 555	if (ret)
 556		return;
 557
 558	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_PG_CNTL + ix);
 559	value &= ~PD_SCLK_DIVIDER_MASK;
 560	value |= PD_SCLK_DIVIDER(dividers.post_div);
 561	WREG32_SMC(SMU_SCLK_DPM_STATE_0_PG_CNTL + ix, value);
 562}
 563
 564static void trinity_set_ds_dividers(struct radeon_device *rdev,
 565				    u32 index, u32 divider)
 566{
 567	u32 value;
 568	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 569
 570	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix);
 571	value &= ~DS_DIV_MASK;
 572	value |= DS_DIV(divider);
 573	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix, value);
 574}
 575
 576static void trinity_set_ss_dividers(struct radeon_device *rdev,
 577				    u32 index, u32 divider)
 578{
 579	u32 value;
 580	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 581
 582	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix);
 583	value &= ~DS_SH_DIV_MASK;
 584	value |= DS_SH_DIV(divider);
 585	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix, value);
 586}
 587
 588static void trinity_set_vid(struct radeon_device *rdev, u32 index, u32 vid)
 589{
 590	struct trinity_power_info *pi = trinity_get_pi(rdev);
 591	u32 vid_7bit = sumo_convert_vid2_to_vid7(rdev, &pi->sys_info.vid_mapping_table, vid);
 592	u32 value;
 593	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 594
 595	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix);
 596	value &= ~VID_MASK;
 597	value |= VID(vid_7bit);
 598	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix, value);
 599
 600	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix);
 601	value &= ~LVRT_MASK;
 602	value |= LVRT(0);
 603	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix, value);
 604}
 605
 606static void trinity_set_allos_gnb_slow(struct radeon_device *rdev,
 607				       u32 index, u32 gnb_slow)
 608{
 609	u32 value;
 610	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 611
 612	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_3 + ix);
 613	value &= ~GNB_SLOW_MASK;
 614	value |= GNB_SLOW(gnb_slow);
 615	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_3 + ix, value);
 616}
 617
 618static void trinity_set_force_nbp_state(struct radeon_device *rdev,
 619					u32 index, u32 force_nbp_state)
 620{
 621	u32 value;
 622	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 623
 624	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_3 + ix);
 625	value &= ~FORCE_NBPS1_MASK;
 626	value |= FORCE_NBPS1(force_nbp_state);
 627	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_3 + ix, value);
 628}
 629
 630static void trinity_set_display_wm(struct radeon_device *rdev,
 631				   u32 index, u32 wm)
 632{
 633	u32 value;
 634	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 635
 636	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix);
 637	value &= ~DISPLAY_WM_MASK;
 638	value |= DISPLAY_WM(wm);
 639	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix, value);
 640}
 641
 642static void trinity_set_vce_wm(struct radeon_device *rdev,
 643			       u32 index, u32 wm)
 644{
 645	u32 value;
 646	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 647
 648	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix);
 649	value &= ~VCE_WM_MASK;
 650	value |= VCE_WM(wm);
 651	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_1 + ix, value);
 652}
 653
 654static void trinity_set_at(struct radeon_device *rdev,
 655			   u32 index, u32 at)
 656{
 657	u32 value;
 658	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 659
 660	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_AT + ix);
 661	value &= ~AT_MASK;
 662	value |= AT(at);
 663	WREG32_SMC(SMU_SCLK_DPM_STATE_0_AT + ix, value);
 664}
 665
 666static void trinity_program_power_level(struct radeon_device *rdev,
 667					struct trinity_pl *pl, u32 index)
 668{
 669	struct trinity_power_info *pi = trinity_get_pi(rdev);
 670
 671	if (index >= SUMO_MAX_HARDWARE_POWERLEVELS)
 672		return;
 673
 674	trinity_set_divider_value(rdev, index, pl->sclk);
 675	trinity_set_vid(rdev, index, pl->vddc_index);
 676	trinity_set_ss_dividers(rdev, index, pl->ss_divider_index);
 677	trinity_set_ds_dividers(rdev, index, pl->ds_divider_index);
 678	trinity_set_allos_gnb_slow(rdev, index, pl->allow_gnb_slow);
 679	trinity_set_force_nbp_state(rdev, index, pl->force_nbp_state);
 680	trinity_set_display_wm(rdev, index, pl->display_wm);
 681	trinity_set_vce_wm(rdev, index, pl->vce_wm);
 682	trinity_set_at(rdev, index, pi->at[index]);
 683}
 684
 685static void trinity_power_level_enable_disable(struct radeon_device *rdev,
 686					       u32 index, bool enable)
 687{
 688	u32 value;
 689	u32 ix = index * TRINITY_SIZEOF_DPM_STATE_TABLE;
 690
 691	value = RREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix);
 692	value &= ~STATE_VALID_MASK;
 693	if (enable)
 694		value |= STATE_VALID(1);
 695	WREG32_SMC(SMU_SCLK_DPM_STATE_0_CNTL_0 + ix, value);
 696}
 697
 698static bool trinity_dpm_enabled(struct radeon_device *rdev)
 699{
 700	if (RREG32_SMC(SMU_SCLK_DPM_CNTL) & SCLK_DPM_EN(1))
 701		return true;
 702	else
 703		return false;
 704}
 705
 706static void trinity_start_dpm(struct radeon_device *rdev)
 707{
 708	u32 value = RREG32_SMC(SMU_SCLK_DPM_CNTL);
 709
 710	value &= ~(SCLK_DPM_EN_MASK | SCLK_DPM_BOOT_STATE_MASK | VOLTAGE_CHG_EN_MASK);
 711	value |= SCLK_DPM_EN(1) | SCLK_DPM_BOOT_STATE(0) | VOLTAGE_CHG_EN(1);
 712	WREG32_SMC(SMU_SCLK_DPM_CNTL, value);
 713
 714	WREG32_P(GENERAL_PWRMGT, GLOBAL_PWRMGT_EN, ~GLOBAL_PWRMGT_EN);
 715	WREG32_P(CG_CG_VOLTAGE_CNTL, 0, ~EN);
 716
 717	trinity_dpm_config(rdev, true);
 718}
 719
 720static void trinity_wait_for_dpm_enabled(struct radeon_device *rdev)
 721{
 722	int i;
 723
 724	for (i = 0; i < rdev->usec_timeout; i++) {
 725		if (RREG32(SCLK_PWRMGT_CNTL) & DYNAMIC_PM_EN)
 726			break;
 727		udelay(1);
 728	}
 729	for (i = 0; i < rdev->usec_timeout; i++) {
 730		if ((RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & TARGET_STATE_MASK) == 0)
 731			break;
 732		udelay(1);
 733	}
 734	for (i = 0; i < rdev->usec_timeout; i++) {
 735		if ((RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_STATE_MASK) == 0)
 736			break;
 737		udelay(1);
 738	}
 739}
 740
 741static void trinity_stop_dpm(struct radeon_device *rdev)
 742{
 743	u32 sclk_dpm_cntl;
 744
 745	WREG32_P(CG_CG_VOLTAGE_CNTL, EN, ~EN);
 746
 747	sclk_dpm_cntl = RREG32_SMC(SMU_SCLK_DPM_CNTL);
 748	sclk_dpm_cntl &= ~(SCLK_DPM_EN_MASK | VOLTAGE_CHG_EN_MASK);
 749	WREG32_SMC(SMU_SCLK_DPM_CNTL, sclk_dpm_cntl);
 750
 751	trinity_dpm_config(rdev, false);
 752}
 753
 754static void trinity_start_am(struct radeon_device *rdev)
 755{
 756	WREG32_P(SCLK_PWRMGT_CNTL, 0, ~(RESET_SCLK_CNT | RESET_BUSY_CNT));
 757}
 758
 759static void trinity_reset_am(struct radeon_device *rdev)
 760{
 761	WREG32_P(SCLK_PWRMGT_CNTL, RESET_SCLK_CNT | RESET_BUSY_CNT,
 762		 ~(RESET_SCLK_CNT | RESET_BUSY_CNT));
 763}
 764
 765static void trinity_wait_for_level_0(struct radeon_device *rdev)
 766{
 767	int i;
 768
 769	for (i = 0; i < rdev->usec_timeout; i++) {
 770		if ((RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_STATE_MASK) == 0)
 771			break;
 772		udelay(1);
 773	}
 774}
 775
 776static void trinity_enable_power_level_0(struct radeon_device *rdev)
 777{
 778	trinity_power_level_enable_disable(rdev, 0, true);
 779}
 780
 781static void trinity_force_level_0(struct radeon_device *rdev)
 782{
 783	trinity_dpm_force_state(rdev, 0);
 784}
 785
 786static void trinity_unforce_levels(struct radeon_device *rdev)
 787{
 788	trinity_dpm_no_forced_level(rdev);
 789}
 790
 791static void trinity_program_power_levels_0_to_n(struct radeon_device *rdev,
 792						struct radeon_ps *new_rps,
 793						struct radeon_ps *old_rps)
 794{
 795	struct trinity_ps *new_ps = trinity_get_ps(new_rps);
 796	struct trinity_ps *old_ps = trinity_get_ps(old_rps);
 797	u32 i;
 798	u32 n_current_state_levels = (old_ps == NULL) ? 1 : old_ps->num_levels;
 799
 800	for (i = 0; i < new_ps->num_levels; i++) {
 801		trinity_program_power_level(rdev, &new_ps->levels[i], i);
 802		trinity_power_level_enable_disable(rdev, i, true);
 803	}
 804
 805	for (i = new_ps->num_levels; i < n_current_state_levels; i++)
 806		trinity_power_level_enable_disable(rdev, i, false);
 807}
 808
 809static void trinity_program_bootup_state(struct radeon_device *rdev)
 810{
 811	struct trinity_power_info *pi = trinity_get_pi(rdev);
 812	u32 i;
 813
 814	trinity_program_power_level(rdev, &pi->boot_pl, 0);
 815	trinity_power_level_enable_disable(rdev, 0, true);
 816
 817	for (i = 1; i < 8; i++)
 818		trinity_power_level_enable_disable(rdev, i, false);
 819}
 820
 821static void trinity_setup_uvd_clock_table(struct radeon_device *rdev,
 822					  struct radeon_ps *rps)
 823{
 824	struct trinity_ps *ps = trinity_get_ps(rps);
 825	u32 uvdstates = (ps->vclk_low_divider |
 826			 ps->vclk_high_divider << 8 |
 827			 ps->dclk_low_divider << 16 |
 828			 ps->dclk_high_divider << 24);
 829
 830	WREG32_SMC(SMU_UVD_DPM_STATES, uvdstates);
 831}
 832
 833static void trinity_setup_uvd_dpm_interval(struct radeon_device *rdev,
 834					   u32 interval)
 835{
 836	u32 p, u;
 837	u32 tp = RREG32_SMC(PM_TP);
 838	u32 val;
 839	u32 xclk = radeon_get_xclk(rdev);
 840
 841	r600_calculate_u_and_p(interval, xclk, 16, &p, &u);
 842
 843	val = (p + tp - 1) / tp;
 844
 845	WREG32_SMC(SMU_UVD_DPM_CNTL, val);
 846}
 847
 848static bool trinity_uvd_clocks_zero(struct radeon_ps *rps)
 849{
 850	if ((rps->vclk == 0) && (rps->dclk == 0))
 851		return true;
 852	else
 853		return false;
 854}
 855
 856static bool trinity_uvd_clocks_equal(struct radeon_ps *rps1,
 857				     struct radeon_ps *rps2)
 858{
 859	struct trinity_ps *ps1 = trinity_get_ps(rps1);
 860	struct trinity_ps *ps2 = trinity_get_ps(rps2);
 861
 862	if ((rps1->vclk == rps2->vclk) &&
 863	    (rps1->dclk == rps2->dclk) &&
 864	    (ps1->vclk_low_divider == ps2->vclk_low_divider) &&
 865	    (ps1->vclk_high_divider == ps2->vclk_high_divider) &&
 866	    (ps1->dclk_low_divider == ps2->dclk_low_divider) &&
 867	    (ps1->dclk_high_divider == ps2->dclk_high_divider))
 868		return true;
 869	else
 870		return false;
 871}
 872
 873static void trinity_setup_uvd_clocks(struct radeon_device *rdev,
 874				     struct radeon_ps *new_rps,
 875				     struct radeon_ps *old_rps)
 876{
 877	struct trinity_power_info *pi = trinity_get_pi(rdev);
 878
 879	if (pi->enable_gfx_power_gating) {
 880		trinity_gfx_powergating_enable(rdev, false);
 881	}
 882
 883	if (pi->uvd_dpm) {
 884		if (trinity_uvd_clocks_zero(new_rps) &&
 885		    !trinity_uvd_clocks_zero(old_rps)) {
 886			trinity_setup_uvd_dpm_interval(rdev, 0);
 887		} else if (!trinity_uvd_clocks_zero(new_rps)) {
 888			trinity_setup_uvd_clock_table(rdev, new_rps);
 889
 890			if (trinity_uvd_clocks_zero(old_rps)) {
 891				u32 tmp = RREG32(CG_MISC_REG);
 892				tmp &= 0xfffffffd;
 893				WREG32(CG_MISC_REG, tmp);
 894
 895				radeon_set_uvd_clocks(rdev, new_rps->vclk, new_rps->dclk);
 896
 897				trinity_setup_uvd_dpm_interval(rdev, 3000);
 898			}
 899		}
 900		trinity_uvd_dpm_config(rdev);
 901	} else {
 902		if (trinity_uvd_clocks_zero(new_rps) ||
 903		    trinity_uvd_clocks_equal(new_rps, old_rps))
 904			return;
 905
 906		radeon_set_uvd_clocks(rdev, new_rps->vclk, new_rps->dclk);
 907	}
 908
 909	if (pi->enable_gfx_power_gating) {
 910		trinity_gfx_powergating_enable(rdev, true);
 911	}
 912}
 913
 914static void trinity_set_uvd_clock_before_set_eng_clock(struct radeon_device *rdev,
 915						       struct radeon_ps *new_rps,
 916						       struct radeon_ps *old_rps)
 917{
 918	struct trinity_ps *new_ps = trinity_get_ps(new_rps);
 919	struct trinity_ps *current_ps = trinity_get_ps(new_rps);
 920
 921	if (new_ps->levels[new_ps->num_levels - 1].sclk >=
 922	    current_ps->levels[current_ps->num_levels - 1].sclk)
 923		return;
 924
 925	trinity_setup_uvd_clocks(rdev, new_rps, old_rps);
 926}
 927
 928static void trinity_set_uvd_clock_after_set_eng_clock(struct radeon_device *rdev,
 929						      struct radeon_ps *new_rps,
 930						      struct radeon_ps *old_rps)
 931{
 932	struct trinity_ps *new_ps = trinity_get_ps(new_rps);
 933	struct trinity_ps *current_ps = trinity_get_ps(old_rps);
 934
 935	if (new_ps->levels[new_ps->num_levels - 1].sclk <
 936	    current_ps->levels[current_ps->num_levels - 1].sclk)
 937		return;
 938
 939	trinity_setup_uvd_clocks(rdev, new_rps, old_rps);
 940}
 941
 942static void trinity_set_vce_clock(struct radeon_device *rdev,
 943				  struct radeon_ps *new_rps,
 944				  struct radeon_ps *old_rps)
 945{
 946	if ((old_rps->evclk != new_rps->evclk) ||
 947	    (old_rps->ecclk != new_rps->ecclk)) {
 948		/* turn the clocks on when encoding, off otherwise */
 949		if (new_rps->evclk || new_rps->ecclk)
 950			vce_v1_0_enable_mgcg(rdev, false);
 951		else
 952			vce_v1_0_enable_mgcg(rdev, true);
 953		radeon_set_vce_clocks(rdev, new_rps->evclk, new_rps->ecclk);
 954	}
 955}
 956
 957static void trinity_program_ttt(struct radeon_device *rdev)
 958{
 959	struct trinity_power_info *pi = trinity_get_pi(rdev);
 960	u32 value = RREG32_SMC(SMU_SCLK_DPM_TTT);
 961
 962	value &= ~(HT_MASK | LT_MASK);
 963	value |= HT((pi->thermal_auto_throttling + 49) * 8);
 964	value |= LT((pi->thermal_auto_throttling + 49 - pi->sys_info.htc_hyst_lmt) * 8);
 965	WREG32_SMC(SMU_SCLK_DPM_TTT, value);
 966}
 967
 968static void trinity_enable_att(struct radeon_device *rdev)
 969{
 970	u32 value = RREG32_SMC(SMU_SCLK_DPM_TT_CNTL);
 971
 972	value &= ~SCLK_TT_EN_MASK;
 973	value |= SCLK_TT_EN(1);
 974	WREG32_SMC(SMU_SCLK_DPM_TT_CNTL, value);
 975}
 976
 977static void trinity_program_sclk_dpm(struct radeon_device *rdev)
 978{
 979	u32 p, u;
 980	u32 tp = RREG32_SMC(PM_TP);
 981	u32 ni;
 982	u32 xclk = radeon_get_xclk(rdev);
 983	u32 value;
 984
 985	r600_calculate_u_and_p(400, xclk, 16, &p, &u);
 986
 987	ni = (p + tp - 1) / tp;
 988
 989	value = RREG32_SMC(PM_I_CNTL_1);
 990	value &= ~SCLK_DPM_MASK;
 991	value |= SCLK_DPM(ni);
 992	WREG32_SMC(PM_I_CNTL_1, value);
 993}
 994
 995static int trinity_set_thermal_temperature_range(struct radeon_device *rdev,
 996						 int min_temp, int max_temp)
 997{
 998	int low_temp = 0 * 1000;
 999	int high_temp = 255 * 1000;
1000
1001	if (low_temp < min_temp)
1002		low_temp = min_temp;
1003	if (high_temp > max_temp)
1004		high_temp = max_temp;
1005	if (high_temp < low_temp) {
1006		DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
1007		return -EINVAL;
1008	}
1009
1010	WREG32_P(CG_THERMAL_INT_CTRL, DIG_THERM_INTH(49 + (high_temp / 1000)), ~DIG_THERM_INTH_MASK);
1011	WREG32_P(CG_THERMAL_INT_CTRL, DIG_THERM_INTL(49 + (low_temp / 1000)), ~DIG_THERM_INTL_MASK);
1012
1013	rdev->pm.dpm.thermal.min_temp = low_temp;
1014	rdev->pm.dpm.thermal.max_temp = high_temp;
1015
1016	return 0;
1017}
1018
1019static void trinity_update_current_ps(struct radeon_device *rdev,
1020				      struct radeon_ps *rps)
1021{
1022	struct trinity_ps *new_ps = trinity_get_ps(rps);
1023	struct trinity_power_info *pi = trinity_get_pi(rdev);
1024
1025	pi->current_rps = *rps;
1026	pi->current_ps = *new_ps;
1027	pi->current_rps.ps_priv = &pi->current_ps;
1028}
1029
1030static void trinity_update_requested_ps(struct radeon_device *rdev,
1031					struct radeon_ps *rps)
1032{
1033	struct trinity_ps *new_ps = trinity_get_ps(rps);
1034	struct trinity_power_info *pi = trinity_get_pi(rdev);
1035
1036	pi->requested_rps = *rps;
1037	pi->requested_ps = *new_ps;
1038	pi->requested_rps.ps_priv = &pi->requested_ps;
1039}
1040
1041void trinity_dpm_enable_bapm(struct radeon_device *rdev, bool enable)
1042{
1043	struct trinity_power_info *pi = trinity_get_pi(rdev);
1044
1045	if (pi->enable_bapm) {
1046		trinity_acquire_mutex(rdev);
1047		trinity_dpm_bapm_enable(rdev, enable);
1048		trinity_release_mutex(rdev);
1049	}
1050}
1051
1052int trinity_dpm_enable(struct radeon_device *rdev)
1053{
1054	struct trinity_power_info *pi = trinity_get_pi(rdev);
1055
1056	trinity_acquire_mutex(rdev);
1057
1058	if (trinity_dpm_enabled(rdev)) {
1059		trinity_release_mutex(rdev);
1060		return -EINVAL;
1061	}
1062
1063	trinity_program_bootup_state(rdev);
1064	sumo_program_vc(rdev, 0x00C00033);
1065	trinity_start_am(rdev);
1066	if (pi->enable_auto_thermal_throttling) {
1067		trinity_program_ttt(rdev);
1068		trinity_enable_att(rdev);
1069	}
1070	trinity_program_sclk_dpm(rdev);
1071	trinity_start_dpm(rdev);
1072	trinity_wait_for_dpm_enabled(rdev);
1073	trinity_dpm_bapm_enable(rdev, false);
1074	trinity_release_mutex(rdev);
1075
1076	trinity_update_current_ps(rdev, rdev->pm.dpm.boot_ps);
1077
1078	return 0;
1079}
1080
1081int trinity_dpm_late_enable(struct radeon_device *rdev)
1082{
1083	int ret;
1084
1085	trinity_acquire_mutex(rdev);
1086	trinity_enable_clock_power_gating(rdev);
1087
1088	if (rdev->irq.installed &&
1089	    r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
1090		ret = trinity_set_thermal_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
1091		if (ret) {
1092			trinity_release_mutex(rdev);
1093			return ret;
1094		}
1095		rdev->irq.dpm_thermal = true;
1096		radeon_irq_set(rdev);
1097	}
1098	trinity_release_mutex(rdev);
1099
1100	return 0;
1101}
1102
1103void trinity_dpm_disable(struct radeon_device *rdev)
1104{
1105	trinity_acquire_mutex(rdev);
1106	if (!trinity_dpm_enabled(rdev)) {
1107		trinity_release_mutex(rdev);
1108		return;
1109	}
1110	trinity_dpm_bapm_enable(rdev, false);
1111	trinity_disable_clock_power_gating(rdev);
1112	sumo_clear_vc(rdev);
1113	trinity_wait_for_level_0(rdev);
1114	trinity_stop_dpm(rdev);
1115	trinity_reset_am(rdev);
1116	trinity_release_mutex(rdev);
1117
1118	if (rdev->irq.installed &&
1119	    r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
1120		rdev->irq.dpm_thermal = false;
1121		radeon_irq_set(rdev);
1122	}
1123
1124	trinity_update_current_ps(rdev, rdev->pm.dpm.boot_ps);
1125}
1126
1127static void trinity_get_min_sclk_divider(struct radeon_device *rdev)
1128{
1129	struct trinity_power_info *pi = trinity_get_pi(rdev);
1130
1131	pi->min_sclk_did =
1132		(RREG32_SMC(CC_SMU_MISC_FUSES) & MinSClkDid_MASK) >> MinSClkDid_SHIFT;
1133}
1134
1135static void trinity_setup_nbp_sim(struct radeon_device *rdev,
1136				  struct radeon_ps *rps)
1137{
1138	struct trinity_power_info *pi = trinity_get_pi(rdev);
1139	struct trinity_ps *new_ps = trinity_get_ps(rps);
1140	u32 nbpsconfig;
1141
1142	if (pi->sys_info.nb_dpm_enable) {
1143		nbpsconfig = RREG32_SMC(NB_PSTATE_CONFIG);
1144		nbpsconfig &= ~(Dpm0PgNbPsLo_MASK | Dpm0PgNbPsHi_MASK | DpmXNbPsLo_MASK | DpmXNbPsHi_MASK);
1145		nbpsconfig |= (Dpm0PgNbPsLo(new_ps->Dpm0PgNbPsLo) |
1146			       Dpm0PgNbPsHi(new_ps->Dpm0PgNbPsHi) |
1147			       DpmXNbPsLo(new_ps->DpmXNbPsLo) |
1148			       DpmXNbPsHi(new_ps->DpmXNbPsHi));
1149		WREG32_SMC(NB_PSTATE_CONFIG, nbpsconfig);
1150	}
1151}
1152
1153int trinity_dpm_force_performance_level(struct radeon_device *rdev,
1154					enum radeon_dpm_forced_level level)
1155{
1156	struct trinity_power_info *pi = trinity_get_pi(rdev);
1157	struct radeon_ps *rps = &pi->current_rps;
1158	struct trinity_ps *ps = trinity_get_ps(rps);
1159	int i, ret;
1160
1161	if (ps->num_levels <= 1)
1162		return 0;
1163
1164	if (level == RADEON_DPM_FORCED_LEVEL_HIGH) {
1165		/* not supported by the hw */
1166		return -EINVAL;
1167	} else if (level == RADEON_DPM_FORCED_LEVEL_LOW) {
1168		ret = trinity_dpm_n_levels_disabled(rdev, ps->num_levels - 1);
1169		if (ret)
1170			return ret;
1171	} else {
1172		for (i = 0; i < ps->num_levels; i++) {
1173			ret = trinity_dpm_n_levels_disabled(rdev, 0);
1174			if (ret)
1175				return ret;
1176		}
1177	}
1178
1179	rdev->pm.dpm.forced_level = level;
1180
1181	return 0;
1182}
1183
1184int trinity_dpm_pre_set_power_state(struct radeon_device *rdev)
1185{
1186	struct trinity_power_info *pi = trinity_get_pi(rdev);
1187	struct radeon_ps requested_ps = *rdev->pm.dpm.requested_ps;
1188	struct radeon_ps *new_ps = &requested_ps;
1189
1190	trinity_update_requested_ps(rdev, new_ps);
1191
1192	trinity_apply_state_adjust_rules(rdev,
1193					 &pi->requested_rps,
1194					 &pi->current_rps);
1195
1196	return 0;
1197}
1198
1199int trinity_dpm_set_power_state(struct radeon_device *rdev)
1200{
1201	struct trinity_power_info *pi = trinity_get_pi(rdev);
1202	struct radeon_ps *new_ps = &pi->requested_rps;
1203	struct radeon_ps *old_ps = &pi->current_rps;
1204
1205	trinity_acquire_mutex(rdev);
1206	if (pi->enable_dpm) {
1207		if (pi->enable_bapm)
1208			trinity_dpm_bapm_enable(rdev, rdev->pm.dpm.ac_power);
1209		trinity_set_uvd_clock_before_set_eng_clock(rdev, new_ps, old_ps);
1210		trinity_enable_power_level_0(rdev);
1211		trinity_force_level_0(rdev);
1212		trinity_wait_for_level_0(rdev);
1213		trinity_setup_nbp_sim(rdev, new_ps);
1214		trinity_program_power_levels_0_to_n(rdev, new_ps, old_ps);
1215		trinity_force_level_0(rdev);
1216		trinity_unforce_levels(rdev);
1217		trinity_set_uvd_clock_after_set_eng_clock(rdev, new_ps, old_ps);
1218		trinity_set_vce_clock(rdev, new_ps, old_ps);
1219	}
1220	trinity_release_mutex(rdev);
1221
1222	return 0;
1223}
1224
1225void trinity_dpm_post_set_power_state(struct radeon_device *rdev)
1226{
1227	struct trinity_power_info *pi = trinity_get_pi(rdev);
1228	struct radeon_ps *new_ps = &pi->requested_rps;
1229
1230	trinity_update_current_ps(rdev, new_ps);
1231}
1232
1233void trinity_dpm_setup_asic(struct radeon_device *rdev)
1234{
1235	trinity_acquire_mutex(rdev);
1236	sumo_program_sstp(rdev);
1237	sumo_take_smu_control(rdev, true);
1238	trinity_get_min_sclk_divider(rdev);
1239	trinity_release_mutex(rdev);
1240}
1241
1242#if 0
1243void trinity_dpm_reset_asic(struct radeon_device *rdev)
1244{
1245	struct trinity_power_info *pi = trinity_get_pi(rdev);
1246
1247	trinity_acquire_mutex(rdev);
1248	if (pi->enable_dpm) {
1249		trinity_enable_power_level_0(rdev);
1250		trinity_force_level_0(rdev);
1251		trinity_wait_for_level_0(rdev);
1252		trinity_program_bootup_state(rdev);
1253		trinity_force_level_0(rdev);
1254		trinity_unforce_levels(rdev);
1255	}
1256	trinity_release_mutex(rdev);
1257}
1258#endif
1259
1260static u16 trinity_convert_voltage_index_to_value(struct radeon_device *rdev,
1261						  u32 vid_2bit)
1262{
1263	struct trinity_power_info *pi = trinity_get_pi(rdev);
1264	u32 vid_7bit = sumo_convert_vid2_to_vid7(rdev, &pi->sys_info.vid_mapping_table, vid_2bit);
1265	u32 svi_mode = (RREG32_SMC(PM_CONFIG) & SVI_Mode) ? 1 : 0;
1266	u32 step = (svi_mode == 0) ? 1250 : 625;
1267	u32 delta = vid_7bit * step + 50;
1268
1269	if (delta > 155000)
1270		return 0;
1271
1272	return (155000 - delta) / 100;
1273}
1274
1275static void trinity_patch_boot_state(struct radeon_device *rdev,
1276				     struct trinity_ps *ps)
1277{
1278	struct trinity_power_info *pi = trinity_get_pi(rdev);
1279
1280	ps->num_levels = 1;
1281	ps->nbps_flags = 0;
1282	ps->bapm_flags = 0;
1283	ps->levels[0] = pi->boot_pl;
1284}
1285
1286static u8 trinity_calculate_vce_wm(struct radeon_device *rdev, u32 sclk)
1287{
1288	if (sclk < 20000)
1289		return 1;
1290	return 0;
1291}
1292
1293static void trinity_construct_boot_state(struct radeon_device *rdev)
1294{
1295	struct trinity_power_info *pi = trinity_get_pi(rdev);
1296
1297	pi->boot_pl.sclk = pi->sys_info.bootup_sclk;
1298	pi->boot_pl.vddc_index = pi->sys_info.bootup_nb_voltage_index;
1299	pi->boot_pl.ds_divider_index = 0;
1300	pi->boot_pl.ss_divider_index = 0;
1301	pi->boot_pl.allow_gnb_slow = 1;
1302	pi->boot_pl.force_nbp_state = 0;
1303	pi->boot_pl.display_wm = 0;
1304	pi->boot_pl.vce_wm = 0;
1305	pi->current_ps.num_levels = 1;
1306	pi->current_ps.levels[0] = pi->boot_pl;
1307}
1308
1309static u8 trinity_get_sleep_divider_id_from_clock(struct radeon_device *rdev,
1310						  u32 sclk, u32 min_sclk_in_sr)
1311{
1312	struct trinity_power_info *pi = trinity_get_pi(rdev);
1313	u32 i;
1314	u32 temp;
1315	u32 min = (min_sclk_in_sr > TRINITY_MINIMUM_ENGINE_CLOCK) ?
1316		min_sclk_in_sr : TRINITY_MINIMUM_ENGINE_CLOCK;
1317
1318	if (sclk < min)
1319		return 0;
1320
1321	if (!pi->enable_sclk_ds)
1322		return 0;
1323
1324	for (i = TRINITY_MAX_DEEPSLEEP_DIVIDER_ID;  ; i--) {
1325		temp = sclk / sumo_get_sleep_divider_from_id(i);
1326		if (temp >= min || i == 0)
1327			break;
1328	}
1329
1330	return (u8)i;
1331}
1332
1333static u32 trinity_get_valid_engine_clock(struct radeon_device *rdev,
1334					  u32 lower_limit)
1335{
1336	struct trinity_power_info *pi = trinity_get_pi(rdev);
1337	u32 i;
1338
1339	for (i = 0; i < pi->sys_info.sclk_voltage_mapping_table.num_max_dpm_entries; i++) {
1340		if (pi->sys_info.sclk_voltage_mapping_table.entries[i].sclk_frequency >= lower_limit)
1341			return pi->sys_info.sclk_voltage_mapping_table.entries[i].sclk_frequency;
1342	}
1343
1344	if (i == pi->sys_info.sclk_voltage_mapping_table.num_max_dpm_entries)
1345		DRM_ERROR("engine clock out of range!");
1346
1347	return 0;
1348}
1349
1350static void trinity_patch_thermal_state(struct radeon_device *rdev,
1351					struct trinity_ps *ps,
1352					struct trinity_ps *current_ps)
1353{
1354	struct trinity_power_info *pi = trinity_get_pi(rdev);
1355	u32 sclk_in_sr = pi->sys_info.min_sclk; /* ??? */
1356	u32 current_vddc;
1357	u32 current_sclk;
1358	u32 current_index = 0;
1359
1360	if (current_ps) {
1361		current_vddc = current_ps->levels[current_index].vddc_index;
1362		current_sclk = current_ps->levels[current_index].sclk;
1363	} else {
1364		current_vddc = pi->boot_pl.vddc_index;
1365		current_sclk = pi->boot_pl.sclk;
1366	}
1367
1368	ps->levels[0].vddc_index = current_vddc;
1369
1370	if (ps->levels[0].sclk > current_sclk)
1371		ps->levels[0].sclk = current_sclk;
1372
1373	ps->levels[0].ds_divider_index =
1374		trinity_get_sleep_divider_id_from_clock(rdev, ps->levels[0].sclk, sclk_in_sr);
1375	ps->levels[0].ss_divider_index = ps->levels[0].ds_divider_index;
1376	ps->levels[0].allow_gnb_slow = 1;
1377	ps->levels[0].force_nbp_state = 0;
1378	ps->levels[0].display_wm = 0;
1379	ps->levels[0].vce_wm =
1380		trinity_calculate_vce_wm(rdev, ps->levels[0].sclk);
1381}
1382
1383static u8 trinity_calculate_display_wm(struct radeon_device *rdev,
1384				       struct trinity_ps *ps, u32 index)
1385{
1386	if (ps == NULL || ps->num_levels <= 1)
1387		return 0;
1388	else if (ps->num_levels == 2) {
1389		if (index == 0)
1390			return 0;
1391		else
1392			return 1;
1393	} else {
1394		if (index == 0)
1395			return 0;
1396		else if (ps->levels[index].sclk < 30000)
1397			return 0;
1398		else
1399			return 1;
1400	}
1401}
1402
1403static u32 trinity_get_uvd_clock_index(struct radeon_device *rdev,
1404				       struct radeon_ps *rps)
1405{
1406	struct trinity_power_info *pi = trinity_get_pi(rdev);
1407	u32 i = 0;
1408
1409	for (i = 0; i < 4; i++) {
1410		if ((rps->vclk == pi->sys_info.uvd_clock_table_entries[i].vclk) &&
1411		    (rps->dclk == pi->sys_info.uvd_clock_table_entries[i].dclk))
1412		    break;
1413	}
1414
1415	if (i >= 4) {
1416		DRM_ERROR("UVD clock index not found!\n");
1417		i = 3;
1418	}
1419	return i;
1420}
1421
1422static void trinity_adjust_uvd_state(struct radeon_device *rdev,
1423				     struct radeon_ps *rps)
1424{
1425	struct trinity_ps *ps = trinity_get_ps(rps);
1426	struct trinity_power_info *pi = trinity_get_pi(rdev);
1427	u32 high_index = 0;
1428	u32 low_index = 0;
1429
1430	if (pi->uvd_dpm && r600_is_uvd_state(rps->class, rps->class2)) {
1431		high_index = trinity_get_uvd_clock_index(rdev, rps);
1432
1433		switch (high_index) {
1434		case 3:
1435		case 2:
1436			low_index = 1;
1437			break;
1438		case 1:
1439		case 0:
1440		default:
1441			low_index = 0;
1442			break;
1443		}
1444
1445		ps->vclk_low_divider =
1446			pi->sys_info.uvd_clock_table_entries[high_index].vclk_did;
1447		ps->dclk_low_divider =
1448			pi->sys_info.uvd_clock_table_entries[high_index].dclk_did;
1449		ps->vclk_high_divider =
1450			pi->sys_info.uvd_clock_table_entries[low_index].vclk_did;
1451		ps->dclk_high_divider =
1452			pi->sys_info.uvd_clock_table_entries[low_index].dclk_did;
1453	}
1454}
1455
1456static int trinity_get_vce_clock_voltage(struct radeon_device *rdev,
1457					 u32 evclk, u32 ecclk, u16 *voltage)
1458{
1459	u32 i;
1460	int ret = -EINVAL;
1461	struct radeon_vce_clock_voltage_dependency_table *table =
1462		&rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table;
1463
1464	if (((evclk == 0) && (ecclk == 0)) ||
1465	    (table && (table->count == 0))) {
1466		*voltage = 0;
1467		return 0;
1468	}
1469
1470	for (i = 0; i < table->count; i++) {
1471		if ((evclk <= table->entries[i].evclk) &&
1472		    (ecclk <= table->entries[i].ecclk)) {
1473			*voltage = table->entries[i].v;
1474			ret = 0;
1475			break;
1476		}
1477	}
1478
1479	/* if no match return the highest voltage */
1480	if (ret)
1481		*voltage = table->entries[table->count - 1].v;
1482
1483	return ret;
1484}
1485
1486static void trinity_apply_state_adjust_rules(struct radeon_device *rdev,
1487					     struct radeon_ps *new_rps,
1488					     struct radeon_ps *old_rps)
1489{
1490	struct trinity_ps *ps = trinity_get_ps(new_rps);
1491	struct trinity_ps *current_ps = trinity_get_ps(old_rps);
1492	struct trinity_power_info *pi = trinity_get_pi(rdev);
1493	u32 min_voltage = 0; /* ??? */
1494	u32 min_sclk = pi->sys_info.min_sclk; /* XXX check against disp reqs */
1495	u32 sclk_in_sr = pi->sys_info.min_sclk; /* ??? */
1496	u32 i;
1497	u16 min_vce_voltage;
1498	bool force_high;
1499	u32 num_active_displays = rdev->pm.dpm.new_active_crtc_count;
1500
1501	if (new_rps->class & ATOM_PPLIB_CLASSIFICATION_THERMAL)
1502		return trinity_patch_thermal_state(rdev, ps, current_ps);
1503
1504	trinity_adjust_uvd_state(rdev, new_rps);
1505
1506	if (new_rps->vce_active) {
1507		new_rps->evclk = rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].evclk;
1508		new_rps->ecclk = rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].ecclk;
1509	} else {
1510		new_rps->evclk = 0;
1511		new_rps->ecclk = 0;
1512	}
1513
1514	for (i = 0; i < ps->num_levels; i++) {
1515		if (ps->levels[i].vddc_index < min_voltage)
1516			ps->levels[i].vddc_index = min_voltage;
1517
1518		if (ps->levels[i].sclk < min_sclk)
1519			ps->levels[i].sclk =
1520				trinity_get_valid_engine_clock(rdev, min_sclk);
1521
1522		/* patch in vce limits */
1523		if (new_rps->vce_active) {
1524			/* sclk */
1525			if (ps->levels[i].sclk < rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].sclk)
1526				ps->levels[i].sclk = rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].sclk;
1527			/* vddc */
1528			trinity_get_vce_clock_voltage(rdev, new_rps->evclk, new_rps->ecclk, &min_vce_voltage);
1529			if (ps->levels[i].vddc_index < min_vce_voltage)
1530				ps->levels[i].vddc_index = min_vce_voltage;
1531		}
1532
1533		ps->levels[i].ds_divider_index =
1534			sumo_get_sleep_divider_id_from_clock(rdev, ps->levels[i].sclk, sclk_in_sr);
1535
1536		ps->levels[i].ss_divider_index = ps->levels[i].ds_divider_index;
1537
1538		ps->levels[i].allow_gnb_slow = 1;
1539		ps->levels[i].force_nbp_state = 0;
1540		ps->levels[i].display_wm =
1541			trinity_calculate_display_wm(rdev, ps, i);
1542		ps->levels[i].vce_wm =
1543			trinity_calculate_vce_wm(rdev, ps->levels[0].sclk);
1544	}
1545
1546	if ((new_rps->class & (ATOM_PPLIB_CLASSIFICATION_HDSTATE | ATOM_PPLIB_CLASSIFICATION_SDSTATE)) ||
1547	    ((new_rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) == ATOM_PPLIB_CLASSIFICATION_UI_BATTERY))
1548		ps->bapm_flags |= TRINITY_POWERSTATE_FLAGS_BAPM_DISABLE;
1549
1550	if (pi->sys_info.nb_dpm_enable) {
1551		ps->Dpm0PgNbPsLo = 0x1;
1552		ps->Dpm0PgNbPsHi = 0x0;
1553		ps->DpmXNbPsLo = 0x2;
1554		ps->DpmXNbPsHi = 0x1;
1555
1556		if ((new_rps->class & (ATOM_PPLIB_CLASSIFICATION_HDSTATE | ATOM_PPLIB_CLASSIFICATION_SDSTATE)) ||
1557		    ((new_rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) == ATOM_PPLIB_CLASSIFICATION_UI_BATTERY)) {
1558			force_high = ((new_rps->class & ATOM_PPLIB_CLASSIFICATION_HDSTATE) ||
1559				      ((new_rps->class & ATOM_PPLIB_CLASSIFICATION_SDSTATE) &&
1560				       (pi->sys_info.uma_channel_number == 1)));
1561			force_high = (num_active_displays >= 3) || force_high;
1562			ps->Dpm0PgNbPsLo = force_high ? 0x2 : 0x3;
1563			ps->Dpm0PgNbPsHi = 0x1;
1564			ps->DpmXNbPsLo = force_high ? 0x2 : 0x3;
1565			ps->DpmXNbPsHi = 0x2;
1566			ps->levels[ps->num_levels - 1].allow_gnb_slow = 0;
1567		}
1568	}
1569}
1570
1571static void trinity_cleanup_asic(struct radeon_device *rdev)
1572{
1573	sumo_take_smu_control(rdev, false);
1574}
1575
1576#if 0
1577static void trinity_pre_display_configuration_change(struct radeon_device *rdev)
1578{
1579	struct trinity_power_info *pi = trinity_get_pi(rdev);
1580
1581	if (pi->voltage_drop_in_dce)
1582		trinity_dce_enable_voltage_adjustment(rdev, false);
1583}
1584#endif
1585
1586static void trinity_add_dccac_value(struct radeon_device *rdev)
1587{
1588	u32 gpu_cac_avrg_cntl_window_size;
1589	u32 num_active_displays = rdev->pm.dpm.new_active_crtc_count;
1590	u64 disp_clk = rdev->clock.default_dispclk / 100;
1591	u32 dc_cac_value;
1592
1593	gpu_cac_avrg_cntl_window_size =
1594		(RREG32_SMC(GPU_CAC_AVRG_CNTL) & WINDOW_SIZE_MASK) >> WINDOW_SIZE_SHIFT;
1595
1596	dc_cac_value = (u32)((14213 * disp_clk * disp_clk * (u64)num_active_displays) >>
1597			     (32 - gpu_cac_avrg_cntl_window_size));
1598
1599	WREG32_SMC(DC_CAC_VALUE, dc_cac_value);
1600}
1601
1602void trinity_dpm_display_configuration_changed(struct radeon_device *rdev)
1603{
1604	struct trinity_power_info *pi = trinity_get_pi(rdev);
1605
1606	if (pi->voltage_drop_in_dce)
1607		trinity_dce_enable_voltage_adjustment(rdev, true);
1608	trinity_add_dccac_value(rdev);
1609}
1610
1611union power_info {
1612	struct _ATOM_POWERPLAY_INFO info;
1613	struct _ATOM_POWERPLAY_INFO_V2 info_2;
1614	struct _ATOM_POWERPLAY_INFO_V3 info_3;
1615	struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
1616	struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
1617	struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
1618};
1619
1620union pplib_clock_info {
1621	struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
1622	struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
1623	struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
1624	struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
1625};
1626
1627union pplib_power_state {
1628	struct _ATOM_PPLIB_STATE v1;
1629	struct _ATOM_PPLIB_STATE_V2 v2;
1630};
1631
1632static void trinity_parse_pplib_non_clock_info(struct radeon_device *rdev,
1633					       struct radeon_ps *rps,
1634					       struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
1635					       u8 table_rev)
1636{
1637	struct trinity_ps *ps = trinity_get_ps(rps);
1638
1639	rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
1640	rps->class = le16_to_cpu(non_clock_info->usClassification);
1641	rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
1642
1643	if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
1644		rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
1645		rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
1646	} else {
1647		rps->vclk = 0;
1648		rps->dclk = 0;
1649	}
1650
1651	if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
1652		rdev->pm.dpm.boot_ps = rps;
1653		trinity_patch_boot_state(rdev, ps);
1654	}
1655	if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
1656		rdev->pm.dpm.uvd_ps = rps;
1657}
1658
1659static void trinity_parse_pplib_clock_info(struct radeon_device *rdev,
1660					   struct radeon_ps *rps, int index,
1661					   union pplib_clock_info *clock_info)
1662{
1663	struct trinity_power_info *pi = trinity_get_pi(rdev);
1664	struct trinity_ps *ps = trinity_get_ps(rps);
1665	struct trinity_pl *pl = &ps->levels[index];
1666	u32 sclk;
1667
1668	sclk = le16_to_cpu(clock_info->sumo.usEngineClockLow);
1669	sclk |= clock_info->sumo.ucEngineClockHigh << 16;
1670	pl->sclk = sclk;
1671	pl->vddc_index = clock_info->sumo.vddcIndex;
1672
1673	ps->num_levels = index + 1;
1674
1675	if (pi->enable_sclk_ds) {
1676		pl->ds_divider_index = 5;
1677		pl->ss_divider_index = 5;
1678	}
1679}
1680
1681static int trinity_parse_power_table(struct radeon_device *rdev)
1682{
1683	struct radeon_mode_info *mode_info = &rdev->mode_info;
1684	struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
1685	union pplib_power_state *power_state;
1686	int i, j, k, non_clock_array_index, clock_array_index;
1687	union pplib_clock_info *clock_info;
1688	struct _StateArray *state_array;
1689	struct _ClockInfoArray *clock_info_array;
1690	struct _NonClockInfoArray *non_clock_info_array;
1691	union power_info *power_info;
1692	int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
1693	u16 data_offset;
1694	u8 frev, crev;
1695	u8 *power_state_offset;
1696	struct sumo_ps *ps;
1697
1698	if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
1699				   &frev, &crev, &data_offset))
1700		return -EINVAL;
1701	power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
1702
1703	state_array = (struct _StateArray *)
1704		(mode_info->atom_context->bios + data_offset +
1705		 le16_to_cpu(power_info->pplib.usStateArrayOffset));
1706	clock_info_array = (struct _ClockInfoArray *)
1707		(mode_info->atom_context->bios + data_offset +
1708		 le16_to_cpu(power_info->pplib.usClockInfoArrayOffset));
1709	non_clock_info_array = (struct _NonClockInfoArray *)
1710		(mode_info->atom_context->bios + data_offset +
1711		 le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset));
1712
1713	rdev->pm.dpm.ps = kcalloc(state_array->ucNumEntries,
1714				  sizeof(struct radeon_ps),
1715				  GFP_KERNEL);
1716	if (!rdev->pm.dpm.ps)
1717		return -ENOMEM;
1718	power_state_offset = (u8 *)state_array->states;
1719	for (i = 0; i < state_array->ucNumEntries; i++) {
1720		u8 *idx;
1721		power_state = (union pplib_power_state *)power_state_offset;
1722		non_clock_array_index = power_state->v2.nonClockInfoIndex;
1723		non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
1724			&non_clock_info_array->nonClockInfo[non_clock_array_index];
1725		if (!rdev->pm.power_state[i].clock_info) {
1726			kfree(rdev->pm.dpm.ps);
1727			return -EINVAL;
1728		}
1729		ps = kzalloc(sizeof(struct sumo_ps), GFP_KERNEL);
1730		if (ps == NULL) {
1731			kfree(rdev->pm.dpm.ps);
1732			return -ENOMEM;
1733		}
1734		rdev->pm.dpm.ps[i].ps_priv = ps;
1735		k = 0;
1736		idx = (u8 *)&power_state->v2.clockInfoIndex[0];
1737		for (j = 0; j < power_state->v2.ucNumDPMLevels; j++) {
1738			clock_array_index = idx[j];
1739			if (clock_array_index >= clock_info_array->ucNumEntries)
1740				continue;
1741			if (k >= SUMO_MAX_HARDWARE_POWERLEVELS)
1742				break;
1743			clock_info = (union pplib_clock_info *)
1744				((u8 *)&clock_info_array->clockInfo[0] +
1745				 (clock_array_index * clock_info_array->ucEntrySize));
1746			trinity_parse_pplib_clock_info(rdev,
1747						       &rdev->pm.dpm.ps[i], k,
1748						       clock_info);
1749			k++;
1750		}
1751		trinity_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
1752						   non_clock_info,
1753						   non_clock_info_array->ucEntrySize);
1754		power_state_offset += 2 + power_state->v2.ucNumDPMLevels;
1755	}
1756	rdev->pm.dpm.num_ps = state_array->ucNumEntries;
1757
1758	/* fill in the vce power states */
1759	for (i = 0; i < RADEON_MAX_VCE_LEVELS; i++) {
1760		u32 sclk;
1761		clock_array_index = rdev->pm.dpm.vce_states[i].clk_idx;
1762		clock_info = (union pplib_clock_info *)
1763			&clock_info_array->clockInfo[clock_array_index * clock_info_array->ucEntrySize];
1764		sclk = le16_to_cpu(clock_info->sumo.usEngineClockLow);
1765		sclk |= clock_info->sumo.ucEngineClockHigh << 16;
1766		rdev->pm.dpm.vce_states[i].sclk = sclk;
1767		rdev->pm.dpm.vce_states[i].mclk = 0;
1768	}
1769
1770	return 0;
1771}
1772
1773union igp_info {
1774	struct _ATOM_INTEGRATED_SYSTEM_INFO info;
1775	struct _ATOM_INTEGRATED_SYSTEM_INFO_V2 info_2;
1776	struct _ATOM_INTEGRATED_SYSTEM_INFO_V5 info_5;
1777	struct _ATOM_INTEGRATED_SYSTEM_INFO_V6 info_6;
1778	struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_7 info_7;
1779};
1780
1781static u32 trinity_convert_did_to_freq(struct radeon_device *rdev, u8 did)
1782{
1783	struct trinity_power_info *pi = trinity_get_pi(rdev);
1784	u32 divider;
1785
1786	if (did >= 8 && did <= 0x3f)
1787		divider = did * 25;
1788	else if (did > 0x3f && did <= 0x5f)
1789		divider = (did - 64) * 50 + 1600;
1790	else if (did > 0x5f && did <= 0x7e)
1791		divider = (did - 96) * 100 + 3200;
1792	else if (did == 0x7f)
1793		divider = 128 * 100;
1794	else
1795		return 10000;
1796
1797	return ((pi->sys_info.dentist_vco_freq * 100) + (divider - 1)) / divider;
1798}
1799
1800static int trinity_parse_sys_info_table(struct radeon_device *rdev)
1801{
1802	struct trinity_power_info *pi = trinity_get_pi(rdev);
1803	struct radeon_mode_info *mode_info = &rdev->mode_info;
1804	int index = GetIndexIntoMasterTable(DATA, IntegratedSystemInfo);
1805	union igp_info *igp_info;
1806	u8 frev, crev;
1807	u16 data_offset;
1808	int i;
1809
1810	if (atom_parse_data_header(mode_info->atom_context, index, NULL,
1811				   &frev, &crev, &data_offset)) {
1812		igp_info = (union igp_info *)(mode_info->atom_context->bios +
1813					      data_offset);
1814
1815		if (crev != 7) {
1816			DRM_ERROR("Unsupported IGP table: %d %d\n", frev, crev);
1817			return -EINVAL;
1818		}
1819		pi->sys_info.bootup_sclk = le32_to_cpu(igp_info->info_7.ulBootUpEngineClock);
1820		pi->sys_info.min_sclk = le32_to_cpu(igp_info->info_7.ulMinEngineClock);
1821		pi->sys_info.bootup_uma_clk = le32_to_cpu(igp_info->info_7.ulBootUpUMAClock);
1822		pi->sys_info.dentist_vco_freq = le32_to_cpu(igp_info->info_7.ulDentistVCOFreq);
1823		pi->sys_info.bootup_nb_voltage_index =
1824			le16_to_cpu(igp_info->info_7.usBootUpNBVoltage);
1825		if (igp_info->info_7.ucHtcTmpLmt == 0)
1826			pi->sys_info.htc_tmp_lmt = 203;
1827		else
1828			pi->sys_info.htc_tmp_lmt = igp_info->info_7.ucHtcTmpLmt;
1829		if (igp_info->info_7.ucHtcHystLmt == 0)
1830			pi->sys_info.htc_hyst_lmt = 5;
1831		else
1832			pi->sys_info.htc_hyst_lmt = igp_info->info_7.ucHtcHystLmt;
1833		if (pi->sys_info.htc_tmp_lmt <= pi->sys_info.htc_hyst_lmt) {
1834			DRM_ERROR("The htcTmpLmt should be larger than htcHystLmt.\n");
1835		}
1836
1837		if (pi->enable_nbps_policy)
1838			pi->sys_info.nb_dpm_enable = igp_info->info_7.ucNBDPMEnable;
1839		else
1840			pi->sys_info.nb_dpm_enable = 0;
1841
1842		for (i = 0; i < TRINITY_NUM_NBPSTATES; i++) {
1843			pi->sys_info.nbp_mclk[i] = le32_to_cpu(igp_info->info_7.ulNbpStateMemclkFreq[i]);
1844			pi->sys_info.nbp_nclk[i] = le32_to_cpu(igp_info->info_7.ulNbpStateNClkFreq[i]);
1845		}
1846
1847		pi->sys_info.nbp_voltage_index[0] = le16_to_cpu(igp_info->info_7.usNBP0Voltage);
1848		pi->sys_info.nbp_voltage_index[1] = le16_to_cpu(igp_info->info_7.usNBP1Voltage);
1849		pi->sys_info.nbp_voltage_index[2] = le16_to_cpu(igp_info->info_7.usNBP2Voltage);
1850		pi->sys_info.nbp_voltage_index[3] = le16_to_cpu(igp_info->info_7.usNBP3Voltage);
1851
1852		if (!pi->sys_info.nb_dpm_enable) {
1853			for (i = 1; i < TRINITY_NUM_NBPSTATES; i++) {
1854				pi->sys_info.nbp_mclk[i] = pi->sys_info.nbp_mclk[0];
1855				pi->sys_info.nbp_nclk[i] = pi->sys_info.nbp_nclk[0];
1856				pi->sys_info.nbp_voltage_index[i] = pi->sys_info.nbp_voltage_index[0];
1857			}
1858		}
1859
1860		pi->sys_info.uma_channel_number = igp_info->info_7.ucUMAChannelNumber;
1861
1862		sumo_construct_sclk_voltage_mapping_table(rdev,
1863							  &pi->sys_info.sclk_voltage_mapping_table,
1864							  igp_info->info_7.sAvail_SCLK);
1865		sumo_construct_vid_mapping_table(rdev, &pi->sys_info.vid_mapping_table,
1866						 igp_info->info_7.sAvail_SCLK);
1867
1868		pi->sys_info.uvd_clock_table_entries[0].vclk_did =
1869			igp_info->info_7.ucDPMState0VclkFid;
1870		pi->sys_info.uvd_clock_table_entries[1].vclk_did =
1871			igp_info->info_7.ucDPMState1VclkFid;
1872		pi->sys_info.uvd_clock_table_entries[2].vclk_did =
1873			igp_info->info_7.ucDPMState2VclkFid;
1874		pi->sys_info.uvd_clock_table_entries[3].vclk_did =
1875			igp_info->info_7.ucDPMState3VclkFid;
1876
1877		pi->sys_info.uvd_clock_table_entries[0].dclk_did =
1878			igp_info->info_7.ucDPMState0DclkFid;
1879		pi->sys_info.uvd_clock_table_entries[1].dclk_did =
1880			igp_info->info_7.ucDPMState1DclkFid;
1881		pi->sys_info.uvd_clock_table_entries[2].dclk_did =
1882			igp_info->info_7.ucDPMState2DclkFid;
1883		pi->sys_info.uvd_clock_table_entries[3].dclk_did =
1884			igp_info->info_7.ucDPMState3DclkFid;
1885
1886		for (i = 0; i < 4; i++) {
1887			pi->sys_info.uvd_clock_table_entries[i].vclk =
1888				trinity_convert_did_to_freq(rdev,
1889							    pi->sys_info.uvd_clock_table_entries[i].vclk_did);
1890			pi->sys_info.uvd_clock_table_entries[i].dclk =
1891				trinity_convert_did_to_freq(rdev,
1892							    pi->sys_info.uvd_clock_table_entries[i].dclk_did);
1893		}
1894
1895
1896
1897	}
1898	return 0;
1899}
1900
1901int trinity_dpm_init(struct radeon_device *rdev)
1902{
1903	struct trinity_power_info *pi;
1904	int ret, i;
1905
1906	pi = kzalloc(sizeof(struct trinity_power_info), GFP_KERNEL);
1907	if (pi == NULL)
1908		return -ENOMEM;
1909	rdev->pm.dpm.priv = pi;
1910
1911	for (i = 0; i < SUMO_MAX_HARDWARE_POWERLEVELS; i++)
1912		pi->at[i] = TRINITY_AT_DFLT;
1913
1914	if (radeon_bapm == -1) {
1915		/* There are stability issues reported on with
1916		 * bapm enabled when switching between AC and battery
1917		 * power.  At the same time, some MSI boards hang
1918		 * if it's not enabled and dpm is enabled.  Just enable
1919		 * it for MSI boards right now.
1920		 */
1921		if (rdev->pdev->subsystem_vendor == 0x1462)
1922			pi->enable_bapm = true;
1923		else
1924			pi->enable_bapm = false;
1925	} else if (radeon_bapm == 0) {
1926		pi->enable_bapm = false;
1927	} else {
1928		pi->enable_bapm = true;
1929	}
1930	pi->enable_nbps_policy = true;
1931	pi->enable_sclk_ds = true;
1932	pi->enable_gfx_power_gating = true;
1933	pi->enable_gfx_clock_gating = true;
1934	pi->enable_mg_clock_gating = false;
1935	pi->enable_gfx_dynamic_mgpg = false;
1936	pi->override_dynamic_mgpg = false;
1937	pi->enable_auto_thermal_throttling = true;
1938	pi->voltage_drop_in_dce = false; /* need to restructure dpm/modeset interaction */
1939	pi->uvd_dpm = true; /* ??? */
1940
1941	ret = trinity_parse_sys_info_table(rdev);
1942	if (ret)
1943		return ret;
1944
1945	trinity_construct_boot_state(rdev);
1946
1947	ret = r600_get_platform_caps(rdev);
1948	if (ret)
1949		return ret;
1950
1951	ret = r600_parse_extended_power_table(rdev);
1952	if (ret)
1953		return ret;
1954
1955	ret = trinity_parse_power_table(rdev);
1956	if (ret)
1957		return ret;
1958
1959	pi->thermal_auto_throttling = pi->sys_info.htc_tmp_lmt;
1960	pi->enable_dpm = true;
1961
1962	return 0;
1963}
1964
1965void trinity_dpm_print_power_state(struct radeon_device *rdev,
1966				   struct radeon_ps *rps)
1967{
1968	int i;
1969	struct trinity_ps *ps = trinity_get_ps(rps);
1970
1971	r600_dpm_print_class_info(rps->class, rps->class2);
1972	r600_dpm_print_cap_info(rps->caps);
1973	printk("\tuvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
1974	for (i = 0; i < ps->num_levels; i++) {
1975		struct trinity_pl *pl = &ps->levels[i];
1976		printk("\t\tpower level %d    sclk: %u vddc: %u\n",
1977		       i, pl->sclk,
1978		       trinity_convert_voltage_index_to_value(rdev, pl->vddc_index));
1979	}
1980	r600_dpm_print_ps_status(rdev, rps);
1981}
1982
1983void trinity_dpm_debugfs_print_current_performance_level(struct radeon_device *rdev,
1984							 struct seq_file *m)
1985{
1986	struct trinity_power_info *pi = trinity_get_pi(rdev);
1987	struct radeon_ps *rps = &pi->current_rps;
1988	struct trinity_ps *ps = trinity_get_ps(rps);
1989	struct trinity_pl *pl;
1990	u32 current_index =
1991		(RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_STATE_MASK) >>
1992		CURRENT_STATE_SHIFT;
1993
1994	if (current_index >= ps->num_levels) {
1995		seq_printf(m, "invalid dpm profile %d\n", current_index);
1996	} else {
1997		pl = &ps->levels[current_index];
1998		seq_printf(m, "uvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
1999		seq_printf(m, "power level %d    sclk: %u vddc: %u\n",
2000			   current_index, pl->sclk,
2001			   trinity_convert_voltage_index_to_value(rdev, pl->vddc_index));
2002	}
2003}
2004
2005u32 trinity_dpm_get_current_sclk(struct radeon_device *rdev)
2006{
2007	struct trinity_power_info *pi = trinity_get_pi(rdev);
2008	struct radeon_ps *rps = &pi->current_rps;
2009	struct trinity_ps *ps = trinity_get_ps(rps);
2010	struct trinity_pl *pl;
2011	u32 current_index =
2012		(RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_STATE_MASK) >>
2013		CURRENT_STATE_SHIFT;
2014
2015	if (current_index >= ps->num_levels) {
2016		return 0;
2017	} else {
2018		pl = &ps->levels[current_index];
2019		return pl->sclk;
2020	}
2021}
2022
2023u32 trinity_dpm_get_current_mclk(struct radeon_device *rdev)
2024{
2025	struct trinity_power_info *pi = trinity_get_pi(rdev);
2026
2027	return pi->sys_info.bootup_uma_clk;
2028}
2029
2030void trinity_dpm_fini(struct radeon_device *rdev)
2031{
2032	int i;
2033
2034	trinity_cleanup_asic(rdev); /* ??? */
2035
2036	for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
2037		kfree(rdev->pm.dpm.ps[i].ps_priv);
2038	}
2039	kfree(rdev->pm.dpm.ps);
2040	kfree(rdev->pm.dpm.priv);
2041	r600_free_extended_power_table(rdev);
2042}
2043
2044u32 trinity_dpm_get_sclk(struct radeon_device *rdev, bool low)
2045{
2046	struct trinity_power_info *pi = trinity_get_pi(rdev);
2047	struct trinity_ps *requested_state = trinity_get_ps(&pi->requested_rps);
2048
2049	if (low)
2050		return requested_state->levels[0].sclk;
2051	else
2052		return requested_state->levels[requested_state->num_levels - 1].sclk;
2053}
2054
2055u32 trinity_dpm_get_mclk(struct radeon_device *rdev, bool low)
2056{
2057	struct trinity_power_info *pi = trinity_get_pi(rdev);
2058
2059	return pi->sys_info.bootup_uma_clk;
2060}