Linux Audio

Check our new training course

Loading...
v4.6
   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 "drmP.h"
  26#include "radeon.h"
  27#include "radeon_asic.h"
  28#include "r600d.h"
  29#include "r600_dpm.h"
  30#include "atom.h"
  31
  32const u32 r600_utc[R600_PM_NUMBER_OF_TC] =
  33{
  34	R600_UTC_DFLT_00,
  35	R600_UTC_DFLT_01,
  36	R600_UTC_DFLT_02,
  37	R600_UTC_DFLT_03,
  38	R600_UTC_DFLT_04,
  39	R600_UTC_DFLT_05,
  40	R600_UTC_DFLT_06,
  41	R600_UTC_DFLT_07,
  42	R600_UTC_DFLT_08,
  43	R600_UTC_DFLT_09,
  44	R600_UTC_DFLT_10,
  45	R600_UTC_DFLT_11,
  46	R600_UTC_DFLT_12,
  47	R600_UTC_DFLT_13,
  48	R600_UTC_DFLT_14,
  49};
  50
  51const u32 r600_dtc[R600_PM_NUMBER_OF_TC] =
  52{
  53	R600_DTC_DFLT_00,
  54	R600_DTC_DFLT_01,
  55	R600_DTC_DFLT_02,
  56	R600_DTC_DFLT_03,
  57	R600_DTC_DFLT_04,
  58	R600_DTC_DFLT_05,
  59	R600_DTC_DFLT_06,
  60	R600_DTC_DFLT_07,
  61	R600_DTC_DFLT_08,
  62	R600_DTC_DFLT_09,
  63	R600_DTC_DFLT_10,
  64	R600_DTC_DFLT_11,
  65	R600_DTC_DFLT_12,
  66	R600_DTC_DFLT_13,
  67	R600_DTC_DFLT_14,
  68};
  69
  70void r600_dpm_print_class_info(u32 class, u32 class2)
  71{
  72	printk("\tui class: ");
 
  73	switch (class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) {
  74	case ATOM_PPLIB_CLASSIFICATION_UI_NONE:
  75	default:
  76		printk("none\n");
  77		break;
  78	case ATOM_PPLIB_CLASSIFICATION_UI_BATTERY:
  79		printk("battery\n");
  80		break;
  81	case ATOM_PPLIB_CLASSIFICATION_UI_BALANCED:
  82		printk("balanced\n");
  83		break;
  84	case ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE:
  85		printk("performance\n");
  86		break;
  87	}
  88	printk("\tinternal class: ");
 
 
  89	if (((class & ~ATOM_PPLIB_CLASSIFICATION_UI_MASK) == 0) &&
  90	    (class2 == 0))
  91		printk("none");
  92	else {
  93		if (class & ATOM_PPLIB_CLASSIFICATION_BOOT)
  94			printk("boot ");
  95		if (class & ATOM_PPLIB_CLASSIFICATION_THERMAL)
  96			printk("thermal ");
  97		if (class & ATOM_PPLIB_CLASSIFICATION_LIMITEDPOWERSOURCE)
  98			printk("limited_pwr ");
  99		if (class & ATOM_PPLIB_CLASSIFICATION_REST)
 100			printk("rest ");
 101		if (class & ATOM_PPLIB_CLASSIFICATION_FORCED)
 102			printk("forced ");
 103		if (class & ATOM_PPLIB_CLASSIFICATION_3DPERFORMANCE)
 104			printk("3d_perf ");
 105		if (class & ATOM_PPLIB_CLASSIFICATION_OVERDRIVETEMPLATE)
 106			printk("ovrdrv ");
 107		if (class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
 108			printk("uvd ");
 109		if (class & ATOM_PPLIB_CLASSIFICATION_3DLOW)
 110			printk("3d_low ");
 111		if (class & ATOM_PPLIB_CLASSIFICATION_ACPI)
 112			printk("acpi ");
 113		if (class & ATOM_PPLIB_CLASSIFICATION_HD2STATE)
 114			printk("uvd_hd2 ");
 115		if (class & ATOM_PPLIB_CLASSIFICATION_HDSTATE)
 116			printk("uvd_hd ");
 117		if (class & ATOM_PPLIB_CLASSIFICATION_SDSTATE)
 118			printk("uvd_sd ");
 119		if (class2 & ATOM_PPLIB_CLASSIFICATION2_LIMITEDPOWERSOURCE_2)
 120			printk("limited_pwr2 ");
 121		if (class2 & ATOM_PPLIB_CLASSIFICATION2_ULV)
 122			printk("ulv ");
 123		if (class2 & ATOM_PPLIB_CLASSIFICATION2_MVC)
 124			printk("uvd_mvc ");
 125	}
 126	printk("\n");
 127}
 128
 129void r600_dpm_print_cap_info(u32 caps)
 130{
 131	printk("\tcaps: ");
 132	if (caps & ATOM_PPLIB_SINGLE_DISPLAY_ONLY)
 133		printk("single_disp ");
 134	if (caps & ATOM_PPLIB_SUPPORTS_VIDEO_PLAYBACK)
 135		printk("video ");
 136	if (caps & ATOM_PPLIB_DISALLOW_ON_DC)
 137		printk("no_dc ");
 138	printk("\n");
 139}
 140
 141void r600_dpm_print_ps_status(struct radeon_device *rdev,
 142			      struct radeon_ps *rps)
 143{
 144	printk("\tstatus: ");
 145	if (rps == rdev->pm.dpm.current_ps)
 146		printk("c ");
 147	if (rps == rdev->pm.dpm.requested_ps)
 148		printk("r ");
 149	if (rps == rdev->pm.dpm.boot_ps)
 150		printk("b ");
 151	printk("\n");
 152}
 153
 154u32 r600_dpm_get_vblank_time(struct radeon_device *rdev)
 155{
 156	struct drm_device *dev = rdev->ddev;
 157	struct drm_crtc *crtc;
 158	struct radeon_crtc *radeon_crtc;
 159	u32 line_time_us, vblank_lines;
 160	u32 vblank_time_us = 0xffffffff; /* if the displays are off, vblank time is max */
 161
 162	if (rdev->num_crtc && rdev->mode_info.mode_config_initialized) {
 163		list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 164			radeon_crtc = to_radeon_crtc(crtc);
 165			if (crtc->enabled && radeon_crtc->enabled && radeon_crtc->hw_mode.clock) {
 166				line_time_us = (radeon_crtc->hw_mode.crtc_htotal * 1000) /
 167					radeon_crtc->hw_mode.clock;
 168				vblank_lines = radeon_crtc->hw_mode.crtc_vblank_end -
 169					radeon_crtc->hw_mode.crtc_vdisplay +
 170					(radeon_crtc->v_border * 2);
 171				vblank_time_us = vblank_lines * line_time_us;
 
 172				break;
 173			}
 174		}
 175	}
 176
 177	return vblank_time_us;
 178}
 179
 180u32 r600_dpm_get_vrefresh(struct radeon_device *rdev)
 181{
 182	struct drm_device *dev = rdev->ddev;
 183	struct drm_crtc *crtc;
 184	struct radeon_crtc *radeon_crtc;
 185	u32 vrefresh = 0;
 186
 187	if (rdev->num_crtc && rdev->mode_info.mode_config_initialized) {
 188		list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 189			radeon_crtc = to_radeon_crtc(crtc);
 190			if (crtc->enabled && radeon_crtc->enabled && radeon_crtc->hw_mode.clock) {
 191				vrefresh = drm_mode_vrefresh(&radeon_crtc->hw_mode);
 192				break;
 193			}
 194		}
 195	}
 196	return vrefresh;
 197}
 198
 199void r600_calculate_u_and_p(u32 i, u32 r_c, u32 p_b,
 200			    u32 *p, u32 *u)
 201{
 202	u32 b_c = 0;
 203	u32 i_c;
 204	u32 tmp;
 205
 206	i_c = (i * r_c) / 100;
 207	tmp = i_c >> p_b;
 208
 209	while (tmp) {
 210		b_c++;
 211		tmp >>= 1;
 212	}
 213
 214	*u = (b_c + 1) / 2;
 215	*p = i_c / (1 << (2 * (*u)));
 216}
 217
 218int r600_calculate_at(u32 t, u32 h, u32 fh, u32 fl, u32 *tl, u32 *th)
 219{
 220	u32 k, a, ah, al;
 221	u32 t1;
 222
 223	if ((fl == 0) || (fh == 0) || (fl > fh))
 224		return -EINVAL;
 225
 226	k = (100 * fh) / fl;
 227	t1 = (t * (k - 100));
 228	a = (1000 * (100 * h + t1)) / (10000 + (t1 / 100));
 229	a = (a + 5) / 10;
 230	ah = ((a * t) + 5000) / 10000;
 231	al = a - ah;
 232
 233	*th = t - ah;
 234	*tl = t + al;
 235
 236	return 0;
 237}
 238
 239void r600_gfx_clockgating_enable(struct radeon_device *rdev, bool enable)
 240{
 241	int i;
 242
 243	if (enable) {
 244		WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
 245	} else {
 246		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
 247
 248		WREG32(CG_RLC_REQ_AND_RSP, 0x2);
 249
 250		for (i = 0; i < rdev->usec_timeout; i++) {
 251			if (((RREG32(CG_RLC_REQ_AND_RSP) & CG_RLC_RSP_TYPE_MASK) >> CG_RLC_RSP_TYPE_SHIFT) == 1)
 252				break;
 253			udelay(1);
 254		}
 255
 256		WREG32(CG_RLC_REQ_AND_RSP, 0x0);
 257
 258		WREG32(GRBM_PWR_CNTL, 0x1);
 259		RREG32(GRBM_PWR_CNTL);
 260	}
 261}
 262
 263void r600_dynamicpm_enable(struct radeon_device *rdev, bool enable)
 264{
 265	if (enable)
 266		WREG32_P(GENERAL_PWRMGT, GLOBAL_PWRMGT_EN, ~GLOBAL_PWRMGT_EN);
 267	else
 268		WREG32_P(GENERAL_PWRMGT, 0, ~GLOBAL_PWRMGT_EN);
 269}
 270
 271void r600_enable_thermal_protection(struct radeon_device *rdev, bool enable)
 272{
 273	if (enable)
 274		WREG32_P(GENERAL_PWRMGT, 0, ~THERMAL_PROTECTION_DIS);
 275	else
 276		WREG32_P(GENERAL_PWRMGT, THERMAL_PROTECTION_DIS, ~THERMAL_PROTECTION_DIS);
 277}
 278
 279void r600_enable_acpi_pm(struct radeon_device *rdev)
 280{
 281	WREG32_P(GENERAL_PWRMGT, STATIC_PM_EN, ~STATIC_PM_EN);
 282}
 283
 284void r600_enable_dynamic_pcie_gen2(struct radeon_device *rdev, bool enable)
 285{
 286	if (enable)
 287		WREG32_P(GENERAL_PWRMGT, ENABLE_GEN2PCIE, ~ENABLE_GEN2PCIE);
 288	else
 289		WREG32_P(GENERAL_PWRMGT, 0, ~ENABLE_GEN2PCIE);
 290}
 291
 292bool r600_dynamicpm_enabled(struct radeon_device *rdev)
 293{
 294	if (RREG32(GENERAL_PWRMGT) & GLOBAL_PWRMGT_EN)
 295		return true;
 296	else
 297		return false;
 298}
 299
 300void r600_enable_sclk_control(struct radeon_device *rdev, bool enable)
 301{
 302	if (enable)
 303		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~SCLK_PWRMGT_OFF);
 304	else
 305		WREG32_P(SCLK_PWRMGT_CNTL, SCLK_PWRMGT_OFF, ~SCLK_PWRMGT_OFF);
 306}
 307
 308void r600_enable_mclk_control(struct radeon_device *rdev, bool enable)
 309{
 310	if (enable)
 311		WREG32_P(MCLK_PWRMGT_CNTL, 0, ~MPLL_PWRMGT_OFF);
 312	else
 313		WREG32_P(MCLK_PWRMGT_CNTL, MPLL_PWRMGT_OFF, ~MPLL_PWRMGT_OFF);
 314}
 315
 316void r600_enable_spll_bypass(struct radeon_device *rdev, bool enable)
 317{
 318	if (enable)
 319		WREG32_P(CG_SPLL_FUNC_CNTL, SPLL_BYPASS_EN, ~SPLL_BYPASS_EN);
 320	else
 321		WREG32_P(CG_SPLL_FUNC_CNTL, 0, ~SPLL_BYPASS_EN);
 322}
 323
 324void r600_wait_for_spll_change(struct radeon_device *rdev)
 325{
 326	int i;
 327
 328	for (i = 0; i < rdev->usec_timeout; i++) {
 329		if (RREG32(CG_SPLL_FUNC_CNTL) & SPLL_CHG_STATUS)
 330			break;
 331		udelay(1);
 332	}
 333}
 334
 335void r600_set_bsp(struct radeon_device *rdev, u32 u, u32 p)
 336{
 337	WREG32(CG_BSP, BSP(p) | BSU(u));
 338}
 339
 340void r600_set_at(struct radeon_device *rdev,
 341		 u32 l_to_m, u32 m_to_h,
 342		 u32 h_to_m, u32 m_to_l)
 343{
 344	WREG32(CG_RT, FLS(l_to_m) | FMS(m_to_h));
 345	WREG32(CG_LT, FHS(h_to_m) | FMS(m_to_l));
 346}
 347
 348void r600_set_tc(struct radeon_device *rdev,
 349		 u32 index, u32 u_t, u32 d_t)
 350{
 351	WREG32(CG_FFCT_0 + (index * 4), UTC_0(u_t) | DTC_0(d_t));
 352}
 353
 354void r600_select_td(struct radeon_device *rdev,
 355		    enum r600_td td)
 356{
 357	if (td == R600_TD_AUTO)
 358		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_FORCE_TREND_SEL);
 359	else
 360		WREG32_P(SCLK_PWRMGT_CNTL, FIR_FORCE_TREND_SEL, ~FIR_FORCE_TREND_SEL);
 361	if (td == R600_TD_UP)
 362		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_TREND_MODE);
 363	if (td == R600_TD_DOWN)
 364		WREG32_P(SCLK_PWRMGT_CNTL, FIR_TREND_MODE, ~FIR_TREND_MODE);
 365}
 366
 367void r600_set_vrc(struct radeon_device *rdev, u32 vrv)
 368{
 369	WREG32(CG_FTV, vrv);
 370}
 371
 372void r600_set_tpu(struct radeon_device *rdev, u32 u)
 373{
 374	WREG32_P(CG_TPC, TPU(u), ~TPU_MASK);
 375}
 376
 377void r600_set_tpc(struct radeon_device *rdev, u32 c)
 378{
 379	WREG32_P(CG_TPC, TPCC(c), ~TPCC_MASK);
 380}
 381
 382void r600_set_sstu(struct radeon_device *rdev, u32 u)
 383{
 384	WREG32_P(CG_SSP, CG_SSTU(u), ~CG_SSTU_MASK);
 385}
 386
 387void r600_set_sst(struct radeon_device *rdev, u32 t)
 388{
 389	WREG32_P(CG_SSP, CG_SST(t), ~CG_SST_MASK);
 390}
 391
 392void r600_set_git(struct radeon_device *rdev, u32 t)
 393{
 394	WREG32_P(CG_GIT, CG_GICST(t), ~CG_GICST_MASK);
 395}
 396
 397void r600_set_fctu(struct radeon_device *rdev, u32 u)
 398{
 399	WREG32_P(CG_FC_T, FC_TU(u), ~FC_TU_MASK);
 400}
 401
 402void r600_set_fct(struct radeon_device *rdev, u32 t)
 403{
 404	WREG32_P(CG_FC_T, FC_T(t), ~FC_T_MASK);
 405}
 406
 407void r600_set_ctxcgtt3d_rphc(struct radeon_device *rdev, u32 p)
 408{
 409	WREG32_P(CG_CTX_CGTT3D_R, PHC(p), ~PHC_MASK);
 410}
 411
 412void r600_set_ctxcgtt3d_rsdc(struct radeon_device *rdev, u32 s)
 413{
 414	WREG32_P(CG_CTX_CGTT3D_R, SDC(s), ~SDC_MASK);
 415}
 416
 417void r600_set_vddc3d_oorsu(struct radeon_device *rdev, u32 u)
 418{
 419	WREG32_P(CG_VDDC3D_OOR, SU(u), ~SU_MASK);
 420}
 421
 422void r600_set_vddc3d_oorphc(struct radeon_device *rdev, u32 p)
 423{
 424	WREG32_P(CG_VDDC3D_OOR, PHC(p), ~PHC_MASK);
 425}
 426
 427void r600_set_vddc3d_oorsdc(struct radeon_device *rdev, u32 s)
 428{
 429	WREG32_P(CG_VDDC3D_OOR, SDC(s), ~SDC_MASK);
 430}
 431
 432void r600_set_mpll_lock_time(struct radeon_device *rdev, u32 lock_time)
 433{
 434	WREG32_P(MPLL_TIME, MPLL_LOCK_TIME(lock_time), ~MPLL_LOCK_TIME_MASK);
 435}
 436
 437void r600_set_mpll_reset_time(struct radeon_device *rdev, u32 reset_time)
 438{
 439	WREG32_P(MPLL_TIME, MPLL_RESET_TIME(reset_time), ~MPLL_RESET_TIME_MASK);
 440}
 441
 442void r600_engine_clock_entry_enable(struct radeon_device *rdev,
 443				    u32 index, bool enable)
 444{
 445	if (enable)
 446		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 447			 STEP_0_SPLL_ENTRY_VALID, ~STEP_0_SPLL_ENTRY_VALID);
 448	else
 449		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 450			 0, ~STEP_0_SPLL_ENTRY_VALID);
 451}
 452
 453void r600_engine_clock_entry_enable_pulse_skipping(struct radeon_device *rdev,
 454						   u32 index, bool enable)
 455{
 456	if (enable)
 457		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 458			 STEP_0_SPLL_STEP_ENABLE, ~STEP_0_SPLL_STEP_ENABLE);
 459	else
 460		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 461			 0, ~STEP_0_SPLL_STEP_ENABLE);
 462}
 463
 464void r600_engine_clock_entry_enable_post_divider(struct radeon_device *rdev,
 465						 u32 index, bool enable)
 466{
 467	if (enable)
 468		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 469			 STEP_0_POST_DIV_EN, ~STEP_0_POST_DIV_EN);
 470	else
 471		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 472			 0, ~STEP_0_POST_DIV_EN);
 473}
 474
 475void r600_engine_clock_entry_set_post_divider(struct radeon_device *rdev,
 476					      u32 index, u32 divider)
 477{
 478	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 479		 STEP_0_SPLL_POST_DIV(divider), ~STEP_0_SPLL_POST_DIV_MASK);
 480}
 481
 482void r600_engine_clock_entry_set_reference_divider(struct radeon_device *rdev,
 483						   u32 index, u32 divider)
 484{
 485	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 486		 STEP_0_SPLL_REF_DIV(divider), ~STEP_0_SPLL_REF_DIV_MASK);
 487}
 488
 489void r600_engine_clock_entry_set_feedback_divider(struct radeon_device *rdev,
 490						  u32 index, u32 divider)
 491{
 492	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 493		 STEP_0_SPLL_FB_DIV(divider), ~STEP_0_SPLL_FB_DIV_MASK);
 494}
 495
 496void r600_engine_clock_entry_set_step_time(struct radeon_device *rdev,
 497					   u32 index, u32 step_time)
 498{
 499	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 500		 STEP_0_SPLL_STEP_TIME(step_time), ~STEP_0_SPLL_STEP_TIME_MASK);
 501}
 502
 503void r600_vid_rt_set_ssu(struct radeon_device *rdev, u32 u)
 504{
 505	WREG32_P(VID_RT, SSTU(u), ~SSTU_MASK);
 506}
 507
 508void r600_vid_rt_set_vru(struct radeon_device *rdev, u32 u)
 509{
 510	WREG32_P(VID_RT, VID_CRTU(u), ~VID_CRTU_MASK);
 511}
 512
 513void r600_vid_rt_set_vrt(struct radeon_device *rdev, u32 rt)
 514{
 515	WREG32_P(VID_RT, VID_CRT(rt), ~VID_CRT_MASK);
 516}
 517
 518void r600_voltage_control_enable_pins(struct radeon_device *rdev,
 519				      u64 mask)
 520{
 521	WREG32(LOWER_GPIO_ENABLE, mask & 0xffffffff);
 522	WREG32(UPPER_GPIO_ENABLE, upper_32_bits(mask));
 523}
 524
 525
 526void r600_voltage_control_program_voltages(struct radeon_device *rdev,
 527					   enum r600_power_level index, u64 pins)
 528{
 529	u32 tmp, mask;
 530	u32 ix = 3 - (3 & index);
 531
 532	WREG32(CTXSW_VID_LOWER_GPIO_CNTL + (ix * 4), pins & 0xffffffff);
 533
 534	mask = 7 << (3 * ix);
 535	tmp = RREG32(VID_UPPER_GPIO_CNTL);
 536	tmp = (tmp & ~mask) | ((pins >> (32 - (3 * ix))) & mask);
 537	WREG32(VID_UPPER_GPIO_CNTL, tmp);
 538}
 539
 540void r600_voltage_control_deactivate_static_control(struct radeon_device *rdev,
 541						    u64 mask)
 542{
 543	u32 gpio;
 544
 545	gpio = RREG32(GPIOPAD_MASK);
 546	gpio &= ~mask;
 547	WREG32(GPIOPAD_MASK, gpio);
 548
 549	gpio = RREG32(GPIOPAD_EN);
 550	gpio &= ~mask;
 551	WREG32(GPIOPAD_EN, gpio);
 552
 553	gpio = RREG32(GPIOPAD_A);
 554	gpio &= ~mask;
 555	WREG32(GPIOPAD_A, gpio);
 556}
 557
 558void r600_power_level_enable(struct radeon_device *rdev,
 559			     enum r600_power_level index, bool enable)
 560{
 561	u32 ix = 3 - (3 & index);
 562
 563	if (enable)
 564		WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), CTXSW_FREQ_STATE_ENABLE,
 565			 ~CTXSW_FREQ_STATE_ENABLE);
 566	else
 567		WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), 0,
 568			 ~CTXSW_FREQ_STATE_ENABLE);
 569}
 570
 571void r600_power_level_set_voltage_index(struct radeon_device *rdev,
 572					enum r600_power_level index, u32 voltage_index)
 573{
 574	u32 ix = 3 - (3 & index);
 575
 576	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4),
 577		 CTXSW_FREQ_VIDS_CFG_INDEX(voltage_index), ~CTXSW_FREQ_VIDS_CFG_INDEX_MASK);
 578}
 579
 580void r600_power_level_set_mem_clock_index(struct radeon_device *rdev,
 581					  enum r600_power_level index, u32 mem_clock_index)
 582{
 583	u32 ix = 3 - (3 & index);
 584
 585	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4),
 586		 CTXSW_FREQ_MCLK_CFG_INDEX(mem_clock_index), ~CTXSW_FREQ_MCLK_CFG_INDEX_MASK);
 587}
 588
 589void r600_power_level_set_eng_clock_index(struct radeon_device *rdev,
 590					  enum r600_power_level index, u32 eng_clock_index)
 591{
 592	u32 ix = 3 - (3 & index);
 593
 594	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4),
 595		 CTXSW_FREQ_SCLK_CFG_INDEX(eng_clock_index), ~CTXSW_FREQ_SCLK_CFG_INDEX_MASK);
 596}
 597
 598void r600_power_level_set_watermark_id(struct radeon_device *rdev,
 599				       enum r600_power_level index,
 600				       enum r600_display_watermark watermark_id)
 601{
 602	u32 ix = 3 - (3 & index);
 603	u32 tmp = 0;
 604
 605	if (watermark_id == R600_DISPLAY_WATERMARK_HIGH)
 606		tmp = CTXSW_FREQ_DISPLAY_WATERMARK;
 607	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), tmp, ~CTXSW_FREQ_DISPLAY_WATERMARK);
 608}
 609
 610void r600_power_level_set_pcie_gen2(struct radeon_device *rdev,
 611				    enum r600_power_level index, bool compatible)
 612{
 613	u32 ix = 3 - (3 & index);
 614	u32 tmp = 0;
 615
 616	if (compatible)
 617		tmp = CTXSW_FREQ_GEN2PCIE_VOLT;
 618	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), tmp, ~CTXSW_FREQ_GEN2PCIE_VOLT);
 619}
 620
 621enum r600_power_level r600_power_level_get_current_index(struct radeon_device *rdev)
 622{
 623	u32 tmp;
 624
 625	tmp = RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_PROFILE_INDEX_MASK;
 626	tmp >>= CURRENT_PROFILE_INDEX_SHIFT;
 627	return tmp;
 628}
 629
 630enum r600_power_level r600_power_level_get_target_index(struct radeon_device *rdev)
 631{
 632	u32 tmp;
 633
 634	tmp = RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & TARGET_PROFILE_INDEX_MASK;
 635	tmp >>= TARGET_PROFILE_INDEX_SHIFT;
 636	return tmp;
 637}
 638
 639void r600_power_level_set_enter_index(struct radeon_device *rdev,
 640				      enum r600_power_level index)
 641{
 642	WREG32_P(TARGET_AND_CURRENT_PROFILE_INDEX, DYN_PWR_ENTER_INDEX(index),
 643		 ~DYN_PWR_ENTER_INDEX_MASK);
 644}
 645
 646void r600_wait_for_power_level_unequal(struct radeon_device *rdev,
 647				       enum r600_power_level index)
 648{
 649	int i;
 650
 651	for (i = 0; i < rdev->usec_timeout; i++) {
 652		if (r600_power_level_get_target_index(rdev) != index)
 653			break;
 654		udelay(1);
 655	}
 656
 657	for (i = 0; i < rdev->usec_timeout; i++) {
 658		if (r600_power_level_get_current_index(rdev) != index)
 659			break;
 660		udelay(1);
 661	}
 662}
 663
 664void r600_wait_for_power_level(struct radeon_device *rdev,
 665			       enum r600_power_level index)
 666{
 667	int i;
 668
 669	for (i = 0; i < rdev->usec_timeout; i++) {
 670		if (r600_power_level_get_target_index(rdev) == index)
 671			break;
 672		udelay(1);
 673	}
 674
 675	for (i = 0; i < rdev->usec_timeout; i++) {
 676		if (r600_power_level_get_current_index(rdev) == index)
 677			break;
 678		udelay(1);
 679	}
 680}
 681
 682void r600_start_dpm(struct radeon_device *rdev)
 683{
 684	r600_enable_sclk_control(rdev, false);
 685	r600_enable_mclk_control(rdev, false);
 686
 687	r600_dynamicpm_enable(rdev, true);
 688
 689	radeon_wait_for_vblank(rdev, 0);
 690	radeon_wait_for_vblank(rdev, 1);
 691
 692	r600_enable_spll_bypass(rdev, true);
 693	r600_wait_for_spll_change(rdev);
 694	r600_enable_spll_bypass(rdev, false);
 695	r600_wait_for_spll_change(rdev);
 696
 697	r600_enable_spll_bypass(rdev, true);
 698	r600_wait_for_spll_change(rdev);
 699	r600_enable_spll_bypass(rdev, false);
 700	r600_wait_for_spll_change(rdev);
 701
 702	r600_enable_sclk_control(rdev, true);
 703	r600_enable_mclk_control(rdev, true);
 704}
 705
 706void r600_stop_dpm(struct radeon_device *rdev)
 707{
 708	r600_dynamicpm_enable(rdev, false);
 709}
 710
 711int r600_dpm_pre_set_power_state(struct radeon_device *rdev)
 712{
 713	return 0;
 714}
 715
 716void r600_dpm_post_set_power_state(struct radeon_device *rdev)
 717{
 718
 719}
 720
 721bool r600_is_uvd_state(u32 class, u32 class2)
 722{
 723	if (class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
 724		return true;
 725	if (class & ATOM_PPLIB_CLASSIFICATION_HD2STATE)
 726		return true;
 727	if (class & ATOM_PPLIB_CLASSIFICATION_HDSTATE)
 728		return true;
 729	if (class & ATOM_PPLIB_CLASSIFICATION_SDSTATE)
 730		return true;
 731	if (class2 & ATOM_PPLIB_CLASSIFICATION2_MVC)
 732		return true;
 733	return false;
 734}
 735
 736static int r600_set_thermal_temperature_range(struct radeon_device *rdev,
 737					      int min_temp, int max_temp)
 738{
 739	int low_temp = 0 * 1000;
 740	int high_temp = 255 * 1000;
 741
 742	if (low_temp < min_temp)
 743		low_temp = min_temp;
 744	if (high_temp > max_temp)
 745		high_temp = max_temp;
 746	if (high_temp < low_temp) {
 747		DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
 748		return -EINVAL;
 749	}
 750
 751	WREG32_P(CG_THERMAL_INT, DIG_THERM_INTH(high_temp / 1000), ~DIG_THERM_INTH_MASK);
 752	WREG32_P(CG_THERMAL_INT, DIG_THERM_INTL(low_temp / 1000), ~DIG_THERM_INTL_MASK);
 753	WREG32_P(CG_THERMAL_CTRL, DIG_THERM_DPM(high_temp / 1000), ~DIG_THERM_DPM_MASK);
 754
 755	rdev->pm.dpm.thermal.min_temp = low_temp;
 756	rdev->pm.dpm.thermal.max_temp = high_temp;
 757
 758	return 0;
 759}
 760
 761bool r600_is_internal_thermal_sensor(enum radeon_int_thermal_type sensor)
 762{
 763	switch (sensor) {
 764	case THERMAL_TYPE_RV6XX:
 765	case THERMAL_TYPE_RV770:
 766	case THERMAL_TYPE_EVERGREEN:
 767	case THERMAL_TYPE_SUMO:
 768	case THERMAL_TYPE_NI:
 769	case THERMAL_TYPE_SI:
 770	case THERMAL_TYPE_CI:
 771	case THERMAL_TYPE_KV:
 772		return true;
 773	case THERMAL_TYPE_ADT7473_WITH_INTERNAL:
 774	case THERMAL_TYPE_EMC2103_WITH_INTERNAL:
 775		return false; /* need special handling */
 776	case THERMAL_TYPE_NONE:
 777	case THERMAL_TYPE_EXTERNAL:
 778	case THERMAL_TYPE_EXTERNAL_GPIO:
 779	default:
 780		return false;
 781	}
 782}
 783
 784int r600_dpm_late_enable(struct radeon_device *rdev)
 785{
 786	int ret;
 787
 788	if (rdev->irq.installed &&
 789	    r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
 790		ret = r600_set_thermal_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
 791		if (ret)
 792			return ret;
 793		rdev->irq.dpm_thermal = true;
 794		radeon_irq_set(rdev);
 795	}
 796
 797	return 0;
 798}
 799
 800union power_info {
 801	struct _ATOM_POWERPLAY_INFO info;
 802	struct _ATOM_POWERPLAY_INFO_V2 info_2;
 803	struct _ATOM_POWERPLAY_INFO_V3 info_3;
 804	struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
 805	struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
 806	struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
 807	struct _ATOM_PPLIB_POWERPLAYTABLE4 pplib4;
 808	struct _ATOM_PPLIB_POWERPLAYTABLE5 pplib5;
 809};
 810
 811union fan_info {
 812	struct _ATOM_PPLIB_FANTABLE fan;
 813	struct _ATOM_PPLIB_FANTABLE2 fan2;
 814	struct _ATOM_PPLIB_FANTABLE3 fan3;
 815};
 816
 817static int r600_parse_clk_voltage_dep_table(struct radeon_clock_voltage_dependency_table *radeon_table,
 818					    ATOM_PPLIB_Clock_Voltage_Dependency_Table *atom_table)
 819{
 820	u32 size = atom_table->ucNumEntries *
 821		sizeof(struct radeon_clock_voltage_dependency_entry);
 822	int i;
 823	ATOM_PPLIB_Clock_Voltage_Dependency_Record *entry;
 824
 825	radeon_table->entries = kzalloc(size, GFP_KERNEL);
 
 
 826	if (!radeon_table->entries)
 827		return -ENOMEM;
 828
 829	entry = &atom_table->entries[0];
 830	for (i = 0; i < atom_table->ucNumEntries; i++) {
 831		radeon_table->entries[i].clk = le16_to_cpu(entry->usClockLow) |
 832			(entry->ucClockHigh << 16);
 833		radeon_table->entries[i].v = le16_to_cpu(entry->usVoltage);
 834		entry = (ATOM_PPLIB_Clock_Voltage_Dependency_Record *)
 835			((u8 *)entry + sizeof(ATOM_PPLIB_Clock_Voltage_Dependency_Record));
 836	}
 837	radeon_table->count = atom_table->ucNumEntries;
 838
 839	return 0;
 840}
 841
 842int r600_get_platform_caps(struct radeon_device *rdev)
 843{
 844	struct radeon_mode_info *mode_info = &rdev->mode_info;
 845	union power_info *power_info;
 846	int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
 847	u16 data_offset;
 848	u8 frev, crev;
 849
 850	if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
 851				   &frev, &crev, &data_offset))
 852		return -EINVAL;
 853	power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
 854
 855	rdev->pm.dpm.platform_caps = le32_to_cpu(power_info->pplib.ulPlatformCaps);
 856	rdev->pm.dpm.backbias_response_time = le16_to_cpu(power_info->pplib.usBackbiasTime);
 857	rdev->pm.dpm.voltage_response_time = le16_to_cpu(power_info->pplib.usVoltageTime);
 858
 859	return 0;
 860}
 861
 862/* sizeof(ATOM_PPLIB_EXTENDEDHEADER) */
 863#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V2 12
 864#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V3 14
 865#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V4 16
 866#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V5 18
 867#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V6 20
 868#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V7 22
 869
 870int r600_parse_extended_power_table(struct radeon_device *rdev)
 871{
 872	struct radeon_mode_info *mode_info = &rdev->mode_info;
 873	union power_info *power_info;
 874	union fan_info *fan_info;
 875	ATOM_PPLIB_Clock_Voltage_Dependency_Table *dep_table;
 876	int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
 877	u16 data_offset;
 878	u8 frev, crev;
 879	int ret, i;
 880
 881	if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
 882				   &frev, &crev, &data_offset))
 883		return -EINVAL;
 884	power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
 885
 886	/* fan table */
 887	if (le16_to_cpu(power_info->pplib.usTableSize) >=
 888	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE3)) {
 889		if (power_info->pplib3.usFanTableOffset) {
 890			fan_info = (union fan_info *)(mode_info->atom_context->bios + data_offset +
 891						      le16_to_cpu(power_info->pplib3.usFanTableOffset));
 892			rdev->pm.dpm.fan.t_hyst = fan_info->fan.ucTHyst;
 893			rdev->pm.dpm.fan.t_min = le16_to_cpu(fan_info->fan.usTMin);
 894			rdev->pm.dpm.fan.t_med = le16_to_cpu(fan_info->fan.usTMed);
 895			rdev->pm.dpm.fan.t_high = le16_to_cpu(fan_info->fan.usTHigh);
 896			rdev->pm.dpm.fan.pwm_min = le16_to_cpu(fan_info->fan.usPWMMin);
 897			rdev->pm.dpm.fan.pwm_med = le16_to_cpu(fan_info->fan.usPWMMed);
 898			rdev->pm.dpm.fan.pwm_high = le16_to_cpu(fan_info->fan.usPWMHigh);
 899			if (fan_info->fan.ucFanTableFormat >= 2)
 900				rdev->pm.dpm.fan.t_max = le16_to_cpu(fan_info->fan2.usTMax);
 901			else
 902				rdev->pm.dpm.fan.t_max = 10900;
 903			rdev->pm.dpm.fan.cycle_delay = 100000;
 904			if (fan_info->fan.ucFanTableFormat >= 3) {
 905				rdev->pm.dpm.fan.control_mode = fan_info->fan3.ucFanControlMode;
 906				rdev->pm.dpm.fan.default_max_fan_pwm =
 907					le16_to_cpu(fan_info->fan3.usFanPWMMax);
 908				rdev->pm.dpm.fan.default_fan_output_sensitivity = 4836;
 909				rdev->pm.dpm.fan.fan_output_sensitivity =
 910					le16_to_cpu(fan_info->fan3.usFanOutputSensitivity);
 911			}
 912			rdev->pm.dpm.fan.ucode_fan_control = true;
 913		}
 914	}
 915
 916	/* clock dependancy tables, shedding tables */
 917	if (le16_to_cpu(power_info->pplib.usTableSize) >=
 918	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE4)) {
 919		if (power_info->pplib4.usVddcDependencyOnSCLKOffset) {
 920			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 921				(mode_info->atom_context->bios + data_offset +
 922				 le16_to_cpu(power_info->pplib4.usVddcDependencyOnSCLKOffset));
 923			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk,
 924							       dep_table);
 925			if (ret)
 926				return ret;
 927		}
 928		if (power_info->pplib4.usVddciDependencyOnMCLKOffset) {
 929			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 930				(mode_info->atom_context->bios + data_offset +
 931				 le16_to_cpu(power_info->pplib4.usVddciDependencyOnMCLKOffset));
 932			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk,
 933							       dep_table);
 934			if (ret) {
 935				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries);
 936				return ret;
 937			}
 938		}
 939		if (power_info->pplib4.usVddcDependencyOnMCLKOffset) {
 940			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 941				(mode_info->atom_context->bios + data_offset +
 942				 le16_to_cpu(power_info->pplib4.usVddcDependencyOnMCLKOffset));
 943			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk,
 944							       dep_table);
 945			if (ret) {
 946				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries);
 947				kfree(rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk.entries);
 948				return ret;
 949			}
 950		}
 951		if (power_info->pplib4.usMvddDependencyOnMCLKOffset) {
 952			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 953				(mode_info->atom_context->bios + data_offset +
 954				 le16_to_cpu(power_info->pplib4.usMvddDependencyOnMCLKOffset));
 955			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk,
 956							       dep_table);
 957			if (ret) {
 958				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries);
 959				kfree(rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk.entries);
 960				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk.entries);
 961				return ret;
 962			}
 963		}
 964		if (power_info->pplib4.usMaxClockVoltageOnDCOffset) {
 965			ATOM_PPLIB_Clock_Voltage_Limit_Table *clk_v =
 966				(ATOM_PPLIB_Clock_Voltage_Limit_Table *)
 967				(mode_info->atom_context->bios + data_offset +
 968				 le16_to_cpu(power_info->pplib4.usMaxClockVoltageOnDCOffset));
 969			if (clk_v->ucNumEntries) {
 970				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.sclk =
 971					le16_to_cpu(clk_v->entries[0].usSclkLow) |
 972					(clk_v->entries[0].ucSclkHigh << 16);
 973				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.mclk =
 974					le16_to_cpu(clk_v->entries[0].usMclkLow) |
 975					(clk_v->entries[0].ucMclkHigh << 16);
 976				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.vddc =
 977					le16_to_cpu(clk_v->entries[0].usVddc);
 978				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.vddci =
 979					le16_to_cpu(clk_v->entries[0].usVddci);
 980			}
 981		}
 982		if (power_info->pplib4.usVddcPhaseShedLimitsTableOffset) {
 983			ATOM_PPLIB_PhaseSheddingLimits_Table *psl =
 984				(ATOM_PPLIB_PhaseSheddingLimits_Table *)
 985				(mode_info->atom_context->bios + data_offset +
 986				 le16_to_cpu(power_info->pplib4.usVddcPhaseShedLimitsTableOffset));
 987			ATOM_PPLIB_PhaseSheddingLimits_Record *entry;
 988
 989			rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries =
 990				kzalloc(psl->ucNumEntries *
 991					sizeof(struct radeon_phase_shedding_limits_entry),
 992					GFP_KERNEL);
 993			if (!rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries) {
 994				r600_free_extended_power_table(rdev);
 995				return -ENOMEM;
 996			}
 997
 998			entry = &psl->entries[0];
 999			for (i = 0; i < psl->ucNumEntries; i++) {
1000				rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries[i].sclk =
1001					le16_to_cpu(entry->usSclkLow) | (entry->ucSclkHigh << 16);
1002				rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries[i].mclk =
1003					le16_to_cpu(entry->usMclkLow) | (entry->ucMclkHigh << 16);
1004				rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries[i].voltage =
1005					le16_to_cpu(entry->usVoltage);
1006				entry = (ATOM_PPLIB_PhaseSheddingLimits_Record *)
1007					((u8 *)entry + sizeof(ATOM_PPLIB_PhaseSheddingLimits_Record));
1008			}
1009			rdev->pm.dpm.dyn_state.phase_shedding_limits_table.count =
1010				psl->ucNumEntries;
1011		}
1012	}
1013
1014	/* cac data */
1015	if (le16_to_cpu(power_info->pplib.usTableSize) >=
1016	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE5)) {
1017		rdev->pm.dpm.tdp_limit = le32_to_cpu(power_info->pplib5.ulTDPLimit);
1018		rdev->pm.dpm.near_tdp_limit = le32_to_cpu(power_info->pplib5.ulNearTDPLimit);
1019		rdev->pm.dpm.near_tdp_limit_adjusted = rdev->pm.dpm.near_tdp_limit;
1020		rdev->pm.dpm.tdp_od_limit = le16_to_cpu(power_info->pplib5.usTDPODLimit);
1021		if (rdev->pm.dpm.tdp_od_limit)
1022			rdev->pm.dpm.power_control = true;
1023		else
1024			rdev->pm.dpm.power_control = false;
1025		rdev->pm.dpm.tdp_adjustment = 0;
1026		rdev->pm.dpm.sq_ramping_threshold = le32_to_cpu(power_info->pplib5.ulSQRampingThreshold);
1027		rdev->pm.dpm.cac_leakage = le32_to_cpu(power_info->pplib5.ulCACLeakage);
1028		rdev->pm.dpm.load_line_slope = le16_to_cpu(power_info->pplib5.usLoadLineSlope);
1029		if (power_info->pplib5.usCACLeakageTableOffset) {
1030			ATOM_PPLIB_CAC_Leakage_Table *cac_table =
1031				(ATOM_PPLIB_CAC_Leakage_Table *)
1032				(mode_info->atom_context->bios + data_offset +
1033				 le16_to_cpu(power_info->pplib5.usCACLeakageTableOffset));
1034			ATOM_PPLIB_CAC_Leakage_Record *entry;
1035			u32 size = cac_table->ucNumEntries * sizeof(struct radeon_cac_leakage_table);
1036			rdev->pm.dpm.dyn_state.cac_leakage_table.entries = kzalloc(size, GFP_KERNEL);
1037			if (!rdev->pm.dpm.dyn_state.cac_leakage_table.entries) {
1038				r600_free_extended_power_table(rdev);
1039				return -ENOMEM;
1040			}
1041			entry = &cac_table->entries[0];
1042			for (i = 0; i < cac_table->ucNumEntries; i++) {
1043				if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_EVV) {
1044					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc1 =
1045						le16_to_cpu(entry->usVddc1);
1046					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc2 =
1047						le16_to_cpu(entry->usVddc2);
1048					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc3 =
1049						le16_to_cpu(entry->usVddc3);
1050				} else {
1051					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc =
1052						le16_to_cpu(entry->usVddc);
1053					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].leakage =
1054						le32_to_cpu(entry->ulLeakageValue);
1055				}
1056				entry = (ATOM_PPLIB_CAC_Leakage_Record *)
1057					((u8 *)entry + sizeof(ATOM_PPLIB_CAC_Leakage_Record));
1058			}
1059			rdev->pm.dpm.dyn_state.cac_leakage_table.count = cac_table->ucNumEntries;
1060		}
1061	}
1062
1063	/* ext tables */
1064	if (le16_to_cpu(power_info->pplib.usTableSize) >=
1065	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE3)) {
1066		ATOM_PPLIB_EXTENDEDHEADER *ext_hdr = (ATOM_PPLIB_EXTENDEDHEADER *)
1067			(mode_info->atom_context->bios + data_offset +
1068			 le16_to_cpu(power_info->pplib3.usExtendendedHeaderOffset));
1069		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V2) &&
1070			ext_hdr->usVCETableOffset) {
1071			VCEClockInfoArray *array = (VCEClockInfoArray *)
1072				(mode_info->atom_context->bios + data_offset +
1073				 le16_to_cpu(ext_hdr->usVCETableOffset) + 1);
1074			ATOM_PPLIB_VCE_Clock_Voltage_Limit_Table *limits =
1075				(ATOM_PPLIB_VCE_Clock_Voltage_Limit_Table *)
1076				(mode_info->atom_context->bios + data_offset +
1077				 le16_to_cpu(ext_hdr->usVCETableOffset) + 1 +
1078				 1 + array->ucNumEntries * sizeof(VCEClockInfo));
1079			ATOM_PPLIB_VCE_State_Table *states =
1080				(ATOM_PPLIB_VCE_State_Table *)
1081				(mode_info->atom_context->bios + data_offset +
1082				 le16_to_cpu(ext_hdr->usVCETableOffset) + 1 +
1083				 1 + (array->ucNumEntries * sizeof (VCEClockInfo)) +
1084				 1 + (limits->numEntries * sizeof(ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record)));
1085			ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record *entry;
1086			ATOM_PPLIB_VCE_State_Record *state_entry;
1087			VCEClockInfo *vce_clk;
1088			u32 size = limits->numEntries *
1089				sizeof(struct radeon_vce_clock_voltage_dependency_entry);
1090			rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries =
1091				kzalloc(size, GFP_KERNEL);
1092			if (!rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries) {
1093				r600_free_extended_power_table(rdev);
1094				return -ENOMEM;
1095			}
1096			rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.count =
1097				limits->numEntries;
1098			entry = &limits->entries[0];
1099			state_entry = &states->entries[0];
1100			for (i = 0; i < limits->numEntries; i++) {
1101				vce_clk = (VCEClockInfo *)
1102					((u8 *)&array->entries[0] +
1103					 (entry->ucVCEClockInfoIndex * sizeof(VCEClockInfo)));
1104				rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[i].evclk =
1105					le16_to_cpu(vce_clk->usEVClkLow) | (vce_clk->ucEVClkHigh << 16);
1106				rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[i].ecclk =
1107					le16_to_cpu(vce_clk->usECClkLow) | (vce_clk->ucECClkHigh << 16);
1108				rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[i].v =
1109					le16_to_cpu(entry->usVoltage);
1110				entry = (ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record *)
1111					((u8 *)entry + sizeof(ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record));
1112			}
1113			for (i = 0; i < states->numEntries; i++) {
1114				if (i >= RADEON_MAX_VCE_LEVELS)
1115					break;
1116				vce_clk = (VCEClockInfo *)
1117					((u8 *)&array->entries[0] +
1118					 (state_entry->ucVCEClockInfoIndex * sizeof(VCEClockInfo)));
1119				rdev->pm.dpm.vce_states[i].evclk =
1120					le16_to_cpu(vce_clk->usEVClkLow) | (vce_clk->ucEVClkHigh << 16);
1121				rdev->pm.dpm.vce_states[i].ecclk =
1122					le16_to_cpu(vce_clk->usECClkLow) | (vce_clk->ucECClkHigh << 16);
1123				rdev->pm.dpm.vce_states[i].clk_idx =
1124					state_entry->ucClockInfoIndex & 0x3f;
1125				rdev->pm.dpm.vce_states[i].pstate =
1126					(state_entry->ucClockInfoIndex & 0xc0) >> 6;
1127				state_entry = (ATOM_PPLIB_VCE_State_Record *)
1128					((u8 *)state_entry + sizeof(ATOM_PPLIB_VCE_State_Record));
1129			}
1130		}
1131		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V3) &&
1132			ext_hdr->usUVDTableOffset) {
1133			UVDClockInfoArray *array = (UVDClockInfoArray *)
1134				(mode_info->atom_context->bios + data_offset +
1135				 le16_to_cpu(ext_hdr->usUVDTableOffset) + 1);
1136			ATOM_PPLIB_UVD_Clock_Voltage_Limit_Table *limits =
1137				(ATOM_PPLIB_UVD_Clock_Voltage_Limit_Table *)
1138				(mode_info->atom_context->bios + data_offset +
1139				 le16_to_cpu(ext_hdr->usUVDTableOffset) + 1 +
1140				 1 + (array->ucNumEntries * sizeof (UVDClockInfo)));
1141			ATOM_PPLIB_UVD_Clock_Voltage_Limit_Record *entry;
1142			u32 size = limits->numEntries *
1143				sizeof(struct radeon_uvd_clock_voltage_dependency_entry);
1144			rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries =
1145				kzalloc(size, GFP_KERNEL);
1146			if (!rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries) {
1147				r600_free_extended_power_table(rdev);
1148				return -ENOMEM;
1149			}
1150			rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.count =
1151				limits->numEntries;
1152			entry = &limits->entries[0];
1153			for (i = 0; i < limits->numEntries; i++) {
1154				UVDClockInfo *uvd_clk = (UVDClockInfo *)
1155					((u8 *)&array->entries[0] +
1156					 (entry->ucUVDClockInfoIndex * sizeof(UVDClockInfo)));
1157				rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[i].vclk =
1158					le16_to_cpu(uvd_clk->usVClkLow) | (uvd_clk->ucVClkHigh << 16);
1159				rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[i].dclk =
1160					le16_to_cpu(uvd_clk->usDClkLow) | (uvd_clk->ucDClkHigh << 16);
1161				rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[i].v =
1162					le16_to_cpu(entry->usVoltage);
1163				entry = (ATOM_PPLIB_UVD_Clock_Voltage_Limit_Record *)
1164					((u8 *)entry + sizeof(ATOM_PPLIB_UVD_Clock_Voltage_Limit_Record));
1165			}
1166		}
1167		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V4) &&
1168			ext_hdr->usSAMUTableOffset) {
1169			ATOM_PPLIB_SAMClk_Voltage_Limit_Table *limits =
1170				(ATOM_PPLIB_SAMClk_Voltage_Limit_Table *)
1171				(mode_info->atom_context->bios + data_offset +
1172				 le16_to_cpu(ext_hdr->usSAMUTableOffset) + 1);
1173			ATOM_PPLIB_SAMClk_Voltage_Limit_Record *entry;
1174			u32 size = limits->numEntries *
1175				sizeof(struct radeon_clock_voltage_dependency_entry);
1176			rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries =
1177				kzalloc(size, GFP_KERNEL);
1178			if (!rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries) {
1179				r600_free_extended_power_table(rdev);
1180				return -ENOMEM;
1181			}
1182			rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.count =
1183				limits->numEntries;
1184			entry = &limits->entries[0];
1185			for (i = 0; i < limits->numEntries; i++) {
1186				rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries[i].clk =
1187					le16_to_cpu(entry->usSAMClockLow) | (entry->ucSAMClockHigh << 16);
1188				rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries[i].v =
1189					le16_to_cpu(entry->usVoltage);
1190				entry = (ATOM_PPLIB_SAMClk_Voltage_Limit_Record *)
1191					((u8 *)entry + sizeof(ATOM_PPLIB_SAMClk_Voltage_Limit_Record));
1192			}
1193		}
1194		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V5) &&
1195		    ext_hdr->usPPMTableOffset) {
1196			ATOM_PPLIB_PPM_Table *ppm = (ATOM_PPLIB_PPM_Table *)
1197				(mode_info->atom_context->bios + data_offset +
1198				 le16_to_cpu(ext_hdr->usPPMTableOffset));
1199			rdev->pm.dpm.dyn_state.ppm_table =
1200				kzalloc(sizeof(struct radeon_ppm_table), GFP_KERNEL);
1201			if (!rdev->pm.dpm.dyn_state.ppm_table) {
1202				r600_free_extended_power_table(rdev);
1203				return -ENOMEM;
1204			}
1205			rdev->pm.dpm.dyn_state.ppm_table->ppm_design = ppm->ucPpmDesign;
1206			rdev->pm.dpm.dyn_state.ppm_table->cpu_core_number =
1207				le16_to_cpu(ppm->usCpuCoreNumber);
1208			rdev->pm.dpm.dyn_state.ppm_table->platform_tdp =
1209				le32_to_cpu(ppm->ulPlatformTDP);
1210			rdev->pm.dpm.dyn_state.ppm_table->small_ac_platform_tdp =
1211				le32_to_cpu(ppm->ulSmallACPlatformTDP);
1212			rdev->pm.dpm.dyn_state.ppm_table->platform_tdc =
1213				le32_to_cpu(ppm->ulPlatformTDC);
1214			rdev->pm.dpm.dyn_state.ppm_table->small_ac_platform_tdc =
1215				le32_to_cpu(ppm->ulSmallACPlatformTDC);
1216			rdev->pm.dpm.dyn_state.ppm_table->apu_tdp =
1217				le32_to_cpu(ppm->ulApuTDP);
1218			rdev->pm.dpm.dyn_state.ppm_table->dgpu_tdp =
1219				le32_to_cpu(ppm->ulDGpuTDP);
1220			rdev->pm.dpm.dyn_state.ppm_table->dgpu_ulv_power =
1221				le32_to_cpu(ppm->ulDGpuUlvPower);
1222			rdev->pm.dpm.dyn_state.ppm_table->tj_max =
1223				le32_to_cpu(ppm->ulTjmax);
1224		}
1225		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V6) &&
1226			ext_hdr->usACPTableOffset) {
1227			ATOM_PPLIB_ACPClk_Voltage_Limit_Table *limits =
1228				(ATOM_PPLIB_ACPClk_Voltage_Limit_Table *)
1229				(mode_info->atom_context->bios + data_offset +
1230				 le16_to_cpu(ext_hdr->usACPTableOffset) + 1);
1231			ATOM_PPLIB_ACPClk_Voltage_Limit_Record *entry;
1232			u32 size = limits->numEntries *
1233				sizeof(struct radeon_clock_voltage_dependency_entry);
1234			rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries =
1235				kzalloc(size, GFP_KERNEL);
1236			if (!rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries) {
1237				r600_free_extended_power_table(rdev);
1238				return -ENOMEM;
1239			}
1240			rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.count =
1241				limits->numEntries;
1242			entry = &limits->entries[0];
1243			for (i = 0; i < limits->numEntries; i++) {
1244				rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries[i].clk =
1245					le16_to_cpu(entry->usACPClockLow) | (entry->ucACPClockHigh << 16);
1246				rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries[i].v =
1247					le16_to_cpu(entry->usVoltage);
1248				entry = (ATOM_PPLIB_ACPClk_Voltage_Limit_Record *)
1249					((u8 *)entry + sizeof(ATOM_PPLIB_ACPClk_Voltage_Limit_Record));
1250			}
1251		}
1252		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V7) &&
1253			ext_hdr->usPowerTuneTableOffset) {
1254			u8 rev = *(u8 *)(mode_info->atom_context->bios + data_offset +
1255					 le16_to_cpu(ext_hdr->usPowerTuneTableOffset));
1256			ATOM_PowerTune_Table *pt;
1257			rdev->pm.dpm.dyn_state.cac_tdp_table =
1258				kzalloc(sizeof(struct radeon_cac_tdp_table), GFP_KERNEL);
1259			if (!rdev->pm.dpm.dyn_state.cac_tdp_table) {
1260				r600_free_extended_power_table(rdev);
1261				return -ENOMEM;
1262			}
1263			if (rev > 0) {
1264				ATOM_PPLIB_POWERTUNE_Table_V1 *ppt = (ATOM_PPLIB_POWERTUNE_Table_V1 *)
1265					(mode_info->atom_context->bios + data_offset +
1266					 le16_to_cpu(ext_hdr->usPowerTuneTableOffset));
1267				rdev->pm.dpm.dyn_state.cac_tdp_table->maximum_power_delivery_limit =
1268					le16_to_cpu(ppt->usMaximumPowerDeliveryLimit);
1269				pt = &ppt->power_tune_table;
1270			} else {
1271				ATOM_PPLIB_POWERTUNE_Table *ppt = (ATOM_PPLIB_POWERTUNE_Table *)
1272					(mode_info->atom_context->bios + data_offset +
1273					 le16_to_cpu(ext_hdr->usPowerTuneTableOffset));
1274				rdev->pm.dpm.dyn_state.cac_tdp_table->maximum_power_delivery_limit = 255;
1275				pt = &ppt->power_tune_table;
1276			}
1277			rdev->pm.dpm.dyn_state.cac_tdp_table->tdp = le16_to_cpu(pt->usTDP);
1278			rdev->pm.dpm.dyn_state.cac_tdp_table->configurable_tdp =
1279				le16_to_cpu(pt->usConfigurableTDP);
1280			rdev->pm.dpm.dyn_state.cac_tdp_table->tdc = le16_to_cpu(pt->usTDC);
1281			rdev->pm.dpm.dyn_state.cac_tdp_table->battery_power_limit =
1282				le16_to_cpu(pt->usBatteryPowerLimit);
1283			rdev->pm.dpm.dyn_state.cac_tdp_table->small_power_limit =
1284				le16_to_cpu(pt->usSmallPowerLimit);
1285			rdev->pm.dpm.dyn_state.cac_tdp_table->low_cac_leakage =
1286				le16_to_cpu(pt->usLowCACLeakage);
1287			rdev->pm.dpm.dyn_state.cac_tdp_table->high_cac_leakage =
1288				le16_to_cpu(pt->usHighCACLeakage);
1289		}
1290	}
1291
1292	return 0;
1293}
1294
1295void r600_free_extended_power_table(struct radeon_device *rdev)
1296{
1297	struct radeon_dpm_dynamic_state *dyn_state = &rdev->pm.dpm.dyn_state;
1298
1299	kfree(dyn_state->vddc_dependency_on_sclk.entries);
1300	kfree(dyn_state->vddci_dependency_on_mclk.entries);
1301	kfree(dyn_state->vddc_dependency_on_mclk.entries);
1302	kfree(dyn_state->mvdd_dependency_on_mclk.entries);
1303	kfree(dyn_state->cac_leakage_table.entries);
1304	kfree(dyn_state->phase_shedding_limits_table.entries);
1305	kfree(dyn_state->ppm_table);
1306	kfree(dyn_state->cac_tdp_table);
1307	kfree(dyn_state->vce_clock_voltage_dependency_table.entries);
1308	kfree(dyn_state->uvd_clock_voltage_dependency_table.entries);
1309	kfree(dyn_state->samu_clock_voltage_dependency_table.entries);
1310	kfree(dyn_state->acp_clock_voltage_dependency_table.entries);
1311}
1312
1313enum radeon_pcie_gen r600_get_pcie_gen_support(struct radeon_device *rdev,
1314					       u32 sys_mask,
1315					       enum radeon_pcie_gen asic_gen,
1316					       enum radeon_pcie_gen default_gen)
1317{
1318	switch (asic_gen) {
1319	case RADEON_PCIE_GEN1:
1320		return RADEON_PCIE_GEN1;
1321	case RADEON_PCIE_GEN2:
1322		return RADEON_PCIE_GEN2;
1323	case RADEON_PCIE_GEN3:
1324		return RADEON_PCIE_GEN3;
1325	default:
1326		if ((sys_mask & DRM_PCIE_SPEED_80) && (default_gen == RADEON_PCIE_GEN3))
1327			return RADEON_PCIE_GEN3;
1328		else if ((sys_mask & DRM_PCIE_SPEED_50) && (default_gen == RADEON_PCIE_GEN2))
1329			return RADEON_PCIE_GEN2;
1330		else
1331			return RADEON_PCIE_GEN1;
1332	}
1333	return RADEON_PCIE_GEN1;
1334}
1335
1336u16 r600_get_pcie_lane_support(struct radeon_device *rdev,
1337			       u16 asic_lanes,
1338			       u16 default_lanes)
1339{
1340	switch (asic_lanes) {
1341	case 0:
1342	default:
1343		return default_lanes;
1344	case 1:
1345		return 1;
1346	case 2:
1347		return 2;
1348	case 4:
1349		return 4;
1350	case 8:
1351		return 8;
1352	case 12:
1353		return 12;
1354	case 16:
1355		return 16;
1356	}
1357}
1358
1359u8 r600_encode_pci_lane_width(u32 lanes)
1360{
1361	u8 encoded_lanes[] = { 0, 1, 2, 0, 3, 0, 0, 0, 4, 0, 0, 0, 5, 0, 0, 0, 6 };
 
 
1362
1363	if (lanes > 16)
1364		return 0;
1365
1366	return encoded_lanes[lanes];
1367}
v6.2
   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 "r600d.h"
  28#include "r600_dpm.h"
  29#include "atom.h"
  30
  31const u32 r600_utc[R600_PM_NUMBER_OF_TC] =
  32{
  33	R600_UTC_DFLT_00,
  34	R600_UTC_DFLT_01,
  35	R600_UTC_DFLT_02,
  36	R600_UTC_DFLT_03,
  37	R600_UTC_DFLT_04,
  38	R600_UTC_DFLT_05,
  39	R600_UTC_DFLT_06,
  40	R600_UTC_DFLT_07,
  41	R600_UTC_DFLT_08,
  42	R600_UTC_DFLT_09,
  43	R600_UTC_DFLT_10,
  44	R600_UTC_DFLT_11,
  45	R600_UTC_DFLT_12,
  46	R600_UTC_DFLT_13,
  47	R600_UTC_DFLT_14,
  48};
  49
  50const u32 r600_dtc[R600_PM_NUMBER_OF_TC] =
  51{
  52	R600_DTC_DFLT_00,
  53	R600_DTC_DFLT_01,
  54	R600_DTC_DFLT_02,
  55	R600_DTC_DFLT_03,
  56	R600_DTC_DFLT_04,
  57	R600_DTC_DFLT_05,
  58	R600_DTC_DFLT_06,
  59	R600_DTC_DFLT_07,
  60	R600_DTC_DFLT_08,
  61	R600_DTC_DFLT_09,
  62	R600_DTC_DFLT_10,
  63	R600_DTC_DFLT_11,
  64	R600_DTC_DFLT_12,
  65	R600_DTC_DFLT_13,
  66	R600_DTC_DFLT_14,
  67};
  68
  69void r600_dpm_print_class_info(u32 class, u32 class2)
  70{
  71	const char *s;
  72
  73	switch (class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) {
  74	case ATOM_PPLIB_CLASSIFICATION_UI_NONE:
  75	default:
  76		s = "none";
  77		break;
  78	case ATOM_PPLIB_CLASSIFICATION_UI_BATTERY:
  79		s = "battery";
  80		break;
  81	case ATOM_PPLIB_CLASSIFICATION_UI_BALANCED:
  82		s = "balanced";
  83		break;
  84	case ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE:
  85		s = "performance";
  86		break;
  87	}
  88	printk("\tui class: %s\n", s);
  89
  90	printk("\tinternal class:");
  91	if (((class & ~ATOM_PPLIB_CLASSIFICATION_UI_MASK) == 0) &&
  92	    (class2 == 0))
  93		pr_cont(" none");
  94	else {
  95		if (class & ATOM_PPLIB_CLASSIFICATION_BOOT)
  96			pr_cont(" boot");
  97		if (class & ATOM_PPLIB_CLASSIFICATION_THERMAL)
  98			pr_cont(" thermal");
  99		if (class & ATOM_PPLIB_CLASSIFICATION_LIMITEDPOWERSOURCE)
 100			pr_cont(" limited_pwr");
 101		if (class & ATOM_PPLIB_CLASSIFICATION_REST)
 102			pr_cont(" rest");
 103		if (class & ATOM_PPLIB_CLASSIFICATION_FORCED)
 104			pr_cont(" forced");
 105		if (class & ATOM_PPLIB_CLASSIFICATION_3DPERFORMANCE)
 106			pr_cont(" 3d_perf");
 107		if (class & ATOM_PPLIB_CLASSIFICATION_OVERDRIVETEMPLATE)
 108			pr_cont(" ovrdrv");
 109		if (class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
 110			pr_cont(" uvd");
 111		if (class & ATOM_PPLIB_CLASSIFICATION_3DLOW)
 112			pr_cont(" 3d_low");
 113		if (class & ATOM_PPLIB_CLASSIFICATION_ACPI)
 114			pr_cont(" acpi");
 115		if (class & ATOM_PPLIB_CLASSIFICATION_HD2STATE)
 116			pr_cont(" uvd_hd2");
 117		if (class & ATOM_PPLIB_CLASSIFICATION_HDSTATE)
 118			pr_cont(" uvd_hd");
 119		if (class & ATOM_PPLIB_CLASSIFICATION_SDSTATE)
 120			pr_cont(" uvd_sd");
 121		if (class2 & ATOM_PPLIB_CLASSIFICATION2_LIMITEDPOWERSOURCE_2)
 122			pr_cont(" limited_pwr2");
 123		if (class2 & ATOM_PPLIB_CLASSIFICATION2_ULV)
 124			pr_cont(" ulv");
 125		if (class2 & ATOM_PPLIB_CLASSIFICATION2_MVC)
 126			pr_cont(" uvd_mvc");
 127	}
 128	pr_cont("\n");
 129}
 130
 131void r600_dpm_print_cap_info(u32 caps)
 132{
 133	printk("\tcaps:");
 134	if (caps & ATOM_PPLIB_SINGLE_DISPLAY_ONLY)
 135		pr_cont(" single_disp");
 136	if (caps & ATOM_PPLIB_SUPPORTS_VIDEO_PLAYBACK)
 137		pr_cont(" video");
 138	if (caps & ATOM_PPLIB_DISALLOW_ON_DC)
 139		pr_cont(" no_dc");
 140	pr_cont("\n");
 141}
 142
 143void r600_dpm_print_ps_status(struct radeon_device *rdev,
 144			      struct radeon_ps *rps)
 145{
 146	printk("\tstatus:");
 147	if (rps == rdev->pm.dpm.current_ps)
 148		pr_cont(" c");
 149	if (rps == rdev->pm.dpm.requested_ps)
 150		pr_cont(" r");
 151	if (rps == rdev->pm.dpm.boot_ps)
 152		pr_cont(" b");
 153	pr_cont("\n");
 154}
 155
 156u32 r600_dpm_get_vblank_time(struct radeon_device *rdev)
 157{
 158	struct drm_device *dev = rdev->ddev;
 159	struct drm_crtc *crtc;
 160	struct radeon_crtc *radeon_crtc;
 161	u32 vblank_in_pixels;
 162	u32 vblank_time_us = 0xffffffff; /* if the displays are off, vblank time is max */
 163
 164	if (rdev->num_crtc && rdev->mode_info.mode_config_initialized) {
 165		list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 166			radeon_crtc = to_radeon_crtc(crtc);
 167			if (crtc->enabled && radeon_crtc->enabled && radeon_crtc->hw_mode.clock) {
 168				vblank_in_pixels =
 169					radeon_crtc->hw_mode.crtc_htotal *
 170					(radeon_crtc->hw_mode.crtc_vblank_end -
 171					 radeon_crtc->hw_mode.crtc_vdisplay +
 172					 (radeon_crtc->v_border * 2));
 173
 174				vblank_time_us = vblank_in_pixels * 1000 / radeon_crtc->hw_mode.clock;
 175				break;
 176			}
 177		}
 178	}
 179
 180	return vblank_time_us;
 181}
 182
 183u32 r600_dpm_get_vrefresh(struct radeon_device *rdev)
 184{
 185	struct drm_device *dev = rdev->ddev;
 186	struct drm_crtc *crtc;
 187	struct radeon_crtc *radeon_crtc;
 188	u32 vrefresh = 0;
 189
 190	if (rdev->num_crtc && rdev->mode_info.mode_config_initialized) {
 191		list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 192			radeon_crtc = to_radeon_crtc(crtc);
 193			if (crtc->enabled && radeon_crtc->enabled && radeon_crtc->hw_mode.clock) {
 194				vrefresh = drm_mode_vrefresh(&radeon_crtc->hw_mode);
 195				break;
 196			}
 197		}
 198	}
 199	return vrefresh;
 200}
 201
 202void r600_calculate_u_and_p(u32 i, u32 r_c, u32 p_b,
 203			    u32 *p, u32 *u)
 204{
 205	u32 b_c = 0;
 206	u32 i_c;
 207	u32 tmp;
 208
 209	i_c = (i * r_c) / 100;
 210	tmp = i_c >> p_b;
 211
 212	while (tmp) {
 213		b_c++;
 214		tmp >>= 1;
 215	}
 216
 217	*u = (b_c + 1) / 2;
 218	*p = i_c / (1 << (2 * (*u)));
 219}
 220
 221int r600_calculate_at(u32 t, u32 h, u32 fh, u32 fl, u32 *tl, u32 *th)
 222{
 223	u32 k, a, ah, al;
 224	u32 t1;
 225
 226	if ((fl == 0) || (fh == 0) || (fl > fh))
 227		return -EINVAL;
 228
 229	k = (100 * fh) / fl;
 230	t1 = (t * (k - 100));
 231	a = (1000 * (100 * h + t1)) / (10000 + (t1 / 100));
 232	a = (a + 5) / 10;
 233	ah = ((a * t) + 5000) / 10000;
 234	al = a - ah;
 235
 236	*th = t - ah;
 237	*tl = t + al;
 238
 239	return 0;
 240}
 241
 242void r600_gfx_clockgating_enable(struct radeon_device *rdev, bool enable)
 243{
 244	int i;
 245
 246	if (enable) {
 247		WREG32_P(SCLK_PWRMGT_CNTL, DYN_GFX_CLK_OFF_EN, ~DYN_GFX_CLK_OFF_EN);
 248	} else {
 249		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
 250
 251		WREG32(CG_RLC_REQ_AND_RSP, 0x2);
 252
 253		for (i = 0; i < rdev->usec_timeout; i++) {
 254			if (((RREG32(CG_RLC_REQ_AND_RSP) & CG_RLC_RSP_TYPE_MASK) >> CG_RLC_RSP_TYPE_SHIFT) == 1)
 255				break;
 256			udelay(1);
 257		}
 258
 259		WREG32(CG_RLC_REQ_AND_RSP, 0x0);
 260
 261		WREG32(GRBM_PWR_CNTL, 0x1);
 262		RREG32(GRBM_PWR_CNTL);
 263	}
 264}
 265
 266void r600_dynamicpm_enable(struct radeon_device *rdev, bool enable)
 267{
 268	if (enable)
 269		WREG32_P(GENERAL_PWRMGT, GLOBAL_PWRMGT_EN, ~GLOBAL_PWRMGT_EN);
 270	else
 271		WREG32_P(GENERAL_PWRMGT, 0, ~GLOBAL_PWRMGT_EN);
 272}
 273
 274void r600_enable_thermal_protection(struct radeon_device *rdev, bool enable)
 275{
 276	if (enable)
 277		WREG32_P(GENERAL_PWRMGT, 0, ~THERMAL_PROTECTION_DIS);
 278	else
 279		WREG32_P(GENERAL_PWRMGT, THERMAL_PROTECTION_DIS, ~THERMAL_PROTECTION_DIS);
 280}
 281
 282void r600_enable_acpi_pm(struct radeon_device *rdev)
 283{
 284	WREG32_P(GENERAL_PWRMGT, STATIC_PM_EN, ~STATIC_PM_EN);
 285}
 286
 287void r600_enable_dynamic_pcie_gen2(struct radeon_device *rdev, bool enable)
 288{
 289	if (enable)
 290		WREG32_P(GENERAL_PWRMGT, ENABLE_GEN2PCIE, ~ENABLE_GEN2PCIE);
 291	else
 292		WREG32_P(GENERAL_PWRMGT, 0, ~ENABLE_GEN2PCIE);
 293}
 294
 295bool r600_dynamicpm_enabled(struct radeon_device *rdev)
 296{
 297	if (RREG32(GENERAL_PWRMGT) & GLOBAL_PWRMGT_EN)
 298		return true;
 299	else
 300		return false;
 301}
 302
 303void r600_enable_sclk_control(struct radeon_device *rdev, bool enable)
 304{
 305	if (enable)
 306		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~SCLK_PWRMGT_OFF);
 307	else
 308		WREG32_P(SCLK_PWRMGT_CNTL, SCLK_PWRMGT_OFF, ~SCLK_PWRMGT_OFF);
 309}
 310
 311void r600_enable_mclk_control(struct radeon_device *rdev, bool enable)
 312{
 313	if (enable)
 314		WREG32_P(MCLK_PWRMGT_CNTL, 0, ~MPLL_PWRMGT_OFF);
 315	else
 316		WREG32_P(MCLK_PWRMGT_CNTL, MPLL_PWRMGT_OFF, ~MPLL_PWRMGT_OFF);
 317}
 318
 319void r600_enable_spll_bypass(struct radeon_device *rdev, bool enable)
 320{
 321	if (enable)
 322		WREG32_P(CG_SPLL_FUNC_CNTL, SPLL_BYPASS_EN, ~SPLL_BYPASS_EN);
 323	else
 324		WREG32_P(CG_SPLL_FUNC_CNTL, 0, ~SPLL_BYPASS_EN);
 325}
 326
 327void r600_wait_for_spll_change(struct radeon_device *rdev)
 328{
 329	int i;
 330
 331	for (i = 0; i < rdev->usec_timeout; i++) {
 332		if (RREG32(CG_SPLL_FUNC_CNTL) & SPLL_CHG_STATUS)
 333			break;
 334		udelay(1);
 335	}
 336}
 337
 338void r600_set_bsp(struct radeon_device *rdev, u32 u, u32 p)
 339{
 340	WREG32(CG_BSP, BSP(p) | BSU(u));
 341}
 342
 343void r600_set_at(struct radeon_device *rdev,
 344		 u32 l_to_m, u32 m_to_h,
 345		 u32 h_to_m, u32 m_to_l)
 346{
 347	WREG32(CG_RT, FLS(l_to_m) | FMS(m_to_h));
 348	WREG32(CG_LT, FHS(h_to_m) | FMS(m_to_l));
 349}
 350
 351void r600_set_tc(struct radeon_device *rdev,
 352		 u32 index, u32 u_t, u32 d_t)
 353{
 354	WREG32(CG_FFCT_0 + (index * 4), UTC_0(u_t) | DTC_0(d_t));
 355}
 356
 357void r600_select_td(struct radeon_device *rdev,
 358		    enum r600_td td)
 359{
 360	if (td == R600_TD_AUTO)
 361		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_FORCE_TREND_SEL);
 362	else
 363		WREG32_P(SCLK_PWRMGT_CNTL, FIR_FORCE_TREND_SEL, ~FIR_FORCE_TREND_SEL);
 364	if (td == R600_TD_UP)
 365		WREG32_P(SCLK_PWRMGT_CNTL, 0, ~FIR_TREND_MODE);
 366	if (td == R600_TD_DOWN)
 367		WREG32_P(SCLK_PWRMGT_CNTL, FIR_TREND_MODE, ~FIR_TREND_MODE);
 368}
 369
 370void r600_set_vrc(struct radeon_device *rdev, u32 vrv)
 371{
 372	WREG32(CG_FTV, vrv);
 373}
 374
 375void r600_set_tpu(struct radeon_device *rdev, u32 u)
 376{
 377	WREG32_P(CG_TPC, TPU(u), ~TPU_MASK);
 378}
 379
 380void r600_set_tpc(struct radeon_device *rdev, u32 c)
 381{
 382	WREG32_P(CG_TPC, TPCC(c), ~TPCC_MASK);
 383}
 384
 385void r600_set_sstu(struct radeon_device *rdev, u32 u)
 386{
 387	WREG32_P(CG_SSP, CG_SSTU(u), ~CG_SSTU_MASK);
 388}
 389
 390void r600_set_sst(struct radeon_device *rdev, u32 t)
 391{
 392	WREG32_P(CG_SSP, CG_SST(t), ~CG_SST_MASK);
 393}
 394
 395void r600_set_git(struct radeon_device *rdev, u32 t)
 396{
 397	WREG32_P(CG_GIT, CG_GICST(t), ~CG_GICST_MASK);
 398}
 399
 400void r600_set_fctu(struct radeon_device *rdev, u32 u)
 401{
 402	WREG32_P(CG_FC_T, FC_TU(u), ~FC_TU_MASK);
 403}
 404
 405void r600_set_fct(struct radeon_device *rdev, u32 t)
 406{
 407	WREG32_P(CG_FC_T, FC_T(t), ~FC_T_MASK);
 408}
 409
 410void r600_set_ctxcgtt3d_rphc(struct radeon_device *rdev, u32 p)
 411{
 412	WREG32_P(CG_CTX_CGTT3D_R, PHC(p), ~PHC_MASK);
 413}
 414
 415void r600_set_ctxcgtt3d_rsdc(struct radeon_device *rdev, u32 s)
 416{
 417	WREG32_P(CG_CTX_CGTT3D_R, SDC(s), ~SDC_MASK);
 418}
 419
 420void r600_set_vddc3d_oorsu(struct radeon_device *rdev, u32 u)
 421{
 422	WREG32_P(CG_VDDC3D_OOR, SU(u), ~SU_MASK);
 423}
 424
 425void r600_set_vddc3d_oorphc(struct radeon_device *rdev, u32 p)
 426{
 427	WREG32_P(CG_VDDC3D_OOR, PHC(p), ~PHC_MASK);
 428}
 429
 430void r600_set_vddc3d_oorsdc(struct radeon_device *rdev, u32 s)
 431{
 432	WREG32_P(CG_VDDC3D_OOR, SDC(s), ~SDC_MASK);
 433}
 434
 435void r600_set_mpll_lock_time(struct radeon_device *rdev, u32 lock_time)
 436{
 437	WREG32_P(MPLL_TIME, MPLL_LOCK_TIME(lock_time), ~MPLL_LOCK_TIME_MASK);
 438}
 439
 440void r600_set_mpll_reset_time(struct radeon_device *rdev, u32 reset_time)
 441{
 442	WREG32_P(MPLL_TIME, MPLL_RESET_TIME(reset_time), ~MPLL_RESET_TIME_MASK);
 443}
 444
 445void r600_engine_clock_entry_enable(struct radeon_device *rdev,
 446				    u32 index, bool enable)
 447{
 448	if (enable)
 449		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 450			 STEP_0_SPLL_ENTRY_VALID, ~STEP_0_SPLL_ENTRY_VALID);
 451	else
 452		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 453			 0, ~STEP_0_SPLL_ENTRY_VALID);
 454}
 455
 456void r600_engine_clock_entry_enable_pulse_skipping(struct radeon_device *rdev,
 457						   u32 index, bool enable)
 458{
 459	if (enable)
 460		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 461			 STEP_0_SPLL_STEP_ENABLE, ~STEP_0_SPLL_STEP_ENABLE);
 462	else
 463		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 464			 0, ~STEP_0_SPLL_STEP_ENABLE);
 465}
 466
 467void r600_engine_clock_entry_enable_post_divider(struct radeon_device *rdev,
 468						 u32 index, bool enable)
 469{
 470	if (enable)
 471		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 472			 STEP_0_POST_DIV_EN, ~STEP_0_POST_DIV_EN);
 473	else
 474		WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART2 + (index * 4 * 2),
 475			 0, ~STEP_0_POST_DIV_EN);
 476}
 477
 478void r600_engine_clock_entry_set_post_divider(struct radeon_device *rdev,
 479					      u32 index, u32 divider)
 480{
 481	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 482		 STEP_0_SPLL_POST_DIV(divider), ~STEP_0_SPLL_POST_DIV_MASK);
 483}
 484
 485void r600_engine_clock_entry_set_reference_divider(struct radeon_device *rdev,
 486						   u32 index, u32 divider)
 487{
 488	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 489		 STEP_0_SPLL_REF_DIV(divider), ~STEP_0_SPLL_REF_DIV_MASK);
 490}
 491
 492void r600_engine_clock_entry_set_feedback_divider(struct radeon_device *rdev,
 493						  u32 index, u32 divider)
 494{
 495	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 496		 STEP_0_SPLL_FB_DIV(divider), ~STEP_0_SPLL_FB_DIV_MASK);
 497}
 498
 499void r600_engine_clock_entry_set_step_time(struct radeon_device *rdev,
 500					   u32 index, u32 step_time)
 501{
 502	WREG32_P(SCLK_FREQ_SETTING_STEP_0_PART1 + (index * 4 * 2),
 503		 STEP_0_SPLL_STEP_TIME(step_time), ~STEP_0_SPLL_STEP_TIME_MASK);
 504}
 505
 506void r600_vid_rt_set_ssu(struct radeon_device *rdev, u32 u)
 507{
 508	WREG32_P(VID_RT, SSTU(u), ~SSTU_MASK);
 509}
 510
 511void r600_vid_rt_set_vru(struct radeon_device *rdev, u32 u)
 512{
 513	WREG32_P(VID_RT, VID_CRTU(u), ~VID_CRTU_MASK);
 514}
 515
 516void r600_vid_rt_set_vrt(struct radeon_device *rdev, u32 rt)
 517{
 518	WREG32_P(VID_RT, VID_CRT(rt), ~VID_CRT_MASK);
 519}
 520
 521void r600_voltage_control_enable_pins(struct radeon_device *rdev,
 522				      u64 mask)
 523{
 524	WREG32(LOWER_GPIO_ENABLE, mask & 0xffffffff);
 525	WREG32(UPPER_GPIO_ENABLE, upper_32_bits(mask));
 526}
 527
 528
 529void r600_voltage_control_program_voltages(struct radeon_device *rdev,
 530					   enum r600_power_level index, u64 pins)
 531{
 532	u32 tmp, mask;
 533	u32 ix = 3 - (3 & index);
 534
 535	WREG32(CTXSW_VID_LOWER_GPIO_CNTL + (ix * 4), pins & 0xffffffff);
 536
 537	mask = 7 << (3 * ix);
 538	tmp = RREG32(VID_UPPER_GPIO_CNTL);
 539	tmp = (tmp & ~mask) | ((pins >> (32 - (3 * ix))) & mask);
 540	WREG32(VID_UPPER_GPIO_CNTL, tmp);
 541}
 542
 543void r600_voltage_control_deactivate_static_control(struct radeon_device *rdev,
 544						    u64 mask)
 545{
 546	u32 gpio;
 547
 548	gpio = RREG32(GPIOPAD_MASK);
 549	gpio &= ~mask;
 550	WREG32(GPIOPAD_MASK, gpio);
 551
 552	gpio = RREG32(GPIOPAD_EN);
 553	gpio &= ~mask;
 554	WREG32(GPIOPAD_EN, gpio);
 555
 556	gpio = RREG32(GPIOPAD_A);
 557	gpio &= ~mask;
 558	WREG32(GPIOPAD_A, gpio);
 559}
 560
 561void r600_power_level_enable(struct radeon_device *rdev,
 562			     enum r600_power_level index, bool enable)
 563{
 564	u32 ix = 3 - (3 & index);
 565
 566	if (enable)
 567		WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), CTXSW_FREQ_STATE_ENABLE,
 568			 ~CTXSW_FREQ_STATE_ENABLE);
 569	else
 570		WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), 0,
 571			 ~CTXSW_FREQ_STATE_ENABLE);
 572}
 573
 574void r600_power_level_set_voltage_index(struct radeon_device *rdev,
 575					enum r600_power_level index, u32 voltage_index)
 576{
 577	u32 ix = 3 - (3 & index);
 578
 579	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4),
 580		 CTXSW_FREQ_VIDS_CFG_INDEX(voltage_index), ~CTXSW_FREQ_VIDS_CFG_INDEX_MASK);
 581}
 582
 583void r600_power_level_set_mem_clock_index(struct radeon_device *rdev,
 584					  enum r600_power_level index, u32 mem_clock_index)
 585{
 586	u32 ix = 3 - (3 & index);
 587
 588	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4),
 589		 CTXSW_FREQ_MCLK_CFG_INDEX(mem_clock_index), ~CTXSW_FREQ_MCLK_CFG_INDEX_MASK);
 590}
 591
 592void r600_power_level_set_eng_clock_index(struct radeon_device *rdev,
 593					  enum r600_power_level index, u32 eng_clock_index)
 594{
 595	u32 ix = 3 - (3 & index);
 596
 597	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4),
 598		 CTXSW_FREQ_SCLK_CFG_INDEX(eng_clock_index), ~CTXSW_FREQ_SCLK_CFG_INDEX_MASK);
 599}
 600
 601void r600_power_level_set_watermark_id(struct radeon_device *rdev,
 602				       enum r600_power_level index,
 603				       enum r600_display_watermark watermark_id)
 604{
 605	u32 ix = 3 - (3 & index);
 606	u32 tmp = 0;
 607
 608	if (watermark_id == R600_DISPLAY_WATERMARK_HIGH)
 609		tmp = CTXSW_FREQ_DISPLAY_WATERMARK;
 610	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), tmp, ~CTXSW_FREQ_DISPLAY_WATERMARK);
 611}
 612
 613void r600_power_level_set_pcie_gen2(struct radeon_device *rdev,
 614				    enum r600_power_level index, bool compatible)
 615{
 616	u32 ix = 3 - (3 & index);
 617	u32 tmp = 0;
 618
 619	if (compatible)
 620		tmp = CTXSW_FREQ_GEN2PCIE_VOLT;
 621	WREG32_P(CTXSW_PROFILE_INDEX + (ix * 4), tmp, ~CTXSW_FREQ_GEN2PCIE_VOLT);
 622}
 623
 624enum r600_power_level r600_power_level_get_current_index(struct radeon_device *rdev)
 625{
 626	u32 tmp;
 627
 628	tmp = RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_PROFILE_INDEX_MASK;
 629	tmp >>= CURRENT_PROFILE_INDEX_SHIFT;
 630	return tmp;
 631}
 632
 633enum r600_power_level r600_power_level_get_target_index(struct radeon_device *rdev)
 634{
 635	u32 tmp;
 636
 637	tmp = RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & TARGET_PROFILE_INDEX_MASK;
 638	tmp >>= TARGET_PROFILE_INDEX_SHIFT;
 639	return tmp;
 640}
 641
 642void r600_power_level_set_enter_index(struct radeon_device *rdev,
 643				      enum r600_power_level index)
 644{
 645	WREG32_P(TARGET_AND_CURRENT_PROFILE_INDEX, DYN_PWR_ENTER_INDEX(index),
 646		 ~DYN_PWR_ENTER_INDEX_MASK);
 647}
 648
 649void r600_wait_for_power_level_unequal(struct radeon_device *rdev,
 650				       enum r600_power_level index)
 651{
 652	int i;
 653
 654	for (i = 0; i < rdev->usec_timeout; i++) {
 655		if (r600_power_level_get_target_index(rdev) != index)
 656			break;
 657		udelay(1);
 658	}
 659
 660	for (i = 0; i < rdev->usec_timeout; i++) {
 661		if (r600_power_level_get_current_index(rdev) != index)
 662			break;
 663		udelay(1);
 664	}
 665}
 666
 667void r600_wait_for_power_level(struct radeon_device *rdev,
 668			       enum r600_power_level index)
 669{
 670	int i;
 671
 672	for (i = 0; i < rdev->usec_timeout; i++) {
 673		if (r600_power_level_get_target_index(rdev) == index)
 674			break;
 675		udelay(1);
 676	}
 677
 678	for (i = 0; i < rdev->usec_timeout; i++) {
 679		if (r600_power_level_get_current_index(rdev) == index)
 680			break;
 681		udelay(1);
 682	}
 683}
 684
 685void r600_start_dpm(struct radeon_device *rdev)
 686{
 687	r600_enable_sclk_control(rdev, false);
 688	r600_enable_mclk_control(rdev, false);
 689
 690	r600_dynamicpm_enable(rdev, true);
 691
 692	radeon_wait_for_vblank(rdev, 0);
 693	radeon_wait_for_vblank(rdev, 1);
 694
 695	r600_enable_spll_bypass(rdev, true);
 696	r600_wait_for_spll_change(rdev);
 697	r600_enable_spll_bypass(rdev, false);
 698	r600_wait_for_spll_change(rdev);
 699
 700	r600_enable_spll_bypass(rdev, true);
 701	r600_wait_for_spll_change(rdev);
 702	r600_enable_spll_bypass(rdev, false);
 703	r600_wait_for_spll_change(rdev);
 704
 705	r600_enable_sclk_control(rdev, true);
 706	r600_enable_mclk_control(rdev, true);
 707}
 708
 709void r600_stop_dpm(struct radeon_device *rdev)
 710{
 711	r600_dynamicpm_enable(rdev, false);
 712}
 713
 714int r600_dpm_pre_set_power_state(struct radeon_device *rdev)
 715{
 716	return 0;
 717}
 718
 719void r600_dpm_post_set_power_state(struct radeon_device *rdev)
 720{
 721
 722}
 723
 724bool r600_is_uvd_state(u32 class, u32 class2)
 725{
 726	if (class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
 727		return true;
 728	if (class & ATOM_PPLIB_CLASSIFICATION_HD2STATE)
 729		return true;
 730	if (class & ATOM_PPLIB_CLASSIFICATION_HDSTATE)
 731		return true;
 732	if (class & ATOM_PPLIB_CLASSIFICATION_SDSTATE)
 733		return true;
 734	if (class2 & ATOM_PPLIB_CLASSIFICATION2_MVC)
 735		return true;
 736	return false;
 737}
 738
 739static int r600_set_thermal_temperature_range(struct radeon_device *rdev,
 740					      int min_temp, int max_temp)
 741{
 742	int low_temp = 0 * 1000;
 743	int high_temp = 255 * 1000;
 744
 745	if (low_temp < min_temp)
 746		low_temp = min_temp;
 747	if (high_temp > max_temp)
 748		high_temp = max_temp;
 749	if (high_temp < low_temp) {
 750		DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
 751		return -EINVAL;
 752	}
 753
 754	WREG32_P(CG_THERMAL_INT, DIG_THERM_INTH(high_temp / 1000), ~DIG_THERM_INTH_MASK);
 755	WREG32_P(CG_THERMAL_INT, DIG_THERM_INTL(low_temp / 1000), ~DIG_THERM_INTL_MASK);
 756	WREG32_P(CG_THERMAL_CTRL, DIG_THERM_DPM(high_temp / 1000), ~DIG_THERM_DPM_MASK);
 757
 758	rdev->pm.dpm.thermal.min_temp = low_temp;
 759	rdev->pm.dpm.thermal.max_temp = high_temp;
 760
 761	return 0;
 762}
 763
 764bool r600_is_internal_thermal_sensor(enum radeon_int_thermal_type sensor)
 765{
 766	switch (sensor) {
 767	case THERMAL_TYPE_RV6XX:
 768	case THERMAL_TYPE_RV770:
 769	case THERMAL_TYPE_EVERGREEN:
 770	case THERMAL_TYPE_SUMO:
 771	case THERMAL_TYPE_NI:
 772	case THERMAL_TYPE_SI:
 773	case THERMAL_TYPE_CI:
 774	case THERMAL_TYPE_KV:
 775		return true;
 776	case THERMAL_TYPE_ADT7473_WITH_INTERNAL:
 777	case THERMAL_TYPE_EMC2103_WITH_INTERNAL:
 778		return false; /* need special handling */
 779	case THERMAL_TYPE_NONE:
 780	case THERMAL_TYPE_EXTERNAL:
 781	case THERMAL_TYPE_EXTERNAL_GPIO:
 782	default:
 783		return false;
 784	}
 785}
 786
 787int r600_dpm_late_enable(struct radeon_device *rdev)
 788{
 789	int ret;
 790
 791	if (rdev->irq.installed &&
 792	    r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
 793		ret = r600_set_thermal_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
 794		if (ret)
 795			return ret;
 796		rdev->irq.dpm_thermal = true;
 797		radeon_irq_set(rdev);
 798	}
 799
 800	return 0;
 801}
 802
 803union power_info {
 804	struct _ATOM_POWERPLAY_INFO info;
 805	struct _ATOM_POWERPLAY_INFO_V2 info_2;
 806	struct _ATOM_POWERPLAY_INFO_V3 info_3;
 807	struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
 808	struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
 809	struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
 810	struct _ATOM_PPLIB_POWERPLAYTABLE4 pplib4;
 811	struct _ATOM_PPLIB_POWERPLAYTABLE5 pplib5;
 812};
 813
 814union fan_info {
 815	struct _ATOM_PPLIB_FANTABLE fan;
 816	struct _ATOM_PPLIB_FANTABLE2 fan2;
 817	struct _ATOM_PPLIB_FANTABLE3 fan3;
 818};
 819
 820static int r600_parse_clk_voltage_dep_table(struct radeon_clock_voltage_dependency_table *radeon_table,
 821					    ATOM_PPLIB_Clock_Voltage_Dependency_Table *atom_table)
 822{
 
 
 823	int i;
 824	ATOM_PPLIB_Clock_Voltage_Dependency_Record *entry;
 825
 826	radeon_table->entries = kcalloc(atom_table->ucNumEntries,
 827					sizeof(struct radeon_clock_voltage_dependency_entry),
 828					GFP_KERNEL);
 829	if (!radeon_table->entries)
 830		return -ENOMEM;
 831
 832	entry = &atom_table->entries[0];
 833	for (i = 0; i < atom_table->ucNumEntries; i++) {
 834		radeon_table->entries[i].clk = le16_to_cpu(entry->usClockLow) |
 835			(entry->ucClockHigh << 16);
 836		radeon_table->entries[i].v = le16_to_cpu(entry->usVoltage);
 837		entry = (ATOM_PPLIB_Clock_Voltage_Dependency_Record *)
 838			((u8 *)entry + sizeof(ATOM_PPLIB_Clock_Voltage_Dependency_Record));
 839	}
 840	radeon_table->count = atom_table->ucNumEntries;
 841
 842	return 0;
 843}
 844
 845int r600_get_platform_caps(struct radeon_device *rdev)
 846{
 847	struct radeon_mode_info *mode_info = &rdev->mode_info;
 848	union power_info *power_info;
 849	int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
 850	u16 data_offset;
 851	u8 frev, crev;
 852
 853	if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
 854				   &frev, &crev, &data_offset))
 855		return -EINVAL;
 856	power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
 857
 858	rdev->pm.dpm.platform_caps = le32_to_cpu(power_info->pplib.ulPlatformCaps);
 859	rdev->pm.dpm.backbias_response_time = le16_to_cpu(power_info->pplib.usBackbiasTime);
 860	rdev->pm.dpm.voltage_response_time = le16_to_cpu(power_info->pplib.usVoltageTime);
 861
 862	return 0;
 863}
 864
 865/* sizeof(ATOM_PPLIB_EXTENDEDHEADER) */
 866#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V2 12
 867#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V3 14
 868#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V4 16
 869#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V5 18
 870#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V6 20
 871#define SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V7 22
 872
 873int r600_parse_extended_power_table(struct radeon_device *rdev)
 874{
 875	struct radeon_mode_info *mode_info = &rdev->mode_info;
 876	union power_info *power_info;
 877	union fan_info *fan_info;
 878	ATOM_PPLIB_Clock_Voltage_Dependency_Table *dep_table;
 879	int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
 880	u16 data_offset;
 881	u8 frev, crev;
 882	int ret, i;
 883
 884	if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
 885				   &frev, &crev, &data_offset))
 886		return -EINVAL;
 887	power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
 888
 889	/* fan table */
 890	if (le16_to_cpu(power_info->pplib.usTableSize) >=
 891	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE3)) {
 892		if (power_info->pplib3.usFanTableOffset) {
 893			fan_info = (union fan_info *)(mode_info->atom_context->bios + data_offset +
 894						      le16_to_cpu(power_info->pplib3.usFanTableOffset));
 895			rdev->pm.dpm.fan.t_hyst = fan_info->fan.ucTHyst;
 896			rdev->pm.dpm.fan.t_min = le16_to_cpu(fan_info->fan.usTMin);
 897			rdev->pm.dpm.fan.t_med = le16_to_cpu(fan_info->fan.usTMed);
 898			rdev->pm.dpm.fan.t_high = le16_to_cpu(fan_info->fan.usTHigh);
 899			rdev->pm.dpm.fan.pwm_min = le16_to_cpu(fan_info->fan.usPWMMin);
 900			rdev->pm.dpm.fan.pwm_med = le16_to_cpu(fan_info->fan.usPWMMed);
 901			rdev->pm.dpm.fan.pwm_high = le16_to_cpu(fan_info->fan.usPWMHigh);
 902			if (fan_info->fan.ucFanTableFormat >= 2)
 903				rdev->pm.dpm.fan.t_max = le16_to_cpu(fan_info->fan2.usTMax);
 904			else
 905				rdev->pm.dpm.fan.t_max = 10900;
 906			rdev->pm.dpm.fan.cycle_delay = 100000;
 907			if (fan_info->fan.ucFanTableFormat >= 3) {
 908				rdev->pm.dpm.fan.control_mode = fan_info->fan3.ucFanControlMode;
 909				rdev->pm.dpm.fan.default_max_fan_pwm =
 910					le16_to_cpu(fan_info->fan3.usFanPWMMax);
 911				rdev->pm.dpm.fan.default_fan_output_sensitivity = 4836;
 912				rdev->pm.dpm.fan.fan_output_sensitivity =
 913					le16_to_cpu(fan_info->fan3.usFanOutputSensitivity);
 914			}
 915			rdev->pm.dpm.fan.ucode_fan_control = true;
 916		}
 917	}
 918
 919	/* clock dependancy tables, shedding tables */
 920	if (le16_to_cpu(power_info->pplib.usTableSize) >=
 921	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE4)) {
 922		if (power_info->pplib4.usVddcDependencyOnSCLKOffset) {
 923			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 924				(mode_info->atom_context->bios + data_offset +
 925				 le16_to_cpu(power_info->pplib4.usVddcDependencyOnSCLKOffset));
 926			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk,
 927							       dep_table);
 928			if (ret)
 929				return ret;
 930		}
 931		if (power_info->pplib4.usVddciDependencyOnMCLKOffset) {
 932			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 933				(mode_info->atom_context->bios + data_offset +
 934				 le16_to_cpu(power_info->pplib4.usVddciDependencyOnMCLKOffset));
 935			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk,
 936							       dep_table);
 937			if (ret) {
 938				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries);
 939				return ret;
 940			}
 941		}
 942		if (power_info->pplib4.usVddcDependencyOnMCLKOffset) {
 943			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 944				(mode_info->atom_context->bios + data_offset +
 945				 le16_to_cpu(power_info->pplib4.usVddcDependencyOnMCLKOffset));
 946			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk,
 947							       dep_table);
 948			if (ret) {
 949				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries);
 950				kfree(rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk.entries);
 951				return ret;
 952			}
 953		}
 954		if (power_info->pplib4.usMvddDependencyOnMCLKOffset) {
 955			dep_table = (ATOM_PPLIB_Clock_Voltage_Dependency_Table *)
 956				(mode_info->atom_context->bios + data_offset +
 957				 le16_to_cpu(power_info->pplib4.usMvddDependencyOnMCLKOffset));
 958			ret = r600_parse_clk_voltage_dep_table(&rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk,
 959							       dep_table);
 960			if (ret) {
 961				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries);
 962				kfree(rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk.entries);
 963				kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk.entries);
 964				return ret;
 965			}
 966		}
 967		if (power_info->pplib4.usMaxClockVoltageOnDCOffset) {
 968			ATOM_PPLIB_Clock_Voltage_Limit_Table *clk_v =
 969				(ATOM_PPLIB_Clock_Voltage_Limit_Table *)
 970				(mode_info->atom_context->bios + data_offset +
 971				 le16_to_cpu(power_info->pplib4.usMaxClockVoltageOnDCOffset));
 972			if (clk_v->ucNumEntries) {
 973				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.sclk =
 974					le16_to_cpu(clk_v->entries[0].usSclkLow) |
 975					(clk_v->entries[0].ucSclkHigh << 16);
 976				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.mclk =
 977					le16_to_cpu(clk_v->entries[0].usMclkLow) |
 978					(clk_v->entries[0].ucMclkHigh << 16);
 979				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.vddc =
 980					le16_to_cpu(clk_v->entries[0].usVddc);
 981				rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.vddci =
 982					le16_to_cpu(clk_v->entries[0].usVddci);
 983			}
 984		}
 985		if (power_info->pplib4.usVddcPhaseShedLimitsTableOffset) {
 986			ATOM_PPLIB_PhaseSheddingLimits_Table *psl =
 987				(ATOM_PPLIB_PhaseSheddingLimits_Table *)
 988				(mode_info->atom_context->bios + data_offset +
 989				 le16_to_cpu(power_info->pplib4.usVddcPhaseShedLimitsTableOffset));
 990			ATOM_PPLIB_PhaseSheddingLimits_Record *entry;
 991
 992			rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries =
 993				kcalloc(psl->ucNumEntries,
 994					sizeof(struct radeon_phase_shedding_limits_entry),
 995					GFP_KERNEL);
 996			if (!rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries) {
 997				r600_free_extended_power_table(rdev);
 998				return -ENOMEM;
 999			}
1000
1001			entry = &psl->entries[0];
1002			for (i = 0; i < psl->ucNumEntries; i++) {
1003				rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries[i].sclk =
1004					le16_to_cpu(entry->usSclkLow) | (entry->ucSclkHigh << 16);
1005				rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries[i].mclk =
1006					le16_to_cpu(entry->usMclkLow) | (entry->ucMclkHigh << 16);
1007				rdev->pm.dpm.dyn_state.phase_shedding_limits_table.entries[i].voltage =
1008					le16_to_cpu(entry->usVoltage);
1009				entry = (ATOM_PPLIB_PhaseSheddingLimits_Record *)
1010					((u8 *)entry + sizeof(ATOM_PPLIB_PhaseSheddingLimits_Record));
1011			}
1012			rdev->pm.dpm.dyn_state.phase_shedding_limits_table.count =
1013				psl->ucNumEntries;
1014		}
1015	}
1016
1017	/* cac data */
1018	if (le16_to_cpu(power_info->pplib.usTableSize) >=
1019	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE5)) {
1020		rdev->pm.dpm.tdp_limit = le32_to_cpu(power_info->pplib5.ulTDPLimit);
1021		rdev->pm.dpm.near_tdp_limit = le32_to_cpu(power_info->pplib5.ulNearTDPLimit);
1022		rdev->pm.dpm.near_tdp_limit_adjusted = rdev->pm.dpm.near_tdp_limit;
1023		rdev->pm.dpm.tdp_od_limit = le16_to_cpu(power_info->pplib5.usTDPODLimit);
1024		if (rdev->pm.dpm.tdp_od_limit)
1025			rdev->pm.dpm.power_control = true;
1026		else
1027			rdev->pm.dpm.power_control = false;
1028		rdev->pm.dpm.tdp_adjustment = 0;
1029		rdev->pm.dpm.sq_ramping_threshold = le32_to_cpu(power_info->pplib5.ulSQRampingThreshold);
1030		rdev->pm.dpm.cac_leakage = le32_to_cpu(power_info->pplib5.ulCACLeakage);
1031		rdev->pm.dpm.load_line_slope = le16_to_cpu(power_info->pplib5.usLoadLineSlope);
1032		if (power_info->pplib5.usCACLeakageTableOffset) {
1033			ATOM_PPLIB_CAC_Leakage_Table *cac_table =
1034				(ATOM_PPLIB_CAC_Leakage_Table *)
1035				(mode_info->atom_context->bios + data_offset +
1036				 le16_to_cpu(power_info->pplib5.usCACLeakageTableOffset));
1037			ATOM_PPLIB_CAC_Leakage_Record *entry;
1038			u32 size = cac_table->ucNumEntries * sizeof(struct radeon_cac_leakage_table);
1039			rdev->pm.dpm.dyn_state.cac_leakage_table.entries = kzalloc(size, GFP_KERNEL);
1040			if (!rdev->pm.dpm.dyn_state.cac_leakage_table.entries) {
1041				r600_free_extended_power_table(rdev);
1042				return -ENOMEM;
1043			}
1044			entry = &cac_table->entries[0];
1045			for (i = 0; i < cac_table->ucNumEntries; i++) {
1046				if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_EVV) {
1047					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc1 =
1048						le16_to_cpu(entry->usVddc1);
1049					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc2 =
1050						le16_to_cpu(entry->usVddc2);
1051					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc3 =
1052						le16_to_cpu(entry->usVddc3);
1053				} else {
1054					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc =
1055						le16_to_cpu(entry->usVddc);
1056					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].leakage =
1057						le32_to_cpu(entry->ulLeakageValue);
1058				}
1059				entry = (ATOM_PPLIB_CAC_Leakage_Record *)
1060					((u8 *)entry + sizeof(ATOM_PPLIB_CAC_Leakage_Record));
1061			}
1062			rdev->pm.dpm.dyn_state.cac_leakage_table.count = cac_table->ucNumEntries;
1063		}
1064	}
1065
1066	/* ext tables */
1067	if (le16_to_cpu(power_info->pplib.usTableSize) >=
1068	    sizeof(struct _ATOM_PPLIB_POWERPLAYTABLE3)) {
1069		ATOM_PPLIB_EXTENDEDHEADER *ext_hdr = (ATOM_PPLIB_EXTENDEDHEADER *)
1070			(mode_info->atom_context->bios + data_offset +
1071			 le16_to_cpu(power_info->pplib3.usExtendendedHeaderOffset));
1072		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V2) &&
1073			ext_hdr->usVCETableOffset) {
1074			VCEClockInfoArray *array = (VCEClockInfoArray *)
1075				(mode_info->atom_context->bios + data_offset +
1076				 le16_to_cpu(ext_hdr->usVCETableOffset) + 1);
1077			ATOM_PPLIB_VCE_Clock_Voltage_Limit_Table *limits =
1078				(ATOM_PPLIB_VCE_Clock_Voltage_Limit_Table *)
1079				(mode_info->atom_context->bios + data_offset +
1080				 le16_to_cpu(ext_hdr->usVCETableOffset) + 1 +
1081				 1 + array->ucNumEntries * sizeof(VCEClockInfo));
1082			ATOM_PPLIB_VCE_State_Table *states =
1083				(ATOM_PPLIB_VCE_State_Table *)
1084				(mode_info->atom_context->bios + data_offset +
1085				 le16_to_cpu(ext_hdr->usVCETableOffset) + 1 +
1086				 1 + (array->ucNumEntries * sizeof (VCEClockInfo)) +
1087				 1 + (limits->numEntries * sizeof(ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record)));
1088			ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record *entry;
1089			ATOM_PPLIB_VCE_State_Record *state_entry;
1090			VCEClockInfo *vce_clk;
1091			u32 size = limits->numEntries *
1092				sizeof(struct radeon_vce_clock_voltage_dependency_entry);
1093			rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries =
1094				kzalloc(size, GFP_KERNEL);
1095			if (!rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries) {
1096				r600_free_extended_power_table(rdev);
1097				return -ENOMEM;
1098			}
1099			rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.count =
1100				limits->numEntries;
1101			entry = &limits->entries[0];
1102			state_entry = &states->entries[0];
1103			for (i = 0; i < limits->numEntries; i++) {
1104				vce_clk = (VCEClockInfo *)
1105					((u8 *)&array->entries[0] +
1106					 (entry->ucVCEClockInfoIndex * sizeof(VCEClockInfo)));
1107				rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[i].evclk =
1108					le16_to_cpu(vce_clk->usEVClkLow) | (vce_clk->ucEVClkHigh << 16);
1109				rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[i].ecclk =
1110					le16_to_cpu(vce_clk->usECClkLow) | (vce_clk->ucECClkHigh << 16);
1111				rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[i].v =
1112					le16_to_cpu(entry->usVoltage);
1113				entry = (ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record *)
1114					((u8 *)entry + sizeof(ATOM_PPLIB_VCE_Clock_Voltage_Limit_Record));
1115			}
1116			for (i = 0; i < states->numEntries; i++) {
1117				if (i >= RADEON_MAX_VCE_LEVELS)
1118					break;
1119				vce_clk = (VCEClockInfo *)
1120					((u8 *)&array->entries[0] +
1121					 (state_entry->ucVCEClockInfoIndex * sizeof(VCEClockInfo)));
1122				rdev->pm.dpm.vce_states[i].evclk =
1123					le16_to_cpu(vce_clk->usEVClkLow) | (vce_clk->ucEVClkHigh << 16);
1124				rdev->pm.dpm.vce_states[i].ecclk =
1125					le16_to_cpu(vce_clk->usECClkLow) | (vce_clk->ucECClkHigh << 16);
1126				rdev->pm.dpm.vce_states[i].clk_idx =
1127					state_entry->ucClockInfoIndex & 0x3f;
1128				rdev->pm.dpm.vce_states[i].pstate =
1129					(state_entry->ucClockInfoIndex & 0xc0) >> 6;
1130				state_entry = (ATOM_PPLIB_VCE_State_Record *)
1131					((u8 *)state_entry + sizeof(ATOM_PPLIB_VCE_State_Record));
1132			}
1133		}
1134		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V3) &&
1135			ext_hdr->usUVDTableOffset) {
1136			UVDClockInfoArray *array = (UVDClockInfoArray *)
1137				(mode_info->atom_context->bios + data_offset +
1138				 le16_to_cpu(ext_hdr->usUVDTableOffset) + 1);
1139			ATOM_PPLIB_UVD_Clock_Voltage_Limit_Table *limits =
1140				(ATOM_PPLIB_UVD_Clock_Voltage_Limit_Table *)
1141				(mode_info->atom_context->bios + data_offset +
1142				 le16_to_cpu(ext_hdr->usUVDTableOffset) + 1 +
1143				 1 + (array->ucNumEntries * sizeof (UVDClockInfo)));
1144			ATOM_PPLIB_UVD_Clock_Voltage_Limit_Record *entry;
1145			u32 size = limits->numEntries *
1146				sizeof(struct radeon_uvd_clock_voltage_dependency_entry);
1147			rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries =
1148				kzalloc(size, GFP_KERNEL);
1149			if (!rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries) {
1150				r600_free_extended_power_table(rdev);
1151				return -ENOMEM;
1152			}
1153			rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.count =
1154				limits->numEntries;
1155			entry = &limits->entries[0];
1156			for (i = 0; i < limits->numEntries; i++) {
1157				UVDClockInfo *uvd_clk = (UVDClockInfo *)
1158					((u8 *)&array->entries[0] +
1159					 (entry->ucUVDClockInfoIndex * sizeof(UVDClockInfo)));
1160				rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[i].vclk =
1161					le16_to_cpu(uvd_clk->usVClkLow) | (uvd_clk->ucVClkHigh << 16);
1162				rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[i].dclk =
1163					le16_to_cpu(uvd_clk->usDClkLow) | (uvd_clk->ucDClkHigh << 16);
1164				rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[i].v =
1165					le16_to_cpu(entry->usVoltage);
1166				entry = (ATOM_PPLIB_UVD_Clock_Voltage_Limit_Record *)
1167					((u8 *)entry + sizeof(ATOM_PPLIB_UVD_Clock_Voltage_Limit_Record));
1168			}
1169		}
1170		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V4) &&
1171			ext_hdr->usSAMUTableOffset) {
1172			ATOM_PPLIB_SAMClk_Voltage_Limit_Table *limits =
1173				(ATOM_PPLIB_SAMClk_Voltage_Limit_Table *)
1174				(mode_info->atom_context->bios + data_offset +
1175				 le16_to_cpu(ext_hdr->usSAMUTableOffset) + 1);
1176			ATOM_PPLIB_SAMClk_Voltage_Limit_Record *entry;
1177			u32 size = limits->numEntries *
1178				sizeof(struct radeon_clock_voltage_dependency_entry);
1179			rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries =
1180				kzalloc(size, GFP_KERNEL);
1181			if (!rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries) {
1182				r600_free_extended_power_table(rdev);
1183				return -ENOMEM;
1184			}
1185			rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.count =
1186				limits->numEntries;
1187			entry = &limits->entries[0];
1188			for (i = 0; i < limits->numEntries; i++) {
1189				rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries[i].clk =
1190					le16_to_cpu(entry->usSAMClockLow) | (entry->ucSAMClockHigh << 16);
1191				rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries[i].v =
1192					le16_to_cpu(entry->usVoltage);
1193				entry = (ATOM_PPLIB_SAMClk_Voltage_Limit_Record *)
1194					((u8 *)entry + sizeof(ATOM_PPLIB_SAMClk_Voltage_Limit_Record));
1195			}
1196		}
1197		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V5) &&
1198		    ext_hdr->usPPMTableOffset) {
1199			ATOM_PPLIB_PPM_Table *ppm = (ATOM_PPLIB_PPM_Table *)
1200				(mode_info->atom_context->bios + data_offset +
1201				 le16_to_cpu(ext_hdr->usPPMTableOffset));
1202			rdev->pm.dpm.dyn_state.ppm_table =
1203				kzalloc(sizeof(struct radeon_ppm_table), GFP_KERNEL);
1204			if (!rdev->pm.dpm.dyn_state.ppm_table) {
1205				r600_free_extended_power_table(rdev);
1206				return -ENOMEM;
1207			}
1208			rdev->pm.dpm.dyn_state.ppm_table->ppm_design = ppm->ucPpmDesign;
1209			rdev->pm.dpm.dyn_state.ppm_table->cpu_core_number =
1210				le16_to_cpu(ppm->usCpuCoreNumber);
1211			rdev->pm.dpm.dyn_state.ppm_table->platform_tdp =
1212				le32_to_cpu(ppm->ulPlatformTDP);
1213			rdev->pm.dpm.dyn_state.ppm_table->small_ac_platform_tdp =
1214				le32_to_cpu(ppm->ulSmallACPlatformTDP);
1215			rdev->pm.dpm.dyn_state.ppm_table->platform_tdc =
1216				le32_to_cpu(ppm->ulPlatformTDC);
1217			rdev->pm.dpm.dyn_state.ppm_table->small_ac_platform_tdc =
1218				le32_to_cpu(ppm->ulSmallACPlatformTDC);
1219			rdev->pm.dpm.dyn_state.ppm_table->apu_tdp =
1220				le32_to_cpu(ppm->ulApuTDP);
1221			rdev->pm.dpm.dyn_state.ppm_table->dgpu_tdp =
1222				le32_to_cpu(ppm->ulDGpuTDP);
1223			rdev->pm.dpm.dyn_state.ppm_table->dgpu_ulv_power =
1224				le32_to_cpu(ppm->ulDGpuUlvPower);
1225			rdev->pm.dpm.dyn_state.ppm_table->tj_max =
1226				le32_to_cpu(ppm->ulTjmax);
1227		}
1228		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V6) &&
1229			ext_hdr->usACPTableOffset) {
1230			ATOM_PPLIB_ACPClk_Voltage_Limit_Table *limits =
1231				(ATOM_PPLIB_ACPClk_Voltage_Limit_Table *)
1232				(mode_info->atom_context->bios + data_offset +
1233				 le16_to_cpu(ext_hdr->usACPTableOffset) + 1);
1234			ATOM_PPLIB_ACPClk_Voltage_Limit_Record *entry;
1235			u32 size = limits->numEntries *
1236				sizeof(struct radeon_clock_voltage_dependency_entry);
1237			rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries =
1238				kzalloc(size, GFP_KERNEL);
1239			if (!rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries) {
1240				r600_free_extended_power_table(rdev);
1241				return -ENOMEM;
1242			}
1243			rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.count =
1244				limits->numEntries;
1245			entry = &limits->entries[0];
1246			for (i = 0; i < limits->numEntries; i++) {
1247				rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries[i].clk =
1248					le16_to_cpu(entry->usACPClockLow) | (entry->ucACPClockHigh << 16);
1249				rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries[i].v =
1250					le16_to_cpu(entry->usVoltage);
1251				entry = (ATOM_PPLIB_ACPClk_Voltage_Limit_Record *)
1252					((u8 *)entry + sizeof(ATOM_PPLIB_ACPClk_Voltage_Limit_Record));
1253			}
1254		}
1255		if ((le16_to_cpu(ext_hdr->usSize) >= SIZE_OF_ATOM_PPLIB_EXTENDEDHEADER_V7) &&
1256			ext_hdr->usPowerTuneTableOffset) {
1257			u8 rev = *(u8 *)(mode_info->atom_context->bios + data_offset +
1258					 le16_to_cpu(ext_hdr->usPowerTuneTableOffset));
1259			ATOM_PowerTune_Table *pt;
1260			rdev->pm.dpm.dyn_state.cac_tdp_table =
1261				kzalloc(sizeof(struct radeon_cac_tdp_table), GFP_KERNEL);
1262			if (!rdev->pm.dpm.dyn_state.cac_tdp_table) {
1263				r600_free_extended_power_table(rdev);
1264				return -ENOMEM;
1265			}
1266			if (rev > 0) {
1267				ATOM_PPLIB_POWERTUNE_Table_V1 *ppt = (ATOM_PPLIB_POWERTUNE_Table_V1 *)
1268					(mode_info->atom_context->bios + data_offset +
1269					 le16_to_cpu(ext_hdr->usPowerTuneTableOffset));
1270				rdev->pm.dpm.dyn_state.cac_tdp_table->maximum_power_delivery_limit =
1271					le16_to_cpu(ppt->usMaximumPowerDeliveryLimit);
1272				pt = &ppt->power_tune_table;
1273			} else {
1274				ATOM_PPLIB_POWERTUNE_Table *ppt = (ATOM_PPLIB_POWERTUNE_Table *)
1275					(mode_info->atom_context->bios + data_offset +
1276					 le16_to_cpu(ext_hdr->usPowerTuneTableOffset));
1277				rdev->pm.dpm.dyn_state.cac_tdp_table->maximum_power_delivery_limit = 255;
1278				pt = &ppt->power_tune_table;
1279			}
1280			rdev->pm.dpm.dyn_state.cac_tdp_table->tdp = le16_to_cpu(pt->usTDP);
1281			rdev->pm.dpm.dyn_state.cac_tdp_table->configurable_tdp =
1282				le16_to_cpu(pt->usConfigurableTDP);
1283			rdev->pm.dpm.dyn_state.cac_tdp_table->tdc = le16_to_cpu(pt->usTDC);
1284			rdev->pm.dpm.dyn_state.cac_tdp_table->battery_power_limit =
1285				le16_to_cpu(pt->usBatteryPowerLimit);
1286			rdev->pm.dpm.dyn_state.cac_tdp_table->small_power_limit =
1287				le16_to_cpu(pt->usSmallPowerLimit);
1288			rdev->pm.dpm.dyn_state.cac_tdp_table->low_cac_leakage =
1289				le16_to_cpu(pt->usLowCACLeakage);
1290			rdev->pm.dpm.dyn_state.cac_tdp_table->high_cac_leakage =
1291				le16_to_cpu(pt->usHighCACLeakage);
1292		}
1293	}
1294
1295	return 0;
1296}
1297
1298void r600_free_extended_power_table(struct radeon_device *rdev)
1299{
1300	struct radeon_dpm_dynamic_state *dyn_state = &rdev->pm.dpm.dyn_state;
1301
1302	kfree(dyn_state->vddc_dependency_on_sclk.entries);
1303	kfree(dyn_state->vddci_dependency_on_mclk.entries);
1304	kfree(dyn_state->vddc_dependency_on_mclk.entries);
1305	kfree(dyn_state->mvdd_dependency_on_mclk.entries);
1306	kfree(dyn_state->cac_leakage_table.entries);
1307	kfree(dyn_state->phase_shedding_limits_table.entries);
1308	kfree(dyn_state->ppm_table);
1309	kfree(dyn_state->cac_tdp_table);
1310	kfree(dyn_state->vce_clock_voltage_dependency_table.entries);
1311	kfree(dyn_state->uvd_clock_voltage_dependency_table.entries);
1312	kfree(dyn_state->samu_clock_voltage_dependency_table.entries);
1313	kfree(dyn_state->acp_clock_voltage_dependency_table.entries);
1314}
1315
1316enum radeon_pcie_gen r600_get_pcie_gen_support(struct radeon_device *rdev,
1317					       u32 sys_mask,
1318					       enum radeon_pcie_gen asic_gen,
1319					       enum radeon_pcie_gen default_gen)
1320{
1321	switch (asic_gen) {
1322	case RADEON_PCIE_GEN1:
1323		return RADEON_PCIE_GEN1;
1324	case RADEON_PCIE_GEN2:
1325		return RADEON_PCIE_GEN2;
1326	case RADEON_PCIE_GEN3:
1327		return RADEON_PCIE_GEN3;
1328	default:
1329		if ((sys_mask & RADEON_PCIE_SPEED_80) && (default_gen == RADEON_PCIE_GEN3))
1330			return RADEON_PCIE_GEN3;
1331		else if ((sys_mask & RADEON_PCIE_SPEED_50) && (default_gen == RADEON_PCIE_GEN2))
1332			return RADEON_PCIE_GEN2;
1333		else
1334			return RADEON_PCIE_GEN1;
1335	}
1336	return RADEON_PCIE_GEN1;
1337}
1338
1339u16 r600_get_pcie_lane_support(struct radeon_device *rdev,
1340			       u16 asic_lanes,
1341			       u16 default_lanes)
1342{
1343	switch (asic_lanes) {
1344	case 0:
1345	default:
1346		return default_lanes;
1347	case 1:
1348		return 1;
1349	case 2:
1350		return 2;
1351	case 4:
1352		return 4;
1353	case 8:
1354		return 8;
1355	case 12:
1356		return 12;
1357	case 16:
1358		return 16;
1359	}
1360}
1361
1362u8 r600_encode_pci_lane_width(u32 lanes)
1363{
1364	static const u8 encoded_lanes[] = {
1365		0, 1, 2, 0, 3, 0, 0, 0, 4, 0, 0, 0, 5, 0, 0, 0, 6
1366	};
1367
1368	if (lanes > 16)
1369		return 0;
1370
1371	return encoded_lanes[lanes];
1372}