Bug Summary

File:dev/pci/drm/radeon/rv6xx_dpm.c
Warning:line 253, column 41
The left operand of '>=' is a garbage value

Annotated Source Code

Press '?' to see keyboard shortcuts

clang -cc1 -cc1 -triple amd64-unknown-openbsd7.0 -analyze -disable-free -disable-llvm-verifier -discard-value-names -main-file-name rv6xx_dpm.c -analyzer-store=region -analyzer-opt-analyze-nested-blocks -analyzer-checker=core -analyzer-checker=apiModeling -analyzer-checker=unix -analyzer-checker=deadcode -analyzer-checker=security.insecureAPI.UncheckedReturn -analyzer-checker=security.insecureAPI.getpw -analyzer-checker=security.insecureAPI.gets -analyzer-checker=security.insecureAPI.mktemp -analyzer-checker=security.insecureAPI.mkstemp -analyzer-checker=security.insecureAPI.vfork -analyzer-checker=nullability.NullPassedToNonnull -analyzer-checker=nullability.NullReturnedFromNonnull -analyzer-output plist -w -setup-static-analyzer -mrelocation-model static -mframe-pointer=all -relaxed-aliasing -fno-rounding-math -mconstructor-aliases -ffreestanding -mcmodel=kernel -target-cpu x86-64 -target-feature +retpoline-indirect-calls -target-feature +retpoline-indirect-branches -target-feature -sse2 -target-feature -sse -target-feature -3dnow -target-feature -mmx -target-feature +save-args -disable-red-zone -no-implicit-float -tune-cpu generic -debugger-tuning=gdb -fcoverage-compilation-dir=/usr/src/sys/arch/amd64/compile/GENERIC.MP/obj -nostdsysteminc -nobuiltininc -resource-dir /usr/local/lib/clang/13.0.0 -I /usr/src/sys -I /usr/src/sys/arch/amd64/compile/GENERIC.MP/obj -I /usr/src/sys/arch -I /usr/src/sys/dev/pci/drm/include -I /usr/src/sys/dev/pci/drm/include/uapi -I /usr/src/sys/dev/pci/drm/amd/include/asic_reg -I /usr/src/sys/dev/pci/drm/amd/include -I /usr/src/sys/dev/pci/drm/amd/amdgpu -I /usr/src/sys/dev/pci/drm/amd/display -I /usr/src/sys/dev/pci/drm/amd/display/include -I /usr/src/sys/dev/pci/drm/amd/display/dc -I /usr/src/sys/dev/pci/drm/amd/display/amdgpu_dm -I /usr/src/sys/dev/pci/drm/amd/pm/inc -I /usr/src/sys/dev/pci/drm/amd/pm/swsmu -I /usr/src/sys/dev/pci/drm/amd/pm/swsmu/smu11 -I /usr/src/sys/dev/pci/drm/amd/pm/swsmu/smu12 -I /usr/src/sys/dev/pci/drm/amd/pm/powerplay -I /usr/src/sys/dev/pci/drm/amd/pm/powerplay/hwmgr -I /usr/src/sys/dev/pci/drm/amd/pm/powerplay/smumgr -I /usr/src/sys/dev/pci/drm/amd/display/dc/inc -I /usr/src/sys/dev/pci/drm/amd/display/dc/inc/hw -I /usr/src/sys/dev/pci/drm/amd/display/dc/clk_mgr -I /usr/src/sys/dev/pci/drm/amd/display/modules/inc -I /usr/src/sys/dev/pci/drm/amd/display/modules/hdcp -I /usr/src/sys/dev/pci/drm/amd/display/dmub/inc -I /usr/src/sys/dev/pci/drm/i915 -D DDB -D DIAGNOSTIC -D KTRACE -D ACCOUNTING -D KMEMSTATS -D PTRACE -D POOL_DEBUG -D CRYPTO -D SYSVMSG -D SYSVSEM -D SYSVSHM -D UVM_SWAP_ENCRYPT -D FFS -D FFS2 -D FFS_SOFTUPDATES -D UFS_DIRHASH -D QUOTA -D EXT2FS -D MFS -D NFSCLIENT -D NFSSERVER -D CD9660 -D UDF -D MSDOSFS -D FIFO -D FUSE -D SOCKET_SPLICE -D TCP_ECN -D TCP_SIGNATURE -D INET6 -D IPSEC -D PPP_BSDCOMP -D PPP_DEFLATE -D PIPEX -D MROUTING -D MPLS -D BOOT_CONFIG -D USER_PCICONF -D APERTURE -D MTRR -D NTFS -D HIBERNATE -D PCIVERBOSE -D USBVERBOSE -D WSDISPLAY_COMPAT_USL -D WSDISPLAY_COMPAT_RAWKBD -D WSDISPLAY_DEFAULTSCREENS=6 -D X86EMU -D ONEWIREVERBOSE -D MULTIPROCESSOR -D MAXUSERS=80 -D _KERNEL -D CONFIG_DRM_AMD_DC_DCN3_0 -O2 -Wno-pointer-sign -Wno-address-of-packed-member -Wno-constant-conversion -Wno-unused-but-set-variable -Wno-gnu-folding-constant -fdebug-compilation-dir=/usr/src/sys/arch/amd64/compile/GENERIC.MP/obj -ferror-limit 19 -fwrapv -D_RET_PROTECTOR -ret-protector -fgnuc-version=4.2.1 -vectorize-loops -vectorize-slp -fno-builtin-malloc -fno-builtin-calloc -fno-builtin-realloc -fno-builtin-valloc -fno-builtin-free -fno-builtin-strdup -fno-builtin-strndup -analyzer-output=html -faddrsig -o /usr/obj/sys/arch/amd64/compile/GENERIC.MP/scan-build/2022-01-12-131800-47421-1 -x c /usr/src/sys/dev/pci/drm/radeon/rv6xx_dpm.c
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 "rv6xxd.h"
28#include "r600_dpm.h"
29#include "rv6xx_dpm.h"
30#include "atom.h"
31#include <linux/seq_file.h>
32
33static u32 rv6xx_scale_count_given_unit(struct radeon_device *rdev,
34 u32 unscaled_count, u32 unit);
35
36static struct rv6xx_ps *rv6xx_get_ps(struct radeon_ps *rps)
37{
38 struct rv6xx_ps *ps = rps->ps_priv;
39
40 return ps;
41}
42
43static struct rv6xx_power_info *rv6xx_get_pi(struct radeon_device *rdev)
44{
45 struct rv6xx_power_info *pi = rdev->pm.dpm.priv;
46
47 return pi;
48}
49
50static void rv6xx_force_pcie_gen1(struct radeon_device *rdev)
51{
52 u32 tmp;
53 int i;
54
55 tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL)rdev->pciep_rreg(rdev, (0xa4));
56 tmp &= LC_GEN2_EN(1 << 0);
57 WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa4), (tmp));
58
59 tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL)rdev->pciep_rreg(rdev, (0xa4));
60 tmp |= LC_INITIATE_LINK_SPEED_CHANGE(1 << 7);
61 WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa4), (tmp));
62
63 for (i = 0; i < rdev->usec_timeout; i++) {
64 if (!(RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL)rdev->pciep_rreg(rdev, (0xa4)) & LC_CURRENT_DATA_RATE(1 << 11)))
65 break;
66 udelay(1);
67 }
68
69 tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL)rdev->pciep_rreg(rdev, (0xa4));
70 tmp &= ~LC_INITIATE_LINK_SPEED_CHANGE(1 << 7);
71 WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa4), (tmp));
72}
73
74static void rv6xx_enable_pcie_gen2_support(struct radeon_device *rdev)
75{
76 u32 tmp;
77
78 tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL)rdev->pciep_rreg(rdev, (0xa4));
79
80 if ((tmp & LC_OTHER_SIDE_EVER_SENT_GEN2(1 << 23)) &&
81 (tmp & LC_OTHER_SIDE_SUPPORTS_GEN2(1 << 24))) {
82 tmp |= LC_GEN2_EN(1 << 0);
83 WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa4), (tmp));
84 }
85}
86
87static void rv6xx_enable_bif_dynamic_pcie_gen2(struct radeon_device *rdev,
88 bool_Bool enable)
89{
90 u32 tmp;
91
92 tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL)rdev->pciep_rreg(rdev, (0xa4)) & ~LC_HW_VOLTAGE_IF_CONTROL_MASK(3 << 12);
93 if (enable)
94 tmp |= LC_HW_VOLTAGE_IF_CONTROL(1)((1) << 12);
95 else
96 tmp |= LC_HW_VOLTAGE_IF_CONTROL(0)((0) << 12);
97 WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa4), (tmp));
98}
99
100static void rv6xx_enable_l0s(struct radeon_device *rdev)
101{
102 u32 tmp;
103
104 tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL)rdev->pciep_rreg(rdev, (0xa0)) & ~LC_L0S_INACTIVITY_MASK(0xf << 8);
105 tmp |= LC_L0S_INACTIVITY(3)((3) << 8);
106 WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa0), (tmp));
107}
108
109static void rv6xx_enable_l1(struct radeon_device *rdev)
110{
111 u32 tmp;
112
113 tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL)rdev->pciep_rreg(rdev, (0xa0));
114 tmp &= ~LC_L1_INACTIVITY_MASK(0xf << 12);
115 tmp |= LC_L1_INACTIVITY(4)((4) << 12);
116 tmp &= ~LC_PMI_TO_L1_DIS(1 << 16);
117 tmp &= ~LC_ASPM_TO_L1_DIS(1 << 24);
118 WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa0), (tmp));
119}
120
121static void rv6xx_enable_pll_sleep_in_l1(struct radeon_device *rdev)
122{
123 u32 tmp;
124
125 tmp = RREG32_PCIE_PORT(PCIE_LC_CNTL)rdev->pciep_rreg(rdev, (0xa0)) & ~LC_L1_INACTIVITY_MASK(0xf << 12);
126 tmp |= LC_L1_INACTIVITY(8)((8) << 12);
127 WREG32_PCIE_PORT(PCIE_LC_CNTL, tmp)rdev->pciep_wreg(rdev, (0xa0), (tmp));
128
129 /* NOTE, this is a PCIE indirect reg, not PCIE PORT */
130 tmp = RREG32_PCIE(PCIE_P_CNTL)rv370_pcie_rreg(rdev, (0x40));
131 tmp |= P_PLL_PWRDN_IN_L1L23(1 << 3);
132 tmp &= ~P_PLL_BUF_PDNB(1 << 4);
133 tmp &= ~P_PLL_PDNB(1 << 9);
134 tmp |= P_ALLOW_PRX_FRONTEND_SHUTOFF(1 << 12);
135 WREG32_PCIE(PCIE_P_CNTL, tmp)rv370_pcie_wreg(rdev, (0x40), (tmp));
136}
137
138static int rv6xx_convert_clock_to_stepping(struct radeon_device *rdev,
139 u32 clock, struct rv6xx_sclk_stepping *step)
140{
141 int ret;
142 struct atom_clock_dividers dividers;
143
144 ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM2,
145 clock, false0, &dividers);
146 if (ret)
6
Assuming 'ret' is not equal to 0
7
Taking true branch
147 return ret;
8
Returning without writing to 'step->vco_frequency'
148
149 if (dividers.enable_post_div)
150 step->post_divider = 2 + (dividers.post_div & 0xF) + (dividers.post_div >> 4);
151 else
152 step->post_divider = 1;
153
154 step->vco_frequency = clock * step->post_divider;
155
156 return 0;
157}
158
159static void rv6xx_output_stepping(struct radeon_device *rdev,
160 u32 step_index, struct rv6xx_sclk_stepping *step)
161{
162 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
163 u32 ref_clk = rdev->clock.spll.reference_freq;
164 u32 fb_divider;
165 u32 spll_step_count = rv6xx_scale_count_given_unit(rdev,
166 R600_SPLLSTEPTIME_DFLT0x1000 *
167 pi->spll_ref_div,
168 R600_SPLLSTEPUNIT_DFLT0x3);
169
170 r600_engine_clock_entry_enable(rdev, step_index, true1);
171 r600_engine_clock_entry_enable_pulse_skipping(rdev, step_index, false0);
172
173 if (step->post_divider == 1)
174 r600_engine_clock_entry_enable_post_divider(rdev, step_index, false0);
175 else {
176 u32 lo_len = (step->post_divider - 2) / 2;
177 u32 hi_len = step->post_divider - 2 - lo_len;
178
179 r600_engine_clock_entry_enable_post_divider(rdev, step_index, true1);
180 r600_engine_clock_entry_set_post_divider(rdev, step_index, (hi_len << 4) | lo_len);
181 }
182
183 fb_divider = ((step->vco_frequency * pi->spll_ref_div) / ref_clk) >>
184 pi->fb_div_scale;
185
186 r600_engine_clock_entry_set_reference_divider(rdev, step_index,
187 pi->spll_ref_div - 1);
188 r600_engine_clock_entry_set_feedback_divider(rdev, step_index, fb_divider);
189 r600_engine_clock_entry_set_step_time(rdev, step_index, spll_step_count);
190
191}
192
193static struct rv6xx_sclk_stepping rv6xx_next_vco_step(struct radeon_device *rdev,
194 struct rv6xx_sclk_stepping *cur,
195 bool_Bool increasing_vco, u32 step_size)
196{
197 struct rv6xx_sclk_stepping next;
198
199 next.post_divider = cur->post_divider;
200
201 if (increasing_vco)
202 next.vco_frequency = (cur->vco_frequency * (100 + step_size)) / 100;
203 else
204 next.vco_frequency = (cur->vco_frequency * 100 + 99 + step_size) / (100 + step_size);
205
206 return next;
207}
208
209static bool_Bool rv6xx_can_step_post_div(struct radeon_device *rdev,
210 struct rv6xx_sclk_stepping *cur,
211 struct rv6xx_sclk_stepping *target)
212{
213 return (cur->post_divider > target->post_divider) &&
214 ((cur->vco_frequency * target->post_divider) <=
215 (target->vco_frequency * (cur->post_divider - 1)));
216}
217
218static struct rv6xx_sclk_stepping rv6xx_next_post_div_step(struct radeon_device *rdev,
219 struct rv6xx_sclk_stepping *cur,
220 struct rv6xx_sclk_stepping *target)
221{
222 struct rv6xx_sclk_stepping next = *cur;
223
224 while (rv6xx_can_step_post_div(rdev, &next, target))
225 next.post_divider--;
226
227 return next;
228}
229
230static bool_Bool rv6xx_reached_stepping_target(struct radeon_device *rdev,
231 struct rv6xx_sclk_stepping *cur,
232 struct rv6xx_sclk_stepping *target,
233 bool_Bool increasing_vco)
234{
235 return (increasing_vco && (cur->vco_frequency >= target->vco_frequency)) ||
236 (!increasing_vco && (cur->vco_frequency <= target->vco_frequency));
237}
238
239static void rv6xx_generate_steps(struct radeon_device *rdev,
240 u32 low, u32 high,
241 u32 start_index, u8 *end_index)
242{
243 struct rv6xx_sclk_stepping cur;
244 struct rv6xx_sclk_stepping target;
245 bool_Bool increasing_vco;
246 u32 step_index = start_index;
247
248 rv6xx_convert_clock_to_stepping(rdev, low, &cur);
249 rv6xx_convert_clock_to_stepping(rdev, high, &target);
5
Calling 'rv6xx_convert_clock_to_stepping'
9
Returning from 'rv6xx_convert_clock_to_stepping'
250
251 rv6xx_output_stepping(rdev, step_index++, &cur);
252
253 increasing_vco = (target.vco_frequency >= cur.vco_frequency);
10
The left operand of '>=' is a garbage value
254
255 if (target.post_divider > cur.post_divider)
256 cur.post_divider = target.post_divider;
257
258 while (1) {
259 struct rv6xx_sclk_stepping next;
260
261 if (rv6xx_can_step_post_div(rdev, &cur, &target))
262 next = rv6xx_next_post_div_step(rdev, &cur, &target);
263 else
264 next = rv6xx_next_vco_step(rdev, &cur, increasing_vco, R600_VCOSTEPPCT_DFLT20);
265
266 if (rv6xx_reached_stepping_target(rdev, &next, &target, increasing_vco)) {
267 struct rv6xx_sclk_stepping tiny =
268 rv6xx_next_vco_step(rdev, &target, !increasing_vco, R600_ENDINGVCOSTEPPCT_DFLT5);
269 tiny.post_divider = next.post_divider;
270
271 if (!rv6xx_reached_stepping_target(rdev, &tiny, &cur, !increasing_vco))
272 rv6xx_output_stepping(rdev, step_index++, &tiny);
273
274 if ((next.post_divider != target.post_divider) &&
275 (next.vco_frequency != target.vco_frequency)) {
276 struct rv6xx_sclk_stepping final_vco;
277
278 final_vco.vco_frequency = target.vco_frequency;
279 final_vco.post_divider = next.post_divider;
280
281 rv6xx_output_stepping(rdev, step_index++, &final_vco);
282 }
283
284 rv6xx_output_stepping(rdev, step_index++, &target);
285 break;
286 } else
287 rv6xx_output_stepping(rdev, step_index++, &next);
288
289 cur = next;
290 }
291
292 *end_index = (u8)step_index - 1;
293
294}
295
296static void rv6xx_generate_single_step(struct radeon_device *rdev,
297 u32 clock, u32 index)
298{
299 struct rv6xx_sclk_stepping step;
300
301 rv6xx_convert_clock_to_stepping(rdev, clock, &step);
302 rv6xx_output_stepping(rdev, index, &step);
303}
304
305static void rv6xx_invalidate_intermediate_steps_range(struct radeon_device *rdev,
306 u32 start_index, u32 end_index)
307{
308 u32 step_index;
309
310 for (step_index = start_index + 1; step_index < end_index; step_index++)
311 r600_engine_clock_entry_enable(rdev, step_index, false0);
312}
313
314static void rv6xx_set_engine_spread_spectrum_clk_s(struct radeon_device *rdev,
315 u32 index, u32 clk_s)
316{
317 WREG32_P(CG_SPLL_SPREAD_SPECTRUM_LOW + (index * 4),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(0xff << 3)); tmp_ |= ((((clk_s) <<
3)) & ~(~(0xff << 3))); r100_mm_wreg(rdev, (0x820 +
(index * 4)), (tmp_), 0); } while (0)
318 CLKS(clk_s), ~CLKS_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(0xff << 3)); tmp_ |= ((((clk_s) <<
3)) & ~(~(0xff << 3))); r100_mm_wreg(rdev, (0x820 +
(index * 4)), (tmp_), 0); } while (0)
;
319}
320
321static void rv6xx_set_engine_spread_spectrum_clk_v(struct radeon_device *rdev,
322 u32 index, u32 clk_v)
323{
324 WREG32_P(CG_SPLL_SPREAD_SPECTRUM_LOW + (index * 4),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(0x7ff << 11)); tmp_ |= ((((clk_v) <<
11)) & ~(~(0x7ff << 11))); r100_mm_wreg(rdev, (0x820
+ (index * 4)), (tmp_), 0); } while (0)
325 CLKV(clk_v), ~CLKV_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(0x7ff << 11)); tmp_ |= ((((clk_v) <<
11)) & ~(~(0x7ff << 11))); r100_mm_wreg(rdev, (0x820
+ (index * 4)), (tmp_), 0); } while (0)
;
326}
327
328static void rv6xx_enable_engine_spread_spectrum(struct radeon_device *rdev,
329 u32 index, bool_Bool enable)
330{
331 if (enable)
332 WREG32_P(CG_SPLL_SPREAD_SPECTRUM_LOW + (index * 4),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(1 << 0)); tmp_ |= (((1 << 0)
) & ~(~(1 << 0))); r100_mm_wreg(rdev, (0x820 + (index
* 4)), (tmp_), 0); } while (0)
333 SSEN, ~SSEN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(1 << 0)); tmp_ |= (((1 << 0)
) & ~(~(1 << 0))); r100_mm_wreg(rdev, (0x820 + (index
* 4)), (tmp_), 0); } while (0)
;
334 else
335 WREG32_P(CG_SPLL_SPREAD_SPECTRUM_LOW + (index * 4),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(1 << 0)); tmp_ |= ((0) & ~(~(1
<< 0))); r100_mm_wreg(rdev, (0x820 + (index * 4)), (tmp_
), 0); } while (0)
336 0, ~SSEN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x820 + (index * 4))
, 0); tmp_ &= (~(1 << 0)); tmp_ |= ((0) & ~(~(1
<< 0))); r100_mm_wreg(rdev, (0x820 + (index * 4)), (tmp_
), 0); } while (0)
;
337}
338
339static void rv6xx_set_memory_spread_spectrum_clk_s(struct radeon_device *rdev,
340 u32 clk_s)
341{
342 WREG32_P(CG_MPLL_SPREAD_SPECTRUM, CLKS(clk_s), ~CLKS_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x830), 0); tmp_ &=
(~(0xff << 3)); tmp_ |= ((((clk_s) << 3)) & ~
(~(0xff << 3))); r100_mm_wreg(rdev, (0x830), (tmp_), 0)
; } while (0)
;
343}
344
345static void rv6xx_set_memory_spread_spectrum_clk_v(struct radeon_device *rdev,
346 u32 clk_v)
347{
348 WREG32_P(CG_MPLL_SPREAD_SPECTRUM, CLKV(clk_v), ~CLKV_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x830), 0); tmp_ &=
(~(0x7ff << 11)); tmp_ |= ((((clk_v) << 11)) &
~(~(0x7ff << 11))); r100_mm_wreg(rdev, (0x830), (tmp_)
, 0); } while (0)
;
349}
350
351static void rv6xx_enable_memory_spread_spectrum(struct radeon_device *rdev,
352 bool_Bool enable)
353{
354 if (enable)
355 WREG32_P(CG_MPLL_SPREAD_SPECTRUM, SSEN, ~SSEN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x830), 0); tmp_ &=
(~(1 << 0)); tmp_ |= (((1 << 0)) & ~(~(1 <<
0))); r100_mm_wreg(rdev, (0x830), (tmp_), 0); } while (0)
;
356 else
357 WREG32_P(CG_MPLL_SPREAD_SPECTRUM, 0, ~SSEN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x830), 0); tmp_ &=
(~(1 << 0)); tmp_ |= ((0) & ~(~(1 << 0))); r100_mm_wreg
(rdev, (0x830), (tmp_), 0); } while (0)
;
358}
359
360static void rv6xx_enable_dynamic_spread_spectrum(struct radeon_device *rdev,
361 bool_Bool enable)
362{
363 if (enable)
364 WREG32_P(GENERAL_PWRMGT, DYN_SPREAD_SPECTRUM_EN, ~DYN_SPREAD_SPECTRUM_EN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 21)); tmp_ |= (((1 << 21)) & ~(~(1 <<
21))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
365 else
366 WREG32_P(GENERAL_PWRMGT, 0, ~DYN_SPREAD_SPECTRUM_EN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 21)); tmp_ |= ((0) & ~(~(1 << 21)));
r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
367}
368
369static void rv6xx_memory_clock_entry_enable_post_divider(struct radeon_device *rdev,
370 u32 index, bool_Bool enable)
371{
372 if (enable)
373 WREG32_P(MPLL_FREQ_LEVEL_0 + (index * 4),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(1 << 28)); tmp_ |= (((1 << 28
)) & ~(~(1 << 28))); r100_mm_wreg(rdev, (0x6e8 + (index
* 4)), (tmp_), 0); } while (0)
374 LEVEL0_MPLL_DIV_EN, ~LEVEL0_MPLL_DIV_EN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(1 << 28)); tmp_ |= (((1 << 28
)) & ~(~(1 << 28))); r100_mm_wreg(rdev, (0x6e8 + (index
* 4)), (tmp_), 0); } while (0)
;
375 else
376 WREG32_P(MPLL_FREQ_LEVEL_0 + (index * 4), 0, ~LEVEL0_MPLL_DIV_EN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(1 << 28)); tmp_ |= ((0) & ~(~(
1 << 28))); r100_mm_wreg(rdev, (0x6e8 + (index * 4)), (
tmp_), 0); } while (0)
;
377}
378
379static void rv6xx_memory_clock_entry_set_post_divider(struct radeon_device *rdev,
380 u32 index, u32 divider)
381{
382 WREG32_P(MPLL_FREQ_LEVEL_0 + (index * 4),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(0xff << 0)); tmp_ |= ((((divider) <<
0)) & ~(~(0xff << 0))); r100_mm_wreg(rdev, (0x6e8 +
(index * 4)), (tmp_), 0); } while (0)
383 LEVEL0_MPLL_POST_DIV(divider), ~LEVEL0_MPLL_POST_DIV_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(0xff << 0)); tmp_ |= ((((divider) <<
0)) & ~(~(0xff << 0))); r100_mm_wreg(rdev, (0x6e8 +
(index * 4)), (tmp_), 0); } while (0)
;
384}
385
386static void rv6xx_memory_clock_entry_set_feedback_divider(struct radeon_device *rdev,
387 u32 index, u32 divider)
388{
389 WREG32_P(MPLL_FREQ_LEVEL_0 + (index * 4), LEVEL0_MPLL_FB_DIV(divider),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(0xfff << 8)); tmp_ |= ((((divider)
<< 8)) & ~(~(0xfff << 8))); r100_mm_wreg(rdev
, (0x6e8 + (index * 4)), (tmp_), 0); } while (0)
390 ~LEVEL0_MPLL_FB_DIV_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(0xfff << 8)); tmp_ |= ((((divider)
<< 8)) & ~(~(0xfff << 8))); r100_mm_wreg(rdev
, (0x6e8 + (index * 4)), (tmp_), 0); } while (0)
;
391}
392
393static void rv6xx_memory_clock_entry_set_reference_divider(struct radeon_device *rdev,
394 u32 index, u32 divider)
395{
396 WREG32_P(MPLL_FREQ_LEVEL_0 + (index * 4),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(0x3f << 20)); tmp_ |= ((((divider)
<< 20)) & ~(~(0x3f << 20))); r100_mm_wreg(rdev
, (0x6e8 + (index * 4)), (tmp_), 0); } while (0)
397 LEVEL0_MPLL_REF_DIV(divider), ~LEVEL0_MPLL_REF_DIV_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6e8 + (index * 4))
, 0); tmp_ &= (~(0x3f << 20)); tmp_ |= ((((divider)
<< 20)) & ~(~(0x3f << 20))); r100_mm_wreg(rdev
, (0x6e8 + (index * 4)), (tmp_), 0); } while (0)
;
398}
399
400static void rv6xx_vid_response_set_brt(struct radeon_device *rdev, u32 rt)
401{
402 WREG32_P(VID_RT, BRT(rt), ~BRT_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x6f8), 0); tmp_ &=
(~(0xff << 24)); tmp_ |= ((((rt) << 24)) & ~
(~(0xff << 24))); r100_mm_wreg(rdev, (0x6f8), (tmp_), 0
); } while (0)
;
403}
404
405static void rv6xx_enable_engine_feedback_and_reference_sync(struct radeon_device *rdev)
406{
407 WREG32_P(SPLL_CNTL_MODE, SPLL_DIV_SYNC, ~SPLL_DIV_SYNC)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x60c), 0); tmp_ &=
(~(1 << 5)); tmp_ |= (((1 << 5)) & ~(~(1 <<
5))); r100_mm_wreg(rdev, (0x60c), (tmp_), 0); } while (0)
;
408}
409
410static u32 rv6xx_clocks_per_unit(u32 unit)
411{
412 u32 tmp = 1 << (2 * unit);
413
414 return tmp;
415}
416
417static u32 rv6xx_scale_count_given_unit(struct radeon_device *rdev,
418 u32 unscaled_count, u32 unit)
419{
420 u32 count_per_unit = rv6xx_clocks_per_unit(unit);
421
422 return (unscaled_count + count_per_unit - 1) / count_per_unit;
423}
424
425static u32 rv6xx_compute_count_for_delay(struct radeon_device *rdev,
426 u32 delay_us, u32 unit)
427{
428 u32 ref_clk = rdev->clock.spll.reference_freq;
429
430 return rv6xx_scale_count_given_unit(rdev, delay_us * (ref_clk / 100), unit);
431}
432
433static void rv6xx_calculate_engine_speed_stepping_parameters(struct radeon_device *rdev,
434 struct rv6xx_ps *state)
435{
436 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
437
438 pi->hw.sclks[R600_POWER_LEVEL_LOW] =
439 state->low.sclk;
440 pi->hw.sclks[R600_POWER_LEVEL_MEDIUM] =
441 state->medium.sclk;
442 pi->hw.sclks[R600_POWER_LEVEL_HIGH] =
443 state->high.sclk;
444
445 pi->hw.low_sclk_index = R600_POWER_LEVEL_LOW;
446 pi->hw.medium_sclk_index = R600_POWER_LEVEL_MEDIUM;
447 pi->hw.high_sclk_index = R600_POWER_LEVEL_HIGH;
448}
449
450static void rv6xx_calculate_memory_clock_stepping_parameters(struct radeon_device *rdev,
451 struct rv6xx_ps *state)
452{
453 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
454
455 pi->hw.mclks[R600_POWER_LEVEL_CTXSW] =
456 state->high.mclk;
457 pi->hw.mclks[R600_POWER_LEVEL_HIGH] =
458 state->high.mclk;
459 pi->hw.mclks[R600_POWER_LEVEL_MEDIUM] =
460 state->medium.mclk;
461 pi->hw.mclks[R600_POWER_LEVEL_LOW] =
462 state->low.mclk;
463
464 pi->hw.high_mclk_index = R600_POWER_LEVEL_HIGH;
465
466 if (state->high.mclk == state->medium.mclk)
467 pi->hw.medium_mclk_index =
468 pi->hw.high_mclk_index;
469 else
470 pi->hw.medium_mclk_index = R600_POWER_LEVEL_MEDIUM;
471
472
473 if (state->medium.mclk == state->low.mclk)
474 pi->hw.low_mclk_index =
475 pi->hw.medium_mclk_index;
476 else
477 pi->hw.low_mclk_index = R600_POWER_LEVEL_LOW;
478}
479
480static void rv6xx_calculate_voltage_stepping_parameters(struct radeon_device *rdev,
481 struct rv6xx_ps *state)
482{
483 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
484
485 pi->hw.vddc[R600_POWER_LEVEL_CTXSW] = state->high.vddc;
486 pi->hw.vddc[R600_POWER_LEVEL_HIGH] = state->high.vddc;
487 pi->hw.vddc[R600_POWER_LEVEL_MEDIUM] = state->medium.vddc;
488 pi->hw.vddc[R600_POWER_LEVEL_LOW] = state->low.vddc;
489
490 pi->hw.backbias[R600_POWER_LEVEL_CTXSW] =
491 (state->high.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4) ? true1 : false0;
492 pi->hw.backbias[R600_POWER_LEVEL_HIGH] =
493 (state->high.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4) ? true1 : false0;
494 pi->hw.backbias[R600_POWER_LEVEL_MEDIUM] =
495 (state->medium.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4) ? true1 : false0;
496 pi->hw.backbias[R600_POWER_LEVEL_LOW] =
497 (state->low.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4) ? true1 : false0;
498
499 pi->hw.pcie_gen2[R600_POWER_LEVEL_HIGH] =
500 (state->high.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN21) ? true1 : false0;
501 pi->hw.pcie_gen2[R600_POWER_LEVEL_MEDIUM] =
502 (state->medium.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN21) ? true1 : false0;
503 pi->hw.pcie_gen2[R600_POWER_LEVEL_LOW] =
504 (state->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN21) ? true1 : false0;
505
506 pi->hw.high_vddc_index = R600_POWER_LEVEL_HIGH;
507
508 if ((state->high.vddc == state->medium.vddc) &&
509 ((state->high.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4) ==
510 (state->medium.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4)))
511 pi->hw.medium_vddc_index =
512 pi->hw.high_vddc_index;
513 else
514 pi->hw.medium_vddc_index = R600_POWER_LEVEL_MEDIUM;
515
516 if ((state->medium.vddc == state->low.vddc) &&
517 ((state->medium.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4) ==
518 (state->low.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4)))
519 pi->hw.low_vddc_index =
520 pi->hw.medium_vddc_index;
521 else
522 pi->hw.medium_vddc_index = R600_POWER_LEVEL_LOW;
523}
524
525static inline u32 rv6xx_calculate_vco_frequency(u32 ref_clock,
526 struct atom_clock_dividers *dividers,
527 u32 fb_divider_scale)
528{
529 return ref_clock * ((dividers->fb_div & ~1) << fb_divider_scale) /
530 (dividers->ref_div + 1);
531}
532
533static inline u32 rv6xx_calculate_spread_spectrum_clk_v(u32 vco_freq, u32 ref_freq,
534 u32 ss_rate, u32 ss_percent,
535 u32 fb_divider_scale)
536{
537 u32 fb_divider = vco_freq / ref_freq;
538
539 return (ss_percent * ss_rate * 4 * (fb_divider * fb_divider) /
540 (5375 * ((vco_freq * 10) / (4096 >> fb_divider_scale))));
541}
542
543static inline u32 rv6xx_calculate_spread_spectrum_clk_s(u32 ss_rate, u32 ref_freq)
544{
545 return (((ref_freq * 10) / (ss_rate * 2)) - 1) / 4;
546}
547
548static void rv6xx_program_engine_spread_spectrum(struct radeon_device *rdev,
549 u32 clock, enum r600_power_level level)
550{
551 u32 ref_clk = rdev->clock.spll.reference_freq;
552 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
553 struct atom_clock_dividers dividers;
554 struct radeon_atom_ss ss;
555 u32 vco_freq, clk_v, clk_s;
556
557 rv6xx_enable_engine_spread_spectrum(rdev, level, false0);
558
559 if (clock && pi->sclk_ss) {
560 if (radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM2, clock, false0, &dividers) == 0) {
561 vco_freq = rv6xx_calculate_vco_frequency(ref_clk, &dividers,
562 pi->fb_div_scale);
563
564 if (radeon_atombios_get_asic_ss_info(rdev, &ss,
565 ASIC_INTERNAL_ENGINE_SS2, vco_freq)) {
566 clk_v = rv6xx_calculate_spread_spectrum_clk_v(vco_freq,
567 (ref_clk / (dividers.ref_div + 1)),
568 ss.rate,
569 ss.percentage,
570 pi->fb_div_scale);
571
572 clk_s = rv6xx_calculate_spread_spectrum_clk_s(ss.rate,
573 (ref_clk / (dividers.ref_div + 1)));
574
575 rv6xx_set_engine_spread_spectrum_clk_v(rdev, level, clk_v);
576 rv6xx_set_engine_spread_spectrum_clk_s(rdev, level, clk_s);
577 rv6xx_enable_engine_spread_spectrum(rdev, level, true1);
578 }
579 }
580 }
581}
582
583static void rv6xx_program_sclk_spread_spectrum_parameters_except_lowest_entry(struct radeon_device *rdev)
584{
585 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
586
587 rv6xx_program_engine_spread_spectrum(rdev,
588 pi->hw.sclks[R600_POWER_LEVEL_HIGH],
589 R600_POWER_LEVEL_HIGH);
590
591 rv6xx_program_engine_spread_spectrum(rdev,
592 pi->hw.sclks[R600_POWER_LEVEL_MEDIUM],
593 R600_POWER_LEVEL_MEDIUM);
594
595}
596
597static int rv6xx_program_mclk_stepping_entry(struct radeon_device *rdev,
598 u32 entry, u32 clock)
599{
600 struct atom_clock_dividers dividers;
601
602 if (radeon_atom_get_clock_dividers(rdev, COMPUTE_MEMORY_PLL_PARAM1, clock, false0, &dividers))
603 return -EINVAL22;
604
605
606 rv6xx_memory_clock_entry_set_reference_divider(rdev, entry, dividers.ref_div);
607 rv6xx_memory_clock_entry_set_feedback_divider(rdev, entry, dividers.fb_div);
608 rv6xx_memory_clock_entry_set_post_divider(rdev, entry, dividers.post_div);
609
610 if (dividers.enable_post_div)
611 rv6xx_memory_clock_entry_enable_post_divider(rdev, entry, true1);
612 else
613 rv6xx_memory_clock_entry_enable_post_divider(rdev, entry, false0);
614
615 return 0;
616}
617
618static void rv6xx_program_mclk_stepping_parameters_except_lowest_entry(struct radeon_device *rdev)
619{
620 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
621 int i;
622
623 for (i = 1; i < R600_PM_NUMBER_OF_MCLKS4; i++) {
624 if (pi->hw.mclks[i])
625 rv6xx_program_mclk_stepping_entry(rdev, i,
626 pi->hw.mclks[i]);
627 }
628}
629
630static void rv6xx_find_memory_clock_with_highest_vco(struct radeon_device *rdev,
631 u32 requested_memory_clock,
632 u32 ref_clk,
633 struct atom_clock_dividers *dividers,
634 u32 *vco_freq)
635{
636 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
637 struct atom_clock_dividers req_dividers;
638 u32 vco_freq_temp;
639
640 if (radeon_atom_get_clock_dividers(rdev, COMPUTE_MEMORY_PLL_PARAM1,
641 requested_memory_clock, false0, &req_dividers) == 0) {
642 vco_freq_temp = rv6xx_calculate_vco_frequency(ref_clk, &req_dividers,
643 pi->fb_div_scale);
644
645 if (vco_freq_temp > *vco_freq) {
646 *dividers = req_dividers;
647 *vco_freq = vco_freq_temp;
648 }
649 }
650}
651
652static void rv6xx_program_mclk_spread_spectrum_parameters(struct radeon_device *rdev)
653{
654 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
655 u32 ref_clk = rdev->clock.mpll.reference_freq;
656 struct atom_clock_dividers dividers;
657 struct radeon_atom_ss ss;
658 u32 vco_freq = 0, clk_v, clk_s;
659
660 rv6xx_enable_memory_spread_spectrum(rdev, false0);
661
662 if (pi->mclk_ss) {
663 rv6xx_find_memory_clock_with_highest_vco(rdev,
664 pi->hw.mclks[pi->hw.high_mclk_index],
665 ref_clk,
666 &dividers,
667 &vco_freq);
668
669 rv6xx_find_memory_clock_with_highest_vco(rdev,
670 pi->hw.mclks[pi->hw.medium_mclk_index],
671 ref_clk,
672 &dividers,
673 &vco_freq);
674
675 rv6xx_find_memory_clock_with_highest_vco(rdev,
676 pi->hw.mclks[pi->hw.low_mclk_index],
677 ref_clk,
678 &dividers,
679 &vco_freq);
680
681 if (vco_freq) {
682 if (radeon_atombios_get_asic_ss_info(rdev, &ss,
683 ASIC_INTERNAL_MEMORY_SS1, vco_freq)) {
684 clk_v = rv6xx_calculate_spread_spectrum_clk_v(vco_freq,
685 (ref_clk / (dividers.ref_div + 1)),
686 ss.rate,
687 ss.percentage,
688 pi->fb_div_scale);
689
690 clk_s = rv6xx_calculate_spread_spectrum_clk_s(ss.rate,
691 (ref_clk / (dividers.ref_div + 1)));
692
693 rv6xx_set_memory_spread_spectrum_clk_v(rdev, clk_v);
694 rv6xx_set_memory_spread_spectrum_clk_s(rdev, clk_s);
695 rv6xx_enable_memory_spread_spectrum(rdev, true1);
696 }
697 }
698 }
699}
700
701static int rv6xx_program_voltage_stepping_entry(struct radeon_device *rdev,
702 u32 entry, u16 voltage)
703{
704 u32 mask, set_pins;
705 int ret;
706
707 ret = radeon_atom_get_voltage_gpio_settings(rdev, voltage,
708 SET_VOLTAGE_TYPE_ASIC_VDDC1,
709 &set_pins, &mask);
710 if (ret)
711 return ret;
712
713 r600_voltage_control_program_voltages(rdev, entry, set_pins);
714
715 return 0;
716}
717
718static void rv6xx_program_voltage_stepping_parameters_except_lowest_entry(struct radeon_device *rdev)
719{
720 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
721 int i;
722
723 for (i = 1; i < R600_PM_NUMBER_OF_VOLTAGE_LEVELS4; i++)
724 rv6xx_program_voltage_stepping_entry(rdev, i,
725 pi->hw.vddc[i]);
726
727}
728
729static void rv6xx_program_backbias_stepping_parameters_except_lowest_entry(struct radeon_device *rdev)
730{
731 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
732
733 if (pi->hw.backbias[1])
734 WREG32_P(VID_UPPER_GPIO_CNTL, MEDIUM_BACKBIAS_VALUE, ~MEDIUM_BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x740), 0); tmp_ &=
(~(1 << 14)); tmp_ |= (((1 << 14)) & ~(~(1 <<
14))); r100_mm_wreg(rdev, (0x740), (tmp_), 0); } while (0)
;
735 else
736 WREG32_P(VID_UPPER_GPIO_CNTL, 0, ~MEDIUM_BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x740), 0); tmp_ &=
(~(1 << 14)); tmp_ |= ((0) & ~(~(1 << 14)));
r100_mm_wreg(rdev, (0x740), (tmp_), 0); } while (0)
;
737
738 if (pi->hw.backbias[2])
739 WREG32_P(VID_UPPER_GPIO_CNTL, HIGH_BACKBIAS_VALUE, ~HIGH_BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x740), 0); tmp_ &=
(~(1 << 13)); tmp_ |= (((1 << 13)) & ~(~(1 <<
13))); r100_mm_wreg(rdev, (0x740), (tmp_), 0); } while (0)
;
740 else
741 WREG32_P(VID_UPPER_GPIO_CNTL, 0, ~HIGH_BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x740), 0); tmp_ &=
(~(1 << 13)); tmp_ |= ((0) & ~(~(1 << 13)));
r100_mm_wreg(rdev, (0x740), (tmp_), 0); } while (0)
;
742}
743
744static void rv6xx_program_sclk_spread_spectrum_parameters_lowest_entry(struct radeon_device *rdev)
745{
746 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
747
748 rv6xx_program_engine_spread_spectrum(rdev,
749 pi->hw.sclks[R600_POWER_LEVEL_LOW],
750 R600_POWER_LEVEL_LOW);
751}
752
753static void rv6xx_program_mclk_stepping_parameters_lowest_entry(struct radeon_device *rdev)
754{
755 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
756
757 if (pi->hw.mclks[0])
758 rv6xx_program_mclk_stepping_entry(rdev, 0,
759 pi->hw.mclks[0]);
760}
761
762static void rv6xx_program_voltage_stepping_parameters_lowest_entry(struct radeon_device *rdev)
763{
764 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
765
766 rv6xx_program_voltage_stepping_entry(rdev, 0,
767 pi->hw.vddc[0]);
768
769}
770
771static void rv6xx_program_backbias_stepping_parameters_lowest_entry(struct radeon_device *rdev)
772{
773 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
774
775 if (pi->hw.backbias[0])
776 WREG32_P(VID_UPPER_GPIO_CNTL, LOW_BACKBIAS_VALUE, ~LOW_BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x740), 0); tmp_ &=
(~(1 << 15)); tmp_ |= (((1 << 15)) & ~(~(1 <<
15))); r100_mm_wreg(rdev, (0x740), (tmp_), 0); } while (0)
;
777 else
778 WREG32_P(VID_UPPER_GPIO_CNTL, 0, ~LOW_BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x740), 0); tmp_ &=
(~(1 << 15)); tmp_ |= ((0) & ~(~(1 << 15)));
r100_mm_wreg(rdev, (0x740), (tmp_), 0); } while (0)
;
779}
780
781static u32 calculate_memory_refresh_rate(struct radeon_device *rdev,
782 u32 engine_clock)
783{
784 u32 dram_rows, dram_refresh_rate;
785 u32 tmp;
786
787 tmp = (RREG32(RAMCFG)r100_mm_rreg(rdev, (0x2408), 0) & NOOFROWS_MASK0x0000001C) >> NOOFROWS_SHIFT2;
788 dram_rows = 1 << (tmp + 10);
789 dram_refresh_rate = 1 << ((RREG32(MC_SEQ_RESERVE_M)r100_mm_rreg(rdev, (0x2894), 0) & 0x3) + 3);
790
791 return ((engine_clock * 10) * dram_refresh_rate / dram_rows - 32) / 64;
792}
793
794static void rv6xx_program_memory_timing_parameters(struct radeon_device *rdev)
795{
796 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
797 u32 sqm_ratio;
798 u32 arb_refresh_rate;
799 u32 high_clock;
800
801 if (pi->hw.sclks[R600_POWER_LEVEL_HIGH] <
802 (pi->hw.sclks[R600_POWER_LEVEL_LOW] * 0xFF / 0x40))
803 high_clock = pi->hw.sclks[R600_POWER_LEVEL_HIGH];
804 else
805 high_clock =
806 pi->hw.sclks[R600_POWER_LEVEL_LOW] * 0xFF / 0x40;
807
808 radeon_atom_set_engine_dram_timings(rdev, high_clock, 0);
809
810 sqm_ratio = (STATE0(64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_LOW])((64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_LOW]) <<
0)
|
811 STATE1(64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_MEDIUM])((64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_MEDIUM])
<< 8)
|
812 STATE2(64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_HIGH])((64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_HIGH]) <<
16)
|
813 STATE3(64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_HIGH])((64 * high_clock / pi->hw.sclks[R600_POWER_LEVEL_HIGH]) <<
24)
);
814 WREG32(SQM_RATIO, sqm_ratio)r100_mm_wreg(rdev, (0x2424), (sqm_ratio), 0);
815
816 arb_refresh_rate =
817 (POWERMODE0(calculate_memory_refresh_rate(rdev,((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_LOW
])) << 0)
818 pi->hw.sclks[R600_POWER_LEVEL_LOW]))((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_LOW
])) << 0)
|
819 POWERMODE1(calculate_memory_refresh_rate(rdev,((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_MEDIUM
])) << 8)
820 pi->hw.sclks[R600_POWER_LEVEL_MEDIUM]))((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_MEDIUM
])) << 8)
|
821 POWERMODE2(calculate_memory_refresh_rate(rdev,((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_HIGH
])) << 16)
822 pi->hw.sclks[R600_POWER_LEVEL_HIGH]))((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_HIGH
])) << 16)
|
823 POWERMODE3(calculate_memory_refresh_rate(rdev,((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_HIGH
])) << 24)
824 pi->hw.sclks[R600_POWER_LEVEL_HIGH]))((calculate_memory_refresh_rate(rdev, pi->hw.sclks[R600_POWER_LEVEL_HIGH
])) << 24)
);
825 WREG32(ARB_RFSH_RATE, arb_refresh_rate)r100_mm_wreg(rdev, (0x2464), (arb_refresh_rate), 0);
826}
827
828static void rv6xx_program_mpll_timing_parameters(struct radeon_device *rdev)
829{
830 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
831
832 r600_set_mpll_lock_time(rdev, R600_MPLLLOCKTIME_DFLT100 *
833 pi->mpll_ref_div);
834 r600_set_mpll_reset_time(rdev, R600_MPLLRESETTIME_DFLT150);
835}
836
837static void rv6xx_program_bsp(struct radeon_device *rdev)
838{
839 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
840 u32 ref_clk = rdev->clock.spll.reference_freq;
841
842 r600_calculate_u_and_p(R600_ASI_DFLT10000,
843 ref_clk, 16,
844 &pi->bsp,
845 &pi->bsu);
846
847 r600_set_bsp(rdev, pi->bsu, pi->bsp);
848}
849
850static void rv6xx_program_at(struct radeon_device *rdev)
851{
852 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
853
854 r600_set_at(rdev,
855 (pi->hw.rp[0] * pi->bsp) / 200,
856 (pi->hw.rp[1] * pi->bsp) / 200,
857 (pi->hw.lp[2] * pi->bsp) / 200,
858 (pi->hw.lp[1] * pi->bsp) / 200);
859}
860
861static void rv6xx_program_git(struct radeon_device *rdev)
862{
863 r600_set_git(rdev, R600_GICST_DFLT0x200);
864}
865
866static void rv6xx_program_tp(struct radeon_device *rdev)
867{
868 int i;
869
870 for (i = 0; i < R600_PM_NUMBER_OF_TC15; i++)
871 r600_set_tc(rdev, i, r600_utc[i], r600_dtc[i]);
872
873 r600_select_td(rdev, R600_TD_DFLT0);
874}
875
876static void rv6xx_program_vc(struct radeon_device *rdev)
877{
878 r600_set_vrc(rdev, R600_VRC_DFLT0x0000C003);
879}
880
881static void rv6xx_clear_vc(struct radeon_device *rdev)
882{
883 r600_set_vrc(rdev, 0);
884}
885
886static void rv6xx_program_tpp(struct radeon_device *rdev)
887{
888 r600_set_tpu(rdev, R600_TPU_DFLT0);
889 r600_set_tpc(rdev, R600_TPC_DFLT0x200);
890}
891
892static void rv6xx_program_sstp(struct radeon_device *rdev)
893{
894 r600_set_sstu(rdev, R600_SSTU_DFLT0);
895 r600_set_sst(rdev, R600_SST_DFLT0x00C8);
896}
897
898static void rv6xx_program_fcp(struct radeon_device *rdev)
899{
900 r600_set_fctu(rdev, R600_FCTU_DFLT0);
901 r600_set_fct(rdev, R600_FCT_DFLT0x0400);
902}
903
904static void rv6xx_program_vddc3d_parameters(struct radeon_device *rdev)
905{
906 r600_set_vddc3d_oorsu(rdev, R600_VDDC3DOORSU_DFLT0);
907 r600_set_vddc3d_oorphc(rdev, R600_VDDC3DOORPHC_DFLT0x100);
908 r600_set_vddc3d_oorsdc(rdev, R600_VDDC3DOORSDC_DFLT0x7);
909 r600_set_ctxcgtt3d_rphc(rdev, R600_CTXCGTT3DRPHC_DFLT0x20);
910 r600_set_ctxcgtt3d_rsdc(rdev, R600_CTXCGTT3DRSDC_DFLT0x40);
911}
912
913static void rv6xx_program_voltage_timing_parameters(struct radeon_device *rdev)
914{
915 u32 rt;
916
917 r600_vid_rt_set_vru(rdev, R600_VRU_DFLT0x3);
918
919 r600_vid_rt_set_vrt(rdev,
920 rv6xx_compute_count_for_delay(rdev,
921 rdev->pm.dpm.voltage_response_time,
922 R600_VRU_DFLT0x3));
923
924 rt = rv6xx_compute_count_for_delay(rdev,
925 rdev->pm.dpm.backbias_response_time,
926 R600_VRU_DFLT0x3);
927
928 rv6xx_vid_response_set_brt(rdev, (rt + 0x1F) >> 5);
929}
930
931static void rv6xx_program_engine_speed_parameters(struct radeon_device *rdev)
932{
933 r600_vid_rt_set_ssu(rdev, R600_SPLLSTEPUNIT_DFLT0x3);
934 rv6xx_enable_engine_feedback_and_reference_sync(rdev);
935}
936
937static u64 rv6xx_get_master_voltage_mask(struct radeon_device *rdev)
938{
939 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
940 u64 master_mask = 0;
941 int i;
942
943 for (i = 0; i < R600_PM_NUMBER_OF_VOLTAGE_LEVELS4; i++) {
944 u32 tmp_mask, tmp_set_pins;
945 int ret;
946
947 ret = radeon_atom_get_voltage_gpio_settings(rdev,
948 pi->hw.vddc[i],
949 SET_VOLTAGE_TYPE_ASIC_VDDC1,
950 &tmp_set_pins, &tmp_mask);
951
952 if (ret == 0)
953 master_mask |= tmp_mask;
954 }
955
956 return master_mask;
957}
958
959static void rv6xx_program_voltage_gpio_pins(struct radeon_device *rdev)
960{
961 r600_voltage_control_enable_pins(rdev,
962 rv6xx_get_master_voltage_mask(rdev));
963}
964
965static void rv6xx_enable_static_voltage_control(struct radeon_device *rdev,
966 struct radeon_ps *new_ps,
967 bool_Bool enable)
968{
969 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
970
971 if (enable)
972 radeon_atom_set_voltage(rdev,
973 new_state->low.vddc,
974 SET_VOLTAGE_TYPE_ASIC_VDDC1);
975 else
976 r600_voltage_control_deactivate_static_control(rdev,
977 rv6xx_get_master_voltage_mask(rdev));
978}
979
980static void rv6xx_enable_display_gap(struct radeon_device *rdev, bool_Bool enable)
981{
982 if (enable) {
983 u32 tmp = (DISP1_GAP(R600_PM_DISPLAY_GAP_VBLANK_OR_WM)((R600_PM_DISPLAY_GAP_VBLANK_OR_WM) << 0) |
984 DISP2_GAP(R600_PM_DISPLAY_GAP_VBLANK_OR_WM)((R600_PM_DISPLAY_GAP_VBLANK_OR_WM) << 2) |
985 DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE)((R600_PM_DISPLAY_GAP_IGNORE) << 24) |
986 DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE)((R600_PM_DISPLAY_GAP_IGNORE) << 26) |
987 VBI_TIMER_COUNT(0x3FFF)((0x3FFF) << 4) |
988 VBI_TIMER_UNIT(7)((7) << 20));
989 WREG32(CG_DISPLAY_GAP_CNTL, tmp)r100_mm_wreg(rdev, (0x7dc), (tmp), 0);
990
991 WREG32_P(MCLK_PWRMGT_CNTL, USE_DISPLAY_GAP, ~USE_DISPLAY_GAP)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x624), 0); tmp_ &=
(~(1 << 25)); tmp_ |= (((1 << 25)) & ~(~(1 <<
25))); r100_mm_wreg(rdev, (0x624), (tmp_), 0); } while (0)
;
992 } else
993 WREG32_P(MCLK_PWRMGT_CNTL, 0, ~USE_DISPLAY_GAP)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x624), 0); tmp_ &=
(~(1 << 25)); tmp_ |= ((0) & ~(~(1 << 25)));
r100_mm_wreg(rdev, (0x624), (tmp_), 0); } while (0)
;
994}
995
996static void rv6xx_program_power_level_enter_state(struct radeon_device *rdev)
997{
998 r600_power_level_set_enter_index(rdev, R600_POWER_LEVEL_MEDIUM);
999}
1000
1001static void rv6xx_calculate_t(u32 l_f, u32 h_f, int h,
1002 int d_l, int d_r, u8 *l, u8 *r)
1003{
1004 int a_n, a_d, h_r, l_r;
1005
1006 h_r = d_l;
1007 l_r = 100 - d_r;
1008
1009 a_n = (int)h_f * d_l + (int)l_f * (h - d_r);
1010 a_d = (int)l_f * l_r + (int)h_f * h_r;
1011
1012 if (a_d != 0) {
1013 *l = d_l - h_r * a_n / a_d;
1014 *r = d_r + l_r * a_n / a_d;
1015 }
1016}
1017
1018static void rv6xx_calculate_ap(struct radeon_device *rdev,
1019 struct rv6xx_ps *state)
1020{
1021 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1022
1023 pi->hw.lp[0] = 0;
1024 pi->hw.rp[R600_PM_NUMBER_OF_ACTIVITY_LEVELS3 - 1]
1025 = 100;
1026
1027 rv6xx_calculate_t(state->low.sclk,
1028 state->medium.sclk,
1029 R600_AH_DFLT5,
1030 R600_LMP_DFLT15,
1031 R600_RLP_DFLT25,
1032 &pi->hw.lp[1],
1033 &pi->hw.rp[0]);
1034
1035 rv6xx_calculate_t(state->medium.sclk,
1036 state->high.sclk,
1037 R600_AH_DFLT5,
1038 R600_LHP_DFLT40,
1039 R600_RMP_DFLT65,
1040 &pi->hw.lp[2],
1041 &pi->hw.rp[1]);
1042
1043}
1044
1045static void rv6xx_calculate_stepping_parameters(struct radeon_device *rdev,
1046 struct radeon_ps *new_ps)
1047{
1048 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1049
1050 rv6xx_calculate_engine_speed_stepping_parameters(rdev, new_state);
1051 rv6xx_calculate_memory_clock_stepping_parameters(rdev, new_state);
1052 rv6xx_calculate_voltage_stepping_parameters(rdev, new_state);
1053 rv6xx_calculate_ap(rdev, new_state);
1054}
1055
1056static void rv6xx_program_stepping_parameters_except_lowest_entry(struct radeon_device *rdev)
1057{
1058 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1059
1060 rv6xx_program_mclk_stepping_parameters_except_lowest_entry(rdev);
1061 if (pi->voltage_control)
1062 rv6xx_program_voltage_stepping_parameters_except_lowest_entry(rdev);
1063 rv6xx_program_backbias_stepping_parameters_except_lowest_entry(rdev);
1064 rv6xx_program_sclk_spread_spectrum_parameters_except_lowest_entry(rdev);
1065 rv6xx_program_mclk_spread_spectrum_parameters(rdev);
1066 rv6xx_program_memory_timing_parameters(rdev);
1067}
1068
1069static void rv6xx_program_stepping_parameters_lowest_entry(struct radeon_device *rdev)
1070{
1071 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1072
1073 rv6xx_program_mclk_stepping_parameters_lowest_entry(rdev);
1074 if (pi->voltage_control)
1075 rv6xx_program_voltage_stepping_parameters_lowest_entry(rdev);
1076 rv6xx_program_backbias_stepping_parameters_lowest_entry(rdev);
1077 rv6xx_program_sclk_spread_spectrum_parameters_lowest_entry(rdev);
1078}
1079
1080static void rv6xx_program_power_level_low(struct radeon_device *rdev)
1081{
1082 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1083
1084 r600_power_level_set_voltage_index(rdev, R600_POWER_LEVEL_LOW,
1085 pi->hw.low_vddc_index);
1086 r600_power_level_set_mem_clock_index(rdev, R600_POWER_LEVEL_LOW,
1087 pi->hw.low_mclk_index);
1088 r600_power_level_set_eng_clock_index(rdev, R600_POWER_LEVEL_LOW,
1089 pi->hw.low_sclk_index);
1090 r600_power_level_set_watermark_id(rdev, R600_POWER_LEVEL_LOW,
1091 R600_DISPLAY_WATERMARK_LOW);
1092 r600_power_level_set_pcie_gen2(rdev, R600_POWER_LEVEL_LOW,
1093 pi->hw.pcie_gen2[R600_POWER_LEVEL_LOW]);
1094}
1095
1096static void rv6xx_program_power_level_low_to_lowest_state(struct radeon_device *rdev)
1097{
1098 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1099
1100 r600_power_level_set_voltage_index(rdev, R600_POWER_LEVEL_LOW, 0);
1101 r600_power_level_set_mem_clock_index(rdev, R600_POWER_LEVEL_LOW, 0);
1102 r600_power_level_set_eng_clock_index(rdev, R600_POWER_LEVEL_LOW, 0);
1103
1104 r600_power_level_set_watermark_id(rdev, R600_POWER_LEVEL_LOW,
1105 R600_DISPLAY_WATERMARK_LOW);
1106
1107 r600_power_level_set_pcie_gen2(rdev, R600_POWER_LEVEL_LOW,
1108 pi->hw.pcie_gen2[R600_POWER_LEVEL_LOW]);
1109
1110}
1111
1112static void rv6xx_program_power_level_medium(struct radeon_device *rdev)
1113{
1114 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1115
1116 r600_power_level_set_voltage_index(rdev, R600_POWER_LEVEL_MEDIUM,
1117 pi->hw.medium_vddc_index);
1118 r600_power_level_set_mem_clock_index(rdev, R600_POWER_LEVEL_MEDIUM,
1119 pi->hw.medium_mclk_index);
1120 r600_power_level_set_eng_clock_index(rdev, R600_POWER_LEVEL_MEDIUM,
1121 pi->hw.medium_sclk_index);
1122 r600_power_level_set_watermark_id(rdev, R600_POWER_LEVEL_MEDIUM,
1123 R600_DISPLAY_WATERMARK_LOW);
1124 r600_power_level_set_pcie_gen2(rdev, R600_POWER_LEVEL_MEDIUM,
1125 pi->hw.pcie_gen2[R600_POWER_LEVEL_MEDIUM]);
1126}
1127
1128static void rv6xx_program_power_level_medium_for_transition(struct radeon_device *rdev)
1129{
1130 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1131
1132 rv6xx_program_mclk_stepping_entry(rdev,
1133 R600_POWER_LEVEL_CTXSW,
1134 pi->hw.mclks[pi->hw.low_mclk_index]);
1135
1136 r600_power_level_set_voltage_index(rdev, R600_POWER_LEVEL_MEDIUM, 1);
1137
1138 r600_power_level_set_mem_clock_index(rdev, R600_POWER_LEVEL_MEDIUM,
1139 R600_POWER_LEVEL_CTXSW);
1140 r600_power_level_set_eng_clock_index(rdev, R600_POWER_LEVEL_MEDIUM,
1141 pi->hw.medium_sclk_index);
1142
1143 r600_power_level_set_watermark_id(rdev, R600_POWER_LEVEL_MEDIUM,
1144 R600_DISPLAY_WATERMARK_LOW);
1145
1146 rv6xx_enable_engine_spread_spectrum(rdev, R600_POWER_LEVEL_MEDIUM, false0);
1147
1148 r600_power_level_set_pcie_gen2(rdev, R600_POWER_LEVEL_MEDIUM,
1149 pi->hw.pcie_gen2[R600_POWER_LEVEL_LOW]);
1150}
1151
1152static void rv6xx_program_power_level_high(struct radeon_device *rdev)
1153{
1154 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1155
1156 r600_power_level_set_voltage_index(rdev, R600_POWER_LEVEL_HIGH,
1157 pi->hw.high_vddc_index);
1158 r600_power_level_set_mem_clock_index(rdev, R600_POWER_LEVEL_HIGH,
1159 pi->hw.high_mclk_index);
1160 r600_power_level_set_eng_clock_index(rdev, R600_POWER_LEVEL_HIGH,
1161 pi->hw.high_sclk_index);
1162
1163 r600_power_level_set_watermark_id(rdev, R600_POWER_LEVEL_HIGH,
1164 R600_DISPLAY_WATERMARK_HIGH);
1165
1166 r600_power_level_set_pcie_gen2(rdev, R600_POWER_LEVEL_HIGH,
1167 pi->hw.pcie_gen2[R600_POWER_LEVEL_HIGH]);
1168}
1169
1170static void rv6xx_enable_backbias(struct radeon_device *rdev, bool_Bool enable)
1171{
1172 if (enable)
1173 WREG32_P(GENERAL_PWRMGT, BACKBIAS_PAD_EN | BACKBIAS_DPM_CNTL,do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~((1 << 16) | (1 << 18))); tmp_ |= (((1 <<
16) | (1 << 18)) & ~(~((1 << 16) | (1 <<
18)))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
1174 ~(BACKBIAS_PAD_EN | BACKBIAS_DPM_CNTL))do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~((1 << 16) | (1 << 18))); tmp_ |= (((1 <<
16) | (1 << 18)) & ~(~((1 << 16) | (1 <<
18)))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1175 else
1176 WREG32_P(GENERAL_PWRMGT, 0,do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~((1 << 17) | (1 << 16) | (1 << 18))); tmp_
|= ((0) & ~(~((1 << 17) | (1 << 16) | (1 <<
18)))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
1177 ~(BACKBIAS_VALUE | BACKBIAS_PAD_EN | BACKBIAS_DPM_CNTL))do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~((1 << 17) | (1 << 16) | (1 << 18))); tmp_
|= ((0) & ~(~((1 << 17) | (1 << 16) | (1 <<
18)))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1178}
1179
1180static void rv6xx_program_display_gap(struct radeon_device *rdev)
1181{
1182 u32 tmp = RREG32(CG_DISPLAY_GAP_CNTL)r100_mm_rreg(rdev, (0x7dc), 0);
1183
1184 tmp &= ~(DISP1_GAP_MCHG_MASK(3 << 24) | DISP2_GAP_MCHG_MASK(3 << 26));
1185 if (rdev->pm.dpm.new_active_crtcs & 1) {
1186 tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_VBLANK)((R600_PM_DISPLAY_GAP_VBLANK) << 24);
1187 tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE)((R600_PM_DISPLAY_GAP_IGNORE) << 26);
1188 } else if (rdev->pm.dpm.new_active_crtcs & 2) {
1189 tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE)((R600_PM_DISPLAY_GAP_IGNORE) << 24);
1190 tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_VBLANK)((R600_PM_DISPLAY_GAP_VBLANK) << 26);
1191 } else {
1192 tmp |= DISP1_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE)((R600_PM_DISPLAY_GAP_IGNORE) << 24);
1193 tmp |= DISP2_GAP_MCHG(R600_PM_DISPLAY_GAP_IGNORE)((R600_PM_DISPLAY_GAP_IGNORE) << 26);
1194 }
1195 WREG32(CG_DISPLAY_GAP_CNTL, tmp)r100_mm_wreg(rdev, (0x7dc), (tmp), 0);
1196}
1197
1198static void rv6xx_set_sw_voltage_to_safe(struct radeon_device *rdev,
1199 struct radeon_ps *new_ps,
1200 struct radeon_ps *old_ps)
1201{
1202 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1203 struct rv6xx_ps *old_state = rv6xx_get_ps(old_ps);
1204 u16 safe_voltage;
1205
1206 safe_voltage = (new_state->low.vddc >= old_state->low.vddc) ?
1207 new_state->low.vddc : old_state->low.vddc;
1208
1209 rv6xx_program_voltage_stepping_entry(rdev, R600_POWER_LEVEL_CTXSW,
1210 safe_voltage);
1211
1212 WREG32_P(GENERAL_PWRMGT, SW_GPIO_INDEX(R600_POWER_LEVEL_CTXSW),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(3 << 6)); tmp_ |= ((((R600_POWER_LEVEL_CTXSW) <<
6)) & ~(~(3 << 6))); r100_mm_wreg(rdev, (0x618), (
tmp_), 0); } while (0)
1213 ~SW_GPIO_INDEX_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(3 << 6)); tmp_ |= ((((R600_POWER_LEVEL_CTXSW) <<
6)) & ~(~(3 << 6))); r100_mm_wreg(rdev, (0x618), (
tmp_), 0); } while (0)
;
1214}
1215
1216static void rv6xx_set_sw_voltage_to_low(struct radeon_device *rdev,
1217 struct radeon_ps *old_ps)
1218{
1219 struct rv6xx_ps *old_state = rv6xx_get_ps(old_ps);
1220
1221 rv6xx_program_voltage_stepping_entry(rdev, R600_POWER_LEVEL_CTXSW,
1222 old_state->low.vddc);
1223
1224 WREG32_P(GENERAL_PWRMGT, SW_GPIO_INDEX(R600_POWER_LEVEL_CTXSW),do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(3 << 6)); tmp_ |= ((((R600_POWER_LEVEL_CTXSW) <<
6)) & ~(~(3 << 6))); r100_mm_wreg(rdev, (0x618), (
tmp_), 0); } while (0)
1225 ~SW_GPIO_INDEX_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(3 << 6)); tmp_ |= ((((R600_POWER_LEVEL_CTXSW) <<
6)) & ~(~(3 << 6))); r100_mm_wreg(rdev, (0x618), (
tmp_), 0); } while (0)
;
1226}
1227
1228static void rv6xx_set_safe_backbias(struct radeon_device *rdev,
1229 struct radeon_ps *new_ps,
1230 struct radeon_ps *old_ps)
1231{
1232 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1233 struct rv6xx_ps *old_state = rv6xx_get_ps(old_ps);
1234
1235 if ((new_state->low.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4) &&
1236 (old_state->low.flags & ATOM_PPLIB_R600_FLAGS_BACKBIASENABLE4))
1237 WREG32_P(GENERAL_PWRMGT, BACKBIAS_VALUE, ~BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 17)); tmp_ |= (((1 << 17)) & ~(~(1 <<
17))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1238 else
1239 WREG32_P(GENERAL_PWRMGT, 0, ~BACKBIAS_VALUE)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 17)); tmp_ |= ((0) & ~(~(1 << 17)));
r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1240}
1241
1242static void rv6xx_set_safe_pcie_gen2(struct radeon_device *rdev,
1243 struct radeon_ps *new_ps,
1244 struct radeon_ps *old_ps)
1245{
1246 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1247 struct rv6xx_ps *old_state = rv6xx_get_ps(old_ps);
1248
1249 if ((new_state->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN21) !=
1250 (old_state->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN21))
1251 rv6xx_force_pcie_gen1(rdev);
1252}
1253
1254static void rv6xx_enable_dynamic_voltage_control(struct radeon_device *rdev,
1255 bool_Bool enable)
1256{
1257 if (enable)
1258 WREG32_P(GENERAL_PWRMGT, VOLT_PWRMGT_EN, ~VOLT_PWRMGT_EN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 10)); tmp_ |= (((1 << 10)) & ~(~(1 <<
10))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1259 else
1260 WREG32_P(GENERAL_PWRMGT, 0, ~VOLT_PWRMGT_EN)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 10)); tmp_ |= ((0) & ~(~(1 << 10)));
r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1261}
1262
1263static void rv6xx_enable_dynamic_backbias_control(struct radeon_device *rdev,
1264 bool_Bool enable)
1265{
1266 if (enable)
1267 WREG32_P(GENERAL_PWRMGT, BACKBIAS_DPM_CNTL, ~BACKBIAS_DPM_CNTL)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 18)); tmp_ |= (((1 << 18)) & ~(~(1 <<
18))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1268 else
1269 WREG32_P(GENERAL_PWRMGT, 0, ~BACKBIAS_DPM_CNTL)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 18)); tmp_ |= ((0) & ~(~(1 << 18)));
r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1270}
1271
1272static int rv6xx_step_sw_voltage(struct radeon_device *rdev,
1273 u16 initial_voltage,
1274 u16 target_voltage)
1275{
1276 u16 current_voltage;
1277 u16 true_target_voltage;
1278 u16 voltage_step;
1279 int signed_voltage_step;
1280
1281 if ((radeon_atom_get_voltage_step(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC1,
1282 &voltage_step)) ||
1283 (radeon_atom_round_to_true_voltage(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC1,
1284 initial_voltage, &current_voltage)) ||
1285 (radeon_atom_round_to_true_voltage(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC1,
1286 target_voltage, &true_target_voltage)))
1287 return -EINVAL22;
1288
1289 if (true_target_voltage < current_voltage)
1290 signed_voltage_step = -(int)voltage_step;
1291 else
1292 signed_voltage_step = voltage_step;
1293
1294 while (current_voltage != true_target_voltage) {
1295 current_voltage += signed_voltage_step;
1296 rv6xx_program_voltage_stepping_entry(rdev, R600_POWER_LEVEL_CTXSW,
1297 current_voltage);
1298 drm_msleep((rdev->pm.dpm.voltage_response_time + 999) / 1000)mdelay((rdev->pm.dpm.voltage_response_time + 999) / 1000);
1299 }
1300
1301 return 0;
1302}
1303
1304static int rv6xx_step_voltage_if_increasing(struct radeon_device *rdev,
1305 struct radeon_ps *new_ps,
1306 struct radeon_ps *old_ps)
1307{
1308 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1309 struct rv6xx_ps *old_state = rv6xx_get_ps(old_ps);
1310
1311 if (new_state->low.vddc > old_state->low.vddc)
1312 return rv6xx_step_sw_voltage(rdev,
1313 old_state->low.vddc,
1314 new_state->low.vddc);
1315
1316 return 0;
1317}
1318
1319static int rv6xx_step_voltage_if_decreasing(struct radeon_device *rdev,
1320 struct radeon_ps *new_ps,
1321 struct radeon_ps *old_ps)
1322{
1323 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1324 struct rv6xx_ps *old_state = rv6xx_get_ps(old_ps);
1325
1326 if (new_state->low.vddc < old_state->low.vddc)
1327 return rv6xx_step_sw_voltage(rdev,
1328 old_state->low.vddc,
1329 new_state->low.vddc);
1330 else
1331 return 0;
1332}
1333
1334static void rv6xx_enable_high(struct radeon_device *rdev)
1335{
1336 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1337
1338 if ((pi->restricted_levels < 1) ||
1339 (pi->restricted_levels == 3))
1340 r600_power_level_enable(rdev, R600_POWER_LEVEL_HIGH, true1);
1341}
1342
1343static void rv6xx_enable_medium(struct radeon_device *rdev)
1344{
1345 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1346
1347 if (pi->restricted_levels < 2)
1348 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, true1);
1349}
1350
1351static void rv6xx_set_dpm_event_sources(struct radeon_device *rdev, u32 sources)
1352{
1353 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1354 bool_Bool want_thermal_protection;
1355 enum radeon_dpm_event_src dpm_event_src;
1356
1357 switch (sources) {
1358 case 0:
1359 default:
1360 want_thermal_protection = false0;
1361 break;
1362 case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL):
1363 want_thermal_protection = true1;
1364 dpm_event_src = RADEON_DPM_EVENT_SRC_DIGITAL;
1365 break;
1366
1367 case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL):
1368 want_thermal_protection = true1;
1369 dpm_event_src = RADEON_DPM_EVENT_SRC_EXTERNAL;
1370 break;
1371
1372 case ((1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL) |
1373 (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL)):
1374 want_thermal_protection = true1;
1375 dpm_event_src = RADEON_DPM_EVENT_SRC_DIGIAL_OR_EXTERNAL;
1376 break;
1377 }
1378
1379 if (want_thermal_protection) {
1380 WREG32_P(CG_THERMAL_CTRL, DPM_EVENT_SRC(dpm_event_src), ~DPM_EVENT_SRC_MASK)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x7f0), 0); tmp_ &=
(~(7 << 0)); tmp_ |= ((((dpm_event_src) << 0)) &
~(~(7 << 0))); r100_mm_wreg(rdev, (0x7f0), (tmp_), 0);
} while (0)
;
1381 if (pi->thermal_protection)
1382 WREG32_P(GENERAL_PWRMGT, 0, ~THERMAL_PROTECTION_DIS)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 3)); tmp_ |= ((0) & ~(~(1 << 3))); r100_mm_wreg
(rdev, (0x618), (tmp_), 0); } while (0)
;
1383 } else {
1384 WREG32_P(GENERAL_PWRMGT, THERMAL_PROTECTION_DIS, ~THERMAL_PROTECTION_DIS)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x618), 0); tmp_ &=
(~(1 << 3)); tmp_ |= (((1 << 3)) & ~(~(1 <<
3))); r100_mm_wreg(rdev, (0x618), (tmp_), 0); } while (0)
;
1385 }
1386}
1387
1388static void rv6xx_enable_auto_throttle_source(struct radeon_device *rdev,
1389 enum radeon_dpm_auto_throttle_src source,
1390 bool_Bool enable)
1391{
1392 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1393
1394 if (enable) {
1395 if (!(pi->active_auto_throttle_sources & (1 << source))) {
1396 pi->active_auto_throttle_sources |= 1 << source;
1397 rv6xx_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
1398 }
1399 } else {
1400 if (pi->active_auto_throttle_sources & (1 << source)) {
1401 pi->active_auto_throttle_sources &= ~(1 << source);
1402 rv6xx_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
1403 }
1404 }
1405}
1406
1407
1408static void rv6xx_enable_thermal_protection(struct radeon_device *rdev,
1409 bool_Bool enable)
1410{
1411 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1412
1413 if (pi->active_auto_throttle_sources)
1414 r600_enable_thermal_protection(rdev, enable);
1415}
1416
1417static void rv6xx_generate_transition_stepping(struct radeon_device *rdev,
1418 struct radeon_ps *new_ps,
1419 struct radeon_ps *old_ps)
1420{
1421 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1422 struct rv6xx_ps *old_state = rv6xx_get_ps(old_ps);
1423 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1424
1425 rv6xx_generate_steps(rdev,
4
Calling 'rv6xx_generate_steps'
1426 old_state->low.sclk,
1427 new_state->low.sclk,
1428 0, &pi->hw.medium_sclk_index);
1429}
1430
1431static void rv6xx_generate_low_step(struct radeon_device *rdev,
1432 struct radeon_ps *new_ps)
1433{
1434 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1435 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1436
1437 pi->hw.low_sclk_index = 0;
1438 rv6xx_generate_single_step(rdev,
1439 new_state->low.sclk,
1440 0);
1441}
1442
1443static void rv6xx_invalidate_intermediate_steps(struct radeon_device *rdev)
1444{
1445 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1446
1447 rv6xx_invalidate_intermediate_steps_range(rdev, 0,
1448 pi->hw.medium_sclk_index);
1449}
1450
1451static void rv6xx_generate_stepping_table(struct radeon_device *rdev,
1452 struct radeon_ps *new_ps)
1453{
1454 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1455 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1456
1457 pi->hw.low_sclk_index = 0;
1458
1459 rv6xx_generate_steps(rdev,
1460 new_state->low.sclk,
1461 new_state->medium.sclk,
1462 0,
1463 &pi->hw.medium_sclk_index);
1464 rv6xx_generate_steps(rdev,
1465 new_state->medium.sclk,
1466 new_state->high.sclk,
1467 pi->hw.medium_sclk_index,
1468 &pi->hw.high_sclk_index);
1469}
1470
1471static void rv6xx_enable_spread_spectrum(struct radeon_device *rdev,
1472 bool_Bool enable)
1473{
1474 if (enable)
1475 rv6xx_enable_dynamic_spread_spectrum(rdev, true1);
1476 else {
1477 rv6xx_enable_engine_spread_spectrum(rdev, R600_POWER_LEVEL_LOW, false0);
1478 rv6xx_enable_engine_spread_spectrum(rdev, R600_POWER_LEVEL_MEDIUM, false0);
1479 rv6xx_enable_engine_spread_spectrum(rdev, R600_POWER_LEVEL_HIGH, false0);
1480 rv6xx_enable_dynamic_spread_spectrum(rdev, false0);
1481 rv6xx_enable_memory_spread_spectrum(rdev, false0);
1482 }
1483}
1484
1485static void rv6xx_reset_lvtm_data_sync(struct radeon_device *rdev)
1486{
1487 if (ASIC_IS_DCE3(rdev)((rdev->family >= CHIP_RV620)))
1488 WREG32_P(DCE3_LVTMA_DATA_SYNCHRONIZATION, LVTMA_PFREQCHG, ~LVTMA_PFREQCHG)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x7f98), 0); tmp_ &=
(~(1 << 8)); tmp_ |= (((1 << 8)) & ~(~(1 <<
8))); r100_mm_wreg(rdev, (0x7f98), (tmp_), 0); } while (0)
;
1489 else
1490 WREG32_P(LVTMA_DATA_SYNCHRONIZATION, LVTMA_PFREQCHG, ~LVTMA_PFREQCHG)do { uint32_t tmp_ = r100_mm_rreg(rdev, (0x7adc), 0); tmp_ &=
(~(1 << 8)); tmp_ |= (((1 << 8)) & ~(~(1 <<
8))); r100_mm_wreg(rdev, (0x7adc), (tmp_), 0); } while (0)
;
1491}
1492
1493static void rv6xx_enable_dynamic_pcie_gen2(struct radeon_device *rdev,
1494 struct radeon_ps *new_ps,
1495 bool_Bool enable)
1496{
1497 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1498
1499 if (enable) {
1500 rv6xx_enable_bif_dynamic_pcie_gen2(rdev, true1);
1501 rv6xx_enable_pcie_gen2_support(rdev);
1502 r600_enable_dynamic_pcie_gen2(rdev, true1);
1503 } else {
1504 if (!(new_state->low.flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN21))
1505 rv6xx_force_pcie_gen1(rdev);
1506 rv6xx_enable_bif_dynamic_pcie_gen2(rdev, false0);
1507 r600_enable_dynamic_pcie_gen2(rdev, false0);
1508 }
1509}
1510
1511static void rv6xx_set_uvd_clock_before_set_eng_clock(struct radeon_device *rdev,
1512 struct radeon_ps *new_ps,
1513 struct radeon_ps *old_ps)
1514{
1515 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1516 struct rv6xx_ps *current_state = rv6xx_get_ps(old_ps);
1517
1518 if ((new_ps->vclk == old_ps->vclk) &&
1519 (new_ps->dclk == old_ps->dclk))
1520 return;
1521
1522 if (new_state->high.sclk >= current_state->high.sclk)
1523 return;
1524
1525 radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk)(rdev)->asic->pm.set_uvd_clocks((rdev), (new_ps->vclk
), (new_ps->dclk))
;
1526}
1527
1528static void rv6xx_set_uvd_clock_after_set_eng_clock(struct radeon_device *rdev,
1529 struct radeon_ps *new_ps,
1530 struct radeon_ps *old_ps)
1531{
1532 struct rv6xx_ps *new_state = rv6xx_get_ps(new_ps);
1533 struct rv6xx_ps *current_state = rv6xx_get_ps(old_ps);
1534
1535 if ((new_ps->vclk == old_ps->vclk) &&
1536 (new_ps->dclk == old_ps->dclk))
1537 return;
1538
1539 if (new_state->high.sclk < current_state->high.sclk)
1540 return;
1541
1542 radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk)(rdev)->asic->pm.set_uvd_clocks((rdev), (new_ps->vclk
), (new_ps->dclk))
;
1543}
1544
1545int rv6xx_dpm_enable(struct radeon_device *rdev)
1546{
1547 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1548 struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
1549
1550 if (r600_dynamicpm_enabled(rdev))
1551 return -EINVAL22;
1552
1553 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS1)
1554 rv6xx_enable_backbias(rdev, true1);
1555
1556 if (pi->dynamic_ss)
1557 rv6xx_enable_spread_spectrum(rdev, true1);
1558
1559 rv6xx_program_mpll_timing_parameters(rdev);
1560 rv6xx_program_bsp(rdev);
1561 rv6xx_program_git(rdev);
1562 rv6xx_program_tp(rdev);
1563 rv6xx_program_tpp(rdev);
1564 rv6xx_program_sstp(rdev);
1565 rv6xx_program_fcp(rdev);
1566 rv6xx_program_vddc3d_parameters(rdev);
1567 rv6xx_program_voltage_timing_parameters(rdev);
1568 rv6xx_program_engine_speed_parameters(rdev);
1569
1570 rv6xx_enable_display_gap(rdev, true1);
1571 if (pi->display_gap == false0)
1572 rv6xx_enable_display_gap(rdev, false0);
1573
1574 rv6xx_program_power_level_enter_state(rdev);
1575
1576 rv6xx_calculate_stepping_parameters(rdev, boot_ps);
1577
1578 if (pi->voltage_control)
1579 rv6xx_program_voltage_gpio_pins(rdev);
1580
1581 rv6xx_generate_stepping_table(rdev, boot_ps);
1582
1583 rv6xx_program_stepping_parameters_except_lowest_entry(rdev);
1584 rv6xx_program_stepping_parameters_lowest_entry(rdev);
1585
1586 rv6xx_program_power_level_low(rdev);
1587 rv6xx_program_power_level_medium(rdev);
1588 rv6xx_program_power_level_high(rdev);
1589 rv6xx_program_vc(rdev);
1590 rv6xx_program_at(rdev);
1591
1592 r600_power_level_enable(rdev, R600_POWER_LEVEL_LOW, true1);
1593 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, true1);
1594 r600_power_level_enable(rdev, R600_POWER_LEVEL_HIGH, true1);
1595
1596 rv6xx_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, true1);
1597
1598 r600_start_dpm(rdev);
1599
1600 if (pi->voltage_control)
1601 rv6xx_enable_static_voltage_control(rdev, boot_ps, false0);
1602
1603 if (pi->dynamic_pcie_gen2)
1604 rv6xx_enable_dynamic_pcie_gen2(rdev, boot_ps, true1);
1605
1606 if (pi->gfx_clock_gating)
1607 r600_gfx_clockgating_enable(rdev, true1);
1608
1609 return 0;
1610}
1611
1612void rv6xx_dpm_disable(struct radeon_device *rdev)
1613{
1614 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1615 struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
1616
1617 if (!r600_dynamicpm_enabled(rdev))
1618 return;
1619
1620 r600_power_level_enable(rdev, R600_POWER_LEVEL_LOW, true1);
1621 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, true1);
1622 rv6xx_enable_display_gap(rdev, false0);
1623 rv6xx_clear_vc(rdev);
1624 r600_set_at(rdev, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF);
1625
1626 if (pi->thermal_protection)
1627 r600_enable_thermal_protection(rdev, false0);
1628
1629 r600_wait_for_power_level(rdev, R600_POWER_LEVEL_LOW);
1630 r600_power_level_enable(rdev, R600_POWER_LEVEL_HIGH, false0);
1631 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, false0);
1632
1633 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS1)
1634 rv6xx_enable_backbias(rdev, false0);
1635
1636 rv6xx_enable_spread_spectrum(rdev, false0);
1637
1638 if (pi->voltage_control)
1639 rv6xx_enable_static_voltage_control(rdev, boot_ps, true1);
1640
1641 if (pi->dynamic_pcie_gen2)
1642 rv6xx_enable_dynamic_pcie_gen2(rdev, boot_ps, false0);
1643
1644 if (rdev->irq.installed &&
1645 r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
1646 rdev->irq.dpm_thermal = false0;
1647 radeon_irq_set(rdev)(rdev)->asic->irq.set((rdev));
1648 }
1649
1650 if (pi->gfx_clock_gating)
1651 r600_gfx_clockgating_enable(rdev, false0);
1652
1653 r600_stop_dpm(rdev);
1654}
1655
1656int rv6xx_dpm_set_power_state(struct radeon_device *rdev)
1657{
1658 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
1659 struct radeon_ps *new_ps = rdev->pm.dpm.requested_ps;
1660 struct radeon_ps *old_ps = rdev->pm.dpm.current_ps;
1661 int ret;
1662
1663 pi->restricted_levels = 0;
1664
1665 rv6xx_set_uvd_clock_before_set_eng_clock(rdev, new_ps, old_ps);
1666
1667 rv6xx_clear_vc(rdev);
1668 r600_power_level_enable(rdev, R600_POWER_LEVEL_LOW, true1);
1669 r600_set_at(rdev, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF);
1670
1671 if (pi->thermal_protection)
1
Assuming field 'thermal_protection' is false
2
Taking false branch
1672 r600_enable_thermal_protection(rdev, false0);
1673
1674 r600_wait_for_power_level(rdev, R600_POWER_LEVEL_LOW);
1675 r600_power_level_enable(rdev, R600_POWER_LEVEL_HIGH, false0);
1676 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, false0);
1677
1678 rv6xx_generate_transition_stepping(rdev, new_ps, old_ps);
3
Calling 'rv6xx_generate_transition_stepping'
1679 rv6xx_program_power_level_medium_for_transition(rdev);
1680
1681 if (pi->voltage_control) {
1682 rv6xx_set_sw_voltage_to_safe(rdev, new_ps, old_ps);
1683 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_STEPVDDC128)
1684 rv6xx_set_sw_voltage_to_low(rdev, old_ps);
1685 }
1686
1687 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS1)
1688 rv6xx_set_safe_backbias(rdev, new_ps, old_ps);
1689
1690 if (pi->dynamic_pcie_gen2)
1691 rv6xx_set_safe_pcie_gen2(rdev, new_ps, old_ps);
1692
1693 if (pi->voltage_control)
1694 rv6xx_enable_dynamic_voltage_control(rdev, false0);
1695
1696 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS1)
1697 rv6xx_enable_dynamic_backbias_control(rdev, false0);
1698
1699 if (pi->voltage_control) {
1700 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_STEPVDDC128)
1701 rv6xx_step_voltage_if_increasing(rdev, new_ps, old_ps);
1702 drm_msleep((rdev->pm.dpm.voltage_response_time + 999) / 1000)mdelay((rdev->pm.dpm.voltage_response_time + 999) / 1000);
1703 }
1704
1705 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, true1);
1706 r600_power_level_enable(rdev, R600_POWER_LEVEL_LOW, false0);
1707 r600_wait_for_power_level_unequal(rdev, R600_POWER_LEVEL_LOW);
1708
1709 rv6xx_generate_low_step(rdev, new_ps);
1710 rv6xx_invalidate_intermediate_steps(rdev);
1711 rv6xx_calculate_stepping_parameters(rdev, new_ps);
1712 rv6xx_program_stepping_parameters_lowest_entry(rdev);
1713 rv6xx_program_power_level_low_to_lowest_state(rdev);
1714
1715 r600_power_level_enable(rdev, R600_POWER_LEVEL_LOW, true1);
1716 r600_wait_for_power_level(rdev, R600_POWER_LEVEL_LOW);
1717 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, false0);
1718
1719 if (pi->voltage_control) {
1720 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_STEPVDDC128) {
1721 ret = rv6xx_step_voltage_if_decreasing(rdev, new_ps, old_ps);
1722 if (ret)
1723 return ret;
1724 }
1725 rv6xx_enable_dynamic_voltage_control(rdev, true1);
1726 }
1727
1728 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_BACKBIAS1)
1729 rv6xx_enable_dynamic_backbias_control(rdev, true1);
1730
1731 if (pi->dynamic_pcie_gen2)
1732 rv6xx_enable_dynamic_pcie_gen2(rdev, new_ps, true1);
1733
1734 rv6xx_reset_lvtm_data_sync(rdev);
1735
1736 rv6xx_generate_stepping_table(rdev, new_ps);
1737 rv6xx_program_stepping_parameters_except_lowest_entry(rdev);
1738 rv6xx_program_power_level_low(rdev);
1739 rv6xx_program_power_level_medium(rdev);
1740 rv6xx_program_power_level_high(rdev);
1741 rv6xx_enable_medium(rdev);
1742 rv6xx_enable_high(rdev);
1743
1744 if (pi->thermal_protection)
1745 rv6xx_enable_thermal_protection(rdev, true1);
1746 rv6xx_program_vc(rdev);
1747 rv6xx_program_at(rdev);
1748
1749 rv6xx_set_uvd_clock_after_set_eng_clock(rdev, new_ps, old_ps);
1750
1751 return 0;
1752}
1753
1754void rv6xx_setup_asic(struct radeon_device *rdev)
1755{
1756 r600_enable_acpi_pm(rdev);
1757
1758 if (radeon_aspm != 0) {
1759 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L0s8)
1760 rv6xx_enable_l0s(rdev);
1761 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_ASPM_L116)
1762 rv6xx_enable_l1(rdev);
1763 if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_TURNOFFPLL_ASPML11024)
1764 rv6xx_enable_pll_sleep_in_l1(rdev);
1765 }
1766}
1767
1768void rv6xx_dpm_display_configuration_changed(struct radeon_device *rdev)
1769{
1770 rv6xx_program_display_gap(rdev);
1771}
1772
1773union power_info {
1774 struct _ATOM_POWERPLAY_INFO info;
1775 struct _ATOM_POWERPLAY_INFO_V2 info_2;
1776 struct _ATOM_POWERPLAY_INFO_V3 info_3;
1777 struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
1778 struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
1779 struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
1780};
1781
1782union pplib_clock_info {
1783 struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
1784 struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
1785 struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
1786 struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
1787};
1788
1789union pplib_power_state {
1790 struct _ATOM_PPLIB_STATE v1;
1791 struct _ATOM_PPLIB_STATE_V2 v2;
1792};
1793
1794static void rv6xx_parse_pplib_non_clock_info(struct radeon_device *rdev,
1795 struct radeon_ps *rps,
1796 struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info)
1797{
1798 rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings)((__uint32_t)(non_clock_info->ulCapsAndSettings));
1799 rps->class = le16_to_cpu(non_clock_info->usClassification)((__uint16_t)(non_clock_info->usClassification));
1800 rps->class2 = le16_to_cpu(non_clock_info->usClassification2)((__uint16_t)(non_clock_info->usClassification2));
1801
1802 if (r600_is_uvd_state(rps->class, rps->class2)) {
1803 rps->vclk = RV6XX_DEFAULT_VCLK_FREQ40000;
1804 rps->dclk = RV6XX_DEFAULT_DCLK_FREQ30000;
1805 } else {
1806 rps->vclk = 0;
1807 rps->dclk = 0;
1808 }
1809
1810 if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT0x0008)
1811 rdev->pm.dpm.boot_ps = rps;
1812 if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE0x0400)
1813 rdev->pm.dpm.uvd_ps = rps;
1814}
1815
1816static void rv6xx_parse_pplib_clock_info(struct radeon_device *rdev,
1817 struct radeon_ps *rps, int index,
1818 union pplib_clock_info *clock_info)
1819{
1820 struct rv6xx_ps *ps = rv6xx_get_ps(rps);
1821 u32 sclk, mclk;
1822 u16 vddc;
1823 struct rv6xx_pl *pl;
1824
1825 switch (index) {
1826 case 0:
1827 pl = &ps->low;
1828 break;
1829 case 1:
1830 pl = &ps->medium;
1831 break;
1832 case 2:
1833 default:
1834 pl = &ps->high;
1835 break;
1836 }
1837
1838 sclk = le16_to_cpu(clock_info->r600.usEngineClockLow)((__uint16_t)(clock_info->r600.usEngineClockLow));
1839 sclk |= clock_info->r600.ucEngineClockHigh << 16;
1840 mclk = le16_to_cpu(clock_info->r600.usMemoryClockLow)((__uint16_t)(clock_info->r600.usMemoryClockLow));
1841 mclk |= clock_info->r600.ucMemoryClockHigh << 16;
1842
1843 pl->mclk = mclk;
1844 pl->sclk = sclk;
1845 pl->vddc = le16_to_cpu(clock_info->r600.usVDDC)((__uint16_t)(clock_info->r600.usVDDC));
1846 pl->flags = le32_to_cpu(clock_info->r600.ulFlags)((__uint32_t)(clock_info->r600.ulFlags));
1847
1848 /* patch up vddc if necessary */
1849 if (pl->vddc == 0xff01) {
1850 if (radeon_atom_get_max_vddc(rdev, 0, 0, &vddc) == 0)
1851 pl->vddc = vddc;
1852 }
1853
1854 /* fix up pcie gen2 */
1855 if (pl->flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN21) {
1856 if ((rdev->family == CHIP_RV610) || (rdev->family == CHIP_RV630)) {
1857 if (pl->vddc < 1100)
1858 pl->flags &= ~ATOM_PPLIB_R600_FLAGS_PCIEGEN21;
1859 }
1860 }
1861
1862 /* patch up boot state */
1863 if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT0x0008) {
1864 u16 vddc, vddci, mvdd;
1865 radeon_atombios_get_default_voltages(rdev, &vddc, &vddci, &mvdd);
1866 pl->mclk = rdev->clock.default_mclk;
1867 pl->sclk = rdev->clock.default_sclk;
1868 pl->vddc = vddc;
1869 }
1870}
1871
1872static int rv6xx_parse_power_table(struct radeon_device *rdev)
1873{
1874 struct radeon_mode_info *mode_info = &rdev->mode_info;
1875 struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
1876 union pplib_power_state *power_state;
1877 int i, j;
1878 union pplib_clock_info *clock_info;
1879 union power_info *power_info;
1880 int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo)(((char*)(&((ATOM_MASTER_LIST_OF_DATA_TABLES*)0)->PowerPlayInfo
)-(char*)0)/sizeof(USHORT))
;
1881 u16 data_offset;
1882 u8 frev, crev;
1883 struct rv6xx_ps *ps;
1884
1885 if (!atom_parse_data_header(mode_info->atom_context, index, NULL((void *)0),
1886 &frev, &crev, &data_offset))
1887 return -EINVAL22;
1888 power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
1889
1890 rdev->pm.dpm.ps = kcalloc(power_info->pplib.ucNumStates,
1891 sizeof(struct radeon_ps),
1892 GFP_KERNEL(0x0001 | 0x0004));
1893 if (!rdev->pm.dpm.ps)
1894 return -ENOMEM12;
1895
1896 for (i = 0; i < power_info->pplib.ucNumStates; i++) {
1897 power_state = (union pplib_power_state *)
1898 (mode_info->atom_context->bios + data_offset +
1899 le16_to_cpu(power_info->pplib.usStateArrayOffset)((__uint16_t)(power_info->pplib.usStateArrayOffset)) +
1900 i * power_info->pplib.ucStateEntrySize);
1901 non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
1902 (mode_info->atom_context->bios + data_offset +
1903 le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset)((__uint16_t)(power_info->pplib.usNonClockInfoArrayOffset)
)
+
1904 (power_state->v1.ucNonClockStateIndex *
1905 power_info->pplib.ucNonClockSize));
1906 if (power_info->pplib.ucStateEntrySize - 1) {
1907 u8 *idx;
1908 ps = kzalloc(sizeof(struct rv6xx_ps), GFP_KERNEL(0x0001 | 0x0004));
1909 if (ps == NULL((void *)0)) {
1910 kfree(rdev->pm.dpm.ps);
1911 return -ENOMEM12;
1912 }
1913 rdev->pm.dpm.ps[i].ps_priv = ps;
1914 rv6xx_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
1915 non_clock_info);
1916 idx = (u8 *)&power_state->v1.ucClockStateIndices[0];
1917 for (j = 0; j < (power_info->pplib.ucStateEntrySize - 1); j++) {
1918 clock_info = (union pplib_clock_info *)
1919 (mode_info->atom_context->bios + data_offset +
1920 le16_to_cpu(power_info->pplib.usClockInfoArrayOffset)((__uint16_t)(power_info->pplib.usClockInfoArrayOffset)) +
1921 (idx[j] * power_info->pplib.ucClockInfoSize));
1922 rv6xx_parse_pplib_clock_info(rdev,
1923 &rdev->pm.dpm.ps[i], j,
1924 clock_info);
1925 }
1926 }
1927 }
1928 rdev->pm.dpm.num_ps = power_info->pplib.ucNumStates;
1929 return 0;
1930}
1931
1932int rv6xx_dpm_init(struct radeon_device *rdev)
1933{
1934 struct radeon_atom_ss ss;
1935 struct atom_clock_dividers dividers;
1936 struct rv6xx_power_info *pi;
1937 int ret;
1938
1939 pi = kzalloc(sizeof(struct rv6xx_power_info), GFP_KERNEL(0x0001 | 0x0004));
1940 if (pi == NULL((void *)0))
1941 return -ENOMEM12;
1942 rdev->pm.dpm.priv = pi;
1943
1944 ret = r600_get_platform_caps(rdev);
1945 if (ret)
1946 return ret;
1947
1948 ret = rv6xx_parse_power_table(rdev);
1949 if (ret)
1950 return ret;
1951
1952 if (rdev->pm.dpm.voltage_response_time == 0)
1953 rdev->pm.dpm.voltage_response_time = R600_VOLTAGERESPONSETIME_DFLT1000;
1954 if (rdev->pm.dpm.backbias_response_time == 0)
1955 rdev->pm.dpm.backbias_response_time = R600_BACKBIASRESPONSETIME_DFLT1000;
1956
1957 ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM2,
1958 0, false0, &dividers);
1959 if (ret)
1960 pi->spll_ref_div = dividers.ref_div + 1;
1961 else
1962 pi->spll_ref_div = R600_REFERENCEDIVIDER_DFLT4;
1963
1964 ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_MEMORY_PLL_PARAM1,
1965 0, false0, &dividers);
1966 if (ret)
1967 pi->mpll_ref_div = dividers.ref_div + 1;
1968 else
1969 pi->mpll_ref_div = R600_REFERENCEDIVIDER_DFLT4;
1970
1971 if (rdev->family >= CHIP_RV670)
1972 pi->fb_div_scale = 1;
1973 else
1974 pi->fb_div_scale = 0;
1975
1976 pi->voltage_control =
1977 radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC1, 0);
1978
1979 pi->gfx_clock_gating = true1;
1980
1981 pi->sclk_ss = radeon_atombios_get_asic_ss_info(rdev, &ss,
1982 ASIC_INTERNAL_ENGINE_SS2, 0);
1983 pi->mclk_ss = radeon_atombios_get_asic_ss_info(rdev, &ss,
1984 ASIC_INTERNAL_MEMORY_SS1, 0);
1985
1986 /* Disable sclk ss, causes hangs on a lot of systems */
1987 pi->sclk_ss = false0;
1988
1989 if (pi->sclk_ss || pi->mclk_ss)
1990 pi->dynamic_ss = true1;
1991 else
1992 pi->dynamic_ss = false0;
1993
1994 pi->dynamic_pcie_gen2 = true1;
1995
1996 if (pi->gfx_clock_gating &&
1997 (rdev->pm.int_thermal_type != THERMAL_TYPE_NONE))
1998 pi->thermal_protection = true1;
1999 else
2000 pi->thermal_protection = false0;
2001
2002 pi->display_gap = true1;
2003
2004 return 0;
2005}
2006
2007void rv6xx_dpm_print_power_state(struct radeon_device *rdev,
2008 struct radeon_ps *rps)
2009{
2010 struct rv6xx_ps *ps = rv6xx_get_ps(rps);
2011 struct rv6xx_pl *pl;
2012
2013 r600_dpm_print_class_info(rps->class, rps->class2);
2014 r600_dpm_print_cap_info(rps->caps);
2015 printk("\tuvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
2016 pl = &ps->low;
2017 printk("\t\tpower level 0 sclk: %u mclk: %u vddc: %u\n",
2018 pl->sclk, pl->mclk, pl->vddc);
2019 pl = &ps->medium;
2020 printk("\t\tpower level 1 sclk: %u mclk: %u vddc: %u\n",
2021 pl->sclk, pl->mclk, pl->vddc);
2022 pl = &ps->high;
2023 printk("\t\tpower level 2 sclk: %u mclk: %u vddc: %u\n",
2024 pl->sclk, pl->mclk, pl->vddc);
2025 r600_dpm_print_ps_status(rdev, rps);
2026}
2027
2028void rv6xx_dpm_debugfs_print_current_performance_level(struct radeon_device *rdev,
2029 struct seq_file *m)
2030{
2031 struct radeon_ps *rps = rdev->pm.dpm.current_ps;
2032 struct rv6xx_ps *ps = rv6xx_get_ps(rps);
2033 struct rv6xx_pl *pl;
2034 u32 current_index =
2035 (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX)r100_mm_rreg(rdev, (0x70c), 0) & CURRENT_PROFILE_INDEX_MASK(3 << 2)) >>
2036 CURRENT_PROFILE_INDEX_SHIFT2;
2037
2038 if (current_index > 2) {
2039 seq_printf(m, "invalid dpm profile %d\n", current_index);
2040 } else {
2041 if (current_index == 0)
2042 pl = &ps->low;
2043 else if (current_index == 1)
2044 pl = &ps->medium;
2045 else /* current_index == 2 */
2046 pl = &ps->high;
2047 seq_printf(m, "uvd vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
2048 seq_printf(m, "power level %d sclk: %u mclk: %u vddc: %u\n",
2049 current_index, pl->sclk, pl->mclk, pl->vddc);
2050 }
2051}
2052
2053/* get the current sclk in 10 khz units */
2054u32 rv6xx_dpm_get_current_sclk(struct radeon_device *rdev)
2055{
2056 struct radeon_ps *rps = rdev->pm.dpm.current_ps;
2057 struct rv6xx_ps *ps = rv6xx_get_ps(rps);
2058 struct rv6xx_pl *pl;
2059 u32 current_index =
2060 (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX)r100_mm_rreg(rdev, (0x70c), 0) & CURRENT_PROFILE_INDEX_MASK(3 << 2)) >>
2061 CURRENT_PROFILE_INDEX_SHIFT2;
2062
2063 if (current_index > 2) {
2064 return 0;
2065 } else {
2066 if (current_index == 0)
2067 pl = &ps->low;
2068 else if (current_index == 1)
2069 pl = &ps->medium;
2070 else /* current_index == 2 */
2071 pl = &ps->high;
2072 return pl->sclk;
2073 }
2074}
2075
2076/* get the current mclk in 10 khz units */
2077u32 rv6xx_dpm_get_current_mclk(struct radeon_device *rdev)
2078{
2079 struct radeon_ps *rps = rdev->pm.dpm.current_ps;
2080 struct rv6xx_ps *ps = rv6xx_get_ps(rps);
2081 struct rv6xx_pl *pl;
2082 u32 current_index =
2083 (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX)r100_mm_rreg(rdev, (0x70c), 0) & CURRENT_PROFILE_INDEX_MASK(3 << 2)) >>
2084 CURRENT_PROFILE_INDEX_SHIFT2;
2085
2086 if (current_index > 2) {
2087 return 0;
2088 } else {
2089 if (current_index == 0)
2090 pl = &ps->low;
2091 else if (current_index == 1)
2092 pl = &ps->medium;
2093 else /* current_index == 2 */
2094 pl = &ps->high;
2095 return pl->mclk;
2096 }
2097}
2098
2099void rv6xx_dpm_fini(struct radeon_device *rdev)
2100{
2101 int i;
2102
2103 for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
2104 kfree(rdev->pm.dpm.ps[i].ps_priv);
2105 }
2106 kfree(rdev->pm.dpm.ps);
2107 kfree(rdev->pm.dpm.priv);
2108}
2109
2110u32 rv6xx_dpm_get_sclk(struct radeon_device *rdev, bool_Bool low)
2111{
2112 struct rv6xx_ps *requested_state = rv6xx_get_ps(rdev->pm.dpm.requested_ps);
2113
2114 if (low)
2115 return requested_state->low.sclk;
2116 else
2117 return requested_state->high.sclk;
2118}
2119
2120u32 rv6xx_dpm_get_mclk(struct radeon_device *rdev, bool_Bool low)
2121{
2122 struct rv6xx_ps *requested_state = rv6xx_get_ps(rdev->pm.dpm.requested_ps);
2123
2124 if (low)
2125 return requested_state->low.mclk;
2126 else
2127 return requested_state->high.mclk;
2128}
2129
2130int rv6xx_dpm_force_performance_level(struct radeon_device *rdev,
2131 enum radeon_dpm_forced_level level)
2132{
2133 struct rv6xx_power_info *pi = rv6xx_get_pi(rdev);
2134
2135 if (level == RADEON_DPM_FORCED_LEVEL_HIGH) {
2136 pi->restricted_levels = 3;
2137 } else if (level == RADEON_DPM_FORCED_LEVEL_LOW) {
2138 pi->restricted_levels = 2;
2139 } else {
2140 pi->restricted_levels = 0;
2141 }
2142
2143 rv6xx_clear_vc(rdev);
2144 r600_power_level_enable(rdev, R600_POWER_LEVEL_LOW, true1);
2145 r600_set_at(rdev, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF);
2146 r600_wait_for_power_level(rdev, R600_POWER_LEVEL_LOW);
2147 r600_power_level_enable(rdev, R600_POWER_LEVEL_HIGH, false0);
2148 r600_power_level_enable(rdev, R600_POWER_LEVEL_MEDIUM, false0);
2149 rv6xx_enable_medium(rdev);
2150 rv6xx_enable_high(rdev);
2151 if (pi->restricted_levels == 3)
2152 r600_power_level_enable(rdev, R600_POWER_LEVEL_LOW, false0);
2153 rv6xx_program_vc(rdev);
2154 rv6xx_program_at(rdev);
2155
2156 rdev->pm.dpm.forced_level = level;
2157
2158 return 0;
2159}