Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
   1/*
   2 * Copyright 2011 Advanced Micro Devices, Inc.
   3 *
   4 * Permission is hereby granted, free of charge, to any person obtaining a
   5 * copy of this software and associated documentation files (the "Software"),
   6 * to deal in the Software without restriction, including without limitation
   7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8 * and/or sell copies of the Software, and to permit persons to whom the
   9 * Software is furnished to do so, subject to the following conditions:
  10 *
  11 * The above copyright notice and this permission notice shall be included in
  12 * all copies or substantial portions of the Software.
  13 *
  14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20 * OTHER DEALINGS IN THE SOFTWARE.
  21 *
  22 * Authors: Alex Deucher
  23 */
  24
  25#include "radeon.h"
  26#include "radeon_asic.h"
  27#include "rv770.h"
  28#include "rv770d.h"
  29#include "r600_dpm.h"
  30#include "rv770_dpm.h"
  31#include "cypress_dpm.h"
  32#include "atom.h"
  33#include "evergreen.h"
  34#include <linux/seq_file.h>
  35
  36#define MC_CG_ARB_FREQ_F0           0x0a
  37#define MC_CG_ARB_FREQ_F1           0x0b
  38#define MC_CG_ARB_FREQ_F2           0x0c
  39#define MC_CG_ARB_FREQ_F3           0x0d
  40
  41#define MC_CG_SEQ_DRAMCONF_S0       0x05
  42#define MC_CG_SEQ_DRAMCONF_S1       0x06
  43
  44#define PCIE_BUS_CLK                10000
  45#define TCLK                        (PCIE_BUS_CLK / 10)
  46
  47#define SMC_RAM_END 0xC000
  48
  49struct rv7xx_ps *rv770_get_ps(struct radeon_ps *rps)
  50{
  51	struct rv7xx_ps *ps = rps->ps_priv;
  52
  53	return ps;
  54}
  55
  56struct rv7xx_power_info *rv770_get_pi(struct radeon_device *rdev)
  57{
  58	struct rv7xx_power_info *pi = rdev->pm.dpm.priv;
  59
  60	return pi;
  61}
  62
  63struct evergreen_power_info *evergreen_get_pi(struct radeon_device *rdev)
  64{
  65	struct evergreen_power_info *pi = rdev->pm.dpm.priv;
  66
  67	return pi;
  68}
  69
  70static void rv770_enable_bif_dynamic_pcie_gen2(struct radeon_device *rdev,
  71					       bool enable)
  72{
  73	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  74	u32 tmp;
  75
  76	tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL);
  77	if (enable) {
  78		tmp &= ~LC_HW_VOLTAGE_IF_CONTROL_MASK;
  79		tmp |= LC_HW_VOLTAGE_IF_CONTROL(1);
  80		tmp |= LC_GEN2_EN_STRAP;
  81	} else {
  82		if (!pi->boot_in_gen2) {
  83			tmp &= ~LC_HW_VOLTAGE_IF_CONTROL_MASK;
  84			tmp &= ~LC_GEN2_EN_STRAP;
  85		}
  86	}
  87	if ((tmp & LC_OTHER_SIDE_EVER_SENT_GEN2) ||
  88	    (tmp & LC_OTHER_SIDE_SUPPORTS_GEN2))
  89		WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp);
  90
  91}
  92
  93static void rv770_enable_l0s(struct radeon_device *rdev)
  94{
  95	u32 tmp;
  96
  97	tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL) & ~LC_L0S_INACTIVITY_MASK;
  98	tmp |= LC_L0S_INACTIVITY(3);
  99	WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp);
 100}
 101
 102static void rv770_enable_l1(struct radeon_device *rdev)
 103{
 104	u32 tmp;
 105
 106	tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL);
 107	tmp &= ~LC_L1_INACTIVITY_MASK;
 108	tmp |= LC_L1_INACTIVITY(4);
 109	tmp &= ~LC_PMI_TO_L1_DIS;
 110	tmp &= ~LC_ASPM_TO_L1_DIS;
 111	WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp);
 112}
 113
 114static void rv770_enable_pll_sleep_in_l1(struct radeon_device *rdev)
 115{
 116	u32 tmp;
 117
 118	tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL) & ~LC_L1_INACTIVITY_MASK;
 119	tmp |= LC_L1_INACTIVITY(8);
 120	WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp);
 121
 122	/* NOTE, this is a PCIE indirect reg, not PCIE PORT */
 123	tmp = RREG32_PCIE(PCIE_P_CNTL);
 124	tmp |= P_PLL_PWRDN_IN_L1L23;
 125	tmp &= ~P_PLL_BUF_PDNB;
 126	tmp &= ~P_PLL_PDNB;
 127	tmp |= P_ALLOW_PRX_FRONTEND_SHUTOFF;
 128	WREG32_PCIE(PCIE_P_CNTL, tmp);
 129}
 130
 131static void rv770_gfx_clock_gating_enable(struct radeon_device *rdev,
 132					  bool enable)
 133{
 134	if (enable)
 135		WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
 136	else {
 137		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
 138		WREG32_P(SCLK_PWRMGT_CNTL, GFX_CLK_FORCE_ON, ~GFX_CLK_FORCE_ON);
 139		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~GFX_CLK_FORCE_ON);
 140		RREG32(GB_TILING_CONFIG);
 141	}
 142}
 143
 144static void rv770_mg_clock_gating_enable(struct radeon_device *rdev,
 145					 bool enable)
 146{
 147	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 148
 149	if (enable) {
 150		u32 mgcg_cgtt_local0;
 151
 152		if (rdev->family == CHIP_RV770)
 153			mgcg_cgtt_local0 = RV770_MGCGTTLOCAL0_DFLT;
 154		else
 155			mgcg_cgtt_local0 = RV7XX_MGCGTTLOCAL0_DFLT;
 156
 157		WREG32(CG_CGTT_LOCAL_0, mgcg_cgtt_local0);
 158		WREG32(CG_CGTT_LOCAL_1, (RV770_MGCGTTLOCAL1_DFLT & 0xFFFFCFFF));
 159
 160		if (pi->mgcgtssm)
 161			WREG32(CGTS_SM_CTRL_REG, RV770_MGCGCGTSSMCTRL_DFLT);
 162	} else {
 163		WREG32(CG_CGTT_LOCAL_0, 0xFFFFFFFF);
 164		WREG32(CG_CGTT_LOCAL_1, 0xFFFFCFFF);
 165	}
 166}
 167
 168void rv770_restore_cgcg(struct radeon_device *rdev)
 169{
 170	bool dpm_en = false, cg_en = false;
 171
 172	if (RREG32(GENERAL_PWRMGT) & GLOBAL_PWRMGT_EN)
 173		dpm_en = true;
 174	if (RREG32(SCLK_PWRMGT_CNTL) & DYN_GFX_CLK_OFF_EN)
 175		cg_en = true;
 176
 177	if (dpm_en && !cg_en)
 178		WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
 179}
 180
 181static void rv770_start_dpm(struct radeon_device *rdev)
 182{
 183	WREG32_P(SCLK_PWRMGT_CNTL, 0, ~SCLK_PWRMGT_OFF);
 184
 185	WREG32_P(MCLK_PWRMGT_CNTL, 0, ~MPLL_PWRMGT_OFF);
 186
 187	WREG32_P(GENERAL_PWRMGT, GLOBAL_PWRMGT_EN, ~GLOBAL_PWRMGT_EN);
 188}
 189
 190void rv770_stop_dpm(struct radeon_device *rdev)
 191{
 192	PPSMC_Result result;
 193
 194	result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_TwoLevelsDisabled);
 195
 196	if (result != PPSMC_Result_OK)
 197		DRM_DEBUG("Could not force DPM to low.\n");
 198
 199	WREG32_P(GENERAL_PWRMGT, 0, ~GLOBAL_PWRMGT_EN);
 200
 201	WREG32_P(SCLK_PWRMGT_CNTL, SCLK_PWRMGT_OFF, ~SCLK_PWRMGT_OFF);
 202
 203	WREG32_P(MCLK_PWRMGT_CNTL, MPLL_PWRMGT_OFF, ~MPLL_PWRMGT_OFF);
 204}
 205
 206bool rv770_dpm_enabled(struct radeon_device *rdev)
 207{
 208	if (RREG32(GENERAL_PWRMGT) & GLOBAL_PWRMGT_EN)
 209		return true;
 210	else
 211		return false;
 212}
 213
 214void rv770_enable_thermal_protection(struct radeon_device *rdev,
 215				     bool enable)
 216{
 217	if (enable)
 218		WREG32_P(GENERAL_PWRMGT, 0, ~THERMAL_PROTECTION_DIS);
 219	else
 220		WREG32_P(GENERAL_PWRMGT, THERMAL_PROTECTION_DIS, ~THERMAL_PROTECTION_DIS);
 221}
 222
 223void rv770_enable_acpi_pm(struct radeon_device *rdev)
 224{
 225	WREG32_P(GENERAL_PWRMGT, STATIC_PM_EN, ~STATIC_PM_EN);
 226}
 227
 228u8 rv770_get_seq_value(struct radeon_device *rdev,
 229		       struct rv7xx_pl *pl)
 230{
 231	return (pl->flags & ATOM_PPLIB_R600_FLAGS_LOWPOWER) ?
 232		MC_CG_SEQ_DRAMCONF_S0 : MC_CG_SEQ_DRAMCONF_S1;
 233}
 234
 235#if 0
 236int rv770_read_smc_soft_register(struct radeon_device *rdev,
 237				 u16 reg_offset, u32 *value)
 238{
 239	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 240
 241	return rv770_read_smc_sram_dword(rdev,
 242					 pi->soft_regs_start + reg_offset,
 243					 value, pi->sram_end);
 244}
 245#endif
 246
 247int rv770_write_smc_soft_register(struct radeon_device *rdev,
 248				  u16 reg_offset, u32 value)
 249{
 250	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 251
 252	return rv770_write_smc_sram_dword(rdev,
 253					  pi->soft_regs_start + reg_offset,
 254					  value, pi->sram_end);
 255}
 256
 257int rv770_populate_smc_t(struct radeon_device *rdev,
 258			 struct radeon_ps *radeon_state,
 259			 RV770_SMC_SWSTATE *smc_state)
 260{
 261	struct rv7xx_ps *state = rv770_get_ps(radeon_state);
 262	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 263	int i;
 264	int a_n;
 265	int a_d;
 266	u8 l[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE];
 267	u8 r[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE];
 268	u32 a_t;
 269
 270	l[0] = 0;
 271	r[2] = 100;
 272
 273	a_n = (int)state->medium.sclk * pi->lmp +
 274		(int)state->low.sclk * (R600_AH_DFLT - pi->rlp);
 275	a_d = (int)state->low.sclk * (100 - (int)pi->rlp) +
 276		(int)state->medium.sclk * pi->lmp;
 277
 278	l[1] = (u8)(pi->lmp - (int)pi->lmp * a_n / a_d);
 279	r[0] = (u8)(pi->rlp + (100 - (int)pi->rlp) * a_n / a_d);
 280
 281	a_n = (int)state->high.sclk * pi->lhp + (int)state->medium.sclk *
 282		(R600_AH_DFLT - pi->rmp);
 283	a_d = (int)state->medium.sclk * (100 - (int)pi->rmp) +
 284		(int)state->high.sclk * pi->lhp;
 285
 286	l[2] = (u8)(pi->lhp - (int)pi->lhp * a_n / a_d);
 287	r[1] = (u8)(pi->rmp + (100 - (int)pi->rmp) * a_n / a_d);
 288
 289	for (i = 0; i < (RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1); i++) {
 290		a_t = CG_R(r[i] * pi->bsp / 200) | CG_L(l[i] * pi->bsp / 200);
 291		smc_state->levels[i].aT = cpu_to_be32(a_t);
 292	}
 293
 294	a_t = CG_R(r[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1] * pi->pbsp / 200) |
 295		CG_L(l[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1] * pi->pbsp / 200);
 296
 297	smc_state->levels[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1].aT =
 298		cpu_to_be32(a_t);
 299
 300	return 0;
 301}
 302
 303int rv770_populate_smc_sp(struct radeon_device *rdev,
 304			  struct radeon_ps *radeon_state,
 305			  RV770_SMC_SWSTATE *smc_state)
 306{
 307	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 308	int i;
 309
 310	for (i = 0; i < (RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1); i++)
 311		smc_state->levels[i].bSP = cpu_to_be32(pi->dsp);
 312
 313	smc_state->levels[RV770_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1].bSP =
 314		cpu_to_be32(pi->psp);
 315
 316	return 0;
 317}
 318
 319static void rv770_calculate_fractional_mpll_feedback_divider(u32 memory_clock,
 320							     u32 reference_clock,
 321							     bool gddr5,
 322							     struct atom_clock_dividers *dividers,
 323							     u32 *clkf,
 324							     u32 *clkfrac)
 325{
 326	u32 post_divider, reference_divider, feedback_divider8;
 327	u32 fyclk;
 328
 329	if (gddr5)
 330		fyclk = (memory_clock * 8) / 2;
 331	else
 332		fyclk = (memory_clock * 4) / 2;
 333
 334	post_divider = dividers->post_div;
 335	reference_divider = dividers->ref_div;
 336
 337	feedback_divider8 =
 338		(8 * fyclk * reference_divider * post_divider) / reference_clock;
 339
 340	*clkf = feedback_divider8 / 8;
 341	*clkfrac = feedback_divider8 % 8;
 342}
 343
 344static int rv770_encode_yclk_post_div(u32 postdiv, u32 *encoded_postdiv)
 345{
 346	int ret = 0;
 347
 348	switch (postdiv) {
 349	case 1:
 350		*encoded_postdiv = 0;
 351		break;
 352	case 2:
 353		*encoded_postdiv = 1;
 354		break;
 355	case 4:
 356		*encoded_postdiv = 2;
 357		break;
 358	case 8:
 359		*encoded_postdiv = 3;
 360		break;
 361	case 16:
 362		*encoded_postdiv = 4;
 363		break;
 364	default:
 365		ret = -EINVAL;
 366		break;
 367	}
 368
 369	return ret;
 370}
 371
 372u32 rv770_map_clkf_to_ibias(struct radeon_device *rdev, u32 clkf)
 373{
 374	if (clkf <= 0x10)
 375		return 0x4B;
 376	if (clkf <= 0x19)
 377		return 0x5B;
 378	if (clkf <= 0x21)
 379		return 0x2B;
 380	if (clkf <= 0x27)
 381		return 0x6C;
 382	if (clkf <= 0x31)
 383		return 0x9D;
 384	return 0xC6;
 385}
 386
 387static int rv770_populate_mclk_value(struct radeon_device *rdev,
 388				     u32 engine_clock, u32 memory_clock,
 389				     RV7XX_SMC_MCLK_VALUE *mclk)
 390{
 391	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 392	u8 encoded_reference_dividers[] = { 0, 16, 17, 20, 21 };
 393	u32 mpll_ad_func_cntl =
 394		pi->clk_regs.rv770.mpll_ad_func_cntl;
 395	u32 mpll_ad_func_cntl_2 =
 396		pi->clk_regs.rv770.mpll_ad_func_cntl_2;
 397	u32 mpll_dq_func_cntl =
 398		pi->clk_regs.rv770.mpll_dq_func_cntl;
 399	u32 mpll_dq_func_cntl_2 =
 400		pi->clk_regs.rv770.mpll_dq_func_cntl_2;
 401	u32 mclk_pwrmgt_cntl =
 402		pi->clk_regs.rv770.mclk_pwrmgt_cntl;
 403	u32 dll_cntl = pi->clk_regs.rv770.dll_cntl;
 404	struct atom_clock_dividers dividers;
 405	u32 reference_clock = rdev->clock.mpll.reference_freq;
 406	u32 clkf, clkfrac;
 407	u32 postdiv_yclk;
 408	u32 ibias;
 409	int ret;
 410
 411	ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_MEMORY_PLL_PARAM,
 412					     memory_clock, false, &dividers);
 413	if (ret)
 414		return ret;
 415
 416	if ((dividers.ref_div < 1) || (dividers.ref_div > 5))
 417		return -EINVAL;
 418
 419	rv770_calculate_fractional_mpll_feedback_divider(memory_clock, reference_clock,
 420							 pi->mem_gddr5,
 421							 &dividers, &clkf, &clkfrac);
 422
 423	ret = rv770_encode_yclk_post_div(dividers.post_div, &postdiv_yclk);
 424	if (ret)
 425		return ret;
 426
 427	ibias = rv770_map_clkf_to_ibias(rdev, clkf);
 428
 429	mpll_ad_func_cntl &= ~(CLKR_MASK |
 430			       YCLK_POST_DIV_MASK |
 431			       CLKF_MASK |
 432			       CLKFRAC_MASK |
 433			       IBIAS_MASK);
 434	mpll_ad_func_cntl |= CLKR(encoded_reference_dividers[dividers.ref_div - 1]);
 435	mpll_ad_func_cntl |= YCLK_POST_DIV(postdiv_yclk);
 436	mpll_ad_func_cntl |= CLKF(clkf);
 437	mpll_ad_func_cntl |= CLKFRAC(clkfrac);
 438	mpll_ad_func_cntl |= IBIAS(ibias);
 439
 440	if (dividers.vco_mode)
 441		mpll_ad_func_cntl_2 |= VCO_MODE;
 442	else
 443		mpll_ad_func_cntl_2 &= ~VCO_MODE;
 444
 445	if (pi->mem_gddr5) {
 446		rv770_calculate_fractional_mpll_feedback_divider(memory_clock,
 447								 reference_clock,
 448								 pi->mem_gddr5,
 449								 &dividers, &clkf, &clkfrac);
 450
 451		ibias = rv770_map_clkf_to_ibias(rdev, clkf);
 452
 453		ret = rv770_encode_yclk_post_div(dividers.post_div, &postdiv_yclk);
 454		if (ret)
 455			return ret;
 456
 457		mpll_dq_func_cntl &= ~(CLKR_MASK |
 458				       YCLK_POST_DIV_MASK |
 459				       CLKF_MASK |
 460				       CLKFRAC_MASK |
 461				       IBIAS_MASK);
 462		mpll_dq_func_cntl |= CLKR(encoded_reference_dividers[dividers.ref_div - 1]);
 463		mpll_dq_func_cntl |= YCLK_POST_DIV(postdiv_yclk);
 464		mpll_dq_func_cntl |= CLKF(clkf);
 465		mpll_dq_func_cntl |= CLKFRAC(clkfrac);
 466		mpll_dq_func_cntl |= IBIAS(ibias);
 467
 468		if (dividers.vco_mode)
 469			mpll_dq_func_cntl_2 |= VCO_MODE;
 470		else
 471			mpll_dq_func_cntl_2 &= ~VCO_MODE;
 472	}
 473
 474	mclk->mclk770.mclk_value = cpu_to_be32(memory_clock);
 475	mclk->mclk770.vMPLL_AD_FUNC_CNTL = cpu_to_be32(mpll_ad_func_cntl);
 476	mclk->mclk770.vMPLL_AD_FUNC_CNTL_2 = cpu_to_be32(mpll_ad_func_cntl_2);
 477	mclk->mclk770.vMPLL_DQ_FUNC_CNTL = cpu_to_be32(mpll_dq_func_cntl);
 478	mclk->mclk770.vMPLL_DQ_FUNC_CNTL_2 = cpu_to_be32(mpll_dq_func_cntl_2);
 479	mclk->mclk770.vMCLK_PWRMGT_CNTL = cpu_to_be32(mclk_pwrmgt_cntl);
 480	mclk->mclk770.vDLL_CNTL = cpu_to_be32(dll_cntl);
 481
 482	return 0;
 483}
 484
 485static int rv770_populate_sclk_value(struct radeon_device *rdev,
 486				     u32 engine_clock,
 487				     RV770_SMC_SCLK_VALUE *sclk)
 488{
 489	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 490	struct atom_clock_dividers dividers;
 491	u32 spll_func_cntl =
 492		pi->clk_regs.rv770.cg_spll_func_cntl;
 493	u32 spll_func_cntl_2 =
 494		pi->clk_regs.rv770.cg_spll_func_cntl_2;
 495	u32 spll_func_cntl_3 =
 496		pi->clk_regs.rv770.cg_spll_func_cntl_3;
 497	u32 cg_spll_spread_spectrum =
 498		pi->clk_regs.rv770.cg_spll_spread_spectrum;
 499	u32 cg_spll_spread_spectrum_2 =
 500		pi->clk_regs.rv770.cg_spll_spread_spectrum_2;
 501	u64 tmp;
 502	u32 reference_clock = rdev->clock.spll.reference_freq;
 503	u32 reference_divider, post_divider;
 504	u32 fbdiv;
 505	int ret;
 506
 507	ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
 508					     engine_clock, false, &dividers);
 509	if (ret)
 510		return ret;
 511
 512	reference_divider = 1 + dividers.ref_div;
 513
 514	if (dividers.enable_post_div)
 515		post_divider = (0x0f & (dividers.post_div >> 4)) + (0x0f & dividers.post_div) + 2;
 516	else
 517		post_divider = 1;
 518
 519	tmp = (u64) engine_clock * reference_divider * post_divider * 16384;
 520	do_div(tmp, reference_clock);
 521	fbdiv = (u32) tmp;
 522
 523	if (dividers.enable_post_div)
 524		spll_func_cntl |= SPLL_DIVEN;
 525	else
 526		spll_func_cntl &= ~SPLL_DIVEN;
 527	spll_func_cntl &= ~(SPLL_HILEN_MASK | SPLL_LOLEN_MASK | SPLL_REF_DIV_MASK);
 528	spll_func_cntl |= SPLL_REF_DIV(dividers.ref_div);
 529	spll_func_cntl |= SPLL_HILEN((dividers.post_div >> 4) & 0xf);
 530	spll_func_cntl |= SPLL_LOLEN(dividers.post_div & 0xf);
 531
 532	spll_func_cntl_2 &= ~SCLK_MUX_SEL_MASK;
 533	spll_func_cntl_2 |= SCLK_MUX_SEL(2);
 534
 535	spll_func_cntl_3 &= ~SPLL_FB_DIV_MASK;
 536	spll_func_cntl_3 |= SPLL_FB_DIV(fbdiv);
 537	spll_func_cntl_3 |= SPLL_DITHEN;
 538
 539	if (pi->sclk_ss) {
 540		struct radeon_atom_ss ss;
 541		u32 vco_freq = engine_clock * post_divider;
 542
 543		if (radeon_atombios_get_asic_ss_info(rdev, &ss,
 544						     ASIC_INTERNAL_ENGINE_SS, vco_freq)) {
 545			u32 clk_s = reference_clock * 5 / (reference_divider * ss.rate);
 546			u32 clk_v = ss.percentage * fbdiv / (clk_s * 10000);
 547
 548			cg_spll_spread_spectrum &= ~CLKS_MASK;
 549			cg_spll_spread_spectrum |= CLKS(clk_s);
 550			cg_spll_spread_spectrum |= SSEN;
 551
 552			cg_spll_spread_spectrum_2 &= ~CLKV_MASK;
 553			cg_spll_spread_spectrum_2 |= CLKV(clk_v);
 554		}
 555	}
 556
 557	sclk->sclk_value = cpu_to_be32(engine_clock);
 558	sclk->vCG_SPLL_FUNC_CNTL = cpu_to_be32(spll_func_cntl);
 559	sclk->vCG_SPLL_FUNC_CNTL_2 = cpu_to_be32(spll_func_cntl_2);
 560	sclk->vCG_SPLL_FUNC_CNTL_3 = cpu_to_be32(spll_func_cntl_3);
 561	sclk->vCG_SPLL_SPREAD_SPECTRUM = cpu_to_be32(cg_spll_spread_spectrum);
 562	sclk->vCG_SPLL_SPREAD_SPECTRUM_2 = cpu_to_be32(cg_spll_spread_spectrum_2);
 563
 564	return 0;
 565}
 566
 567int rv770_populate_vddc_value(struct radeon_device *rdev, u16 vddc,
 568			      RV770_SMC_VOLTAGE_VALUE *voltage)
 569{
 570	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 571	int i;
 572
 573	if (!pi->voltage_control) {
 574		voltage->index = 0;
 575		voltage->value = 0;
 576		return 0;
 577	}
 578
 579	for (i = 0; i < pi->valid_vddc_entries; i++) {
 580		if (vddc <= pi->vddc_table[i].vddc) {
 581			voltage->index = pi->vddc_table[i].vddc_index;
 582			voltage->value = cpu_to_be16(vddc);
 583			break;
 584		}
 585	}
 586
 587	if (i == pi->valid_vddc_entries)
 588		return -EINVAL;
 589
 590	return 0;
 591}
 592
 593int rv770_populate_mvdd_value(struct radeon_device *rdev, u32 mclk,
 594			      RV770_SMC_VOLTAGE_VALUE *voltage)
 595{
 596	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 597
 598	if (!pi->mvdd_control) {
 599		voltage->index = MVDD_HIGH_INDEX;
 600		voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
 601		return 0;
 602	}
 603
 604	if (mclk <= pi->mvdd_split_frequency) {
 605		voltage->index = MVDD_LOW_INDEX;
 606		voltage->value = cpu_to_be16(MVDD_LOW_VALUE);
 607	} else {
 608		voltage->index = MVDD_HIGH_INDEX;
 609		voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
 610	}
 611
 612	return 0;
 613}
 614
 615static int rv770_convert_power_level_to_smc(struct radeon_device *rdev,
 616					    struct rv7xx_pl *pl,
 617					    RV770_SMC_HW_PERFORMANCE_LEVEL *level,
 618					    u8 watermark_level)
 619{
 620	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 621	int ret;
 622
 623	level->gen2PCIE = pi->pcie_gen2 ?
 624		((pl->flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2) ? 1 : 0) : 0;
 625	level->gen2XSP  = (pl->flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2) ? 1 : 0;
 626	level->backbias = (pl->flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE) ? 1 : 0;
 627	level->displayWatermark = watermark_level;
 628
 629	if (rdev->family == CHIP_RV740)
 630		ret = rv740_populate_sclk_value(rdev, pl->sclk,
 631						&level->sclk);
 632	else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
 633		ret = rv730_populate_sclk_value(rdev, pl->sclk,
 634						&level->sclk);
 635	else
 636		ret = rv770_populate_sclk_value(rdev, pl->sclk,
 637						&level->sclk);
 638	if (ret)
 639		return ret;
 640
 641	if (rdev->family == CHIP_RV740) {
 642		if (pi->mem_gddr5) {
 643			if (pl->mclk <= pi->mclk_strobe_mode_threshold)
 644				level->strobeMode =
 645					rv740_get_mclk_frequency_ratio(pl->mclk) | 0x10;
 646			else
 647				level->strobeMode = 0;
 648
 649			if (pl->mclk > pi->mclk_edc_enable_threshold)
 650				level->mcFlags = SMC_MC_EDC_RD_FLAG | SMC_MC_EDC_WR_FLAG;
 651			else
 652				level->mcFlags =  0;
 653		}
 654		ret = rv740_populate_mclk_value(rdev, pl->sclk,
 655						pl->mclk, &level->mclk);
 656	} else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
 657		ret = rv730_populate_mclk_value(rdev, pl->sclk,
 658						pl->mclk, &level->mclk);
 659	else
 660		ret = rv770_populate_mclk_value(rdev, pl->sclk,
 661						pl->mclk, &level->mclk);
 662	if (ret)
 663		return ret;
 664
 665	ret = rv770_populate_vddc_value(rdev, pl->vddc,
 666					&level->vddc);
 667	if (ret)
 668		return ret;
 669
 670	ret = rv770_populate_mvdd_value(rdev, pl->mclk, &level->mvdd);
 671
 672	return ret;
 673}
 674
 675static int rv770_convert_power_state_to_smc(struct radeon_device *rdev,
 676					    struct radeon_ps *radeon_state,
 677					    RV770_SMC_SWSTATE *smc_state)
 678{
 679	struct rv7xx_ps *state = rv770_get_ps(radeon_state);
 680	int ret;
 681
 682	if (!(radeon_state->caps & ATOM_PPLIB_DISALLOW_ON_DC))
 683		smc_state->flags |= PPSMC_SWSTATE_FLAG_DC;
 684
 685	ret = rv770_convert_power_level_to_smc(rdev,
 686					       &state->low,
 687					       &smc_state->levels[0],
 688					       PPSMC_DISPLAY_WATERMARK_LOW);
 689	if (ret)
 690		return ret;
 691
 692	ret = rv770_convert_power_level_to_smc(rdev,
 693					       &state->medium,
 694					       &smc_state->levels[1],
 695					       PPSMC_DISPLAY_WATERMARK_LOW);
 696	if (ret)
 697		return ret;
 698
 699	ret = rv770_convert_power_level_to_smc(rdev,
 700					       &state->high,
 701					       &smc_state->levels[2],
 702					       PPSMC_DISPLAY_WATERMARK_HIGH);
 703	if (ret)
 704		return ret;
 705
 706	smc_state->levels[0].arbValue = MC_CG_ARB_FREQ_F1;
 707	smc_state->levels[1].arbValue = MC_CG_ARB_FREQ_F2;
 708	smc_state->levels[2].arbValue = MC_CG_ARB_FREQ_F3;
 709
 710	smc_state->levels[0].seqValue = rv770_get_seq_value(rdev,
 711							    &state->low);
 712	smc_state->levels[1].seqValue = rv770_get_seq_value(rdev,
 713							    &state->medium);
 714	smc_state->levels[2].seqValue = rv770_get_seq_value(rdev,
 715							    &state->high);
 716
 717	rv770_populate_smc_sp(rdev, radeon_state, smc_state);
 718
 719	return rv770_populate_smc_t(rdev, radeon_state, smc_state);
 720
 721}
 722
 723u32 rv770_calculate_memory_refresh_rate(struct radeon_device *rdev,
 724					u32 engine_clock)
 725{
 726	u32 dram_rows;
 727	u32 dram_refresh_rate;
 728	u32 mc_arb_rfsh_rate;
 729	u32 tmp;
 730
 731	tmp = (RREG32(MC_ARB_RAMCFG) & NOOFROWS_MASK) >> NOOFROWS_SHIFT;
 732	dram_rows = 1 << (tmp + 10);
 733	tmp = RREG32(MC_SEQ_MISC0) & 3;
 734	dram_refresh_rate = 1 << (tmp + 3);
 735	mc_arb_rfsh_rate = ((engine_clock * 10) * dram_refresh_rate / dram_rows - 32) / 64;
 736
 737	return mc_arb_rfsh_rate;
 738}
 739
 740static void rv770_program_memory_timing_parameters(struct radeon_device *rdev,
 741						   struct radeon_ps *radeon_state)
 742{
 743	struct rv7xx_ps *state = rv770_get_ps(radeon_state);
 744	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 745	u32 sqm_ratio;
 746	u32 arb_refresh_rate;
 747	u32 high_clock;
 748
 749	if (state->high.sclk < (state->low.sclk * 0xFF / 0x40))
 750		high_clock = state->high.sclk;
 751	else
 752		high_clock = (state->low.sclk * 0xFF / 0x40);
 753
 754	radeon_atom_set_engine_dram_timings(rdev, high_clock,
 755					    state->high.mclk);
 756
 757	sqm_ratio =
 758		STATE0(64 * high_clock / pi->boot_sclk) |
 759		STATE1(64 * high_clock / state->low.sclk) |
 760		STATE2(64 * high_clock / state->medium.sclk) |
 761		STATE3(64 * high_clock / state->high.sclk);
 762	WREG32(MC_ARB_SQM_RATIO, sqm_ratio);
 763
 764	arb_refresh_rate =
 765		POWERMODE0(rv770_calculate_memory_refresh_rate(rdev, pi->boot_sclk)) |
 766		POWERMODE1(rv770_calculate_memory_refresh_rate(rdev, state->low.sclk)) |
 767		POWERMODE2(rv770_calculate_memory_refresh_rate(rdev, state->medium.sclk)) |
 768		POWERMODE3(rv770_calculate_memory_refresh_rate(rdev, state->high.sclk));
 769	WREG32(MC_ARB_RFSH_RATE, arb_refresh_rate);
 770}
 771
 772void rv770_enable_backbias(struct radeon_device *rdev,
 773			   bool enable)
 774{
 775	if (enable)
 776		WREG32_P(GENERAL_PWRMGT, BACKBIAS_PAD_EN, ~BACKBIAS_PAD_EN);
 777	else
 778		WREG32_P(GENERAL_PWRMGT, 0, ~(BACKBIAS_VALUE | BACKBIAS_PAD_EN));
 779}
 780
 781static void rv770_enable_spread_spectrum(struct radeon_device *rdev,
 782					 bool enable)
 783{
 784	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 785
 786	if (enable) {
 787		if (pi->sclk_ss)
 788			WREG32_P(GENERAL_PWRMGT, DYN_SPREAD_SPECTRUM_EN, ~DYN_SPREAD_SPECTRUM_EN);
 789
 790		if (pi->mclk_ss) {
 791			if (rdev->family == CHIP_RV740)
 792				rv740_enable_mclk_spread_spectrum(rdev, true);
 793		}
 794	} else {
 795		WREG32_P(CG_SPLL_SPREAD_SPECTRUM, 0, ~SSEN);
 796
 797		WREG32_P(GENERAL_PWRMGT, 0, ~DYN_SPREAD_SPECTRUM_EN);
 798
 799		WREG32_P(CG_MPLL_SPREAD_SPECTRUM, 0, ~SSEN);
 800
 801		if (rdev->family == CHIP_RV740)
 802			rv740_enable_mclk_spread_spectrum(rdev, false);
 803	}
 804}
 805
 806static void rv770_program_mpll_timing_parameters(struct radeon_device *rdev)
 807{
 808	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 809
 810	if ((rdev->family == CHIP_RV770) && !pi->mem_gddr5) {
 811		WREG32(MPLL_TIME,
 812		       (MPLL_LOCK_TIME(R600_MPLLLOCKTIME_DFLT * pi->ref_div) |
 813			MPLL_RESET_TIME(R600_MPLLRESETTIME_DFLT)));
 814	}
 815}
 816
 817void rv770_setup_bsp(struct radeon_device *rdev)
 818{
 819	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 820	u32 xclk = radeon_get_xclk(rdev);
 821
 822	r600_calculate_u_and_p(pi->asi,
 823			       xclk,
 824			       16,
 825			       &pi->bsp,
 826			       &pi->bsu);
 827
 828	r600_calculate_u_and_p(pi->pasi,
 829			       xclk,
 830			       16,
 831			       &pi->pbsp,
 832			       &pi->pbsu);
 833
 834	pi->dsp = BSP(pi->bsp) | BSU(pi->bsu);
 835	pi->psp = BSP(pi->pbsp) | BSU(pi->pbsu);
 836
 837	WREG32(CG_BSP, pi->dsp);
 838
 839}
 840
 841void rv770_program_git(struct radeon_device *rdev)
 842{
 843	WREG32_P(CG_GIT, CG_GICST(R600_GICST_DFLT), ~CG_GICST_MASK);
 844}
 845
 846void rv770_program_tp(struct radeon_device *rdev)
 847{
 848	int i;
 849	enum r600_td td = R600_TD_DFLT;
 850
 851	for (i = 0; i < R600_PM_NUMBER_OF_TC; i++)
 852		WREG32(CG_FFCT_0 + (i * 4), (UTC_0(r600_utc[i]) | DTC_0(r600_dtc[i])));
 853
 854	if (td == R600_TD_AUTO)
 855		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_FORCE_TREND_SEL);
 856	else
 857		WREG32_P(SCLK_PWRMGT_CNTL, FIR_FORCE_TREND_SEL, ~FIR_FORCE_TREND_SEL);
 858	if (td == R600_TD_UP)
 859		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_TREND_MODE);
 860	if (td == R600_TD_DOWN)
 861		WREG32_P(SCLK_PWRMGT_CNTL, FIR_TREND_MODE, ~FIR_TREND_MODE);
 862}
 863
 864void rv770_program_tpp(struct radeon_device *rdev)
 865{
 866	WREG32(CG_TPC, R600_TPC_DFLT);
 867}
 868
 869void rv770_program_sstp(struct radeon_device *rdev)
 870{
 871	WREG32(CG_SSP, (SSTU(R600_SSTU_DFLT) | SST(R600_SST_DFLT)));
 872}
 873
 874void rv770_program_engine_speed_parameters(struct radeon_device *rdev)
 875{
 876	WREG32_P(SPLL_CNTL_MODE, SPLL_DIV_SYNC, ~SPLL_DIV_SYNC);
 877}
 878
 879static void rv770_enable_display_gap(struct radeon_device *rdev)
 880{
 881	u32 tmp = RREG32(CG_DISPLAY_GAP_CNTL);
 882
 883	tmp &= ~(DISP1_GAP_MCHG_MASK | DISP2_GAP_MCHG_MASK);
 884	tmp |= (DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE) |
 885		DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE));
 886	WREG32(CG_DISPLAY_GAP_CNTL, tmp);
 887}
 888
 889void rv770_program_vc(struct radeon_device *rdev)
 890{
 891	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 892
 893	WREG32(CG_FTV, pi->vrc);
 894}
 895
 896void rv770_clear_vc(struct radeon_device *rdev)
 897{
 898	WREG32(CG_FTV, 0);
 899}
 900
 901int rv770_upload_firmware(struct radeon_device *rdev)
 902{
 903	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 904	int ret;
 905
 906	rv770_reset_smc(rdev);
 907	rv770_stop_smc_clock(rdev);
 908
 909	ret = rv770_load_smc_ucode(rdev, pi->sram_end);
 910	if (ret)
 911		return ret;
 912
 913	return 0;
 914}
 915
 916static int rv770_populate_smc_acpi_state(struct radeon_device *rdev,
 917					 RV770_SMC_STATETABLE *table)
 918{
 919	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
 920
 921	u32 mpll_ad_func_cntl =
 922		pi->clk_regs.rv770.mpll_ad_func_cntl;
 923	u32 mpll_ad_func_cntl_2 =
 924		pi->clk_regs.rv770.mpll_ad_func_cntl_2;
 925	u32 mpll_dq_func_cntl =
 926		pi->clk_regs.rv770.mpll_dq_func_cntl;
 927	u32 mpll_dq_func_cntl_2 =
 928		pi->clk_regs.rv770.mpll_dq_func_cntl_2;
 929	u32 spll_func_cntl =
 930		pi->clk_regs.rv770.cg_spll_func_cntl;
 931	u32 spll_func_cntl_2 =
 932		pi->clk_regs.rv770.cg_spll_func_cntl_2;
 933	u32 spll_func_cntl_3 =
 934		pi->clk_regs.rv770.cg_spll_func_cntl_3;
 935	u32 mclk_pwrmgt_cntl;
 936	u32 dll_cntl;
 937
 938	table->ACPIState = table->initialState;
 939
 940	table->ACPIState.flags &= ~PPSMC_SWSTATE_FLAG_DC;
 941
 942	if (pi->acpi_vddc) {
 943		rv770_populate_vddc_value(rdev, pi->acpi_vddc,
 944					  &table->ACPIState.levels[0].vddc);
 945		if (pi->pcie_gen2) {
 946			if (pi->acpi_pcie_gen2)
 947				table->ACPIState.levels[0].gen2PCIE = 1;
 948			else
 949				table->ACPIState.levels[0].gen2PCIE = 0;
 950		} else
 951			table->ACPIState.levels[0].gen2PCIE = 0;
 952		if (pi->acpi_pcie_gen2)
 953			table->ACPIState.levels[0].gen2XSP = 1;
 954		else
 955			table->ACPIState.levels[0].gen2XSP = 0;
 956	} else {
 957		rv770_populate_vddc_value(rdev, pi->min_vddc_in_table,
 958					  &table->ACPIState.levels[0].vddc);
 959		table->ACPIState.levels[0].gen2PCIE = 0;
 960	}
 961
 962
 963	mpll_ad_func_cntl_2 |= BIAS_GEN_PDNB | RESET_EN;
 964
 965	mpll_dq_func_cntl_2 |= BIAS_GEN_PDNB | RESET_EN;
 966
 967	mclk_pwrmgt_cntl = (MRDCKA0_RESET |
 968			    MRDCKA1_RESET |
 969			    MRDCKB0_RESET |
 970			    MRDCKB1_RESET |
 971			    MRDCKC0_RESET |
 972			    MRDCKC1_RESET |
 973			    MRDCKD0_RESET |
 974			    MRDCKD1_RESET);
 975
 976	dll_cntl = 0xff000000;
 977
 978	spll_func_cntl |= SPLL_RESET | SPLL_SLEEP | SPLL_BYPASS_EN;
 979
 980	spll_func_cntl_2 &= ~SCLK_MUX_SEL_MASK;
 981	spll_func_cntl_2 |= SCLK_MUX_SEL(4);
 982
 983	table->ACPIState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL = cpu_to_be32(mpll_ad_func_cntl);
 984	table->ACPIState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL_2 = cpu_to_be32(mpll_ad_func_cntl_2);
 985	table->ACPIState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL = cpu_to_be32(mpll_dq_func_cntl);
 986	table->ACPIState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL_2 = cpu_to_be32(mpll_dq_func_cntl_2);
 987
 988	table->ACPIState.levels[0].mclk.mclk770.vMCLK_PWRMGT_CNTL = cpu_to_be32(mclk_pwrmgt_cntl);
 989	table->ACPIState.levels[0].mclk.mclk770.vDLL_CNTL = cpu_to_be32(dll_cntl);
 990
 991	table->ACPIState.levels[0].mclk.mclk770.mclk_value = 0;
 992
 993	table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL = cpu_to_be32(spll_func_cntl);
 994	table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_2 = cpu_to_be32(spll_func_cntl_2);
 995	table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_3 = cpu_to_be32(spll_func_cntl_3);
 996
 997	table->ACPIState.levels[0].sclk.sclk_value = 0;
 998
 999	rv770_populate_mvdd_value(rdev, 0, &table->ACPIState.levels[0].mvdd);
1000
1001	table->ACPIState.levels[1] = table->ACPIState.levels[0];
1002	table->ACPIState.levels[2] = table->ACPIState.levels[0];
1003
1004	return 0;
1005}
1006
1007int rv770_populate_initial_mvdd_value(struct radeon_device *rdev,
1008				      RV770_SMC_VOLTAGE_VALUE *voltage)
1009{
1010	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1011
1012	if ((pi->s0_vid_lower_smio_cntl & pi->mvdd_mask_low) ==
1013	     (pi->mvdd_low_smio[MVDD_LOW_INDEX] & pi->mvdd_mask_low) ) {
1014		voltage->index = MVDD_LOW_INDEX;
1015		voltage->value = cpu_to_be16(MVDD_LOW_VALUE);
1016	} else {
1017		voltage->index = MVDD_HIGH_INDEX;
1018		voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
1019	}
1020
1021	return 0;
1022}
1023
1024static int rv770_populate_smc_initial_state(struct radeon_device *rdev,
1025					    struct radeon_ps *radeon_state,
1026					    RV770_SMC_STATETABLE *table)
1027{
1028	struct rv7xx_ps *initial_state = rv770_get_ps(radeon_state);
1029	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1030	u32 a_t;
1031
1032	table->initialState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL =
1033		cpu_to_be32(pi->clk_regs.rv770.mpll_ad_func_cntl);
1034	table->initialState.levels[0].mclk.mclk770.vMPLL_AD_FUNC_CNTL_2 =
1035		cpu_to_be32(pi->clk_regs.rv770.mpll_ad_func_cntl_2);
1036	table->initialState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL =
1037		cpu_to_be32(pi->clk_regs.rv770.mpll_dq_func_cntl);
1038	table->initialState.levels[0].mclk.mclk770.vMPLL_DQ_FUNC_CNTL_2 =
1039		cpu_to_be32(pi->clk_regs.rv770.mpll_dq_func_cntl_2);
1040	table->initialState.levels[0].mclk.mclk770.vMCLK_PWRMGT_CNTL =
1041		cpu_to_be32(pi->clk_regs.rv770.mclk_pwrmgt_cntl);
1042	table->initialState.levels[0].mclk.mclk770.vDLL_CNTL =
1043		cpu_to_be32(pi->clk_regs.rv770.dll_cntl);
1044
1045	table->initialState.levels[0].mclk.mclk770.vMPLL_SS =
1046		cpu_to_be32(pi->clk_regs.rv770.mpll_ss1);
1047	table->initialState.levels[0].mclk.mclk770.vMPLL_SS2 =
1048		cpu_to_be32(pi->clk_regs.rv770.mpll_ss2);
1049
1050	table->initialState.levels[0].mclk.mclk770.mclk_value =
1051		cpu_to_be32(initial_state->low.mclk);
1052
1053	table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL =
1054		cpu_to_be32(pi->clk_regs.rv770.cg_spll_func_cntl);
1055	table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_2 =
1056		cpu_to_be32(pi->clk_regs.rv770.cg_spll_func_cntl_2);
1057	table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_3 =
1058		cpu_to_be32(pi->clk_regs.rv770.cg_spll_func_cntl_3);
1059	table->initialState.levels[0].sclk.vCG_SPLL_SPREAD_SPECTRUM =
1060		cpu_to_be32(pi->clk_regs.rv770.cg_spll_spread_spectrum);
1061	table->initialState.levels[0].sclk.vCG_SPLL_SPREAD_SPECTRUM_2 =
1062		cpu_to_be32(pi->clk_regs.rv770.cg_spll_spread_spectrum_2);
1063
1064	table->initialState.levels[0].sclk.sclk_value =
1065		cpu_to_be32(initial_state->low.sclk);
1066
1067	table->initialState.levels[0].arbValue = MC_CG_ARB_FREQ_F0;
1068
1069	table->initialState.levels[0].seqValue =
1070		rv770_get_seq_value(rdev, &initial_state->low);
1071
1072	rv770_populate_vddc_value(rdev,
1073				  initial_state->low.vddc,
1074				  &table->initialState.levels[0].vddc);
1075	rv770_populate_initial_mvdd_value(rdev,
1076					  &table->initialState.levels[0].mvdd);
1077
1078	a_t = CG_R(0xffff) | CG_L(0);
1079	table->initialState.levels[0].aT = cpu_to_be32(a_t);
1080
1081	table->initialState.levels[0].bSP = cpu_to_be32(pi->dsp);
1082
1083	if (pi->boot_in_gen2)
1084		table->initialState.levels[0].gen2PCIE = 1;
1085	else
1086		table->initialState.levels[0].gen2PCIE = 0;
1087	if (initial_state->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2)
1088		table->initialState.levels[0].gen2XSP = 1;
1089	else
1090		table->initialState.levels[0].gen2XSP = 0;
1091
1092	if (rdev->family == CHIP_RV740) {
1093		if (pi->mem_gddr5) {
1094			if (initial_state->low.mclk <= pi->mclk_strobe_mode_threshold)
1095				table->initialState.levels[0].strobeMode =
1096					rv740_get_mclk_frequency_ratio(initial_state->low.mclk) | 0x10;
1097			else
1098				table->initialState.levels[0].strobeMode = 0;
1099
1100			if (initial_state->low.mclk >= pi->mclk_edc_enable_threshold)
1101				table->initialState.levels[0].mcFlags = SMC_MC_EDC_RD_FLAG | SMC_MC_EDC_WR_FLAG;
1102			else
1103				table->initialState.levels[0].mcFlags =  0;
1104		}
1105	}
1106
1107	table->initialState.levels[1] = table->initialState.levels[0];
1108	table->initialState.levels[2] = table->initialState.levels[0];
1109
1110	table->initialState.flags |= PPSMC_SWSTATE_FLAG_DC;
1111
1112	return 0;
1113}
1114
1115static int rv770_populate_smc_vddc_table(struct radeon_device *rdev,
1116					 RV770_SMC_STATETABLE *table)
1117{
1118	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1119	int i;
1120
1121	for (i = 0; i < pi->valid_vddc_entries; i++) {
1122		table->highSMIO[pi->vddc_table[i].vddc_index] =
1123			pi->vddc_table[i].high_smio;
1124		table->lowSMIO[pi->vddc_table[i].vddc_index] =
1125			cpu_to_be32(pi->vddc_table[i].low_smio);
1126	}
1127
1128	table->voltageMaskTable.highMask[RV770_SMC_VOLTAGEMASK_VDDC] = 0;
1129	table->voltageMaskTable.lowMask[RV770_SMC_VOLTAGEMASK_VDDC] =
1130		cpu_to_be32(pi->vddc_mask_low);
1131
1132	for (i = 0;
1133	     ((i < pi->valid_vddc_entries) &&
1134	      (pi->max_vddc_in_table >
1135	       pi->vddc_table[i].vddc));
1136	     i++);
1137
1138	table->maxVDDCIndexInPPTable =
1139		pi->vddc_table[i].vddc_index;
1140
1141	return 0;
1142}
1143
1144static int rv770_populate_smc_mvdd_table(struct radeon_device *rdev,
1145					 RV770_SMC_STATETABLE *table)
1146{
1147	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1148
1149	if (pi->mvdd_control) {
1150		table->lowSMIO[MVDD_HIGH_INDEX] |=
1151			cpu_to_be32(pi->mvdd_low_smio[MVDD_HIGH_INDEX]);
1152		table->lowSMIO[MVDD_LOW_INDEX] |=
1153			cpu_to_be32(pi->mvdd_low_smio[MVDD_LOW_INDEX]);
1154
1155		table->voltageMaskTable.highMask[RV770_SMC_VOLTAGEMASK_MVDD] = 0;
1156		table->voltageMaskTable.lowMask[RV770_SMC_VOLTAGEMASK_MVDD] =
1157			cpu_to_be32(pi->mvdd_mask_low);
1158	}
1159
1160	return 0;
1161}
1162
1163static int rv770_init_smc_table(struct radeon_device *rdev,
1164				struct radeon_ps *radeon_boot_state)
1165{
1166	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1167	struct rv7xx_ps *boot_state = rv770_get_ps(radeon_boot_state);
1168	RV770_SMC_STATETABLE *table = &pi->smc_statetable;
1169	int ret;
1170
1171	memset(table, 0, sizeof(RV770_SMC_STATETABLE));
1172
1173	pi->boot_sclk = boot_state->low.sclk;
1174
1175	rv770_populate_smc_vddc_table(rdev, table);
1176	rv770_populate_smc_mvdd_table(rdev, table);
1177
1178	switch (rdev->pm.int_thermal_type) {
1179	case THERMAL_TYPE_RV770:
1180	case THERMAL_TYPE_ADT7473_WITH_INTERNAL:
1181		table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_INTERNAL;
1182		break;
1183	case THERMAL_TYPE_NONE:
1184		table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_NONE;
1185		break;
1186	case THERMAL_TYPE_EXTERNAL_GPIO:
1187	default:
1188		table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_EXTERNAL;
1189		break;
1190	}
1191
1192	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_HARDWAREDC) {
1193		table->systemFlags |= PPSMC_SYSTEMFLAG_GPIO_DC;
1194
1195		if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_DONT_WAIT_FOR_VBLANK_ON_ALERT)
1196			table->extraFlags |= PPSMC_EXTRAFLAGS_AC2DC_DONT_WAIT_FOR_VBLANK;
1197
1198		if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_GOTO_BOOT_ON_ALERT)
1199			table->extraFlags |= PPSMC_EXTRAFLAGS_AC2DC_ACTION_GOTOINITIALSTATE;
1200	}
1201
1202	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_STEPVDDC)
1203		table->systemFlags |= PPSMC_SYSTEMFLAG_STEPVDDC;
1204
1205	if (pi->mem_gddr5)
1206		table->systemFlags |= PPSMC_SYSTEMFLAG_GDDR5;
1207
1208	if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
1209		ret = rv730_populate_smc_initial_state(rdev, radeon_boot_state, table);
1210	else
1211		ret = rv770_populate_smc_initial_state(rdev, radeon_boot_state, table);
1212	if (ret)
1213		return ret;
1214
1215	if (rdev->family == CHIP_RV740)
1216		ret = rv740_populate_smc_acpi_state(rdev, table);
1217	else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
1218		ret = rv730_populate_smc_acpi_state(rdev, table);
1219	else
1220		ret = rv770_populate_smc_acpi_state(rdev, table);
1221	if (ret)
1222		return ret;
1223
1224	table->driverState = table->initialState;
1225
1226	return rv770_copy_bytes_to_smc(rdev,
1227				       pi->state_table_start,
1228				       (const u8 *)table,
1229				       sizeof(RV770_SMC_STATETABLE),
1230				       pi->sram_end);
1231}
1232
1233static int rv770_construct_vddc_table(struct radeon_device *rdev)
1234{
1235	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1236	u16 min, max, step;
1237	u32 steps = 0;
1238	u8 vddc_index = 0;
1239	u32 i;
1240
1241	radeon_atom_get_min_voltage(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, &min);
1242	radeon_atom_get_max_voltage(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, &max);
1243	radeon_atom_get_voltage_step(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, &step);
1244
1245	steps = (max - min) / step + 1;
1246
1247	if (steps > MAX_NO_VREG_STEPS)
1248		return -EINVAL;
1249
1250	for (i = 0; i < steps; i++) {
1251		u32 gpio_pins, gpio_mask;
1252
1253		pi->vddc_table[i].vddc = (u16)(min + i * step);
1254		radeon_atom_get_voltage_gpio_settings(rdev,
1255						      pi->vddc_table[i].vddc,
1256						      SET_VOLTAGE_TYPE_ASIC_VDDC,
1257						      &gpio_pins, &gpio_mask);
1258		pi->vddc_table[i].low_smio = gpio_pins & gpio_mask;
1259		pi->vddc_table[i].high_smio = 0;
1260		pi->vddc_mask_low = gpio_mask;
1261		if (i > 0) {
1262			if ((pi->vddc_table[i].low_smio !=
1263			     pi->vddc_table[i - 1].low_smio ) ||
1264			     (pi->vddc_table[i].high_smio !=
1265			      pi->vddc_table[i - 1].high_smio))
1266				vddc_index++;
1267		}
1268		pi->vddc_table[i].vddc_index = vddc_index;
1269	}
1270
1271	pi->valid_vddc_entries = (u8)steps;
1272
1273	return 0;
1274}
1275
1276static u32 rv770_get_mclk_split_point(struct atom_memory_info *memory_info)
1277{
1278	if (memory_info->mem_type == MEM_TYPE_GDDR3)
1279		return 30000;
1280
1281	return 0;
1282}
1283
1284static int rv770_get_mvdd_pin_configuration(struct radeon_device *rdev)
1285{
1286	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1287	u32 gpio_pins, gpio_mask;
1288
1289	radeon_atom_get_voltage_gpio_settings(rdev,
1290					      MVDD_HIGH_VALUE, SET_VOLTAGE_TYPE_ASIC_MVDDC,
1291					      &gpio_pins, &gpio_mask);
1292	pi->mvdd_mask_low = gpio_mask;
1293	pi->mvdd_low_smio[MVDD_HIGH_INDEX] =
1294		gpio_pins & gpio_mask;
1295
1296	radeon_atom_get_voltage_gpio_settings(rdev,
1297					      MVDD_LOW_VALUE, SET_VOLTAGE_TYPE_ASIC_MVDDC,
1298					      &gpio_pins, &gpio_mask);
1299	pi->mvdd_low_smio[MVDD_LOW_INDEX] =
1300		gpio_pins & gpio_mask;
1301
1302	return 0;
1303}
1304
1305u8 rv770_get_memory_module_index(struct radeon_device *rdev)
1306{
1307	return (u8) ((RREG32(BIOS_SCRATCH_4) >> 16) & 0xff);
1308}
1309
1310static int rv770_get_mvdd_configuration(struct radeon_device *rdev)
1311{
1312	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1313	u8 memory_module_index;
1314	struct atom_memory_info memory_info;
1315
1316	memory_module_index = rv770_get_memory_module_index(rdev);
1317
1318	if (radeon_atom_get_memory_info(rdev, memory_module_index, &memory_info)) {
1319		pi->mvdd_control = false;
1320		return 0;
1321	}
1322
1323	pi->mvdd_split_frequency =
1324		rv770_get_mclk_split_point(&memory_info);
1325
1326	if (pi->mvdd_split_frequency == 0) {
1327		pi->mvdd_control = false;
1328		return 0;
1329	}
1330
1331	return rv770_get_mvdd_pin_configuration(rdev);
1332}
1333
1334void rv770_enable_voltage_control(struct radeon_device *rdev,
1335				  bool enable)
1336{
1337	if (enable)
1338		WREG32_P(GENERAL_PWRMGT, VOLT_PWRMGT_EN, ~VOLT_PWRMGT_EN);
1339	else
1340		WREG32_P(GENERAL_PWRMGT, 0, ~VOLT_PWRMGT_EN);
1341}
1342
1343static void rv770_program_display_gap(struct radeon_device *rdev)
1344{
1345	u32 tmp = RREG32(CG_DISPLAY_GAP_CNTL);
1346
1347	tmp &= ~(DISP1_GAP_MCHG_MASK | DISP2_GAP_MCHG_MASK);
1348	if (rdev->pm.dpm.new_active_crtcs & 1) {
1349		tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_VBLANK);
1350		tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
1351	} else if (rdev->pm.dpm.new_active_crtcs & 2) {
1352		tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
1353		tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_VBLANK);
1354	} else {
1355		tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
1356		tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE);
1357	}
1358	WREG32(CG_DISPLAY_GAP_CNTL, tmp);
1359}
1360
1361static void rv770_enable_dynamic_pcie_gen2(struct radeon_device *rdev,
1362					   bool enable)
1363{
1364	rv770_enable_bif_dynamic_pcie_gen2(rdev, enable);
1365
1366	if (enable)
1367		WREG32_P(GENERAL_PWRMGT, ENABLE_GEN2PCIE, ~ENABLE_GEN2PCIE);
1368	else
1369		WREG32_P(GENERAL_PWRMGT, 0, ~ENABLE_GEN2PCIE);
1370}
1371
1372static void r7xx_program_memory_timing_parameters(struct radeon_device *rdev,
1373						  struct radeon_ps *radeon_new_state)
1374{
1375	if ((rdev->family == CHIP_RV730) ||
1376	    (rdev->family == CHIP_RV710) ||
1377	    (rdev->family == CHIP_RV740))
1378		rv730_program_memory_timing_parameters(rdev, radeon_new_state);
1379	else
1380		rv770_program_memory_timing_parameters(rdev, radeon_new_state);
1381}
1382
1383static int rv770_upload_sw_state(struct radeon_device *rdev,
1384				 struct radeon_ps *radeon_new_state)
1385{
1386	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1387	u16 address = pi->state_table_start +
1388		offsetof(RV770_SMC_STATETABLE, driverState);
1389	RV770_SMC_SWSTATE state = { 0 };
1390	int ret;
1391
1392	ret = rv770_convert_power_state_to_smc(rdev, radeon_new_state, &state);
1393	if (ret)
1394		return ret;
1395
1396	return rv770_copy_bytes_to_smc(rdev, address, (const u8 *)&state,
1397				       sizeof(RV770_SMC_SWSTATE),
1398				       pi->sram_end);
1399}
1400
1401int rv770_halt_smc(struct radeon_device *rdev)
1402{
1403	if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_Halt) != PPSMC_Result_OK)
1404		return -EINVAL;
1405
1406	if (rv770_wait_for_smc_inactive(rdev) != PPSMC_Result_OK)
1407		return -EINVAL;
1408
1409	return 0;
1410}
1411
1412int rv770_resume_smc(struct radeon_device *rdev)
1413{
1414	if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_Resume) != PPSMC_Result_OK)
1415		return -EINVAL;
1416	return 0;
1417}
1418
1419int rv770_set_sw_state(struct radeon_device *rdev)
1420{
1421	if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_SwitchToSwState) != PPSMC_Result_OK)
1422		DRM_DEBUG("rv770_set_sw_state failed\n");
1423	return 0;
1424}
1425
1426int rv770_set_boot_state(struct radeon_device *rdev)
1427{
1428	if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_SwitchToInitialState) != PPSMC_Result_OK)
1429		return -EINVAL;
1430	return 0;
1431}
1432
1433void rv770_set_uvd_clock_before_set_eng_clock(struct radeon_device *rdev,
1434					      struct radeon_ps *new_ps,
1435					      struct radeon_ps *old_ps)
1436{
1437	struct rv7xx_ps *new_state = rv770_get_ps(new_ps);
1438	struct rv7xx_ps *current_state = rv770_get_ps(old_ps);
1439
1440	if ((new_ps->vclk == old_ps->vclk) &&
1441	    (new_ps->dclk == old_ps->dclk))
1442		return;
1443
1444	if (new_state->high.sclk >= current_state->high.sclk)
1445		return;
1446
1447	radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk);
1448}
1449
1450void rv770_set_uvd_clock_after_set_eng_clock(struct radeon_device *rdev,
1451					     struct radeon_ps *new_ps,
1452					     struct radeon_ps *old_ps)
1453{
1454	struct rv7xx_ps *new_state = rv770_get_ps(new_ps);
1455	struct rv7xx_ps *current_state = rv770_get_ps(old_ps);
1456
1457	if ((new_ps->vclk == old_ps->vclk) &&
1458	    (new_ps->dclk == old_ps->dclk))
1459		return;
1460
1461	if (new_state->high.sclk < current_state->high.sclk)
1462		return;
1463
1464	radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk);
1465}
1466
1467int rv770_restrict_performance_levels_before_switch(struct radeon_device *rdev)
1468{
1469	if (rv770_send_msg_to_smc(rdev, (PPSMC_Msg)(PPSMC_MSG_NoForcedLevel)) != PPSMC_Result_OK)
1470		return -EINVAL;
1471
1472	if (rv770_send_msg_to_smc(rdev, (PPSMC_Msg)(PPSMC_MSG_TwoLevelsDisabled)) != PPSMC_Result_OK)
1473		return -EINVAL;
1474
1475	return 0;
1476}
1477
1478int rv770_dpm_force_performance_level(struct radeon_device *rdev,
1479				      enum radeon_dpm_forced_level level)
1480{
1481	PPSMC_Msg msg;
1482
1483	if (level == RADEON_DPM_FORCED_LEVEL_HIGH) {
1484		if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_ZeroLevelsDisabled) != PPSMC_Result_OK)
1485			return -EINVAL;
1486		msg = PPSMC_MSG_ForceHigh;
1487	} else if (level == RADEON_DPM_FORCED_LEVEL_LOW) {
1488		if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_NoForcedLevel) != PPSMC_Result_OK)
1489			return -EINVAL;
1490		msg = (PPSMC_Msg)(PPSMC_MSG_TwoLevelsDisabled);
1491	} else {
1492		if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_NoForcedLevel) != PPSMC_Result_OK)
1493			return -EINVAL;
1494		msg = (PPSMC_Msg)(PPSMC_MSG_ZeroLevelsDisabled);
1495	}
1496
1497	if (rv770_send_msg_to_smc(rdev, msg) != PPSMC_Result_OK)
1498		return -EINVAL;
1499
1500	rdev->pm.dpm.forced_level = level;
1501
1502	return 0;
1503}
1504
1505void r7xx_start_smc(struct radeon_device *rdev)
1506{
1507	rv770_start_smc(rdev);
1508	rv770_start_smc_clock(rdev);
1509}
1510
1511
1512void r7xx_stop_smc(struct radeon_device *rdev)
1513{
1514	rv770_reset_smc(rdev);
1515	rv770_stop_smc_clock(rdev);
1516}
1517
1518static void rv770_read_clock_registers(struct radeon_device *rdev)
1519{
1520	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1521
1522	pi->clk_regs.rv770.cg_spll_func_cntl =
1523		RREG32(CG_SPLL_FUNC_CNTL);
1524	pi->clk_regs.rv770.cg_spll_func_cntl_2 =
1525		RREG32(CG_SPLL_FUNC_CNTL_2);
1526	pi->clk_regs.rv770.cg_spll_func_cntl_3 =
1527		RREG32(CG_SPLL_FUNC_CNTL_3);
1528	pi->clk_regs.rv770.cg_spll_spread_spectrum =
1529		RREG32(CG_SPLL_SPREAD_SPECTRUM);
1530	pi->clk_regs.rv770.cg_spll_spread_spectrum_2 =
1531		RREG32(CG_SPLL_SPREAD_SPECTRUM_2);
1532	pi->clk_regs.rv770.mpll_ad_func_cntl =
1533		RREG32(MPLL_AD_FUNC_CNTL);
1534	pi->clk_regs.rv770.mpll_ad_func_cntl_2 =
1535		RREG32(MPLL_AD_FUNC_CNTL_2);
1536	pi->clk_regs.rv770.mpll_dq_func_cntl =
1537		RREG32(MPLL_DQ_FUNC_CNTL);
1538	pi->clk_regs.rv770.mpll_dq_func_cntl_2 =
1539		RREG32(MPLL_DQ_FUNC_CNTL_2);
1540	pi->clk_regs.rv770.mclk_pwrmgt_cntl =
1541		RREG32(MCLK_PWRMGT_CNTL);
1542	pi->clk_regs.rv770.dll_cntl = RREG32(DLL_CNTL);
1543}
1544
1545static void r7xx_read_clock_registers(struct radeon_device *rdev)
1546{
1547	if (rdev->family == CHIP_RV740)
1548		rv740_read_clock_registers(rdev);
1549	else if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
1550		rv730_read_clock_registers(rdev);
1551	else
1552		rv770_read_clock_registers(rdev);
1553}
1554
1555void rv770_read_voltage_smio_registers(struct radeon_device *rdev)
1556{
1557	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1558
1559	pi->s0_vid_lower_smio_cntl =
1560		RREG32(S0_VID_LOWER_SMIO_CNTL);
1561}
1562
1563void rv770_reset_smio_status(struct radeon_device *rdev)
1564{
1565	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1566	u32 sw_smio_index, vid_smio_cntl;
1567
1568	sw_smio_index =
1569		(RREG32(GENERAL_PWRMGT) & SW_SMIO_INDEX_MASK) >> SW_SMIO_INDEX_SHIFT;
1570	switch (sw_smio_index) {
1571	case 3:
1572		vid_smio_cntl = RREG32(S3_VID_LOWER_SMIO_CNTL);
1573		break;
1574	case 2:
1575		vid_smio_cntl = RREG32(S2_VID_LOWER_SMIO_CNTL);
1576		break;
1577	case 1:
1578		vid_smio_cntl = RREG32(S1_VID_LOWER_SMIO_CNTL);
1579		break;
1580	case 0:
1581		return;
1582	default:
1583		vid_smio_cntl = pi->s0_vid_lower_smio_cntl;
1584		break;
1585	}
1586
1587	WREG32(S0_VID_LOWER_SMIO_CNTL, vid_smio_cntl);
1588	WREG32_P(GENERAL_PWRMGT, SW_SMIO_INDEX(0), ~SW_SMIO_INDEX_MASK);
1589}
1590
1591void rv770_get_memory_type(struct radeon_device *rdev)
1592{
1593	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1594	u32 tmp;
1595
1596	tmp = RREG32(MC_SEQ_MISC0);
1597
1598	if (((tmp & MC_SEQ_MISC0_GDDR5_MASK) >> MC_SEQ_MISC0_GDDR5_SHIFT) ==
1599	    MC_SEQ_MISC0_GDDR5_VALUE)
1600		pi->mem_gddr5 = true;
1601	else
1602		pi->mem_gddr5 = false;
1603
1604}
1605
1606void rv770_get_pcie_gen2_status(struct radeon_device *rdev)
1607{
1608	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1609	u32 tmp;
1610
1611	tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL);
1612
1613	if ((tmp & LC_OTHER_SIDE_EVER_SENT_GEN2) &&
1614	    (tmp & LC_OTHER_SIDE_SUPPORTS_GEN2))
1615		pi->pcie_gen2 = true;
1616	else
1617		pi->pcie_gen2 = false;
1618
1619	if (pi->pcie_gen2) {
1620		if (tmp & LC_CURRENT_DATA_RATE)
1621			pi->boot_in_gen2 = true;
1622		else
1623			pi->boot_in_gen2 = false;
1624	} else
1625		pi->boot_in_gen2 = false;
1626}
1627
1628#if 0
1629static int rv770_enter_ulp_state(struct radeon_device *rdev)
1630{
1631	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1632
1633	if (pi->gfx_clock_gating) {
1634		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
1635		WREG32_P(SCLK_PWRMGT_CNTL, GFX_CLK_FORCE_ON, ~GFX_CLK_FORCE_ON);
1636		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~GFX_CLK_FORCE_ON);
1637		RREG32(GB_TILING_CONFIG);
1638	}
1639
1640	WREG32_P(SMC_MSG, HOST_SMC_MSG(PPSMC_MSG_SwitchToMinimumPower),
1641		 ~HOST_SMC_MSG_MASK);
1642
1643	udelay(7000);
1644
1645	return 0;
1646}
1647
1648static int rv770_exit_ulp_state(struct radeon_device *rdev)
1649{
1650	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1651	int i;
1652
1653	WREG32_P(SMC_MSG, HOST_SMC_MSG(PPSMC_MSG_ResumeFromMinimumPower),
1654		 ~HOST_SMC_MSG_MASK);
1655
1656	udelay(7000);
1657
1658	for (i = 0; i < rdev->usec_timeout; i++) {
1659		if (((RREG32(SMC_MSG) & HOST_SMC_RESP_MASK) >> HOST_SMC_RESP_SHIFT) == 1)
1660			break;
1661		udelay(1000);
1662	}
1663
1664	if (pi->gfx_clock_gating)
1665		WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
1666
1667	return 0;
1668}
1669#endif
1670
1671static void rv770_get_mclk_odt_threshold(struct radeon_device *rdev)
1672{
1673	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1674	u8 memory_module_index;
1675	struct atom_memory_info memory_info;
1676
1677	pi->mclk_odt_threshold = 0;
1678
1679	if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710)) {
1680		memory_module_index = rv770_get_memory_module_index(rdev);
1681
1682		if (radeon_atom_get_memory_info(rdev, memory_module_index, &memory_info))
1683			return;
1684
1685		if (memory_info.mem_type == MEM_TYPE_DDR2 ||
1686		    memory_info.mem_type == MEM_TYPE_DDR3)
1687			pi->mclk_odt_threshold = 30000;
1688	}
1689}
1690
1691void rv770_get_max_vddc(struct radeon_device *rdev)
1692{
1693	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1694	u16 vddc;
1695
1696	if (radeon_atom_get_max_vddc(rdev, 0, 0, &vddc))
1697		pi->max_vddc = 0;
1698	else
1699		pi->max_vddc = vddc;
1700}
1701
1702void rv770_program_response_times(struct radeon_device *rdev)
1703{
1704	u32 voltage_response_time, backbias_response_time;
1705	u32 acpi_delay_time, vbi_time_out;
1706	u32 vddc_dly, bb_dly, acpi_dly, vbi_dly;
1707	u32 reference_clock;
1708
1709	voltage_response_time = (u32)rdev->pm.dpm.voltage_response_time;
1710	backbias_response_time = (u32)rdev->pm.dpm.backbias_response_time;
1711
1712	if (voltage_response_time == 0)
1713		voltage_response_time = 1000;
1714
1715	if (backbias_response_time == 0)
1716		backbias_response_time = 1000;
1717
1718	acpi_delay_time = 15000;
1719	vbi_time_out = 100000;
1720
1721	reference_clock = radeon_get_xclk(rdev);
1722
1723	vddc_dly = (voltage_response_time  * reference_clock) / 1600;
1724	bb_dly = (backbias_response_time * reference_clock) / 1600;
1725	acpi_dly = (acpi_delay_time * reference_clock) / 1600;
1726	vbi_dly = (vbi_time_out * reference_clock) / 1600;
1727
1728	rv770_write_smc_soft_register(rdev,
1729				      RV770_SMC_SOFT_REGISTER_delay_vreg, vddc_dly);
1730	rv770_write_smc_soft_register(rdev,
1731				      RV770_SMC_SOFT_REGISTER_delay_bbias, bb_dly);
1732	rv770_write_smc_soft_register(rdev,
1733				      RV770_SMC_SOFT_REGISTER_delay_acpi, acpi_dly);
1734	rv770_write_smc_soft_register(rdev,
1735				      RV770_SMC_SOFT_REGISTER_mclk_chg_timeout, vbi_dly);
1736#if 0
1737	/* XXX look up hw revision */
1738	if (WEKIVA_A21)
1739		rv770_write_smc_soft_register(rdev,
1740					      RV770_SMC_SOFT_REGISTER_baby_step_timer,
1741					      0x10);
1742#endif
1743}
1744
1745static void rv770_program_dcodt_before_state_switch(struct radeon_device *rdev,
1746						    struct radeon_ps *radeon_new_state,
1747						    struct radeon_ps *radeon_current_state)
1748{
1749	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1750	struct rv7xx_ps *new_state = rv770_get_ps(radeon_new_state);
1751	struct rv7xx_ps *current_state = rv770_get_ps(radeon_current_state);
1752	bool current_use_dc = false;
1753	bool new_use_dc = false;
1754
1755	if (pi->mclk_odt_threshold == 0)
1756		return;
1757
1758	if (current_state->high.mclk <= pi->mclk_odt_threshold)
1759		current_use_dc = true;
1760
1761	if (new_state->high.mclk <= pi->mclk_odt_threshold)
1762		new_use_dc = true;
1763
1764	if (current_use_dc == new_use_dc)
1765		return;
1766
1767	if (!current_use_dc && new_use_dc)
1768		return;
1769
1770	if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
1771		rv730_program_dcodt(rdev, new_use_dc);
1772}
1773
1774static void rv770_program_dcodt_after_state_switch(struct radeon_device *rdev,
1775						   struct radeon_ps *radeon_new_state,
1776						   struct radeon_ps *radeon_current_state)
1777{
1778	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1779	struct rv7xx_ps *new_state = rv770_get_ps(radeon_new_state);
1780	struct rv7xx_ps *current_state = rv770_get_ps(radeon_current_state);
1781	bool current_use_dc = false;
1782	bool new_use_dc = false;
1783
1784	if (pi->mclk_odt_threshold == 0)
1785		return;
1786
1787	if (current_state->high.mclk <= pi->mclk_odt_threshold)
1788		current_use_dc = true;
1789
1790	if (new_state->high.mclk <= pi->mclk_odt_threshold)
1791		new_use_dc = true;
1792
1793	if (current_use_dc == new_use_dc)
1794		return;
1795
1796	if (current_use_dc && !new_use_dc)
1797		return;
1798
1799	if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
1800		rv730_program_dcodt(rdev, new_use_dc);
1801}
1802
1803static void rv770_retrieve_odt_values(struct radeon_device *rdev)
1804{
1805	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1806
1807	if (pi->mclk_odt_threshold == 0)
1808		return;
1809
1810	if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
1811		rv730_get_odt_values(rdev);
1812}
1813
1814static void rv770_set_dpm_event_sources(struct radeon_device *rdev, u32 sources)
1815{
1816	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1817	bool want_thermal_protection;
1818	enum radeon_dpm_event_src dpm_event_src;
1819
1820	switch (sources) {
1821	case 0:
1822	default:
1823		want_thermal_protection = false;
1824		break;
1825	case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL):
1826		want_thermal_protection = true;
1827		dpm_event_src = RADEON_DPM_EVENT_SRC_DIGITAL;
1828		break;
1829
1830	case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL):
1831		want_thermal_protection = true;
1832		dpm_event_src = RADEON_DPM_EVENT_SRC_EXTERNAL;
1833		break;
1834
1835	case ((1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL) |
1836	      (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL)):
1837		want_thermal_protection = true;
1838		dpm_event_src = RADEON_DPM_EVENT_SRC_DIGIAL_OR_EXTERNAL;
1839		break;
1840	}
1841
1842	if (want_thermal_protection) {
1843		WREG32_P(CG_THERMAL_CTRL, DPM_EVENT_SRC(dpm_event_src), ~DPM_EVENT_SRC_MASK);
1844		if (pi->thermal_protection)
1845			WREG32_P(GENERAL_PWRMGT, 0, ~THERMAL_PROTECTION_DIS);
1846	} else {
1847		WREG32_P(GENERAL_PWRMGT, THERMAL_PROTECTION_DIS, ~THERMAL_PROTECTION_DIS);
1848	}
1849}
1850
1851void rv770_enable_auto_throttle_source(struct radeon_device *rdev,
1852				       enum radeon_dpm_auto_throttle_src source,
1853				       bool enable)
1854{
1855	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1856
1857	if (enable) {
1858		if (!(pi->active_auto_throttle_sources & (1 << source))) {
1859			pi->active_auto_throttle_sources |= 1 << source;
1860			rv770_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
1861		}
1862	} else {
1863		if (pi->active_auto_throttle_sources & (1 << source)) {
1864			pi->active_auto_throttle_sources &= ~(1 << source);
1865			rv770_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
1866		}
1867	}
1868}
1869
1870static int rv770_set_thermal_temperature_range(struct radeon_device *rdev,
1871					       int min_temp, int max_temp)
1872{
1873	int low_temp = 0 * 1000;
1874	int high_temp = 255 * 1000;
1875
1876	if (low_temp < min_temp)
1877		low_temp = min_temp;
1878	if (high_temp > max_temp)
1879		high_temp = max_temp;
1880	if (high_temp < low_temp) {
1881		DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
1882		return -EINVAL;
1883	}
1884
1885	WREG32_P(CG_THERMAL_INT, DIG_THERM_INTH(high_temp / 1000), ~DIG_THERM_INTH_MASK);
1886	WREG32_P(CG_THERMAL_INT, DIG_THERM_INTL(low_temp / 1000), ~DIG_THERM_INTL_MASK);
1887	WREG32_P(CG_THERMAL_CTRL, DIG_THERM_DPM(high_temp / 1000), ~DIG_THERM_DPM_MASK);
1888
1889	rdev->pm.dpm.thermal.min_temp = low_temp;
1890	rdev->pm.dpm.thermal.max_temp = high_temp;
1891
1892	return 0;
1893}
1894
1895int rv770_dpm_enable(struct radeon_device *rdev)
1896{
1897	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
1898	struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
1899	int ret;
1900
1901	if (pi->gfx_clock_gating)
1902		rv770_restore_cgcg(rdev);
1903
1904	if (rv770_dpm_enabled(rdev))
1905		return -EINVAL;
1906
1907	if (pi->voltage_control) {
1908		rv770_enable_voltage_control(rdev, true);
1909		ret = rv770_construct_vddc_table(rdev);
1910		if (ret) {
1911			DRM_ERROR("rv770_construct_vddc_table failed\n");
1912			return ret;
1913		}
1914	}
1915
1916	if (pi->dcodt)
1917		rv770_retrieve_odt_values(rdev);
1918
1919	if (pi->mvdd_control) {
1920		ret = rv770_get_mvdd_configuration(rdev);
1921		if (ret) {
1922			DRM_ERROR("rv770_get_mvdd_configuration failed\n");
1923			return ret;
1924		}
1925	}
1926
1927	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS)
1928		rv770_enable_backbias(rdev, true);
1929
1930	rv770_enable_spread_spectrum(rdev, true);
1931
1932	if (pi->thermal_protection)
1933		rv770_enable_thermal_protection(rdev, true);
1934
1935	rv770_program_mpll_timing_parameters(rdev);
1936	rv770_setup_bsp(rdev);
1937	rv770_program_git(rdev);
1938	rv770_program_tp(rdev);
1939	rv770_program_tpp(rdev);
1940	rv770_program_sstp(rdev);
1941	rv770_program_engine_speed_parameters(rdev);
1942	rv770_enable_display_gap(rdev);
1943	rv770_program_vc(rdev);
1944
1945	if (pi->dynamic_pcie_gen2)
1946		rv770_enable_dynamic_pcie_gen2(rdev, true);
1947
1948	ret = rv770_upload_firmware(rdev);
1949	if (ret) {
1950		DRM_ERROR("rv770_upload_firmware failed\n");
1951		return ret;
1952	}
1953	ret = rv770_init_smc_table(rdev, boot_ps);
1954	if (ret) {
1955		DRM_ERROR("rv770_init_smc_table failed\n");
1956		return ret;
1957	}
1958
1959	rv770_program_response_times(rdev);
1960	r7xx_start_smc(rdev);
1961
1962	if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
1963		rv730_start_dpm(rdev);
1964	else
1965		rv770_start_dpm(rdev);
1966
1967	if (pi->gfx_clock_gating)
1968		rv770_gfx_clock_gating_enable(rdev, true);
1969
1970	if (pi->mg_clock_gating)
1971		rv770_mg_clock_gating_enable(rdev, true);
1972
1973	rv770_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, true);
1974
1975	return 0;
1976}
1977
1978int rv770_dpm_late_enable(struct radeon_device *rdev)
1979{
1980	int ret;
1981
1982	if (rdev->irq.installed &&
1983	    r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
1984		PPSMC_Result result;
1985
1986		ret = rv770_set_thermal_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
1987		if (ret)
1988			return ret;
1989		rdev->irq.dpm_thermal = true;
1990		radeon_irq_set(rdev);
1991		result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_EnableThermalInterrupt);
1992
1993		if (result != PPSMC_Result_OK)
1994			DRM_DEBUG_KMS("Could not enable thermal interrupts.\n");
1995	}
1996
1997	return 0;
1998}
1999
2000void rv770_dpm_disable(struct radeon_device *rdev)
2001{
2002	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
2003
2004	if (!rv770_dpm_enabled(rdev))
2005		return;
2006
2007	rv770_clear_vc(rdev);
2008
2009	if (pi->thermal_protection)
2010		rv770_enable_thermal_protection(rdev, false);
2011
2012	rv770_enable_spread_spectrum(rdev, false);
2013
2014	if (pi->dynamic_pcie_gen2)
2015		rv770_enable_dynamic_pcie_gen2(rdev, false);
2016
2017	if (rdev->irq.installed &&
2018	    r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
2019		rdev->irq.dpm_thermal = false;
2020		radeon_irq_set(rdev);
2021	}
2022
2023	if (pi->gfx_clock_gating)
2024		rv770_gfx_clock_gating_enable(rdev, false);
2025
2026	if (pi->mg_clock_gating)
2027		rv770_mg_clock_gating_enable(rdev, false);
2028
2029	if ((rdev->family == CHIP_RV730) || (rdev->family == CHIP_RV710))
2030		rv730_stop_dpm(rdev);
2031	else
2032		rv770_stop_dpm(rdev);
2033
2034	r7xx_stop_smc(rdev);
2035	rv770_reset_smio_status(rdev);
2036}
2037
2038int rv770_dpm_set_power_state(struct radeon_device *rdev)
2039{
2040	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
2041	struct radeon_ps *new_ps = rdev->pm.dpm.requested_ps;
2042	struct radeon_ps *old_ps = rdev->pm.dpm.current_ps;
2043	int ret;
2044
2045	ret = rv770_restrict_performance_levels_before_switch(rdev);
2046	if (ret) {
2047		DRM_ERROR("rv770_restrict_performance_levels_before_switch failed\n");
2048		return ret;
2049	}
2050	rv770_set_uvd_clock_before_set_eng_clock(rdev, new_ps, old_ps);
2051	ret = rv770_halt_smc(rdev);
2052	if (ret) {
2053		DRM_ERROR("rv770_halt_smc failed\n");
2054		return ret;
2055	}
2056	ret = rv770_upload_sw_state(rdev, new_ps);
2057	if (ret) {
2058		DRM_ERROR("rv770_upload_sw_state failed\n");
2059		return ret;
2060	}
2061	r7xx_program_memory_timing_parameters(rdev, new_ps);
2062	if (pi->dcodt)
2063		rv770_program_dcodt_before_state_switch(rdev, new_ps, old_ps);
2064	ret = rv770_resume_smc(rdev);
2065	if (ret) {
2066		DRM_ERROR("rv770_resume_smc failed\n");
2067		return ret;
2068	}
2069	ret = rv770_set_sw_state(rdev);
2070	if (ret) {
2071		DRM_ERROR("rv770_set_sw_state failed\n");
2072		return ret;
2073	}
2074	if (pi->dcodt)
2075		rv770_program_dcodt_after_state_switch(rdev, new_ps, old_ps);
2076	rv770_set_uvd_clock_after_set_eng_clock(rdev, new_ps, old_ps);
2077
2078	return 0;
2079}
2080
2081#if 0
2082void rv770_dpm_reset_asic(struct radeon_device *rdev)
2083{
2084	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
2085	struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
2086
2087	rv770_restrict_performance_levels_before_switch(rdev);
2088	if (pi->dcodt)
2089		rv770_program_dcodt_before_state_switch(rdev, boot_ps, boot_ps);
2090	rv770_set_boot_state(rdev);
2091	if (pi->dcodt)
2092		rv770_program_dcodt_after_state_switch(rdev, boot_ps, boot_ps);
2093}
2094#endif
2095
2096void rv770_dpm_setup_asic(struct radeon_device *rdev)
2097{
2098	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
2099
2100	r7xx_read_clock_registers(rdev);
2101	rv770_read_voltage_smio_registers(rdev);
2102	rv770_get_memory_type(rdev);
2103	if (pi->dcodt)
2104		rv770_get_mclk_odt_threshold(rdev);
2105	rv770_get_pcie_gen2_status(rdev);
2106
2107	rv770_enable_acpi_pm(rdev);
2108
2109	if (radeon_aspm != 0) {
2110		if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L0s)
2111			rv770_enable_l0s(rdev);
2112		if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L1)
2113			rv770_enable_l1(rdev);
2114		if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_TURNOFFPLL_ASPML1)
2115			rv770_enable_pll_sleep_in_l1(rdev);
2116	}
2117}
2118
2119void rv770_dpm_display_configuration_changed(struct radeon_device *rdev)
2120{
2121	rv770_program_display_gap(rdev);
2122}
2123
2124union power_info {
2125	struct _ATOM_POWERPLAY_INFO info;
2126	struct _ATOM_POWERPLAY_INFO_V2 info_2;
2127	struct _ATOM_POWERPLAY_INFO_V3 info_3;
2128	struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
2129	struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
2130	struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
2131};
2132
2133union pplib_clock_info {
2134	struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
2135	struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
2136	struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
2137	struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
2138};
2139
2140union pplib_power_state {
2141	struct _ATOM_PPLIB_STATE v1;
2142	struct _ATOM_PPLIB_STATE_V2 v2;
2143};
2144
2145static void rv7xx_parse_pplib_non_clock_info(struct radeon_device *rdev,
2146					     struct radeon_ps *rps,
2147					     struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
2148					     u8 table_rev)
2149{
2150	rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
2151	rps->class = le16_to_cpu(non_clock_info->usClassification);
2152	rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
2153
2154	if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
2155		rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
2156		rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
2157	} else {
2158		rps->vclk = 0;
2159		rps->dclk = 0;
2160	}
2161
2162	if (r600_is_uvd_state(rps->class, rps->class2)) {
2163		if ((rps->vclk == 0) || (rps->dclk == 0)) {
2164			rps->vclk = RV770_DEFAULT_VCLK_FREQ;
2165			rps->dclk = RV770_DEFAULT_DCLK_FREQ;
2166		}
2167	}
2168
2169	if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT)
2170		rdev->pm.dpm.boot_ps = rps;
2171	if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
2172		rdev->pm.dpm.uvd_ps = rps;
2173}
2174
2175static void rv7xx_parse_pplib_clock_info(struct radeon_device *rdev,
2176					 struct radeon_ps *rps, int index,
2177					 union pplib_clock_info *clock_info)
2178{
2179	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
2180	struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
2181	struct rv7xx_ps *ps = rv770_get_ps(rps);
2182	u32 sclk, mclk;
2183	struct rv7xx_pl *pl;
2184
2185	switch (index) {
2186	case 0:
2187		pl = &ps->low;
2188		break;
2189	case 1:
2190		pl = &ps->medium;
2191		break;
2192	case 2:
2193	default:
2194		pl = &ps->high;
2195		break;
2196	}
2197
2198	if (rdev->family >= CHIP_CEDAR) {
2199		sclk = le16_to_cpu(clock_info->evergreen.usEngineClockLow);
2200		sclk |= clock_info->evergreen.ucEngineClockHigh << 16;
2201		mclk = le16_to_cpu(clock_info->evergreen.usMemoryClockLow);
2202		mclk |= clock_info->evergreen.ucMemoryClockHigh << 16;
2203
2204		pl->vddc = le16_to_cpu(clock_info->evergreen.usVDDC);
2205		pl->vddci = le16_to_cpu(clock_info->evergreen.usVDDCI);
2206		pl->flags = le32_to_cpu(clock_info->evergreen.ulFlags);
2207	} else {
2208		sclk = le16_to_cpu(clock_info->r600.usEngineClockLow);
2209		sclk |= clock_info->r600.ucEngineClockHigh << 16;
2210		mclk = le16_to_cpu(clock_info->r600.usMemoryClockLow);
2211		mclk |= clock_info->r600.ucMemoryClockHigh << 16;
2212
2213		pl->vddc = le16_to_cpu(clock_info->r600.usVDDC);
2214		pl->flags = le32_to_cpu(clock_info->r600.ulFlags);
2215	}
2216
2217	pl->mclk = mclk;
2218	pl->sclk = sclk;
2219
2220	/* patch up vddc if necessary */
2221	if (pl->vddc == 0xff01) {
2222		if (pi->max_vddc)
2223			pl->vddc = pi->max_vddc;
2224	}
2225
2226	if (rps->class & ATOM_PPLIB_CLASSIFICATION_ACPI) {
2227		pi->acpi_vddc = pl->vddc;
2228		if (rdev->family >= CHIP_CEDAR)
2229			eg_pi->acpi_vddci = pl->vddci;
2230		if (ps->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2)
2231			pi->acpi_pcie_gen2 = true;
2232		else
2233			pi->acpi_pcie_gen2 = false;
2234	}
2235
2236	if (rps->class2 & ATOM_PPLIB_CLASSIFICATION2_ULV) {
2237		if (rdev->family >= CHIP_BARTS) {
2238			eg_pi->ulv.supported = true;
2239			eg_pi->ulv.pl = pl;
2240		}
2241	}
2242
2243	if (pi->min_vddc_in_table > pl->vddc)
2244		pi->min_vddc_in_table = pl->vddc;
2245
2246	if (pi->max_vddc_in_table < pl->vddc)
2247		pi->max_vddc_in_table = pl->vddc;
2248
2249	/* patch up boot state */
2250	if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
2251		u16 vddc, vddci, mvdd;
2252		radeon_atombios_get_default_voltages(rdev, &vddc, &vddci, &mvdd);
2253		pl->mclk = rdev->clock.default_mclk;
2254		pl->sclk = rdev->clock.default_sclk;
2255		pl->vddc = vddc;
2256		pl->vddci = vddci;
2257	}
2258
2259	if ((rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) ==
2260	    ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE) {
2261		rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.sclk = pl->sclk;
2262		rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.mclk = pl->mclk;
2263		rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddc = pl->vddc;
2264		rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddci = pl->vddci;
2265	}
2266}
2267
2268int rv7xx_parse_power_table(struct radeon_device *rdev)
2269{
2270	struct radeon_mode_info *mode_info = &rdev->mode_info;
2271	struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
2272	union pplib_power_state *power_state;
2273	int i, j;
2274	union pplib_clock_info *clock_info;
2275	union power_info *power_info;
2276	int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
2277	u16 data_offset;
2278	u8 frev, crev;
2279	struct rv7xx_ps *ps;
2280
2281	if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
2282				   &frev, &crev, &data_offset))
2283		return -EINVAL;
2284	power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
2285
2286	rdev->pm.dpm.ps = kcalloc(power_info->pplib.ucNumStates,
2287				  sizeof(struct radeon_ps),
2288				  GFP_KERNEL);
2289	if (!rdev->pm.dpm.ps)
2290		return -ENOMEM;
2291
2292	for (i = 0; i < power_info->pplib.ucNumStates; i++) {
2293		power_state = (union pplib_power_state *)
2294			(mode_info->atom_context->bios + data_offset +
2295			 le16_to_cpu(power_info->pplib.usStateArrayOffset) +
2296			 i * power_info->pplib.ucStateEntrySize);
2297		non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
2298			(mode_info->atom_context->bios + data_offset +
2299			 le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset) +
2300			 (power_state->v1.ucNonClockStateIndex *
2301			  power_info->pplib.ucNonClockSize));
2302		if (power_info->pplib.ucStateEntrySize - 1) {
2303			u8 *idx;
2304			ps = kzalloc(sizeof(struct rv7xx_ps), GFP_KERNEL);
2305			if (ps == NULL) {
2306				kfree(rdev->pm.dpm.ps);
2307				return -ENOMEM;
2308			}
2309			rdev->pm.dpm.ps[i].ps_priv = ps;
2310			rv7xx_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
2311							 non_clock_info,
2312							 power_info->pplib.ucNonClockSize);
2313			idx = (u8 *)&power_state->v1.ucClockStateIndices[0];
2314			for (j = 0; j < (power_info->pplib.ucStateEntrySize - 1); j++) {
2315				clock_info = (union pplib_clock_info *)
2316					(mode_info->atom_context->bios + data_offset +
2317					 le16_to_cpu(power_info->pplib.usClockInfoArrayOffset) +
2318					 (idx[j] * power_info->pplib.ucClockInfoSize));
2319				rv7xx_parse_pplib_clock_info(rdev,
2320							     &rdev->pm.dpm.ps[i], j,
2321							     clock_info);
2322			}
2323		}
2324	}
2325	rdev->pm.dpm.num_ps = power_info->pplib.ucNumStates;
2326	return 0;
2327}
2328
2329void rv770_get_engine_memory_ss(struct radeon_device *rdev)
2330{
2331	struct rv7xx_power_info *pi = rv770_get_pi(rdev);
2332	struct radeon_atom_ss ss;
2333
2334	pi->sclk_ss = radeon_atombios_get_asic_ss_info(rdev, &ss,
2335						       ASIC_INTERNAL_ENGINE_SS, 0);
2336	pi->mclk_ss = radeon_atombios_get_asic_ss_info(rdev, &ss,
2337						       ASIC_INTERNAL_MEMORY_SS, 0);
2338
2339	if (pi->sclk_ss || pi->mclk_ss)
2340		pi->dynamic_ss = true;
2341	else
2342		pi->dynamic_ss = false;
2343}
2344
2345int rv770_dpm_init(struct radeon_device *rdev)
2346{
2347	struct rv7xx_power_info *pi;
2348	struct atom_clock_dividers dividers;
2349	int ret;
2350
2351	pi = kzalloc(sizeof(struct rv7xx_power_info), GFP_KERNEL);
2352	if (pi == NULL)
2353		return -ENOMEM;
2354	rdev->pm.dpm.priv = pi;
2355
2356	rv770_get_max_vddc(rdev);
2357
2358	pi->acpi_vddc = 0;
2359	pi->min_vddc_in_table = 0;
2360	pi->max_vddc_in_table = 0;
2361
2362	ret = r600_get_platform_caps(rdev);
2363	if (ret)
2364		return ret;
2365
2366	ret = rv7xx_parse_power_table(rdev);
2367	if (ret)
2368		return ret;
2369
2370	if (rdev->pm.dpm.voltage_response_time == 0)
2371		rdev->pm.dpm.voltage_response_time = R600_VOLTAGERESPONSETIME_DFLT;
2372	if (rdev->pm.dpm.backbias_response_time == 0)
2373		rdev->pm.dpm.backbias_response_time = R600_BACKBIASRESPONSETIME_DFLT;
2374
2375	ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
2376					     0, false, &dividers);
2377	if (ret)
2378		pi->ref_div = dividers.ref_div + 1;
2379	else
2380		pi->ref_div = R600_REFERENCEDIVIDER_DFLT;
2381
2382	pi->mclk_strobe_mode_threshold = 30000;
2383	pi->mclk_edc_enable_threshold = 30000;
2384
2385	pi->rlp = RV770_RLP_DFLT;
2386	pi->rmp = RV770_RMP_DFLT;
2387	pi->lhp = RV770_LHP_DFLT;
2388	pi->lmp = RV770_LMP_DFLT;
2389
2390	pi->voltage_control =
2391		radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, 0);
2392
2393	pi->mvdd_control =
2394		radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_MVDDC, 0);
2395
2396	rv770_get_engine_memory_ss(rdev);
2397
2398	pi->asi = RV770_ASI_DFLT;
2399	pi->pasi = RV770_HASI_DFLT;
2400	pi->vrc = RV770_VRC_DFLT;
2401
2402	pi->power_gating = false;
2403
2404	pi->gfx_clock_gating = true;
2405
2406	pi->mg_clock_gating = true;
2407	pi->mgcgtssm = true;
2408
2409	pi->dynamic_pcie_gen2 = true;
2410
2411	if (rdev->pm.int_thermal_type != THERMAL_TYPE_NONE)
2412		pi->thermal_protection = true;
2413	else
2414		pi->thermal_protection = false;
2415
2416	pi->display_gap = true;
2417
2418	if (rdev->flags & RADEON_IS_MOBILITY)
2419		pi->dcodt = true;
2420	else
2421		pi->dcodt = false;
2422
2423	pi->ulps = true;
2424
2425	pi->mclk_stutter_mode_threshold = 0;
2426
2427	pi->sram_end = SMC_RAM_END;
2428	pi->state_table_start = RV770_SMC_TABLE_ADDRESS;
2429	pi->soft_regs_start = RV770_SMC_SOFT_REGISTERS_START;
2430
2431	return 0;
2432}
2433
2434void rv770_dpm_print_power_state(struct radeon_device *rdev,
2435				 struct radeon_ps *rps)
2436{
2437	struct rv7xx_ps *ps = rv770_get_ps(rps);
2438	struct rv7xx_pl *pl;
2439
2440	r600_dpm_print_class_info(rps->class, rps->class2);
2441	r600_dpm_print_cap_info(rps->caps);
2442	printk("\tuvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
2443	if (rdev->family >= CHIP_CEDAR) {
2444		pl = &ps->low;
2445		printk("\t\tpower level 0    sclk: %u mclk: %u vddc: %u vddci: %u\n",
2446		       pl->sclk, pl->mclk, pl->vddc, pl->vddci);
2447		pl = &ps->medium;
2448		printk("\t\tpower level 1    sclk: %u mclk: %u vddc: %u vddci: %u\n",
2449		       pl->sclk, pl->mclk, pl->vddc, pl->vddci);
2450		pl = &ps->high;
2451		printk("\t\tpower level 2    sclk: %u mclk: %u vddc: %u vddci: %u\n",
2452		       pl->sclk, pl->mclk, pl->vddc, pl->vddci);
2453	} else {
2454		pl = &ps->low;
2455		printk("\t\tpower level 0    sclk: %u mclk: %u vddc: %u\n",
2456		       pl->sclk, pl->mclk, pl->vddc);
2457		pl = &ps->medium;
2458		printk("\t\tpower level 1    sclk: %u mclk: %u vddc: %u\n",
2459		       pl->sclk, pl->mclk, pl->vddc);
2460		pl = &ps->high;
2461		printk("\t\tpower level 2    sclk: %u mclk: %u vddc: %u\n",
2462		       pl->sclk, pl->mclk, pl->vddc);
2463	}
2464	r600_dpm_print_ps_status(rdev, rps);
2465}
2466
2467void rv770_dpm_debugfs_print_current_performance_level(struct radeon_device *rdev,
2468						       struct seq_file *m)
2469{
2470	struct radeon_ps *rps = rdev->pm.dpm.current_ps;
2471	struct rv7xx_ps *ps = rv770_get_ps(rps);
2472	struct rv7xx_pl *pl;
2473	u32 current_index =
2474		(RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_PROFILE_INDEX_MASK) >>
2475		CURRENT_PROFILE_INDEX_SHIFT;
2476
2477	if (current_index > 2) {
2478		seq_printf(m, "invalid dpm profile %d\n", current_index);
2479	} else {
2480		if (current_index == 0)
2481			pl = &ps->low;
2482		else if (current_index == 1)
2483			pl = &ps->medium;
2484		else /* current_index == 2 */
2485			pl = &ps->high;
2486		seq_printf(m, "uvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
2487		if (rdev->family >= CHIP_CEDAR) {
2488			seq_printf(m, "power level %d    sclk: %u mclk: %u vddc: %u vddci: %u\n",
2489				   current_index, pl->sclk, pl->mclk, pl->vddc, pl->vddci);
2490		} else {
2491			seq_printf(m, "power level %d    sclk: %u mclk: %u vddc: %u\n",
2492				   current_index, pl->sclk, pl->mclk, pl->vddc);
2493		}
2494	}
2495}
2496
2497u32 rv770_dpm_get_current_sclk(struct radeon_device *rdev)
2498{
2499	struct radeon_ps *rps = rdev->pm.dpm.current_ps;
2500	struct rv7xx_ps *ps = rv770_get_ps(rps);
2501	struct rv7xx_pl *pl;
2502	u32 current_index =
2503		(RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_PROFILE_INDEX_MASK) >>
2504		CURRENT_PROFILE_INDEX_SHIFT;
2505
2506	if (current_index > 2) {
2507		return 0;
2508	} else {
2509		if (current_index == 0)
2510			pl = &ps->low;
2511		else if (current_index == 1)
2512			pl = &ps->medium;
2513		else /* current_index == 2 */
2514			pl = &ps->high;
2515		return  pl->sclk;
2516	}
2517}
2518
2519u32 rv770_dpm_get_current_mclk(struct radeon_device *rdev)
2520{
2521	struct radeon_ps *rps = rdev->pm.dpm.current_ps;
2522	struct rv7xx_ps *ps = rv770_get_ps(rps);
2523	struct rv7xx_pl *pl;
2524	u32 current_index =
2525		(RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_PROFILE_INDEX_MASK) >>
2526		CURRENT_PROFILE_INDEX_SHIFT;
2527
2528	if (current_index > 2) {
2529		return 0;
2530	} else {
2531		if (current_index == 0)
2532			pl = &ps->low;
2533		else if (current_index == 1)
2534			pl = &ps->medium;
2535		else /* current_index == 2 */
2536			pl = &ps->high;
2537		return  pl->mclk;
2538	}
2539}
2540
2541void rv770_dpm_fini(struct radeon_device *rdev)
2542{
2543	int i;
2544
2545	for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
2546		kfree(rdev->pm.dpm.ps[i].ps_priv);
2547	}
2548	kfree(rdev->pm.dpm.ps);
2549	kfree(rdev->pm.dpm.priv);
2550}
2551
2552u32 rv770_dpm_get_sclk(struct radeon_device *rdev, bool low)
2553{
2554	struct rv7xx_ps *requested_state = rv770_get_ps(rdev->pm.dpm.requested_ps);
2555
2556	if (low)
2557		return requested_state->low.sclk;
2558	else
2559		return requested_state->high.sclk;
2560}
2561
2562u32 rv770_dpm_get_mclk(struct radeon_device *rdev, bool low)
2563{
2564	struct rv7xx_ps *requested_state = rv770_get_ps(rdev->pm.dpm.requested_ps);
2565
2566	if (low)
2567		return requested_state->low.mclk;
2568	else
2569		return requested_state->high.mclk;
2570}
2571
2572bool rv770_dpm_vblank_too_short(struct radeon_device *rdev)
2573{
2574	u32 vblank_time = r600_dpm_get_vblank_time(rdev);
2575	u32 switch_limit = 200; /* 300 */
2576
2577	/* RV770 */
2578	/* mclk switching doesn't seem to work reliably on desktop RV770s */
2579	if ((rdev->family == CHIP_RV770) &&
2580	    !(rdev->flags & RADEON_IS_MOBILITY))
2581		switch_limit = 0xffffffff; /* disable mclk switching */
2582
2583	if (vblank_time < switch_limit)
2584		return true;
2585	else
2586		return false;
2587
2588}