xref: /linux/drivers/gpu/drm/radeon/ci_dpm.c (revision 189abca05a89fc7b422811e497a7116b3e4f4dca)
1 /*
2  * Copyright 2013 Advanced Micro Devices, Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  */
23 
24 #include <linux/firmware.h>
25 #include <linux/pci.h>
26 #include <linux/seq_file.h>
27 
28 #include "atom.h"
29 #include "ci_dpm.h"
30 #include "cik.h"
31 #include "cikd.h"
32 #include "r600_dpm.h"
33 #include "radeon.h"
34 #include "radeon_asic.h"
35 #include "radeon_ucode.h"
36 #include "si_dpm.h"
37 
38 #define MC_CG_ARB_FREQ_F0           0x0a
39 #define MC_CG_ARB_FREQ_F1           0x0b
40 #define MC_CG_ARB_FREQ_F2           0x0c
41 #define MC_CG_ARB_FREQ_F3           0x0d
42 
43 #define SMC_RAM_END 0x40000
44 
45 #define VOLTAGE_SCALE               4
46 #define VOLTAGE_VID_OFFSET_SCALE1    625
47 #define VOLTAGE_VID_OFFSET_SCALE2    100
48 
49 static const struct ci_pt_defaults defaults_hawaii_xt = {
50 	1, 0xF, 0xFD, 0x19, 5, 0x14, 0, 0xB0000,
51 	{ 0x2E,  0x00,  0x00,  0x88,  0x00,  0x00,  0x72,  0x60,  0x51,  0xA7,  0x79,  0x6B,  0x90,  0xBD,  0x79  },
52 	{ 0x217, 0x217, 0x217, 0x242, 0x242, 0x242, 0x269, 0x269, 0x269, 0x2A1, 0x2A1, 0x2A1, 0x2C9, 0x2C9, 0x2C9 }
53 };
54 
55 static const struct ci_pt_defaults defaults_hawaii_pro = {
56 	1, 0xF, 0xFD, 0x19, 5, 0x14, 0, 0x65062,
57 	{ 0x2E,  0x00,  0x00,  0x88,  0x00,  0x00,  0x72,  0x60,  0x51,  0xA7,  0x79,  0x6B,  0x90,  0xBD,  0x79  },
58 	{ 0x217, 0x217, 0x217, 0x242, 0x242, 0x242, 0x269, 0x269, 0x269, 0x2A1, 0x2A1, 0x2A1, 0x2C9, 0x2C9, 0x2C9 }
59 };
60 
61 static const struct ci_pt_defaults defaults_bonaire_xt = {
62 	1, 0xF, 0xFD, 0x19, 5, 45, 0, 0xB0000,
63 	{ 0x79,  0x253, 0x25D, 0xAE,  0x72,  0x80,  0x83,  0x86,  0x6F,  0xC8,  0xC9,  0xC9,  0x2F,  0x4D,  0x61  },
64 	{ 0x17C, 0x172, 0x180, 0x1BC, 0x1B3, 0x1BD, 0x206, 0x200, 0x203, 0x25D, 0x25A, 0x255, 0x2C3, 0x2C5, 0x2B4 }
65 };
66 
67 static const struct ci_pt_defaults defaults_saturn_xt = {
68 	1, 0xF, 0xFD, 0x19, 5, 55, 0, 0x70000,
69 	{ 0x8C,  0x247, 0x249, 0xA6,  0x80,  0x81,  0x8B,  0x89,  0x86,  0xC9,  0xCA,  0xC9,  0x4D,  0x4D,  0x4D  },
70 	{ 0x187, 0x187, 0x187, 0x1C7, 0x1C7, 0x1C7, 0x210, 0x210, 0x210, 0x266, 0x266, 0x266, 0x2C9, 0x2C9, 0x2C9 }
71 };
72 
73 static const struct ci_pt_config_reg didt_config_ci[] = {
74 	{ 0x10, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
75 	{ 0x10, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
76 	{ 0x10, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
77 	{ 0x10, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
78 	{ 0x11, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
79 	{ 0x11, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
80 	{ 0x11, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
81 	{ 0x11, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
82 	{ 0x12, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
83 	{ 0x12, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
84 	{ 0x12, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
85 	{ 0x12, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
86 	{ 0x2, 0x00003fff, 0, 0x4, CISLANDS_CONFIGREG_DIDT_IND },
87 	{ 0x2, 0x03ff0000, 16, 0x80, CISLANDS_CONFIGREG_DIDT_IND },
88 	{ 0x2, 0x78000000, 27, 0x3, CISLANDS_CONFIGREG_DIDT_IND },
89 	{ 0x1, 0x0000ffff, 0, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
90 	{ 0x1, 0xffff0000, 16, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
91 	{ 0x0, 0x00000001, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
92 	{ 0x30, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
93 	{ 0x30, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
94 	{ 0x30, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
95 	{ 0x30, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
96 	{ 0x31, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
97 	{ 0x31, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
98 	{ 0x31, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
99 	{ 0x31, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
100 	{ 0x32, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
101 	{ 0x32, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
102 	{ 0x32, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
103 	{ 0x32, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
104 	{ 0x22, 0x00003fff, 0, 0x4, CISLANDS_CONFIGREG_DIDT_IND },
105 	{ 0x22, 0x03ff0000, 16, 0x80, CISLANDS_CONFIGREG_DIDT_IND },
106 	{ 0x22, 0x78000000, 27, 0x3, CISLANDS_CONFIGREG_DIDT_IND },
107 	{ 0x21, 0x0000ffff, 0, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
108 	{ 0x21, 0xffff0000, 16, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
109 	{ 0x20, 0x00000001, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
110 	{ 0x50, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
111 	{ 0x50, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
112 	{ 0x50, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
113 	{ 0x50, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
114 	{ 0x51, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
115 	{ 0x51, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
116 	{ 0x51, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
117 	{ 0x51, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
118 	{ 0x52, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
119 	{ 0x52, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
120 	{ 0x52, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
121 	{ 0x52, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
122 	{ 0x42, 0x00003fff, 0, 0x4, CISLANDS_CONFIGREG_DIDT_IND },
123 	{ 0x42, 0x03ff0000, 16, 0x80, CISLANDS_CONFIGREG_DIDT_IND },
124 	{ 0x42, 0x78000000, 27, 0x3, CISLANDS_CONFIGREG_DIDT_IND },
125 	{ 0x41, 0x0000ffff, 0, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
126 	{ 0x41, 0xffff0000, 16, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
127 	{ 0x40, 0x00000001, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
128 	{ 0x70, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
129 	{ 0x70, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
130 	{ 0x70, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
131 	{ 0x70, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
132 	{ 0x71, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
133 	{ 0x71, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
134 	{ 0x71, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
135 	{ 0x71, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
136 	{ 0x72, 0x000000ff, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
137 	{ 0x72, 0x0000ff00, 8, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
138 	{ 0x72, 0x00ff0000, 16, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
139 	{ 0x72, 0xff000000, 24, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
140 	{ 0x62, 0x00003fff, 0, 0x4, CISLANDS_CONFIGREG_DIDT_IND },
141 	{ 0x62, 0x03ff0000, 16, 0x80, CISLANDS_CONFIGREG_DIDT_IND },
142 	{ 0x62, 0x78000000, 27, 0x3, CISLANDS_CONFIGREG_DIDT_IND },
143 	{ 0x61, 0x0000ffff, 0, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
144 	{ 0x61, 0xffff0000, 16, 0x3FFF, CISLANDS_CONFIGREG_DIDT_IND },
145 	{ 0x60, 0x00000001, 0, 0x0, CISLANDS_CONFIGREG_DIDT_IND },
146 	{ 0xFFFFFFFF }
147 };
148 
149 extern u8 rv770_get_memory_module_index(struct radeon_device *rdev);
150 extern int ni_copy_and_switch_arb_sets(struct radeon_device *rdev,
151 				       u32 arb_freq_src, u32 arb_freq_dest);
152 static int ci_get_std_voltage_value_sidd(struct radeon_device *rdev,
153 					 struct atom_voltage_table_entry *voltage_table,
154 					 u16 *std_voltage_hi_sidd, u16 *std_voltage_lo_sidd);
155 static int ci_set_power_limit(struct radeon_device *rdev, u32 n);
156 static int ci_set_overdrive_target_tdp(struct radeon_device *rdev,
157 				       u32 target_tdp);
158 static int ci_update_uvd_dpm(struct radeon_device *rdev, bool gate);
159 
160 static PPSMC_Result ci_send_msg_to_smc(struct radeon_device *rdev, PPSMC_Msg msg);
161 static PPSMC_Result ci_send_msg_to_smc_with_parameter(struct radeon_device *rdev,
162 						      PPSMC_Msg msg, u32 parameter);
163 
164 static void ci_thermal_start_smc_fan_control(struct radeon_device *rdev);
165 static void ci_fan_ctrl_set_default_mode(struct radeon_device *rdev);
166 
167 static struct ci_power_info *ci_get_pi(struct radeon_device *rdev)
168 {
169 	struct ci_power_info *pi = rdev->pm.dpm.priv;
170 
171 	return pi;
172 }
173 
174 static struct ci_ps *ci_get_ps(struct radeon_ps *rps)
175 {
176 	struct ci_ps *ps = rps->ps_priv;
177 
178 	return ps;
179 }
180 
181 static void ci_initialize_powertune_defaults(struct radeon_device *rdev)
182 {
183 	struct ci_power_info *pi = ci_get_pi(rdev);
184 
185 	switch (rdev->pdev->device) {
186 	case 0x6649:
187 	case 0x6650:
188 	case 0x6651:
189 	case 0x6658:
190 	case 0x665C:
191 	case 0x665D:
192 	default:
193 		pi->powertune_defaults = &defaults_bonaire_xt;
194 		break;
195 	case 0x6640:
196 	case 0x6641:
197 	case 0x6646:
198 	case 0x6647:
199 		pi->powertune_defaults = &defaults_saturn_xt;
200 		break;
201 	case 0x67B8:
202 	case 0x67B0:
203 		pi->powertune_defaults = &defaults_hawaii_xt;
204 		break;
205 	case 0x67BA:
206 	case 0x67B1:
207 		pi->powertune_defaults = &defaults_hawaii_pro;
208 		break;
209 	case 0x67A0:
210 	case 0x67A1:
211 	case 0x67A2:
212 	case 0x67A8:
213 	case 0x67A9:
214 	case 0x67AA:
215 	case 0x67B9:
216 	case 0x67BE:
217 		pi->powertune_defaults = &defaults_bonaire_xt;
218 		break;
219 	}
220 
221 	pi->dte_tj_offset = 0;
222 
223 	pi->caps_power_containment = true;
224 	pi->caps_cac = false;
225 	pi->caps_sq_ramping = false;
226 	pi->caps_db_ramping = false;
227 	pi->caps_td_ramping = false;
228 	pi->caps_tcp_ramping = false;
229 
230 	if (pi->caps_power_containment) {
231 		pi->caps_cac = true;
232 		if (rdev->family == CHIP_HAWAII)
233 			pi->enable_bapm_feature = false;
234 		else
235 			pi->enable_bapm_feature = true;
236 		pi->enable_tdc_limit_feature = true;
237 		pi->enable_pkg_pwr_tracking_feature = true;
238 	}
239 }
240 
241 static u8 ci_convert_to_vid(u16 vddc)
242 {
243 	return (6200 - (vddc * VOLTAGE_SCALE)) / 25;
244 }
245 
246 static int ci_populate_bapm_vddc_vid_sidd(struct radeon_device *rdev)
247 {
248 	struct ci_power_info *pi = ci_get_pi(rdev);
249 	u8 *hi_vid = pi->smc_powertune_table.BapmVddCVidHiSidd;
250 	u8 *lo_vid = pi->smc_powertune_table.BapmVddCVidLoSidd;
251 	u8 *hi2_vid = pi->smc_powertune_table.BapmVddCVidHiSidd2;
252 	u32 i;
253 
254 	if (rdev->pm.dpm.dyn_state.cac_leakage_table.entries == NULL)
255 		return -EINVAL;
256 	if (rdev->pm.dpm.dyn_state.cac_leakage_table.count > 8)
257 		return -EINVAL;
258 	if (rdev->pm.dpm.dyn_state.cac_leakage_table.count !=
259 	    rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.count)
260 		return -EINVAL;
261 
262 	for (i = 0; i < rdev->pm.dpm.dyn_state.cac_leakage_table.count; i++) {
263 		if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_EVV) {
264 			lo_vid[i] = ci_convert_to_vid(rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc1);
265 			hi_vid[i] = ci_convert_to_vid(rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc2);
266 			hi2_vid[i] = ci_convert_to_vid(rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc3);
267 		} else {
268 			lo_vid[i] = ci_convert_to_vid(rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].vddc);
269 			hi_vid[i] = ci_convert_to_vid((u16)rdev->pm.dpm.dyn_state.cac_leakage_table.entries[i].leakage);
270 		}
271 	}
272 	return 0;
273 }
274 
275 static int ci_populate_vddc_vid(struct radeon_device *rdev)
276 {
277 	struct ci_power_info *pi = ci_get_pi(rdev);
278 	u8 *vid = pi->smc_powertune_table.VddCVid;
279 	u32 i;
280 
281 	if (pi->vddc_voltage_table.count > 8)
282 		return -EINVAL;
283 
284 	for (i = 0; i < pi->vddc_voltage_table.count; i++)
285 		vid[i] = ci_convert_to_vid(pi->vddc_voltage_table.entries[i].value);
286 
287 	return 0;
288 }
289 
290 static int ci_populate_svi_load_line(struct radeon_device *rdev)
291 {
292 	struct ci_power_info *pi = ci_get_pi(rdev);
293 	const struct ci_pt_defaults *pt_defaults = pi->powertune_defaults;
294 
295 	pi->smc_powertune_table.SviLoadLineEn = pt_defaults->svi_load_line_en;
296 	pi->smc_powertune_table.SviLoadLineVddC = pt_defaults->svi_load_line_vddc;
297 	pi->smc_powertune_table.SviLoadLineTrimVddC = 3;
298 	pi->smc_powertune_table.SviLoadLineOffsetVddC = 0;
299 
300 	return 0;
301 }
302 
303 static int ci_populate_tdc_limit(struct radeon_device *rdev)
304 {
305 	struct ci_power_info *pi = ci_get_pi(rdev);
306 	const struct ci_pt_defaults *pt_defaults = pi->powertune_defaults;
307 	u16 tdc_limit;
308 
309 	tdc_limit = rdev->pm.dpm.dyn_state.cac_tdp_table->tdc * 256;
310 	pi->smc_powertune_table.TDC_VDDC_PkgLimit = cpu_to_be16(tdc_limit);
311 	pi->smc_powertune_table.TDC_VDDC_ThrottleReleaseLimitPerc =
312 		pt_defaults->tdc_vddc_throttle_release_limit_perc;
313 	pi->smc_powertune_table.TDC_MAWt = pt_defaults->tdc_mawt;
314 
315 	return 0;
316 }
317 
318 static int ci_populate_dw8(struct radeon_device *rdev)
319 {
320 	struct ci_power_info *pi = ci_get_pi(rdev);
321 	const struct ci_pt_defaults *pt_defaults = pi->powertune_defaults;
322 	int ret;
323 
324 	ret = ci_read_smc_sram_dword(rdev,
325 				     SMU7_FIRMWARE_HEADER_LOCATION +
326 				     offsetof(SMU7_Firmware_Header, PmFuseTable) +
327 				     offsetof(SMU7_Discrete_PmFuses, TdcWaterfallCtl),
328 				     (u32 *)&pi->smc_powertune_table.TdcWaterfallCtl,
329 				     pi->sram_end);
330 	if (ret)
331 		return -EINVAL;
332 	else
333 		pi->smc_powertune_table.TdcWaterfallCtl = pt_defaults->tdc_waterfall_ctl;
334 
335 	return 0;
336 }
337 
338 static int ci_populate_fuzzy_fan(struct radeon_device *rdev)
339 {
340 	struct ci_power_info *pi = ci_get_pi(rdev);
341 
342 	if ((rdev->pm.dpm.fan.fan_output_sensitivity & (1 << 15)) ||
343 	    (rdev->pm.dpm.fan.fan_output_sensitivity == 0))
344 		rdev->pm.dpm.fan.fan_output_sensitivity =
345 			rdev->pm.dpm.fan.default_fan_output_sensitivity;
346 
347 	pi->smc_powertune_table.FuzzyFan_PwmSetDelta =
348 		cpu_to_be16(rdev->pm.dpm.fan.fan_output_sensitivity);
349 
350 	return 0;
351 }
352 
353 static int ci_min_max_v_gnbl_pm_lid_from_bapm_vddc(struct radeon_device *rdev)
354 {
355 	struct ci_power_info *pi = ci_get_pi(rdev);
356 	u8 *hi_vid = pi->smc_powertune_table.BapmVddCVidHiSidd;
357 	u8 *lo_vid = pi->smc_powertune_table.BapmVddCVidLoSidd;
358 	int i, min, max;
359 
360 	min = max = hi_vid[0];
361 	for (i = 0; i < 8; i++) {
362 		if (0 != hi_vid[i]) {
363 			if (min > hi_vid[i])
364 				min = hi_vid[i];
365 			if (max < hi_vid[i])
366 				max = hi_vid[i];
367 		}
368 
369 		if (0 != lo_vid[i]) {
370 			if (min > lo_vid[i])
371 				min = lo_vid[i];
372 			if (max < lo_vid[i])
373 				max = lo_vid[i];
374 		}
375 	}
376 
377 	if ((min == 0) || (max == 0))
378 		return -EINVAL;
379 	pi->smc_powertune_table.GnbLPMLMaxVid = (u8)max;
380 	pi->smc_powertune_table.GnbLPMLMinVid = (u8)min;
381 
382 	return 0;
383 }
384 
385 static int ci_populate_bapm_vddc_base_leakage_sidd(struct radeon_device *rdev)
386 {
387 	struct ci_power_info *pi = ci_get_pi(rdev);
388 	u16 hi_sidd, lo_sidd;
389 	struct radeon_cac_tdp_table *cac_tdp_table =
390 		rdev->pm.dpm.dyn_state.cac_tdp_table;
391 
392 	hi_sidd = cac_tdp_table->high_cac_leakage / 100 * 256;
393 	lo_sidd = cac_tdp_table->low_cac_leakage / 100 * 256;
394 
395 	pi->smc_powertune_table.BapmVddCBaseLeakageHiSidd = cpu_to_be16(hi_sidd);
396 	pi->smc_powertune_table.BapmVddCBaseLeakageLoSidd = cpu_to_be16(lo_sidd);
397 
398 	return 0;
399 }
400 
401 static int ci_populate_bapm_parameters_in_dpm_table(struct radeon_device *rdev)
402 {
403 	struct ci_power_info *pi = ci_get_pi(rdev);
404 	const struct ci_pt_defaults *pt_defaults = pi->powertune_defaults;
405 	SMU7_Discrete_DpmTable  *dpm_table = &pi->smc_state_table;
406 	struct radeon_cac_tdp_table *cac_tdp_table =
407 		rdev->pm.dpm.dyn_state.cac_tdp_table;
408 	struct radeon_ppm_table *ppm = rdev->pm.dpm.dyn_state.ppm_table;
409 	int i, j, k;
410 	const u16 *def1;
411 	const u16 *def2;
412 
413 	dpm_table->DefaultTdp = cac_tdp_table->tdp * 256;
414 	dpm_table->TargetTdp = cac_tdp_table->configurable_tdp * 256;
415 
416 	dpm_table->DTETjOffset = (u8)pi->dte_tj_offset;
417 	dpm_table->GpuTjMax =
418 		(u8)(pi->thermal_temp_setting.temperature_high / 1000);
419 	dpm_table->GpuTjHyst = 8;
420 
421 	dpm_table->DTEAmbientTempBase = pt_defaults->dte_ambient_temp_base;
422 
423 	if (ppm) {
424 		dpm_table->PPM_PkgPwrLimit = cpu_to_be16((u16)ppm->dgpu_tdp * 256 / 1000);
425 		dpm_table->PPM_TemperatureLimit = cpu_to_be16((u16)ppm->tj_max * 256);
426 	} else {
427 		dpm_table->PPM_PkgPwrLimit = cpu_to_be16(0);
428 		dpm_table->PPM_TemperatureLimit = cpu_to_be16(0);
429 	}
430 
431 	dpm_table->BAPM_TEMP_GRADIENT = cpu_to_be32(pt_defaults->bapm_temp_gradient);
432 	def1 = pt_defaults->bapmti_r;
433 	def2 = pt_defaults->bapmti_rc;
434 
435 	for (i = 0; i < SMU7_DTE_ITERATIONS; i++) {
436 		for (j = 0; j < SMU7_DTE_SOURCES; j++) {
437 			for (k = 0; k < SMU7_DTE_SINKS; k++) {
438 				dpm_table->BAPMTI_R[i][j][k] = cpu_to_be16(*def1);
439 				dpm_table->BAPMTI_RC[i][j][k] = cpu_to_be16(*def2);
440 				def1++;
441 				def2++;
442 			}
443 		}
444 	}
445 
446 	return 0;
447 }
448 
449 static int ci_populate_pm_base(struct radeon_device *rdev)
450 {
451 	struct ci_power_info *pi = ci_get_pi(rdev);
452 	u32 pm_fuse_table_offset;
453 	int ret;
454 
455 	if (pi->caps_power_containment) {
456 		ret = ci_read_smc_sram_dword(rdev,
457 					     SMU7_FIRMWARE_HEADER_LOCATION +
458 					     offsetof(SMU7_Firmware_Header, PmFuseTable),
459 					     &pm_fuse_table_offset, pi->sram_end);
460 		if (ret)
461 			return ret;
462 		ret = ci_populate_bapm_vddc_vid_sidd(rdev);
463 		if (ret)
464 			return ret;
465 		ret = ci_populate_vddc_vid(rdev);
466 		if (ret)
467 			return ret;
468 		ret = ci_populate_svi_load_line(rdev);
469 		if (ret)
470 			return ret;
471 		ret = ci_populate_tdc_limit(rdev);
472 		if (ret)
473 			return ret;
474 		ret = ci_populate_dw8(rdev);
475 		if (ret)
476 			return ret;
477 		ret = ci_populate_fuzzy_fan(rdev);
478 		if (ret)
479 			return ret;
480 		ret = ci_min_max_v_gnbl_pm_lid_from_bapm_vddc(rdev);
481 		if (ret)
482 			return ret;
483 		ret = ci_populate_bapm_vddc_base_leakage_sidd(rdev);
484 		if (ret)
485 			return ret;
486 		ret = ci_copy_bytes_to_smc(rdev, pm_fuse_table_offset,
487 					   (u8 *)&pi->smc_powertune_table,
488 					   sizeof(SMU7_Discrete_PmFuses), pi->sram_end);
489 		if (ret)
490 			return ret;
491 	}
492 
493 	return 0;
494 }
495 
496 static void ci_do_enable_didt(struct radeon_device *rdev, const bool enable)
497 {
498 	struct ci_power_info *pi = ci_get_pi(rdev);
499 	u32 data;
500 
501 	if (pi->caps_sq_ramping) {
502 		data = RREG32_DIDT(DIDT_SQ_CTRL0);
503 		if (enable)
504 			data |= DIDT_CTRL_EN;
505 		else
506 			data &= ~DIDT_CTRL_EN;
507 		WREG32_DIDT(DIDT_SQ_CTRL0, data);
508 	}
509 
510 	if (pi->caps_db_ramping) {
511 		data = RREG32_DIDT(DIDT_DB_CTRL0);
512 		if (enable)
513 			data |= DIDT_CTRL_EN;
514 		else
515 			data &= ~DIDT_CTRL_EN;
516 		WREG32_DIDT(DIDT_DB_CTRL0, data);
517 	}
518 
519 	if (pi->caps_td_ramping) {
520 		data = RREG32_DIDT(DIDT_TD_CTRL0);
521 		if (enable)
522 			data |= DIDT_CTRL_EN;
523 		else
524 			data &= ~DIDT_CTRL_EN;
525 		WREG32_DIDT(DIDT_TD_CTRL0, data);
526 	}
527 
528 	if (pi->caps_tcp_ramping) {
529 		data = RREG32_DIDT(DIDT_TCP_CTRL0);
530 		if (enable)
531 			data |= DIDT_CTRL_EN;
532 		else
533 			data &= ~DIDT_CTRL_EN;
534 		WREG32_DIDT(DIDT_TCP_CTRL0, data);
535 	}
536 }
537 
538 static int ci_program_pt_config_registers(struct radeon_device *rdev,
539 					  const struct ci_pt_config_reg *cac_config_regs)
540 {
541 	const struct ci_pt_config_reg *config_regs = cac_config_regs;
542 	u32 data;
543 	u32 cache = 0;
544 
545 	if (config_regs == NULL)
546 		return -EINVAL;
547 
548 	while (config_regs->offset != 0xFFFFFFFF) {
549 		if (config_regs->type == CISLANDS_CONFIGREG_CACHE) {
550 			cache |= ((config_regs->value << config_regs->shift) & config_regs->mask);
551 		} else {
552 			switch (config_regs->type) {
553 			case CISLANDS_CONFIGREG_SMC_IND:
554 				data = RREG32_SMC(config_regs->offset);
555 				break;
556 			case CISLANDS_CONFIGREG_DIDT_IND:
557 				data = RREG32_DIDT(config_regs->offset);
558 				break;
559 			default:
560 				data = RREG32(config_regs->offset << 2);
561 				break;
562 			}
563 
564 			data &= ~config_regs->mask;
565 			data |= ((config_regs->value << config_regs->shift) & config_regs->mask);
566 			data |= cache;
567 
568 			switch (config_regs->type) {
569 			case CISLANDS_CONFIGREG_SMC_IND:
570 				WREG32_SMC(config_regs->offset, data);
571 				break;
572 			case CISLANDS_CONFIGREG_DIDT_IND:
573 				WREG32_DIDT(config_regs->offset, data);
574 				break;
575 			default:
576 				WREG32(config_regs->offset << 2, data);
577 				break;
578 			}
579 			cache = 0;
580 		}
581 		config_regs++;
582 	}
583 	return 0;
584 }
585 
586 static int ci_enable_didt(struct radeon_device *rdev, bool enable)
587 {
588 	struct ci_power_info *pi = ci_get_pi(rdev);
589 	int ret;
590 
591 	if (pi->caps_sq_ramping || pi->caps_db_ramping ||
592 	    pi->caps_td_ramping || pi->caps_tcp_ramping) {
593 		cik_enter_rlc_safe_mode(rdev);
594 
595 		if (enable) {
596 			ret = ci_program_pt_config_registers(rdev, didt_config_ci);
597 			if (ret) {
598 				cik_exit_rlc_safe_mode(rdev);
599 				return ret;
600 			}
601 		}
602 
603 		ci_do_enable_didt(rdev, enable);
604 
605 		cik_exit_rlc_safe_mode(rdev);
606 	}
607 
608 	return 0;
609 }
610 
611 static int ci_enable_power_containment(struct radeon_device *rdev, bool enable)
612 {
613 	struct ci_power_info *pi = ci_get_pi(rdev);
614 	PPSMC_Result smc_result;
615 	int ret = 0;
616 
617 	if (enable) {
618 		pi->power_containment_features = 0;
619 		if (pi->caps_power_containment) {
620 			if (pi->enable_bapm_feature) {
621 				smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_EnableDTE);
622 				if (smc_result != PPSMC_Result_OK)
623 					ret = -EINVAL;
624 				else
625 					pi->power_containment_features |= POWERCONTAINMENT_FEATURE_BAPM;
626 			}
627 
628 			if (pi->enable_tdc_limit_feature) {
629 				smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_TDCLimitEnable);
630 				if (smc_result != PPSMC_Result_OK)
631 					ret = -EINVAL;
632 				else
633 					pi->power_containment_features |= POWERCONTAINMENT_FEATURE_TDCLimit;
634 			}
635 
636 			if (pi->enable_pkg_pwr_tracking_feature) {
637 				smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_PkgPwrLimitEnable);
638 				if (smc_result != PPSMC_Result_OK) {
639 					ret = -EINVAL;
640 				} else {
641 					struct radeon_cac_tdp_table *cac_tdp_table =
642 						rdev->pm.dpm.dyn_state.cac_tdp_table;
643 					u32 default_pwr_limit =
644 						(u32)(cac_tdp_table->maximum_power_delivery_limit * 256);
645 
646 					pi->power_containment_features |= POWERCONTAINMENT_FEATURE_PkgPwrLimit;
647 
648 					ci_set_power_limit(rdev, default_pwr_limit);
649 				}
650 			}
651 		}
652 	} else {
653 		if (pi->caps_power_containment && pi->power_containment_features) {
654 			if (pi->power_containment_features & POWERCONTAINMENT_FEATURE_TDCLimit)
655 				ci_send_msg_to_smc(rdev, PPSMC_MSG_TDCLimitDisable);
656 
657 			if (pi->power_containment_features & POWERCONTAINMENT_FEATURE_BAPM)
658 				ci_send_msg_to_smc(rdev, PPSMC_MSG_DisableDTE);
659 
660 			if (pi->power_containment_features & POWERCONTAINMENT_FEATURE_PkgPwrLimit)
661 				ci_send_msg_to_smc(rdev, PPSMC_MSG_PkgPwrLimitDisable);
662 			pi->power_containment_features = 0;
663 		}
664 	}
665 
666 	return ret;
667 }
668 
669 static int ci_enable_smc_cac(struct radeon_device *rdev, bool enable)
670 {
671 	struct ci_power_info *pi = ci_get_pi(rdev);
672 	PPSMC_Result smc_result;
673 	int ret = 0;
674 
675 	if (pi->caps_cac) {
676 		if (enable) {
677 			smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_EnableCac);
678 			if (smc_result != PPSMC_Result_OK) {
679 				ret = -EINVAL;
680 				pi->cac_enabled = false;
681 			} else {
682 				pi->cac_enabled = true;
683 			}
684 		} else if (pi->cac_enabled) {
685 			ci_send_msg_to_smc(rdev, PPSMC_MSG_DisableCac);
686 			pi->cac_enabled = false;
687 		}
688 	}
689 
690 	return ret;
691 }
692 
693 static int ci_enable_thermal_based_sclk_dpm(struct radeon_device *rdev,
694 					    bool enable)
695 {
696 	struct ci_power_info *pi = ci_get_pi(rdev);
697 	PPSMC_Result smc_result = PPSMC_Result_OK;
698 
699 	if (pi->thermal_sclk_dpm_enabled) {
700 		if (enable)
701 			smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_ENABLE_THERMAL_DPM);
702 		else
703 			smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_DISABLE_THERMAL_DPM);
704 	}
705 
706 	if (smc_result == PPSMC_Result_OK)
707 		return 0;
708 	else
709 		return -EINVAL;
710 }
711 
712 static int ci_power_control_set_level(struct radeon_device *rdev)
713 {
714 	struct ci_power_info *pi = ci_get_pi(rdev);
715 	struct radeon_cac_tdp_table *cac_tdp_table =
716 		rdev->pm.dpm.dyn_state.cac_tdp_table;
717 	s32 adjust_percent;
718 	s32 target_tdp;
719 	int ret = 0;
720 	bool adjust_polarity = false; /* ??? */
721 
722 	if (pi->caps_power_containment) {
723 		adjust_percent = adjust_polarity ?
724 			rdev->pm.dpm.tdp_adjustment : (-1 * rdev->pm.dpm.tdp_adjustment);
725 		target_tdp = ((100 + adjust_percent) *
726 			      (s32)cac_tdp_table->configurable_tdp) / 100;
727 
728 		ret = ci_set_overdrive_target_tdp(rdev, (u32)target_tdp);
729 	}
730 
731 	return ret;
732 }
733 
734 void ci_dpm_powergate_uvd(struct radeon_device *rdev, bool gate)
735 {
736 	struct ci_power_info *pi = ci_get_pi(rdev);
737 
738 	if (pi->uvd_power_gated == gate)
739 		return;
740 
741 	pi->uvd_power_gated = gate;
742 
743 	ci_update_uvd_dpm(rdev, gate);
744 }
745 
746 bool ci_dpm_vblank_too_short(struct radeon_device *rdev)
747 {
748 	struct ci_power_info *pi = ci_get_pi(rdev);
749 	u32 vblank_time = r600_dpm_get_vblank_time(rdev);
750 	u32 switch_limit = pi->mem_gddr5 ? 450 : 300;
751 
752 	/* disable mclk switching if the refresh is >120Hz, even if the
753         * blanking period would allow it
754         */
755 	if (r600_dpm_get_vrefresh(rdev) > 120)
756 		return true;
757 
758 	if (vblank_time < switch_limit)
759 		return true;
760 	else
761 		return false;
762 
763 }
764 
765 static void ci_apply_state_adjust_rules(struct radeon_device *rdev,
766 					struct radeon_ps *rps)
767 {
768 	struct ci_ps *ps = ci_get_ps(rps);
769 	struct ci_power_info *pi = ci_get_pi(rdev);
770 	struct radeon_clock_and_voltage_limits *max_limits;
771 	bool disable_mclk_switching;
772 	u32 sclk, mclk;
773 	int i;
774 
775 	if (rps->vce_active) {
776 		rps->evclk = rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].evclk;
777 		rps->ecclk = rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].ecclk;
778 	} else {
779 		rps->evclk = 0;
780 		rps->ecclk = 0;
781 	}
782 
783 	if ((rdev->pm.dpm.new_active_crtc_count > 1) ||
784 	    ci_dpm_vblank_too_short(rdev))
785 		disable_mclk_switching = true;
786 	else
787 		disable_mclk_switching = false;
788 
789 	if ((rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) == ATOM_PPLIB_CLASSIFICATION_UI_BATTERY)
790 		pi->battery_state = true;
791 	else
792 		pi->battery_state = false;
793 
794 	if (rdev->pm.dpm.ac_power)
795 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
796 	else
797 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc;
798 
799 	if (rdev->pm.dpm.ac_power == false) {
800 		for (i = 0; i < ps->performance_level_count; i++) {
801 			if (ps->performance_levels[i].mclk > max_limits->mclk)
802 				ps->performance_levels[i].mclk = max_limits->mclk;
803 			if (ps->performance_levels[i].sclk > max_limits->sclk)
804 				ps->performance_levels[i].sclk = max_limits->sclk;
805 		}
806 	}
807 
808 	/* XXX validate the min clocks required for display */
809 
810 	if (disable_mclk_switching) {
811 		mclk  = ps->performance_levels[ps->performance_level_count - 1].mclk;
812 		sclk = ps->performance_levels[0].sclk;
813 	} else {
814 		mclk = ps->performance_levels[0].mclk;
815 		sclk = ps->performance_levels[0].sclk;
816 	}
817 
818 	if (rps->vce_active) {
819 		if (sclk < rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].sclk)
820 			sclk = rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].sclk;
821 		if (mclk < rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].mclk)
822 			mclk = rdev->pm.dpm.vce_states[rdev->pm.dpm.vce_level].mclk;
823 	}
824 
825 	ps->performance_levels[0].sclk = sclk;
826 	ps->performance_levels[0].mclk = mclk;
827 
828 	if (ps->performance_levels[1].sclk < ps->performance_levels[0].sclk)
829 		ps->performance_levels[1].sclk = ps->performance_levels[0].sclk;
830 
831 	if (disable_mclk_switching) {
832 		if (ps->performance_levels[0].mclk < ps->performance_levels[1].mclk)
833 			ps->performance_levels[0].mclk = ps->performance_levels[1].mclk;
834 	} else {
835 		if (ps->performance_levels[1].mclk < ps->performance_levels[0].mclk)
836 			ps->performance_levels[1].mclk = ps->performance_levels[0].mclk;
837 	}
838 }
839 
840 static int ci_thermal_set_temperature_range(struct radeon_device *rdev,
841 					    int min_temp, int max_temp)
842 {
843 	int low_temp = 0 * 1000;
844 	int high_temp = 255 * 1000;
845 	u32 tmp;
846 
847 	if (low_temp < min_temp)
848 		low_temp = min_temp;
849 	if (high_temp > max_temp)
850 		high_temp = max_temp;
851 	if (high_temp < low_temp) {
852 		DRM_ERROR("invalid thermal range: %d - %d\n", low_temp, high_temp);
853 		return -EINVAL;
854 	}
855 
856 	tmp = RREG32_SMC(CG_THERMAL_INT);
857 	tmp &= ~(CI_DIG_THERM_INTH_MASK | CI_DIG_THERM_INTL_MASK);
858 	tmp |= CI_DIG_THERM_INTH(high_temp / 1000) |
859 		CI_DIG_THERM_INTL(low_temp / 1000);
860 	WREG32_SMC(CG_THERMAL_INT, tmp);
861 
862 #if 0
863 	/* XXX: need to figure out how to handle this properly */
864 	tmp = RREG32_SMC(CG_THERMAL_CTRL);
865 	tmp &= DIG_THERM_DPM_MASK;
866 	tmp |= DIG_THERM_DPM(high_temp / 1000);
867 	WREG32_SMC(CG_THERMAL_CTRL, tmp);
868 #endif
869 
870 	rdev->pm.dpm.thermal.min_temp = low_temp;
871 	rdev->pm.dpm.thermal.max_temp = high_temp;
872 
873 	return 0;
874 }
875 
876 static int ci_thermal_enable_alert(struct radeon_device *rdev,
877 				   bool enable)
878 {
879 	u32 thermal_int = RREG32_SMC(CG_THERMAL_INT);
880 	PPSMC_Result result;
881 
882 	if (enable) {
883 		thermal_int &= ~(THERM_INT_MASK_HIGH | THERM_INT_MASK_LOW);
884 		WREG32_SMC(CG_THERMAL_INT, thermal_int);
885 		rdev->irq.dpm_thermal = false;
886 		result = ci_send_msg_to_smc(rdev, PPSMC_MSG_Thermal_Cntl_Enable);
887 		if (result != PPSMC_Result_OK) {
888 			DRM_DEBUG_KMS("Could not enable thermal interrupts.\n");
889 			return -EINVAL;
890 		}
891 	} else {
892 		thermal_int |= THERM_INT_MASK_HIGH | THERM_INT_MASK_LOW;
893 		WREG32_SMC(CG_THERMAL_INT, thermal_int);
894 		rdev->irq.dpm_thermal = true;
895 		result = ci_send_msg_to_smc(rdev, PPSMC_MSG_Thermal_Cntl_Disable);
896 		if (result != PPSMC_Result_OK) {
897 			DRM_DEBUG_KMS("Could not disable thermal interrupts.\n");
898 			return -EINVAL;
899 		}
900 	}
901 
902 	return 0;
903 }
904 
905 static void ci_fan_ctrl_set_static_mode(struct radeon_device *rdev, u32 mode)
906 {
907 	struct ci_power_info *pi = ci_get_pi(rdev);
908 	u32 tmp;
909 
910 	if (pi->fan_ctrl_is_in_default_mode) {
911 		tmp = (RREG32_SMC(CG_FDO_CTRL2) & FDO_PWM_MODE_MASK) >> FDO_PWM_MODE_SHIFT;
912 		pi->fan_ctrl_default_mode = tmp;
913 		tmp = (RREG32_SMC(CG_FDO_CTRL2) & TMIN_MASK) >> TMIN_SHIFT;
914 		pi->t_min = tmp;
915 		pi->fan_ctrl_is_in_default_mode = false;
916 	}
917 
918 	tmp = RREG32_SMC(CG_FDO_CTRL2) & ~TMIN_MASK;
919 	tmp |= TMIN(0);
920 	WREG32_SMC(CG_FDO_CTRL2, tmp);
921 
922 	tmp = RREG32_SMC(CG_FDO_CTRL2) & ~FDO_PWM_MODE_MASK;
923 	tmp |= FDO_PWM_MODE(mode);
924 	WREG32_SMC(CG_FDO_CTRL2, tmp);
925 }
926 
927 static int ci_thermal_setup_fan_table(struct radeon_device *rdev)
928 {
929 	struct ci_power_info *pi = ci_get_pi(rdev);
930 	SMU7_Discrete_FanTable fan_table = { FDO_MODE_HARDWARE };
931 	u32 duty100;
932 	u32 t_diff1, t_diff2, pwm_diff1, pwm_diff2;
933 	u16 fdo_min, slope1, slope2;
934 	u32 reference_clock, tmp;
935 	int ret;
936 	u64 tmp64;
937 
938 	if (!pi->fan_table_start) {
939 		rdev->pm.dpm.fan.ucode_fan_control = false;
940 		return 0;
941 	}
942 
943 	duty100 = (RREG32_SMC(CG_FDO_CTRL1) & FMAX_DUTY100_MASK) >> FMAX_DUTY100_SHIFT;
944 
945 	if (duty100 == 0) {
946 		rdev->pm.dpm.fan.ucode_fan_control = false;
947 		return 0;
948 	}
949 
950 	tmp64 = (u64)rdev->pm.dpm.fan.pwm_min * duty100;
951 	do_div(tmp64, 10000);
952 	fdo_min = (u16)tmp64;
953 
954 	t_diff1 = rdev->pm.dpm.fan.t_med - rdev->pm.dpm.fan.t_min;
955 	t_diff2 = rdev->pm.dpm.fan.t_high - rdev->pm.dpm.fan.t_med;
956 
957 	pwm_diff1 = rdev->pm.dpm.fan.pwm_med - rdev->pm.dpm.fan.pwm_min;
958 	pwm_diff2 = rdev->pm.dpm.fan.pwm_high - rdev->pm.dpm.fan.pwm_med;
959 
960 	slope1 = (u16)((50 + ((16 * duty100 * pwm_diff1) / t_diff1)) / 100);
961 	slope2 = (u16)((50 + ((16 * duty100 * pwm_diff2) / t_diff2)) / 100);
962 
963 	fan_table.TempMin = cpu_to_be16((50 + rdev->pm.dpm.fan.t_min) / 100);
964 	fan_table.TempMed = cpu_to_be16((50 + rdev->pm.dpm.fan.t_med) / 100);
965 	fan_table.TempMax = cpu_to_be16((50 + rdev->pm.dpm.fan.t_max) / 100);
966 
967 	fan_table.Slope1 = cpu_to_be16(slope1);
968 	fan_table.Slope2 = cpu_to_be16(slope2);
969 
970 	fan_table.FdoMin = cpu_to_be16(fdo_min);
971 
972 	fan_table.HystDown = cpu_to_be16(rdev->pm.dpm.fan.t_hyst);
973 
974 	fan_table.HystUp = cpu_to_be16(1);
975 
976 	fan_table.HystSlope = cpu_to_be16(1);
977 
978 	fan_table.TempRespLim = cpu_to_be16(5);
979 
980 	reference_clock = radeon_get_xclk(rdev);
981 
982 	fan_table.RefreshPeriod = cpu_to_be32((rdev->pm.dpm.fan.cycle_delay *
983 					       reference_clock) / 1600);
984 
985 	fan_table.FdoMax = cpu_to_be16((u16)duty100);
986 
987 	tmp = (RREG32_SMC(CG_MULT_THERMAL_CTRL) & TEMP_SEL_MASK) >> TEMP_SEL_SHIFT;
988 	fan_table.TempSrc = (uint8_t)tmp;
989 
990 	ret = ci_copy_bytes_to_smc(rdev,
991 				   pi->fan_table_start,
992 				   (u8 *)(&fan_table),
993 				   sizeof(fan_table),
994 				   pi->sram_end);
995 
996 	if (ret) {
997 		DRM_ERROR("Failed to load fan table to the SMC.");
998 		rdev->pm.dpm.fan.ucode_fan_control = false;
999 	}
1000 
1001 	return 0;
1002 }
1003 
1004 static int ci_fan_ctrl_start_smc_fan_control(struct radeon_device *rdev)
1005 {
1006 	struct ci_power_info *pi = ci_get_pi(rdev);
1007 	PPSMC_Result ret;
1008 
1009 	if (pi->caps_od_fuzzy_fan_control_support) {
1010 		ret = ci_send_msg_to_smc_with_parameter(rdev,
1011 							PPSMC_StartFanControl,
1012 							FAN_CONTROL_FUZZY);
1013 		if (ret != PPSMC_Result_OK)
1014 			return -EINVAL;
1015 		ret = ci_send_msg_to_smc_with_parameter(rdev,
1016 							PPSMC_MSG_SetFanPwmMax,
1017 							rdev->pm.dpm.fan.default_max_fan_pwm);
1018 		if (ret != PPSMC_Result_OK)
1019 			return -EINVAL;
1020 	} else {
1021 		ret = ci_send_msg_to_smc_with_parameter(rdev,
1022 							PPSMC_StartFanControl,
1023 							FAN_CONTROL_TABLE);
1024 		if (ret != PPSMC_Result_OK)
1025 			return -EINVAL;
1026 	}
1027 
1028 	pi->fan_is_controlled_by_smc = true;
1029 	return 0;
1030 }
1031 
1032 static int ci_fan_ctrl_stop_smc_fan_control(struct radeon_device *rdev)
1033 {
1034 	PPSMC_Result ret;
1035 	struct ci_power_info *pi = ci_get_pi(rdev);
1036 
1037 	ret = ci_send_msg_to_smc(rdev, PPSMC_StopFanControl);
1038 	if (ret == PPSMC_Result_OK) {
1039 		pi->fan_is_controlled_by_smc = false;
1040 		return 0;
1041 	} else
1042 		return -EINVAL;
1043 }
1044 
1045 int ci_fan_ctrl_get_fan_speed_percent(struct radeon_device *rdev,
1046 					     u32 *speed)
1047 {
1048 	u32 duty, duty100;
1049 	u64 tmp64;
1050 
1051 	if (rdev->pm.no_fan)
1052 		return -ENOENT;
1053 
1054 	duty100 = (RREG32_SMC(CG_FDO_CTRL1) & FMAX_DUTY100_MASK) >> FMAX_DUTY100_SHIFT;
1055 	duty = (RREG32_SMC(CG_THERMAL_STATUS) & FDO_PWM_DUTY_MASK) >> FDO_PWM_DUTY_SHIFT;
1056 
1057 	if (duty100 == 0)
1058 		return -EINVAL;
1059 
1060 	tmp64 = (u64)duty * 100;
1061 	do_div(tmp64, duty100);
1062 	*speed = (u32)tmp64;
1063 
1064 	if (*speed > 100)
1065 		*speed = 100;
1066 
1067 	return 0;
1068 }
1069 
1070 int ci_fan_ctrl_set_fan_speed_percent(struct radeon_device *rdev,
1071 					     u32 speed)
1072 {
1073 	u32 tmp;
1074 	u32 duty, duty100;
1075 	u64 tmp64;
1076 	struct ci_power_info *pi = ci_get_pi(rdev);
1077 
1078 	if (rdev->pm.no_fan)
1079 		return -ENOENT;
1080 
1081 	if (pi->fan_is_controlled_by_smc)
1082 		return -EINVAL;
1083 
1084 	if (speed > 100)
1085 		return -EINVAL;
1086 
1087 	duty100 = (RREG32_SMC(CG_FDO_CTRL1) & FMAX_DUTY100_MASK) >> FMAX_DUTY100_SHIFT;
1088 
1089 	if (duty100 == 0)
1090 		return -EINVAL;
1091 
1092 	tmp64 = (u64)speed * duty100;
1093 	do_div(tmp64, 100);
1094 	duty = (u32)tmp64;
1095 
1096 	tmp = RREG32_SMC(CG_FDO_CTRL0) & ~FDO_STATIC_DUTY_MASK;
1097 	tmp |= FDO_STATIC_DUTY(duty);
1098 	WREG32_SMC(CG_FDO_CTRL0, tmp);
1099 
1100 	return 0;
1101 }
1102 
1103 void ci_fan_ctrl_set_mode(struct radeon_device *rdev, u32 mode)
1104 {
1105 	if (mode) {
1106 		/* stop auto-manage */
1107 		if (rdev->pm.dpm.fan.ucode_fan_control)
1108 			ci_fan_ctrl_stop_smc_fan_control(rdev);
1109 		ci_fan_ctrl_set_static_mode(rdev, mode);
1110 	} else {
1111 		/* restart auto-manage */
1112 		if (rdev->pm.dpm.fan.ucode_fan_control)
1113 			ci_thermal_start_smc_fan_control(rdev);
1114 		else
1115 			ci_fan_ctrl_set_default_mode(rdev);
1116 	}
1117 }
1118 
1119 u32 ci_fan_ctrl_get_mode(struct radeon_device *rdev)
1120 {
1121 	struct ci_power_info *pi = ci_get_pi(rdev);
1122 	u32 tmp;
1123 
1124 	if (pi->fan_is_controlled_by_smc)
1125 		return 0;
1126 
1127 	tmp = RREG32_SMC(CG_FDO_CTRL2) & FDO_PWM_MODE_MASK;
1128 	return (tmp >> FDO_PWM_MODE_SHIFT);
1129 }
1130 
1131 #if 0
1132 static int ci_fan_ctrl_get_fan_speed_rpm(struct radeon_device *rdev,
1133 					 u32 *speed)
1134 {
1135 	u32 tach_period;
1136 	u32 xclk = radeon_get_xclk(rdev);
1137 
1138 	if (rdev->pm.no_fan)
1139 		return -ENOENT;
1140 
1141 	if (rdev->pm.fan_pulses_per_revolution == 0)
1142 		return -ENOENT;
1143 
1144 	tach_period = (RREG32_SMC(CG_TACH_STATUS) & TACH_PERIOD_MASK) >> TACH_PERIOD_SHIFT;
1145 	if (tach_period == 0)
1146 		return -ENOENT;
1147 
1148 	*speed = 60 * xclk * 10000 / tach_period;
1149 
1150 	return 0;
1151 }
1152 
1153 static int ci_fan_ctrl_set_fan_speed_rpm(struct radeon_device *rdev,
1154 					 u32 speed)
1155 {
1156 	u32 tach_period, tmp;
1157 	u32 xclk = radeon_get_xclk(rdev);
1158 
1159 	if (rdev->pm.no_fan)
1160 		return -ENOENT;
1161 
1162 	if (rdev->pm.fan_pulses_per_revolution == 0)
1163 		return -ENOENT;
1164 
1165 	if ((speed < rdev->pm.fan_min_rpm) ||
1166 	    (speed > rdev->pm.fan_max_rpm))
1167 		return -EINVAL;
1168 
1169 	if (rdev->pm.dpm.fan.ucode_fan_control)
1170 		ci_fan_ctrl_stop_smc_fan_control(rdev);
1171 
1172 	tach_period = 60 * xclk * 10000 / (8 * speed);
1173 	tmp = RREG32_SMC(CG_TACH_CTRL) & ~TARGET_PERIOD_MASK;
1174 	tmp |= TARGET_PERIOD(tach_period);
1175 	WREG32_SMC(CG_TACH_CTRL, tmp);
1176 
1177 	ci_fan_ctrl_set_static_mode(rdev, FDO_PWM_MODE_STATIC_RPM);
1178 
1179 	return 0;
1180 }
1181 #endif
1182 
1183 static void ci_fan_ctrl_set_default_mode(struct radeon_device *rdev)
1184 {
1185 	struct ci_power_info *pi = ci_get_pi(rdev);
1186 	u32 tmp;
1187 
1188 	if (!pi->fan_ctrl_is_in_default_mode) {
1189 		tmp = RREG32_SMC(CG_FDO_CTRL2) & ~FDO_PWM_MODE_MASK;
1190 		tmp |= FDO_PWM_MODE(pi->fan_ctrl_default_mode);
1191 		WREG32_SMC(CG_FDO_CTRL2, tmp);
1192 
1193 		tmp = RREG32_SMC(CG_FDO_CTRL2) & ~TMIN_MASK;
1194 		tmp |= TMIN(pi->t_min);
1195 		WREG32_SMC(CG_FDO_CTRL2, tmp);
1196 		pi->fan_ctrl_is_in_default_mode = true;
1197 	}
1198 }
1199 
1200 static void ci_thermal_start_smc_fan_control(struct radeon_device *rdev)
1201 {
1202 	if (rdev->pm.dpm.fan.ucode_fan_control) {
1203 		ci_fan_ctrl_start_smc_fan_control(rdev);
1204 		ci_fan_ctrl_set_static_mode(rdev, FDO_PWM_MODE_STATIC);
1205 	}
1206 }
1207 
1208 static void ci_thermal_initialize(struct radeon_device *rdev)
1209 {
1210 	u32 tmp;
1211 
1212 	if (rdev->pm.fan_pulses_per_revolution) {
1213 		tmp = RREG32_SMC(CG_TACH_CTRL) & ~EDGE_PER_REV_MASK;
1214 		tmp |= EDGE_PER_REV(rdev->pm.fan_pulses_per_revolution - 1);
1215 		WREG32_SMC(CG_TACH_CTRL, tmp);
1216 	}
1217 
1218 	tmp = RREG32_SMC(CG_FDO_CTRL2) & ~TACH_PWM_RESP_RATE_MASK;
1219 	tmp |= TACH_PWM_RESP_RATE(0x28);
1220 	WREG32_SMC(CG_FDO_CTRL2, tmp);
1221 }
1222 
1223 static int ci_thermal_start_thermal_controller(struct radeon_device *rdev)
1224 {
1225 	int ret;
1226 
1227 	ci_thermal_initialize(rdev);
1228 	ret = ci_thermal_set_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
1229 	if (ret)
1230 		return ret;
1231 	ret = ci_thermal_enable_alert(rdev, true);
1232 	if (ret)
1233 		return ret;
1234 	if (rdev->pm.dpm.fan.ucode_fan_control) {
1235 		ret = ci_thermal_setup_fan_table(rdev);
1236 		if (ret)
1237 			return ret;
1238 		ci_thermal_start_smc_fan_control(rdev);
1239 	}
1240 
1241 	return 0;
1242 }
1243 
1244 static void ci_thermal_stop_thermal_controller(struct radeon_device *rdev)
1245 {
1246 	if (!rdev->pm.no_fan)
1247 		ci_fan_ctrl_set_default_mode(rdev);
1248 }
1249 
1250 #if 0
1251 static int ci_read_smc_soft_register(struct radeon_device *rdev,
1252 				     u16 reg_offset, u32 *value)
1253 {
1254 	struct ci_power_info *pi = ci_get_pi(rdev);
1255 
1256 	return ci_read_smc_sram_dword(rdev,
1257 				      pi->soft_regs_start + reg_offset,
1258 				      value, pi->sram_end);
1259 }
1260 #endif
1261 
1262 static int ci_write_smc_soft_register(struct radeon_device *rdev,
1263 				      u16 reg_offset, u32 value)
1264 {
1265 	struct ci_power_info *pi = ci_get_pi(rdev);
1266 
1267 	return ci_write_smc_sram_dword(rdev,
1268 				       pi->soft_regs_start + reg_offset,
1269 				       value, pi->sram_end);
1270 }
1271 
1272 static void ci_init_fps_limits(struct radeon_device *rdev)
1273 {
1274 	struct ci_power_info *pi = ci_get_pi(rdev);
1275 	SMU7_Discrete_DpmTable *table = &pi->smc_state_table;
1276 
1277 	if (pi->caps_fps) {
1278 		u16 tmp;
1279 
1280 		tmp = 45;
1281 		table->FpsHighT = cpu_to_be16(tmp);
1282 
1283 		tmp = 30;
1284 		table->FpsLowT = cpu_to_be16(tmp);
1285 	}
1286 }
1287 
1288 static int ci_update_sclk_t(struct radeon_device *rdev)
1289 {
1290 	struct ci_power_info *pi = ci_get_pi(rdev);
1291 	int ret = 0;
1292 	u32 low_sclk_interrupt_t = 0;
1293 
1294 	if (pi->caps_sclk_throttle_low_notification) {
1295 		low_sclk_interrupt_t = cpu_to_be32(pi->low_sclk_interrupt_t);
1296 
1297 		ret = ci_copy_bytes_to_smc(rdev,
1298 					   pi->dpm_table_start +
1299 					   offsetof(SMU7_Discrete_DpmTable, LowSclkInterruptT),
1300 					   (u8 *)&low_sclk_interrupt_t,
1301 					   sizeof(u32), pi->sram_end);
1302 
1303 	}
1304 
1305 	return ret;
1306 }
1307 
1308 static void ci_get_leakage_voltages(struct radeon_device *rdev)
1309 {
1310 	struct ci_power_info *pi = ci_get_pi(rdev);
1311 	u16 leakage_id, virtual_voltage_id;
1312 	u16 vddc, vddci;
1313 	int i;
1314 
1315 	pi->vddc_leakage.count = 0;
1316 	pi->vddci_leakage.count = 0;
1317 
1318 	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_EVV) {
1319 		for (i = 0; i < CISLANDS_MAX_LEAKAGE_COUNT; i++) {
1320 			virtual_voltage_id = ATOM_VIRTUAL_VOLTAGE_ID0 + i;
1321 			if (radeon_atom_get_voltage_evv(rdev, virtual_voltage_id, &vddc) != 0)
1322 				continue;
1323 			if (vddc != 0 && vddc != virtual_voltage_id) {
1324 				pi->vddc_leakage.actual_voltage[pi->vddc_leakage.count] = vddc;
1325 				pi->vddc_leakage.leakage_id[pi->vddc_leakage.count] = virtual_voltage_id;
1326 				pi->vddc_leakage.count++;
1327 			}
1328 		}
1329 	} else if (radeon_atom_get_leakage_id_from_vbios(rdev, &leakage_id) == 0) {
1330 		for (i = 0; i < CISLANDS_MAX_LEAKAGE_COUNT; i++) {
1331 			virtual_voltage_id = ATOM_VIRTUAL_VOLTAGE_ID0 + i;
1332 			if (radeon_atom_get_leakage_vddc_based_on_leakage_params(rdev, &vddc, &vddci,
1333 										 virtual_voltage_id,
1334 										 leakage_id) == 0) {
1335 				if (vddc != 0 && vddc != virtual_voltage_id) {
1336 					pi->vddc_leakage.actual_voltage[pi->vddc_leakage.count] = vddc;
1337 					pi->vddc_leakage.leakage_id[pi->vddc_leakage.count] = virtual_voltage_id;
1338 					pi->vddc_leakage.count++;
1339 				}
1340 				if (vddci != 0 && vddci != virtual_voltage_id) {
1341 					pi->vddci_leakage.actual_voltage[pi->vddci_leakage.count] = vddci;
1342 					pi->vddci_leakage.leakage_id[pi->vddci_leakage.count] = virtual_voltage_id;
1343 					pi->vddci_leakage.count++;
1344 				}
1345 			}
1346 		}
1347 	}
1348 }
1349 
1350 static void ci_set_dpm_event_sources(struct radeon_device *rdev, u32 sources)
1351 {
1352 	struct ci_power_info *pi = ci_get_pi(rdev);
1353 	bool want_thermal_protection;
1354 	u32 tmp;
1355 
1356 	switch (sources) {
1357 	case 0:
1358 	default:
1359 		want_thermal_protection = false;
1360 		break;
1361 	case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL):
1362 		want_thermal_protection = true;
1363 		break;
1364 	case (1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL):
1365 		want_thermal_protection = true;
1366 		break;
1367 	case ((1 << RADEON_DPM_AUTO_THROTTLE_SRC_EXTERNAL) |
1368 	      (1 << RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL)):
1369 		want_thermal_protection = true;
1370 		break;
1371 	}
1372 
1373 	if (want_thermal_protection) {
1374 		tmp = RREG32_SMC(GENERAL_PWRMGT);
1375 		if (pi->thermal_protection)
1376 			tmp &= ~THERMAL_PROTECTION_DIS;
1377 		else
1378 			tmp |= THERMAL_PROTECTION_DIS;
1379 		WREG32_SMC(GENERAL_PWRMGT, tmp);
1380 	} else {
1381 		tmp = RREG32_SMC(GENERAL_PWRMGT);
1382 		tmp |= THERMAL_PROTECTION_DIS;
1383 		WREG32_SMC(GENERAL_PWRMGT, tmp);
1384 	}
1385 }
1386 
1387 static void ci_enable_auto_throttle_source(struct radeon_device *rdev,
1388 					   enum radeon_dpm_auto_throttle_src source,
1389 					   bool enable)
1390 {
1391 	struct ci_power_info *pi = ci_get_pi(rdev);
1392 
1393 	if (enable) {
1394 		if (!(pi->active_auto_throttle_sources & (1 << source))) {
1395 			pi->active_auto_throttle_sources |= 1 << source;
1396 			ci_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
1397 		}
1398 	} else {
1399 		if (pi->active_auto_throttle_sources & (1 << source)) {
1400 			pi->active_auto_throttle_sources &= ~(1 << source);
1401 			ci_set_dpm_event_sources(rdev, pi->active_auto_throttle_sources);
1402 		}
1403 	}
1404 }
1405 
1406 static void ci_enable_vr_hot_gpio_interrupt(struct radeon_device *rdev)
1407 {
1408 	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_REGULATOR_HOT)
1409 		ci_send_msg_to_smc(rdev, PPSMC_MSG_EnableVRHotGPIOInterrupt);
1410 }
1411 
1412 static int ci_unfreeze_sclk_mclk_dpm(struct radeon_device *rdev)
1413 {
1414 	struct ci_power_info *pi = ci_get_pi(rdev);
1415 	PPSMC_Result smc_result;
1416 
1417 	if (!pi->need_update_smu7_dpm_table)
1418 		return 0;
1419 
1420 	if ((!pi->sclk_dpm_key_disabled) &&
1421 	    (pi->need_update_smu7_dpm_table & (DPMTABLE_OD_UPDATE_SCLK | DPMTABLE_UPDATE_SCLK))) {
1422 		smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_SCLKDPM_UnfreezeLevel);
1423 		if (smc_result != PPSMC_Result_OK)
1424 			return -EINVAL;
1425 	}
1426 
1427 	if ((!pi->mclk_dpm_key_disabled) &&
1428 	    (pi->need_update_smu7_dpm_table & DPMTABLE_OD_UPDATE_MCLK)) {
1429 		smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_MCLKDPM_UnfreezeLevel);
1430 		if (smc_result != PPSMC_Result_OK)
1431 			return -EINVAL;
1432 	}
1433 
1434 	pi->need_update_smu7_dpm_table = 0;
1435 	return 0;
1436 }
1437 
1438 static int ci_enable_sclk_mclk_dpm(struct radeon_device *rdev, bool enable)
1439 {
1440 	struct ci_power_info *pi = ci_get_pi(rdev);
1441 	PPSMC_Result smc_result;
1442 
1443 	if (enable) {
1444 		if (!pi->sclk_dpm_key_disabled) {
1445 			smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_DPM_Enable);
1446 			if (smc_result != PPSMC_Result_OK)
1447 				return -EINVAL;
1448 		}
1449 
1450 		if (!pi->mclk_dpm_key_disabled) {
1451 			smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_MCLKDPM_Enable);
1452 			if (smc_result != PPSMC_Result_OK)
1453 				return -EINVAL;
1454 
1455 			WREG32_P(MC_SEQ_CNTL_3, CAC_EN, ~CAC_EN);
1456 
1457 			WREG32_SMC(LCAC_MC0_CNTL, 0x05);
1458 			WREG32_SMC(LCAC_MC1_CNTL, 0x05);
1459 			WREG32_SMC(LCAC_CPL_CNTL, 0x100005);
1460 
1461 			udelay(10);
1462 
1463 			WREG32_SMC(LCAC_MC0_CNTL, 0x400005);
1464 			WREG32_SMC(LCAC_MC1_CNTL, 0x400005);
1465 			WREG32_SMC(LCAC_CPL_CNTL, 0x500005);
1466 		}
1467 	} else {
1468 		if (!pi->sclk_dpm_key_disabled) {
1469 			smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_DPM_Disable);
1470 			if (smc_result != PPSMC_Result_OK)
1471 				return -EINVAL;
1472 		}
1473 
1474 		if (!pi->mclk_dpm_key_disabled) {
1475 			smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_MCLKDPM_Disable);
1476 			if (smc_result != PPSMC_Result_OK)
1477 				return -EINVAL;
1478 		}
1479 	}
1480 
1481 	return 0;
1482 }
1483 
1484 static int ci_start_dpm(struct radeon_device *rdev)
1485 {
1486 	struct ci_power_info *pi = ci_get_pi(rdev);
1487 	PPSMC_Result smc_result;
1488 	int ret;
1489 	u32 tmp;
1490 
1491 	tmp = RREG32_SMC(GENERAL_PWRMGT);
1492 	tmp |= GLOBAL_PWRMGT_EN;
1493 	WREG32_SMC(GENERAL_PWRMGT, tmp);
1494 
1495 	tmp = RREG32_SMC(SCLK_PWRMGT_CNTL);
1496 	tmp |= DYNAMIC_PM_EN;
1497 	WREG32_SMC(SCLK_PWRMGT_CNTL, tmp);
1498 
1499 	ci_write_smc_soft_register(rdev, offsetof(SMU7_SoftRegisters, VoltageChangeTimeout), 0x1000);
1500 
1501 	WREG32_P(BIF_LNCNT_RESET, 0, ~RESET_LNCNT_EN);
1502 
1503 	smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_Voltage_Cntl_Enable);
1504 	if (smc_result != PPSMC_Result_OK)
1505 		return -EINVAL;
1506 
1507 	ret = ci_enable_sclk_mclk_dpm(rdev, true);
1508 	if (ret)
1509 		return ret;
1510 
1511 	if (!pi->pcie_dpm_key_disabled) {
1512 		smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_PCIeDPM_Enable);
1513 		if (smc_result != PPSMC_Result_OK)
1514 			return -EINVAL;
1515 	}
1516 
1517 	return 0;
1518 }
1519 
1520 static int ci_freeze_sclk_mclk_dpm(struct radeon_device *rdev)
1521 {
1522 	struct ci_power_info *pi = ci_get_pi(rdev);
1523 	PPSMC_Result smc_result;
1524 
1525 	if (!pi->need_update_smu7_dpm_table)
1526 		return 0;
1527 
1528 	if ((!pi->sclk_dpm_key_disabled) &&
1529 	    (pi->need_update_smu7_dpm_table & (DPMTABLE_OD_UPDATE_SCLK | DPMTABLE_UPDATE_SCLK))) {
1530 		smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_SCLKDPM_FreezeLevel);
1531 		if (smc_result != PPSMC_Result_OK)
1532 			return -EINVAL;
1533 	}
1534 
1535 	if ((!pi->mclk_dpm_key_disabled) &&
1536 	    (pi->need_update_smu7_dpm_table & DPMTABLE_OD_UPDATE_MCLK)) {
1537 		smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_MCLKDPM_FreezeLevel);
1538 		if (smc_result != PPSMC_Result_OK)
1539 			return -EINVAL;
1540 	}
1541 
1542 	return 0;
1543 }
1544 
1545 static int ci_stop_dpm(struct radeon_device *rdev)
1546 {
1547 	struct ci_power_info *pi = ci_get_pi(rdev);
1548 	PPSMC_Result smc_result;
1549 	int ret;
1550 	u32 tmp;
1551 
1552 	tmp = RREG32_SMC(GENERAL_PWRMGT);
1553 	tmp &= ~GLOBAL_PWRMGT_EN;
1554 	WREG32_SMC(GENERAL_PWRMGT, tmp);
1555 
1556 	tmp = RREG32_SMC(SCLK_PWRMGT_CNTL);
1557 	tmp &= ~DYNAMIC_PM_EN;
1558 	WREG32_SMC(SCLK_PWRMGT_CNTL, tmp);
1559 
1560 	if (!pi->pcie_dpm_key_disabled) {
1561 		smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_PCIeDPM_Disable);
1562 		if (smc_result != PPSMC_Result_OK)
1563 			return -EINVAL;
1564 	}
1565 
1566 	ret = ci_enable_sclk_mclk_dpm(rdev, false);
1567 	if (ret)
1568 		return ret;
1569 
1570 	smc_result = ci_send_msg_to_smc(rdev, PPSMC_MSG_Voltage_Cntl_Disable);
1571 	if (smc_result != PPSMC_Result_OK)
1572 		return -EINVAL;
1573 
1574 	return 0;
1575 }
1576 
1577 static void ci_enable_sclk_control(struct radeon_device *rdev, bool enable)
1578 {
1579 	u32 tmp = RREG32_SMC(SCLK_PWRMGT_CNTL);
1580 
1581 	if (enable)
1582 		tmp &= ~SCLK_PWRMGT_OFF;
1583 	else
1584 		tmp |= SCLK_PWRMGT_OFF;
1585 	WREG32_SMC(SCLK_PWRMGT_CNTL, tmp);
1586 }
1587 
1588 #if 0
1589 static int ci_notify_hw_of_power_source(struct radeon_device *rdev,
1590 					bool ac_power)
1591 {
1592 	struct ci_power_info *pi = ci_get_pi(rdev);
1593 	struct radeon_cac_tdp_table *cac_tdp_table =
1594 		rdev->pm.dpm.dyn_state.cac_tdp_table;
1595 	u32 power_limit;
1596 
1597 	if (ac_power)
1598 		power_limit = (u32)(cac_tdp_table->maximum_power_delivery_limit * 256);
1599 	else
1600 		power_limit = (u32)(cac_tdp_table->battery_power_limit * 256);
1601 
1602 	ci_set_power_limit(rdev, power_limit);
1603 
1604 	if (pi->caps_automatic_dc_transition) {
1605 		if (ac_power)
1606 			ci_send_msg_to_smc(rdev, PPSMC_MSG_RunningOnAC);
1607 		else
1608 			ci_send_msg_to_smc(rdev, PPSMC_MSG_Remove_DC_Clamp);
1609 	}
1610 
1611 	return 0;
1612 }
1613 #endif
1614 
1615 static PPSMC_Result ci_send_msg_to_smc(struct radeon_device *rdev, PPSMC_Msg msg)
1616 {
1617 	u32 tmp;
1618 	int i;
1619 
1620 	if (!ci_is_smc_running(rdev))
1621 		return PPSMC_Result_Failed;
1622 
1623 	WREG32(SMC_MESSAGE_0, msg);
1624 
1625 	for (i = 0; i < rdev->usec_timeout; i++) {
1626 		tmp = RREG32(SMC_RESP_0);
1627 		if (tmp != 0)
1628 			break;
1629 		udelay(1);
1630 	}
1631 	tmp = RREG32(SMC_RESP_0);
1632 
1633 	return (PPSMC_Result)tmp;
1634 }
1635 
1636 static PPSMC_Result ci_send_msg_to_smc_with_parameter(struct radeon_device *rdev,
1637 						      PPSMC_Msg msg, u32 parameter)
1638 {
1639 	WREG32(SMC_MSG_ARG_0, parameter);
1640 	return ci_send_msg_to_smc(rdev, msg);
1641 }
1642 
1643 static PPSMC_Result ci_send_msg_to_smc_return_parameter(struct radeon_device *rdev,
1644 							PPSMC_Msg msg, u32 *parameter)
1645 {
1646 	PPSMC_Result smc_result;
1647 
1648 	smc_result = ci_send_msg_to_smc(rdev, msg);
1649 
1650 	if ((smc_result == PPSMC_Result_OK) && parameter)
1651 		*parameter = RREG32(SMC_MSG_ARG_0);
1652 
1653 	return smc_result;
1654 }
1655 
1656 static int ci_dpm_force_state_sclk(struct radeon_device *rdev, u32 n)
1657 {
1658 	struct ci_power_info *pi = ci_get_pi(rdev);
1659 
1660 	if (!pi->sclk_dpm_key_disabled) {
1661 		PPSMC_Result smc_result =
1662 			ci_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SCLKDPM_SetEnabledMask, 1 << n);
1663 		if (smc_result != PPSMC_Result_OK)
1664 			return -EINVAL;
1665 	}
1666 
1667 	return 0;
1668 }
1669 
1670 static int ci_dpm_force_state_mclk(struct radeon_device *rdev, u32 n)
1671 {
1672 	struct ci_power_info *pi = ci_get_pi(rdev);
1673 
1674 	if (!pi->mclk_dpm_key_disabled) {
1675 		PPSMC_Result smc_result =
1676 			ci_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_MCLKDPM_SetEnabledMask, 1 << n);
1677 		if (smc_result != PPSMC_Result_OK)
1678 			return -EINVAL;
1679 	}
1680 
1681 	return 0;
1682 }
1683 
1684 static int ci_dpm_force_state_pcie(struct radeon_device *rdev, u32 n)
1685 {
1686 	struct ci_power_info *pi = ci_get_pi(rdev);
1687 
1688 	if (!pi->pcie_dpm_key_disabled) {
1689 		PPSMC_Result smc_result =
1690 			ci_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_PCIeDPM_ForceLevel, n);
1691 		if (smc_result != PPSMC_Result_OK)
1692 			return -EINVAL;
1693 	}
1694 
1695 	return 0;
1696 }
1697 
1698 static int ci_set_power_limit(struct radeon_device *rdev, u32 n)
1699 {
1700 	struct ci_power_info *pi = ci_get_pi(rdev);
1701 
1702 	if (pi->power_containment_features & POWERCONTAINMENT_FEATURE_PkgPwrLimit) {
1703 		PPSMC_Result smc_result =
1704 			ci_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_PkgPwrSetLimit, n);
1705 		if (smc_result != PPSMC_Result_OK)
1706 			return -EINVAL;
1707 	}
1708 
1709 	return 0;
1710 }
1711 
1712 static int ci_set_overdrive_target_tdp(struct radeon_device *rdev,
1713 				       u32 target_tdp)
1714 {
1715 	PPSMC_Result smc_result =
1716 		ci_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_OverDriveSetTargetTdp, target_tdp);
1717 	if (smc_result != PPSMC_Result_OK)
1718 		return -EINVAL;
1719 	return 0;
1720 }
1721 
1722 #if 0
1723 static int ci_set_boot_state(struct radeon_device *rdev)
1724 {
1725 	return ci_enable_sclk_mclk_dpm(rdev, false);
1726 }
1727 #endif
1728 
1729 static u32 ci_get_average_sclk_freq(struct radeon_device *rdev)
1730 {
1731 	u32 sclk_freq;
1732 	PPSMC_Result smc_result =
1733 		ci_send_msg_to_smc_return_parameter(rdev,
1734 						    PPSMC_MSG_API_GetSclkFrequency,
1735 						    &sclk_freq);
1736 	if (smc_result != PPSMC_Result_OK)
1737 		sclk_freq = 0;
1738 
1739 	return sclk_freq;
1740 }
1741 
1742 static u32 ci_get_average_mclk_freq(struct radeon_device *rdev)
1743 {
1744 	u32 mclk_freq;
1745 	PPSMC_Result smc_result =
1746 		ci_send_msg_to_smc_return_parameter(rdev,
1747 						    PPSMC_MSG_API_GetMclkFrequency,
1748 						    &mclk_freq);
1749 	if (smc_result != PPSMC_Result_OK)
1750 		mclk_freq = 0;
1751 
1752 	return mclk_freq;
1753 }
1754 
1755 static void ci_dpm_start_smc(struct radeon_device *rdev)
1756 {
1757 	int i;
1758 
1759 	ci_program_jump_on_start(rdev);
1760 	ci_start_smc_clock(rdev);
1761 	ci_start_smc(rdev);
1762 	for (i = 0; i < rdev->usec_timeout; i++) {
1763 		if (RREG32_SMC(FIRMWARE_FLAGS) & INTERRUPTS_ENABLED)
1764 			break;
1765 	}
1766 }
1767 
1768 static void ci_dpm_stop_smc(struct radeon_device *rdev)
1769 {
1770 	ci_reset_smc(rdev);
1771 	ci_stop_smc_clock(rdev);
1772 }
1773 
1774 static int ci_process_firmware_header(struct radeon_device *rdev)
1775 {
1776 	struct ci_power_info *pi = ci_get_pi(rdev);
1777 	u32 tmp;
1778 	int ret;
1779 
1780 	ret = ci_read_smc_sram_dword(rdev,
1781 				     SMU7_FIRMWARE_HEADER_LOCATION +
1782 				     offsetof(SMU7_Firmware_Header, DpmTable),
1783 				     &tmp, pi->sram_end);
1784 	if (ret)
1785 		return ret;
1786 
1787 	pi->dpm_table_start = tmp;
1788 
1789 	ret = ci_read_smc_sram_dword(rdev,
1790 				     SMU7_FIRMWARE_HEADER_LOCATION +
1791 				     offsetof(SMU7_Firmware_Header, SoftRegisters),
1792 				     &tmp, pi->sram_end);
1793 	if (ret)
1794 		return ret;
1795 
1796 	pi->soft_regs_start = tmp;
1797 
1798 	ret = ci_read_smc_sram_dword(rdev,
1799 				     SMU7_FIRMWARE_HEADER_LOCATION +
1800 				     offsetof(SMU7_Firmware_Header, mcRegisterTable),
1801 				     &tmp, pi->sram_end);
1802 	if (ret)
1803 		return ret;
1804 
1805 	pi->mc_reg_table_start = tmp;
1806 
1807 	ret = ci_read_smc_sram_dword(rdev,
1808 				     SMU7_FIRMWARE_HEADER_LOCATION +
1809 				     offsetof(SMU7_Firmware_Header, FanTable),
1810 				     &tmp, pi->sram_end);
1811 	if (ret)
1812 		return ret;
1813 
1814 	pi->fan_table_start = tmp;
1815 
1816 	ret = ci_read_smc_sram_dword(rdev,
1817 				     SMU7_FIRMWARE_HEADER_LOCATION +
1818 				     offsetof(SMU7_Firmware_Header, mcArbDramTimingTable),
1819 				     &tmp, pi->sram_end);
1820 	if (ret)
1821 		return ret;
1822 
1823 	pi->arb_table_start = tmp;
1824 
1825 	return 0;
1826 }
1827 
1828 static void ci_read_clock_registers(struct radeon_device *rdev)
1829 {
1830 	struct ci_power_info *pi = ci_get_pi(rdev);
1831 
1832 	pi->clock_registers.cg_spll_func_cntl =
1833 		RREG32_SMC(CG_SPLL_FUNC_CNTL);
1834 	pi->clock_registers.cg_spll_func_cntl_2 =
1835 		RREG32_SMC(CG_SPLL_FUNC_CNTL_2);
1836 	pi->clock_registers.cg_spll_func_cntl_3 =
1837 		RREG32_SMC(CG_SPLL_FUNC_CNTL_3);
1838 	pi->clock_registers.cg_spll_func_cntl_4 =
1839 		RREG32_SMC(CG_SPLL_FUNC_CNTL_4);
1840 	pi->clock_registers.cg_spll_spread_spectrum =
1841 		RREG32_SMC(CG_SPLL_SPREAD_SPECTRUM);
1842 	pi->clock_registers.cg_spll_spread_spectrum_2 =
1843 		RREG32_SMC(CG_SPLL_SPREAD_SPECTRUM_2);
1844 	pi->clock_registers.dll_cntl = RREG32(DLL_CNTL);
1845 	pi->clock_registers.mclk_pwrmgt_cntl = RREG32(MCLK_PWRMGT_CNTL);
1846 	pi->clock_registers.mpll_ad_func_cntl = RREG32(MPLL_AD_FUNC_CNTL);
1847 	pi->clock_registers.mpll_dq_func_cntl = RREG32(MPLL_DQ_FUNC_CNTL);
1848 	pi->clock_registers.mpll_func_cntl = RREG32(MPLL_FUNC_CNTL);
1849 	pi->clock_registers.mpll_func_cntl_1 = RREG32(MPLL_FUNC_CNTL_1);
1850 	pi->clock_registers.mpll_func_cntl_2 = RREG32(MPLL_FUNC_CNTL_2);
1851 	pi->clock_registers.mpll_ss1 = RREG32(MPLL_SS1);
1852 	pi->clock_registers.mpll_ss2 = RREG32(MPLL_SS2);
1853 }
1854 
1855 static void ci_init_sclk_t(struct radeon_device *rdev)
1856 {
1857 	struct ci_power_info *pi = ci_get_pi(rdev);
1858 
1859 	pi->low_sclk_interrupt_t = 0;
1860 }
1861 
1862 static void ci_enable_thermal_protection(struct radeon_device *rdev,
1863 					 bool enable)
1864 {
1865 	u32 tmp = RREG32_SMC(GENERAL_PWRMGT);
1866 
1867 	if (enable)
1868 		tmp &= ~THERMAL_PROTECTION_DIS;
1869 	else
1870 		tmp |= THERMAL_PROTECTION_DIS;
1871 	WREG32_SMC(GENERAL_PWRMGT, tmp);
1872 }
1873 
1874 static void ci_enable_acpi_power_management(struct radeon_device *rdev)
1875 {
1876 	u32 tmp = RREG32_SMC(GENERAL_PWRMGT);
1877 
1878 	tmp |= STATIC_PM_EN;
1879 
1880 	WREG32_SMC(GENERAL_PWRMGT, tmp);
1881 }
1882 
1883 #if 0
1884 static int ci_enter_ulp_state(struct radeon_device *rdev)
1885 {
1886 
1887 	WREG32(SMC_MESSAGE_0, PPSMC_MSG_SwitchToMinimumPower);
1888 
1889 	udelay(25000);
1890 
1891 	return 0;
1892 }
1893 
1894 static int ci_exit_ulp_state(struct radeon_device *rdev)
1895 {
1896 	int i;
1897 
1898 	WREG32(SMC_MESSAGE_0, PPSMC_MSG_ResumeFromMinimumPower);
1899 
1900 	udelay(7000);
1901 
1902 	for (i = 0; i < rdev->usec_timeout; i++) {
1903 		if (RREG32(SMC_RESP_0) == 1)
1904 			break;
1905 		udelay(1000);
1906 	}
1907 
1908 	return 0;
1909 }
1910 #endif
1911 
1912 static int ci_notify_smc_display_change(struct radeon_device *rdev,
1913 					bool has_display)
1914 {
1915 	PPSMC_Msg msg = has_display ? PPSMC_MSG_HasDisplay : PPSMC_MSG_NoDisplay;
1916 
1917 	return (ci_send_msg_to_smc(rdev, msg) == PPSMC_Result_OK) ?  0 : -EINVAL;
1918 }
1919 
1920 static int ci_enable_ds_master_switch(struct radeon_device *rdev,
1921 				      bool enable)
1922 {
1923 	struct ci_power_info *pi = ci_get_pi(rdev);
1924 
1925 	if (enable) {
1926 		if (pi->caps_sclk_ds) {
1927 			if (ci_send_msg_to_smc(rdev, PPSMC_MSG_MASTER_DeepSleep_ON) != PPSMC_Result_OK)
1928 				return -EINVAL;
1929 		} else {
1930 			if (ci_send_msg_to_smc(rdev, PPSMC_MSG_MASTER_DeepSleep_OFF) != PPSMC_Result_OK)
1931 				return -EINVAL;
1932 		}
1933 	} else {
1934 		if (pi->caps_sclk_ds) {
1935 			if (ci_send_msg_to_smc(rdev, PPSMC_MSG_MASTER_DeepSleep_OFF) != PPSMC_Result_OK)
1936 				return -EINVAL;
1937 		}
1938 	}
1939 
1940 	return 0;
1941 }
1942 
1943 static void ci_program_display_gap(struct radeon_device *rdev)
1944 {
1945 	u32 tmp = RREG32_SMC(CG_DISPLAY_GAP_CNTL);
1946 	u32 pre_vbi_time_in_us;
1947 	u32 frame_time_in_us;
1948 	u32 ref_clock = rdev->clock.spll.reference_freq;
1949 	u32 refresh_rate = r600_dpm_get_vrefresh(rdev);
1950 	u32 vblank_time = r600_dpm_get_vblank_time(rdev);
1951 
1952 	tmp &= ~DISP_GAP_MASK;
1953 	if (rdev->pm.dpm.new_active_crtc_count > 0)
1954 		tmp |= DISP_GAP(R600_PM_DISPLAY_GAP_VBLANK_OR_WM);
1955 	else
1956 		tmp |= DISP_GAP(R600_PM_DISPLAY_GAP_IGNORE);
1957 	WREG32_SMC(CG_DISPLAY_GAP_CNTL, tmp);
1958 
1959 	if (refresh_rate == 0)
1960 		refresh_rate = 60;
1961 	if (vblank_time == 0xffffffff)
1962 		vblank_time = 500;
1963 	frame_time_in_us = 1000000 / refresh_rate;
1964 	pre_vbi_time_in_us =
1965 		frame_time_in_us - 200 - vblank_time;
1966 	tmp = pre_vbi_time_in_us * (ref_clock / 100);
1967 
1968 	WREG32_SMC(CG_DISPLAY_GAP_CNTL2, tmp);
1969 	ci_write_smc_soft_register(rdev, offsetof(SMU7_SoftRegisters, PreVBlankGap), 0x64);
1970 	ci_write_smc_soft_register(rdev, offsetof(SMU7_SoftRegisters, VBlankTimeout), (frame_time_in_us - pre_vbi_time_in_us));
1971 
1972 
1973 	ci_notify_smc_display_change(rdev, (rdev->pm.dpm.new_active_crtc_count == 1));
1974 
1975 }
1976 
1977 static void ci_enable_spread_spectrum(struct radeon_device *rdev, bool enable)
1978 {
1979 	struct ci_power_info *pi = ci_get_pi(rdev);
1980 	u32 tmp;
1981 
1982 	if (enable) {
1983 		if (pi->caps_sclk_ss_support) {
1984 			tmp = RREG32_SMC(GENERAL_PWRMGT);
1985 			tmp |= DYN_SPREAD_SPECTRUM_EN;
1986 			WREG32_SMC(GENERAL_PWRMGT, tmp);
1987 		}
1988 	} else {
1989 		tmp = RREG32_SMC(CG_SPLL_SPREAD_SPECTRUM);
1990 		tmp &= ~SSEN;
1991 		WREG32_SMC(CG_SPLL_SPREAD_SPECTRUM, tmp);
1992 
1993 		tmp = RREG32_SMC(GENERAL_PWRMGT);
1994 		tmp &= ~DYN_SPREAD_SPECTRUM_EN;
1995 		WREG32_SMC(GENERAL_PWRMGT, tmp);
1996 	}
1997 }
1998 
1999 static void ci_program_sstp(struct radeon_device *rdev)
2000 {
2001 	WREG32_SMC(CG_SSP, (SSTU(R600_SSTU_DFLT) | SST(R600_SST_DFLT)));
2002 }
2003 
2004 static void ci_enable_display_gap(struct radeon_device *rdev)
2005 {
2006 	u32 tmp = RREG32_SMC(CG_DISPLAY_GAP_CNTL);
2007 
2008 	tmp &= ~(DISP_GAP_MASK | DISP_GAP_MCHG_MASK);
2009 	tmp |= (DISP_GAP(R600_PM_DISPLAY_GAP_IGNORE) |
2010 		DISP_GAP_MCHG(R600_PM_DISPLAY_GAP_VBLANK));
2011 
2012 	WREG32_SMC(CG_DISPLAY_GAP_CNTL, tmp);
2013 }
2014 
2015 static void ci_program_vc(struct radeon_device *rdev)
2016 {
2017 	u32 tmp;
2018 
2019 	tmp = RREG32_SMC(SCLK_PWRMGT_CNTL);
2020 	tmp &= ~(RESET_SCLK_CNT | RESET_BUSY_CNT);
2021 	WREG32_SMC(SCLK_PWRMGT_CNTL, tmp);
2022 
2023 	WREG32_SMC(CG_FTV_0, CISLANDS_VRC_DFLT0);
2024 	WREG32_SMC(CG_FTV_1, CISLANDS_VRC_DFLT1);
2025 	WREG32_SMC(CG_FTV_2, CISLANDS_VRC_DFLT2);
2026 	WREG32_SMC(CG_FTV_3, CISLANDS_VRC_DFLT3);
2027 	WREG32_SMC(CG_FTV_4, CISLANDS_VRC_DFLT4);
2028 	WREG32_SMC(CG_FTV_5, CISLANDS_VRC_DFLT5);
2029 	WREG32_SMC(CG_FTV_6, CISLANDS_VRC_DFLT6);
2030 	WREG32_SMC(CG_FTV_7, CISLANDS_VRC_DFLT7);
2031 }
2032 
2033 static void ci_clear_vc(struct radeon_device *rdev)
2034 {
2035 	u32 tmp;
2036 
2037 	tmp = RREG32_SMC(SCLK_PWRMGT_CNTL);
2038 	tmp |= (RESET_SCLK_CNT | RESET_BUSY_CNT);
2039 	WREG32_SMC(SCLK_PWRMGT_CNTL, tmp);
2040 
2041 	WREG32_SMC(CG_FTV_0, 0);
2042 	WREG32_SMC(CG_FTV_1, 0);
2043 	WREG32_SMC(CG_FTV_2, 0);
2044 	WREG32_SMC(CG_FTV_3, 0);
2045 	WREG32_SMC(CG_FTV_4, 0);
2046 	WREG32_SMC(CG_FTV_5, 0);
2047 	WREG32_SMC(CG_FTV_6, 0);
2048 	WREG32_SMC(CG_FTV_7, 0);
2049 }
2050 
2051 static int ci_upload_firmware(struct radeon_device *rdev)
2052 {
2053 	struct ci_power_info *pi = ci_get_pi(rdev);
2054 	int i;
2055 
2056 	for (i = 0; i < rdev->usec_timeout; i++) {
2057 		if (RREG32_SMC(RCU_UC_EVENTS) & BOOT_SEQ_DONE)
2058 			break;
2059 	}
2060 	WREG32_SMC(SMC_SYSCON_MISC_CNTL, 1);
2061 
2062 	ci_stop_smc_clock(rdev);
2063 	ci_reset_smc(rdev);
2064 
2065 	return ci_load_smc_ucode(rdev, pi->sram_end);
2066 
2067 }
2068 
2069 static int ci_get_svi2_voltage_table(struct radeon_device *rdev,
2070 				     struct radeon_clock_voltage_dependency_table *voltage_dependency_table,
2071 				     struct atom_voltage_table *voltage_table)
2072 {
2073 	u32 i;
2074 
2075 	if (voltage_dependency_table == NULL)
2076 		return -EINVAL;
2077 
2078 	voltage_table->mask_low = 0;
2079 	voltage_table->phase_delay = 0;
2080 
2081 	voltage_table->count = voltage_dependency_table->count;
2082 	for (i = 0; i < voltage_table->count; i++) {
2083 		voltage_table->entries[i].value = voltage_dependency_table->entries[i].v;
2084 		voltage_table->entries[i].smio_low = 0;
2085 	}
2086 
2087 	return 0;
2088 }
2089 
2090 static int ci_construct_voltage_tables(struct radeon_device *rdev)
2091 {
2092 	struct ci_power_info *pi = ci_get_pi(rdev);
2093 	int ret;
2094 
2095 	if (pi->voltage_control == CISLANDS_VOLTAGE_CONTROL_BY_GPIO) {
2096 		ret = radeon_atom_get_voltage_table(rdev, VOLTAGE_TYPE_VDDC,
2097 						    VOLTAGE_OBJ_GPIO_LUT,
2098 						    &pi->vddc_voltage_table);
2099 		if (ret)
2100 			return ret;
2101 	} else if (pi->voltage_control == CISLANDS_VOLTAGE_CONTROL_BY_SVID2) {
2102 		ret = ci_get_svi2_voltage_table(rdev,
2103 						&rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk,
2104 						&pi->vddc_voltage_table);
2105 		if (ret)
2106 			return ret;
2107 	}
2108 
2109 	if (pi->vddc_voltage_table.count > SMU7_MAX_LEVELS_VDDC)
2110 		si_trim_voltage_table_to_fit_state_table(rdev, SMU7_MAX_LEVELS_VDDC,
2111 							 &pi->vddc_voltage_table);
2112 
2113 	if (pi->vddci_control == CISLANDS_VOLTAGE_CONTROL_BY_GPIO) {
2114 		ret = radeon_atom_get_voltage_table(rdev, VOLTAGE_TYPE_VDDCI,
2115 						    VOLTAGE_OBJ_GPIO_LUT,
2116 						    &pi->vddci_voltage_table);
2117 		if (ret)
2118 			return ret;
2119 	} else if (pi->vddci_control == CISLANDS_VOLTAGE_CONTROL_BY_SVID2) {
2120 		ret = ci_get_svi2_voltage_table(rdev,
2121 						&rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk,
2122 						&pi->vddci_voltage_table);
2123 		if (ret)
2124 			return ret;
2125 	}
2126 
2127 	if (pi->vddci_voltage_table.count > SMU7_MAX_LEVELS_VDDCI)
2128 		si_trim_voltage_table_to_fit_state_table(rdev, SMU7_MAX_LEVELS_VDDCI,
2129 							 &pi->vddci_voltage_table);
2130 
2131 	if (pi->mvdd_control == CISLANDS_VOLTAGE_CONTROL_BY_GPIO) {
2132 		ret = radeon_atom_get_voltage_table(rdev, VOLTAGE_TYPE_MVDDC,
2133 						    VOLTAGE_OBJ_GPIO_LUT,
2134 						    &pi->mvdd_voltage_table);
2135 		if (ret)
2136 			return ret;
2137 	} else if (pi->mvdd_control == CISLANDS_VOLTAGE_CONTROL_BY_SVID2) {
2138 		ret = ci_get_svi2_voltage_table(rdev,
2139 						&rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk,
2140 						&pi->mvdd_voltage_table);
2141 		if (ret)
2142 			return ret;
2143 	}
2144 
2145 	if (pi->mvdd_voltage_table.count > SMU7_MAX_LEVELS_MVDD)
2146 		si_trim_voltage_table_to_fit_state_table(rdev, SMU7_MAX_LEVELS_MVDD,
2147 							 &pi->mvdd_voltage_table);
2148 
2149 	return 0;
2150 }
2151 
2152 static void ci_populate_smc_voltage_table(struct radeon_device *rdev,
2153 					  struct atom_voltage_table_entry *voltage_table,
2154 					  SMU7_Discrete_VoltageLevel *smc_voltage_table)
2155 {
2156 	int ret;
2157 
2158 	ret = ci_get_std_voltage_value_sidd(rdev, voltage_table,
2159 					    &smc_voltage_table->StdVoltageHiSidd,
2160 					    &smc_voltage_table->StdVoltageLoSidd);
2161 
2162 	if (ret) {
2163 		smc_voltage_table->StdVoltageHiSidd = voltage_table->value * VOLTAGE_SCALE;
2164 		smc_voltage_table->StdVoltageLoSidd = voltage_table->value * VOLTAGE_SCALE;
2165 	}
2166 
2167 	smc_voltage_table->Voltage = cpu_to_be16(voltage_table->value * VOLTAGE_SCALE);
2168 	smc_voltage_table->StdVoltageHiSidd =
2169 		cpu_to_be16(smc_voltage_table->StdVoltageHiSidd);
2170 	smc_voltage_table->StdVoltageLoSidd =
2171 		cpu_to_be16(smc_voltage_table->StdVoltageLoSidd);
2172 }
2173 
2174 static int ci_populate_smc_vddc_table(struct radeon_device *rdev,
2175 				      SMU7_Discrete_DpmTable *table)
2176 {
2177 	struct ci_power_info *pi = ci_get_pi(rdev);
2178 	unsigned int count;
2179 
2180 	table->VddcLevelCount = pi->vddc_voltage_table.count;
2181 	for (count = 0; count < table->VddcLevelCount; count++) {
2182 		ci_populate_smc_voltage_table(rdev,
2183 					      &pi->vddc_voltage_table.entries[count],
2184 					      &table->VddcLevel[count]);
2185 
2186 		if (pi->voltage_control == CISLANDS_VOLTAGE_CONTROL_BY_GPIO)
2187 			table->VddcLevel[count].Smio |=
2188 				pi->vddc_voltage_table.entries[count].smio_low;
2189 		else
2190 			table->VddcLevel[count].Smio = 0;
2191 	}
2192 	table->VddcLevelCount = cpu_to_be32(table->VddcLevelCount);
2193 
2194 	return 0;
2195 }
2196 
2197 static int ci_populate_smc_vddci_table(struct radeon_device *rdev,
2198 				       SMU7_Discrete_DpmTable *table)
2199 {
2200 	unsigned int count;
2201 	struct ci_power_info *pi = ci_get_pi(rdev);
2202 
2203 	table->VddciLevelCount = pi->vddci_voltage_table.count;
2204 	for (count = 0; count < table->VddciLevelCount; count++) {
2205 		ci_populate_smc_voltage_table(rdev,
2206 					      &pi->vddci_voltage_table.entries[count],
2207 					      &table->VddciLevel[count]);
2208 
2209 		if (pi->vddci_control == CISLANDS_VOLTAGE_CONTROL_BY_GPIO)
2210 			table->VddciLevel[count].Smio |=
2211 				pi->vddci_voltage_table.entries[count].smio_low;
2212 		else
2213 			table->VddciLevel[count].Smio = 0;
2214 	}
2215 	table->VddciLevelCount = cpu_to_be32(table->VddciLevelCount);
2216 
2217 	return 0;
2218 }
2219 
2220 static int ci_populate_smc_mvdd_table(struct radeon_device *rdev,
2221 				      SMU7_Discrete_DpmTable *table)
2222 {
2223 	struct ci_power_info *pi = ci_get_pi(rdev);
2224 	unsigned int count;
2225 
2226 	table->MvddLevelCount = pi->mvdd_voltage_table.count;
2227 	for (count = 0; count < table->MvddLevelCount; count++) {
2228 		ci_populate_smc_voltage_table(rdev,
2229 					      &pi->mvdd_voltage_table.entries[count],
2230 					      &table->MvddLevel[count]);
2231 
2232 		if (pi->mvdd_control == CISLANDS_VOLTAGE_CONTROL_BY_GPIO)
2233 			table->MvddLevel[count].Smio |=
2234 				pi->mvdd_voltage_table.entries[count].smio_low;
2235 		else
2236 			table->MvddLevel[count].Smio = 0;
2237 	}
2238 	table->MvddLevelCount = cpu_to_be32(table->MvddLevelCount);
2239 
2240 	return 0;
2241 }
2242 
2243 static int ci_populate_smc_voltage_tables(struct radeon_device *rdev,
2244 					  SMU7_Discrete_DpmTable *table)
2245 {
2246 	int ret;
2247 
2248 	ret = ci_populate_smc_vddc_table(rdev, table);
2249 	if (ret)
2250 		return ret;
2251 
2252 	ret = ci_populate_smc_vddci_table(rdev, table);
2253 	if (ret)
2254 		return ret;
2255 
2256 	ret = ci_populate_smc_mvdd_table(rdev, table);
2257 	if (ret)
2258 		return ret;
2259 
2260 	return 0;
2261 }
2262 
2263 static int ci_populate_mvdd_value(struct radeon_device *rdev, u32 mclk,
2264 				  SMU7_Discrete_VoltageLevel *voltage)
2265 {
2266 	struct ci_power_info *pi = ci_get_pi(rdev);
2267 	u32 i = 0;
2268 
2269 	if (pi->mvdd_control != CISLANDS_VOLTAGE_CONTROL_NONE) {
2270 		for (i = 0; i < rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk.count; i++) {
2271 			if (mclk <= rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk.entries[i].clk) {
2272 				voltage->Voltage = pi->mvdd_voltage_table.entries[i].value;
2273 				break;
2274 			}
2275 		}
2276 
2277 		if (i >= rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk.count)
2278 			return -EINVAL;
2279 	}
2280 
2281 	return -EINVAL;
2282 }
2283 
2284 static int ci_get_std_voltage_value_sidd(struct radeon_device *rdev,
2285 					 struct atom_voltage_table_entry *voltage_table,
2286 					 u16 *std_voltage_hi_sidd, u16 *std_voltage_lo_sidd)
2287 {
2288 	u16 v_index, idx;
2289 	bool voltage_found = false;
2290 	*std_voltage_hi_sidd = voltage_table->value * VOLTAGE_SCALE;
2291 	*std_voltage_lo_sidd = voltage_table->value * VOLTAGE_SCALE;
2292 
2293 	if (rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries == NULL)
2294 		return -EINVAL;
2295 
2296 	if (rdev->pm.dpm.dyn_state.cac_leakage_table.entries) {
2297 		for (v_index = 0; (u32)v_index < rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.count; v_index++) {
2298 			if (voltage_table->value ==
2299 			    rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[v_index].v) {
2300 				voltage_found = true;
2301 				if ((u32)v_index < rdev->pm.dpm.dyn_state.cac_leakage_table.count)
2302 					idx = v_index;
2303 				else
2304 					idx = rdev->pm.dpm.dyn_state.cac_leakage_table.count - 1;
2305 				*std_voltage_lo_sidd =
2306 					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[idx].vddc * VOLTAGE_SCALE;
2307 				*std_voltage_hi_sidd =
2308 					rdev->pm.dpm.dyn_state.cac_leakage_table.entries[idx].leakage * VOLTAGE_SCALE;
2309 				break;
2310 			}
2311 		}
2312 
2313 		if (!voltage_found) {
2314 			for (v_index = 0; (u32)v_index < rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.count; v_index++) {
2315 				if (voltage_table->value <=
2316 				    rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[v_index].v) {
2317 					voltage_found = true;
2318 					if ((u32)v_index < rdev->pm.dpm.dyn_state.cac_leakage_table.count)
2319 						idx = v_index;
2320 					else
2321 						idx = rdev->pm.dpm.dyn_state.cac_leakage_table.count - 1;
2322 					*std_voltage_lo_sidd =
2323 						rdev->pm.dpm.dyn_state.cac_leakage_table.entries[idx].vddc * VOLTAGE_SCALE;
2324 					*std_voltage_hi_sidd =
2325 						rdev->pm.dpm.dyn_state.cac_leakage_table.entries[idx].leakage * VOLTAGE_SCALE;
2326 					break;
2327 				}
2328 			}
2329 		}
2330 	}
2331 
2332 	return 0;
2333 }
2334 
2335 static void ci_populate_phase_value_based_on_sclk(struct radeon_device *rdev,
2336 						  const struct radeon_phase_shedding_limits_table *limits,
2337 						  u32 sclk,
2338 						  u32 *phase_shedding)
2339 {
2340 	unsigned int i;
2341 
2342 	*phase_shedding = 1;
2343 
2344 	for (i = 0; i < limits->count; i++) {
2345 		if (sclk < limits->entries[i].sclk) {
2346 			*phase_shedding = i;
2347 			break;
2348 		}
2349 	}
2350 }
2351 
2352 static void ci_populate_phase_value_based_on_mclk(struct radeon_device *rdev,
2353 						  const struct radeon_phase_shedding_limits_table *limits,
2354 						  u32 mclk,
2355 						  u32 *phase_shedding)
2356 {
2357 	unsigned int i;
2358 
2359 	*phase_shedding = 1;
2360 
2361 	for (i = 0; i < limits->count; i++) {
2362 		if (mclk < limits->entries[i].mclk) {
2363 			*phase_shedding = i;
2364 			break;
2365 		}
2366 	}
2367 }
2368 
2369 static int ci_init_arb_table_index(struct radeon_device *rdev)
2370 {
2371 	struct ci_power_info *pi = ci_get_pi(rdev);
2372 	u32 tmp;
2373 	int ret;
2374 
2375 	ret = ci_read_smc_sram_dword(rdev, pi->arb_table_start,
2376 				     &tmp, pi->sram_end);
2377 	if (ret)
2378 		return ret;
2379 
2380 	tmp &= 0x00FFFFFF;
2381 	tmp |= MC_CG_ARB_FREQ_F1 << 24;
2382 
2383 	return ci_write_smc_sram_dword(rdev, pi->arb_table_start,
2384 				       tmp, pi->sram_end);
2385 }
2386 
2387 static int ci_get_dependency_volt_by_clk(struct radeon_device *rdev,
2388 					 struct radeon_clock_voltage_dependency_table *allowed_clock_voltage_table,
2389 					 u32 clock, u32 *voltage)
2390 {
2391 	u32 i = 0;
2392 
2393 	if (allowed_clock_voltage_table->count == 0)
2394 		return -EINVAL;
2395 
2396 	for (i = 0; i < allowed_clock_voltage_table->count; i++) {
2397 		if (allowed_clock_voltage_table->entries[i].clk >= clock) {
2398 			*voltage = allowed_clock_voltage_table->entries[i].v;
2399 			return 0;
2400 		}
2401 	}
2402 
2403 	*voltage = allowed_clock_voltage_table->entries[i-1].v;
2404 
2405 	return 0;
2406 }
2407 
2408 static u8 ci_get_sleep_divider_id_from_clock(struct radeon_device *rdev,
2409 					     u32 sclk, u32 min_sclk_in_sr)
2410 {
2411 	u32 i;
2412 	u32 tmp;
2413 	u32 min = (min_sclk_in_sr > CISLAND_MINIMUM_ENGINE_CLOCK) ?
2414 		min_sclk_in_sr : CISLAND_MINIMUM_ENGINE_CLOCK;
2415 
2416 	if (sclk < min)
2417 		return 0;
2418 
2419 	for (i = CISLAND_MAX_DEEPSLEEP_DIVIDER_ID;  ; i--) {
2420 		tmp = sclk / (1 << i);
2421 		if (tmp >= min || i == 0)
2422 			break;
2423 	}
2424 
2425 	return (u8)i;
2426 }
2427 
2428 static int ci_initial_switch_from_arb_f0_to_f1(struct radeon_device *rdev)
2429 {
2430 	return ni_copy_and_switch_arb_sets(rdev, MC_CG_ARB_FREQ_F0, MC_CG_ARB_FREQ_F1);
2431 }
2432 
2433 static int ci_reset_to_default(struct radeon_device *rdev)
2434 {
2435 	return (ci_send_msg_to_smc(rdev, PPSMC_MSG_ResetToDefaults) == PPSMC_Result_OK) ?
2436 		0 : -EINVAL;
2437 }
2438 
2439 static int ci_force_switch_to_arb_f0(struct radeon_device *rdev)
2440 {
2441 	u32 tmp;
2442 
2443 	tmp = (RREG32_SMC(SMC_SCRATCH9) & 0x0000ff00) >> 8;
2444 
2445 	if (tmp == MC_CG_ARB_FREQ_F0)
2446 		return 0;
2447 
2448 	return ni_copy_and_switch_arb_sets(rdev, tmp, MC_CG_ARB_FREQ_F0);
2449 }
2450 
2451 static void ci_register_patching_mc_arb(struct radeon_device *rdev,
2452 					const u32 engine_clock,
2453 					const u32 memory_clock,
2454 					u32 *dram_timimg2)
2455 {
2456 	bool patch;
2457 	u32 tmp, tmp2;
2458 
2459 	tmp = RREG32(MC_SEQ_MISC0);
2460 	patch = ((tmp & 0x0000f00) == 0x300) ? true : false;
2461 
2462 	if (patch &&
2463 	    ((rdev->pdev->device == 0x67B0) ||
2464 	     (rdev->pdev->device == 0x67B1))) {
2465 		if ((memory_clock > 100000) && (memory_clock <= 125000)) {
2466 			tmp2 = (((0x31 * engine_clock) / 125000) - 1) & 0xff;
2467 			*dram_timimg2 &= ~0x00ff0000;
2468 			*dram_timimg2 |= tmp2 << 16;
2469 		} else if ((memory_clock > 125000) && (memory_clock <= 137500)) {
2470 			tmp2 = (((0x36 * engine_clock) / 137500) - 1) & 0xff;
2471 			*dram_timimg2 &= ~0x00ff0000;
2472 			*dram_timimg2 |= tmp2 << 16;
2473 		}
2474 	}
2475 }
2476 
2477 
2478 static int ci_populate_memory_timing_parameters(struct radeon_device *rdev,
2479 						u32 sclk,
2480 						u32 mclk,
2481 						SMU7_Discrete_MCArbDramTimingTableEntry *arb_regs)
2482 {
2483 	u32 dram_timing;
2484 	u32 dram_timing2;
2485 	u32 burst_time;
2486 
2487 	radeon_atom_set_engine_dram_timings(rdev, sclk, mclk);
2488 
2489 	dram_timing  = RREG32(MC_ARB_DRAM_TIMING);
2490 	dram_timing2 = RREG32(MC_ARB_DRAM_TIMING2);
2491 	burst_time = RREG32(MC_ARB_BURST_TIME) & STATE0_MASK;
2492 
2493 	ci_register_patching_mc_arb(rdev, sclk, mclk, &dram_timing2);
2494 
2495 	arb_regs->McArbDramTiming  = cpu_to_be32(dram_timing);
2496 	arb_regs->McArbDramTiming2 = cpu_to_be32(dram_timing2);
2497 	arb_regs->McArbBurstTime = (u8)burst_time;
2498 
2499 	return 0;
2500 }
2501 
2502 static int ci_do_program_memory_timing_parameters(struct radeon_device *rdev)
2503 {
2504 	struct ci_power_info *pi = ci_get_pi(rdev);
2505 	SMU7_Discrete_MCArbDramTimingTable arb_regs;
2506 	u32 i, j;
2507 	int ret =  0;
2508 
2509 	memset(&arb_regs, 0, sizeof(SMU7_Discrete_MCArbDramTimingTable));
2510 
2511 	for (i = 0; i < pi->dpm_table.sclk_table.count; i++) {
2512 		for (j = 0; j < pi->dpm_table.mclk_table.count; j++) {
2513 			ret = ci_populate_memory_timing_parameters(rdev,
2514 								   pi->dpm_table.sclk_table.dpm_levels[i].value,
2515 								   pi->dpm_table.mclk_table.dpm_levels[j].value,
2516 								   &arb_regs.entries[i][j]);
2517 			if (ret)
2518 				break;
2519 		}
2520 	}
2521 
2522 	if (ret == 0)
2523 		ret = ci_copy_bytes_to_smc(rdev,
2524 					   pi->arb_table_start,
2525 					   (u8 *)&arb_regs,
2526 					   sizeof(SMU7_Discrete_MCArbDramTimingTable),
2527 					   pi->sram_end);
2528 
2529 	return ret;
2530 }
2531 
2532 static int ci_program_memory_timing_parameters(struct radeon_device *rdev)
2533 {
2534 	struct ci_power_info *pi = ci_get_pi(rdev);
2535 
2536 	if (pi->need_update_smu7_dpm_table == 0)
2537 		return 0;
2538 
2539 	return ci_do_program_memory_timing_parameters(rdev);
2540 }
2541 
2542 static void ci_populate_smc_initial_state(struct radeon_device *rdev,
2543 					  struct radeon_ps *radeon_boot_state)
2544 {
2545 	struct ci_ps *boot_state = ci_get_ps(radeon_boot_state);
2546 	struct ci_power_info *pi = ci_get_pi(rdev);
2547 	u32 level = 0;
2548 
2549 	for (level = 0; level < rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.count; level++) {
2550 		if (rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[level].clk >=
2551 		    boot_state->performance_levels[0].sclk) {
2552 			pi->smc_state_table.GraphicsBootLevel = level;
2553 			break;
2554 		}
2555 	}
2556 
2557 	for (level = 0; level < rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk.count; level++) {
2558 		if (rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk.entries[level].clk >=
2559 		    boot_state->performance_levels[0].mclk) {
2560 			pi->smc_state_table.MemoryBootLevel = level;
2561 			break;
2562 		}
2563 	}
2564 }
2565 
2566 static u32 ci_get_dpm_level_enable_mask_value(struct ci_single_dpm_table *dpm_table)
2567 {
2568 	u32 i;
2569 	u32 mask_value = 0;
2570 
2571 	for (i = dpm_table->count; i > 0; i--) {
2572 		mask_value = mask_value << 1;
2573 		if (dpm_table->dpm_levels[i-1].enabled)
2574 			mask_value |= 0x1;
2575 		else
2576 			mask_value &= 0xFFFFFFFE;
2577 	}
2578 
2579 	return mask_value;
2580 }
2581 
2582 static void ci_populate_smc_link_level(struct radeon_device *rdev,
2583 				       SMU7_Discrete_DpmTable *table)
2584 {
2585 	struct ci_power_info *pi = ci_get_pi(rdev);
2586 	struct ci_dpm_table *dpm_table = &pi->dpm_table;
2587 	u32 i;
2588 
2589 	for (i = 0; i < dpm_table->pcie_speed_table.count; i++) {
2590 		table->LinkLevel[i].PcieGenSpeed =
2591 			(u8)dpm_table->pcie_speed_table.dpm_levels[i].value;
2592 		table->LinkLevel[i].PcieLaneCount =
2593 			r600_encode_pci_lane_width(dpm_table->pcie_speed_table.dpm_levels[i].param1);
2594 		table->LinkLevel[i].EnabledForActivity = 1;
2595 		table->LinkLevel[i].DownT = cpu_to_be32(5);
2596 		table->LinkLevel[i].UpT = cpu_to_be32(30);
2597 	}
2598 
2599 	pi->smc_state_table.LinkLevelCount = (u8)dpm_table->pcie_speed_table.count;
2600 	pi->dpm_level_enable_mask.pcie_dpm_enable_mask =
2601 		ci_get_dpm_level_enable_mask_value(&dpm_table->pcie_speed_table);
2602 }
2603 
2604 static int ci_populate_smc_uvd_level(struct radeon_device *rdev,
2605 				     SMU7_Discrete_DpmTable *table)
2606 {
2607 	u32 count;
2608 	struct atom_clock_dividers dividers;
2609 	int ret = -EINVAL;
2610 
2611 	table->UvdLevelCount =
2612 		rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.count;
2613 
2614 	for (count = 0; count < table->UvdLevelCount; count++) {
2615 		table->UvdLevel[count].VclkFrequency =
2616 			rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[count].vclk;
2617 		table->UvdLevel[count].DclkFrequency =
2618 			rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[count].dclk;
2619 		table->UvdLevel[count].MinVddc =
2620 			rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[count].v * VOLTAGE_SCALE;
2621 		table->UvdLevel[count].MinVddcPhases = 1;
2622 
2623 		ret = radeon_atom_get_clock_dividers(rdev,
2624 						     COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK,
2625 						     table->UvdLevel[count].VclkFrequency, false, &dividers);
2626 		if (ret)
2627 			return ret;
2628 
2629 		table->UvdLevel[count].VclkDivider = (u8)dividers.post_divider;
2630 
2631 		ret = radeon_atom_get_clock_dividers(rdev,
2632 						     COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK,
2633 						     table->UvdLevel[count].DclkFrequency, false, &dividers);
2634 		if (ret)
2635 			return ret;
2636 
2637 		table->UvdLevel[count].DclkDivider = (u8)dividers.post_divider;
2638 
2639 		table->UvdLevel[count].VclkFrequency = cpu_to_be32(table->UvdLevel[count].VclkFrequency);
2640 		table->UvdLevel[count].DclkFrequency = cpu_to_be32(table->UvdLevel[count].DclkFrequency);
2641 		table->UvdLevel[count].MinVddc = cpu_to_be16(table->UvdLevel[count].MinVddc);
2642 	}
2643 
2644 	return ret;
2645 }
2646 
2647 static int ci_populate_smc_vce_level(struct radeon_device *rdev,
2648 				     SMU7_Discrete_DpmTable *table)
2649 {
2650 	u32 count;
2651 	struct atom_clock_dividers dividers;
2652 	int ret = -EINVAL;
2653 
2654 	table->VceLevelCount =
2655 		rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.count;
2656 
2657 	for (count = 0; count < table->VceLevelCount; count++) {
2658 		table->VceLevel[count].Frequency =
2659 			rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[count].evclk;
2660 		table->VceLevel[count].MinVoltage =
2661 			(u16)rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[count].v * VOLTAGE_SCALE;
2662 		table->VceLevel[count].MinPhases = 1;
2663 
2664 		ret = radeon_atom_get_clock_dividers(rdev,
2665 						     COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK,
2666 						     table->VceLevel[count].Frequency, false, &dividers);
2667 		if (ret)
2668 			return ret;
2669 
2670 		table->VceLevel[count].Divider = (u8)dividers.post_divider;
2671 
2672 		table->VceLevel[count].Frequency = cpu_to_be32(table->VceLevel[count].Frequency);
2673 		table->VceLevel[count].MinVoltage = cpu_to_be16(table->VceLevel[count].MinVoltage);
2674 	}
2675 
2676 	return ret;
2677 
2678 }
2679 
2680 static int ci_populate_smc_acp_level(struct radeon_device *rdev,
2681 				     SMU7_Discrete_DpmTable *table)
2682 {
2683 	u32 count;
2684 	struct atom_clock_dividers dividers;
2685 	int ret = -EINVAL;
2686 
2687 	table->AcpLevelCount = (u8)
2688 		(rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.count);
2689 
2690 	for (count = 0; count < table->AcpLevelCount; count++) {
2691 		table->AcpLevel[count].Frequency =
2692 			rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries[count].clk;
2693 		table->AcpLevel[count].MinVoltage =
2694 			rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries[count].v;
2695 		table->AcpLevel[count].MinPhases = 1;
2696 
2697 		ret = radeon_atom_get_clock_dividers(rdev,
2698 						     COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK,
2699 						     table->AcpLevel[count].Frequency, false, &dividers);
2700 		if (ret)
2701 			return ret;
2702 
2703 		table->AcpLevel[count].Divider = (u8)dividers.post_divider;
2704 
2705 		table->AcpLevel[count].Frequency = cpu_to_be32(table->AcpLevel[count].Frequency);
2706 		table->AcpLevel[count].MinVoltage = cpu_to_be16(table->AcpLevel[count].MinVoltage);
2707 	}
2708 
2709 	return ret;
2710 }
2711 
2712 static int ci_populate_smc_samu_level(struct radeon_device *rdev,
2713 				      SMU7_Discrete_DpmTable *table)
2714 {
2715 	u32 count;
2716 	struct atom_clock_dividers dividers;
2717 	int ret = -EINVAL;
2718 
2719 	table->SamuLevelCount =
2720 		rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.count;
2721 
2722 	for (count = 0; count < table->SamuLevelCount; count++) {
2723 		table->SamuLevel[count].Frequency =
2724 			rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries[count].clk;
2725 		table->SamuLevel[count].MinVoltage =
2726 			rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries[count].v * VOLTAGE_SCALE;
2727 		table->SamuLevel[count].MinPhases = 1;
2728 
2729 		ret = radeon_atom_get_clock_dividers(rdev,
2730 						     COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK,
2731 						     table->SamuLevel[count].Frequency, false, &dividers);
2732 		if (ret)
2733 			return ret;
2734 
2735 		table->SamuLevel[count].Divider = (u8)dividers.post_divider;
2736 
2737 		table->SamuLevel[count].Frequency = cpu_to_be32(table->SamuLevel[count].Frequency);
2738 		table->SamuLevel[count].MinVoltage = cpu_to_be16(table->SamuLevel[count].MinVoltage);
2739 	}
2740 
2741 	return ret;
2742 }
2743 
2744 static int ci_calculate_mclk_params(struct radeon_device *rdev,
2745 				    u32 memory_clock,
2746 				    SMU7_Discrete_MemoryLevel *mclk,
2747 				    bool strobe_mode,
2748 				    bool dll_state_on)
2749 {
2750 	struct ci_power_info *pi = ci_get_pi(rdev);
2751 	u32  dll_cntl = pi->clock_registers.dll_cntl;
2752 	u32  mclk_pwrmgt_cntl = pi->clock_registers.mclk_pwrmgt_cntl;
2753 	u32  mpll_ad_func_cntl = pi->clock_registers.mpll_ad_func_cntl;
2754 	u32  mpll_dq_func_cntl = pi->clock_registers.mpll_dq_func_cntl;
2755 	u32  mpll_func_cntl = pi->clock_registers.mpll_func_cntl;
2756 	u32  mpll_func_cntl_1 = pi->clock_registers.mpll_func_cntl_1;
2757 	u32  mpll_func_cntl_2 = pi->clock_registers.mpll_func_cntl_2;
2758 	u32  mpll_ss1 = pi->clock_registers.mpll_ss1;
2759 	u32  mpll_ss2 = pi->clock_registers.mpll_ss2;
2760 	struct atom_mpll_param mpll_param;
2761 	int ret;
2762 
2763 	ret = radeon_atom_get_memory_pll_dividers(rdev, memory_clock, strobe_mode, &mpll_param);
2764 	if (ret)
2765 		return ret;
2766 
2767 	mpll_func_cntl &= ~BWCTRL_MASK;
2768 	mpll_func_cntl |= BWCTRL(mpll_param.bwcntl);
2769 
2770 	mpll_func_cntl_1 &= ~(CLKF_MASK | CLKFRAC_MASK | VCO_MODE_MASK);
2771 	mpll_func_cntl_1 |= CLKF(mpll_param.clkf) |
2772 		CLKFRAC(mpll_param.clkfrac) | VCO_MODE(mpll_param.vco_mode);
2773 
2774 	mpll_ad_func_cntl &= ~YCLK_POST_DIV_MASK;
2775 	mpll_ad_func_cntl |= YCLK_POST_DIV(mpll_param.post_div);
2776 
2777 	if (pi->mem_gddr5) {
2778 		mpll_dq_func_cntl &= ~(YCLK_SEL_MASK | YCLK_POST_DIV_MASK);
2779 		mpll_dq_func_cntl |= YCLK_SEL(mpll_param.yclk_sel) |
2780 			YCLK_POST_DIV(mpll_param.post_div);
2781 	}
2782 
2783 	if (pi->caps_mclk_ss_support) {
2784 		struct radeon_atom_ss ss;
2785 		u32 freq_nom;
2786 		u32 tmp;
2787 		u32 reference_clock = rdev->clock.mpll.reference_freq;
2788 
2789 		if (mpll_param.qdr == 1)
2790 			freq_nom = memory_clock * 4 * (1 << mpll_param.post_div);
2791 		else
2792 			freq_nom = memory_clock * 2 * (1 << mpll_param.post_div);
2793 
2794 		tmp = (freq_nom / reference_clock);
2795 		tmp = tmp * tmp;
2796 		if (radeon_atombios_get_asic_ss_info(rdev, &ss,
2797 						     ASIC_INTERNAL_MEMORY_SS, freq_nom)) {
2798 			u32 clks = reference_clock * 5 / ss.rate;
2799 			u32 clkv = (u32)((((131 * ss.percentage * ss.rate) / 100) * tmp) / freq_nom);
2800 
2801 			mpll_ss1 &= ~CLKV_MASK;
2802 			mpll_ss1 |= CLKV(clkv);
2803 
2804 			mpll_ss2 &= ~CLKS_MASK;
2805 			mpll_ss2 |= CLKS(clks);
2806 		}
2807 	}
2808 
2809 	mclk_pwrmgt_cntl &= ~DLL_SPEED_MASK;
2810 	mclk_pwrmgt_cntl |= DLL_SPEED(mpll_param.dll_speed);
2811 
2812 	if (dll_state_on)
2813 		mclk_pwrmgt_cntl |= MRDCK0_PDNB | MRDCK1_PDNB;
2814 	else
2815 		mclk_pwrmgt_cntl &= ~(MRDCK0_PDNB | MRDCK1_PDNB);
2816 
2817 	mclk->MclkFrequency = memory_clock;
2818 	mclk->MpllFuncCntl = mpll_func_cntl;
2819 	mclk->MpllFuncCntl_1 = mpll_func_cntl_1;
2820 	mclk->MpllFuncCntl_2 = mpll_func_cntl_2;
2821 	mclk->MpllAdFuncCntl = mpll_ad_func_cntl;
2822 	mclk->MpllDqFuncCntl = mpll_dq_func_cntl;
2823 	mclk->MclkPwrmgtCntl = mclk_pwrmgt_cntl;
2824 	mclk->DllCntl = dll_cntl;
2825 	mclk->MpllSs1 = mpll_ss1;
2826 	mclk->MpllSs2 = mpll_ss2;
2827 
2828 	return 0;
2829 }
2830 
2831 static int ci_populate_single_memory_level(struct radeon_device *rdev,
2832 					   u32 memory_clock,
2833 					   SMU7_Discrete_MemoryLevel *memory_level)
2834 {
2835 	struct ci_power_info *pi = ci_get_pi(rdev);
2836 	int ret;
2837 	bool dll_state_on;
2838 
2839 	if (rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk.entries) {
2840 		ret = ci_get_dependency_volt_by_clk(rdev,
2841 						    &rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk,
2842 						    memory_clock, &memory_level->MinVddc);
2843 		if (ret)
2844 			return ret;
2845 	}
2846 
2847 	if (rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk.entries) {
2848 		ret = ci_get_dependency_volt_by_clk(rdev,
2849 						    &rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk,
2850 						    memory_clock, &memory_level->MinVddci);
2851 		if (ret)
2852 			return ret;
2853 	}
2854 
2855 	if (rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk.entries) {
2856 		ret = ci_get_dependency_volt_by_clk(rdev,
2857 						    &rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk,
2858 						    memory_clock, &memory_level->MinMvdd);
2859 		if (ret)
2860 			return ret;
2861 	}
2862 
2863 	memory_level->MinVddcPhases = 1;
2864 
2865 	if (pi->vddc_phase_shed_control)
2866 		ci_populate_phase_value_based_on_mclk(rdev,
2867 						      &rdev->pm.dpm.dyn_state.phase_shedding_limits_table,
2868 						      memory_clock,
2869 						      &memory_level->MinVddcPhases);
2870 
2871 	memory_level->EnabledForThrottle = 1;
2872 	memory_level->UpH = 0;
2873 	memory_level->DownH = 100;
2874 	memory_level->VoltageDownH = 0;
2875 	memory_level->ActivityLevel = (u16)pi->mclk_activity_target;
2876 
2877 	memory_level->StutterEnable = false;
2878 	memory_level->StrobeEnable = false;
2879 	memory_level->EdcReadEnable = false;
2880 	memory_level->EdcWriteEnable = false;
2881 	memory_level->RttEnable = false;
2882 
2883 	memory_level->DisplayWatermark = PPSMC_DISPLAY_WATERMARK_LOW;
2884 
2885 	if (pi->mclk_stutter_mode_threshold &&
2886 	    (memory_clock <= pi->mclk_stutter_mode_threshold) &&
2887 	    (pi->uvd_enabled == false) &&
2888 	    (RREG32(DPG_PIPE_STUTTER_CONTROL) & STUTTER_ENABLE) &&
2889 	    (rdev->pm.dpm.new_active_crtc_count <= 2))
2890 		memory_level->StutterEnable = true;
2891 
2892 	if (pi->mclk_strobe_mode_threshold &&
2893 	    (memory_clock <= pi->mclk_strobe_mode_threshold))
2894 		memory_level->StrobeEnable = 1;
2895 
2896 	if (pi->mem_gddr5) {
2897 		memory_level->StrobeRatio =
2898 			si_get_mclk_frequency_ratio(memory_clock, memory_level->StrobeEnable);
2899 		if (pi->mclk_edc_enable_threshold &&
2900 		    (memory_clock > pi->mclk_edc_enable_threshold))
2901 			memory_level->EdcReadEnable = true;
2902 
2903 		if (pi->mclk_edc_wr_enable_threshold &&
2904 		    (memory_clock > pi->mclk_edc_wr_enable_threshold))
2905 			memory_level->EdcWriteEnable = true;
2906 
2907 		if (memory_level->StrobeEnable) {
2908 			if (si_get_mclk_frequency_ratio(memory_clock, true) >=
2909 			    ((RREG32(MC_SEQ_MISC7) >> 16) & 0xf))
2910 				dll_state_on = ((RREG32(MC_SEQ_MISC5) >> 1) & 0x1) ? true : false;
2911 			else
2912 				dll_state_on = ((RREG32(MC_SEQ_MISC6) >> 1) & 0x1) ? true : false;
2913 		} else {
2914 			dll_state_on = pi->dll_default_on;
2915 		}
2916 	} else {
2917 		memory_level->StrobeRatio = si_get_ddr3_mclk_frequency_ratio(memory_clock);
2918 		dll_state_on = ((RREG32(MC_SEQ_MISC5) >> 1) & 0x1) ? true : false;
2919 	}
2920 
2921 	ret = ci_calculate_mclk_params(rdev, memory_clock, memory_level, memory_level->StrobeEnable, dll_state_on);
2922 	if (ret)
2923 		return ret;
2924 
2925 	memory_level->MinVddc = cpu_to_be32(memory_level->MinVddc * VOLTAGE_SCALE);
2926 	memory_level->MinVddcPhases = cpu_to_be32(memory_level->MinVddcPhases);
2927 	memory_level->MinVddci = cpu_to_be32(memory_level->MinVddci * VOLTAGE_SCALE);
2928 	memory_level->MinMvdd = cpu_to_be32(memory_level->MinMvdd * VOLTAGE_SCALE);
2929 
2930 	memory_level->MclkFrequency = cpu_to_be32(memory_level->MclkFrequency);
2931 	memory_level->ActivityLevel = cpu_to_be16(memory_level->ActivityLevel);
2932 	memory_level->MpllFuncCntl = cpu_to_be32(memory_level->MpllFuncCntl);
2933 	memory_level->MpllFuncCntl_1 = cpu_to_be32(memory_level->MpllFuncCntl_1);
2934 	memory_level->MpllFuncCntl_2 = cpu_to_be32(memory_level->MpllFuncCntl_2);
2935 	memory_level->MpllAdFuncCntl = cpu_to_be32(memory_level->MpllAdFuncCntl);
2936 	memory_level->MpllDqFuncCntl = cpu_to_be32(memory_level->MpllDqFuncCntl);
2937 	memory_level->MclkPwrmgtCntl = cpu_to_be32(memory_level->MclkPwrmgtCntl);
2938 	memory_level->DllCntl = cpu_to_be32(memory_level->DllCntl);
2939 	memory_level->MpllSs1 = cpu_to_be32(memory_level->MpllSs1);
2940 	memory_level->MpllSs2 = cpu_to_be32(memory_level->MpllSs2);
2941 
2942 	return 0;
2943 }
2944 
2945 static int ci_populate_smc_acpi_level(struct radeon_device *rdev,
2946 				      SMU7_Discrete_DpmTable *table)
2947 {
2948 	struct ci_power_info *pi = ci_get_pi(rdev);
2949 	struct atom_clock_dividers dividers;
2950 	SMU7_Discrete_VoltageLevel voltage_level;
2951 	u32 spll_func_cntl = pi->clock_registers.cg_spll_func_cntl;
2952 	u32 spll_func_cntl_2 = pi->clock_registers.cg_spll_func_cntl_2;
2953 	u32 dll_cntl = pi->clock_registers.dll_cntl;
2954 	u32 mclk_pwrmgt_cntl = pi->clock_registers.mclk_pwrmgt_cntl;
2955 	int ret;
2956 
2957 	table->ACPILevel.Flags &= ~PPSMC_SWSTATE_FLAG_DC;
2958 
2959 	if (pi->acpi_vddc)
2960 		table->ACPILevel.MinVddc = cpu_to_be32(pi->acpi_vddc * VOLTAGE_SCALE);
2961 	else
2962 		table->ACPILevel.MinVddc = cpu_to_be32(pi->min_vddc_in_pp_table * VOLTAGE_SCALE);
2963 
2964 	table->ACPILevel.MinVddcPhases = pi->vddc_phase_shed_control ? 0 : 1;
2965 
2966 	table->ACPILevel.SclkFrequency = rdev->clock.spll.reference_freq;
2967 
2968 	ret = radeon_atom_get_clock_dividers(rdev,
2969 					     COMPUTE_GPUCLK_INPUT_FLAG_SCLK,
2970 					     table->ACPILevel.SclkFrequency, false, &dividers);
2971 	if (ret)
2972 		return ret;
2973 
2974 	table->ACPILevel.SclkDid = (u8)dividers.post_divider;
2975 	table->ACPILevel.DisplayWatermark = PPSMC_DISPLAY_WATERMARK_LOW;
2976 	table->ACPILevel.DeepSleepDivId = 0;
2977 
2978 	spll_func_cntl &= ~SPLL_PWRON;
2979 	spll_func_cntl |= SPLL_RESET;
2980 
2981 	spll_func_cntl_2 &= ~SCLK_MUX_SEL_MASK;
2982 	spll_func_cntl_2 |= SCLK_MUX_SEL(4);
2983 
2984 	table->ACPILevel.CgSpllFuncCntl = spll_func_cntl;
2985 	table->ACPILevel.CgSpllFuncCntl2 = spll_func_cntl_2;
2986 	table->ACPILevel.CgSpllFuncCntl3 = pi->clock_registers.cg_spll_func_cntl_3;
2987 	table->ACPILevel.CgSpllFuncCntl4 = pi->clock_registers.cg_spll_func_cntl_4;
2988 	table->ACPILevel.SpllSpreadSpectrum = pi->clock_registers.cg_spll_spread_spectrum;
2989 	table->ACPILevel.SpllSpreadSpectrum2 = pi->clock_registers.cg_spll_spread_spectrum_2;
2990 	table->ACPILevel.CcPwrDynRm = 0;
2991 	table->ACPILevel.CcPwrDynRm1 = 0;
2992 
2993 	table->ACPILevel.Flags = cpu_to_be32(table->ACPILevel.Flags);
2994 	table->ACPILevel.MinVddcPhases = cpu_to_be32(table->ACPILevel.MinVddcPhases);
2995 	table->ACPILevel.SclkFrequency = cpu_to_be32(table->ACPILevel.SclkFrequency);
2996 	table->ACPILevel.CgSpllFuncCntl = cpu_to_be32(table->ACPILevel.CgSpllFuncCntl);
2997 	table->ACPILevel.CgSpllFuncCntl2 = cpu_to_be32(table->ACPILevel.CgSpllFuncCntl2);
2998 	table->ACPILevel.CgSpllFuncCntl3 = cpu_to_be32(table->ACPILevel.CgSpllFuncCntl3);
2999 	table->ACPILevel.CgSpllFuncCntl4 = cpu_to_be32(table->ACPILevel.CgSpllFuncCntl4);
3000 	table->ACPILevel.SpllSpreadSpectrum = cpu_to_be32(table->ACPILevel.SpllSpreadSpectrum);
3001 	table->ACPILevel.SpllSpreadSpectrum2 = cpu_to_be32(table->ACPILevel.SpllSpreadSpectrum2);
3002 	table->ACPILevel.CcPwrDynRm = cpu_to_be32(table->ACPILevel.CcPwrDynRm);
3003 	table->ACPILevel.CcPwrDynRm1 = cpu_to_be32(table->ACPILevel.CcPwrDynRm1);
3004 
3005 	table->MemoryACPILevel.MinVddc = table->ACPILevel.MinVddc;
3006 	table->MemoryACPILevel.MinVddcPhases = table->ACPILevel.MinVddcPhases;
3007 
3008 	if (pi->vddci_control != CISLANDS_VOLTAGE_CONTROL_NONE) {
3009 		if (pi->acpi_vddci)
3010 			table->MemoryACPILevel.MinVddci =
3011 				cpu_to_be32(pi->acpi_vddci * VOLTAGE_SCALE);
3012 		else
3013 			table->MemoryACPILevel.MinVddci =
3014 				cpu_to_be32(pi->min_vddci_in_pp_table * VOLTAGE_SCALE);
3015 	}
3016 
3017 	if (ci_populate_mvdd_value(rdev, 0, &voltage_level))
3018 		table->MemoryACPILevel.MinMvdd = 0;
3019 	else
3020 		table->MemoryACPILevel.MinMvdd =
3021 			cpu_to_be32(voltage_level.Voltage * VOLTAGE_SCALE);
3022 
3023 	mclk_pwrmgt_cntl |= MRDCK0_RESET | MRDCK1_RESET;
3024 	mclk_pwrmgt_cntl &= ~(MRDCK0_PDNB | MRDCK1_PDNB);
3025 
3026 	dll_cntl &= ~(MRDCK0_BYPASS | MRDCK1_BYPASS);
3027 
3028 	table->MemoryACPILevel.DllCntl = cpu_to_be32(dll_cntl);
3029 	table->MemoryACPILevel.MclkPwrmgtCntl = cpu_to_be32(mclk_pwrmgt_cntl);
3030 	table->MemoryACPILevel.MpllAdFuncCntl =
3031 		cpu_to_be32(pi->clock_registers.mpll_ad_func_cntl);
3032 	table->MemoryACPILevel.MpllDqFuncCntl =
3033 		cpu_to_be32(pi->clock_registers.mpll_dq_func_cntl);
3034 	table->MemoryACPILevel.MpllFuncCntl =
3035 		cpu_to_be32(pi->clock_registers.mpll_func_cntl);
3036 	table->MemoryACPILevel.MpllFuncCntl_1 =
3037 		cpu_to_be32(pi->clock_registers.mpll_func_cntl_1);
3038 	table->MemoryACPILevel.MpllFuncCntl_2 =
3039 		cpu_to_be32(pi->clock_registers.mpll_func_cntl_2);
3040 	table->MemoryACPILevel.MpllSs1 = cpu_to_be32(pi->clock_registers.mpll_ss1);
3041 	table->MemoryACPILevel.MpllSs2 = cpu_to_be32(pi->clock_registers.mpll_ss2);
3042 
3043 	table->MemoryACPILevel.EnabledForThrottle = 0;
3044 	table->MemoryACPILevel.EnabledForActivity = 0;
3045 	table->MemoryACPILevel.UpH = 0;
3046 	table->MemoryACPILevel.DownH = 100;
3047 	table->MemoryACPILevel.VoltageDownH = 0;
3048 	table->MemoryACPILevel.ActivityLevel =
3049 		cpu_to_be16((u16)pi->mclk_activity_target);
3050 
3051 	table->MemoryACPILevel.StutterEnable = false;
3052 	table->MemoryACPILevel.StrobeEnable = false;
3053 	table->MemoryACPILevel.EdcReadEnable = false;
3054 	table->MemoryACPILevel.EdcWriteEnable = false;
3055 	table->MemoryACPILevel.RttEnable = false;
3056 
3057 	return 0;
3058 }
3059 
3060 
3061 static int ci_enable_ulv(struct radeon_device *rdev, bool enable)
3062 {
3063 	struct ci_power_info *pi = ci_get_pi(rdev);
3064 	struct ci_ulv_parm *ulv = &pi->ulv;
3065 
3066 	if (ulv->supported) {
3067 		if (enable)
3068 			return (ci_send_msg_to_smc(rdev, PPSMC_MSG_EnableULV) == PPSMC_Result_OK) ?
3069 				0 : -EINVAL;
3070 		else
3071 			return (ci_send_msg_to_smc(rdev, PPSMC_MSG_DisableULV) == PPSMC_Result_OK) ?
3072 				0 : -EINVAL;
3073 	}
3074 
3075 	return 0;
3076 }
3077 
3078 static int ci_populate_ulv_level(struct radeon_device *rdev,
3079 				 SMU7_Discrete_Ulv *state)
3080 {
3081 	struct ci_power_info *pi = ci_get_pi(rdev);
3082 	u16 ulv_voltage = rdev->pm.dpm.backbias_response_time;
3083 
3084 	state->CcPwrDynRm = 0;
3085 	state->CcPwrDynRm1 = 0;
3086 
3087 	if (ulv_voltage == 0) {
3088 		pi->ulv.supported = false;
3089 		return 0;
3090 	}
3091 
3092 	if (pi->voltage_control != CISLANDS_VOLTAGE_CONTROL_BY_SVID2) {
3093 		if (ulv_voltage > rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[0].v)
3094 			state->VddcOffset = 0;
3095 		else
3096 			state->VddcOffset =
3097 				rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[0].v - ulv_voltage;
3098 	} else {
3099 		if (ulv_voltage > rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[0].v)
3100 			state->VddcOffsetVid = 0;
3101 		else
3102 			state->VddcOffsetVid = (u8)
3103 				((rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[0].v - ulv_voltage) *
3104 				 VOLTAGE_VID_OFFSET_SCALE2 / VOLTAGE_VID_OFFSET_SCALE1);
3105 	}
3106 	state->VddcPhase = pi->vddc_phase_shed_control ? 0 : 1;
3107 
3108 	state->CcPwrDynRm = cpu_to_be32(state->CcPwrDynRm);
3109 	state->CcPwrDynRm1 = cpu_to_be32(state->CcPwrDynRm1);
3110 	state->VddcOffset = cpu_to_be16(state->VddcOffset);
3111 
3112 	return 0;
3113 }
3114 
3115 static int ci_calculate_sclk_params(struct radeon_device *rdev,
3116 				    u32 engine_clock,
3117 				    SMU7_Discrete_GraphicsLevel *sclk)
3118 {
3119 	struct ci_power_info *pi = ci_get_pi(rdev);
3120 	struct atom_clock_dividers dividers;
3121 	u32 spll_func_cntl_3 = pi->clock_registers.cg_spll_func_cntl_3;
3122 	u32 spll_func_cntl_4 = pi->clock_registers.cg_spll_func_cntl_4;
3123 	u32 cg_spll_spread_spectrum = pi->clock_registers.cg_spll_spread_spectrum;
3124 	u32 cg_spll_spread_spectrum_2 = pi->clock_registers.cg_spll_spread_spectrum_2;
3125 	u32 reference_clock = rdev->clock.spll.reference_freq;
3126 	u32 reference_divider;
3127 	u32 fbdiv;
3128 	int ret;
3129 
3130 	ret = radeon_atom_get_clock_dividers(rdev,
3131 					     COMPUTE_GPUCLK_INPUT_FLAG_SCLK,
3132 					     engine_clock, false, &dividers);
3133 	if (ret)
3134 		return ret;
3135 
3136 	reference_divider = 1 + dividers.ref_div;
3137 	fbdiv = dividers.fb_div & 0x3FFFFFF;
3138 
3139 	spll_func_cntl_3 &= ~SPLL_FB_DIV_MASK;
3140 	spll_func_cntl_3 |= SPLL_FB_DIV(fbdiv);
3141 	spll_func_cntl_3 |= SPLL_DITHEN;
3142 
3143 	if (pi->caps_sclk_ss_support) {
3144 		struct radeon_atom_ss ss;
3145 		u32 vco_freq = engine_clock * dividers.post_div;
3146 
3147 		if (radeon_atombios_get_asic_ss_info(rdev, &ss,
3148 						     ASIC_INTERNAL_ENGINE_SS, vco_freq)) {
3149 			u32 clk_s = reference_clock * 5 / (reference_divider * ss.rate);
3150 			u32 clk_v = 4 * ss.percentage * fbdiv / (clk_s * 10000);
3151 
3152 			cg_spll_spread_spectrum &= ~CLK_S_MASK;
3153 			cg_spll_spread_spectrum |= CLK_S(clk_s);
3154 			cg_spll_spread_spectrum |= SSEN;
3155 
3156 			cg_spll_spread_spectrum_2 &= ~CLK_V_MASK;
3157 			cg_spll_spread_spectrum_2 |= CLK_V(clk_v);
3158 		}
3159 	}
3160 
3161 	sclk->SclkFrequency = engine_clock;
3162 	sclk->CgSpllFuncCntl3 = spll_func_cntl_3;
3163 	sclk->CgSpllFuncCntl4 = spll_func_cntl_4;
3164 	sclk->SpllSpreadSpectrum = cg_spll_spread_spectrum;
3165 	sclk->SpllSpreadSpectrum2  = cg_spll_spread_spectrum_2;
3166 	sclk->SclkDid = (u8)dividers.post_divider;
3167 
3168 	return 0;
3169 }
3170 
3171 static int ci_populate_single_graphic_level(struct radeon_device *rdev,
3172 					    u32 engine_clock,
3173 					    u16 sclk_activity_level_t,
3174 					    SMU7_Discrete_GraphicsLevel *graphic_level)
3175 {
3176 	struct ci_power_info *pi = ci_get_pi(rdev);
3177 	int ret;
3178 
3179 	ret = ci_calculate_sclk_params(rdev, engine_clock, graphic_level);
3180 	if (ret)
3181 		return ret;
3182 
3183 	ret = ci_get_dependency_volt_by_clk(rdev,
3184 					    &rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk,
3185 					    engine_clock, &graphic_level->MinVddc);
3186 	if (ret)
3187 		return ret;
3188 
3189 	graphic_level->SclkFrequency = engine_clock;
3190 
3191 	graphic_level->Flags =  0;
3192 	graphic_level->MinVddcPhases = 1;
3193 
3194 	if (pi->vddc_phase_shed_control)
3195 		ci_populate_phase_value_based_on_sclk(rdev,
3196 						      &rdev->pm.dpm.dyn_state.phase_shedding_limits_table,
3197 						      engine_clock,
3198 						      &graphic_level->MinVddcPhases);
3199 
3200 	graphic_level->ActivityLevel = sclk_activity_level_t;
3201 
3202 	graphic_level->CcPwrDynRm = 0;
3203 	graphic_level->CcPwrDynRm1 = 0;
3204 	graphic_level->EnabledForThrottle = 1;
3205 	graphic_level->UpH = 0;
3206 	graphic_level->DownH = 0;
3207 	graphic_level->VoltageDownH = 0;
3208 	graphic_level->PowerThrottle = 0;
3209 
3210 	if (pi->caps_sclk_ds)
3211 		graphic_level->DeepSleepDivId = ci_get_sleep_divider_id_from_clock(rdev,
3212 										   engine_clock,
3213 										   CISLAND_MINIMUM_ENGINE_CLOCK);
3214 
3215 	graphic_level->DisplayWatermark = PPSMC_DISPLAY_WATERMARK_LOW;
3216 
3217 	graphic_level->Flags = cpu_to_be32(graphic_level->Flags);
3218 	graphic_level->MinVddc = cpu_to_be32(graphic_level->MinVddc * VOLTAGE_SCALE);
3219 	graphic_level->MinVddcPhases = cpu_to_be32(graphic_level->MinVddcPhases);
3220 	graphic_level->SclkFrequency = cpu_to_be32(graphic_level->SclkFrequency);
3221 	graphic_level->ActivityLevel = cpu_to_be16(graphic_level->ActivityLevel);
3222 	graphic_level->CgSpllFuncCntl3 = cpu_to_be32(graphic_level->CgSpllFuncCntl3);
3223 	graphic_level->CgSpllFuncCntl4 = cpu_to_be32(graphic_level->CgSpllFuncCntl4);
3224 	graphic_level->SpllSpreadSpectrum = cpu_to_be32(graphic_level->SpllSpreadSpectrum);
3225 	graphic_level->SpllSpreadSpectrum2 = cpu_to_be32(graphic_level->SpllSpreadSpectrum2);
3226 	graphic_level->CcPwrDynRm = cpu_to_be32(graphic_level->CcPwrDynRm);
3227 	graphic_level->CcPwrDynRm1 = cpu_to_be32(graphic_level->CcPwrDynRm1);
3228 
3229 	return 0;
3230 }
3231 
3232 static int ci_populate_all_graphic_levels(struct radeon_device *rdev)
3233 {
3234 	struct ci_power_info *pi = ci_get_pi(rdev);
3235 	struct ci_dpm_table *dpm_table = &pi->dpm_table;
3236 	u32 level_array_address = pi->dpm_table_start +
3237 		offsetof(SMU7_Discrete_DpmTable, GraphicsLevel);
3238 	u32 level_array_size = sizeof(SMU7_Discrete_GraphicsLevel) *
3239 		SMU7_MAX_LEVELS_GRAPHICS;
3240 	SMU7_Discrete_GraphicsLevel *levels = pi->smc_state_table.GraphicsLevel;
3241 	u32 i, ret;
3242 
3243 	memset(levels, 0, level_array_size);
3244 
3245 	for (i = 0; i < dpm_table->sclk_table.count; i++) {
3246 		ret = ci_populate_single_graphic_level(rdev,
3247 						       dpm_table->sclk_table.dpm_levels[i].value,
3248 						       (u16)pi->activity_target[i],
3249 						       &pi->smc_state_table.GraphicsLevel[i]);
3250 		if (ret)
3251 			return ret;
3252 		if (i > 1)
3253 			pi->smc_state_table.GraphicsLevel[i].DeepSleepDivId = 0;
3254 		if (i == (dpm_table->sclk_table.count - 1))
3255 			pi->smc_state_table.GraphicsLevel[i].DisplayWatermark =
3256 				PPSMC_DISPLAY_WATERMARK_HIGH;
3257 	}
3258 	pi->smc_state_table.GraphicsLevel[0].EnabledForActivity = 1;
3259 
3260 	pi->smc_state_table.GraphicsDpmLevelCount = (u8)dpm_table->sclk_table.count;
3261 	pi->dpm_level_enable_mask.sclk_dpm_enable_mask =
3262 		ci_get_dpm_level_enable_mask_value(&dpm_table->sclk_table);
3263 
3264 	ret = ci_copy_bytes_to_smc(rdev, level_array_address,
3265 				   (u8 *)levels, level_array_size,
3266 				   pi->sram_end);
3267 	if (ret)
3268 		return ret;
3269 
3270 	return 0;
3271 }
3272 
3273 static int ci_populate_ulv_state(struct radeon_device *rdev,
3274 				 SMU7_Discrete_Ulv *ulv_level)
3275 {
3276 	return ci_populate_ulv_level(rdev, ulv_level);
3277 }
3278 
3279 static int ci_populate_all_memory_levels(struct radeon_device *rdev)
3280 {
3281 	struct ci_power_info *pi = ci_get_pi(rdev);
3282 	struct ci_dpm_table *dpm_table = &pi->dpm_table;
3283 	u32 level_array_address = pi->dpm_table_start +
3284 		offsetof(SMU7_Discrete_DpmTable, MemoryLevel);
3285 	u32 level_array_size = sizeof(SMU7_Discrete_MemoryLevel) *
3286 		SMU7_MAX_LEVELS_MEMORY;
3287 	SMU7_Discrete_MemoryLevel *levels = pi->smc_state_table.MemoryLevel;
3288 	u32 i, ret;
3289 
3290 	memset(levels, 0, level_array_size);
3291 
3292 	for (i = 0; i < dpm_table->mclk_table.count; i++) {
3293 		if (dpm_table->mclk_table.dpm_levels[i].value == 0)
3294 			return -EINVAL;
3295 		ret = ci_populate_single_memory_level(rdev,
3296 						      dpm_table->mclk_table.dpm_levels[i].value,
3297 						      &pi->smc_state_table.MemoryLevel[i]);
3298 		if (ret)
3299 			return ret;
3300 	}
3301 
3302 	pi->smc_state_table.MemoryLevel[0].EnabledForActivity = 1;
3303 
3304 	if ((dpm_table->mclk_table.count >= 2) &&
3305 	    ((rdev->pdev->device == 0x67B0) || (rdev->pdev->device == 0x67B1))) {
3306 		pi->smc_state_table.MemoryLevel[1].MinVddc =
3307 			pi->smc_state_table.MemoryLevel[0].MinVddc;
3308 		pi->smc_state_table.MemoryLevel[1].MinVddcPhases =
3309 			pi->smc_state_table.MemoryLevel[0].MinVddcPhases;
3310 	}
3311 
3312 	pi->smc_state_table.MemoryLevel[0].ActivityLevel = cpu_to_be16(0x1F);
3313 
3314 	pi->smc_state_table.MemoryDpmLevelCount = (u8)dpm_table->mclk_table.count;
3315 	pi->dpm_level_enable_mask.mclk_dpm_enable_mask =
3316 		ci_get_dpm_level_enable_mask_value(&dpm_table->mclk_table);
3317 
3318 	pi->smc_state_table.MemoryLevel[dpm_table->mclk_table.count - 1].DisplayWatermark =
3319 		PPSMC_DISPLAY_WATERMARK_HIGH;
3320 
3321 	ret = ci_copy_bytes_to_smc(rdev, level_array_address,
3322 				   (u8 *)levels, level_array_size,
3323 				   pi->sram_end);
3324 	if (ret)
3325 		return ret;
3326 
3327 	return 0;
3328 }
3329 
3330 static void ci_reset_single_dpm_table(struct radeon_device *rdev,
3331 				      struct ci_single_dpm_table *dpm_table,
3332 				      u32 count)
3333 {
3334 	u32 i;
3335 
3336 	dpm_table->count = count;
3337 	for (i = 0; i < MAX_REGULAR_DPM_NUMBER; i++)
3338 		dpm_table->dpm_levels[i].enabled = false;
3339 }
3340 
3341 static void ci_setup_pcie_table_entry(struct ci_single_dpm_table *dpm_table,
3342 				      u32 index, u32 pcie_gen, u32 pcie_lanes)
3343 {
3344 	dpm_table->dpm_levels[index].value = pcie_gen;
3345 	dpm_table->dpm_levels[index].param1 = pcie_lanes;
3346 	dpm_table->dpm_levels[index].enabled = true;
3347 }
3348 
3349 static int ci_setup_default_pcie_tables(struct radeon_device *rdev)
3350 {
3351 	struct ci_power_info *pi = ci_get_pi(rdev);
3352 
3353 	if (!pi->use_pcie_performance_levels && !pi->use_pcie_powersaving_levels)
3354 		return -EINVAL;
3355 
3356 	if (pi->use_pcie_performance_levels && !pi->use_pcie_powersaving_levels) {
3357 		pi->pcie_gen_powersaving = pi->pcie_gen_performance;
3358 		pi->pcie_lane_powersaving = pi->pcie_lane_performance;
3359 	} else if (!pi->use_pcie_performance_levels && pi->use_pcie_powersaving_levels) {
3360 		pi->pcie_gen_performance = pi->pcie_gen_powersaving;
3361 		pi->pcie_lane_performance = pi->pcie_lane_powersaving;
3362 	}
3363 
3364 	ci_reset_single_dpm_table(rdev,
3365 				  &pi->dpm_table.pcie_speed_table,
3366 				  SMU7_MAX_LEVELS_LINK);
3367 
3368 	if (rdev->family == CHIP_BONAIRE)
3369 		ci_setup_pcie_table_entry(&pi->dpm_table.pcie_speed_table, 0,
3370 					  pi->pcie_gen_powersaving.min,
3371 					  pi->pcie_lane_powersaving.max);
3372 	else
3373 		ci_setup_pcie_table_entry(&pi->dpm_table.pcie_speed_table, 0,
3374 					  pi->pcie_gen_powersaving.min,
3375 					  pi->pcie_lane_powersaving.min);
3376 	ci_setup_pcie_table_entry(&pi->dpm_table.pcie_speed_table, 1,
3377 				  pi->pcie_gen_performance.min,
3378 				  pi->pcie_lane_performance.min);
3379 	ci_setup_pcie_table_entry(&pi->dpm_table.pcie_speed_table, 2,
3380 				  pi->pcie_gen_powersaving.min,
3381 				  pi->pcie_lane_powersaving.max);
3382 	ci_setup_pcie_table_entry(&pi->dpm_table.pcie_speed_table, 3,
3383 				  pi->pcie_gen_performance.min,
3384 				  pi->pcie_lane_performance.max);
3385 	ci_setup_pcie_table_entry(&pi->dpm_table.pcie_speed_table, 4,
3386 				  pi->pcie_gen_powersaving.max,
3387 				  pi->pcie_lane_powersaving.max);
3388 	ci_setup_pcie_table_entry(&pi->dpm_table.pcie_speed_table, 5,
3389 				  pi->pcie_gen_performance.max,
3390 				  pi->pcie_lane_performance.max);
3391 
3392 	pi->dpm_table.pcie_speed_table.count = 6;
3393 
3394 	return 0;
3395 }
3396 
3397 static int ci_setup_default_dpm_tables(struct radeon_device *rdev)
3398 {
3399 	struct ci_power_info *pi = ci_get_pi(rdev);
3400 	struct radeon_clock_voltage_dependency_table *allowed_sclk_vddc_table =
3401 		&rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
3402 	struct radeon_clock_voltage_dependency_table *allowed_mclk_table =
3403 		&rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk;
3404 	struct radeon_cac_leakage_table *std_voltage_table =
3405 		&rdev->pm.dpm.dyn_state.cac_leakage_table;
3406 	u32 i;
3407 
3408 	if (allowed_sclk_vddc_table->count < 1)
3409 		return -EINVAL;
3410 	if (allowed_mclk_table->count < 1)
3411 		return -EINVAL;
3412 
3413 	memset(&pi->dpm_table, 0, sizeof(struct ci_dpm_table));
3414 
3415 	ci_reset_single_dpm_table(rdev,
3416 				  &pi->dpm_table.sclk_table,
3417 				  SMU7_MAX_LEVELS_GRAPHICS);
3418 	ci_reset_single_dpm_table(rdev,
3419 				  &pi->dpm_table.mclk_table,
3420 				  SMU7_MAX_LEVELS_MEMORY);
3421 	ci_reset_single_dpm_table(rdev,
3422 				  &pi->dpm_table.vddc_table,
3423 				  SMU7_MAX_LEVELS_VDDC);
3424 	ci_reset_single_dpm_table(rdev,
3425 				  &pi->dpm_table.vddci_table,
3426 				  SMU7_MAX_LEVELS_VDDCI);
3427 	ci_reset_single_dpm_table(rdev,
3428 				  &pi->dpm_table.mvdd_table,
3429 				  SMU7_MAX_LEVELS_MVDD);
3430 
3431 	pi->dpm_table.sclk_table.count = 0;
3432 	for (i = 0; i < allowed_sclk_vddc_table->count; i++) {
3433 		if ((i == 0) ||
3434 		    (pi->dpm_table.sclk_table.dpm_levels[pi->dpm_table.sclk_table.count-1].value !=
3435 		     allowed_sclk_vddc_table->entries[i].clk)) {
3436 			pi->dpm_table.sclk_table.dpm_levels[pi->dpm_table.sclk_table.count].value =
3437 				allowed_sclk_vddc_table->entries[i].clk;
3438 			pi->dpm_table.sclk_table.dpm_levels[pi->dpm_table.sclk_table.count].enabled =
3439 				(i == 0) ? true : false;
3440 			pi->dpm_table.sclk_table.count++;
3441 		}
3442 	}
3443 
3444 	pi->dpm_table.mclk_table.count = 0;
3445 	for (i = 0; i < allowed_mclk_table->count; i++) {
3446 		if ((i == 0) ||
3447 		    (pi->dpm_table.mclk_table.dpm_levels[pi->dpm_table.mclk_table.count-1].value !=
3448 		     allowed_mclk_table->entries[i].clk)) {
3449 			pi->dpm_table.mclk_table.dpm_levels[pi->dpm_table.mclk_table.count].value =
3450 				allowed_mclk_table->entries[i].clk;
3451 			pi->dpm_table.mclk_table.dpm_levels[pi->dpm_table.mclk_table.count].enabled =
3452 				(i == 0) ? true : false;
3453 			pi->dpm_table.mclk_table.count++;
3454 		}
3455 	}
3456 
3457 	for (i = 0; i < allowed_sclk_vddc_table->count; i++) {
3458 		pi->dpm_table.vddc_table.dpm_levels[i].value =
3459 			allowed_sclk_vddc_table->entries[i].v;
3460 		pi->dpm_table.vddc_table.dpm_levels[i].param1 =
3461 			std_voltage_table->entries[i].leakage;
3462 		pi->dpm_table.vddc_table.dpm_levels[i].enabled = true;
3463 	}
3464 	pi->dpm_table.vddc_table.count = allowed_sclk_vddc_table->count;
3465 
3466 	allowed_mclk_table = &rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk;
3467 	for (i = 0; i < allowed_mclk_table->count; i++) {
3468 		pi->dpm_table.vddci_table.dpm_levels[i].value =
3469 			allowed_mclk_table->entries[i].v;
3470 		pi->dpm_table.vddci_table.dpm_levels[i].enabled = true;
3471 	}
3472 	pi->dpm_table.vddci_table.count = allowed_mclk_table->count;
3473 
3474 	allowed_mclk_table = &rdev->pm.dpm.dyn_state.mvdd_dependency_on_mclk;
3475 	for (i = 0; i < allowed_mclk_table->count; i++) {
3476 		pi->dpm_table.mvdd_table.dpm_levels[i].value =
3477 			allowed_mclk_table->entries[i].v;
3478 		pi->dpm_table.mvdd_table.dpm_levels[i].enabled = true;
3479 	}
3480 	pi->dpm_table.mvdd_table.count = allowed_mclk_table->count;
3481 
3482 	ci_setup_default_pcie_tables(rdev);
3483 
3484 	return 0;
3485 }
3486 
3487 static int ci_find_boot_level(struct ci_single_dpm_table *table,
3488 			      u32 value, u32 *boot_level)
3489 {
3490 	u32 i;
3491 	int ret = -EINVAL;
3492 
3493 	for (i = 0; i < table->count; i++) {
3494 		if (value == table->dpm_levels[i].value) {
3495 			*boot_level = i;
3496 			ret = 0;
3497 		}
3498 	}
3499 
3500 	return ret;
3501 }
3502 
3503 static int ci_init_smc_table(struct radeon_device *rdev)
3504 {
3505 	struct ci_power_info *pi = ci_get_pi(rdev);
3506 	struct ci_ulv_parm *ulv = &pi->ulv;
3507 	struct radeon_ps *radeon_boot_state = rdev->pm.dpm.boot_ps;
3508 	SMU7_Discrete_DpmTable *table = &pi->smc_state_table;
3509 	int ret;
3510 
3511 	ret = ci_setup_default_dpm_tables(rdev);
3512 	if (ret)
3513 		return ret;
3514 
3515 	if (pi->voltage_control != CISLANDS_VOLTAGE_CONTROL_NONE)
3516 		ci_populate_smc_voltage_tables(rdev, table);
3517 
3518 	ci_init_fps_limits(rdev);
3519 
3520 	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_HARDWAREDC)
3521 		table->SystemFlags |= PPSMC_SYSTEMFLAG_GPIO_DC;
3522 
3523 	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_STEPVDDC)
3524 		table->SystemFlags |= PPSMC_SYSTEMFLAG_STEPVDDC;
3525 
3526 	if (pi->mem_gddr5)
3527 		table->SystemFlags |= PPSMC_SYSTEMFLAG_GDDR5;
3528 
3529 	if (ulv->supported) {
3530 		ret = ci_populate_ulv_state(rdev, &pi->smc_state_table.Ulv);
3531 		if (ret)
3532 			return ret;
3533 		WREG32_SMC(CG_ULV_PARAMETER, ulv->cg_ulv_parameter);
3534 	}
3535 
3536 	ret = ci_populate_all_graphic_levels(rdev);
3537 	if (ret)
3538 		return ret;
3539 
3540 	ret = ci_populate_all_memory_levels(rdev);
3541 	if (ret)
3542 		return ret;
3543 
3544 	ci_populate_smc_link_level(rdev, table);
3545 
3546 	ret = ci_populate_smc_acpi_level(rdev, table);
3547 	if (ret)
3548 		return ret;
3549 
3550 	ret = ci_populate_smc_vce_level(rdev, table);
3551 	if (ret)
3552 		return ret;
3553 
3554 	ret = ci_populate_smc_acp_level(rdev, table);
3555 	if (ret)
3556 		return ret;
3557 
3558 	ret = ci_populate_smc_samu_level(rdev, table);
3559 	if (ret)
3560 		return ret;
3561 
3562 	ret = ci_do_program_memory_timing_parameters(rdev);
3563 	if (ret)
3564 		return ret;
3565 
3566 	ret = ci_populate_smc_uvd_level(rdev, table);
3567 	if (ret)
3568 		return ret;
3569 
3570 	table->UvdBootLevel  = 0;
3571 	table->VceBootLevel  = 0;
3572 	table->AcpBootLevel  = 0;
3573 	table->SamuBootLevel  = 0;
3574 	table->GraphicsBootLevel  = 0;
3575 	table->MemoryBootLevel  = 0;
3576 
3577 	ret = ci_find_boot_level(&pi->dpm_table.sclk_table,
3578 				 pi->vbios_boot_state.sclk_bootup_value,
3579 				 (u32 *)&pi->smc_state_table.GraphicsBootLevel);
3580 
3581 	ret = ci_find_boot_level(&pi->dpm_table.mclk_table,
3582 				 pi->vbios_boot_state.mclk_bootup_value,
3583 				 (u32 *)&pi->smc_state_table.MemoryBootLevel);
3584 
3585 	table->BootVddc = pi->vbios_boot_state.vddc_bootup_value;
3586 	table->BootVddci = pi->vbios_boot_state.vddci_bootup_value;
3587 	table->BootMVdd = pi->vbios_boot_state.mvdd_bootup_value;
3588 
3589 	ci_populate_smc_initial_state(rdev, radeon_boot_state);
3590 
3591 	ret = ci_populate_bapm_parameters_in_dpm_table(rdev);
3592 	if (ret)
3593 		return ret;
3594 
3595 	table->UVDInterval = 1;
3596 	table->VCEInterval = 1;
3597 	table->ACPInterval = 1;
3598 	table->SAMUInterval = 1;
3599 	table->GraphicsVoltageChangeEnable = 1;
3600 	table->GraphicsThermThrottleEnable = 1;
3601 	table->GraphicsInterval = 1;
3602 	table->VoltageInterval = 1;
3603 	table->ThermalInterval = 1;
3604 	table->TemperatureLimitHigh = (u16)((pi->thermal_temp_setting.temperature_high *
3605 					     CISLANDS_Q88_FORMAT_CONVERSION_UNIT) / 1000);
3606 	table->TemperatureLimitLow = (u16)((pi->thermal_temp_setting.temperature_low *
3607 					    CISLANDS_Q88_FORMAT_CONVERSION_UNIT) / 1000);
3608 	table->MemoryVoltageChangeEnable = 1;
3609 	table->MemoryInterval = 1;
3610 	table->VoltageResponseTime = 0;
3611 	table->VddcVddciDelta = 4000;
3612 	table->PhaseResponseTime = 0;
3613 	table->MemoryThermThrottleEnable = 1;
3614 	table->PCIeBootLinkLevel = pi->dpm_table.pcie_speed_table.count - 1;
3615 	table->PCIeGenInterval = 1;
3616 	if (pi->voltage_control == CISLANDS_VOLTAGE_CONTROL_BY_SVID2)
3617 		table->SVI2Enable  = 1;
3618 	else
3619 		table->SVI2Enable  = 0;
3620 
3621 	table->ThermGpio = 17;
3622 	table->SclkStepSize = 0x4000;
3623 
3624 	table->SystemFlags = cpu_to_be32(table->SystemFlags);
3625 	table->SmioMaskVddcVid = cpu_to_be32(table->SmioMaskVddcVid);
3626 	table->SmioMaskVddcPhase = cpu_to_be32(table->SmioMaskVddcPhase);
3627 	table->SmioMaskVddciVid = cpu_to_be32(table->SmioMaskVddciVid);
3628 	table->SmioMaskMvddVid = cpu_to_be32(table->SmioMaskMvddVid);
3629 	table->SclkStepSize = cpu_to_be32(table->SclkStepSize);
3630 	table->TemperatureLimitHigh = cpu_to_be16(table->TemperatureLimitHigh);
3631 	table->TemperatureLimitLow = cpu_to_be16(table->TemperatureLimitLow);
3632 	table->VddcVddciDelta = cpu_to_be16(table->VddcVddciDelta);
3633 	table->VoltageResponseTime = cpu_to_be16(table->VoltageResponseTime);
3634 	table->PhaseResponseTime = cpu_to_be16(table->PhaseResponseTime);
3635 	table->BootVddc = cpu_to_be16(table->BootVddc * VOLTAGE_SCALE);
3636 	table->BootVddci = cpu_to_be16(table->BootVddci * VOLTAGE_SCALE);
3637 	table->BootMVdd = cpu_to_be16(table->BootMVdd * VOLTAGE_SCALE);
3638 
3639 	ret = ci_copy_bytes_to_smc(rdev,
3640 				   pi->dpm_table_start +
3641 				   offsetof(SMU7_Discrete_DpmTable, SystemFlags),
3642 				   (u8 *)&table->SystemFlags,
3643 				   sizeof(SMU7_Discrete_DpmTable) - 3 * sizeof(SMU7_PIDController),
3644 				   pi->sram_end);
3645 	if (ret)
3646 		return ret;
3647 
3648 	return 0;
3649 }
3650 
3651 static void ci_trim_single_dpm_states(struct radeon_device *rdev,
3652 				      struct ci_single_dpm_table *dpm_table,
3653 				      u32 low_limit, u32 high_limit)
3654 {
3655 	u32 i;
3656 
3657 	for (i = 0; i < dpm_table->count; i++) {
3658 		if ((dpm_table->dpm_levels[i].value < low_limit) ||
3659 		    (dpm_table->dpm_levels[i].value > high_limit))
3660 			dpm_table->dpm_levels[i].enabled = false;
3661 		else
3662 			dpm_table->dpm_levels[i].enabled = true;
3663 	}
3664 }
3665 
3666 static void ci_trim_pcie_dpm_states(struct radeon_device *rdev,
3667 				    u32 speed_low, u32 lanes_low,
3668 				    u32 speed_high, u32 lanes_high)
3669 {
3670 	struct ci_power_info *pi = ci_get_pi(rdev);
3671 	struct ci_single_dpm_table *pcie_table = &pi->dpm_table.pcie_speed_table;
3672 	u32 i, j;
3673 
3674 	for (i = 0; i < pcie_table->count; i++) {
3675 		if ((pcie_table->dpm_levels[i].value < speed_low) ||
3676 		    (pcie_table->dpm_levels[i].param1 < lanes_low) ||
3677 		    (pcie_table->dpm_levels[i].value > speed_high) ||
3678 		    (pcie_table->dpm_levels[i].param1 > lanes_high))
3679 			pcie_table->dpm_levels[i].enabled = false;
3680 		else
3681 			pcie_table->dpm_levels[i].enabled = true;
3682 	}
3683 
3684 	for (i = 0; i < pcie_table->count; i++) {
3685 		if (pcie_table->dpm_levels[i].enabled) {
3686 			for (j = i + 1; j < pcie_table->count; j++) {
3687 				if (pcie_table->dpm_levels[j].enabled) {
3688 					if ((pcie_table->dpm_levels[i].value == pcie_table->dpm_levels[j].value) &&
3689 					    (pcie_table->dpm_levels[i].param1 == pcie_table->dpm_levels[j].param1))
3690 						pcie_table->dpm_levels[j].enabled = false;
3691 				}
3692 			}
3693 		}
3694 	}
3695 }
3696 
3697 static int ci_trim_dpm_states(struct radeon_device *rdev,
3698 			      struct radeon_ps *radeon_state)
3699 {
3700 	struct ci_ps *state = ci_get_ps(radeon_state);
3701 	struct ci_power_info *pi = ci_get_pi(rdev);
3702 	u32 high_limit_count;
3703 
3704 	if (state->performance_level_count < 1)
3705 		return -EINVAL;
3706 
3707 	if (state->performance_level_count == 1)
3708 		high_limit_count = 0;
3709 	else
3710 		high_limit_count = 1;
3711 
3712 	ci_trim_single_dpm_states(rdev,
3713 				  &pi->dpm_table.sclk_table,
3714 				  state->performance_levels[0].sclk,
3715 				  state->performance_levels[high_limit_count].sclk);
3716 
3717 	ci_trim_single_dpm_states(rdev,
3718 				  &pi->dpm_table.mclk_table,
3719 				  state->performance_levels[0].mclk,
3720 				  state->performance_levels[high_limit_count].mclk);
3721 
3722 	ci_trim_pcie_dpm_states(rdev,
3723 				state->performance_levels[0].pcie_gen,
3724 				state->performance_levels[0].pcie_lane,
3725 				state->performance_levels[high_limit_count].pcie_gen,
3726 				state->performance_levels[high_limit_count].pcie_lane);
3727 
3728 	return 0;
3729 }
3730 
3731 static int ci_apply_disp_minimum_voltage_request(struct radeon_device *rdev)
3732 {
3733 	struct radeon_clock_voltage_dependency_table *disp_voltage_table =
3734 		&rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk;
3735 	struct radeon_clock_voltage_dependency_table *vddc_table =
3736 		&rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
3737 	u32 requested_voltage = 0;
3738 	u32 i;
3739 
3740 	if (disp_voltage_table == NULL)
3741 		return -EINVAL;
3742 	if (!disp_voltage_table->count)
3743 		return -EINVAL;
3744 
3745 	for (i = 0; i < disp_voltage_table->count; i++) {
3746 		if (rdev->clock.current_dispclk == disp_voltage_table->entries[i].clk)
3747 			requested_voltage = disp_voltage_table->entries[i].v;
3748 	}
3749 
3750 	for (i = 0; i < vddc_table->count; i++) {
3751 		if (requested_voltage <= vddc_table->entries[i].v) {
3752 			requested_voltage = vddc_table->entries[i].v;
3753 			return (ci_send_msg_to_smc_with_parameter(rdev,
3754 								  PPSMC_MSG_VddC_Request,
3755 								  requested_voltage * VOLTAGE_SCALE) == PPSMC_Result_OK) ?
3756 				0 : -EINVAL;
3757 		}
3758 	}
3759 
3760 	return -EINVAL;
3761 }
3762 
3763 static int ci_upload_dpm_level_enable_mask(struct radeon_device *rdev)
3764 {
3765 	struct ci_power_info *pi = ci_get_pi(rdev);
3766 	PPSMC_Result result;
3767 
3768 	ci_apply_disp_minimum_voltage_request(rdev);
3769 
3770 	if (!pi->sclk_dpm_key_disabled) {
3771 		if (pi->dpm_level_enable_mask.sclk_dpm_enable_mask) {
3772 			result = ci_send_msg_to_smc_with_parameter(rdev,
3773 								   PPSMC_MSG_SCLKDPM_SetEnabledMask,
3774 								   pi->dpm_level_enable_mask.sclk_dpm_enable_mask);
3775 			if (result != PPSMC_Result_OK)
3776 				return -EINVAL;
3777 		}
3778 	}
3779 
3780 	if (!pi->mclk_dpm_key_disabled) {
3781 		if (pi->dpm_level_enable_mask.mclk_dpm_enable_mask) {
3782 			result = ci_send_msg_to_smc_with_parameter(rdev,
3783 								   PPSMC_MSG_MCLKDPM_SetEnabledMask,
3784 								   pi->dpm_level_enable_mask.mclk_dpm_enable_mask);
3785 			if (result != PPSMC_Result_OK)
3786 				return -EINVAL;
3787 		}
3788 	}
3789 #if 0
3790 	if (!pi->pcie_dpm_key_disabled) {
3791 		if (pi->dpm_level_enable_mask.pcie_dpm_enable_mask) {
3792 			result = ci_send_msg_to_smc_with_parameter(rdev,
3793 								   PPSMC_MSG_PCIeDPM_SetEnabledMask,
3794 								   pi->dpm_level_enable_mask.pcie_dpm_enable_mask);
3795 			if (result != PPSMC_Result_OK)
3796 				return -EINVAL;
3797 		}
3798 	}
3799 #endif
3800 	return 0;
3801 }
3802 
3803 static void ci_find_dpm_states_clocks_in_dpm_table(struct radeon_device *rdev,
3804 						   struct radeon_ps *radeon_state)
3805 {
3806 	struct ci_power_info *pi = ci_get_pi(rdev);
3807 	struct ci_ps *state = ci_get_ps(radeon_state);
3808 	struct ci_single_dpm_table *sclk_table = &pi->dpm_table.sclk_table;
3809 	u32 sclk = state->performance_levels[state->performance_level_count-1].sclk;
3810 	struct ci_single_dpm_table *mclk_table = &pi->dpm_table.mclk_table;
3811 	u32 mclk = state->performance_levels[state->performance_level_count-1].mclk;
3812 	u32 i;
3813 
3814 	pi->need_update_smu7_dpm_table = 0;
3815 
3816 	for (i = 0; i < sclk_table->count; i++) {
3817 		if (sclk == sclk_table->dpm_levels[i].value)
3818 			break;
3819 	}
3820 
3821 	if (i >= sclk_table->count) {
3822 		pi->need_update_smu7_dpm_table |= DPMTABLE_OD_UPDATE_SCLK;
3823 	} else {
3824 		/* XXX The current code always reprogrammed the sclk levels,
3825 		 * but we don't currently handle disp sclk requirements
3826 		 * so just skip it.
3827 		 */
3828 		if (CISLAND_MINIMUM_ENGINE_CLOCK != CISLAND_MINIMUM_ENGINE_CLOCK)
3829 			pi->need_update_smu7_dpm_table |= DPMTABLE_UPDATE_SCLK;
3830 	}
3831 
3832 	for (i = 0; i < mclk_table->count; i++) {
3833 		if (mclk == mclk_table->dpm_levels[i].value)
3834 			break;
3835 	}
3836 
3837 	if (i >= mclk_table->count)
3838 		pi->need_update_smu7_dpm_table |= DPMTABLE_OD_UPDATE_MCLK;
3839 
3840 	if (rdev->pm.dpm.current_active_crtc_count !=
3841 	    rdev->pm.dpm.new_active_crtc_count)
3842 		pi->need_update_smu7_dpm_table |= DPMTABLE_UPDATE_MCLK;
3843 }
3844 
3845 static int ci_populate_and_upload_sclk_mclk_dpm_levels(struct radeon_device *rdev,
3846 						       struct radeon_ps *radeon_state)
3847 {
3848 	struct ci_power_info *pi = ci_get_pi(rdev);
3849 	struct ci_ps *state = ci_get_ps(radeon_state);
3850 	u32 sclk = state->performance_levels[state->performance_level_count-1].sclk;
3851 	u32 mclk = state->performance_levels[state->performance_level_count-1].mclk;
3852 	struct ci_dpm_table *dpm_table = &pi->dpm_table;
3853 	int ret;
3854 
3855 	if (!pi->need_update_smu7_dpm_table)
3856 		return 0;
3857 
3858 	if (pi->need_update_smu7_dpm_table & DPMTABLE_OD_UPDATE_SCLK)
3859 		dpm_table->sclk_table.dpm_levels[dpm_table->sclk_table.count-1].value = sclk;
3860 
3861 	if (pi->need_update_smu7_dpm_table & DPMTABLE_OD_UPDATE_MCLK)
3862 		dpm_table->mclk_table.dpm_levels[dpm_table->mclk_table.count-1].value = mclk;
3863 
3864 	if (pi->need_update_smu7_dpm_table & (DPMTABLE_OD_UPDATE_SCLK | DPMTABLE_UPDATE_SCLK)) {
3865 		ret = ci_populate_all_graphic_levels(rdev);
3866 		if (ret)
3867 			return ret;
3868 	}
3869 
3870 	if (pi->need_update_smu7_dpm_table & (DPMTABLE_OD_UPDATE_MCLK | DPMTABLE_UPDATE_MCLK)) {
3871 		ret = ci_populate_all_memory_levels(rdev);
3872 		if (ret)
3873 			return ret;
3874 	}
3875 
3876 	return 0;
3877 }
3878 
3879 static int ci_enable_uvd_dpm(struct radeon_device *rdev, bool enable)
3880 {
3881 	struct ci_power_info *pi = ci_get_pi(rdev);
3882 	const struct radeon_clock_and_voltage_limits *max_limits;
3883 	int i;
3884 
3885 	if (rdev->pm.dpm.ac_power)
3886 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
3887 	else
3888 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc;
3889 
3890 	if (enable) {
3891 		pi->dpm_level_enable_mask.uvd_dpm_enable_mask = 0;
3892 
3893 		for (i = rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.count - 1; i >= 0; i--) {
3894 			if (rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.entries[i].v <= max_limits->vddc) {
3895 				pi->dpm_level_enable_mask.uvd_dpm_enable_mask |= 1 << i;
3896 
3897 				if (!pi->caps_uvd_dpm)
3898 					break;
3899 			}
3900 		}
3901 
3902 		ci_send_msg_to_smc_with_parameter(rdev,
3903 						  PPSMC_MSG_UVDDPM_SetEnabledMask,
3904 						  pi->dpm_level_enable_mask.uvd_dpm_enable_mask);
3905 
3906 		if (pi->last_mclk_dpm_enable_mask & 0x1) {
3907 			pi->uvd_enabled = true;
3908 			pi->dpm_level_enable_mask.mclk_dpm_enable_mask &= 0xFFFFFFFE;
3909 			ci_send_msg_to_smc_with_parameter(rdev,
3910 							  PPSMC_MSG_MCLKDPM_SetEnabledMask,
3911 							  pi->dpm_level_enable_mask.mclk_dpm_enable_mask);
3912 		}
3913 	} else {
3914 		if (pi->last_mclk_dpm_enable_mask & 0x1) {
3915 			pi->uvd_enabled = false;
3916 			pi->dpm_level_enable_mask.mclk_dpm_enable_mask |= 1;
3917 			ci_send_msg_to_smc_with_parameter(rdev,
3918 							  PPSMC_MSG_MCLKDPM_SetEnabledMask,
3919 							  pi->dpm_level_enable_mask.mclk_dpm_enable_mask);
3920 		}
3921 	}
3922 
3923 	return (ci_send_msg_to_smc(rdev, enable ?
3924 				   PPSMC_MSG_UVDDPM_Enable : PPSMC_MSG_UVDDPM_Disable) == PPSMC_Result_OK) ?
3925 		0 : -EINVAL;
3926 }
3927 
3928 static int ci_enable_vce_dpm(struct radeon_device *rdev, bool enable)
3929 {
3930 	struct ci_power_info *pi = ci_get_pi(rdev);
3931 	const struct radeon_clock_and_voltage_limits *max_limits;
3932 	int i;
3933 
3934 	if (rdev->pm.dpm.ac_power)
3935 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
3936 	else
3937 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc;
3938 
3939 	if (enable) {
3940 		pi->dpm_level_enable_mask.vce_dpm_enable_mask = 0;
3941 		for (i = rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.count - 1; i >= 0; i--) {
3942 			if (rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table.entries[i].v <= max_limits->vddc) {
3943 				pi->dpm_level_enable_mask.vce_dpm_enable_mask |= 1 << i;
3944 
3945 				if (!pi->caps_vce_dpm)
3946 					break;
3947 			}
3948 		}
3949 
3950 		ci_send_msg_to_smc_with_parameter(rdev,
3951 						  PPSMC_MSG_VCEDPM_SetEnabledMask,
3952 						  pi->dpm_level_enable_mask.vce_dpm_enable_mask);
3953 	}
3954 
3955 	return (ci_send_msg_to_smc(rdev, enable ?
3956 				   PPSMC_MSG_VCEDPM_Enable : PPSMC_MSG_VCEDPM_Disable) == PPSMC_Result_OK) ?
3957 		0 : -EINVAL;
3958 }
3959 
3960 #if 0
3961 static int ci_enable_samu_dpm(struct radeon_device *rdev, bool enable)
3962 {
3963 	struct ci_power_info *pi = ci_get_pi(rdev);
3964 	const struct radeon_clock_and_voltage_limits *max_limits;
3965 	int i;
3966 
3967 	if (rdev->pm.dpm.ac_power)
3968 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
3969 	else
3970 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc;
3971 
3972 	if (enable) {
3973 		pi->dpm_level_enable_mask.samu_dpm_enable_mask = 0;
3974 		for (i = rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.count - 1; i >= 0; i--) {
3975 			if (rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table.entries[i].v <= max_limits->vddc) {
3976 				pi->dpm_level_enable_mask.samu_dpm_enable_mask |= 1 << i;
3977 
3978 				if (!pi->caps_samu_dpm)
3979 					break;
3980 			}
3981 		}
3982 
3983 		ci_send_msg_to_smc_with_parameter(rdev,
3984 						  PPSMC_MSG_SAMUDPM_SetEnabledMask,
3985 						  pi->dpm_level_enable_mask.samu_dpm_enable_mask);
3986 	}
3987 	return (ci_send_msg_to_smc(rdev, enable ?
3988 				   PPSMC_MSG_SAMUDPM_Enable : PPSMC_MSG_SAMUDPM_Disable) == PPSMC_Result_OK) ?
3989 		0 : -EINVAL;
3990 }
3991 
3992 static int ci_enable_acp_dpm(struct radeon_device *rdev, bool enable)
3993 {
3994 	struct ci_power_info *pi = ci_get_pi(rdev);
3995 	const struct radeon_clock_and_voltage_limits *max_limits;
3996 	int i;
3997 
3998 	if (rdev->pm.dpm.ac_power)
3999 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
4000 	else
4001 		max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc;
4002 
4003 	if (enable) {
4004 		pi->dpm_level_enable_mask.acp_dpm_enable_mask = 0;
4005 		for (i = rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.count - 1; i >= 0; i--) {
4006 			if (rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table.entries[i].v <= max_limits->vddc) {
4007 				pi->dpm_level_enable_mask.acp_dpm_enable_mask |= 1 << i;
4008 
4009 				if (!pi->caps_acp_dpm)
4010 					break;
4011 			}
4012 		}
4013 
4014 		ci_send_msg_to_smc_with_parameter(rdev,
4015 						  PPSMC_MSG_ACPDPM_SetEnabledMask,
4016 						  pi->dpm_level_enable_mask.acp_dpm_enable_mask);
4017 	}
4018 
4019 	return (ci_send_msg_to_smc(rdev, enable ?
4020 				   PPSMC_MSG_ACPDPM_Enable : PPSMC_MSG_ACPDPM_Disable) == PPSMC_Result_OK) ?
4021 		0 : -EINVAL;
4022 }
4023 #endif
4024 
4025 static int ci_update_uvd_dpm(struct radeon_device *rdev, bool gate)
4026 {
4027 	struct ci_power_info *pi = ci_get_pi(rdev);
4028 	u32 tmp;
4029 
4030 	if (!gate) {
4031 		if (pi->caps_uvd_dpm ||
4032 		    (rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.count <= 0))
4033 			pi->smc_state_table.UvdBootLevel = 0;
4034 		else
4035 			pi->smc_state_table.UvdBootLevel =
4036 				rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table.count - 1;
4037 
4038 		tmp = RREG32_SMC(DPM_TABLE_475);
4039 		tmp &= ~UvdBootLevel_MASK;
4040 		tmp |= UvdBootLevel(pi->smc_state_table.UvdBootLevel);
4041 		WREG32_SMC(DPM_TABLE_475, tmp);
4042 	}
4043 
4044 	return ci_enable_uvd_dpm(rdev, !gate);
4045 }
4046 
4047 static u8 ci_get_vce_boot_level(struct radeon_device *rdev)
4048 {
4049 	u8 i;
4050 	u32 min_evclk = 30000; /* ??? */
4051 	struct radeon_vce_clock_voltage_dependency_table *table =
4052 		&rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table;
4053 
4054 	for (i = 0; i < table->count; i++) {
4055 		if (table->entries[i].evclk >= min_evclk)
4056 			return i;
4057 	}
4058 
4059 	return table->count - 1;
4060 }
4061 
4062 static int ci_update_vce_dpm(struct radeon_device *rdev,
4063 			     struct radeon_ps *radeon_new_state,
4064 			     struct radeon_ps *radeon_current_state)
4065 {
4066 	struct ci_power_info *pi = ci_get_pi(rdev);
4067 	int ret = 0;
4068 	u32 tmp;
4069 
4070 	if (radeon_current_state->evclk != radeon_new_state->evclk) {
4071 		if (radeon_new_state->evclk) {
4072 			/* turn the clocks on when encoding */
4073 			cik_update_cg(rdev, RADEON_CG_BLOCK_VCE, false);
4074 
4075 			pi->smc_state_table.VceBootLevel = ci_get_vce_boot_level(rdev);
4076 			tmp = RREG32_SMC(DPM_TABLE_475);
4077 			tmp &= ~VceBootLevel_MASK;
4078 			tmp |= VceBootLevel(pi->smc_state_table.VceBootLevel);
4079 			WREG32_SMC(DPM_TABLE_475, tmp);
4080 
4081 			ret = ci_enable_vce_dpm(rdev, true);
4082 		} else {
4083 			/* turn the clocks off when not encoding */
4084 			cik_update_cg(rdev, RADEON_CG_BLOCK_VCE, true);
4085 
4086 			ret = ci_enable_vce_dpm(rdev, false);
4087 		}
4088 	}
4089 	return ret;
4090 }
4091 
4092 #if 0
4093 static int ci_update_samu_dpm(struct radeon_device *rdev, bool gate)
4094 {
4095 	return ci_enable_samu_dpm(rdev, gate);
4096 }
4097 
4098 static int ci_update_acp_dpm(struct radeon_device *rdev, bool gate)
4099 {
4100 	struct ci_power_info *pi = ci_get_pi(rdev);
4101 	u32 tmp;
4102 
4103 	if (!gate) {
4104 		pi->smc_state_table.AcpBootLevel = 0;
4105 
4106 		tmp = RREG32_SMC(DPM_TABLE_475);
4107 		tmp &= ~AcpBootLevel_MASK;
4108 		tmp |= AcpBootLevel(pi->smc_state_table.AcpBootLevel);
4109 		WREG32_SMC(DPM_TABLE_475, tmp);
4110 	}
4111 
4112 	return ci_enable_acp_dpm(rdev, !gate);
4113 }
4114 #endif
4115 
4116 static int ci_generate_dpm_level_enable_mask(struct radeon_device *rdev,
4117 					     struct radeon_ps *radeon_state)
4118 {
4119 	struct ci_power_info *pi = ci_get_pi(rdev);
4120 	int ret;
4121 
4122 	ret = ci_trim_dpm_states(rdev, radeon_state);
4123 	if (ret)
4124 		return ret;
4125 
4126 	pi->dpm_level_enable_mask.sclk_dpm_enable_mask =
4127 		ci_get_dpm_level_enable_mask_value(&pi->dpm_table.sclk_table);
4128 	pi->dpm_level_enable_mask.mclk_dpm_enable_mask =
4129 		ci_get_dpm_level_enable_mask_value(&pi->dpm_table.mclk_table);
4130 	pi->last_mclk_dpm_enable_mask =
4131 		pi->dpm_level_enable_mask.mclk_dpm_enable_mask;
4132 	if (pi->uvd_enabled) {
4133 		if (pi->dpm_level_enable_mask.mclk_dpm_enable_mask & 1)
4134 			pi->dpm_level_enable_mask.mclk_dpm_enable_mask &= 0xFFFFFFFE;
4135 	}
4136 	pi->dpm_level_enable_mask.pcie_dpm_enable_mask =
4137 		ci_get_dpm_level_enable_mask_value(&pi->dpm_table.pcie_speed_table);
4138 
4139 	return 0;
4140 }
4141 
4142 static u32 ci_get_lowest_enabled_level(struct radeon_device *rdev,
4143 				       u32 level_mask)
4144 {
4145 	u32 level = 0;
4146 
4147 	while ((level_mask & (1 << level)) == 0)
4148 		level++;
4149 
4150 	return level;
4151 }
4152 
4153 
4154 int ci_dpm_force_performance_level(struct radeon_device *rdev,
4155 				   enum radeon_dpm_forced_level level)
4156 {
4157 	struct ci_power_info *pi = ci_get_pi(rdev);
4158 	u32 tmp, levels, i;
4159 	int ret;
4160 
4161 	if (level == RADEON_DPM_FORCED_LEVEL_HIGH) {
4162 		if ((!pi->pcie_dpm_key_disabled) &&
4163 		    pi->dpm_level_enable_mask.pcie_dpm_enable_mask) {
4164 			levels = 0;
4165 			tmp = pi->dpm_level_enable_mask.pcie_dpm_enable_mask;
4166 			while (tmp >>= 1)
4167 				levels++;
4168 			if (levels) {
4169 				ret = ci_dpm_force_state_pcie(rdev, level);
4170 				if (ret)
4171 					return ret;
4172 				for (i = 0; i < rdev->usec_timeout; i++) {
4173 					tmp = (RREG32_SMC(TARGET_AND_CURRENT_PROFILE_INDEX_1) &
4174 					       CURR_PCIE_INDEX_MASK) >> CURR_PCIE_INDEX_SHIFT;
4175 					if (tmp == levels)
4176 						break;
4177 					udelay(1);
4178 				}
4179 			}
4180 		}
4181 		if ((!pi->sclk_dpm_key_disabled) &&
4182 		    pi->dpm_level_enable_mask.sclk_dpm_enable_mask) {
4183 			levels = 0;
4184 			tmp = pi->dpm_level_enable_mask.sclk_dpm_enable_mask;
4185 			while (tmp >>= 1)
4186 				levels++;
4187 			if (levels) {
4188 				ret = ci_dpm_force_state_sclk(rdev, levels);
4189 				if (ret)
4190 					return ret;
4191 				for (i = 0; i < rdev->usec_timeout; i++) {
4192 					tmp = (RREG32_SMC(TARGET_AND_CURRENT_PROFILE_INDEX) &
4193 					       CURR_SCLK_INDEX_MASK) >> CURR_SCLK_INDEX_SHIFT;
4194 					if (tmp == levels)
4195 						break;
4196 					udelay(1);
4197 				}
4198 			}
4199 		}
4200 		if ((!pi->mclk_dpm_key_disabled) &&
4201 		    pi->dpm_level_enable_mask.mclk_dpm_enable_mask) {
4202 			levels = 0;
4203 			tmp = pi->dpm_level_enable_mask.mclk_dpm_enable_mask;
4204 			while (tmp >>= 1)
4205 				levels++;
4206 			if (levels) {
4207 				ret = ci_dpm_force_state_mclk(rdev, levels);
4208 				if (ret)
4209 					return ret;
4210 				for (i = 0; i < rdev->usec_timeout; i++) {
4211 					tmp = (RREG32_SMC(TARGET_AND_CURRENT_PROFILE_INDEX) &
4212 					       CURR_MCLK_INDEX_MASK) >> CURR_MCLK_INDEX_SHIFT;
4213 					if (tmp == levels)
4214 						break;
4215 					udelay(1);
4216 				}
4217 			}
4218 		}
4219 	} else if (level == RADEON_DPM_FORCED_LEVEL_LOW) {
4220 		if ((!pi->sclk_dpm_key_disabled) &&
4221 		    pi->dpm_level_enable_mask.sclk_dpm_enable_mask) {
4222 			levels = ci_get_lowest_enabled_level(rdev,
4223 							     pi->dpm_level_enable_mask.sclk_dpm_enable_mask);
4224 			ret = ci_dpm_force_state_sclk(rdev, levels);
4225 			if (ret)
4226 				return ret;
4227 			for (i = 0; i < rdev->usec_timeout; i++) {
4228 				tmp = (RREG32_SMC(TARGET_AND_CURRENT_PROFILE_INDEX) &
4229 				       CURR_SCLK_INDEX_MASK) >> CURR_SCLK_INDEX_SHIFT;
4230 				if (tmp == levels)
4231 					break;
4232 				udelay(1);
4233 			}
4234 		}
4235 		if ((!pi->mclk_dpm_key_disabled) &&
4236 		    pi->dpm_level_enable_mask.mclk_dpm_enable_mask) {
4237 			levels = ci_get_lowest_enabled_level(rdev,
4238 							     pi->dpm_level_enable_mask.mclk_dpm_enable_mask);
4239 			ret = ci_dpm_force_state_mclk(rdev, levels);
4240 			if (ret)
4241 				return ret;
4242 			for (i = 0; i < rdev->usec_timeout; i++) {
4243 				tmp = (RREG32_SMC(TARGET_AND_CURRENT_PROFILE_INDEX) &
4244 				       CURR_MCLK_INDEX_MASK) >> CURR_MCLK_INDEX_SHIFT;
4245 				if (tmp == levels)
4246 					break;
4247 				udelay(1);
4248 			}
4249 		}
4250 		if ((!pi->pcie_dpm_key_disabled) &&
4251 		    pi->dpm_level_enable_mask.pcie_dpm_enable_mask) {
4252 			levels = ci_get_lowest_enabled_level(rdev,
4253 							     pi->dpm_level_enable_mask.pcie_dpm_enable_mask);
4254 			ret = ci_dpm_force_state_pcie(rdev, levels);
4255 			if (ret)
4256 				return ret;
4257 			for (i = 0; i < rdev->usec_timeout; i++) {
4258 				tmp = (RREG32_SMC(TARGET_AND_CURRENT_PROFILE_INDEX_1) &
4259 				       CURR_PCIE_INDEX_MASK) >> CURR_PCIE_INDEX_SHIFT;
4260 				if (tmp == levels)
4261 					break;
4262 				udelay(1);
4263 			}
4264 		}
4265 	} else if (level == RADEON_DPM_FORCED_LEVEL_AUTO) {
4266 		if (!pi->pcie_dpm_key_disabled) {
4267 			PPSMC_Result smc_result;
4268 
4269 			smc_result = ci_send_msg_to_smc(rdev,
4270 							PPSMC_MSG_PCIeDPM_UnForceLevel);
4271 			if (smc_result != PPSMC_Result_OK)
4272 				return -EINVAL;
4273 		}
4274 		ret = ci_upload_dpm_level_enable_mask(rdev);
4275 		if (ret)
4276 			return ret;
4277 	}
4278 
4279 	rdev->pm.dpm.forced_level = level;
4280 
4281 	return 0;
4282 }
4283 
4284 static int ci_set_mc_special_registers(struct radeon_device *rdev,
4285 				       struct ci_mc_reg_table *table)
4286 {
4287 	struct ci_power_info *pi = ci_get_pi(rdev);
4288 	u8 i, j, k;
4289 	u32 temp_reg;
4290 
4291 	for (i = 0, j = table->last; i < table->last; i++) {
4292 		if (j >= SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4293 			return -EINVAL;
4294 		switch (table->mc_reg_address[i].s1 << 2) {
4295 		case MC_SEQ_MISC1:
4296 			temp_reg = RREG32(MC_PMG_CMD_EMRS);
4297 			table->mc_reg_address[j].s1 = MC_PMG_CMD_EMRS >> 2;
4298 			table->mc_reg_address[j].s0 = MC_SEQ_PMG_CMD_EMRS_LP >> 2;
4299 			for (k = 0; k < table->num_entries; k++) {
4300 				table->mc_reg_table_entry[k].mc_data[j] =
4301 					((temp_reg & 0xffff0000)) | ((table->mc_reg_table_entry[k].mc_data[i] & 0xffff0000) >> 16);
4302 			}
4303 			j++;
4304 			if (j >= SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4305 				return -EINVAL;
4306 
4307 			temp_reg = RREG32(MC_PMG_CMD_MRS);
4308 			table->mc_reg_address[j].s1 = MC_PMG_CMD_MRS >> 2;
4309 			table->mc_reg_address[j].s0 = MC_SEQ_PMG_CMD_MRS_LP >> 2;
4310 			for (k = 0; k < table->num_entries; k++) {
4311 				table->mc_reg_table_entry[k].mc_data[j] =
4312 					(temp_reg & 0xffff0000) | (table->mc_reg_table_entry[k].mc_data[i] & 0x0000ffff);
4313 				if (!pi->mem_gddr5)
4314 					table->mc_reg_table_entry[k].mc_data[j] |= 0x100;
4315 			}
4316 			j++;
4317 			if (j >= SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4318 				return -EINVAL;
4319 
4320 			if (!pi->mem_gddr5) {
4321 				table->mc_reg_address[j].s1 = MC_PMG_AUTO_CMD >> 2;
4322 				table->mc_reg_address[j].s0 = MC_PMG_AUTO_CMD >> 2;
4323 				for (k = 0; k < table->num_entries; k++) {
4324 					table->mc_reg_table_entry[k].mc_data[j] =
4325 						(table->mc_reg_table_entry[k].mc_data[i] & 0xffff0000) >> 16;
4326 				}
4327 				j++;
4328 				if (j > SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4329 					return -EINVAL;
4330 			}
4331 			break;
4332 		case MC_SEQ_RESERVE_M:
4333 			temp_reg = RREG32(MC_PMG_CMD_MRS1);
4334 			table->mc_reg_address[j].s1 = MC_PMG_CMD_MRS1 >> 2;
4335 			table->mc_reg_address[j].s0 = MC_SEQ_PMG_CMD_MRS1_LP >> 2;
4336 			for (k = 0; k < table->num_entries; k++) {
4337 				table->mc_reg_table_entry[k].mc_data[j] =
4338 					(temp_reg & 0xffff0000) | (table->mc_reg_table_entry[k].mc_data[i] & 0x0000ffff);
4339 			}
4340 			j++;
4341 			if (j > SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4342 				return -EINVAL;
4343 			break;
4344 		default:
4345 			break;
4346 		}
4347 
4348 	}
4349 
4350 	table->last = j;
4351 
4352 	return 0;
4353 }
4354 
4355 static bool ci_check_s0_mc_reg_index(u16 in_reg, u16 *out_reg)
4356 {
4357 	bool result = true;
4358 
4359 	switch (in_reg) {
4360 	case MC_SEQ_RAS_TIMING >> 2:
4361 		*out_reg = MC_SEQ_RAS_TIMING_LP >> 2;
4362 		break;
4363 	case MC_SEQ_DLL_STBY >> 2:
4364 		*out_reg = MC_SEQ_DLL_STBY_LP >> 2;
4365 		break;
4366 	case MC_SEQ_G5PDX_CMD0 >> 2:
4367 		*out_reg = MC_SEQ_G5PDX_CMD0_LP >> 2;
4368 		break;
4369 	case MC_SEQ_G5PDX_CMD1 >> 2:
4370 		*out_reg = MC_SEQ_G5PDX_CMD1_LP >> 2;
4371 		break;
4372 	case MC_SEQ_G5PDX_CTRL >> 2:
4373 		*out_reg = MC_SEQ_G5PDX_CTRL_LP >> 2;
4374 		break;
4375 	case MC_SEQ_CAS_TIMING >> 2:
4376 		*out_reg = MC_SEQ_CAS_TIMING_LP >> 2;
4377 		break;
4378 	case MC_SEQ_MISC_TIMING >> 2:
4379 		*out_reg = MC_SEQ_MISC_TIMING_LP >> 2;
4380 		break;
4381 	case MC_SEQ_MISC_TIMING2 >> 2:
4382 		*out_reg = MC_SEQ_MISC_TIMING2_LP >> 2;
4383 		break;
4384 	case MC_SEQ_PMG_DVS_CMD >> 2:
4385 		*out_reg = MC_SEQ_PMG_DVS_CMD_LP >> 2;
4386 		break;
4387 	case MC_SEQ_PMG_DVS_CTL >> 2:
4388 		*out_reg = MC_SEQ_PMG_DVS_CTL_LP >> 2;
4389 		break;
4390 	case MC_SEQ_RD_CTL_D0 >> 2:
4391 		*out_reg = MC_SEQ_RD_CTL_D0_LP >> 2;
4392 		break;
4393 	case MC_SEQ_RD_CTL_D1 >> 2:
4394 		*out_reg = MC_SEQ_RD_CTL_D1_LP >> 2;
4395 		break;
4396 	case MC_SEQ_WR_CTL_D0 >> 2:
4397 		*out_reg = MC_SEQ_WR_CTL_D0_LP >> 2;
4398 		break;
4399 	case MC_SEQ_WR_CTL_D1 >> 2:
4400 		*out_reg = MC_SEQ_WR_CTL_D1_LP >> 2;
4401 		break;
4402 	case MC_PMG_CMD_EMRS >> 2:
4403 		*out_reg = MC_SEQ_PMG_CMD_EMRS_LP >> 2;
4404 		break;
4405 	case MC_PMG_CMD_MRS >> 2:
4406 		*out_reg = MC_SEQ_PMG_CMD_MRS_LP >> 2;
4407 		break;
4408 	case MC_PMG_CMD_MRS1 >> 2:
4409 		*out_reg = MC_SEQ_PMG_CMD_MRS1_LP >> 2;
4410 		break;
4411 	case MC_SEQ_PMG_TIMING >> 2:
4412 		*out_reg = MC_SEQ_PMG_TIMING_LP >> 2;
4413 		break;
4414 	case MC_PMG_CMD_MRS2 >> 2:
4415 		*out_reg = MC_SEQ_PMG_CMD_MRS2_LP >> 2;
4416 		break;
4417 	case MC_SEQ_WR_CTL_2 >> 2:
4418 		*out_reg = MC_SEQ_WR_CTL_2_LP >> 2;
4419 		break;
4420 	default:
4421 		result = false;
4422 		break;
4423 	}
4424 
4425 	return result;
4426 }
4427 
4428 static void ci_set_valid_flag(struct ci_mc_reg_table *table)
4429 {
4430 	u8 i, j;
4431 
4432 	for (i = 0; i < table->last; i++) {
4433 		for (j = 1; j < table->num_entries; j++) {
4434 			if (table->mc_reg_table_entry[j-1].mc_data[i] !=
4435 			    table->mc_reg_table_entry[j].mc_data[i]) {
4436 				table->valid_flag |= 1 << i;
4437 				break;
4438 			}
4439 		}
4440 	}
4441 }
4442 
4443 static void ci_set_s0_mc_reg_index(struct ci_mc_reg_table *table)
4444 {
4445 	u32 i;
4446 	u16 address;
4447 
4448 	for (i = 0; i < table->last; i++) {
4449 		table->mc_reg_address[i].s0 =
4450 			ci_check_s0_mc_reg_index(table->mc_reg_address[i].s1, &address) ?
4451 			address : table->mc_reg_address[i].s1;
4452 	}
4453 }
4454 
4455 static int ci_copy_vbios_mc_reg_table(const struct atom_mc_reg_table *table,
4456 				      struct ci_mc_reg_table *ci_table)
4457 {
4458 	u8 i, j;
4459 
4460 	if (table->last > SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4461 		return -EINVAL;
4462 	if (table->num_entries > MAX_AC_TIMING_ENTRIES)
4463 		return -EINVAL;
4464 
4465 	for (i = 0; i < table->last; i++)
4466 		ci_table->mc_reg_address[i].s1 = table->mc_reg_address[i].s1;
4467 
4468 	ci_table->last = table->last;
4469 
4470 	for (i = 0; i < table->num_entries; i++) {
4471 		ci_table->mc_reg_table_entry[i].mclk_max =
4472 			table->mc_reg_table_entry[i].mclk_max;
4473 		for (j = 0; j < table->last; j++)
4474 			ci_table->mc_reg_table_entry[i].mc_data[j] =
4475 				table->mc_reg_table_entry[i].mc_data[j];
4476 	}
4477 	ci_table->num_entries = table->num_entries;
4478 
4479 	return 0;
4480 }
4481 
4482 static int ci_register_patching_mc_seq(struct radeon_device *rdev,
4483 				       struct ci_mc_reg_table *table)
4484 {
4485 	u8 i, k;
4486 	u32 tmp;
4487 	bool patch;
4488 
4489 	tmp = RREG32(MC_SEQ_MISC0);
4490 	patch = ((tmp & 0x0000f00) == 0x300) ? true : false;
4491 
4492 	if (patch &&
4493 	    ((rdev->pdev->device == 0x67B0) ||
4494 	     (rdev->pdev->device == 0x67B1))) {
4495 		for (i = 0; i < table->last; i++) {
4496 			if (table->last >= SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4497 				return -EINVAL;
4498 			switch (table->mc_reg_address[i].s1 >> 2) {
4499 			case MC_SEQ_MISC1:
4500 				for (k = 0; k < table->num_entries; k++) {
4501 					if ((table->mc_reg_table_entry[k].mclk_max == 125000) ||
4502 					    (table->mc_reg_table_entry[k].mclk_max == 137500))
4503 						table->mc_reg_table_entry[k].mc_data[i] =
4504 							(table->mc_reg_table_entry[k].mc_data[i] & 0xFFFFFFF8) |
4505 							0x00000007;
4506 				}
4507 				break;
4508 			case MC_SEQ_WR_CTL_D0:
4509 				for (k = 0; k < table->num_entries; k++) {
4510 					if ((table->mc_reg_table_entry[k].mclk_max == 125000) ||
4511 					    (table->mc_reg_table_entry[k].mclk_max == 137500))
4512 						table->mc_reg_table_entry[k].mc_data[i] =
4513 							(table->mc_reg_table_entry[k].mc_data[i] & 0xFFFF0F00) |
4514 							0x0000D0DD;
4515 				}
4516 				break;
4517 			case MC_SEQ_WR_CTL_D1:
4518 				for (k = 0; k < table->num_entries; k++) {
4519 					if ((table->mc_reg_table_entry[k].mclk_max == 125000) ||
4520 					    (table->mc_reg_table_entry[k].mclk_max == 137500))
4521 						table->mc_reg_table_entry[k].mc_data[i] =
4522 							(table->mc_reg_table_entry[k].mc_data[i] & 0xFFFF0F00) |
4523 							0x0000D0DD;
4524 				}
4525 				break;
4526 			case MC_SEQ_WR_CTL_2:
4527 				for (k = 0; k < table->num_entries; k++) {
4528 					if ((table->mc_reg_table_entry[k].mclk_max == 125000) ||
4529 					    (table->mc_reg_table_entry[k].mclk_max == 137500))
4530 						table->mc_reg_table_entry[k].mc_data[i] = 0;
4531 				}
4532 				break;
4533 			case MC_SEQ_CAS_TIMING:
4534 				for (k = 0; k < table->num_entries; k++) {
4535 					if (table->mc_reg_table_entry[k].mclk_max == 125000)
4536 						table->mc_reg_table_entry[k].mc_data[i] =
4537 							(table->mc_reg_table_entry[k].mc_data[i] & 0xFFE0FE0F) |
4538 							0x000C0140;
4539 					else if (table->mc_reg_table_entry[k].mclk_max == 137500)
4540 						table->mc_reg_table_entry[k].mc_data[i] =
4541 							(table->mc_reg_table_entry[k].mc_data[i] & 0xFFE0FE0F) |
4542 							0x000C0150;
4543 				}
4544 				break;
4545 			case MC_SEQ_MISC_TIMING:
4546 				for (k = 0; k < table->num_entries; k++) {
4547 					if (table->mc_reg_table_entry[k].mclk_max == 125000)
4548 						table->mc_reg_table_entry[k].mc_data[i] =
4549 							(table->mc_reg_table_entry[k].mc_data[i] & 0xFFFFFFE0) |
4550 							0x00000030;
4551 					else if (table->mc_reg_table_entry[k].mclk_max == 137500)
4552 						table->mc_reg_table_entry[k].mc_data[i] =
4553 							(table->mc_reg_table_entry[k].mc_data[i] & 0xFFFFFFE0) |
4554 							0x00000035;
4555 				}
4556 				break;
4557 			default:
4558 				break;
4559 			}
4560 		}
4561 
4562 		WREG32(MC_SEQ_IO_DEBUG_INDEX, 3);
4563 		tmp = RREG32(MC_SEQ_IO_DEBUG_DATA);
4564 		tmp = (tmp & 0xFFF8FFFF) | (1 << 16);
4565 		WREG32(MC_SEQ_IO_DEBUG_INDEX, 3);
4566 		WREG32(MC_SEQ_IO_DEBUG_DATA, tmp);
4567 	}
4568 
4569 	return 0;
4570 }
4571 
4572 static int ci_initialize_mc_reg_table(struct radeon_device *rdev)
4573 {
4574 	struct ci_power_info *pi = ci_get_pi(rdev);
4575 	struct atom_mc_reg_table *table;
4576 	struct ci_mc_reg_table *ci_table = &pi->mc_reg_table;
4577 	u8 module_index = rv770_get_memory_module_index(rdev);
4578 	int ret;
4579 
4580 	table = kzalloc(sizeof(struct atom_mc_reg_table), GFP_KERNEL);
4581 	if (!table)
4582 		return -ENOMEM;
4583 
4584 	WREG32(MC_SEQ_RAS_TIMING_LP, RREG32(MC_SEQ_RAS_TIMING));
4585 	WREG32(MC_SEQ_CAS_TIMING_LP, RREG32(MC_SEQ_CAS_TIMING));
4586 	WREG32(MC_SEQ_DLL_STBY_LP, RREG32(MC_SEQ_DLL_STBY));
4587 	WREG32(MC_SEQ_G5PDX_CMD0_LP, RREG32(MC_SEQ_G5PDX_CMD0));
4588 	WREG32(MC_SEQ_G5PDX_CMD1_LP, RREG32(MC_SEQ_G5PDX_CMD1));
4589 	WREG32(MC_SEQ_G5PDX_CTRL_LP, RREG32(MC_SEQ_G5PDX_CTRL));
4590 	WREG32(MC_SEQ_PMG_DVS_CMD_LP, RREG32(MC_SEQ_PMG_DVS_CMD));
4591 	WREG32(MC_SEQ_PMG_DVS_CTL_LP, RREG32(MC_SEQ_PMG_DVS_CTL));
4592 	WREG32(MC_SEQ_MISC_TIMING_LP, RREG32(MC_SEQ_MISC_TIMING));
4593 	WREG32(MC_SEQ_MISC_TIMING2_LP, RREG32(MC_SEQ_MISC_TIMING2));
4594 	WREG32(MC_SEQ_PMG_CMD_EMRS_LP, RREG32(MC_PMG_CMD_EMRS));
4595 	WREG32(MC_SEQ_PMG_CMD_MRS_LP, RREG32(MC_PMG_CMD_MRS));
4596 	WREG32(MC_SEQ_PMG_CMD_MRS1_LP, RREG32(MC_PMG_CMD_MRS1));
4597 	WREG32(MC_SEQ_WR_CTL_D0_LP, RREG32(MC_SEQ_WR_CTL_D0));
4598 	WREG32(MC_SEQ_WR_CTL_D1_LP, RREG32(MC_SEQ_WR_CTL_D1));
4599 	WREG32(MC_SEQ_RD_CTL_D0_LP, RREG32(MC_SEQ_RD_CTL_D0));
4600 	WREG32(MC_SEQ_RD_CTL_D1_LP, RREG32(MC_SEQ_RD_CTL_D1));
4601 	WREG32(MC_SEQ_PMG_TIMING_LP, RREG32(MC_SEQ_PMG_TIMING));
4602 	WREG32(MC_SEQ_PMG_CMD_MRS2_LP, RREG32(MC_PMG_CMD_MRS2));
4603 	WREG32(MC_SEQ_WR_CTL_2_LP, RREG32(MC_SEQ_WR_CTL_2));
4604 
4605 	ret = radeon_atom_init_mc_reg_table(rdev, module_index, table);
4606 	if (ret)
4607 		goto init_mc_done;
4608 
4609 	ret = ci_copy_vbios_mc_reg_table(table, ci_table);
4610 	if (ret)
4611 		goto init_mc_done;
4612 
4613 	ci_set_s0_mc_reg_index(ci_table);
4614 
4615 	ret = ci_register_patching_mc_seq(rdev, ci_table);
4616 	if (ret)
4617 		goto init_mc_done;
4618 
4619 	ret = ci_set_mc_special_registers(rdev, ci_table);
4620 	if (ret)
4621 		goto init_mc_done;
4622 
4623 	ci_set_valid_flag(ci_table);
4624 
4625 init_mc_done:
4626 	kfree(table);
4627 
4628 	return ret;
4629 }
4630 
4631 static int ci_populate_mc_reg_addresses(struct radeon_device *rdev,
4632 					SMU7_Discrete_MCRegisters *mc_reg_table)
4633 {
4634 	struct ci_power_info *pi = ci_get_pi(rdev);
4635 	u32 i, j;
4636 
4637 	for (i = 0, j = 0; j < pi->mc_reg_table.last; j++) {
4638 		if (pi->mc_reg_table.valid_flag & (1 << j)) {
4639 			if (i >= SMU7_DISCRETE_MC_REGISTER_ARRAY_SIZE)
4640 				return -EINVAL;
4641 			mc_reg_table->address[i].s0 = cpu_to_be16(pi->mc_reg_table.mc_reg_address[j].s0);
4642 			mc_reg_table->address[i].s1 = cpu_to_be16(pi->mc_reg_table.mc_reg_address[j].s1);
4643 			i++;
4644 		}
4645 	}
4646 
4647 	mc_reg_table->last = (u8)i;
4648 
4649 	return 0;
4650 }
4651 
4652 static void ci_convert_mc_registers(const struct ci_mc_reg_entry *entry,
4653 				    SMU7_Discrete_MCRegisterSet *data,
4654 				    u32 num_entries, u32 valid_flag)
4655 {
4656 	u32 i, j;
4657 
4658 	for (i = 0, j = 0; j < num_entries; j++) {
4659 		if (valid_flag & (1 << j)) {
4660 			data->value[i] = cpu_to_be32(entry->mc_data[j]);
4661 			i++;
4662 		}
4663 	}
4664 }
4665 
4666 static void ci_convert_mc_reg_table_entry_to_smc(struct radeon_device *rdev,
4667 						 const u32 memory_clock,
4668 						 SMU7_Discrete_MCRegisterSet *mc_reg_table_data)
4669 {
4670 	struct ci_power_info *pi = ci_get_pi(rdev);
4671 	u32 i = 0;
4672 
4673 	for (i = 0; i < pi->mc_reg_table.num_entries; i++) {
4674 		if (memory_clock <= pi->mc_reg_table.mc_reg_table_entry[i].mclk_max)
4675 			break;
4676 	}
4677 
4678 	if ((i == pi->mc_reg_table.num_entries) && (i > 0))
4679 		--i;
4680 
4681 	ci_convert_mc_registers(&pi->mc_reg_table.mc_reg_table_entry[i],
4682 				mc_reg_table_data, pi->mc_reg_table.last,
4683 				pi->mc_reg_table.valid_flag);
4684 }
4685 
4686 static void ci_convert_mc_reg_table_to_smc(struct radeon_device *rdev,
4687 					   SMU7_Discrete_MCRegisters *mc_reg_table)
4688 {
4689 	struct ci_power_info *pi = ci_get_pi(rdev);
4690 	u32 i;
4691 
4692 	for (i = 0; i < pi->dpm_table.mclk_table.count; i++)
4693 		ci_convert_mc_reg_table_entry_to_smc(rdev,
4694 						     pi->dpm_table.mclk_table.dpm_levels[i].value,
4695 						     &mc_reg_table->data[i]);
4696 }
4697 
4698 static int ci_populate_initial_mc_reg_table(struct radeon_device *rdev)
4699 {
4700 	struct ci_power_info *pi = ci_get_pi(rdev);
4701 	int ret;
4702 
4703 	memset(&pi->smc_mc_reg_table, 0, sizeof(SMU7_Discrete_MCRegisters));
4704 
4705 	ret = ci_populate_mc_reg_addresses(rdev, &pi->smc_mc_reg_table);
4706 	if (ret)
4707 		return ret;
4708 	ci_convert_mc_reg_table_to_smc(rdev, &pi->smc_mc_reg_table);
4709 
4710 	return ci_copy_bytes_to_smc(rdev,
4711 				    pi->mc_reg_table_start,
4712 				    (u8 *)&pi->smc_mc_reg_table,
4713 				    sizeof(SMU7_Discrete_MCRegisters),
4714 				    pi->sram_end);
4715 }
4716 
4717 static int ci_update_and_upload_mc_reg_table(struct radeon_device *rdev)
4718 {
4719 	struct ci_power_info *pi = ci_get_pi(rdev);
4720 
4721 	if (!(pi->need_update_smu7_dpm_table & DPMTABLE_OD_UPDATE_MCLK))
4722 		return 0;
4723 
4724 	memset(&pi->smc_mc_reg_table, 0, sizeof(SMU7_Discrete_MCRegisters));
4725 
4726 	ci_convert_mc_reg_table_to_smc(rdev, &pi->smc_mc_reg_table);
4727 
4728 	return ci_copy_bytes_to_smc(rdev,
4729 				    pi->mc_reg_table_start +
4730 				    offsetof(SMU7_Discrete_MCRegisters, data[0]),
4731 				    (u8 *)&pi->smc_mc_reg_table.data[0],
4732 				    sizeof(SMU7_Discrete_MCRegisterSet) *
4733 				    pi->dpm_table.mclk_table.count,
4734 				    pi->sram_end);
4735 }
4736 
4737 static void ci_enable_voltage_control(struct radeon_device *rdev)
4738 {
4739 	u32 tmp = RREG32_SMC(GENERAL_PWRMGT);
4740 
4741 	tmp |= VOLT_PWRMGT_EN;
4742 	WREG32_SMC(GENERAL_PWRMGT, tmp);
4743 }
4744 
4745 static enum radeon_pcie_gen ci_get_maximum_link_speed(struct radeon_device *rdev,
4746 						      struct radeon_ps *radeon_state)
4747 {
4748 	struct ci_ps *state = ci_get_ps(radeon_state);
4749 	int i;
4750 	u16 pcie_speed, max_speed = 0;
4751 
4752 	for (i = 0; i < state->performance_level_count; i++) {
4753 		pcie_speed = state->performance_levels[i].pcie_gen;
4754 		if (max_speed < pcie_speed)
4755 			max_speed = pcie_speed;
4756 	}
4757 
4758 	return max_speed;
4759 }
4760 
4761 static u16 ci_get_current_pcie_speed(struct radeon_device *rdev)
4762 {
4763 	u32 speed_cntl = 0;
4764 
4765 	speed_cntl = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL) & LC_CURRENT_DATA_RATE_MASK;
4766 	speed_cntl >>= LC_CURRENT_DATA_RATE_SHIFT;
4767 
4768 	return (u16)speed_cntl;
4769 }
4770 
4771 static int ci_get_current_pcie_lane_number(struct radeon_device *rdev)
4772 {
4773 	u32 link_width = 0;
4774 
4775 	link_width = RREG32_PCIE_PORT(PCIE_LC_LINK_WIDTH_CNTL) & LC_LINK_WIDTH_RD_MASK;
4776 	link_width >>= LC_LINK_WIDTH_RD_SHIFT;
4777 
4778 	switch (link_width) {
4779 	case RADEON_PCIE_LC_LINK_WIDTH_X1:
4780 		return 1;
4781 	case RADEON_PCIE_LC_LINK_WIDTH_X2:
4782 		return 2;
4783 	case RADEON_PCIE_LC_LINK_WIDTH_X4:
4784 		return 4;
4785 	case RADEON_PCIE_LC_LINK_WIDTH_X8:
4786 		return 8;
4787 	case RADEON_PCIE_LC_LINK_WIDTH_X12:
4788 		/* not actually supported */
4789 		return 12;
4790 	case RADEON_PCIE_LC_LINK_WIDTH_X0:
4791 	case RADEON_PCIE_LC_LINK_WIDTH_X16:
4792 	default:
4793 		return 16;
4794 	}
4795 }
4796 
4797 static void ci_request_link_speed_change_before_state_change(struct radeon_device *rdev,
4798 							     struct radeon_ps *radeon_new_state,
4799 							     struct radeon_ps *radeon_current_state)
4800 {
4801 	struct ci_power_info *pi = ci_get_pi(rdev);
4802 	enum radeon_pcie_gen target_link_speed =
4803 		ci_get_maximum_link_speed(rdev, radeon_new_state);
4804 	enum radeon_pcie_gen current_link_speed;
4805 
4806 	if (pi->force_pcie_gen == RADEON_PCIE_GEN_INVALID)
4807 		current_link_speed = ci_get_maximum_link_speed(rdev, radeon_current_state);
4808 	else
4809 		current_link_speed = pi->force_pcie_gen;
4810 
4811 	pi->force_pcie_gen = RADEON_PCIE_GEN_INVALID;
4812 	pi->pspp_notify_required = false;
4813 	if (target_link_speed > current_link_speed) {
4814 		switch (target_link_speed) {
4815 #ifdef CONFIG_ACPI
4816 		case RADEON_PCIE_GEN3:
4817 			if (radeon_acpi_pcie_performance_request(rdev, PCIE_PERF_REQ_PECI_GEN3, false) == 0)
4818 				break;
4819 			pi->force_pcie_gen = RADEON_PCIE_GEN2;
4820 			if (current_link_speed == RADEON_PCIE_GEN2)
4821 				break;
4822 			fallthrough;
4823 		case RADEON_PCIE_GEN2:
4824 			if (radeon_acpi_pcie_performance_request(rdev, PCIE_PERF_REQ_PECI_GEN2, false) == 0)
4825 				break;
4826 			fallthrough;
4827 #endif
4828 		default:
4829 			pi->force_pcie_gen = ci_get_current_pcie_speed(rdev);
4830 			break;
4831 		}
4832 	} else {
4833 		if (target_link_speed < current_link_speed)
4834 			pi->pspp_notify_required = true;
4835 	}
4836 }
4837 
4838 static void ci_notify_link_speed_change_after_state_change(struct radeon_device *rdev,
4839 							   struct radeon_ps *radeon_new_state,
4840 							   struct radeon_ps *radeon_current_state)
4841 {
4842 	struct ci_power_info *pi = ci_get_pi(rdev);
4843 	enum radeon_pcie_gen target_link_speed =
4844 		ci_get_maximum_link_speed(rdev, radeon_new_state);
4845 	u8 request;
4846 
4847 	if (pi->pspp_notify_required) {
4848 		if (target_link_speed == RADEON_PCIE_GEN3)
4849 			request = PCIE_PERF_REQ_PECI_GEN3;
4850 		else if (target_link_speed == RADEON_PCIE_GEN2)
4851 			request = PCIE_PERF_REQ_PECI_GEN2;
4852 		else
4853 			request = PCIE_PERF_REQ_PECI_GEN1;
4854 
4855 		if ((request == PCIE_PERF_REQ_PECI_GEN1) &&
4856 		    (ci_get_current_pcie_speed(rdev) > 0))
4857 			return;
4858 
4859 #ifdef CONFIG_ACPI
4860 		radeon_acpi_pcie_performance_request(rdev, request, false);
4861 #endif
4862 	}
4863 }
4864 
4865 static int ci_set_private_data_variables_based_on_pptable(struct radeon_device *rdev)
4866 {
4867 	struct ci_power_info *pi = ci_get_pi(rdev);
4868 	struct radeon_clock_voltage_dependency_table *allowed_sclk_vddc_table =
4869 		&rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk;
4870 	struct radeon_clock_voltage_dependency_table *allowed_mclk_vddc_table =
4871 		&rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk;
4872 	struct radeon_clock_voltage_dependency_table *allowed_mclk_vddci_table =
4873 		&rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk;
4874 
4875 	if (allowed_sclk_vddc_table->count < 1)
4876 		return -EINVAL;
4877 	if (allowed_mclk_vddc_table->count < 1)
4878 		return -EINVAL;
4879 	if (allowed_mclk_vddci_table->count < 1)
4880 		return -EINVAL;
4881 
4882 	pi->min_vddc_in_pp_table = allowed_sclk_vddc_table->entries[0].v;
4883 	pi->max_vddc_in_pp_table =
4884 		allowed_sclk_vddc_table->entries[allowed_sclk_vddc_table->count - 1].v;
4885 
4886 	pi->min_vddci_in_pp_table = allowed_mclk_vddci_table->entries[0].v;
4887 	pi->max_vddci_in_pp_table =
4888 		allowed_mclk_vddci_table->entries[allowed_mclk_vddci_table->count - 1].v;
4889 
4890 	rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.sclk =
4891 		allowed_sclk_vddc_table->entries[allowed_sclk_vddc_table->count - 1].clk;
4892 	rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.mclk =
4893 		allowed_mclk_vddc_table->entries[allowed_sclk_vddc_table->count - 1].clk;
4894 	rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddc =
4895 		allowed_sclk_vddc_table->entries[allowed_sclk_vddc_table->count - 1].v;
4896 	rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddci =
4897 		allowed_mclk_vddci_table->entries[allowed_mclk_vddci_table->count - 1].v;
4898 
4899 	return 0;
4900 }
4901 
4902 static void ci_patch_with_vddc_leakage(struct radeon_device *rdev, u16 *vddc)
4903 {
4904 	struct ci_power_info *pi = ci_get_pi(rdev);
4905 	struct ci_leakage_voltage *leakage_table = &pi->vddc_leakage;
4906 	u32 leakage_index;
4907 
4908 	for (leakage_index = 0; leakage_index < leakage_table->count; leakage_index++) {
4909 		if (leakage_table->leakage_id[leakage_index] == *vddc) {
4910 			*vddc = leakage_table->actual_voltage[leakage_index];
4911 			break;
4912 		}
4913 	}
4914 }
4915 
4916 static void ci_patch_with_vddci_leakage(struct radeon_device *rdev, u16 *vddci)
4917 {
4918 	struct ci_power_info *pi = ci_get_pi(rdev);
4919 	struct ci_leakage_voltage *leakage_table = &pi->vddci_leakage;
4920 	u32 leakage_index;
4921 
4922 	for (leakage_index = 0; leakage_index < leakage_table->count; leakage_index++) {
4923 		if (leakage_table->leakage_id[leakage_index] == *vddci) {
4924 			*vddci = leakage_table->actual_voltage[leakage_index];
4925 			break;
4926 		}
4927 	}
4928 }
4929 
4930 static void ci_patch_clock_voltage_dependency_table_with_vddc_leakage(struct radeon_device *rdev,
4931 								      struct radeon_clock_voltage_dependency_table *table)
4932 {
4933 	u32 i;
4934 
4935 	if (table) {
4936 		for (i = 0; i < table->count; i++)
4937 			ci_patch_with_vddc_leakage(rdev, &table->entries[i].v);
4938 	}
4939 }
4940 
4941 static void ci_patch_clock_voltage_dependency_table_with_vddci_leakage(struct radeon_device *rdev,
4942 								       struct radeon_clock_voltage_dependency_table *table)
4943 {
4944 	u32 i;
4945 
4946 	if (table) {
4947 		for (i = 0; i < table->count; i++)
4948 			ci_patch_with_vddci_leakage(rdev, &table->entries[i].v);
4949 	}
4950 }
4951 
4952 static void ci_patch_vce_clock_voltage_dependency_table_with_vddc_leakage(struct radeon_device *rdev,
4953 									  struct radeon_vce_clock_voltage_dependency_table *table)
4954 {
4955 	u32 i;
4956 
4957 	if (table) {
4958 		for (i = 0; i < table->count; i++)
4959 			ci_patch_with_vddc_leakage(rdev, &table->entries[i].v);
4960 	}
4961 }
4962 
4963 static void ci_patch_uvd_clock_voltage_dependency_table_with_vddc_leakage(struct radeon_device *rdev,
4964 									  struct radeon_uvd_clock_voltage_dependency_table *table)
4965 {
4966 	u32 i;
4967 
4968 	if (table) {
4969 		for (i = 0; i < table->count; i++)
4970 			ci_patch_with_vddc_leakage(rdev, &table->entries[i].v);
4971 	}
4972 }
4973 
4974 static void ci_patch_vddc_phase_shed_limit_table_with_vddc_leakage(struct radeon_device *rdev,
4975 								   struct radeon_phase_shedding_limits_table *table)
4976 {
4977 	u32 i;
4978 
4979 	if (table) {
4980 		for (i = 0; i < table->count; i++)
4981 			ci_patch_with_vddc_leakage(rdev, &table->entries[i].voltage);
4982 	}
4983 }
4984 
4985 static void ci_patch_clock_voltage_limits_with_vddc_leakage(struct radeon_device *rdev,
4986 							    struct radeon_clock_and_voltage_limits *table)
4987 {
4988 	if (table) {
4989 		ci_patch_with_vddc_leakage(rdev, (u16 *)&table->vddc);
4990 		ci_patch_with_vddci_leakage(rdev, (u16 *)&table->vddci);
4991 	}
4992 }
4993 
4994 static void ci_patch_cac_leakage_table_with_vddc_leakage(struct radeon_device *rdev,
4995 							 struct radeon_cac_leakage_table *table)
4996 {
4997 	u32 i;
4998 
4999 	if (table) {
5000 		for (i = 0; i < table->count; i++)
5001 			ci_patch_with_vddc_leakage(rdev, &table->entries[i].vddc);
5002 	}
5003 }
5004 
5005 static void ci_patch_dependency_tables_with_leakage(struct radeon_device *rdev)
5006 {
5007 
5008 	ci_patch_clock_voltage_dependency_table_with_vddc_leakage(rdev,
5009 								  &rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk);
5010 	ci_patch_clock_voltage_dependency_table_with_vddc_leakage(rdev,
5011 								  &rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk);
5012 	ci_patch_clock_voltage_dependency_table_with_vddc_leakage(rdev,
5013 								  &rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk);
5014 	ci_patch_clock_voltage_dependency_table_with_vddci_leakage(rdev,
5015 								   &rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk);
5016 	ci_patch_vce_clock_voltage_dependency_table_with_vddc_leakage(rdev,
5017 								      &rdev->pm.dpm.dyn_state.vce_clock_voltage_dependency_table);
5018 	ci_patch_uvd_clock_voltage_dependency_table_with_vddc_leakage(rdev,
5019 								      &rdev->pm.dpm.dyn_state.uvd_clock_voltage_dependency_table);
5020 	ci_patch_clock_voltage_dependency_table_with_vddc_leakage(rdev,
5021 								  &rdev->pm.dpm.dyn_state.samu_clock_voltage_dependency_table);
5022 	ci_patch_clock_voltage_dependency_table_with_vddc_leakage(rdev,
5023 								  &rdev->pm.dpm.dyn_state.acp_clock_voltage_dependency_table);
5024 	ci_patch_vddc_phase_shed_limit_table_with_vddc_leakage(rdev,
5025 							       &rdev->pm.dpm.dyn_state.phase_shedding_limits_table);
5026 	ci_patch_clock_voltage_limits_with_vddc_leakage(rdev,
5027 							&rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac);
5028 	ci_patch_clock_voltage_limits_with_vddc_leakage(rdev,
5029 							&rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc);
5030 	ci_patch_cac_leakage_table_with_vddc_leakage(rdev,
5031 						     &rdev->pm.dpm.dyn_state.cac_leakage_table);
5032 
5033 }
5034 
5035 static void ci_get_memory_type(struct radeon_device *rdev)
5036 {
5037 	struct ci_power_info *pi = ci_get_pi(rdev);
5038 	u32 tmp;
5039 
5040 	tmp = RREG32(MC_SEQ_MISC0);
5041 
5042 	if (((tmp & MC_SEQ_MISC0_GDDR5_MASK) >> MC_SEQ_MISC0_GDDR5_SHIFT) ==
5043 	    MC_SEQ_MISC0_GDDR5_VALUE)
5044 		pi->mem_gddr5 = true;
5045 	else
5046 		pi->mem_gddr5 = false;
5047 
5048 }
5049 
5050 static void ci_update_current_ps(struct radeon_device *rdev,
5051 				 struct radeon_ps *rps)
5052 {
5053 	struct ci_ps *new_ps = ci_get_ps(rps);
5054 	struct ci_power_info *pi = ci_get_pi(rdev);
5055 
5056 	pi->current_rps = *rps;
5057 	pi->current_ps = *new_ps;
5058 	pi->current_rps.ps_priv = &pi->current_ps;
5059 }
5060 
5061 static void ci_update_requested_ps(struct radeon_device *rdev,
5062 				   struct radeon_ps *rps)
5063 {
5064 	struct ci_ps *new_ps = ci_get_ps(rps);
5065 	struct ci_power_info *pi = ci_get_pi(rdev);
5066 
5067 	pi->requested_rps = *rps;
5068 	pi->requested_ps = *new_ps;
5069 	pi->requested_rps.ps_priv = &pi->requested_ps;
5070 }
5071 
5072 int ci_dpm_pre_set_power_state(struct radeon_device *rdev)
5073 {
5074 	struct ci_power_info *pi = ci_get_pi(rdev);
5075 	struct radeon_ps requested_ps = *rdev->pm.dpm.requested_ps;
5076 	struct radeon_ps *new_ps = &requested_ps;
5077 
5078 	ci_update_requested_ps(rdev, new_ps);
5079 
5080 	ci_apply_state_adjust_rules(rdev, &pi->requested_rps);
5081 
5082 	return 0;
5083 }
5084 
5085 void ci_dpm_post_set_power_state(struct radeon_device *rdev)
5086 {
5087 	struct ci_power_info *pi = ci_get_pi(rdev);
5088 	struct radeon_ps *new_ps = &pi->requested_rps;
5089 
5090 	ci_update_current_ps(rdev, new_ps);
5091 }
5092 
5093 
5094 void ci_dpm_setup_asic(struct radeon_device *rdev)
5095 {
5096 	int r;
5097 
5098 	r = ci_mc_load_microcode(rdev);
5099 	if (r)
5100 		DRM_ERROR("Failed to load MC firmware!\n");
5101 	ci_read_clock_registers(rdev);
5102 	ci_get_memory_type(rdev);
5103 	ci_enable_acpi_power_management(rdev);
5104 	ci_init_sclk_t(rdev);
5105 }
5106 
5107 int ci_dpm_enable(struct radeon_device *rdev)
5108 {
5109 	struct ci_power_info *pi = ci_get_pi(rdev);
5110 	struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
5111 	int ret;
5112 
5113 	if (ci_is_smc_running(rdev))
5114 		return -EINVAL;
5115 	if (pi->voltage_control != CISLANDS_VOLTAGE_CONTROL_NONE) {
5116 		ci_enable_voltage_control(rdev);
5117 		ret = ci_construct_voltage_tables(rdev);
5118 		if (ret) {
5119 			DRM_ERROR("ci_construct_voltage_tables failed\n");
5120 			return ret;
5121 		}
5122 	}
5123 	if (pi->caps_dynamic_ac_timing) {
5124 		ret = ci_initialize_mc_reg_table(rdev);
5125 		if (ret)
5126 			pi->caps_dynamic_ac_timing = false;
5127 	}
5128 	if (pi->dynamic_ss)
5129 		ci_enable_spread_spectrum(rdev, true);
5130 	if (pi->thermal_protection)
5131 		ci_enable_thermal_protection(rdev, true);
5132 	ci_program_sstp(rdev);
5133 	ci_enable_display_gap(rdev);
5134 	ci_program_vc(rdev);
5135 	ret = ci_upload_firmware(rdev);
5136 	if (ret) {
5137 		DRM_ERROR("ci_upload_firmware failed\n");
5138 		return ret;
5139 	}
5140 	ret = ci_process_firmware_header(rdev);
5141 	if (ret) {
5142 		DRM_ERROR("ci_process_firmware_header failed\n");
5143 		return ret;
5144 	}
5145 	ret = ci_initial_switch_from_arb_f0_to_f1(rdev);
5146 	if (ret) {
5147 		DRM_ERROR("ci_initial_switch_from_arb_f0_to_f1 failed\n");
5148 		return ret;
5149 	}
5150 	ret = ci_init_smc_table(rdev);
5151 	if (ret) {
5152 		DRM_ERROR("ci_init_smc_table failed\n");
5153 		return ret;
5154 	}
5155 	ret = ci_init_arb_table_index(rdev);
5156 	if (ret) {
5157 		DRM_ERROR("ci_init_arb_table_index failed\n");
5158 		return ret;
5159 	}
5160 	if (pi->caps_dynamic_ac_timing) {
5161 		ret = ci_populate_initial_mc_reg_table(rdev);
5162 		if (ret) {
5163 			DRM_ERROR("ci_populate_initial_mc_reg_table failed\n");
5164 			return ret;
5165 		}
5166 	}
5167 	ret = ci_populate_pm_base(rdev);
5168 	if (ret) {
5169 		DRM_ERROR("ci_populate_pm_base failed\n");
5170 		return ret;
5171 	}
5172 	ci_dpm_start_smc(rdev);
5173 	ci_enable_vr_hot_gpio_interrupt(rdev);
5174 	ret = ci_notify_smc_display_change(rdev, false);
5175 	if (ret) {
5176 		DRM_ERROR("ci_notify_smc_display_change failed\n");
5177 		return ret;
5178 	}
5179 	ci_enable_sclk_control(rdev, true);
5180 	ret = ci_enable_ulv(rdev, true);
5181 	if (ret) {
5182 		DRM_ERROR("ci_enable_ulv failed\n");
5183 		return ret;
5184 	}
5185 	ret = ci_enable_ds_master_switch(rdev, true);
5186 	if (ret) {
5187 		DRM_ERROR("ci_enable_ds_master_switch failed\n");
5188 		return ret;
5189 	}
5190 	ret = ci_start_dpm(rdev);
5191 	if (ret) {
5192 		DRM_ERROR("ci_start_dpm failed\n");
5193 		return ret;
5194 	}
5195 	ret = ci_enable_didt(rdev, true);
5196 	if (ret) {
5197 		DRM_ERROR("ci_enable_didt failed\n");
5198 		return ret;
5199 	}
5200 	ret = ci_enable_smc_cac(rdev, true);
5201 	if (ret) {
5202 		DRM_ERROR("ci_enable_smc_cac failed\n");
5203 		return ret;
5204 	}
5205 	ret = ci_enable_power_containment(rdev, true);
5206 	if (ret) {
5207 		DRM_ERROR("ci_enable_power_containment failed\n");
5208 		return ret;
5209 	}
5210 
5211 	ret = ci_power_control_set_level(rdev);
5212 	if (ret) {
5213 		DRM_ERROR("ci_power_control_set_level failed\n");
5214 		return ret;
5215 	}
5216 
5217 	ci_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, true);
5218 
5219 	ret = ci_enable_thermal_based_sclk_dpm(rdev, true);
5220 	if (ret) {
5221 		DRM_ERROR("ci_enable_thermal_based_sclk_dpm failed\n");
5222 		return ret;
5223 	}
5224 
5225 	ci_thermal_start_thermal_controller(rdev);
5226 
5227 	ci_update_current_ps(rdev, boot_ps);
5228 
5229 	return 0;
5230 }
5231 
5232 static int ci_set_temperature_range(struct radeon_device *rdev)
5233 {
5234 	int ret;
5235 
5236 	ret = ci_thermal_enable_alert(rdev, false);
5237 	if (ret)
5238 		return ret;
5239 	ret = ci_thermal_set_temperature_range(rdev, R600_TEMP_RANGE_MIN, R600_TEMP_RANGE_MAX);
5240 	if (ret)
5241 		return ret;
5242 	ret = ci_thermal_enable_alert(rdev, true);
5243 	if (ret)
5244 		return ret;
5245 
5246 	return ret;
5247 }
5248 
5249 int ci_dpm_late_enable(struct radeon_device *rdev)
5250 {
5251 	int ret;
5252 
5253 	ret = ci_set_temperature_range(rdev);
5254 	if (ret)
5255 		return ret;
5256 
5257 	ci_dpm_powergate_uvd(rdev, true);
5258 
5259 	return 0;
5260 }
5261 
5262 void ci_dpm_disable(struct radeon_device *rdev)
5263 {
5264 	struct ci_power_info *pi = ci_get_pi(rdev);
5265 	struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
5266 
5267 	ci_dpm_powergate_uvd(rdev, false);
5268 
5269 	if (!ci_is_smc_running(rdev))
5270 		return;
5271 
5272 	ci_thermal_stop_thermal_controller(rdev);
5273 
5274 	if (pi->thermal_protection)
5275 		ci_enable_thermal_protection(rdev, false);
5276 	ci_enable_power_containment(rdev, false);
5277 	ci_enable_smc_cac(rdev, false);
5278 	ci_enable_didt(rdev, false);
5279 	ci_enable_spread_spectrum(rdev, false);
5280 	ci_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, false);
5281 	ci_stop_dpm(rdev);
5282 	ci_enable_ds_master_switch(rdev, false);
5283 	ci_enable_ulv(rdev, false);
5284 	ci_clear_vc(rdev);
5285 	ci_reset_to_default(rdev);
5286 	ci_dpm_stop_smc(rdev);
5287 	ci_force_switch_to_arb_f0(rdev);
5288 	ci_enable_thermal_based_sclk_dpm(rdev, false);
5289 
5290 	ci_update_current_ps(rdev, boot_ps);
5291 }
5292 
5293 int ci_dpm_set_power_state(struct radeon_device *rdev)
5294 {
5295 	struct ci_power_info *pi = ci_get_pi(rdev);
5296 	struct radeon_ps *new_ps = &pi->requested_rps;
5297 	struct radeon_ps *old_ps = &pi->current_rps;
5298 	int ret;
5299 
5300 	ci_find_dpm_states_clocks_in_dpm_table(rdev, new_ps);
5301 	if (pi->pcie_performance_request)
5302 		ci_request_link_speed_change_before_state_change(rdev, new_ps, old_ps);
5303 	ret = ci_freeze_sclk_mclk_dpm(rdev);
5304 	if (ret) {
5305 		DRM_ERROR("ci_freeze_sclk_mclk_dpm failed\n");
5306 		return ret;
5307 	}
5308 	ret = ci_populate_and_upload_sclk_mclk_dpm_levels(rdev, new_ps);
5309 	if (ret) {
5310 		DRM_ERROR("ci_populate_and_upload_sclk_mclk_dpm_levels failed\n");
5311 		return ret;
5312 	}
5313 	ret = ci_generate_dpm_level_enable_mask(rdev, new_ps);
5314 	if (ret) {
5315 		DRM_ERROR("ci_generate_dpm_level_enable_mask failed\n");
5316 		return ret;
5317 	}
5318 
5319 	ret = ci_update_vce_dpm(rdev, new_ps, old_ps);
5320 	if (ret) {
5321 		DRM_ERROR("ci_update_vce_dpm failed\n");
5322 		return ret;
5323 	}
5324 
5325 	ret = ci_update_sclk_t(rdev);
5326 	if (ret) {
5327 		DRM_ERROR("ci_update_sclk_t failed\n");
5328 		return ret;
5329 	}
5330 	if (pi->caps_dynamic_ac_timing) {
5331 		ret = ci_update_and_upload_mc_reg_table(rdev);
5332 		if (ret) {
5333 			DRM_ERROR("ci_update_and_upload_mc_reg_table failed\n");
5334 			return ret;
5335 		}
5336 	}
5337 	ret = ci_program_memory_timing_parameters(rdev);
5338 	if (ret) {
5339 		DRM_ERROR("ci_program_memory_timing_parameters failed\n");
5340 		return ret;
5341 	}
5342 	ret = ci_unfreeze_sclk_mclk_dpm(rdev);
5343 	if (ret) {
5344 		DRM_ERROR("ci_unfreeze_sclk_mclk_dpm failed\n");
5345 		return ret;
5346 	}
5347 	ret = ci_upload_dpm_level_enable_mask(rdev);
5348 	if (ret) {
5349 		DRM_ERROR("ci_upload_dpm_level_enable_mask failed\n");
5350 		return ret;
5351 	}
5352 	if (pi->pcie_performance_request)
5353 		ci_notify_link_speed_change_after_state_change(rdev, new_ps, old_ps);
5354 
5355 	return 0;
5356 }
5357 
5358 #if 0
5359 void ci_dpm_reset_asic(struct radeon_device *rdev)
5360 {
5361 	ci_set_boot_state(rdev);
5362 }
5363 #endif
5364 
5365 void ci_dpm_display_configuration_changed(struct radeon_device *rdev)
5366 {
5367 	ci_program_display_gap(rdev);
5368 }
5369 
5370 union power_info {
5371 	struct _ATOM_POWERPLAY_INFO info;
5372 	struct _ATOM_POWERPLAY_INFO_V2 info_2;
5373 	struct _ATOM_POWERPLAY_INFO_V3 info_3;
5374 	struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
5375 	struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
5376 	struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
5377 };
5378 
5379 union pplib_clock_info {
5380 	struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
5381 	struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
5382 	struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
5383 	struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
5384 	struct _ATOM_PPLIB_SI_CLOCK_INFO si;
5385 	struct _ATOM_PPLIB_CI_CLOCK_INFO ci;
5386 };
5387 
5388 union pplib_power_state {
5389 	struct _ATOM_PPLIB_STATE v1;
5390 	struct _ATOM_PPLIB_STATE_V2 v2;
5391 };
5392 
5393 static void ci_parse_pplib_non_clock_info(struct radeon_device *rdev,
5394 					  struct radeon_ps *rps,
5395 					  struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
5396 					  u8 table_rev)
5397 {
5398 	rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
5399 	rps->class = le16_to_cpu(non_clock_info->usClassification);
5400 	rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
5401 
5402 	if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
5403 		rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
5404 		rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
5405 	} else {
5406 		rps->vclk = 0;
5407 		rps->dclk = 0;
5408 	}
5409 
5410 	if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT)
5411 		rdev->pm.dpm.boot_ps = rps;
5412 	if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
5413 		rdev->pm.dpm.uvd_ps = rps;
5414 }
5415 
5416 static void ci_parse_pplib_clock_info(struct radeon_device *rdev,
5417 				      struct radeon_ps *rps, int index,
5418 				      union pplib_clock_info *clock_info)
5419 {
5420 	struct ci_power_info *pi = ci_get_pi(rdev);
5421 	struct ci_ps *ps = ci_get_ps(rps);
5422 	struct ci_pl *pl = &ps->performance_levels[index];
5423 
5424 	ps->performance_level_count = index + 1;
5425 
5426 	pl->sclk = le16_to_cpu(clock_info->ci.usEngineClockLow);
5427 	pl->sclk |= clock_info->ci.ucEngineClockHigh << 16;
5428 	pl->mclk = le16_to_cpu(clock_info->ci.usMemoryClockLow);
5429 	pl->mclk |= clock_info->ci.ucMemoryClockHigh << 16;
5430 
5431 	pl->pcie_gen = r600_get_pcie_gen_support(rdev,
5432 						 pi->sys_pcie_mask,
5433 						 pi->vbios_boot_state.pcie_gen_bootup_value,
5434 						 clock_info->ci.ucPCIEGen);
5435 	pl->pcie_lane = r600_get_pcie_lane_support(rdev,
5436 						   pi->vbios_boot_state.pcie_lane_bootup_value,
5437 						   le16_to_cpu(clock_info->ci.usPCIELane));
5438 
5439 	if (rps->class & ATOM_PPLIB_CLASSIFICATION_ACPI) {
5440 		pi->acpi_pcie_gen = pl->pcie_gen;
5441 	}
5442 
5443 	if (rps->class2 & ATOM_PPLIB_CLASSIFICATION2_ULV) {
5444 		pi->ulv.supported = true;
5445 		pi->ulv.pl = *pl;
5446 		pi->ulv.cg_ulv_parameter = CISLANDS_CGULVPARAMETER_DFLT;
5447 	}
5448 
5449 	/* patch up boot state */
5450 	if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
5451 		pl->mclk = pi->vbios_boot_state.mclk_bootup_value;
5452 		pl->sclk = pi->vbios_boot_state.sclk_bootup_value;
5453 		pl->pcie_gen = pi->vbios_boot_state.pcie_gen_bootup_value;
5454 		pl->pcie_lane = pi->vbios_boot_state.pcie_lane_bootup_value;
5455 	}
5456 
5457 	switch (rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) {
5458 	case ATOM_PPLIB_CLASSIFICATION_UI_BATTERY:
5459 		pi->use_pcie_powersaving_levels = true;
5460 		if (pi->pcie_gen_powersaving.max < pl->pcie_gen)
5461 			pi->pcie_gen_powersaving.max = pl->pcie_gen;
5462 		if (pi->pcie_gen_powersaving.min > pl->pcie_gen)
5463 			pi->pcie_gen_powersaving.min = pl->pcie_gen;
5464 		if (pi->pcie_lane_powersaving.max < pl->pcie_lane)
5465 			pi->pcie_lane_powersaving.max = pl->pcie_lane;
5466 		if (pi->pcie_lane_powersaving.min > pl->pcie_lane)
5467 			pi->pcie_lane_powersaving.min = pl->pcie_lane;
5468 		break;
5469 	case ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE:
5470 		pi->use_pcie_performance_levels = true;
5471 		if (pi->pcie_gen_performance.max < pl->pcie_gen)
5472 			pi->pcie_gen_performance.max = pl->pcie_gen;
5473 		if (pi->pcie_gen_performance.min > pl->pcie_gen)
5474 			pi->pcie_gen_performance.min = pl->pcie_gen;
5475 		if (pi->pcie_lane_performance.max < pl->pcie_lane)
5476 			pi->pcie_lane_performance.max = pl->pcie_lane;
5477 		if (pi->pcie_lane_performance.min > pl->pcie_lane)
5478 			pi->pcie_lane_performance.min = pl->pcie_lane;
5479 		break;
5480 	default:
5481 		break;
5482 	}
5483 }
5484 
5485 static int ci_parse_power_table(struct radeon_device *rdev)
5486 {
5487 	struct radeon_mode_info *mode_info = &rdev->mode_info;
5488 	struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
5489 	union pplib_power_state *power_state;
5490 	int i, j, k, non_clock_array_index, clock_array_index;
5491 	union pplib_clock_info *clock_info;
5492 	struct _StateArray *state_array;
5493 	struct _ClockInfoArray *clock_info_array;
5494 	struct _NonClockInfoArray *non_clock_info_array;
5495 	union power_info *power_info;
5496 	int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
5497 	u16 data_offset;
5498 	u8 frev, crev;
5499 	u8 *power_state_offset;
5500 	struct ci_ps *ps;
5501 	int ret;
5502 
5503 	if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
5504 				   &frev, &crev, &data_offset))
5505 		return -EINVAL;
5506 	power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
5507 
5508 	state_array = (struct _StateArray *)
5509 		(mode_info->atom_context->bios + data_offset +
5510 		 le16_to_cpu(power_info->pplib.usStateArrayOffset));
5511 	clock_info_array = (struct _ClockInfoArray *)
5512 		(mode_info->atom_context->bios + data_offset +
5513 		 le16_to_cpu(power_info->pplib.usClockInfoArrayOffset));
5514 	non_clock_info_array = (struct _NonClockInfoArray *)
5515 		(mode_info->atom_context->bios + data_offset +
5516 		 le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset));
5517 
5518 	rdev->pm.dpm.ps = kcalloc(state_array->ucNumEntries,
5519 				  sizeof(struct radeon_ps),
5520 				  GFP_KERNEL);
5521 	if (!rdev->pm.dpm.ps)
5522 		return -ENOMEM;
5523 	power_state_offset = (u8 *)state_array->states;
5524 	rdev->pm.dpm.num_ps = 0;
5525 	for (i = 0; i < state_array->ucNumEntries; i++) {
5526 		u8 *idx;
5527 		power_state = (union pplib_power_state *)power_state_offset;
5528 		non_clock_array_index = power_state->v2.nonClockInfoIndex;
5529 		non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
5530 			&non_clock_info_array->nonClockInfo[non_clock_array_index];
5531 		if (!rdev->pm.power_state[i].clock_info) {
5532 			ret = -EINVAL;
5533 			goto err_free_ps;
5534 		}
5535 		ps = kzalloc(sizeof(struct ci_ps), GFP_KERNEL);
5536 		if (ps == NULL) {
5537 			ret = -ENOMEM;
5538 			goto err_free_ps;
5539 		}
5540 		rdev->pm.dpm.ps[i].ps_priv = ps;
5541 		ci_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
5542 					      non_clock_info,
5543 					      non_clock_info_array->ucEntrySize);
5544 		k = 0;
5545 		idx = (u8 *)&power_state->v2.clockInfoIndex[0];
5546 		for (j = 0; j < power_state->v2.ucNumDPMLevels; j++) {
5547 			clock_array_index = idx[j];
5548 			if (clock_array_index >= clock_info_array->ucNumEntries)
5549 				continue;
5550 			if (k >= CISLANDS_MAX_HARDWARE_POWERLEVELS)
5551 				break;
5552 			clock_info = (union pplib_clock_info *)
5553 				((u8 *)&clock_info_array->clockInfo[0] +
5554 				 (clock_array_index * clock_info_array->ucEntrySize));
5555 			ci_parse_pplib_clock_info(rdev,
5556 						  &rdev->pm.dpm.ps[i], k,
5557 						  clock_info);
5558 			k++;
5559 		}
5560 		power_state_offset += 2 + power_state->v2.ucNumDPMLevels;
5561 		rdev->pm.dpm.num_ps = i + 1;
5562 	}
5563 
5564 	/* fill in the vce power states */
5565 	for (i = 0; i < RADEON_MAX_VCE_LEVELS; i++) {
5566 		u32 sclk, mclk;
5567 		clock_array_index = rdev->pm.dpm.vce_states[i].clk_idx;
5568 		clock_info = (union pplib_clock_info *)
5569 			&clock_info_array->clockInfo[clock_array_index * clock_info_array->ucEntrySize];
5570 		sclk = le16_to_cpu(clock_info->ci.usEngineClockLow);
5571 		sclk |= clock_info->ci.ucEngineClockHigh << 16;
5572 		mclk = le16_to_cpu(clock_info->ci.usMemoryClockLow);
5573 		mclk |= clock_info->ci.ucMemoryClockHigh << 16;
5574 		rdev->pm.dpm.vce_states[i].sclk = sclk;
5575 		rdev->pm.dpm.vce_states[i].mclk = mclk;
5576 	}
5577 
5578 	return 0;
5579 
5580 err_free_ps:
5581 	for (i = 0; i < rdev->pm.dpm.num_ps; i++)
5582 		kfree(rdev->pm.dpm.ps[i].ps_priv);
5583 	kfree(rdev->pm.dpm.ps);
5584 	return ret;
5585 }
5586 
5587 static int ci_get_vbios_boot_values(struct radeon_device *rdev,
5588 				    struct ci_vbios_boot_state *boot_state)
5589 {
5590 	struct radeon_mode_info *mode_info = &rdev->mode_info;
5591 	int index = GetIndexIntoMasterTable(DATA, FirmwareInfo);
5592 	ATOM_FIRMWARE_INFO_V2_2 *firmware_info;
5593 	u8 frev, crev;
5594 	u16 data_offset;
5595 
5596 	if (atom_parse_data_header(mode_info->atom_context, index, NULL,
5597 				   &frev, &crev, &data_offset)) {
5598 		firmware_info =
5599 			(ATOM_FIRMWARE_INFO_V2_2 *)(mode_info->atom_context->bios +
5600 						    data_offset);
5601 		boot_state->mvdd_bootup_value = le16_to_cpu(firmware_info->usBootUpMVDDCVoltage);
5602 		boot_state->vddc_bootup_value = le16_to_cpu(firmware_info->usBootUpVDDCVoltage);
5603 		boot_state->vddci_bootup_value = le16_to_cpu(firmware_info->usBootUpVDDCIVoltage);
5604 		boot_state->pcie_gen_bootup_value = ci_get_current_pcie_speed(rdev);
5605 		boot_state->pcie_lane_bootup_value = ci_get_current_pcie_lane_number(rdev);
5606 		boot_state->sclk_bootup_value = le32_to_cpu(firmware_info->ulDefaultEngineClock);
5607 		boot_state->mclk_bootup_value = le32_to_cpu(firmware_info->ulDefaultMemoryClock);
5608 
5609 		return 0;
5610 	}
5611 	return -EINVAL;
5612 }
5613 
5614 void ci_dpm_fini(struct radeon_device *rdev)
5615 {
5616 	int i;
5617 
5618 	for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
5619 		kfree(rdev->pm.dpm.ps[i].ps_priv);
5620 	}
5621 	kfree(rdev->pm.dpm.ps);
5622 	kfree(rdev->pm.dpm.priv);
5623 	kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries);
5624 	r600_free_extended_power_table(rdev);
5625 }
5626 
5627 int ci_dpm_init(struct radeon_device *rdev)
5628 {
5629 	int index = GetIndexIntoMasterTable(DATA, ASIC_InternalSS_Info);
5630 	SMU7_Discrete_DpmTable  *dpm_table;
5631 	struct radeon_gpio_rec gpio;
5632 	u16 data_offset, size;
5633 	u8 frev, crev;
5634 	struct ci_power_info *pi;
5635 	enum pci_bus_speed speed_cap = PCI_SPEED_UNKNOWN;
5636 	struct pci_dev *root = rdev->pdev->bus->self;
5637 	int ret;
5638 
5639 	pi = kzalloc(sizeof(struct ci_power_info), GFP_KERNEL);
5640 	if (pi == NULL)
5641 		return -ENOMEM;
5642 	rdev->pm.dpm.priv = pi;
5643 
5644 	if (!pci_is_root_bus(rdev->pdev->bus))
5645 		speed_cap = pcie_get_speed_cap(root);
5646 	if (speed_cap == PCI_SPEED_UNKNOWN) {
5647 		pi->sys_pcie_mask = 0;
5648 	} else {
5649 		if (speed_cap == PCIE_SPEED_8_0GT)
5650 			pi->sys_pcie_mask = RADEON_PCIE_SPEED_25 |
5651 				RADEON_PCIE_SPEED_50 |
5652 				RADEON_PCIE_SPEED_80;
5653 		else if (speed_cap == PCIE_SPEED_5_0GT)
5654 			pi->sys_pcie_mask = RADEON_PCIE_SPEED_25 |
5655 				RADEON_PCIE_SPEED_50;
5656 		else
5657 			pi->sys_pcie_mask = RADEON_PCIE_SPEED_25;
5658 	}
5659 	pi->force_pcie_gen = RADEON_PCIE_GEN_INVALID;
5660 
5661 	pi->pcie_gen_performance.max = RADEON_PCIE_GEN1;
5662 	pi->pcie_gen_performance.min = RADEON_PCIE_GEN3;
5663 	pi->pcie_gen_powersaving.max = RADEON_PCIE_GEN1;
5664 	pi->pcie_gen_powersaving.min = RADEON_PCIE_GEN3;
5665 
5666 	pi->pcie_lane_performance.max = 0;
5667 	pi->pcie_lane_performance.min = 16;
5668 	pi->pcie_lane_powersaving.max = 0;
5669 	pi->pcie_lane_powersaving.min = 16;
5670 
5671 	ret = ci_get_vbios_boot_values(rdev, &pi->vbios_boot_state);
5672 	if (ret) {
5673 		kfree(rdev->pm.dpm.priv);
5674 		return ret;
5675 	}
5676 
5677 	ret = r600_get_platform_caps(rdev);
5678 	if (ret) {
5679 		kfree(rdev->pm.dpm.priv);
5680 		return ret;
5681 	}
5682 
5683 	ret = r600_parse_extended_power_table(rdev);
5684 	if (ret) {
5685 		kfree(rdev->pm.dpm.priv);
5686 		return ret;
5687 	}
5688 
5689 	ret = ci_parse_power_table(rdev);
5690 	if (ret) {
5691 		kfree(rdev->pm.dpm.priv);
5692 		r600_free_extended_power_table(rdev);
5693 		return ret;
5694 	}
5695 
5696 	pi->dll_default_on = false;
5697 	pi->sram_end = SMC_RAM_END;
5698 
5699 	pi->activity_target[0] = CISLAND_TARGETACTIVITY_DFLT;
5700 	pi->activity_target[1] = CISLAND_TARGETACTIVITY_DFLT;
5701 	pi->activity_target[2] = CISLAND_TARGETACTIVITY_DFLT;
5702 	pi->activity_target[3] = CISLAND_TARGETACTIVITY_DFLT;
5703 	pi->activity_target[4] = CISLAND_TARGETACTIVITY_DFLT;
5704 	pi->activity_target[5] = CISLAND_TARGETACTIVITY_DFLT;
5705 	pi->activity_target[6] = CISLAND_TARGETACTIVITY_DFLT;
5706 	pi->activity_target[7] = CISLAND_TARGETACTIVITY_DFLT;
5707 
5708 	pi->mclk_activity_target = CISLAND_MCLK_TARGETACTIVITY_DFLT;
5709 
5710 	pi->sclk_dpm_key_disabled = 0;
5711 	pi->mclk_dpm_key_disabled = 0;
5712 	pi->pcie_dpm_key_disabled = 0;
5713 	pi->thermal_sclk_dpm_enabled = 0;
5714 
5715 	/* mclk dpm is unstable on some R7 260X cards with the old mc ucode */
5716 	if ((rdev->pdev->device == 0x6658) &&
5717 	    (rdev->mc_fw->size == (BONAIRE_MC_UCODE_SIZE * 4))) {
5718 		pi->mclk_dpm_key_disabled = 1;
5719 	}
5720 
5721 	pi->caps_sclk_ds = true;
5722 
5723 	pi->mclk_strobe_mode_threshold = 40000;
5724 	pi->mclk_stutter_mode_threshold = 40000;
5725 	pi->mclk_edc_enable_threshold = 40000;
5726 	pi->mclk_edc_wr_enable_threshold = 40000;
5727 
5728 	ci_initialize_powertune_defaults(rdev);
5729 
5730 	pi->caps_fps = false;
5731 
5732 	pi->caps_sclk_throttle_low_notification = false;
5733 
5734 	pi->caps_uvd_dpm = true;
5735 	pi->caps_vce_dpm = true;
5736 
5737 	ci_get_leakage_voltages(rdev);
5738 	ci_patch_dependency_tables_with_leakage(rdev);
5739 	ci_set_private_data_variables_based_on_pptable(rdev);
5740 
5741 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries =
5742 		kcalloc(4,
5743 			sizeof(struct radeon_clock_voltage_dependency_entry),
5744 			GFP_KERNEL);
5745 	if (!rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries) {
5746 		ci_dpm_fini(rdev);
5747 		return -ENOMEM;
5748 	}
5749 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.count = 4;
5750 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[0].clk = 0;
5751 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[0].v = 0;
5752 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[1].clk = 36000;
5753 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[1].v = 720;
5754 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[2].clk = 54000;
5755 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[2].v = 810;
5756 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[3].clk = 72000;
5757 	rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[3].v = 900;
5758 
5759 	rdev->pm.dpm.dyn_state.mclk_sclk_ratio = 4;
5760 	rdev->pm.dpm.dyn_state.sclk_mclk_delta = 15000;
5761 	rdev->pm.dpm.dyn_state.vddc_vddci_delta = 200;
5762 
5763 	rdev->pm.dpm.dyn_state.valid_sclk_values.count = 0;
5764 	rdev->pm.dpm.dyn_state.valid_sclk_values.values = NULL;
5765 	rdev->pm.dpm.dyn_state.valid_mclk_values.count = 0;
5766 	rdev->pm.dpm.dyn_state.valid_mclk_values.values = NULL;
5767 
5768 	if (rdev->family == CHIP_HAWAII) {
5769 		pi->thermal_temp_setting.temperature_low = 94500;
5770 		pi->thermal_temp_setting.temperature_high = 95000;
5771 		pi->thermal_temp_setting.temperature_shutdown = 104000;
5772 	} else {
5773 		pi->thermal_temp_setting.temperature_low = 99500;
5774 		pi->thermal_temp_setting.temperature_high = 100000;
5775 		pi->thermal_temp_setting.temperature_shutdown = 104000;
5776 	}
5777 
5778 	pi->uvd_enabled = false;
5779 
5780 	dpm_table = &pi->smc_state_table;
5781 
5782 	gpio = radeon_atombios_lookup_gpio(rdev, VDDC_VRHOT_GPIO_PINID);
5783 	if (gpio.valid) {
5784 		dpm_table->VRHotGpio = gpio.shift;
5785 		rdev->pm.dpm.platform_caps |= ATOM_PP_PLATFORM_CAP_REGULATOR_HOT;
5786 	} else {
5787 		dpm_table->VRHotGpio = CISLANDS_UNUSED_GPIO_PIN;
5788 		rdev->pm.dpm.platform_caps &= ~ATOM_PP_PLATFORM_CAP_REGULATOR_HOT;
5789 	}
5790 
5791 	gpio = radeon_atombios_lookup_gpio(rdev, PP_AC_DC_SWITCH_GPIO_PINID);
5792 	if (gpio.valid) {
5793 		dpm_table->AcDcGpio = gpio.shift;
5794 		rdev->pm.dpm.platform_caps |= ATOM_PP_PLATFORM_CAP_HARDWAREDC;
5795 	} else {
5796 		dpm_table->AcDcGpio = CISLANDS_UNUSED_GPIO_PIN;
5797 		rdev->pm.dpm.platform_caps &= ~ATOM_PP_PLATFORM_CAP_HARDWAREDC;
5798 	}
5799 
5800 	gpio = radeon_atombios_lookup_gpio(rdev, VDDC_PCC_GPIO_PINID);
5801 	if (gpio.valid) {
5802 		u32 tmp = RREG32_SMC(CNB_PWRMGT_CNTL);
5803 
5804 		switch (gpio.shift) {
5805 		case 0:
5806 			tmp &= ~GNB_SLOW_MODE_MASK;
5807 			tmp |= GNB_SLOW_MODE(1);
5808 			break;
5809 		case 1:
5810 			tmp &= ~GNB_SLOW_MODE_MASK;
5811 			tmp |= GNB_SLOW_MODE(2);
5812 			break;
5813 		case 2:
5814 			tmp |= GNB_SLOW;
5815 			break;
5816 		case 3:
5817 			tmp |= FORCE_NB_PS1;
5818 			break;
5819 		case 4:
5820 			tmp |= DPM_ENABLED;
5821 			break;
5822 		default:
5823 			DRM_DEBUG("Invalid PCC GPIO: %u!\n", gpio.shift);
5824 			break;
5825 		}
5826 		WREG32_SMC(CNB_PWRMGT_CNTL, tmp);
5827 	}
5828 
5829 	pi->voltage_control = CISLANDS_VOLTAGE_CONTROL_NONE;
5830 	pi->vddci_control = CISLANDS_VOLTAGE_CONTROL_NONE;
5831 	pi->mvdd_control = CISLANDS_VOLTAGE_CONTROL_NONE;
5832 	if (radeon_atom_is_voltage_gpio(rdev, VOLTAGE_TYPE_VDDC, VOLTAGE_OBJ_GPIO_LUT))
5833 		pi->voltage_control = CISLANDS_VOLTAGE_CONTROL_BY_GPIO;
5834 	else if (radeon_atom_is_voltage_gpio(rdev, VOLTAGE_TYPE_VDDC, VOLTAGE_OBJ_SVID2))
5835 		pi->voltage_control = CISLANDS_VOLTAGE_CONTROL_BY_SVID2;
5836 
5837 	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_VDDCI_CONTROL) {
5838 		if (radeon_atom_is_voltage_gpio(rdev, VOLTAGE_TYPE_VDDCI, VOLTAGE_OBJ_GPIO_LUT))
5839 			pi->vddci_control = CISLANDS_VOLTAGE_CONTROL_BY_GPIO;
5840 		else if (radeon_atom_is_voltage_gpio(rdev, VOLTAGE_TYPE_VDDCI, VOLTAGE_OBJ_SVID2))
5841 			pi->vddci_control = CISLANDS_VOLTAGE_CONTROL_BY_SVID2;
5842 		else
5843 			rdev->pm.dpm.platform_caps &= ~ATOM_PP_PLATFORM_CAP_VDDCI_CONTROL;
5844 	}
5845 
5846 	if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_MVDDCONTROL) {
5847 		if (radeon_atom_is_voltage_gpio(rdev, VOLTAGE_TYPE_MVDDC, VOLTAGE_OBJ_GPIO_LUT))
5848 			pi->mvdd_control = CISLANDS_VOLTAGE_CONTROL_BY_GPIO;
5849 		else if (radeon_atom_is_voltage_gpio(rdev, VOLTAGE_TYPE_MVDDC, VOLTAGE_OBJ_SVID2))
5850 			pi->mvdd_control = CISLANDS_VOLTAGE_CONTROL_BY_SVID2;
5851 		else
5852 			rdev->pm.dpm.platform_caps &= ~ATOM_PP_PLATFORM_CAP_MVDDCONTROL;
5853 	}
5854 
5855 	pi->vddc_phase_shed_control = true;
5856 
5857 #if defined(CONFIG_ACPI)
5858 	pi->pcie_performance_request =
5859 		radeon_acpi_is_pcie_performance_request_supported(rdev);
5860 #else
5861 	pi->pcie_performance_request = false;
5862 #endif
5863 
5864 	if (atom_parse_data_header(rdev->mode_info.atom_context, index, &size,
5865 				   &frev, &crev, &data_offset)) {
5866 		pi->caps_sclk_ss_support = true;
5867 		pi->caps_mclk_ss_support = true;
5868 		pi->dynamic_ss = true;
5869 	} else {
5870 		pi->caps_sclk_ss_support = false;
5871 		pi->caps_mclk_ss_support = false;
5872 		pi->dynamic_ss = true;
5873 	}
5874 
5875 	if (rdev->pm.int_thermal_type != THERMAL_TYPE_NONE)
5876 		pi->thermal_protection = true;
5877 	else
5878 		pi->thermal_protection = false;
5879 
5880 	pi->caps_dynamic_ac_timing = true;
5881 
5882 	pi->uvd_power_gated = false;
5883 
5884 	/* make sure dc limits are valid */
5885 	if ((rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.sclk == 0) ||
5886 	    (rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.mclk == 0))
5887 		rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc =
5888 			rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
5889 
5890 	pi->fan_ctrl_is_in_default_mode = true;
5891 
5892 	return 0;
5893 }
5894 
5895 void ci_dpm_debugfs_print_current_performance_level(struct radeon_device *rdev,
5896 						    struct seq_file *m)
5897 {
5898 	struct ci_power_info *pi = ci_get_pi(rdev);
5899 	struct radeon_ps *rps = &pi->current_rps;
5900 	u32 sclk = ci_get_average_sclk_freq(rdev);
5901 	u32 mclk = ci_get_average_mclk_freq(rdev);
5902 
5903 	seq_printf(m, "uvd    %sabled\n", pi->uvd_enabled ? "en" : "dis");
5904 	seq_printf(m, "vce    %sabled\n", rps->vce_active ? "en" : "dis");
5905 	seq_printf(m, "power level avg    sclk: %u mclk: %u\n",
5906 		   sclk, mclk);
5907 }
5908 
5909 void ci_dpm_print_power_state(struct radeon_device *rdev,
5910 			      struct radeon_ps *rps)
5911 {
5912 	struct ci_ps *ps = ci_get_ps(rps);
5913 	struct ci_pl *pl;
5914 	int i;
5915 
5916 	r600_dpm_print_class_info(rps->class, rps->class2);
5917 	r600_dpm_print_cap_info(rps->caps);
5918 	printk("\tuvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
5919 	for (i = 0; i < ps->performance_level_count; i++) {
5920 		pl = &ps->performance_levels[i];
5921 		printk("\t\tpower level %d    sclk: %u mclk: %u pcie gen: %u pcie lanes: %u\n",
5922 		       i, pl->sclk, pl->mclk, pl->pcie_gen + 1, pl->pcie_lane);
5923 	}
5924 	r600_dpm_print_ps_status(rdev, rps);
5925 }
5926 
5927 u32 ci_dpm_get_current_sclk(struct radeon_device *rdev)
5928 {
5929 	u32 sclk = ci_get_average_sclk_freq(rdev);
5930 
5931 	return sclk;
5932 }
5933 
5934 u32 ci_dpm_get_current_mclk(struct radeon_device *rdev)
5935 {
5936 	u32 mclk = ci_get_average_mclk_freq(rdev);
5937 
5938 	return mclk;
5939 }
5940 
5941 u32 ci_dpm_get_sclk(struct radeon_device *rdev, bool low)
5942 {
5943 	struct ci_power_info *pi = ci_get_pi(rdev);
5944 	struct ci_ps *requested_state = ci_get_ps(&pi->requested_rps);
5945 
5946 	if (low)
5947 		return requested_state->performance_levels[0].sclk;
5948 	else
5949 		return requested_state->performance_levels[requested_state->performance_level_count - 1].sclk;
5950 }
5951 
5952 u32 ci_dpm_get_mclk(struct radeon_device *rdev, bool low)
5953 {
5954 	struct ci_power_info *pi = ci_get_pi(rdev);
5955 	struct ci_ps *requested_state = ci_get_ps(&pi->requested_rps);
5956 
5957 	if (low)
5958 		return requested_state->performance_levels[0].mclk;
5959 	else
5960 		return requested_state->performance_levels[requested_state->performance_level_count - 1].mclk;
5961 }
5962