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