xref: /linux/drivers/gpu/drm/radeon/r600.c (revision f2ee442115c9b6219083c019939a9cc0c9abb2f8)
1 /*
2  * Copyright 2008 Advanced Micro Devices, Inc.
3  * Copyright 2008 Red Hat Inc.
4  * Copyright 2009 Jerome Glisse.
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a
7  * copy of this software and associated documentation files (the "Software"),
8  * to deal in the Software without restriction, including without limitation
9  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
10  * and/or sell copies of the Software, and to permit persons to whom the
11  * Software is furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
19  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
20  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
21  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
22  * OTHER DEALINGS IN THE SOFTWARE.
23  *
24  * Authors: Dave Airlie
25  *          Alex Deucher
26  *          Jerome Glisse
27  */
28 #include <linux/slab.h>
29 #include <linux/seq_file.h>
30 #include <linux/firmware.h>
31 #include <linux/platform_device.h>
32 #include <linux/module.h>
33 #include "drmP.h"
34 #include "radeon_drm.h"
35 #include "radeon.h"
36 #include "radeon_asic.h"
37 #include "radeon_mode.h"
38 #include "r600d.h"
39 #include "atom.h"
40 #include "avivod.h"
41 
42 #define PFP_UCODE_SIZE 576
43 #define PM4_UCODE_SIZE 1792
44 #define RLC_UCODE_SIZE 768
45 #define R700_PFP_UCODE_SIZE 848
46 #define R700_PM4_UCODE_SIZE 1360
47 #define R700_RLC_UCODE_SIZE 1024
48 #define EVERGREEN_PFP_UCODE_SIZE 1120
49 #define EVERGREEN_PM4_UCODE_SIZE 1376
50 #define EVERGREEN_RLC_UCODE_SIZE 768
51 #define CAYMAN_RLC_UCODE_SIZE 1024
52 
53 /* Firmware Names */
54 MODULE_FIRMWARE("radeon/R600_pfp.bin");
55 MODULE_FIRMWARE("radeon/R600_me.bin");
56 MODULE_FIRMWARE("radeon/RV610_pfp.bin");
57 MODULE_FIRMWARE("radeon/RV610_me.bin");
58 MODULE_FIRMWARE("radeon/RV630_pfp.bin");
59 MODULE_FIRMWARE("radeon/RV630_me.bin");
60 MODULE_FIRMWARE("radeon/RV620_pfp.bin");
61 MODULE_FIRMWARE("radeon/RV620_me.bin");
62 MODULE_FIRMWARE("radeon/RV635_pfp.bin");
63 MODULE_FIRMWARE("radeon/RV635_me.bin");
64 MODULE_FIRMWARE("radeon/RV670_pfp.bin");
65 MODULE_FIRMWARE("radeon/RV670_me.bin");
66 MODULE_FIRMWARE("radeon/RS780_pfp.bin");
67 MODULE_FIRMWARE("radeon/RS780_me.bin");
68 MODULE_FIRMWARE("radeon/RV770_pfp.bin");
69 MODULE_FIRMWARE("radeon/RV770_me.bin");
70 MODULE_FIRMWARE("radeon/RV730_pfp.bin");
71 MODULE_FIRMWARE("radeon/RV730_me.bin");
72 MODULE_FIRMWARE("radeon/RV710_pfp.bin");
73 MODULE_FIRMWARE("radeon/RV710_me.bin");
74 MODULE_FIRMWARE("radeon/R600_rlc.bin");
75 MODULE_FIRMWARE("radeon/R700_rlc.bin");
76 MODULE_FIRMWARE("radeon/CEDAR_pfp.bin");
77 MODULE_FIRMWARE("radeon/CEDAR_me.bin");
78 MODULE_FIRMWARE("radeon/CEDAR_rlc.bin");
79 MODULE_FIRMWARE("radeon/REDWOOD_pfp.bin");
80 MODULE_FIRMWARE("radeon/REDWOOD_me.bin");
81 MODULE_FIRMWARE("radeon/REDWOOD_rlc.bin");
82 MODULE_FIRMWARE("radeon/JUNIPER_pfp.bin");
83 MODULE_FIRMWARE("radeon/JUNIPER_me.bin");
84 MODULE_FIRMWARE("radeon/JUNIPER_rlc.bin");
85 MODULE_FIRMWARE("radeon/CYPRESS_pfp.bin");
86 MODULE_FIRMWARE("radeon/CYPRESS_me.bin");
87 MODULE_FIRMWARE("radeon/CYPRESS_rlc.bin");
88 MODULE_FIRMWARE("radeon/PALM_pfp.bin");
89 MODULE_FIRMWARE("radeon/PALM_me.bin");
90 MODULE_FIRMWARE("radeon/SUMO_rlc.bin");
91 MODULE_FIRMWARE("radeon/SUMO_pfp.bin");
92 MODULE_FIRMWARE("radeon/SUMO_me.bin");
93 MODULE_FIRMWARE("radeon/SUMO2_pfp.bin");
94 MODULE_FIRMWARE("radeon/SUMO2_me.bin");
95 
96 int r600_debugfs_mc_info_init(struct radeon_device *rdev);
97 
98 /* r600,rv610,rv630,rv620,rv635,rv670 */
99 int r600_mc_wait_for_idle(struct radeon_device *rdev);
100 void r600_gpu_init(struct radeon_device *rdev);
101 void r600_fini(struct radeon_device *rdev);
102 void r600_irq_disable(struct radeon_device *rdev);
103 static void r600_pcie_gen2_enable(struct radeon_device *rdev);
104 
105 /* get temperature in millidegrees */
106 int rv6xx_get_temp(struct radeon_device *rdev)
107 {
108 	u32 temp = (RREG32(CG_THERMAL_STATUS) & ASIC_T_MASK) >>
109 		ASIC_T_SHIFT;
110 	int actual_temp = temp & 0xff;
111 
112 	if (temp & 0x100)
113 		actual_temp -= 256;
114 
115 	return actual_temp * 1000;
116 }
117 
118 void r600_pm_get_dynpm_state(struct radeon_device *rdev)
119 {
120 	int i;
121 
122 	rdev->pm.dynpm_can_upclock = true;
123 	rdev->pm.dynpm_can_downclock = true;
124 
125 	/* power state array is low to high, default is first */
126 	if ((rdev->flags & RADEON_IS_IGP) || (rdev->family == CHIP_R600)) {
127 		int min_power_state_index = 0;
128 
129 		if (rdev->pm.num_power_states > 2)
130 			min_power_state_index = 1;
131 
132 		switch (rdev->pm.dynpm_planned_action) {
133 		case DYNPM_ACTION_MINIMUM:
134 			rdev->pm.requested_power_state_index = min_power_state_index;
135 			rdev->pm.requested_clock_mode_index = 0;
136 			rdev->pm.dynpm_can_downclock = false;
137 			break;
138 		case DYNPM_ACTION_DOWNCLOCK:
139 			if (rdev->pm.current_power_state_index == min_power_state_index) {
140 				rdev->pm.requested_power_state_index = rdev->pm.current_power_state_index;
141 				rdev->pm.dynpm_can_downclock = false;
142 			} else {
143 				if (rdev->pm.active_crtc_count > 1) {
144 					for (i = 0; i < rdev->pm.num_power_states; i++) {
145 						if (rdev->pm.power_state[i].flags & RADEON_PM_STATE_SINGLE_DISPLAY_ONLY)
146 							continue;
147 						else if (i >= rdev->pm.current_power_state_index) {
148 							rdev->pm.requested_power_state_index =
149 								rdev->pm.current_power_state_index;
150 							break;
151 						} else {
152 							rdev->pm.requested_power_state_index = i;
153 							break;
154 						}
155 					}
156 				} else {
157 					if (rdev->pm.current_power_state_index == 0)
158 						rdev->pm.requested_power_state_index =
159 							rdev->pm.num_power_states - 1;
160 					else
161 						rdev->pm.requested_power_state_index =
162 							rdev->pm.current_power_state_index - 1;
163 				}
164 			}
165 			rdev->pm.requested_clock_mode_index = 0;
166 			/* don't use the power state if crtcs are active and no display flag is set */
167 			if ((rdev->pm.active_crtc_count > 0) &&
168 			    (rdev->pm.power_state[rdev->pm.requested_power_state_index].
169 			     clock_info[rdev->pm.requested_clock_mode_index].flags &
170 			     RADEON_PM_MODE_NO_DISPLAY)) {
171 				rdev->pm.requested_power_state_index++;
172 			}
173 			break;
174 		case DYNPM_ACTION_UPCLOCK:
175 			if (rdev->pm.current_power_state_index == (rdev->pm.num_power_states - 1)) {
176 				rdev->pm.requested_power_state_index = rdev->pm.current_power_state_index;
177 				rdev->pm.dynpm_can_upclock = false;
178 			} else {
179 				if (rdev->pm.active_crtc_count > 1) {
180 					for (i = (rdev->pm.num_power_states - 1); i >= 0; i--) {
181 						if (rdev->pm.power_state[i].flags & RADEON_PM_STATE_SINGLE_DISPLAY_ONLY)
182 							continue;
183 						else if (i <= rdev->pm.current_power_state_index) {
184 							rdev->pm.requested_power_state_index =
185 								rdev->pm.current_power_state_index;
186 							break;
187 						} else {
188 							rdev->pm.requested_power_state_index = i;
189 							break;
190 						}
191 					}
192 				} else
193 					rdev->pm.requested_power_state_index =
194 						rdev->pm.current_power_state_index + 1;
195 			}
196 			rdev->pm.requested_clock_mode_index = 0;
197 			break;
198 		case DYNPM_ACTION_DEFAULT:
199 			rdev->pm.requested_power_state_index = rdev->pm.default_power_state_index;
200 			rdev->pm.requested_clock_mode_index = 0;
201 			rdev->pm.dynpm_can_upclock = false;
202 			break;
203 		case DYNPM_ACTION_NONE:
204 		default:
205 			DRM_ERROR("Requested mode for not defined action\n");
206 			return;
207 		}
208 	} else {
209 		/* XXX select a power state based on AC/DC, single/dualhead, etc. */
210 		/* for now just select the first power state and switch between clock modes */
211 		/* power state array is low to high, default is first (0) */
212 		if (rdev->pm.active_crtc_count > 1) {
213 			rdev->pm.requested_power_state_index = -1;
214 			/* start at 1 as we don't want the default mode */
215 			for (i = 1; i < rdev->pm.num_power_states; i++) {
216 				if (rdev->pm.power_state[i].flags & RADEON_PM_STATE_SINGLE_DISPLAY_ONLY)
217 					continue;
218 				else if ((rdev->pm.power_state[i].type == POWER_STATE_TYPE_PERFORMANCE) ||
219 					 (rdev->pm.power_state[i].type == POWER_STATE_TYPE_BATTERY)) {
220 					rdev->pm.requested_power_state_index = i;
221 					break;
222 				}
223 			}
224 			/* if nothing selected, grab the default state. */
225 			if (rdev->pm.requested_power_state_index == -1)
226 				rdev->pm.requested_power_state_index = 0;
227 		} else
228 			rdev->pm.requested_power_state_index = 1;
229 
230 		switch (rdev->pm.dynpm_planned_action) {
231 		case DYNPM_ACTION_MINIMUM:
232 			rdev->pm.requested_clock_mode_index = 0;
233 			rdev->pm.dynpm_can_downclock = false;
234 			break;
235 		case DYNPM_ACTION_DOWNCLOCK:
236 			if (rdev->pm.requested_power_state_index == rdev->pm.current_power_state_index) {
237 				if (rdev->pm.current_clock_mode_index == 0) {
238 					rdev->pm.requested_clock_mode_index = 0;
239 					rdev->pm.dynpm_can_downclock = false;
240 				} else
241 					rdev->pm.requested_clock_mode_index =
242 						rdev->pm.current_clock_mode_index - 1;
243 			} else {
244 				rdev->pm.requested_clock_mode_index = 0;
245 				rdev->pm.dynpm_can_downclock = false;
246 			}
247 			/* don't use the power state if crtcs are active and no display flag is set */
248 			if ((rdev->pm.active_crtc_count > 0) &&
249 			    (rdev->pm.power_state[rdev->pm.requested_power_state_index].
250 			     clock_info[rdev->pm.requested_clock_mode_index].flags &
251 			     RADEON_PM_MODE_NO_DISPLAY)) {
252 				rdev->pm.requested_clock_mode_index++;
253 			}
254 			break;
255 		case DYNPM_ACTION_UPCLOCK:
256 			if (rdev->pm.requested_power_state_index == rdev->pm.current_power_state_index) {
257 				if (rdev->pm.current_clock_mode_index ==
258 				    (rdev->pm.power_state[rdev->pm.requested_power_state_index].num_clock_modes - 1)) {
259 					rdev->pm.requested_clock_mode_index = rdev->pm.current_clock_mode_index;
260 					rdev->pm.dynpm_can_upclock = false;
261 				} else
262 					rdev->pm.requested_clock_mode_index =
263 						rdev->pm.current_clock_mode_index + 1;
264 			} else {
265 				rdev->pm.requested_clock_mode_index =
266 					rdev->pm.power_state[rdev->pm.requested_power_state_index].num_clock_modes - 1;
267 				rdev->pm.dynpm_can_upclock = false;
268 			}
269 			break;
270 		case DYNPM_ACTION_DEFAULT:
271 			rdev->pm.requested_power_state_index = rdev->pm.default_power_state_index;
272 			rdev->pm.requested_clock_mode_index = 0;
273 			rdev->pm.dynpm_can_upclock = false;
274 			break;
275 		case DYNPM_ACTION_NONE:
276 		default:
277 			DRM_ERROR("Requested mode for not defined action\n");
278 			return;
279 		}
280 	}
281 
282 	DRM_DEBUG_DRIVER("Requested: e: %d m: %d p: %d\n",
283 		  rdev->pm.power_state[rdev->pm.requested_power_state_index].
284 		  clock_info[rdev->pm.requested_clock_mode_index].sclk,
285 		  rdev->pm.power_state[rdev->pm.requested_power_state_index].
286 		  clock_info[rdev->pm.requested_clock_mode_index].mclk,
287 		  rdev->pm.power_state[rdev->pm.requested_power_state_index].
288 		  pcie_lanes);
289 }
290 
291 void rs780_pm_init_profile(struct radeon_device *rdev)
292 {
293 	if (rdev->pm.num_power_states == 2) {
294 		/* default */
295 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
296 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
297 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_cm_idx = 0;
298 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_cm_idx = 0;
299 		/* low sh */
300 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_ps_idx = 0;
301 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_ps_idx = 0;
302 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_cm_idx = 0;
303 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_cm_idx = 0;
304 		/* mid sh */
305 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_ps_idx = 0;
306 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_ps_idx = 0;
307 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_cm_idx = 0;
308 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_cm_idx = 0;
309 		/* high sh */
310 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_ps_idx = 0;
311 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_ps_idx = 1;
312 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_cm_idx = 0;
313 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_cm_idx = 0;
314 		/* low mh */
315 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_ps_idx = 0;
316 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_ps_idx = 0;
317 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_cm_idx = 0;
318 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_cm_idx = 0;
319 		/* mid mh */
320 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_ps_idx = 0;
321 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_ps_idx = 0;
322 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_cm_idx = 0;
323 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_cm_idx = 0;
324 		/* high mh */
325 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_ps_idx = 0;
326 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_ps_idx = 1;
327 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_cm_idx = 0;
328 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_cm_idx = 0;
329 	} else if (rdev->pm.num_power_states == 3) {
330 		/* default */
331 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
332 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
333 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_cm_idx = 0;
334 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_cm_idx = 0;
335 		/* low sh */
336 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_ps_idx = 1;
337 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_ps_idx = 1;
338 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_cm_idx = 0;
339 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_cm_idx = 0;
340 		/* mid sh */
341 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_ps_idx = 1;
342 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_ps_idx = 1;
343 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_cm_idx = 0;
344 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_cm_idx = 0;
345 		/* high sh */
346 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_ps_idx = 1;
347 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_ps_idx = 2;
348 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_cm_idx = 0;
349 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_cm_idx = 0;
350 		/* low mh */
351 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_ps_idx = 1;
352 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_ps_idx = 1;
353 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_cm_idx = 0;
354 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_cm_idx = 0;
355 		/* mid mh */
356 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_ps_idx = 1;
357 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_ps_idx = 1;
358 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_cm_idx = 0;
359 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_cm_idx = 0;
360 		/* high mh */
361 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_ps_idx = 1;
362 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_ps_idx = 2;
363 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_cm_idx = 0;
364 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_cm_idx = 0;
365 	} else {
366 		/* default */
367 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
368 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
369 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_cm_idx = 0;
370 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_cm_idx = 0;
371 		/* low sh */
372 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_ps_idx = 2;
373 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_ps_idx = 2;
374 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_cm_idx = 0;
375 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_cm_idx = 0;
376 		/* mid sh */
377 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_ps_idx = 2;
378 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_ps_idx = 2;
379 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_cm_idx = 0;
380 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_cm_idx = 0;
381 		/* high sh */
382 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_ps_idx = 2;
383 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_ps_idx = 3;
384 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_cm_idx = 0;
385 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_cm_idx = 0;
386 		/* low mh */
387 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_ps_idx = 2;
388 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_ps_idx = 0;
389 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_cm_idx = 0;
390 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_cm_idx = 0;
391 		/* mid mh */
392 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_ps_idx = 2;
393 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_ps_idx = 0;
394 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_cm_idx = 0;
395 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_cm_idx = 0;
396 		/* high mh */
397 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_ps_idx = 2;
398 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_ps_idx = 3;
399 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_cm_idx = 0;
400 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_cm_idx = 0;
401 	}
402 }
403 
404 void r600_pm_init_profile(struct radeon_device *rdev)
405 {
406 	int idx;
407 
408 	if (rdev->family == CHIP_R600) {
409 		/* XXX */
410 		/* default */
411 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
412 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
413 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_cm_idx = 0;
414 		rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_cm_idx = 0;
415 		/* low sh */
416 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
417 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
418 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_cm_idx = 0;
419 		rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_cm_idx = 0;
420 		/* mid sh */
421 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
422 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
423 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_cm_idx = 0;
424 		rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_cm_idx = 0;
425 		/* high sh */
426 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
427 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
428 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_cm_idx = 0;
429 		rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_cm_idx = 0;
430 		/* low mh */
431 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
432 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
433 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_cm_idx = 0;
434 		rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_cm_idx = 0;
435 		/* mid mh */
436 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
437 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
438 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_cm_idx = 0;
439 		rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_cm_idx = 0;
440 		/* high mh */
441 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
442 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
443 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_cm_idx = 0;
444 		rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_cm_idx = 0;
445 	} else {
446 		if (rdev->pm.num_power_states < 4) {
447 			/* default */
448 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
449 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
450 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_cm_idx = 0;
451 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_cm_idx = 2;
452 			/* low sh */
453 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_ps_idx = 1;
454 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_ps_idx = 1;
455 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_cm_idx = 0;
456 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_cm_idx = 0;
457 			/* mid sh */
458 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_ps_idx = 1;
459 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_ps_idx = 1;
460 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_cm_idx = 0;
461 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_cm_idx = 1;
462 			/* high sh */
463 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_ps_idx = 1;
464 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_ps_idx = 1;
465 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_cm_idx = 0;
466 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_cm_idx = 2;
467 			/* low mh */
468 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_ps_idx = 2;
469 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_ps_idx = 2;
470 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_cm_idx = 0;
471 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_cm_idx = 0;
472 			/* low mh */
473 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_ps_idx = 2;
474 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_ps_idx = 2;
475 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_cm_idx = 0;
476 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_cm_idx = 1;
477 			/* high mh */
478 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_ps_idx = 2;
479 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_ps_idx = 2;
480 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_cm_idx = 0;
481 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_cm_idx = 2;
482 		} else {
483 			/* default */
484 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_ps_idx = rdev->pm.default_power_state_index;
485 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_ps_idx = rdev->pm.default_power_state_index;
486 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_off_cm_idx = 0;
487 			rdev->pm.profiles[PM_PROFILE_DEFAULT_IDX].dpms_on_cm_idx = 2;
488 			/* low sh */
489 			if (rdev->flags & RADEON_IS_MOBILITY)
490 				idx = radeon_pm_get_type_index(rdev, POWER_STATE_TYPE_BATTERY, 0);
491 			else
492 				idx = radeon_pm_get_type_index(rdev, POWER_STATE_TYPE_PERFORMANCE, 0);
493 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_ps_idx = idx;
494 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_ps_idx = idx;
495 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_off_cm_idx = 0;
496 			rdev->pm.profiles[PM_PROFILE_LOW_SH_IDX].dpms_on_cm_idx = 0;
497 			/* mid sh */
498 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_ps_idx = idx;
499 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_ps_idx = idx;
500 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_off_cm_idx = 0;
501 			rdev->pm.profiles[PM_PROFILE_MID_SH_IDX].dpms_on_cm_idx = 1;
502 			/* high sh */
503 			idx = radeon_pm_get_type_index(rdev, POWER_STATE_TYPE_PERFORMANCE, 0);
504 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_ps_idx = idx;
505 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_ps_idx = idx;
506 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_off_cm_idx = 0;
507 			rdev->pm.profiles[PM_PROFILE_HIGH_SH_IDX].dpms_on_cm_idx = 2;
508 			/* low mh */
509 			if (rdev->flags & RADEON_IS_MOBILITY)
510 				idx = radeon_pm_get_type_index(rdev, POWER_STATE_TYPE_BATTERY, 1);
511 			else
512 				idx = radeon_pm_get_type_index(rdev, POWER_STATE_TYPE_PERFORMANCE, 1);
513 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_ps_idx = idx;
514 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_ps_idx = idx;
515 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_off_cm_idx = 0;
516 			rdev->pm.profiles[PM_PROFILE_LOW_MH_IDX].dpms_on_cm_idx = 0;
517 			/* mid mh */
518 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_ps_idx = idx;
519 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_ps_idx = idx;
520 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_off_cm_idx = 0;
521 			rdev->pm.profiles[PM_PROFILE_MID_MH_IDX].dpms_on_cm_idx = 1;
522 			/* high mh */
523 			idx = radeon_pm_get_type_index(rdev, POWER_STATE_TYPE_PERFORMANCE, 1);
524 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_ps_idx = idx;
525 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_ps_idx = idx;
526 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_off_cm_idx = 0;
527 			rdev->pm.profiles[PM_PROFILE_HIGH_MH_IDX].dpms_on_cm_idx = 2;
528 		}
529 	}
530 }
531 
532 void r600_pm_misc(struct radeon_device *rdev)
533 {
534 	int req_ps_idx = rdev->pm.requested_power_state_index;
535 	int req_cm_idx = rdev->pm.requested_clock_mode_index;
536 	struct radeon_power_state *ps = &rdev->pm.power_state[req_ps_idx];
537 	struct radeon_voltage *voltage = &ps->clock_info[req_cm_idx].voltage;
538 
539 	if ((voltage->type == VOLTAGE_SW) && voltage->voltage) {
540 		/* 0xff01 is a flag rather then an actual voltage */
541 		if (voltage->voltage == 0xff01)
542 			return;
543 		if (voltage->voltage != rdev->pm.current_vddc) {
544 			radeon_atom_set_voltage(rdev, voltage->voltage, SET_VOLTAGE_TYPE_ASIC_VDDC);
545 			rdev->pm.current_vddc = voltage->voltage;
546 			DRM_DEBUG_DRIVER("Setting: v: %d\n", voltage->voltage);
547 		}
548 	}
549 }
550 
551 bool r600_gui_idle(struct radeon_device *rdev)
552 {
553 	if (RREG32(GRBM_STATUS) & GUI_ACTIVE)
554 		return false;
555 	else
556 		return true;
557 }
558 
559 /* hpd for digital panel detect/disconnect */
560 bool r600_hpd_sense(struct radeon_device *rdev, enum radeon_hpd_id hpd)
561 {
562 	bool connected = false;
563 
564 	if (ASIC_IS_DCE3(rdev)) {
565 		switch (hpd) {
566 		case RADEON_HPD_1:
567 			if (RREG32(DC_HPD1_INT_STATUS) & DC_HPDx_SENSE)
568 				connected = true;
569 			break;
570 		case RADEON_HPD_2:
571 			if (RREG32(DC_HPD2_INT_STATUS) & DC_HPDx_SENSE)
572 				connected = true;
573 			break;
574 		case RADEON_HPD_3:
575 			if (RREG32(DC_HPD3_INT_STATUS) & DC_HPDx_SENSE)
576 				connected = true;
577 			break;
578 		case RADEON_HPD_4:
579 			if (RREG32(DC_HPD4_INT_STATUS) & DC_HPDx_SENSE)
580 				connected = true;
581 			break;
582 			/* DCE 3.2 */
583 		case RADEON_HPD_5:
584 			if (RREG32(DC_HPD5_INT_STATUS) & DC_HPDx_SENSE)
585 				connected = true;
586 			break;
587 		case RADEON_HPD_6:
588 			if (RREG32(DC_HPD6_INT_STATUS) & DC_HPDx_SENSE)
589 				connected = true;
590 			break;
591 		default:
592 			break;
593 		}
594 	} else {
595 		switch (hpd) {
596 		case RADEON_HPD_1:
597 			if (RREG32(DC_HOT_PLUG_DETECT1_INT_STATUS) & DC_HOT_PLUG_DETECTx_SENSE)
598 				connected = true;
599 			break;
600 		case RADEON_HPD_2:
601 			if (RREG32(DC_HOT_PLUG_DETECT2_INT_STATUS) & DC_HOT_PLUG_DETECTx_SENSE)
602 				connected = true;
603 			break;
604 		case RADEON_HPD_3:
605 			if (RREG32(DC_HOT_PLUG_DETECT3_INT_STATUS) & DC_HOT_PLUG_DETECTx_SENSE)
606 				connected = true;
607 			break;
608 		default:
609 			break;
610 		}
611 	}
612 	return connected;
613 }
614 
615 void r600_hpd_set_polarity(struct radeon_device *rdev,
616 			   enum radeon_hpd_id hpd)
617 {
618 	u32 tmp;
619 	bool connected = r600_hpd_sense(rdev, hpd);
620 
621 	if (ASIC_IS_DCE3(rdev)) {
622 		switch (hpd) {
623 		case RADEON_HPD_1:
624 			tmp = RREG32(DC_HPD1_INT_CONTROL);
625 			if (connected)
626 				tmp &= ~DC_HPDx_INT_POLARITY;
627 			else
628 				tmp |= DC_HPDx_INT_POLARITY;
629 			WREG32(DC_HPD1_INT_CONTROL, tmp);
630 			break;
631 		case RADEON_HPD_2:
632 			tmp = RREG32(DC_HPD2_INT_CONTROL);
633 			if (connected)
634 				tmp &= ~DC_HPDx_INT_POLARITY;
635 			else
636 				tmp |= DC_HPDx_INT_POLARITY;
637 			WREG32(DC_HPD2_INT_CONTROL, tmp);
638 			break;
639 		case RADEON_HPD_3:
640 			tmp = RREG32(DC_HPD3_INT_CONTROL);
641 			if (connected)
642 				tmp &= ~DC_HPDx_INT_POLARITY;
643 			else
644 				tmp |= DC_HPDx_INT_POLARITY;
645 			WREG32(DC_HPD3_INT_CONTROL, tmp);
646 			break;
647 		case RADEON_HPD_4:
648 			tmp = RREG32(DC_HPD4_INT_CONTROL);
649 			if (connected)
650 				tmp &= ~DC_HPDx_INT_POLARITY;
651 			else
652 				tmp |= DC_HPDx_INT_POLARITY;
653 			WREG32(DC_HPD4_INT_CONTROL, tmp);
654 			break;
655 		case RADEON_HPD_5:
656 			tmp = RREG32(DC_HPD5_INT_CONTROL);
657 			if (connected)
658 				tmp &= ~DC_HPDx_INT_POLARITY;
659 			else
660 				tmp |= DC_HPDx_INT_POLARITY;
661 			WREG32(DC_HPD5_INT_CONTROL, tmp);
662 			break;
663 			/* DCE 3.2 */
664 		case RADEON_HPD_6:
665 			tmp = RREG32(DC_HPD6_INT_CONTROL);
666 			if (connected)
667 				tmp &= ~DC_HPDx_INT_POLARITY;
668 			else
669 				tmp |= DC_HPDx_INT_POLARITY;
670 			WREG32(DC_HPD6_INT_CONTROL, tmp);
671 			break;
672 		default:
673 			break;
674 		}
675 	} else {
676 		switch (hpd) {
677 		case RADEON_HPD_1:
678 			tmp = RREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL);
679 			if (connected)
680 				tmp &= ~DC_HOT_PLUG_DETECTx_INT_POLARITY;
681 			else
682 				tmp |= DC_HOT_PLUG_DETECTx_INT_POLARITY;
683 			WREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL, tmp);
684 			break;
685 		case RADEON_HPD_2:
686 			tmp = RREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL);
687 			if (connected)
688 				tmp &= ~DC_HOT_PLUG_DETECTx_INT_POLARITY;
689 			else
690 				tmp |= DC_HOT_PLUG_DETECTx_INT_POLARITY;
691 			WREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL, tmp);
692 			break;
693 		case RADEON_HPD_3:
694 			tmp = RREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL);
695 			if (connected)
696 				tmp &= ~DC_HOT_PLUG_DETECTx_INT_POLARITY;
697 			else
698 				tmp |= DC_HOT_PLUG_DETECTx_INT_POLARITY;
699 			WREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL, tmp);
700 			break;
701 		default:
702 			break;
703 		}
704 	}
705 }
706 
707 void r600_hpd_init(struct radeon_device *rdev)
708 {
709 	struct drm_device *dev = rdev->ddev;
710 	struct drm_connector *connector;
711 
712 	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
713 		struct radeon_connector *radeon_connector = to_radeon_connector(connector);
714 
715 		if (ASIC_IS_DCE3(rdev)) {
716 			u32 tmp = DC_HPDx_CONNECTION_TIMER(0x9c4) | DC_HPDx_RX_INT_TIMER(0xfa);
717 			if (ASIC_IS_DCE32(rdev))
718 				tmp |= DC_HPDx_EN;
719 
720 			switch (radeon_connector->hpd.hpd) {
721 			case RADEON_HPD_1:
722 				WREG32(DC_HPD1_CONTROL, tmp);
723 				rdev->irq.hpd[0] = true;
724 				break;
725 			case RADEON_HPD_2:
726 				WREG32(DC_HPD2_CONTROL, tmp);
727 				rdev->irq.hpd[1] = true;
728 				break;
729 			case RADEON_HPD_3:
730 				WREG32(DC_HPD3_CONTROL, tmp);
731 				rdev->irq.hpd[2] = true;
732 				break;
733 			case RADEON_HPD_4:
734 				WREG32(DC_HPD4_CONTROL, tmp);
735 				rdev->irq.hpd[3] = true;
736 				break;
737 				/* DCE 3.2 */
738 			case RADEON_HPD_5:
739 				WREG32(DC_HPD5_CONTROL, tmp);
740 				rdev->irq.hpd[4] = true;
741 				break;
742 			case RADEON_HPD_6:
743 				WREG32(DC_HPD6_CONTROL, tmp);
744 				rdev->irq.hpd[5] = true;
745 				break;
746 			default:
747 				break;
748 			}
749 		} else {
750 			switch (radeon_connector->hpd.hpd) {
751 			case RADEON_HPD_1:
752 				WREG32(DC_HOT_PLUG_DETECT1_CONTROL, DC_HOT_PLUG_DETECTx_EN);
753 				rdev->irq.hpd[0] = true;
754 				break;
755 			case RADEON_HPD_2:
756 				WREG32(DC_HOT_PLUG_DETECT2_CONTROL, DC_HOT_PLUG_DETECTx_EN);
757 				rdev->irq.hpd[1] = true;
758 				break;
759 			case RADEON_HPD_3:
760 				WREG32(DC_HOT_PLUG_DETECT3_CONTROL, DC_HOT_PLUG_DETECTx_EN);
761 				rdev->irq.hpd[2] = true;
762 				break;
763 			default:
764 				break;
765 			}
766 		}
767 		radeon_hpd_set_polarity(rdev, radeon_connector->hpd.hpd);
768 	}
769 	if (rdev->irq.installed)
770 		r600_irq_set(rdev);
771 }
772 
773 void r600_hpd_fini(struct radeon_device *rdev)
774 {
775 	struct drm_device *dev = rdev->ddev;
776 	struct drm_connector *connector;
777 
778 	if (ASIC_IS_DCE3(rdev)) {
779 		list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
780 			struct radeon_connector *radeon_connector = to_radeon_connector(connector);
781 			switch (radeon_connector->hpd.hpd) {
782 			case RADEON_HPD_1:
783 				WREG32(DC_HPD1_CONTROL, 0);
784 				rdev->irq.hpd[0] = false;
785 				break;
786 			case RADEON_HPD_2:
787 				WREG32(DC_HPD2_CONTROL, 0);
788 				rdev->irq.hpd[1] = false;
789 				break;
790 			case RADEON_HPD_3:
791 				WREG32(DC_HPD3_CONTROL, 0);
792 				rdev->irq.hpd[2] = false;
793 				break;
794 			case RADEON_HPD_4:
795 				WREG32(DC_HPD4_CONTROL, 0);
796 				rdev->irq.hpd[3] = false;
797 				break;
798 				/* DCE 3.2 */
799 			case RADEON_HPD_5:
800 				WREG32(DC_HPD5_CONTROL, 0);
801 				rdev->irq.hpd[4] = false;
802 				break;
803 			case RADEON_HPD_6:
804 				WREG32(DC_HPD6_CONTROL, 0);
805 				rdev->irq.hpd[5] = false;
806 				break;
807 			default:
808 				break;
809 			}
810 		}
811 	} else {
812 		list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
813 			struct radeon_connector *radeon_connector = to_radeon_connector(connector);
814 			switch (radeon_connector->hpd.hpd) {
815 			case RADEON_HPD_1:
816 				WREG32(DC_HOT_PLUG_DETECT1_CONTROL, 0);
817 				rdev->irq.hpd[0] = false;
818 				break;
819 			case RADEON_HPD_2:
820 				WREG32(DC_HOT_PLUG_DETECT2_CONTROL, 0);
821 				rdev->irq.hpd[1] = false;
822 				break;
823 			case RADEON_HPD_3:
824 				WREG32(DC_HOT_PLUG_DETECT3_CONTROL, 0);
825 				rdev->irq.hpd[2] = false;
826 				break;
827 			default:
828 				break;
829 			}
830 		}
831 	}
832 }
833 
834 /*
835  * R600 PCIE GART
836  */
837 void r600_pcie_gart_tlb_flush(struct radeon_device *rdev)
838 {
839 	unsigned i;
840 	u32 tmp;
841 
842 	/* flush hdp cache so updates hit vram */
843 	if ((rdev->family >= CHIP_RV770) && (rdev->family <= CHIP_RV740) &&
844 	    !(rdev->flags & RADEON_IS_AGP)) {
845 		void __iomem *ptr = (void *)rdev->gart.ptr;
846 		u32 tmp;
847 
848 		/* r7xx hw bug.  write to HDP_DEBUG1 followed by fb read
849 		 * rather than write to HDP_REG_COHERENCY_FLUSH_CNTL
850 		 * This seems to cause problems on some AGP cards. Just use the old
851 		 * method for them.
852 		 */
853 		WREG32(HDP_DEBUG1, 0);
854 		tmp = readl((void __iomem *)ptr);
855 	} else
856 		WREG32(R_005480_HDP_MEM_COHERENCY_FLUSH_CNTL, 0x1);
857 
858 	WREG32(VM_CONTEXT0_INVALIDATION_LOW_ADDR, rdev->mc.gtt_start >> 12);
859 	WREG32(VM_CONTEXT0_INVALIDATION_HIGH_ADDR, (rdev->mc.gtt_end - 1) >> 12);
860 	WREG32(VM_CONTEXT0_REQUEST_RESPONSE, REQUEST_TYPE(1));
861 	for (i = 0; i < rdev->usec_timeout; i++) {
862 		/* read MC_STATUS */
863 		tmp = RREG32(VM_CONTEXT0_REQUEST_RESPONSE);
864 		tmp = (tmp & RESPONSE_TYPE_MASK) >> RESPONSE_TYPE_SHIFT;
865 		if (tmp == 2) {
866 			printk(KERN_WARNING "[drm] r600 flush TLB failed\n");
867 			return;
868 		}
869 		if (tmp) {
870 			return;
871 		}
872 		udelay(1);
873 	}
874 }
875 
876 int r600_pcie_gart_init(struct radeon_device *rdev)
877 {
878 	int r;
879 
880 	if (rdev->gart.robj) {
881 		WARN(1, "R600 PCIE GART already initialized\n");
882 		return 0;
883 	}
884 	/* Initialize common gart structure */
885 	r = radeon_gart_init(rdev);
886 	if (r)
887 		return r;
888 	rdev->gart.table_size = rdev->gart.num_gpu_pages * 8;
889 	return radeon_gart_table_vram_alloc(rdev);
890 }
891 
892 int r600_pcie_gart_enable(struct radeon_device *rdev)
893 {
894 	u32 tmp;
895 	int r, i;
896 
897 	if (rdev->gart.robj == NULL) {
898 		dev_err(rdev->dev, "No VRAM object for PCIE GART.\n");
899 		return -EINVAL;
900 	}
901 	r = radeon_gart_table_vram_pin(rdev);
902 	if (r)
903 		return r;
904 	radeon_gart_restore(rdev);
905 
906 	/* Setup L2 cache */
907 	WREG32(VM_L2_CNTL, ENABLE_L2_CACHE | ENABLE_L2_FRAGMENT_PROCESSING |
908 				ENABLE_L2_PTE_CACHE_LRU_UPDATE_BY_WRITE |
909 				EFFECTIVE_L2_QUEUE_SIZE(7));
910 	WREG32(VM_L2_CNTL2, 0);
911 	WREG32(VM_L2_CNTL3, BANK_SELECT_0(0) | BANK_SELECT_1(1));
912 	/* Setup TLB control */
913 	tmp = ENABLE_L1_TLB | ENABLE_L1_FRAGMENT_PROCESSING |
914 		SYSTEM_ACCESS_MODE_NOT_IN_SYS |
915 		EFFECTIVE_L1_TLB_SIZE(5) | EFFECTIVE_L1_QUEUE_SIZE(5) |
916 		ENABLE_WAIT_L2_QUERY;
917 	WREG32(MC_VM_L1_TLB_MCB_RD_SYS_CNTL, tmp);
918 	WREG32(MC_VM_L1_TLB_MCB_WR_SYS_CNTL, tmp);
919 	WREG32(MC_VM_L1_TLB_MCB_RD_HDP_CNTL, tmp | ENABLE_L1_STRICT_ORDERING);
920 	WREG32(MC_VM_L1_TLB_MCB_WR_HDP_CNTL, tmp);
921 	WREG32(MC_VM_L1_TLB_MCD_RD_A_CNTL, tmp);
922 	WREG32(MC_VM_L1_TLB_MCD_WR_A_CNTL, tmp);
923 	WREG32(MC_VM_L1_TLB_MCD_RD_B_CNTL, tmp);
924 	WREG32(MC_VM_L1_TLB_MCD_WR_B_CNTL, tmp);
925 	WREG32(MC_VM_L1_TLB_MCB_RD_GFX_CNTL, tmp);
926 	WREG32(MC_VM_L1_TLB_MCB_WR_GFX_CNTL, tmp);
927 	WREG32(MC_VM_L1_TLB_MCB_RD_PDMA_CNTL, tmp);
928 	WREG32(MC_VM_L1_TLB_MCB_WR_PDMA_CNTL, tmp);
929 	WREG32(MC_VM_L1_TLB_MCB_RD_SEM_CNTL, tmp | ENABLE_SEMAPHORE_MODE);
930 	WREG32(MC_VM_L1_TLB_MCB_WR_SEM_CNTL, tmp | ENABLE_SEMAPHORE_MODE);
931 	WREG32(VM_CONTEXT0_PAGE_TABLE_START_ADDR, rdev->mc.gtt_start >> 12);
932 	WREG32(VM_CONTEXT0_PAGE_TABLE_END_ADDR, rdev->mc.gtt_end >> 12);
933 	WREG32(VM_CONTEXT0_PAGE_TABLE_BASE_ADDR, rdev->gart.table_addr >> 12);
934 	WREG32(VM_CONTEXT0_CNTL, ENABLE_CONTEXT | PAGE_TABLE_DEPTH(0) |
935 				RANGE_PROTECTION_FAULT_ENABLE_DEFAULT);
936 	WREG32(VM_CONTEXT0_PROTECTION_FAULT_DEFAULT_ADDR,
937 			(u32)(rdev->dummy_page.addr >> 12));
938 	for (i = 1; i < 7; i++)
939 		WREG32(VM_CONTEXT0_CNTL + (i * 4), 0);
940 
941 	r600_pcie_gart_tlb_flush(rdev);
942 	DRM_INFO("PCIE GART of %uM enabled (table at 0x%016llX).\n",
943 		 (unsigned)(rdev->mc.gtt_size >> 20),
944 		 (unsigned long long)rdev->gart.table_addr);
945 	rdev->gart.ready = true;
946 	return 0;
947 }
948 
949 void r600_pcie_gart_disable(struct radeon_device *rdev)
950 {
951 	u32 tmp;
952 	int i;
953 
954 	/* Disable all tables */
955 	for (i = 0; i < 7; i++)
956 		WREG32(VM_CONTEXT0_CNTL + (i * 4), 0);
957 
958 	/* Disable L2 cache */
959 	WREG32(VM_L2_CNTL, ENABLE_L2_FRAGMENT_PROCESSING |
960 				EFFECTIVE_L2_QUEUE_SIZE(7));
961 	WREG32(VM_L2_CNTL3, BANK_SELECT_0(0) | BANK_SELECT_1(1));
962 	/* Setup L1 TLB control */
963 	tmp = EFFECTIVE_L1_TLB_SIZE(5) | EFFECTIVE_L1_QUEUE_SIZE(5) |
964 		ENABLE_WAIT_L2_QUERY;
965 	WREG32(MC_VM_L1_TLB_MCD_RD_A_CNTL, tmp);
966 	WREG32(MC_VM_L1_TLB_MCD_WR_A_CNTL, tmp);
967 	WREG32(MC_VM_L1_TLB_MCD_RD_B_CNTL, tmp);
968 	WREG32(MC_VM_L1_TLB_MCD_WR_B_CNTL, tmp);
969 	WREG32(MC_VM_L1_TLB_MCB_RD_GFX_CNTL, tmp);
970 	WREG32(MC_VM_L1_TLB_MCB_WR_GFX_CNTL, tmp);
971 	WREG32(MC_VM_L1_TLB_MCB_RD_PDMA_CNTL, tmp);
972 	WREG32(MC_VM_L1_TLB_MCB_WR_PDMA_CNTL, tmp);
973 	WREG32(MC_VM_L1_TLB_MCB_RD_SEM_CNTL, tmp);
974 	WREG32(MC_VM_L1_TLB_MCB_WR_SEM_CNTL, tmp);
975 	WREG32(MC_VM_L1_TLB_MCB_RD_SYS_CNTL, tmp);
976 	WREG32(MC_VM_L1_TLB_MCB_WR_SYS_CNTL, tmp);
977 	WREG32(MC_VM_L1_TLB_MCB_RD_HDP_CNTL, tmp);
978 	WREG32(MC_VM_L1_TLB_MCB_WR_HDP_CNTL, tmp);
979 	radeon_gart_table_vram_unpin(rdev);
980 }
981 
982 void r600_pcie_gart_fini(struct radeon_device *rdev)
983 {
984 	radeon_gart_fini(rdev);
985 	r600_pcie_gart_disable(rdev);
986 	radeon_gart_table_vram_free(rdev);
987 }
988 
989 void r600_agp_enable(struct radeon_device *rdev)
990 {
991 	u32 tmp;
992 	int i;
993 
994 	/* Setup L2 cache */
995 	WREG32(VM_L2_CNTL, ENABLE_L2_CACHE | ENABLE_L2_FRAGMENT_PROCESSING |
996 				ENABLE_L2_PTE_CACHE_LRU_UPDATE_BY_WRITE |
997 				EFFECTIVE_L2_QUEUE_SIZE(7));
998 	WREG32(VM_L2_CNTL2, 0);
999 	WREG32(VM_L2_CNTL3, BANK_SELECT_0(0) | BANK_SELECT_1(1));
1000 	/* Setup TLB control */
1001 	tmp = ENABLE_L1_TLB | ENABLE_L1_FRAGMENT_PROCESSING |
1002 		SYSTEM_ACCESS_MODE_NOT_IN_SYS |
1003 		EFFECTIVE_L1_TLB_SIZE(5) | EFFECTIVE_L1_QUEUE_SIZE(5) |
1004 		ENABLE_WAIT_L2_QUERY;
1005 	WREG32(MC_VM_L1_TLB_MCB_RD_SYS_CNTL, tmp);
1006 	WREG32(MC_VM_L1_TLB_MCB_WR_SYS_CNTL, tmp);
1007 	WREG32(MC_VM_L1_TLB_MCB_RD_HDP_CNTL, tmp | ENABLE_L1_STRICT_ORDERING);
1008 	WREG32(MC_VM_L1_TLB_MCB_WR_HDP_CNTL, tmp);
1009 	WREG32(MC_VM_L1_TLB_MCD_RD_A_CNTL, tmp);
1010 	WREG32(MC_VM_L1_TLB_MCD_WR_A_CNTL, tmp);
1011 	WREG32(MC_VM_L1_TLB_MCD_RD_B_CNTL, tmp);
1012 	WREG32(MC_VM_L1_TLB_MCD_WR_B_CNTL, tmp);
1013 	WREG32(MC_VM_L1_TLB_MCB_RD_GFX_CNTL, tmp);
1014 	WREG32(MC_VM_L1_TLB_MCB_WR_GFX_CNTL, tmp);
1015 	WREG32(MC_VM_L1_TLB_MCB_RD_PDMA_CNTL, tmp);
1016 	WREG32(MC_VM_L1_TLB_MCB_WR_PDMA_CNTL, tmp);
1017 	WREG32(MC_VM_L1_TLB_MCB_RD_SEM_CNTL, tmp | ENABLE_SEMAPHORE_MODE);
1018 	WREG32(MC_VM_L1_TLB_MCB_WR_SEM_CNTL, tmp | ENABLE_SEMAPHORE_MODE);
1019 	for (i = 0; i < 7; i++)
1020 		WREG32(VM_CONTEXT0_CNTL + (i * 4), 0);
1021 }
1022 
1023 int r600_mc_wait_for_idle(struct radeon_device *rdev)
1024 {
1025 	unsigned i;
1026 	u32 tmp;
1027 
1028 	for (i = 0; i < rdev->usec_timeout; i++) {
1029 		/* read MC_STATUS */
1030 		tmp = RREG32(R_000E50_SRBM_STATUS) & 0x3F00;
1031 		if (!tmp)
1032 			return 0;
1033 		udelay(1);
1034 	}
1035 	return -1;
1036 }
1037 
1038 static void r600_mc_program(struct radeon_device *rdev)
1039 {
1040 	struct rv515_mc_save save;
1041 	u32 tmp;
1042 	int i, j;
1043 
1044 	/* Initialize HDP */
1045 	for (i = 0, j = 0; i < 32; i++, j += 0x18) {
1046 		WREG32((0x2c14 + j), 0x00000000);
1047 		WREG32((0x2c18 + j), 0x00000000);
1048 		WREG32((0x2c1c + j), 0x00000000);
1049 		WREG32((0x2c20 + j), 0x00000000);
1050 		WREG32((0x2c24 + j), 0x00000000);
1051 	}
1052 	WREG32(HDP_REG_COHERENCY_FLUSH_CNTL, 0);
1053 
1054 	rv515_mc_stop(rdev, &save);
1055 	if (r600_mc_wait_for_idle(rdev)) {
1056 		dev_warn(rdev->dev, "Wait for MC idle timedout !\n");
1057 	}
1058 	/* Lockout access through VGA aperture (doesn't exist before R600) */
1059 	WREG32(VGA_HDP_CONTROL, VGA_MEMORY_DISABLE);
1060 	/* Update configuration */
1061 	if (rdev->flags & RADEON_IS_AGP) {
1062 		if (rdev->mc.vram_start < rdev->mc.gtt_start) {
1063 			/* VRAM before AGP */
1064 			WREG32(MC_VM_SYSTEM_APERTURE_LOW_ADDR,
1065 				rdev->mc.vram_start >> 12);
1066 			WREG32(MC_VM_SYSTEM_APERTURE_HIGH_ADDR,
1067 				rdev->mc.gtt_end >> 12);
1068 		} else {
1069 			/* VRAM after AGP */
1070 			WREG32(MC_VM_SYSTEM_APERTURE_LOW_ADDR,
1071 				rdev->mc.gtt_start >> 12);
1072 			WREG32(MC_VM_SYSTEM_APERTURE_HIGH_ADDR,
1073 				rdev->mc.vram_end >> 12);
1074 		}
1075 	} else {
1076 		WREG32(MC_VM_SYSTEM_APERTURE_LOW_ADDR, rdev->mc.vram_start >> 12);
1077 		WREG32(MC_VM_SYSTEM_APERTURE_HIGH_ADDR, rdev->mc.vram_end >> 12);
1078 	}
1079 	WREG32(MC_VM_SYSTEM_APERTURE_DEFAULT_ADDR, rdev->vram_scratch.gpu_addr >> 12);
1080 	tmp = ((rdev->mc.vram_end >> 24) & 0xFFFF) << 16;
1081 	tmp |= ((rdev->mc.vram_start >> 24) & 0xFFFF);
1082 	WREG32(MC_VM_FB_LOCATION, tmp);
1083 	WREG32(HDP_NONSURFACE_BASE, (rdev->mc.vram_start >> 8));
1084 	WREG32(HDP_NONSURFACE_INFO, (2 << 7));
1085 	WREG32(HDP_NONSURFACE_SIZE, 0x3FFFFFFF);
1086 	if (rdev->flags & RADEON_IS_AGP) {
1087 		WREG32(MC_VM_AGP_TOP, rdev->mc.gtt_end >> 22);
1088 		WREG32(MC_VM_AGP_BOT, rdev->mc.gtt_start >> 22);
1089 		WREG32(MC_VM_AGP_BASE, rdev->mc.agp_base >> 22);
1090 	} else {
1091 		WREG32(MC_VM_AGP_BASE, 0);
1092 		WREG32(MC_VM_AGP_TOP, 0x0FFFFFFF);
1093 		WREG32(MC_VM_AGP_BOT, 0x0FFFFFFF);
1094 	}
1095 	if (r600_mc_wait_for_idle(rdev)) {
1096 		dev_warn(rdev->dev, "Wait for MC idle timedout !\n");
1097 	}
1098 	rv515_mc_resume(rdev, &save);
1099 	/* we need to own VRAM, so turn off the VGA renderer here
1100 	 * to stop it overwriting our objects */
1101 	rv515_vga_render_disable(rdev);
1102 }
1103 
1104 /**
1105  * r600_vram_gtt_location - try to find VRAM & GTT location
1106  * @rdev: radeon device structure holding all necessary informations
1107  * @mc: memory controller structure holding memory informations
1108  *
1109  * Function will place try to place VRAM at same place as in CPU (PCI)
1110  * address space as some GPU seems to have issue when we reprogram at
1111  * different address space.
1112  *
1113  * If there is not enough space to fit the unvisible VRAM after the
1114  * aperture then we limit the VRAM size to the aperture.
1115  *
1116  * If we are using AGP then place VRAM adjacent to AGP aperture are we need
1117  * them to be in one from GPU point of view so that we can program GPU to
1118  * catch access outside them (weird GPU policy see ??).
1119  *
1120  * This function will never fails, worst case are limiting VRAM or GTT.
1121  *
1122  * Note: GTT start, end, size should be initialized before calling this
1123  * function on AGP platform.
1124  */
1125 static void r600_vram_gtt_location(struct radeon_device *rdev, struct radeon_mc *mc)
1126 {
1127 	u64 size_bf, size_af;
1128 
1129 	if (mc->mc_vram_size > 0xE0000000) {
1130 		/* leave room for at least 512M GTT */
1131 		dev_warn(rdev->dev, "limiting VRAM\n");
1132 		mc->real_vram_size = 0xE0000000;
1133 		mc->mc_vram_size = 0xE0000000;
1134 	}
1135 	if (rdev->flags & RADEON_IS_AGP) {
1136 		size_bf = mc->gtt_start;
1137 		size_af = 0xFFFFFFFF - mc->gtt_end + 1;
1138 		if (size_bf > size_af) {
1139 			if (mc->mc_vram_size > size_bf) {
1140 				dev_warn(rdev->dev, "limiting VRAM\n");
1141 				mc->real_vram_size = size_bf;
1142 				mc->mc_vram_size = size_bf;
1143 			}
1144 			mc->vram_start = mc->gtt_start - mc->mc_vram_size;
1145 		} else {
1146 			if (mc->mc_vram_size > size_af) {
1147 				dev_warn(rdev->dev, "limiting VRAM\n");
1148 				mc->real_vram_size = size_af;
1149 				mc->mc_vram_size = size_af;
1150 			}
1151 			mc->vram_start = mc->gtt_end;
1152 		}
1153 		mc->vram_end = mc->vram_start + mc->mc_vram_size - 1;
1154 		dev_info(rdev->dev, "VRAM: %lluM 0x%08llX - 0x%08llX (%lluM used)\n",
1155 				mc->mc_vram_size >> 20, mc->vram_start,
1156 				mc->vram_end, mc->real_vram_size >> 20);
1157 	} else {
1158 		u64 base = 0;
1159 		if (rdev->flags & RADEON_IS_IGP) {
1160 			base = RREG32(MC_VM_FB_LOCATION) & 0xFFFF;
1161 			base <<= 24;
1162 		}
1163 		radeon_vram_location(rdev, &rdev->mc, base);
1164 		rdev->mc.gtt_base_align = 0;
1165 		radeon_gtt_location(rdev, mc);
1166 	}
1167 }
1168 
1169 int r600_mc_init(struct radeon_device *rdev)
1170 {
1171 	u32 tmp;
1172 	int chansize, numchan;
1173 
1174 	/* Get VRAM informations */
1175 	rdev->mc.vram_is_ddr = true;
1176 	tmp = RREG32(RAMCFG);
1177 	if (tmp & CHANSIZE_OVERRIDE) {
1178 		chansize = 16;
1179 	} else if (tmp & CHANSIZE_MASK) {
1180 		chansize = 64;
1181 	} else {
1182 		chansize = 32;
1183 	}
1184 	tmp = RREG32(CHMAP);
1185 	switch ((tmp & NOOFCHAN_MASK) >> NOOFCHAN_SHIFT) {
1186 	case 0:
1187 	default:
1188 		numchan = 1;
1189 		break;
1190 	case 1:
1191 		numchan = 2;
1192 		break;
1193 	case 2:
1194 		numchan = 4;
1195 		break;
1196 	case 3:
1197 		numchan = 8;
1198 		break;
1199 	}
1200 	rdev->mc.vram_width = numchan * chansize;
1201 	/* Could aper size report 0 ? */
1202 	rdev->mc.aper_base = pci_resource_start(rdev->pdev, 0);
1203 	rdev->mc.aper_size = pci_resource_len(rdev->pdev, 0);
1204 	/* Setup GPU memory space */
1205 	rdev->mc.mc_vram_size = RREG32(CONFIG_MEMSIZE);
1206 	rdev->mc.real_vram_size = RREG32(CONFIG_MEMSIZE);
1207 	rdev->mc.visible_vram_size = rdev->mc.aper_size;
1208 	r600_vram_gtt_location(rdev, &rdev->mc);
1209 
1210 	if (rdev->flags & RADEON_IS_IGP) {
1211 		rs690_pm_info(rdev);
1212 		rdev->mc.igp_sideport_enabled = radeon_atombios_sideport_present(rdev);
1213 	}
1214 	radeon_update_bandwidth_info(rdev);
1215 	return 0;
1216 }
1217 
1218 int r600_vram_scratch_init(struct radeon_device *rdev)
1219 {
1220 	int r;
1221 
1222 	if (rdev->vram_scratch.robj == NULL) {
1223 		r = radeon_bo_create(rdev, RADEON_GPU_PAGE_SIZE,
1224 				     PAGE_SIZE, true, RADEON_GEM_DOMAIN_VRAM,
1225 				     &rdev->vram_scratch.robj);
1226 		if (r) {
1227 			return r;
1228 		}
1229 	}
1230 
1231 	r = radeon_bo_reserve(rdev->vram_scratch.robj, false);
1232 	if (unlikely(r != 0))
1233 		return r;
1234 	r = radeon_bo_pin(rdev->vram_scratch.robj,
1235 			  RADEON_GEM_DOMAIN_VRAM, &rdev->vram_scratch.gpu_addr);
1236 	if (r) {
1237 		radeon_bo_unreserve(rdev->vram_scratch.robj);
1238 		return r;
1239 	}
1240 	r = radeon_bo_kmap(rdev->vram_scratch.robj,
1241 				(void **)&rdev->vram_scratch.ptr);
1242 	if (r)
1243 		radeon_bo_unpin(rdev->vram_scratch.robj);
1244 	radeon_bo_unreserve(rdev->vram_scratch.robj);
1245 
1246 	return r;
1247 }
1248 
1249 void r600_vram_scratch_fini(struct radeon_device *rdev)
1250 {
1251 	int r;
1252 
1253 	if (rdev->vram_scratch.robj == NULL) {
1254 		return;
1255 	}
1256 	r = radeon_bo_reserve(rdev->vram_scratch.robj, false);
1257 	if (likely(r == 0)) {
1258 		radeon_bo_kunmap(rdev->vram_scratch.robj);
1259 		radeon_bo_unpin(rdev->vram_scratch.robj);
1260 		radeon_bo_unreserve(rdev->vram_scratch.robj);
1261 	}
1262 	radeon_bo_unref(&rdev->vram_scratch.robj);
1263 }
1264 
1265 /* We doesn't check that the GPU really needs a reset we simply do the
1266  * reset, it's up to the caller to determine if the GPU needs one. We
1267  * might add an helper function to check that.
1268  */
1269 int r600_gpu_soft_reset(struct radeon_device *rdev)
1270 {
1271 	struct rv515_mc_save save;
1272 	u32 grbm_busy_mask = S_008010_VC_BUSY(1) | S_008010_VGT_BUSY_NO_DMA(1) |
1273 				S_008010_VGT_BUSY(1) | S_008010_TA03_BUSY(1) |
1274 				S_008010_TC_BUSY(1) | S_008010_SX_BUSY(1) |
1275 				S_008010_SH_BUSY(1) | S_008010_SPI03_BUSY(1) |
1276 				S_008010_SMX_BUSY(1) | S_008010_SC_BUSY(1) |
1277 				S_008010_PA_BUSY(1) | S_008010_DB03_BUSY(1) |
1278 				S_008010_CR_BUSY(1) | S_008010_CB03_BUSY(1) |
1279 				S_008010_GUI_ACTIVE(1);
1280 	u32 grbm2_busy_mask = S_008014_SPI0_BUSY(1) | S_008014_SPI1_BUSY(1) |
1281 			S_008014_SPI2_BUSY(1) | S_008014_SPI3_BUSY(1) |
1282 			S_008014_TA0_BUSY(1) | S_008014_TA1_BUSY(1) |
1283 			S_008014_TA2_BUSY(1) | S_008014_TA3_BUSY(1) |
1284 			S_008014_DB0_BUSY(1) | S_008014_DB1_BUSY(1) |
1285 			S_008014_DB2_BUSY(1) | S_008014_DB3_BUSY(1) |
1286 			S_008014_CB0_BUSY(1) | S_008014_CB1_BUSY(1) |
1287 			S_008014_CB2_BUSY(1) | S_008014_CB3_BUSY(1);
1288 	u32 tmp;
1289 
1290 	if (!(RREG32(GRBM_STATUS) & GUI_ACTIVE))
1291 		return 0;
1292 
1293 	dev_info(rdev->dev, "GPU softreset \n");
1294 	dev_info(rdev->dev, "  R_008010_GRBM_STATUS=0x%08X\n",
1295 		RREG32(R_008010_GRBM_STATUS));
1296 	dev_info(rdev->dev, "  R_008014_GRBM_STATUS2=0x%08X\n",
1297 		RREG32(R_008014_GRBM_STATUS2));
1298 	dev_info(rdev->dev, "  R_000E50_SRBM_STATUS=0x%08X\n",
1299 		RREG32(R_000E50_SRBM_STATUS));
1300 	rv515_mc_stop(rdev, &save);
1301 	if (r600_mc_wait_for_idle(rdev)) {
1302 		dev_warn(rdev->dev, "Wait for MC idle timedout !\n");
1303 	}
1304 	/* Disable CP parsing/prefetching */
1305 	WREG32(R_0086D8_CP_ME_CNTL, S_0086D8_CP_ME_HALT(1));
1306 	/* Check if any of the rendering block is busy and reset it */
1307 	if ((RREG32(R_008010_GRBM_STATUS) & grbm_busy_mask) ||
1308 	    (RREG32(R_008014_GRBM_STATUS2) & grbm2_busy_mask)) {
1309 		tmp = S_008020_SOFT_RESET_CR(1) |
1310 			S_008020_SOFT_RESET_DB(1) |
1311 			S_008020_SOFT_RESET_CB(1) |
1312 			S_008020_SOFT_RESET_PA(1) |
1313 			S_008020_SOFT_RESET_SC(1) |
1314 			S_008020_SOFT_RESET_SMX(1) |
1315 			S_008020_SOFT_RESET_SPI(1) |
1316 			S_008020_SOFT_RESET_SX(1) |
1317 			S_008020_SOFT_RESET_SH(1) |
1318 			S_008020_SOFT_RESET_TC(1) |
1319 			S_008020_SOFT_RESET_TA(1) |
1320 			S_008020_SOFT_RESET_VC(1) |
1321 			S_008020_SOFT_RESET_VGT(1);
1322 		dev_info(rdev->dev, "  R_008020_GRBM_SOFT_RESET=0x%08X\n", tmp);
1323 		WREG32(R_008020_GRBM_SOFT_RESET, tmp);
1324 		RREG32(R_008020_GRBM_SOFT_RESET);
1325 		mdelay(15);
1326 		WREG32(R_008020_GRBM_SOFT_RESET, 0);
1327 	}
1328 	/* Reset CP (we always reset CP) */
1329 	tmp = S_008020_SOFT_RESET_CP(1);
1330 	dev_info(rdev->dev, "R_008020_GRBM_SOFT_RESET=0x%08X\n", tmp);
1331 	WREG32(R_008020_GRBM_SOFT_RESET, tmp);
1332 	RREG32(R_008020_GRBM_SOFT_RESET);
1333 	mdelay(15);
1334 	WREG32(R_008020_GRBM_SOFT_RESET, 0);
1335 	/* Wait a little for things to settle down */
1336 	mdelay(1);
1337 	dev_info(rdev->dev, "  R_008010_GRBM_STATUS=0x%08X\n",
1338 		RREG32(R_008010_GRBM_STATUS));
1339 	dev_info(rdev->dev, "  R_008014_GRBM_STATUS2=0x%08X\n",
1340 		RREG32(R_008014_GRBM_STATUS2));
1341 	dev_info(rdev->dev, "  R_000E50_SRBM_STATUS=0x%08X\n",
1342 		RREG32(R_000E50_SRBM_STATUS));
1343 	rv515_mc_resume(rdev, &save);
1344 	return 0;
1345 }
1346 
1347 bool r600_gpu_is_lockup(struct radeon_device *rdev)
1348 {
1349 	u32 srbm_status;
1350 	u32 grbm_status;
1351 	u32 grbm_status2;
1352 	struct r100_gpu_lockup *lockup;
1353 	int r;
1354 
1355 	if (rdev->family >= CHIP_RV770)
1356 		lockup = &rdev->config.rv770.lockup;
1357 	else
1358 		lockup = &rdev->config.r600.lockup;
1359 
1360 	srbm_status = RREG32(R_000E50_SRBM_STATUS);
1361 	grbm_status = RREG32(R_008010_GRBM_STATUS);
1362 	grbm_status2 = RREG32(R_008014_GRBM_STATUS2);
1363 	if (!G_008010_GUI_ACTIVE(grbm_status)) {
1364 		r100_gpu_lockup_update(lockup, &rdev->cp);
1365 		return false;
1366 	}
1367 	/* force CP activities */
1368 	r = radeon_ring_lock(rdev, 2);
1369 	if (!r) {
1370 		/* PACKET2 NOP */
1371 		radeon_ring_write(rdev, 0x80000000);
1372 		radeon_ring_write(rdev, 0x80000000);
1373 		radeon_ring_unlock_commit(rdev);
1374 	}
1375 	rdev->cp.rptr = RREG32(R600_CP_RB_RPTR);
1376 	return r100_gpu_cp_is_lockup(rdev, lockup, &rdev->cp);
1377 }
1378 
1379 int r600_asic_reset(struct radeon_device *rdev)
1380 {
1381 	return r600_gpu_soft_reset(rdev);
1382 }
1383 
1384 static u32 r600_get_tile_pipe_to_backend_map(u32 num_tile_pipes,
1385 					     u32 num_backends,
1386 					     u32 backend_disable_mask)
1387 {
1388 	u32 backend_map = 0;
1389 	u32 enabled_backends_mask;
1390 	u32 enabled_backends_count;
1391 	u32 cur_pipe;
1392 	u32 swizzle_pipe[R6XX_MAX_PIPES];
1393 	u32 cur_backend;
1394 	u32 i;
1395 
1396 	if (num_tile_pipes > R6XX_MAX_PIPES)
1397 		num_tile_pipes = R6XX_MAX_PIPES;
1398 	if (num_tile_pipes < 1)
1399 		num_tile_pipes = 1;
1400 	if (num_backends > R6XX_MAX_BACKENDS)
1401 		num_backends = R6XX_MAX_BACKENDS;
1402 	if (num_backends < 1)
1403 		num_backends = 1;
1404 
1405 	enabled_backends_mask = 0;
1406 	enabled_backends_count = 0;
1407 	for (i = 0; i < R6XX_MAX_BACKENDS; ++i) {
1408 		if (((backend_disable_mask >> i) & 1) == 0) {
1409 			enabled_backends_mask |= (1 << i);
1410 			++enabled_backends_count;
1411 		}
1412 		if (enabled_backends_count == num_backends)
1413 			break;
1414 	}
1415 
1416 	if (enabled_backends_count == 0) {
1417 		enabled_backends_mask = 1;
1418 		enabled_backends_count = 1;
1419 	}
1420 
1421 	if (enabled_backends_count != num_backends)
1422 		num_backends = enabled_backends_count;
1423 
1424 	memset((uint8_t *)&swizzle_pipe[0], 0, sizeof(u32) * R6XX_MAX_PIPES);
1425 	switch (num_tile_pipes) {
1426 	case 1:
1427 		swizzle_pipe[0] = 0;
1428 		break;
1429 	case 2:
1430 		swizzle_pipe[0] = 0;
1431 		swizzle_pipe[1] = 1;
1432 		break;
1433 	case 3:
1434 		swizzle_pipe[0] = 0;
1435 		swizzle_pipe[1] = 1;
1436 		swizzle_pipe[2] = 2;
1437 		break;
1438 	case 4:
1439 		swizzle_pipe[0] = 0;
1440 		swizzle_pipe[1] = 1;
1441 		swizzle_pipe[2] = 2;
1442 		swizzle_pipe[3] = 3;
1443 		break;
1444 	case 5:
1445 		swizzle_pipe[0] = 0;
1446 		swizzle_pipe[1] = 1;
1447 		swizzle_pipe[2] = 2;
1448 		swizzle_pipe[3] = 3;
1449 		swizzle_pipe[4] = 4;
1450 		break;
1451 	case 6:
1452 		swizzle_pipe[0] = 0;
1453 		swizzle_pipe[1] = 2;
1454 		swizzle_pipe[2] = 4;
1455 		swizzle_pipe[3] = 5;
1456 		swizzle_pipe[4] = 1;
1457 		swizzle_pipe[5] = 3;
1458 		break;
1459 	case 7:
1460 		swizzle_pipe[0] = 0;
1461 		swizzle_pipe[1] = 2;
1462 		swizzle_pipe[2] = 4;
1463 		swizzle_pipe[3] = 6;
1464 		swizzle_pipe[4] = 1;
1465 		swizzle_pipe[5] = 3;
1466 		swizzle_pipe[6] = 5;
1467 		break;
1468 	case 8:
1469 		swizzle_pipe[0] = 0;
1470 		swizzle_pipe[1] = 2;
1471 		swizzle_pipe[2] = 4;
1472 		swizzle_pipe[3] = 6;
1473 		swizzle_pipe[4] = 1;
1474 		swizzle_pipe[5] = 3;
1475 		swizzle_pipe[6] = 5;
1476 		swizzle_pipe[7] = 7;
1477 		break;
1478 	}
1479 
1480 	cur_backend = 0;
1481 	for (cur_pipe = 0; cur_pipe < num_tile_pipes; ++cur_pipe) {
1482 		while (((1 << cur_backend) & enabled_backends_mask) == 0)
1483 			cur_backend = (cur_backend + 1) % R6XX_MAX_BACKENDS;
1484 
1485 		backend_map |= (u32)(((cur_backend & 3) << (swizzle_pipe[cur_pipe] * 2)));
1486 
1487 		cur_backend = (cur_backend + 1) % R6XX_MAX_BACKENDS;
1488 	}
1489 
1490 	return backend_map;
1491 }
1492 
1493 int r600_count_pipe_bits(uint32_t val)
1494 {
1495 	int i, ret = 0;
1496 
1497 	for (i = 0; i < 32; i++) {
1498 		ret += val & 1;
1499 		val >>= 1;
1500 	}
1501 	return ret;
1502 }
1503 
1504 void r600_gpu_init(struct radeon_device *rdev)
1505 {
1506 	u32 tiling_config;
1507 	u32 ramcfg;
1508 	u32 backend_map;
1509 	u32 cc_rb_backend_disable;
1510 	u32 cc_gc_shader_pipe_config;
1511 	u32 tmp;
1512 	int i, j;
1513 	u32 sq_config;
1514 	u32 sq_gpr_resource_mgmt_1 = 0;
1515 	u32 sq_gpr_resource_mgmt_2 = 0;
1516 	u32 sq_thread_resource_mgmt = 0;
1517 	u32 sq_stack_resource_mgmt_1 = 0;
1518 	u32 sq_stack_resource_mgmt_2 = 0;
1519 
1520 	/* FIXME: implement */
1521 	switch (rdev->family) {
1522 	case CHIP_R600:
1523 		rdev->config.r600.max_pipes = 4;
1524 		rdev->config.r600.max_tile_pipes = 8;
1525 		rdev->config.r600.max_simds = 4;
1526 		rdev->config.r600.max_backends = 4;
1527 		rdev->config.r600.max_gprs = 256;
1528 		rdev->config.r600.max_threads = 192;
1529 		rdev->config.r600.max_stack_entries = 256;
1530 		rdev->config.r600.max_hw_contexts = 8;
1531 		rdev->config.r600.max_gs_threads = 16;
1532 		rdev->config.r600.sx_max_export_size = 128;
1533 		rdev->config.r600.sx_max_export_pos_size = 16;
1534 		rdev->config.r600.sx_max_export_smx_size = 128;
1535 		rdev->config.r600.sq_num_cf_insts = 2;
1536 		break;
1537 	case CHIP_RV630:
1538 	case CHIP_RV635:
1539 		rdev->config.r600.max_pipes = 2;
1540 		rdev->config.r600.max_tile_pipes = 2;
1541 		rdev->config.r600.max_simds = 3;
1542 		rdev->config.r600.max_backends = 1;
1543 		rdev->config.r600.max_gprs = 128;
1544 		rdev->config.r600.max_threads = 192;
1545 		rdev->config.r600.max_stack_entries = 128;
1546 		rdev->config.r600.max_hw_contexts = 8;
1547 		rdev->config.r600.max_gs_threads = 4;
1548 		rdev->config.r600.sx_max_export_size = 128;
1549 		rdev->config.r600.sx_max_export_pos_size = 16;
1550 		rdev->config.r600.sx_max_export_smx_size = 128;
1551 		rdev->config.r600.sq_num_cf_insts = 2;
1552 		break;
1553 	case CHIP_RV610:
1554 	case CHIP_RV620:
1555 	case CHIP_RS780:
1556 	case CHIP_RS880:
1557 		rdev->config.r600.max_pipes = 1;
1558 		rdev->config.r600.max_tile_pipes = 1;
1559 		rdev->config.r600.max_simds = 2;
1560 		rdev->config.r600.max_backends = 1;
1561 		rdev->config.r600.max_gprs = 128;
1562 		rdev->config.r600.max_threads = 192;
1563 		rdev->config.r600.max_stack_entries = 128;
1564 		rdev->config.r600.max_hw_contexts = 4;
1565 		rdev->config.r600.max_gs_threads = 4;
1566 		rdev->config.r600.sx_max_export_size = 128;
1567 		rdev->config.r600.sx_max_export_pos_size = 16;
1568 		rdev->config.r600.sx_max_export_smx_size = 128;
1569 		rdev->config.r600.sq_num_cf_insts = 1;
1570 		break;
1571 	case CHIP_RV670:
1572 		rdev->config.r600.max_pipes = 4;
1573 		rdev->config.r600.max_tile_pipes = 4;
1574 		rdev->config.r600.max_simds = 4;
1575 		rdev->config.r600.max_backends = 4;
1576 		rdev->config.r600.max_gprs = 192;
1577 		rdev->config.r600.max_threads = 192;
1578 		rdev->config.r600.max_stack_entries = 256;
1579 		rdev->config.r600.max_hw_contexts = 8;
1580 		rdev->config.r600.max_gs_threads = 16;
1581 		rdev->config.r600.sx_max_export_size = 128;
1582 		rdev->config.r600.sx_max_export_pos_size = 16;
1583 		rdev->config.r600.sx_max_export_smx_size = 128;
1584 		rdev->config.r600.sq_num_cf_insts = 2;
1585 		break;
1586 	default:
1587 		break;
1588 	}
1589 
1590 	/* Initialize HDP */
1591 	for (i = 0, j = 0; i < 32; i++, j += 0x18) {
1592 		WREG32((0x2c14 + j), 0x00000000);
1593 		WREG32((0x2c18 + j), 0x00000000);
1594 		WREG32((0x2c1c + j), 0x00000000);
1595 		WREG32((0x2c20 + j), 0x00000000);
1596 		WREG32((0x2c24 + j), 0x00000000);
1597 	}
1598 
1599 	WREG32(GRBM_CNTL, GRBM_READ_TIMEOUT(0xff));
1600 
1601 	/* Setup tiling */
1602 	tiling_config = 0;
1603 	ramcfg = RREG32(RAMCFG);
1604 	switch (rdev->config.r600.max_tile_pipes) {
1605 	case 1:
1606 		tiling_config |= PIPE_TILING(0);
1607 		break;
1608 	case 2:
1609 		tiling_config |= PIPE_TILING(1);
1610 		break;
1611 	case 4:
1612 		tiling_config |= PIPE_TILING(2);
1613 		break;
1614 	case 8:
1615 		tiling_config |= PIPE_TILING(3);
1616 		break;
1617 	default:
1618 		break;
1619 	}
1620 	rdev->config.r600.tiling_npipes = rdev->config.r600.max_tile_pipes;
1621 	rdev->config.r600.tiling_nbanks = 4 << ((ramcfg & NOOFBANK_MASK) >> NOOFBANK_SHIFT);
1622 	tiling_config |= BANK_TILING((ramcfg & NOOFBANK_MASK) >> NOOFBANK_SHIFT);
1623 	tiling_config |= GROUP_SIZE((ramcfg & BURSTLENGTH_MASK) >> BURSTLENGTH_SHIFT);
1624 	if ((ramcfg & BURSTLENGTH_MASK) >> BURSTLENGTH_SHIFT)
1625 		rdev->config.r600.tiling_group_size = 512;
1626 	else
1627 		rdev->config.r600.tiling_group_size = 256;
1628 	tmp = (ramcfg & NOOFROWS_MASK) >> NOOFROWS_SHIFT;
1629 	if (tmp > 3) {
1630 		tiling_config |= ROW_TILING(3);
1631 		tiling_config |= SAMPLE_SPLIT(3);
1632 	} else {
1633 		tiling_config |= ROW_TILING(tmp);
1634 		tiling_config |= SAMPLE_SPLIT(tmp);
1635 	}
1636 	tiling_config |= BANK_SWAPS(1);
1637 
1638 	cc_rb_backend_disable = RREG32(CC_RB_BACKEND_DISABLE) & 0x00ff0000;
1639 	cc_rb_backend_disable |=
1640 		BACKEND_DISABLE((R6XX_MAX_BACKENDS_MASK << rdev->config.r600.max_backends) & R6XX_MAX_BACKENDS_MASK);
1641 
1642 	cc_gc_shader_pipe_config = RREG32(CC_GC_SHADER_PIPE_CONFIG) & 0xffffff00;
1643 	cc_gc_shader_pipe_config |=
1644 		INACTIVE_QD_PIPES((R6XX_MAX_PIPES_MASK << rdev->config.r600.max_pipes) & R6XX_MAX_PIPES_MASK);
1645 	cc_gc_shader_pipe_config |=
1646 		INACTIVE_SIMDS((R6XX_MAX_SIMDS_MASK << rdev->config.r600.max_simds) & R6XX_MAX_SIMDS_MASK);
1647 
1648 	backend_map = r600_get_tile_pipe_to_backend_map(rdev->config.r600.max_tile_pipes,
1649 							(R6XX_MAX_BACKENDS -
1650 							 r600_count_pipe_bits((cc_rb_backend_disable &
1651 									       R6XX_MAX_BACKENDS_MASK) >> 16)),
1652 							(cc_rb_backend_disable >> 16));
1653 	rdev->config.r600.tile_config = tiling_config;
1654 	rdev->config.r600.backend_map = backend_map;
1655 	tiling_config |= BACKEND_MAP(backend_map);
1656 	WREG32(GB_TILING_CONFIG, tiling_config);
1657 	WREG32(DCP_TILING_CONFIG, tiling_config & 0xffff);
1658 	WREG32(HDP_TILING_CONFIG, tiling_config & 0xffff);
1659 
1660 	/* Setup pipes */
1661 	WREG32(CC_RB_BACKEND_DISABLE, cc_rb_backend_disable);
1662 	WREG32(CC_GC_SHADER_PIPE_CONFIG, cc_gc_shader_pipe_config);
1663 	WREG32(GC_USER_SHADER_PIPE_CONFIG, cc_gc_shader_pipe_config);
1664 
1665 	tmp = R6XX_MAX_PIPES - r600_count_pipe_bits((cc_gc_shader_pipe_config & INACTIVE_QD_PIPES_MASK) >> 8);
1666 	WREG32(VGT_OUT_DEALLOC_CNTL, (tmp * 4) & DEALLOC_DIST_MASK);
1667 	WREG32(VGT_VERTEX_REUSE_BLOCK_CNTL, ((tmp * 4) - 2) & VTX_REUSE_DEPTH_MASK);
1668 
1669 	/* Setup some CP states */
1670 	WREG32(CP_QUEUE_THRESHOLDS, (ROQ_IB1_START(0x16) | ROQ_IB2_START(0x2b)));
1671 	WREG32(CP_MEQ_THRESHOLDS, (MEQ_END(0x40) | ROQ_END(0x40)));
1672 
1673 	WREG32(TA_CNTL_AUX, (DISABLE_CUBE_ANISO | SYNC_GRADIENT |
1674 			     SYNC_WALKER | SYNC_ALIGNER));
1675 	/* Setup various GPU states */
1676 	if (rdev->family == CHIP_RV670)
1677 		WREG32(ARB_GDEC_RD_CNTL, 0x00000021);
1678 
1679 	tmp = RREG32(SX_DEBUG_1);
1680 	tmp |= SMX_EVENT_RELEASE;
1681 	if ((rdev->family > CHIP_R600))
1682 		tmp |= ENABLE_NEW_SMX_ADDRESS;
1683 	WREG32(SX_DEBUG_1, tmp);
1684 
1685 	if (((rdev->family) == CHIP_R600) ||
1686 	    ((rdev->family) == CHIP_RV630) ||
1687 	    ((rdev->family) == CHIP_RV610) ||
1688 	    ((rdev->family) == CHIP_RV620) ||
1689 	    ((rdev->family) == CHIP_RS780) ||
1690 	    ((rdev->family) == CHIP_RS880)) {
1691 		WREG32(DB_DEBUG, PREZ_MUST_WAIT_FOR_POSTZ_DONE);
1692 	} else {
1693 		WREG32(DB_DEBUG, 0);
1694 	}
1695 	WREG32(DB_WATERMARKS, (DEPTH_FREE(4) | DEPTH_CACHELINE_FREE(16) |
1696 			       DEPTH_FLUSH(16) | DEPTH_PENDING_FREE(4)));
1697 
1698 	WREG32(PA_SC_MULTI_CHIP_CNTL, 0);
1699 	WREG32(VGT_NUM_INSTANCES, 0);
1700 
1701 	WREG32(SPI_CONFIG_CNTL, GPR_WRITE_PRIORITY(0));
1702 	WREG32(SPI_CONFIG_CNTL_1, VTX_DONE_DELAY(0));
1703 
1704 	tmp = RREG32(SQ_MS_FIFO_SIZES);
1705 	if (((rdev->family) == CHIP_RV610) ||
1706 	    ((rdev->family) == CHIP_RV620) ||
1707 	    ((rdev->family) == CHIP_RS780) ||
1708 	    ((rdev->family) == CHIP_RS880)) {
1709 		tmp = (CACHE_FIFO_SIZE(0xa) |
1710 		       FETCH_FIFO_HIWATER(0xa) |
1711 		       DONE_FIFO_HIWATER(0xe0) |
1712 		       ALU_UPDATE_FIFO_HIWATER(0x8));
1713 	} else if (((rdev->family) == CHIP_R600) ||
1714 		   ((rdev->family) == CHIP_RV630)) {
1715 		tmp &= ~DONE_FIFO_HIWATER(0xff);
1716 		tmp |= DONE_FIFO_HIWATER(0x4);
1717 	}
1718 	WREG32(SQ_MS_FIFO_SIZES, tmp);
1719 
1720 	/* SQ_CONFIG, SQ_GPR_RESOURCE_MGMT, SQ_THREAD_RESOURCE_MGMT, SQ_STACK_RESOURCE_MGMT
1721 	 * should be adjusted as needed by the 2D/3D drivers.  This just sets default values
1722 	 */
1723 	sq_config = RREG32(SQ_CONFIG);
1724 	sq_config &= ~(PS_PRIO(3) |
1725 		       VS_PRIO(3) |
1726 		       GS_PRIO(3) |
1727 		       ES_PRIO(3));
1728 	sq_config |= (DX9_CONSTS |
1729 		      VC_ENABLE |
1730 		      PS_PRIO(0) |
1731 		      VS_PRIO(1) |
1732 		      GS_PRIO(2) |
1733 		      ES_PRIO(3));
1734 
1735 	if ((rdev->family) == CHIP_R600) {
1736 		sq_gpr_resource_mgmt_1 = (NUM_PS_GPRS(124) |
1737 					  NUM_VS_GPRS(124) |
1738 					  NUM_CLAUSE_TEMP_GPRS(4));
1739 		sq_gpr_resource_mgmt_2 = (NUM_GS_GPRS(0) |
1740 					  NUM_ES_GPRS(0));
1741 		sq_thread_resource_mgmt = (NUM_PS_THREADS(136) |
1742 					   NUM_VS_THREADS(48) |
1743 					   NUM_GS_THREADS(4) |
1744 					   NUM_ES_THREADS(4));
1745 		sq_stack_resource_mgmt_1 = (NUM_PS_STACK_ENTRIES(128) |
1746 					    NUM_VS_STACK_ENTRIES(128));
1747 		sq_stack_resource_mgmt_2 = (NUM_GS_STACK_ENTRIES(0) |
1748 					    NUM_ES_STACK_ENTRIES(0));
1749 	} else if (((rdev->family) == CHIP_RV610) ||
1750 		   ((rdev->family) == CHIP_RV620) ||
1751 		   ((rdev->family) == CHIP_RS780) ||
1752 		   ((rdev->family) == CHIP_RS880)) {
1753 		/* no vertex cache */
1754 		sq_config &= ~VC_ENABLE;
1755 
1756 		sq_gpr_resource_mgmt_1 = (NUM_PS_GPRS(44) |
1757 					  NUM_VS_GPRS(44) |
1758 					  NUM_CLAUSE_TEMP_GPRS(2));
1759 		sq_gpr_resource_mgmt_2 = (NUM_GS_GPRS(17) |
1760 					  NUM_ES_GPRS(17));
1761 		sq_thread_resource_mgmt = (NUM_PS_THREADS(79) |
1762 					   NUM_VS_THREADS(78) |
1763 					   NUM_GS_THREADS(4) |
1764 					   NUM_ES_THREADS(31));
1765 		sq_stack_resource_mgmt_1 = (NUM_PS_STACK_ENTRIES(40) |
1766 					    NUM_VS_STACK_ENTRIES(40));
1767 		sq_stack_resource_mgmt_2 = (NUM_GS_STACK_ENTRIES(32) |
1768 					    NUM_ES_STACK_ENTRIES(16));
1769 	} else if (((rdev->family) == CHIP_RV630) ||
1770 		   ((rdev->family) == CHIP_RV635)) {
1771 		sq_gpr_resource_mgmt_1 = (NUM_PS_GPRS(44) |
1772 					  NUM_VS_GPRS(44) |
1773 					  NUM_CLAUSE_TEMP_GPRS(2));
1774 		sq_gpr_resource_mgmt_2 = (NUM_GS_GPRS(18) |
1775 					  NUM_ES_GPRS(18));
1776 		sq_thread_resource_mgmt = (NUM_PS_THREADS(79) |
1777 					   NUM_VS_THREADS(78) |
1778 					   NUM_GS_THREADS(4) |
1779 					   NUM_ES_THREADS(31));
1780 		sq_stack_resource_mgmt_1 = (NUM_PS_STACK_ENTRIES(40) |
1781 					    NUM_VS_STACK_ENTRIES(40));
1782 		sq_stack_resource_mgmt_2 = (NUM_GS_STACK_ENTRIES(32) |
1783 					    NUM_ES_STACK_ENTRIES(16));
1784 	} else if ((rdev->family) == CHIP_RV670) {
1785 		sq_gpr_resource_mgmt_1 = (NUM_PS_GPRS(44) |
1786 					  NUM_VS_GPRS(44) |
1787 					  NUM_CLAUSE_TEMP_GPRS(2));
1788 		sq_gpr_resource_mgmt_2 = (NUM_GS_GPRS(17) |
1789 					  NUM_ES_GPRS(17));
1790 		sq_thread_resource_mgmt = (NUM_PS_THREADS(79) |
1791 					   NUM_VS_THREADS(78) |
1792 					   NUM_GS_THREADS(4) |
1793 					   NUM_ES_THREADS(31));
1794 		sq_stack_resource_mgmt_1 = (NUM_PS_STACK_ENTRIES(64) |
1795 					    NUM_VS_STACK_ENTRIES(64));
1796 		sq_stack_resource_mgmt_2 = (NUM_GS_STACK_ENTRIES(64) |
1797 					    NUM_ES_STACK_ENTRIES(64));
1798 	}
1799 
1800 	WREG32(SQ_CONFIG, sq_config);
1801 	WREG32(SQ_GPR_RESOURCE_MGMT_1,  sq_gpr_resource_mgmt_1);
1802 	WREG32(SQ_GPR_RESOURCE_MGMT_2,  sq_gpr_resource_mgmt_2);
1803 	WREG32(SQ_THREAD_RESOURCE_MGMT, sq_thread_resource_mgmt);
1804 	WREG32(SQ_STACK_RESOURCE_MGMT_1, sq_stack_resource_mgmt_1);
1805 	WREG32(SQ_STACK_RESOURCE_MGMT_2, sq_stack_resource_mgmt_2);
1806 
1807 	if (((rdev->family) == CHIP_RV610) ||
1808 	    ((rdev->family) == CHIP_RV620) ||
1809 	    ((rdev->family) == CHIP_RS780) ||
1810 	    ((rdev->family) == CHIP_RS880)) {
1811 		WREG32(VGT_CACHE_INVALIDATION, CACHE_INVALIDATION(TC_ONLY));
1812 	} else {
1813 		WREG32(VGT_CACHE_INVALIDATION, CACHE_INVALIDATION(VC_AND_TC));
1814 	}
1815 
1816 	/* More default values. 2D/3D driver should adjust as needed */
1817 	WREG32(PA_SC_AA_SAMPLE_LOCS_2S, (S0_X(0xc) | S0_Y(0x4) |
1818 					 S1_X(0x4) | S1_Y(0xc)));
1819 	WREG32(PA_SC_AA_SAMPLE_LOCS_4S, (S0_X(0xe) | S0_Y(0xe) |
1820 					 S1_X(0x2) | S1_Y(0x2) |
1821 					 S2_X(0xa) | S2_Y(0x6) |
1822 					 S3_X(0x6) | S3_Y(0xa)));
1823 	WREG32(PA_SC_AA_SAMPLE_LOCS_8S_WD0, (S0_X(0xe) | S0_Y(0xb) |
1824 					     S1_X(0x4) | S1_Y(0xc) |
1825 					     S2_X(0x1) | S2_Y(0x6) |
1826 					     S3_X(0xa) | S3_Y(0xe)));
1827 	WREG32(PA_SC_AA_SAMPLE_LOCS_8S_WD1, (S4_X(0x6) | S4_Y(0x1) |
1828 					     S5_X(0x0) | S5_Y(0x0) |
1829 					     S6_X(0xb) | S6_Y(0x4) |
1830 					     S7_X(0x7) | S7_Y(0x8)));
1831 
1832 	WREG32(VGT_STRMOUT_EN, 0);
1833 	tmp = rdev->config.r600.max_pipes * 16;
1834 	switch (rdev->family) {
1835 	case CHIP_RV610:
1836 	case CHIP_RV620:
1837 	case CHIP_RS780:
1838 	case CHIP_RS880:
1839 		tmp += 32;
1840 		break;
1841 	case CHIP_RV670:
1842 		tmp += 128;
1843 		break;
1844 	default:
1845 		break;
1846 	}
1847 	if (tmp > 256) {
1848 		tmp = 256;
1849 	}
1850 	WREG32(VGT_ES_PER_GS, 128);
1851 	WREG32(VGT_GS_PER_ES, tmp);
1852 	WREG32(VGT_GS_PER_VS, 2);
1853 	WREG32(VGT_GS_VERTEX_REUSE, 16);
1854 
1855 	/* more default values. 2D/3D driver should adjust as needed */
1856 	WREG32(PA_SC_LINE_STIPPLE_STATE, 0);
1857 	WREG32(VGT_STRMOUT_EN, 0);
1858 	WREG32(SX_MISC, 0);
1859 	WREG32(PA_SC_MODE_CNTL, 0);
1860 	WREG32(PA_SC_AA_CONFIG, 0);
1861 	WREG32(PA_SC_LINE_STIPPLE, 0);
1862 	WREG32(SPI_INPUT_Z, 0);
1863 	WREG32(SPI_PS_IN_CONTROL_0, NUM_INTERP(2));
1864 	WREG32(CB_COLOR7_FRAG, 0);
1865 
1866 	/* Clear render buffer base addresses */
1867 	WREG32(CB_COLOR0_BASE, 0);
1868 	WREG32(CB_COLOR1_BASE, 0);
1869 	WREG32(CB_COLOR2_BASE, 0);
1870 	WREG32(CB_COLOR3_BASE, 0);
1871 	WREG32(CB_COLOR4_BASE, 0);
1872 	WREG32(CB_COLOR5_BASE, 0);
1873 	WREG32(CB_COLOR6_BASE, 0);
1874 	WREG32(CB_COLOR7_BASE, 0);
1875 	WREG32(CB_COLOR7_FRAG, 0);
1876 
1877 	switch (rdev->family) {
1878 	case CHIP_RV610:
1879 	case CHIP_RV620:
1880 	case CHIP_RS780:
1881 	case CHIP_RS880:
1882 		tmp = TC_L2_SIZE(8);
1883 		break;
1884 	case CHIP_RV630:
1885 	case CHIP_RV635:
1886 		tmp = TC_L2_SIZE(4);
1887 		break;
1888 	case CHIP_R600:
1889 		tmp = TC_L2_SIZE(0) | L2_DISABLE_LATE_HIT;
1890 		break;
1891 	default:
1892 		tmp = TC_L2_SIZE(0);
1893 		break;
1894 	}
1895 	WREG32(TC_CNTL, tmp);
1896 
1897 	tmp = RREG32(HDP_HOST_PATH_CNTL);
1898 	WREG32(HDP_HOST_PATH_CNTL, tmp);
1899 
1900 	tmp = RREG32(ARB_POP);
1901 	tmp |= ENABLE_TC128;
1902 	WREG32(ARB_POP, tmp);
1903 
1904 	WREG32(PA_SC_MULTI_CHIP_CNTL, 0);
1905 	WREG32(PA_CL_ENHANCE, (CLIP_VTX_REORDER_ENA |
1906 			       NUM_CLIP_SEQ(3)));
1907 	WREG32(PA_SC_ENHANCE, FORCE_EOV_MAX_CLK_CNT(4095));
1908 }
1909 
1910 
1911 /*
1912  * Indirect registers accessor
1913  */
1914 u32 r600_pciep_rreg(struct radeon_device *rdev, u32 reg)
1915 {
1916 	u32 r;
1917 
1918 	WREG32(PCIE_PORT_INDEX, ((reg) & 0xff));
1919 	(void)RREG32(PCIE_PORT_INDEX);
1920 	r = RREG32(PCIE_PORT_DATA);
1921 	return r;
1922 }
1923 
1924 void r600_pciep_wreg(struct radeon_device *rdev, u32 reg, u32 v)
1925 {
1926 	WREG32(PCIE_PORT_INDEX, ((reg) & 0xff));
1927 	(void)RREG32(PCIE_PORT_INDEX);
1928 	WREG32(PCIE_PORT_DATA, (v));
1929 	(void)RREG32(PCIE_PORT_DATA);
1930 }
1931 
1932 /*
1933  * CP & Ring
1934  */
1935 void r600_cp_stop(struct radeon_device *rdev)
1936 {
1937 	radeon_ttm_set_active_vram_size(rdev, rdev->mc.visible_vram_size);
1938 	WREG32(R_0086D8_CP_ME_CNTL, S_0086D8_CP_ME_HALT(1));
1939 	WREG32(SCRATCH_UMSK, 0);
1940 }
1941 
1942 int r600_init_microcode(struct radeon_device *rdev)
1943 {
1944 	struct platform_device *pdev;
1945 	const char *chip_name;
1946 	const char *rlc_chip_name;
1947 	size_t pfp_req_size, me_req_size, rlc_req_size;
1948 	char fw_name[30];
1949 	int err;
1950 
1951 	DRM_DEBUG("\n");
1952 
1953 	pdev = platform_device_register_simple("radeon_cp", 0, NULL, 0);
1954 	err = IS_ERR(pdev);
1955 	if (err) {
1956 		printk(KERN_ERR "radeon_cp: Failed to register firmware\n");
1957 		return -EINVAL;
1958 	}
1959 
1960 	switch (rdev->family) {
1961 	case CHIP_R600:
1962 		chip_name = "R600";
1963 		rlc_chip_name = "R600";
1964 		break;
1965 	case CHIP_RV610:
1966 		chip_name = "RV610";
1967 		rlc_chip_name = "R600";
1968 		break;
1969 	case CHIP_RV630:
1970 		chip_name = "RV630";
1971 		rlc_chip_name = "R600";
1972 		break;
1973 	case CHIP_RV620:
1974 		chip_name = "RV620";
1975 		rlc_chip_name = "R600";
1976 		break;
1977 	case CHIP_RV635:
1978 		chip_name = "RV635";
1979 		rlc_chip_name = "R600";
1980 		break;
1981 	case CHIP_RV670:
1982 		chip_name = "RV670";
1983 		rlc_chip_name = "R600";
1984 		break;
1985 	case CHIP_RS780:
1986 	case CHIP_RS880:
1987 		chip_name = "RS780";
1988 		rlc_chip_name = "R600";
1989 		break;
1990 	case CHIP_RV770:
1991 		chip_name = "RV770";
1992 		rlc_chip_name = "R700";
1993 		break;
1994 	case CHIP_RV730:
1995 	case CHIP_RV740:
1996 		chip_name = "RV730";
1997 		rlc_chip_name = "R700";
1998 		break;
1999 	case CHIP_RV710:
2000 		chip_name = "RV710";
2001 		rlc_chip_name = "R700";
2002 		break;
2003 	case CHIP_CEDAR:
2004 		chip_name = "CEDAR";
2005 		rlc_chip_name = "CEDAR";
2006 		break;
2007 	case CHIP_REDWOOD:
2008 		chip_name = "REDWOOD";
2009 		rlc_chip_name = "REDWOOD";
2010 		break;
2011 	case CHIP_JUNIPER:
2012 		chip_name = "JUNIPER";
2013 		rlc_chip_name = "JUNIPER";
2014 		break;
2015 	case CHIP_CYPRESS:
2016 	case CHIP_HEMLOCK:
2017 		chip_name = "CYPRESS";
2018 		rlc_chip_name = "CYPRESS";
2019 		break;
2020 	case CHIP_PALM:
2021 		chip_name = "PALM";
2022 		rlc_chip_name = "SUMO";
2023 		break;
2024 	case CHIP_SUMO:
2025 		chip_name = "SUMO";
2026 		rlc_chip_name = "SUMO";
2027 		break;
2028 	case CHIP_SUMO2:
2029 		chip_name = "SUMO2";
2030 		rlc_chip_name = "SUMO";
2031 		break;
2032 	default: BUG();
2033 	}
2034 
2035 	if (rdev->family >= CHIP_CEDAR) {
2036 		pfp_req_size = EVERGREEN_PFP_UCODE_SIZE * 4;
2037 		me_req_size = EVERGREEN_PM4_UCODE_SIZE * 4;
2038 		rlc_req_size = EVERGREEN_RLC_UCODE_SIZE * 4;
2039 	} else if (rdev->family >= CHIP_RV770) {
2040 		pfp_req_size = R700_PFP_UCODE_SIZE * 4;
2041 		me_req_size = R700_PM4_UCODE_SIZE * 4;
2042 		rlc_req_size = R700_RLC_UCODE_SIZE * 4;
2043 	} else {
2044 		pfp_req_size = PFP_UCODE_SIZE * 4;
2045 		me_req_size = PM4_UCODE_SIZE * 12;
2046 		rlc_req_size = RLC_UCODE_SIZE * 4;
2047 	}
2048 
2049 	DRM_INFO("Loading %s Microcode\n", chip_name);
2050 
2051 	snprintf(fw_name, sizeof(fw_name), "radeon/%s_pfp.bin", chip_name);
2052 	err = request_firmware(&rdev->pfp_fw, fw_name, &pdev->dev);
2053 	if (err)
2054 		goto out;
2055 	if (rdev->pfp_fw->size != pfp_req_size) {
2056 		printk(KERN_ERR
2057 		       "r600_cp: Bogus length %zu in firmware \"%s\"\n",
2058 		       rdev->pfp_fw->size, fw_name);
2059 		err = -EINVAL;
2060 		goto out;
2061 	}
2062 
2063 	snprintf(fw_name, sizeof(fw_name), "radeon/%s_me.bin", chip_name);
2064 	err = request_firmware(&rdev->me_fw, fw_name, &pdev->dev);
2065 	if (err)
2066 		goto out;
2067 	if (rdev->me_fw->size != me_req_size) {
2068 		printk(KERN_ERR
2069 		       "r600_cp: Bogus length %zu in firmware \"%s\"\n",
2070 		       rdev->me_fw->size, fw_name);
2071 		err = -EINVAL;
2072 	}
2073 
2074 	snprintf(fw_name, sizeof(fw_name), "radeon/%s_rlc.bin", rlc_chip_name);
2075 	err = request_firmware(&rdev->rlc_fw, fw_name, &pdev->dev);
2076 	if (err)
2077 		goto out;
2078 	if (rdev->rlc_fw->size != rlc_req_size) {
2079 		printk(KERN_ERR
2080 		       "r600_rlc: Bogus length %zu in firmware \"%s\"\n",
2081 		       rdev->rlc_fw->size, fw_name);
2082 		err = -EINVAL;
2083 	}
2084 
2085 out:
2086 	platform_device_unregister(pdev);
2087 
2088 	if (err) {
2089 		if (err != -EINVAL)
2090 			printk(KERN_ERR
2091 			       "r600_cp: Failed to load firmware \"%s\"\n",
2092 			       fw_name);
2093 		release_firmware(rdev->pfp_fw);
2094 		rdev->pfp_fw = NULL;
2095 		release_firmware(rdev->me_fw);
2096 		rdev->me_fw = NULL;
2097 		release_firmware(rdev->rlc_fw);
2098 		rdev->rlc_fw = NULL;
2099 	}
2100 	return err;
2101 }
2102 
2103 static int r600_cp_load_microcode(struct radeon_device *rdev)
2104 {
2105 	const __be32 *fw_data;
2106 	int i;
2107 
2108 	if (!rdev->me_fw || !rdev->pfp_fw)
2109 		return -EINVAL;
2110 
2111 	r600_cp_stop(rdev);
2112 
2113 	WREG32(CP_RB_CNTL,
2114 #ifdef __BIG_ENDIAN
2115 	       BUF_SWAP_32BIT |
2116 #endif
2117 	       RB_NO_UPDATE | RB_BLKSZ(15) | RB_BUFSZ(3));
2118 
2119 	/* Reset cp */
2120 	WREG32(GRBM_SOFT_RESET, SOFT_RESET_CP);
2121 	RREG32(GRBM_SOFT_RESET);
2122 	mdelay(15);
2123 	WREG32(GRBM_SOFT_RESET, 0);
2124 
2125 	WREG32(CP_ME_RAM_WADDR, 0);
2126 
2127 	fw_data = (const __be32 *)rdev->me_fw->data;
2128 	WREG32(CP_ME_RAM_WADDR, 0);
2129 	for (i = 0; i < PM4_UCODE_SIZE * 3; i++)
2130 		WREG32(CP_ME_RAM_DATA,
2131 		       be32_to_cpup(fw_data++));
2132 
2133 	fw_data = (const __be32 *)rdev->pfp_fw->data;
2134 	WREG32(CP_PFP_UCODE_ADDR, 0);
2135 	for (i = 0; i < PFP_UCODE_SIZE; i++)
2136 		WREG32(CP_PFP_UCODE_DATA,
2137 		       be32_to_cpup(fw_data++));
2138 
2139 	WREG32(CP_PFP_UCODE_ADDR, 0);
2140 	WREG32(CP_ME_RAM_WADDR, 0);
2141 	WREG32(CP_ME_RAM_RADDR, 0);
2142 	return 0;
2143 }
2144 
2145 int r600_cp_start(struct radeon_device *rdev)
2146 {
2147 	int r;
2148 	uint32_t cp_me;
2149 
2150 	r = radeon_ring_lock(rdev, 7);
2151 	if (r) {
2152 		DRM_ERROR("radeon: cp failed to lock ring (%d).\n", r);
2153 		return r;
2154 	}
2155 	radeon_ring_write(rdev, PACKET3(PACKET3_ME_INITIALIZE, 5));
2156 	radeon_ring_write(rdev, 0x1);
2157 	if (rdev->family >= CHIP_RV770) {
2158 		radeon_ring_write(rdev, 0x0);
2159 		radeon_ring_write(rdev, rdev->config.rv770.max_hw_contexts - 1);
2160 	} else {
2161 		radeon_ring_write(rdev, 0x3);
2162 		radeon_ring_write(rdev, rdev->config.r600.max_hw_contexts - 1);
2163 	}
2164 	radeon_ring_write(rdev, PACKET3_ME_INITIALIZE_DEVICE_ID(1));
2165 	radeon_ring_write(rdev, 0);
2166 	radeon_ring_write(rdev, 0);
2167 	radeon_ring_unlock_commit(rdev);
2168 
2169 	cp_me = 0xff;
2170 	WREG32(R_0086D8_CP_ME_CNTL, cp_me);
2171 	return 0;
2172 }
2173 
2174 int r600_cp_resume(struct radeon_device *rdev)
2175 {
2176 	u32 tmp;
2177 	u32 rb_bufsz;
2178 	int r;
2179 
2180 	/* Reset cp */
2181 	WREG32(GRBM_SOFT_RESET, SOFT_RESET_CP);
2182 	RREG32(GRBM_SOFT_RESET);
2183 	mdelay(15);
2184 	WREG32(GRBM_SOFT_RESET, 0);
2185 
2186 	/* Set ring buffer size */
2187 	rb_bufsz = drm_order(rdev->cp.ring_size / 8);
2188 	tmp = (drm_order(RADEON_GPU_PAGE_SIZE/8) << 8) | rb_bufsz;
2189 #ifdef __BIG_ENDIAN
2190 	tmp |= BUF_SWAP_32BIT;
2191 #endif
2192 	WREG32(CP_RB_CNTL, tmp);
2193 	WREG32(CP_SEM_WAIT_TIMER, 0x4);
2194 
2195 	/* Set the write pointer delay */
2196 	WREG32(CP_RB_WPTR_DELAY, 0);
2197 
2198 	/* Initialize the ring buffer's read and write pointers */
2199 	WREG32(CP_RB_CNTL, tmp | RB_RPTR_WR_ENA);
2200 	WREG32(CP_RB_RPTR_WR, 0);
2201 	rdev->cp.wptr = 0;
2202 	WREG32(CP_RB_WPTR, rdev->cp.wptr);
2203 
2204 	/* set the wb address whether it's enabled or not */
2205 	WREG32(CP_RB_RPTR_ADDR,
2206 	       ((rdev->wb.gpu_addr + RADEON_WB_CP_RPTR_OFFSET) & 0xFFFFFFFC));
2207 	WREG32(CP_RB_RPTR_ADDR_HI, upper_32_bits(rdev->wb.gpu_addr + RADEON_WB_CP_RPTR_OFFSET) & 0xFF);
2208 	WREG32(SCRATCH_ADDR, ((rdev->wb.gpu_addr + RADEON_WB_SCRATCH_OFFSET) >> 8) & 0xFFFFFFFF);
2209 
2210 	if (rdev->wb.enabled)
2211 		WREG32(SCRATCH_UMSK, 0xff);
2212 	else {
2213 		tmp |= RB_NO_UPDATE;
2214 		WREG32(SCRATCH_UMSK, 0);
2215 	}
2216 
2217 	mdelay(1);
2218 	WREG32(CP_RB_CNTL, tmp);
2219 
2220 	WREG32(CP_RB_BASE, rdev->cp.gpu_addr >> 8);
2221 	WREG32(CP_DEBUG, (1 << 27) | (1 << 28));
2222 
2223 	rdev->cp.rptr = RREG32(CP_RB_RPTR);
2224 
2225 	r600_cp_start(rdev);
2226 	rdev->cp.ready = true;
2227 	r = radeon_ring_test(rdev);
2228 	if (r) {
2229 		rdev->cp.ready = false;
2230 		return r;
2231 	}
2232 	return 0;
2233 }
2234 
2235 void r600_cp_commit(struct radeon_device *rdev)
2236 {
2237 	WREG32(CP_RB_WPTR, rdev->cp.wptr);
2238 	(void)RREG32(CP_RB_WPTR);
2239 }
2240 
2241 void r600_ring_init(struct radeon_device *rdev, unsigned ring_size)
2242 {
2243 	u32 rb_bufsz;
2244 
2245 	/* Align ring size */
2246 	rb_bufsz = drm_order(ring_size / 8);
2247 	ring_size = (1 << (rb_bufsz + 1)) * 4;
2248 	rdev->cp.ring_size = ring_size;
2249 	rdev->cp.align_mask = 16 - 1;
2250 }
2251 
2252 void r600_cp_fini(struct radeon_device *rdev)
2253 {
2254 	r600_cp_stop(rdev);
2255 	radeon_ring_fini(rdev);
2256 }
2257 
2258 
2259 /*
2260  * GPU scratch registers helpers function.
2261  */
2262 void r600_scratch_init(struct radeon_device *rdev)
2263 {
2264 	int i;
2265 
2266 	rdev->scratch.num_reg = 7;
2267 	rdev->scratch.reg_base = SCRATCH_REG0;
2268 	for (i = 0; i < rdev->scratch.num_reg; i++) {
2269 		rdev->scratch.free[i] = true;
2270 		rdev->scratch.reg[i] = rdev->scratch.reg_base + (i * 4);
2271 	}
2272 }
2273 
2274 int r600_ring_test(struct radeon_device *rdev)
2275 {
2276 	uint32_t scratch;
2277 	uint32_t tmp = 0;
2278 	unsigned i;
2279 	int r;
2280 
2281 	r = radeon_scratch_get(rdev, &scratch);
2282 	if (r) {
2283 		DRM_ERROR("radeon: cp failed to get scratch reg (%d).\n", r);
2284 		return r;
2285 	}
2286 	WREG32(scratch, 0xCAFEDEAD);
2287 	r = radeon_ring_lock(rdev, 3);
2288 	if (r) {
2289 		DRM_ERROR("radeon: cp failed to lock ring (%d).\n", r);
2290 		radeon_scratch_free(rdev, scratch);
2291 		return r;
2292 	}
2293 	radeon_ring_write(rdev, PACKET3(PACKET3_SET_CONFIG_REG, 1));
2294 	radeon_ring_write(rdev, ((scratch - PACKET3_SET_CONFIG_REG_OFFSET) >> 2));
2295 	radeon_ring_write(rdev, 0xDEADBEEF);
2296 	radeon_ring_unlock_commit(rdev);
2297 	for (i = 0; i < rdev->usec_timeout; i++) {
2298 		tmp = RREG32(scratch);
2299 		if (tmp == 0xDEADBEEF)
2300 			break;
2301 		DRM_UDELAY(1);
2302 	}
2303 	if (i < rdev->usec_timeout) {
2304 		DRM_INFO("ring test succeeded in %d usecs\n", i);
2305 	} else {
2306 		DRM_ERROR("radeon: ring test failed (scratch(0x%04X)=0x%08X)\n",
2307 			  scratch, tmp);
2308 		r = -EINVAL;
2309 	}
2310 	radeon_scratch_free(rdev, scratch);
2311 	return r;
2312 }
2313 
2314 void r600_fence_ring_emit(struct radeon_device *rdev,
2315 			  struct radeon_fence *fence)
2316 {
2317 	if (rdev->wb.use_event) {
2318 		u64 addr = rdev->wb.gpu_addr + R600_WB_EVENT_OFFSET +
2319 			(u64)(rdev->fence_drv.scratch_reg - rdev->scratch.reg_base);
2320 		/* flush read cache over gart */
2321 		radeon_ring_write(rdev, PACKET3(PACKET3_SURFACE_SYNC, 3));
2322 		radeon_ring_write(rdev, PACKET3_TC_ACTION_ENA |
2323 					PACKET3_VC_ACTION_ENA |
2324 					PACKET3_SH_ACTION_ENA);
2325 		radeon_ring_write(rdev, 0xFFFFFFFF);
2326 		radeon_ring_write(rdev, 0);
2327 		radeon_ring_write(rdev, 10); /* poll interval */
2328 		/* EVENT_WRITE_EOP - flush caches, send int */
2329 		radeon_ring_write(rdev, PACKET3(PACKET3_EVENT_WRITE_EOP, 4));
2330 		radeon_ring_write(rdev, EVENT_TYPE(CACHE_FLUSH_AND_INV_EVENT_TS) | EVENT_INDEX(5));
2331 		radeon_ring_write(rdev, addr & 0xffffffff);
2332 		radeon_ring_write(rdev, (upper_32_bits(addr) & 0xff) | DATA_SEL(1) | INT_SEL(2));
2333 		radeon_ring_write(rdev, fence->seq);
2334 		radeon_ring_write(rdev, 0);
2335 	} else {
2336 		/* flush read cache over gart */
2337 		radeon_ring_write(rdev, PACKET3(PACKET3_SURFACE_SYNC, 3));
2338 		radeon_ring_write(rdev, PACKET3_TC_ACTION_ENA |
2339 					PACKET3_VC_ACTION_ENA |
2340 					PACKET3_SH_ACTION_ENA);
2341 		radeon_ring_write(rdev, 0xFFFFFFFF);
2342 		radeon_ring_write(rdev, 0);
2343 		radeon_ring_write(rdev, 10); /* poll interval */
2344 		radeon_ring_write(rdev, PACKET3(PACKET3_EVENT_WRITE, 0));
2345 		radeon_ring_write(rdev, EVENT_TYPE(CACHE_FLUSH_AND_INV_EVENT) | EVENT_INDEX(0));
2346 		/* wait for 3D idle clean */
2347 		radeon_ring_write(rdev, PACKET3(PACKET3_SET_CONFIG_REG, 1));
2348 		radeon_ring_write(rdev, (WAIT_UNTIL - PACKET3_SET_CONFIG_REG_OFFSET) >> 2);
2349 		radeon_ring_write(rdev, WAIT_3D_IDLE_bit | WAIT_3D_IDLECLEAN_bit);
2350 		/* Emit fence sequence & fire IRQ */
2351 		radeon_ring_write(rdev, PACKET3(PACKET3_SET_CONFIG_REG, 1));
2352 		radeon_ring_write(rdev, ((rdev->fence_drv.scratch_reg - PACKET3_SET_CONFIG_REG_OFFSET) >> 2));
2353 		radeon_ring_write(rdev, fence->seq);
2354 		/* CP_INTERRUPT packet 3 no longer exists, use packet 0 */
2355 		radeon_ring_write(rdev, PACKET0(CP_INT_STATUS, 0));
2356 		radeon_ring_write(rdev, RB_INT_STAT);
2357 	}
2358 }
2359 
2360 int r600_copy_blit(struct radeon_device *rdev,
2361 		   uint64_t src_offset,
2362 		   uint64_t dst_offset,
2363 		   unsigned num_gpu_pages,
2364 		   struct radeon_fence *fence)
2365 {
2366 	int r;
2367 
2368 	mutex_lock(&rdev->r600_blit.mutex);
2369 	rdev->r600_blit.vb_ib = NULL;
2370 	r = r600_blit_prepare_copy(rdev, num_gpu_pages);
2371 	if (r) {
2372 		if (rdev->r600_blit.vb_ib)
2373 			radeon_ib_free(rdev, &rdev->r600_blit.vb_ib);
2374 		mutex_unlock(&rdev->r600_blit.mutex);
2375 		return r;
2376 	}
2377 	r600_kms_blit_copy(rdev, src_offset, dst_offset, num_gpu_pages);
2378 	r600_blit_done_copy(rdev, fence);
2379 	mutex_unlock(&rdev->r600_blit.mutex);
2380 	return 0;
2381 }
2382 
2383 void r600_blit_suspend(struct radeon_device *rdev)
2384 {
2385 	int r;
2386 
2387 	/* unpin shaders bo */
2388 	if (rdev->r600_blit.shader_obj) {
2389 		r = radeon_bo_reserve(rdev->r600_blit.shader_obj, false);
2390 		if (!r) {
2391 			radeon_bo_unpin(rdev->r600_blit.shader_obj);
2392 			radeon_bo_unreserve(rdev->r600_blit.shader_obj);
2393 		}
2394 	}
2395 }
2396 
2397 int r600_set_surface_reg(struct radeon_device *rdev, int reg,
2398 			 uint32_t tiling_flags, uint32_t pitch,
2399 			 uint32_t offset, uint32_t obj_size)
2400 {
2401 	/* FIXME: implement */
2402 	return 0;
2403 }
2404 
2405 void r600_clear_surface_reg(struct radeon_device *rdev, int reg)
2406 {
2407 	/* FIXME: implement */
2408 }
2409 
2410 int r600_startup(struct radeon_device *rdev)
2411 {
2412 	int r;
2413 
2414 	/* enable pcie gen2 link */
2415 	r600_pcie_gen2_enable(rdev);
2416 
2417 	if (!rdev->me_fw || !rdev->pfp_fw || !rdev->rlc_fw) {
2418 		r = r600_init_microcode(rdev);
2419 		if (r) {
2420 			DRM_ERROR("Failed to load firmware!\n");
2421 			return r;
2422 		}
2423 	}
2424 
2425 	r = r600_vram_scratch_init(rdev);
2426 	if (r)
2427 		return r;
2428 
2429 	r600_mc_program(rdev);
2430 	if (rdev->flags & RADEON_IS_AGP) {
2431 		r600_agp_enable(rdev);
2432 	} else {
2433 		r = r600_pcie_gart_enable(rdev);
2434 		if (r)
2435 			return r;
2436 	}
2437 	r600_gpu_init(rdev);
2438 	r = r600_blit_init(rdev);
2439 	if (r) {
2440 		r600_blit_fini(rdev);
2441 		rdev->asic->copy = NULL;
2442 		dev_warn(rdev->dev, "failed blitter (%d) falling back to memcpy\n", r);
2443 	}
2444 
2445 	/* allocate wb buffer */
2446 	r = radeon_wb_init(rdev);
2447 	if (r)
2448 		return r;
2449 
2450 	/* Enable IRQ */
2451 	r = r600_irq_init(rdev);
2452 	if (r) {
2453 		DRM_ERROR("radeon: IH init failed (%d).\n", r);
2454 		radeon_irq_kms_fini(rdev);
2455 		return r;
2456 	}
2457 	r600_irq_set(rdev);
2458 
2459 	r = radeon_ring_init(rdev, rdev->cp.ring_size);
2460 	if (r)
2461 		return r;
2462 	r = r600_cp_load_microcode(rdev);
2463 	if (r)
2464 		return r;
2465 	r = r600_cp_resume(rdev);
2466 	if (r)
2467 		return r;
2468 
2469 	return 0;
2470 }
2471 
2472 void r600_vga_set_state(struct radeon_device *rdev, bool state)
2473 {
2474 	uint32_t temp;
2475 
2476 	temp = RREG32(CONFIG_CNTL);
2477 	if (state == false) {
2478 		temp &= ~(1<<0);
2479 		temp |= (1<<1);
2480 	} else {
2481 		temp &= ~(1<<1);
2482 	}
2483 	WREG32(CONFIG_CNTL, temp);
2484 }
2485 
2486 int r600_resume(struct radeon_device *rdev)
2487 {
2488 	int r;
2489 
2490 	/* Do not reset GPU before posting, on r600 hw unlike on r500 hw,
2491 	 * posting will perform necessary task to bring back GPU into good
2492 	 * shape.
2493 	 */
2494 	/* post card */
2495 	atom_asic_init(rdev->mode_info.atom_context);
2496 
2497 	r = r600_startup(rdev);
2498 	if (r) {
2499 		DRM_ERROR("r600 startup failed on resume\n");
2500 		return r;
2501 	}
2502 
2503 	r = r600_ib_test(rdev);
2504 	if (r) {
2505 		DRM_ERROR("radeon: failed testing IB (%d).\n", r);
2506 		return r;
2507 	}
2508 
2509 	r = r600_audio_init(rdev);
2510 	if (r) {
2511 		DRM_ERROR("radeon: audio resume failed\n");
2512 		return r;
2513 	}
2514 
2515 	return r;
2516 }
2517 
2518 int r600_suspend(struct radeon_device *rdev)
2519 {
2520 	r600_audio_fini(rdev);
2521 	/* FIXME: we should wait for ring to be empty */
2522 	r600_cp_stop(rdev);
2523 	rdev->cp.ready = false;
2524 	r600_irq_suspend(rdev);
2525 	radeon_wb_disable(rdev);
2526 	r600_pcie_gart_disable(rdev);
2527 	r600_blit_suspend(rdev);
2528 
2529 	return 0;
2530 }
2531 
2532 /* Plan is to move initialization in that function and use
2533  * helper function so that radeon_device_init pretty much
2534  * do nothing more than calling asic specific function. This
2535  * should also allow to remove a bunch of callback function
2536  * like vram_info.
2537  */
2538 int r600_init(struct radeon_device *rdev)
2539 {
2540 	int r;
2541 
2542 	if (r600_debugfs_mc_info_init(rdev)) {
2543 		DRM_ERROR("Failed to register debugfs file for mc !\n");
2544 	}
2545 	/* This don't do much */
2546 	r = radeon_gem_init(rdev);
2547 	if (r)
2548 		return r;
2549 	/* Read BIOS */
2550 	if (!radeon_get_bios(rdev)) {
2551 		if (ASIC_IS_AVIVO(rdev))
2552 			return -EINVAL;
2553 	}
2554 	/* Must be an ATOMBIOS */
2555 	if (!rdev->is_atom_bios) {
2556 		dev_err(rdev->dev, "Expecting atombios for R600 GPU\n");
2557 		return -EINVAL;
2558 	}
2559 	r = radeon_atombios_init(rdev);
2560 	if (r)
2561 		return r;
2562 	/* Post card if necessary */
2563 	if (!radeon_card_posted(rdev)) {
2564 		if (!rdev->bios) {
2565 			dev_err(rdev->dev, "Card not posted and no BIOS - ignoring\n");
2566 			return -EINVAL;
2567 		}
2568 		DRM_INFO("GPU not posted. posting now...\n");
2569 		atom_asic_init(rdev->mode_info.atom_context);
2570 	}
2571 	/* Initialize scratch registers */
2572 	r600_scratch_init(rdev);
2573 	/* Initialize surface registers */
2574 	radeon_surface_init(rdev);
2575 	/* Initialize clocks */
2576 	radeon_get_clock_info(rdev->ddev);
2577 	/* Fence driver */
2578 	r = radeon_fence_driver_init(rdev);
2579 	if (r)
2580 		return r;
2581 	if (rdev->flags & RADEON_IS_AGP) {
2582 		r = radeon_agp_init(rdev);
2583 		if (r)
2584 			radeon_agp_disable(rdev);
2585 	}
2586 	r = r600_mc_init(rdev);
2587 	if (r)
2588 		return r;
2589 	/* Memory manager */
2590 	r = radeon_bo_init(rdev);
2591 	if (r)
2592 		return r;
2593 
2594 	r = radeon_irq_kms_init(rdev);
2595 	if (r)
2596 		return r;
2597 
2598 	rdev->cp.ring_obj = NULL;
2599 	r600_ring_init(rdev, 1024 * 1024);
2600 
2601 	rdev->ih.ring_obj = NULL;
2602 	r600_ih_ring_init(rdev, 64 * 1024);
2603 
2604 	r = r600_pcie_gart_init(rdev);
2605 	if (r)
2606 		return r;
2607 
2608 	rdev->accel_working = true;
2609 	r = r600_startup(rdev);
2610 	if (r) {
2611 		dev_err(rdev->dev, "disabling GPU acceleration\n");
2612 		r600_cp_fini(rdev);
2613 		r600_irq_fini(rdev);
2614 		radeon_wb_fini(rdev);
2615 		radeon_irq_kms_fini(rdev);
2616 		r600_pcie_gart_fini(rdev);
2617 		rdev->accel_working = false;
2618 	}
2619 	if (rdev->accel_working) {
2620 		r = radeon_ib_pool_init(rdev);
2621 		if (r) {
2622 			dev_err(rdev->dev, "IB initialization failed (%d).\n", r);
2623 			rdev->accel_working = false;
2624 		} else {
2625 			r = r600_ib_test(rdev);
2626 			if (r) {
2627 				dev_err(rdev->dev, "IB test failed (%d).\n", r);
2628 				rdev->accel_working = false;
2629 			}
2630 		}
2631 	}
2632 
2633 	r = r600_audio_init(rdev);
2634 	if (r)
2635 		return r; /* TODO error handling */
2636 	return 0;
2637 }
2638 
2639 void r600_fini(struct radeon_device *rdev)
2640 {
2641 	r600_audio_fini(rdev);
2642 	r600_blit_fini(rdev);
2643 	r600_cp_fini(rdev);
2644 	r600_irq_fini(rdev);
2645 	radeon_wb_fini(rdev);
2646 	radeon_ib_pool_fini(rdev);
2647 	radeon_irq_kms_fini(rdev);
2648 	r600_pcie_gart_fini(rdev);
2649 	r600_vram_scratch_fini(rdev);
2650 	radeon_agp_fini(rdev);
2651 	radeon_gem_fini(rdev);
2652 	radeon_fence_driver_fini(rdev);
2653 	radeon_bo_fini(rdev);
2654 	radeon_atombios_fini(rdev);
2655 	kfree(rdev->bios);
2656 	rdev->bios = NULL;
2657 }
2658 
2659 
2660 /*
2661  * CS stuff
2662  */
2663 void r600_ring_ib_execute(struct radeon_device *rdev, struct radeon_ib *ib)
2664 {
2665 	/* FIXME: implement */
2666 	radeon_ring_write(rdev, PACKET3(PACKET3_INDIRECT_BUFFER, 2));
2667 	radeon_ring_write(rdev,
2668 #ifdef __BIG_ENDIAN
2669 			  (2 << 0) |
2670 #endif
2671 			  (ib->gpu_addr & 0xFFFFFFFC));
2672 	radeon_ring_write(rdev, upper_32_bits(ib->gpu_addr) & 0xFF);
2673 	radeon_ring_write(rdev, ib->length_dw);
2674 }
2675 
2676 int r600_ib_test(struct radeon_device *rdev)
2677 {
2678 	struct radeon_ib *ib;
2679 	uint32_t scratch;
2680 	uint32_t tmp = 0;
2681 	unsigned i;
2682 	int r;
2683 
2684 	r = radeon_scratch_get(rdev, &scratch);
2685 	if (r) {
2686 		DRM_ERROR("radeon: failed to get scratch reg (%d).\n", r);
2687 		return r;
2688 	}
2689 	WREG32(scratch, 0xCAFEDEAD);
2690 	r = radeon_ib_get(rdev, &ib);
2691 	if (r) {
2692 		DRM_ERROR("radeon: failed to get ib (%d).\n", r);
2693 		return r;
2694 	}
2695 	ib->ptr[0] = PACKET3(PACKET3_SET_CONFIG_REG, 1);
2696 	ib->ptr[1] = ((scratch - PACKET3_SET_CONFIG_REG_OFFSET) >> 2);
2697 	ib->ptr[2] = 0xDEADBEEF;
2698 	ib->ptr[3] = PACKET2(0);
2699 	ib->ptr[4] = PACKET2(0);
2700 	ib->ptr[5] = PACKET2(0);
2701 	ib->ptr[6] = PACKET2(0);
2702 	ib->ptr[7] = PACKET2(0);
2703 	ib->ptr[8] = PACKET2(0);
2704 	ib->ptr[9] = PACKET2(0);
2705 	ib->ptr[10] = PACKET2(0);
2706 	ib->ptr[11] = PACKET2(0);
2707 	ib->ptr[12] = PACKET2(0);
2708 	ib->ptr[13] = PACKET2(0);
2709 	ib->ptr[14] = PACKET2(0);
2710 	ib->ptr[15] = PACKET2(0);
2711 	ib->length_dw = 16;
2712 	r = radeon_ib_schedule(rdev, ib);
2713 	if (r) {
2714 		radeon_scratch_free(rdev, scratch);
2715 		radeon_ib_free(rdev, &ib);
2716 		DRM_ERROR("radeon: failed to schedule ib (%d).\n", r);
2717 		return r;
2718 	}
2719 	r = radeon_fence_wait(ib->fence, false);
2720 	if (r) {
2721 		DRM_ERROR("radeon: fence wait failed (%d).\n", r);
2722 		return r;
2723 	}
2724 	for (i = 0; i < rdev->usec_timeout; i++) {
2725 		tmp = RREG32(scratch);
2726 		if (tmp == 0xDEADBEEF)
2727 			break;
2728 		DRM_UDELAY(1);
2729 	}
2730 	if (i < rdev->usec_timeout) {
2731 		DRM_INFO("ib test succeeded in %u usecs\n", i);
2732 	} else {
2733 		DRM_ERROR("radeon: ib test failed (scratch(0x%04X)=0x%08X)\n",
2734 			  scratch, tmp);
2735 		r = -EINVAL;
2736 	}
2737 	radeon_scratch_free(rdev, scratch);
2738 	radeon_ib_free(rdev, &ib);
2739 	return r;
2740 }
2741 
2742 /*
2743  * Interrupts
2744  *
2745  * Interrupts use a ring buffer on r6xx/r7xx hardware.  It works pretty
2746  * the same as the CP ring buffer, but in reverse.  Rather than the CPU
2747  * writing to the ring and the GPU consuming, the GPU writes to the ring
2748  * and host consumes.  As the host irq handler processes interrupts, it
2749  * increments the rptr.  When the rptr catches up with the wptr, all the
2750  * current interrupts have been processed.
2751  */
2752 
2753 void r600_ih_ring_init(struct radeon_device *rdev, unsigned ring_size)
2754 {
2755 	u32 rb_bufsz;
2756 
2757 	/* Align ring size */
2758 	rb_bufsz = drm_order(ring_size / 4);
2759 	ring_size = (1 << rb_bufsz) * 4;
2760 	rdev->ih.ring_size = ring_size;
2761 	rdev->ih.ptr_mask = rdev->ih.ring_size - 1;
2762 	rdev->ih.rptr = 0;
2763 }
2764 
2765 static int r600_ih_ring_alloc(struct radeon_device *rdev)
2766 {
2767 	int r;
2768 
2769 	/* Allocate ring buffer */
2770 	if (rdev->ih.ring_obj == NULL) {
2771 		r = radeon_bo_create(rdev, rdev->ih.ring_size,
2772 				     PAGE_SIZE, true,
2773 				     RADEON_GEM_DOMAIN_GTT,
2774 				     &rdev->ih.ring_obj);
2775 		if (r) {
2776 			DRM_ERROR("radeon: failed to create ih ring buffer (%d).\n", r);
2777 			return r;
2778 		}
2779 		r = radeon_bo_reserve(rdev->ih.ring_obj, false);
2780 		if (unlikely(r != 0))
2781 			return r;
2782 		r = radeon_bo_pin(rdev->ih.ring_obj,
2783 				  RADEON_GEM_DOMAIN_GTT,
2784 				  &rdev->ih.gpu_addr);
2785 		if (r) {
2786 			radeon_bo_unreserve(rdev->ih.ring_obj);
2787 			DRM_ERROR("radeon: failed to pin ih ring buffer (%d).\n", r);
2788 			return r;
2789 		}
2790 		r = radeon_bo_kmap(rdev->ih.ring_obj,
2791 				   (void **)&rdev->ih.ring);
2792 		radeon_bo_unreserve(rdev->ih.ring_obj);
2793 		if (r) {
2794 			DRM_ERROR("radeon: failed to map ih ring buffer (%d).\n", r);
2795 			return r;
2796 		}
2797 	}
2798 	return 0;
2799 }
2800 
2801 static void r600_ih_ring_fini(struct radeon_device *rdev)
2802 {
2803 	int r;
2804 	if (rdev->ih.ring_obj) {
2805 		r = radeon_bo_reserve(rdev->ih.ring_obj, false);
2806 		if (likely(r == 0)) {
2807 			radeon_bo_kunmap(rdev->ih.ring_obj);
2808 			radeon_bo_unpin(rdev->ih.ring_obj);
2809 			radeon_bo_unreserve(rdev->ih.ring_obj);
2810 		}
2811 		radeon_bo_unref(&rdev->ih.ring_obj);
2812 		rdev->ih.ring = NULL;
2813 		rdev->ih.ring_obj = NULL;
2814 	}
2815 }
2816 
2817 void r600_rlc_stop(struct radeon_device *rdev)
2818 {
2819 
2820 	if ((rdev->family >= CHIP_RV770) &&
2821 	    (rdev->family <= CHIP_RV740)) {
2822 		/* r7xx asics need to soft reset RLC before halting */
2823 		WREG32(SRBM_SOFT_RESET, SOFT_RESET_RLC);
2824 		RREG32(SRBM_SOFT_RESET);
2825 		udelay(15000);
2826 		WREG32(SRBM_SOFT_RESET, 0);
2827 		RREG32(SRBM_SOFT_RESET);
2828 	}
2829 
2830 	WREG32(RLC_CNTL, 0);
2831 }
2832 
2833 static void r600_rlc_start(struct radeon_device *rdev)
2834 {
2835 	WREG32(RLC_CNTL, RLC_ENABLE);
2836 }
2837 
2838 static int r600_rlc_init(struct radeon_device *rdev)
2839 {
2840 	u32 i;
2841 	const __be32 *fw_data;
2842 
2843 	if (!rdev->rlc_fw)
2844 		return -EINVAL;
2845 
2846 	r600_rlc_stop(rdev);
2847 
2848 	WREG32(RLC_HB_BASE, 0);
2849 	WREG32(RLC_HB_CNTL, 0);
2850 	WREG32(RLC_HB_RPTR, 0);
2851 	WREG32(RLC_HB_WPTR, 0);
2852 	if (rdev->family <= CHIP_CAICOS) {
2853 		WREG32(RLC_HB_WPTR_LSB_ADDR, 0);
2854 		WREG32(RLC_HB_WPTR_MSB_ADDR, 0);
2855 	}
2856 	WREG32(RLC_MC_CNTL, 0);
2857 	WREG32(RLC_UCODE_CNTL, 0);
2858 
2859 	fw_data = (const __be32 *)rdev->rlc_fw->data;
2860 	if (rdev->family >= CHIP_CAYMAN) {
2861 		for (i = 0; i < CAYMAN_RLC_UCODE_SIZE; i++) {
2862 			WREG32(RLC_UCODE_ADDR, i);
2863 			WREG32(RLC_UCODE_DATA, be32_to_cpup(fw_data++));
2864 		}
2865 	} else if (rdev->family >= CHIP_CEDAR) {
2866 		for (i = 0; i < EVERGREEN_RLC_UCODE_SIZE; i++) {
2867 			WREG32(RLC_UCODE_ADDR, i);
2868 			WREG32(RLC_UCODE_DATA, be32_to_cpup(fw_data++));
2869 		}
2870 	} else if (rdev->family >= CHIP_RV770) {
2871 		for (i = 0; i < R700_RLC_UCODE_SIZE; i++) {
2872 			WREG32(RLC_UCODE_ADDR, i);
2873 			WREG32(RLC_UCODE_DATA, be32_to_cpup(fw_data++));
2874 		}
2875 	} else {
2876 		for (i = 0; i < RLC_UCODE_SIZE; i++) {
2877 			WREG32(RLC_UCODE_ADDR, i);
2878 			WREG32(RLC_UCODE_DATA, be32_to_cpup(fw_data++));
2879 		}
2880 	}
2881 	WREG32(RLC_UCODE_ADDR, 0);
2882 
2883 	r600_rlc_start(rdev);
2884 
2885 	return 0;
2886 }
2887 
2888 static void r600_enable_interrupts(struct radeon_device *rdev)
2889 {
2890 	u32 ih_cntl = RREG32(IH_CNTL);
2891 	u32 ih_rb_cntl = RREG32(IH_RB_CNTL);
2892 
2893 	ih_cntl |= ENABLE_INTR;
2894 	ih_rb_cntl |= IH_RB_ENABLE;
2895 	WREG32(IH_CNTL, ih_cntl);
2896 	WREG32(IH_RB_CNTL, ih_rb_cntl);
2897 	rdev->ih.enabled = true;
2898 }
2899 
2900 void r600_disable_interrupts(struct radeon_device *rdev)
2901 {
2902 	u32 ih_rb_cntl = RREG32(IH_RB_CNTL);
2903 	u32 ih_cntl = RREG32(IH_CNTL);
2904 
2905 	ih_rb_cntl &= ~IH_RB_ENABLE;
2906 	ih_cntl &= ~ENABLE_INTR;
2907 	WREG32(IH_RB_CNTL, ih_rb_cntl);
2908 	WREG32(IH_CNTL, ih_cntl);
2909 	/* set rptr, wptr to 0 */
2910 	WREG32(IH_RB_RPTR, 0);
2911 	WREG32(IH_RB_WPTR, 0);
2912 	rdev->ih.enabled = false;
2913 	rdev->ih.wptr = 0;
2914 	rdev->ih.rptr = 0;
2915 }
2916 
2917 static void r600_disable_interrupt_state(struct radeon_device *rdev)
2918 {
2919 	u32 tmp;
2920 
2921 	WREG32(CP_INT_CNTL, CNTX_BUSY_INT_ENABLE | CNTX_EMPTY_INT_ENABLE);
2922 	WREG32(GRBM_INT_CNTL, 0);
2923 	WREG32(DxMODE_INT_MASK, 0);
2924 	WREG32(D1GRPH_INTERRUPT_CONTROL, 0);
2925 	WREG32(D2GRPH_INTERRUPT_CONTROL, 0);
2926 	if (ASIC_IS_DCE3(rdev)) {
2927 		WREG32(DCE3_DACA_AUTODETECT_INT_CONTROL, 0);
2928 		WREG32(DCE3_DACB_AUTODETECT_INT_CONTROL, 0);
2929 		tmp = RREG32(DC_HPD1_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2930 		WREG32(DC_HPD1_INT_CONTROL, tmp);
2931 		tmp = RREG32(DC_HPD2_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2932 		WREG32(DC_HPD2_INT_CONTROL, tmp);
2933 		tmp = RREG32(DC_HPD3_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2934 		WREG32(DC_HPD3_INT_CONTROL, tmp);
2935 		tmp = RREG32(DC_HPD4_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2936 		WREG32(DC_HPD4_INT_CONTROL, tmp);
2937 		if (ASIC_IS_DCE32(rdev)) {
2938 			tmp = RREG32(DC_HPD5_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2939 			WREG32(DC_HPD5_INT_CONTROL, tmp);
2940 			tmp = RREG32(DC_HPD6_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2941 			WREG32(DC_HPD6_INT_CONTROL, tmp);
2942 		}
2943 	} else {
2944 		WREG32(DACA_AUTODETECT_INT_CONTROL, 0);
2945 		WREG32(DACB_AUTODETECT_INT_CONTROL, 0);
2946 		tmp = RREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL) & DC_HOT_PLUG_DETECTx_INT_POLARITY;
2947 		WREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL, tmp);
2948 		tmp = RREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL) & DC_HOT_PLUG_DETECTx_INT_POLARITY;
2949 		WREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL, tmp);
2950 		tmp = RREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL) & DC_HOT_PLUG_DETECTx_INT_POLARITY;
2951 		WREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL, tmp);
2952 	}
2953 }
2954 
2955 int r600_irq_init(struct radeon_device *rdev)
2956 {
2957 	int ret = 0;
2958 	int rb_bufsz;
2959 	u32 interrupt_cntl, ih_cntl, ih_rb_cntl;
2960 
2961 	/* allocate ring */
2962 	ret = r600_ih_ring_alloc(rdev);
2963 	if (ret)
2964 		return ret;
2965 
2966 	/* disable irqs */
2967 	r600_disable_interrupts(rdev);
2968 
2969 	/* init rlc */
2970 	ret = r600_rlc_init(rdev);
2971 	if (ret) {
2972 		r600_ih_ring_fini(rdev);
2973 		return ret;
2974 	}
2975 
2976 	/* setup interrupt control */
2977 	/* set dummy read address to ring address */
2978 	WREG32(INTERRUPT_CNTL2, rdev->ih.gpu_addr >> 8);
2979 	interrupt_cntl = RREG32(INTERRUPT_CNTL);
2980 	/* IH_DUMMY_RD_OVERRIDE=0 - dummy read disabled with msi, enabled without msi
2981 	 * IH_DUMMY_RD_OVERRIDE=1 - dummy read controlled by IH_DUMMY_RD_EN
2982 	 */
2983 	interrupt_cntl &= ~IH_DUMMY_RD_OVERRIDE;
2984 	/* IH_REQ_NONSNOOP_EN=1 if ring is in non-cacheable memory, e.g., vram */
2985 	interrupt_cntl &= ~IH_REQ_NONSNOOP_EN;
2986 	WREG32(INTERRUPT_CNTL, interrupt_cntl);
2987 
2988 	WREG32(IH_RB_BASE, rdev->ih.gpu_addr >> 8);
2989 	rb_bufsz = drm_order(rdev->ih.ring_size / 4);
2990 
2991 	ih_rb_cntl = (IH_WPTR_OVERFLOW_ENABLE |
2992 		      IH_WPTR_OVERFLOW_CLEAR |
2993 		      (rb_bufsz << 1));
2994 
2995 	if (rdev->wb.enabled)
2996 		ih_rb_cntl |= IH_WPTR_WRITEBACK_ENABLE;
2997 
2998 	/* set the writeback address whether it's enabled or not */
2999 	WREG32(IH_RB_WPTR_ADDR_LO, (rdev->wb.gpu_addr + R600_WB_IH_WPTR_OFFSET) & 0xFFFFFFFC);
3000 	WREG32(IH_RB_WPTR_ADDR_HI, upper_32_bits(rdev->wb.gpu_addr + R600_WB_IH_WPTR_OFFSET) & 0xFF);
3001 
3002 	WREG32(IH_RB_CNTL, ih_rb_cntl);
3003 
3004 	/* set rptr, wptr to 0 */
3005 	WREG32(IH_RB_RPTR, 0);
3006 	WREG32(IH_RB_WPTR, 0);
3007 
3008 	/* Default settings for IH_CNTL (disabled at first) */
3009 	ih_cntl = MC_WRREQ_CREDIT(0x10) | MC_WR_CLEAN_CNT(0x10);
3010 	/* RPTR_REARM only works if msi's are enabled */
3011 	if (rdev->msi_enabled)
3012 		ih_cntl |= RPTR_REARM;
3013 	WREG32(IH_CNTL, ih_cntl);
3014 
3015 	/* force the active interrupt state to all disabled */
3016 	if (rdev->family >= CHIP_CEDAR)
3017 		evergreen_disable_interrupt_state(rdev);
3018 	else
3019 		r600_disable_interrupt_state(rdev);
3020 
3021 	/* enable irqs */
3022 	r600_enable_interrupts(rdev);
3023 
3024 	return ret;
3025 }
3026 
3027 void r600_irq_suspend(struct radeon_device *rdev)
3028 {
3029 	r600_irq_disable(rdev);
3030 	r600_rlc_stop(rdev);
3031 }
3032 
3033 void r600_irq_fini(struct radeon_device *rdev)
3034 {
3035 	r600_irq_suspend(rdev);
3036 	r600_ih_ring_fini(rdev);
3037 }
3038 
3039 int r600_irq_set(struct radeon_device *rdev)
3040 {
3041 	u32 cp_int_cntl = CNTX_BUSY_INT_ENABLE | CNTX_EMPTY_INT_ENABLE;
3042 	u32 mode_int = 0;
3043 	u32 hpd1, hpd2, hpd3, hpd4 = 0, hpd5 = 0, hpd6 = 0;
3044 	u32 grbm_int_cntl = 0;
3045 	u32 hdmi1, hdmi2;
3046 	u32 d1grph = 0, d2grph = 0;
3047 
3048 	if (!rdev->irq.installed) {
3049 		WARN(1, "Can't enable IRQ/MSI because no handler is installed\n");
3050 		return -EINVAL;
3051 	}
3052 	/* don't enable anything if the ih is disabled */
3053 	if (!rdev->ih.enabled) {
3054 		r600_disable_interrupts(rdev);
3055 		/* force the active interrupt state to all disabled */
3056 		r600_disable_interrupt_state(rdev);
3057 		return 0;
3058 	}
3059 
3060 	hdmi1 = RREG32(R600_HDMI_BLOCK1 + R600_HDMI_CNTL) & ~R600_HDMI_INT_EN;
3061 	if (ASIC_IS_DCE3(rdev)) {
3062 		hdmi2 = RREG32(R600_HDMI_BLOCK3 + R600_HDMI_CNTL) & ~R600_HDMI_INT_EN;
3063 		hpd1 = RREG32(DC_HPD1_INT_CONTROL) & ~DC_HPDx_INT_EN;
3064 		hpd2 = RREG32(DC_HPD2_INT_CONTROL) & ~DC_HPDx_INT_EN;
3065 		hpd3 = RREG32(DC_HPD3_INT_CONTROL) & ~DC_HPDx_INT_EN;
3066 		hpd4 = RREG32(DC_HPD4_INT_CONTROL) & ~DC_HPDx_INT_EN;
3067 		if (ASIC_IS_DCE32(rdev)) {
3068 			hpd5 = RREG32(DC_HPD5_INT_CONTROL) & ~DC_HPDx_INT_EN;
3069 			hpd6 = RREG32(DC_HPD6_INT_CONTROL) & ~DC_HPDx_INT_EN;
3070 		}
3071 	} else {
3072 		hdmi2 = RREG32(R600_HDMI_BLOCK2 + R600_HDMI_CNTL) & ~R600_HDMI_INT_EN;
3073 		hpd1 = RREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL) & ~DC_HPDx_INT_EN;
3074 		hpd2 = RREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL) & ~DC_HPDx_INT_EN;
3075 		hpd3 = RREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL) & ~DC_HPDx_INT_EN;
3076 	}
3077 
3078 	if (rdev->irq.sw_int) {
3079 		DRM_DEBUG("r600_irq_set: sw int\n");
3080 		cp_int_cntl |= RB_INT_ENABLE;
3081 		cp_int_cntl |= TIME_STAMP_INT_ENABLE;
3082 	}
3083 	if (rdev->irq.crtc_vblank_int[0] ||
3084 	    rdev->irq.pflip[0]) {
3085 		DRM_DEBUG("r600_irq_set: vblank 0\n");
3086 		mode_int |= D1MODE_VBLANK_INT_MASK;
3087 	}
3088 	if (rdev->irq.crtc_vblank_int[1] ||
3089 	    rdev->irq.pflip[1]) {
3090 		DRM_DEBUG("r600_irq_set: vblank 1\n");
3091 		mode_int |= D2MODE_VBLANK_INT_MASK;
3092 	}
3093 	if (rdev->irq.hpd[0]) {
3094 		DRM_DEBUG("r600_irq_set: hpd 1\n");
3095 		hpd1 |= DC_HPDx_INT_EN;
3096 	}
3097 	if (rdev->irq.hpd[1]) {
3098 		DRM_DEBUG("r600_irq_set: hpd 2\n");
3099 		hpd2 |= DC_HPDx_INT_EN;
3100 	}
3101 	if (rdev->irq.hpd[2]) {
3102 		DRM_DEBUG("r600_irq_set: hpd 3\n");
3103 		hpd3 |= DC_HPDx_INT_EN;
3104 	}
3105 	if (rdev->irq.hpd[3]) {
3106 		DRM_DEBUG("r600_irq_set: hpd 4\n");
3107 		hpd4 |= DC_HPDx_INT_EN;
3108 	}
3109 	if (rdev->irq.hpd[4]) {
3110 		DRM_DEBUG("r600_irq_set: hpd 5\n");
3111 		hpd5 |= DC_HPDx_INT_EN;
3112 	}
3113 	if (rdev->irq.hpd[5]) {
3114 		DRM_DEBUG("r600_irq_set: hpd 6\n");
3115 		hpd6 |= DC_HPDx_INT_EN;
3116 	}
3117 	if (rdev->irq.hdmi[0]) {
3118 		DRM_DEBUG("r600_irq_set: hdmi 1\n");
3119 		hdmi1 |= R600_HDMI_INT_EN;
3120 	}
3121 	if (rdev->irq.hdmi[1]) {
3122 		DRM_DEBUG("r600_irq_set: hdmi 2\n");
3123 		hdmi2 |= R600_HDMI_INT_EN;
3124 	}
3125 	if (rdev->irq.gui_idle) {
3126 		DRM_DEBUG("gui idle\n");
3127 		grbm_int_cntl |= GUI_IDLE_INT_ENABLE;
3128 	}
3129 
3130 	WREG32(CP_INT_CNTL, cp_int_cntl);
3131 	WREG32(DxMODE_INT_MASK, mode_int);
3132 	WREG32(D1GRPH_INTERRUPT_CONTROL, d1grph);
3133 	WREG32(D2GRPH_INTERRUPT_CONTROL, d2grph);
3134 	WREG32(GRBM_INT_CNTL, grbm_int_cntl);
3135 	WREG32(R600_HDMI_BLOCK1 + R600_HDMI_CNTL, hdmi1);
3136 	if (ASIC_IS_DCE3(rdev)) {
3137 		WREG32(R600_HDMI_BLOCK3 + R600_HDMI_CNTL, hdmi2);
3138 		WREG32(DC_HPD1_INT_CONTROL, hpd1);
3139 		WREG32(DC_HPD2_INT_CONTROL, hpd2);
3140 		WREG32(DC_HPD3_INT_CONTROL, hpd3);
3141 		WREG32(DC_HPD4_INT_CONTROL, hpd4);
3142 		if (ASIC_IS_DCE32(rdev)) {
3143 			WREG32(DC_HPD5_INT_CONTROL, hpd5);
3144 			WREG32(DC_HPD6_INT_CONTROL, hpd6);
3145 		}
3146 	} else {
3147 		WREG32(R600_HDMI_BLOCK2 + R600_HDMI_CNTL, hdmi2);
3148 		WREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL, hpd1);
3149 		WREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL, hpd2);
3150 		WREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL, hpd3);
3151 	}
3152 
3153 	return 0;
3154 }
3155 
3156 static void r600_irq_ack(struct radeon_device *rdev)
3157 {
3158 	u32 tmp;
3159 
3160 	if (ASIC_IS_DCE3(rdev)) {
3161 		rdev->irq.stat_regs.r600.disp_int = RREG32(DCE3_DISP_INTERRUPT_STATUS);
3162 		rdev->irq.stat_regs.r600.disp_int_cont = RREG32(DCE3_DISP_INTERRUPT_STATUS_CONTINUE);
3163 		rdev->irq.stat_regs.r600.disp_int_cont2 = RREG32(DCE3_DISP_INTERRUPT_STATUS_CONTINUE2);
3164 	} else {
3165 		rdev->irq.stat_regs.r600.disp_int = RREG32(DISP_INTERRUPT_STATUS);
3166 		rdev->irq.stat_regs.r600.disp_int_cont = RREG32(DISP_INTERRUPT_STATUS_CONTINUE);
3167 		rdev->irq.stat_regs.r600.disp_int_cont2 = 0;
3168 	}
3169 	rdev->irq.stat_regs.r600.d1grph_int = RREG32(D1GRPH_INTERRUPT_STATUS);
3170 	rdev->irq.stat_regs.r600.d2grph_int = RREG32(D2GRPH_INTERRUPT_STATUS);
3171 
3172 	if (rdev->irq.stat_regs.r600.d1grph_int & DxGRPH_PFLIP_INT_OCCURRED)
3173 		WREG32(D1GRPH_INTERRUPT_STATUS, DxGRPH_PFLIP_INT_CLEAR);
3174 	if (rdev->irq.stat_regs.r600.d2grph_int & DxGRPH_PFLIP_INT_OCCURRED)
3175 		WREG32(D2GRPH_INTERRUPT_STATUS, DxGRPH_PFLIP_INT_CLEAR);
3176 	if (rdev->irq.stat_regs.r600.disp_int & LB_D1_VBLANK_INTERRUPT)
3177 		WREG32(D1MODE_VBLANK_STATUS, DxMODE_VBLANK_ACK);
3178 	if (rdev->irq.stat_regs.r600.disp_int & LB_D1_VLINE_INTERRUPT)
3179 		WREG32(D1MODE_VLINE_STATUS, DxMODE_VLINE_ACK);
3180 	if (rdev->irq.stat_regs.r600.disp_int & LB_D2_VBLANK_INTERRUPT)
3181 		WREG32(D2MODE_VBLANK_STATUS, DxMODE_VBLANK_ACK);
3182 	if (rdev->irq.stat_regs.r600.disp_int & LB_D2_VLINE_INTERRUPT)
3183 		WREG32(D2MODE_VLINE_STATUS, DxMODE_VLINE_ACK);
3184 	if (rdev->irq.stat_regs.r600.disp_int & DC_HPD1_INTERRUPT) {
3185 		if (ASIC_IS_DCE3(rdev)) {
3186 			tmp = RREG32(DC_HPD1_INT_CONTROL);
3187 			tmp |= DC_HPDx_INT_ACK;
3188 			WREG32(DC_HPD1_INT_CONTROL, tmp);
3189 		} else {
3190 			tmp = RREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL);
3191 			tmp |= DC_HPDx_INT_ACK;
3192 			WREG32(DC_HOT_PLUG_DETECT1_INT_CONTROL, tmp);
3193 		}
3194 	}
3195 	if (rdev->irq.stat_regs.r600.disp_int & DC_HPD2_INTERRUPT) {
3196 		if (ASIC_IS_DCE3(rdev)) {
3197 			tmp = RREG32(DC_HPD2_INT_CONTROL);
3198 			tmp |= DC_HPDx_INT_ACK;
3199 			WREG32(DC_HPD2_INT_CONTROL, tmp);
3200 		} else {
3201 			tmp = RREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL);
3202 			tmp |= DC_HPDx_INT_ACK;
3203 			WREG32(DC_HOT_PLUG_DETECT2_INT_CONTROL, tmp);
3204 		}
3205 	}
3206 	if (rdev->irq.stat_regs.r600.disp_int_cont & DC_HPD3_INTERRUPT) {
3207 		if (ASIC_IS_DCE3(rdev)) {
3208 			tmp = RREG32(DC_HPD3_INT_CONTROL);
3209 			tmp |= DC_HPDx_INT_ACK;
3210 			WREG32(DC_HPD3_INT_CONTROL, tmp);
3211 		} else {
3212 			tmp = RREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL);
3213 			tmp |= DC_HPDx_INT_ACK;
3214 			WREG32(DC_HOT_PLUG_DETECT3_INT_CONTROL, tmp);
3215 		}
3216 	}
3217 	if (rdev->irq.stat_regs.r600.disp_int_cont & DC_HPD4_INTERRUPT) {
3218 		tmp = RREG32(DC_HPD4_INT_CONTROL);
3219 		tmp |= DC_HPDx_INT_ACK;
3220 		WREG32(DC_HPD4_INT_CONTROL, tmp);
3221 	}
3222 	if (ASIC_IS_DCE32(rdev)) {
3223 		if (rdev->irq.stat_regs.r600.disp_int_cont2 & DC_HPD5_INTERRUPT) {
3224 			tmp = RREG32(DC_HPD5_INT_CONTROL);
3225 			tmp |= DC_HPDx_INT_ACK;
3226 			WREG32(DC_HPD5_INT_CONTROL, tmp);
3227 		}
3228 		if (rdev->irq.stat_regs.r600.disp_int_cont2 & DC_HPD6_INTERRUPT) {
3229 			tmp = RREG32(DC_HPD5_INT_CONTROL);
3230 			tmp |= DC_HPDx_INT_ACK;
3231 			WREG32(DC_HPD6_INT_CONTROL, tmp);
3232 		}
3233 	}
3234 	if (RREG32(R600_HDMI_BLOCK1 + R600_HDMI_STATUS) & R600_HDMI_INT_PENDING) {
3235 		WREG32_P(R600_HDMI_BLOCK1 + R600_HDMI_CNTL, R600_HDMI_INT_ACK, ~R600_HDMI_INT_ACK);
3236 	}
3237 	if (ASIC_IS_DCE3(rdev)) {
3238 		if (RREG32(R600_HDMI_BLOCK3 + R600_HDMI_STATUS) & R600_HDMI_INT_PENDING) {
3239 			WREG32_P(R600_HDMI_BLOCK3 + R600_HDMI_CNTL, R600_HDMI_INT_ACK, ~R600_HDMI_INT_ACK);
3240 		}
3241 	} else {
3242 		if (RREG32(R600_HDMI_BLOCK2 + R600_HDMI_STATUS) & R600_HDMI_INT_PENDING) {
3243 			WREG32_P(R600_HDMI_BLOCK2 + R600_HDMI_CNTL, R600_HDMI_INT_ACK, ~R600_HDMI_INT_ACK);
3244 		}
3245 	}
3246 }
3247 
3248 void r600_irq_disable(struct radeon_device *rdev)
3249 {
3250 	r600_disable_interrupts(rdev);
3251 	/* Wait and acknowledge irq */
3252 	mdelay(1);
3253 	r600_irq_ack(rdev);
3254 	r600_disable_interrupt_state(rdev);
3255 }
3256 
3257 static u32 r600_get_ih_wptr(struct radeon_device *rdev)
3258 {
3259 	u32 wptr, tmp;
3260 
3261 	if (rdev->wb.enabled)
3262 		wptr = le32_to_cpu(rdev->wb.wb[R600_WB_IH_WPTR_OFFSET/4]);
3263 	else
3264 		wptr = RREG32(IH_RB_WPTR);
3265 
3266 	if (wptr & RB_OVERFLOW) {
3267 		/* When a ring buffer overflow happen start parsing interrupt
3268 		 * from the last not overwritten vector (wptr + 16). Hopefully
3269 		 * this should allow us to catchup.
3270 		 */
3271 		dev_warn(rdev->dev, "IH ring buffer overflow (0x%08X, %d, %d)\n",
3272 			wptr, rdev->ih.rptr, (wptr + 16) + rdev->ih.ptr_mask);
3273 		rdev->ih.rptr = (wptr + 16) & rdev->ih.ptr_mask;
3274 		tmp = RREG32(IH_RB_CNTL);
3275 		tmp |= IH_WPTR_OVERFLOW_CLEAR;
3276 		WREG32(IH_RB_CNTL, tmp);
3277 	}
3278 	return (wptr & rdev->ih.ptr_mask);
3279 }
3280 
3281 /*        r600 IV Ring
3282  * Each IV ring entry is 128 bits:
3283  * [7:0]    - interrupt source id
3284  * [31:8]   - reserved
3285  * [59:32]  - interrupt source data
3286  * [127:60]  - reserved
3287  *
3288  * The basic interrupt vector entries
3289  * are decoded as follows:
3290  * src_id  src_data  description
3291  *      1         0  D1 Vblank
3292  *      1         1  D1 Vline
3293  *      5         0  D2 Vblank
3294  *      5         1  D2 Vline
3295  *     19         0  FP Hot plug detection A
3296  *     19         1  FP Hot plug detection B
3297  *     19         2  DAC A auto-detection
3298  *     19         3  DAC B auto-detection
3299  *     21         4  HDMI block A
3300  *     21         5  HDMI block B
3301  *    176         -  CP_INT RB
3302  *    177         -  CP_INT IB1
3303  *    178         -  CP_INT IB2
3304  *    181         -  EOP Interrupt
3305  *    233         -  GUI Idle
3306  *
3307  * Note, these are based on r600 and may need to be
3308  * adjusted or added to on newer asics
3309  */
3310 
3311 int r600_irq_process(struct radeon_device *rdev)
3312 {
3313 	u32 wptr;
3314 	u32 rptr;
3315 	u32 src_id, src_data;
3316 	u32 ring_index;
3317 	unsigned long flags;
3318 	bool queue_hotplug = false;
3319 
3320 	if (!rdev->ih.enabled || rdev->shutdown)
3321 		return IRQ_NONE;
3322 
3323 	/* No MSIs, need a dummy read to flush PCI DMAs */
3324 	if (!rdev->msi_enabled)
3325 		RREG32(IH_RB_WPTR);
3326 
3327 	wptr = r600_get_ih_wptr(rdev);
3328 	rptr = rdev->ih.rptr;
3329 	DRM_DEBUG("r600_irq_process start: rptr %d, wptr %d\n", rptr, wptr);
3330 
3331 	spin_lock_irqsave(&rdev->ih.lock, flags);
3332 
3333 	if (rptr == wptr) {
3334 		spin_unlock_irqrestore(&rdev->ih.lock, flags);
3335 		return IRQ_NONE;
3336 	}
3337 
3338 restart_ih:
3339 	/* Order reading of wptr vs. reading of IH ring data */
3340 	rmb();
3341 
3342 	/* display interrupts */
3343 	r600_irq_ack(rdev);
3344 
3345 	rdev->ih.wptr = wptr;
3346 	while (rptr != wptr) {
3347 		/* wptr/rptr are in bytes! */
3348 		ring_index = rptr / 4;
3349 		src_id = le32_to_cpu(rdev->ih.ring[ring_index]) & 0xff;
3350 		src_data = le32_to_cpu(rdev->ih.ring[ring_index + 1]) & 0xfffffff;
3351 
3352 		switch (src_id) {
3353 		case 1: /* D1 vblank/vline */
3354 			switch (src_data) {
3355 			case 0: /* D1 vblank */
3356 				if (rdev->irq.stat_regs.r600.disp_int & LB_D1_VBLANK_INTERRUPT) {
3357 					if (rdev->irq.crtc_vblank_int[0]) {
3358 						drm_handle_vblank(rdev->ddev, 0);
3359 						rdev->pm.vblank_sync = true;
3360 						wake_up(&rdev->irq.vblank_queue);
3361 					}
3362 					if (rdev->irq.pflip[0])
3363 						radeon_crtc_handle_flip(rdev, 0);
3364 					rdev->irq.stat_regs.r600.disp_int &= ~LB_D1_VBLANK_INTERRUPT;
3365 					DRM_DEBUG("IH: D1 vblank\n");
3366 				}
3367 				break;
3368 			case 1: /* D1 vline */
3369 				if (rdev->irq.stat_regs.r600.disp_int & LB_D1_VLINE_INTERRUPT) {
3370 					rdev->irq.stat_regs.r600.disp_int &= ~LB_D1_VLINE_INTERRUPT;
3371 					DRM_DEBUG("IH: D1 vline\n");
3372 				}
3373 				break;
3374 			default:
3375 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
3376 				break;
3377 			}
3378 			break;
3379 		case 5: /* D2 vblank/vline */
3380 			switch (src_data) {
3381 			case 0: /* D2 vblank */
3382 				if (rdev->irq.stat_regs.r600.disp_int & LB_D2_VBLANK_INTERRUPT) {
3383 					if (rdev->irq.crtc_vblank_int[1]) {
3384 						drm_handle_vblank(rdev->ddev, 1);
3385 						rdev->pm.vblank_sync = true;
3386 						wake_up(&rdev->irq.vblank_queue);
3387 					}
3388 					if (rdev->irq.pflip[1])
3389 						radeon_crtc_handle_flip(rdev, 1);
3390 					rdev->irq.stat_regs.r600.disp_int &= ~LB_D2_VBLANK_INTERRUPT;
3391 					DRM_DEBUG("IH: D2 vblank\n");
3392 				}
3393 				break;
3394 			case 1: /* D1 vline */
3395 				if (rdev->irq.stat_regs.r600.disp_int & LB_D2_VLINE_INTERRUPT) {
3396 					rdev->irq.stat_regs.r600.disp_int &= ~LB_D2_VLINE_INTERRUPT;
3397 					DRM_DEBUG("IH: D2 vline\n");
3398 				}
3399 				break;
3400 			default:
3401 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
3402 				break;
3403 			}
3404 			break;
3405 		case 19: /* HPD/DAC hotplug */
3406 			switch (src_data) {
3407 			case 0:
3408 				if (rdev->irq.stat_regs.r600.disp_int & DC_HPD1_INTERRUPT) {
3409 					rdev->irq.stat_regs.r600.disp_int &= ~DC_HPD1_INTERRUPT;
3410 					queue_hotplug = true;
3411 					DRM_DEBUG("IH: HPD1\n");
3412 				}
3413 				break;
3414 			case 1:
3415 				if (rdev->irq.stat_regs.r600.disp_int & DC_HPD2_INTERRUPT) {
3416 					rdev->irq.stat_regs.r600.disp_int &= ~DC_HPD2_INTERRUPT;
3417 					queue_hotplug = true;
3418 					DRM_DEBUG("IH: HPD2\n");
3419 				}
3420 				break;
3421 			case 4:
3422 				if (rdev->irq.stat_regs.r600.disp_int_cont & DC_HPD3_INTERRUPT) {
3423 					rdev->irq.stat_regs.r600.disp_int_cont &= ~DC_HPD3_INTERRUPT;
3424 					queue_hotplug = true;
3425 					DRM_DEBUG("IH: HPD3\n");
3426 				}
3427 				break;
3428 			case 5:
3429 				if (rdev->irq.stat_regs.r600.disp_int_cont & DC_HPD4_INTERRUPT) {
3430 					rdev->irq.stat_regs.r600.disp_int_cont &= ~DC_HPD4_INTERRUPT;
3431 					queue_hotplug = true;
3432 					DRM_DEBUG("IH: HPD4\n");
3433 				}
3434 				break;
3435 			case 10:
3436 				if (rdev->irq.stat_regs.r600.disp_int_cont2 & DC_HPD5_INTERRUPT) {
3437 					rdev->irq.stat_regs.r600.disp_int_cont2 &= ~DC_HPD5_INTERRUPT;
3438 					queue_hotplug = true;
3439 					DRM_DEBUG("IH: HPD5\n");
3440 				}
3441 				break;
3442 			case 12:
3443 				if (rdev->irq.stat_regs.r600.disp_int_cont2 & DC_HPD6_INTERRUPT) {
3444 					rdev->irq.stat_regs.r600.disp_int_cont2 &= ~DC_HPD6_INTERRUPT;
3445 					queue_hotplug = true;
3446 					DRM_DEBUG("IH: HPD6\n");
3447 				}
3448 				break;
3449 			default:
3450 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
3451 				break;
3452 			}
3453 			break;
3454 		case 21: /* HDMI */
3455 			DRM_DEBUG("IH: HDMI: 0x%x\n", src_data);
3456 			r600_audio_schedule_polling(rdev);
3457 			break;
3458 		case 176: /* CP_INT in ring buffer */
3459 		case 177: /* CP_INT in IB1 */
3460 		case 178: /* CP_INT in IB2 */
3461 			DRM_DEBUG("IH: CP int: 0x%08x\n", src_data);
3462 			radeon_fence_process(rdev);
3463 			break;
3464 		case 181: /* CP EOP event */
3465 			DRM_DEBUG("IH: CP EOP\n");
3466 			radeon_fence_process(rdev);
3467 			break;
3468 		case 233: /* GUI IDLE */
3469 			DRM_DEBUG("IH: GUI idle\n");
3470 			rdev->pm.gui_idle = true;
3471 			wake_up(&rdev->irq.idle_queue);
3472 			break;
3473 		default:
3474 			DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
3475 			break;
3476 		}
3477 
3478 		/* wptr/rptr are in bytes! */
3479 		rptr += 16;
3480 		rptr &= rdev->ih.ptr_mask;
3481 	}
3482 	/* make sure wptr hasn't changed while processing */
3483 	wptr = r600_get_ih_wptr(rdev);
3484 	if (wptr != rdev->ih.wptr)
3485 		goto restart_ih;
3486 	if (queue_hotplug)
3487 		schedule_work(&rdev->hotplug_work);
3488 	rdev->ih.rptr = rptr;
3489 	WREG32(IH_RB_RPTR, rdev->ih.rptr);
3490 	spin_unlock_irqrestore(&rdev->ih.lock, flags);
3491 	return IRQ_HANDLED;
3492 }
3493 
3494 /*
3495  * Debugfs info
3496  */
3497 #if defined(CONFIG_DEBUG_FS)
3498 
3499 static int r600_debugfs_cp_ring_info(struct seq_file *m, void *data)
3500 {
3501 	struct drm_info_node *node = (struct drm_info_node *) m->private;
3502 	struct drm_device *dev = node->minor->dev;
3503 	struct radeon_device *rdev = dev->dev_private;
3504 	unsigned count, i, j;
3505 
3506 	radeon_ring_free_size(rdev);
3507 	count = (rdev->cp.ring_size / 4) - rdev->cp.ring_free_dw;
3508 	seq_printf(m, "CP_STAT 0x%08x\n", RREG32(CP_STAT));
3509 	seq_printf(m, "CP_RB_WPTR 0x%08x\n", RREG32(CP_RB_WPTR));
3510 	seq_printf(m, "CP_RB_RPTR 0x%08x\n", RREG32(CP_RB_RPTR));
3511 	seq_printf(m, "driver's copy of the CP_RB_WPTR 0x%08x\n", rdev->cp.wptr);
3512 	seq_printf(m, "driver's copy of the CP_RB_RPTR 0x%08x\n", rdev->cp.rptr);
3513 	seq_printf(m, "%u free dwords in ring\n", rdev->cp.ring_free_dw);
3514 	seq_printf(m, "%u dwords in ring\n", count);
3515 	i = rdev->cp.rptr;
3516 	for (j = 0; j <= count; j++) {
3517 		seq_printf(m, "r[%04d]=0x%08x\n", i, rdev->cp.ring[i]);
3518 		i = (i + 1) & rdev->cp.ptr_mask;
3519 	}
3520 	return 0;
3521 }
3522 
3523 static int r600_debugfs_mc_info(struct seq_file *m, void *data)
3524 {
3525 	struct drm_info_node *node = (struct drm_info_node *) m->private;
3526 	struct drm_device *dev = node->minor->dev;
3527 	struct radeon_device *rdev = dev->dev_private;
3528 
3529 	DREG32_SYS(m, rdev, R_000E50_SRBM_STATUS);
3530 	DREG32_SYS(m, rdev, VM_L2_STATUS);
3531 	return 0;
3532 }
3533 
3534 static struct drm_info_list r600_mc_info_list[] = {
3535 	{"r600_mc_info", r600_debugfs_mc_info, 0, NULL},
3536 	{"r600_ring_info", r600_debugfs_cp_ring_info, 0, NULL},
3537 };
3538 #endif
3539 
3540 int r600_debugfs_mc_info_init(struct radeon_device *rdev)
3541 {
3542 #if defined(CONFIG_DEBUG_FS)
3543 	return radeon_debugfs_add_files(rdev, r600_mc_info_list, ARRAY_SIZE(r600_mc_info_list));
3544 #else
3545 	return 0;
3546 #endif
3547 }
3548 
3549 /**
3550  * r600_ioctl_wait_idle - flush host path cache on wait idle ioctl
3551  * rdev: radeon device structure
3552  * bo: buffer object struct which userspace is waiting for idle
3553  *
3554  * Some R6XX/R7XX doesn't seems to take into account HDP flush performed
3555  * through ring buffer, this leads to corruption in rendering, see
3556  * http://bugzilla.kernel.org/show_bug.cgi?id=15186 to avoid this we
3557  * directly perform HDP flush by writing register through MMIO.
3558  */
3559 void r600_ioctl_wait_idle(struct radeon_device *rdev, struct radeon_bo *bo)
3560 {
3561 	/* r7xx hw bug.  write to HDP_DEBUG1 followed by fb read
3562 	 * rather than write to HDP_REG_COHERENCY_FLUSH_CNTL.
3563 	 * This seems to cause problems on some AGP cards. Just use the old
3564 	 * method for them.
3565 	 */
3566 	if ((rdev->family >= CHIP_RV770) && (rdev->family <= CHIP_RV740) &&
3567 	    rdev->vram_scratch.ptr && !(rdev->flags & RADEON_IS_AGP)) {
3568 		void __iomem *ptr = (void *)rdev->vram_scratch.ptr;
3569 		u32 tmp;
3570 
3571 		WREG32(HDP_DEBUG1, 0);
3572 		tmp = readl((void __iomem *)ptr);
3573 	} else
3574 		WREG32(R_005480_HDP_MEM_COHERENCY_FLUSH_CNTL, 0x1);
3575 }
3576 
3577 void r600_set_pcie_lanes(struct radeon_device *rdev, int lanes)
3578 {
3579 	u32 link_width_cntl, mask, target_reg;
3580 
3581 	if (rdev->flags & RADEON_IS_IGP)
3582 		return;
3583 
3584 	if (!(rdev->flags & RADEON_IS_PCIE))
3585 		return;
3586 
3587 	/* x2 cards have a special sequence */
3588 	if (ASIC_IS_X2(rdev))
3589 		return;
3590 
3591 	/* FIXME wait for idle */
3592 
3593 	switch (lanes) {
3594 	case 0:
3595 		mask = RADEON_PCIE_LC_LINK_WIDTH_X0;
3596 		break;
3597 	case 1:
3598 		mask = RADEON_PCIE_LC_LINK_WIDTH_X1;
3599 		break;
3600 	case 2:
3601 		mask = RADEON_PCIE_LC_LINK_WIDTH_X2;
3602 		break;
3603 	case 4:
3604 		mask = RADEON_PCIE_LC_LINK_WIDTH_X4;
3605 		break;
3606 	case 8:
3607 		mask = RADEON_PCIE_LC_LINK_WIDTH_X8;
3608 		break;
3609 	case 12:
3610 		mask = RADEON_PCIE_LC_LINK_WIDTH_X12;
3611 		break;
3612 	case 16:
3613 	default:
3614 		mask = RADEON_PCIE_LC_LINK_WIDTH_X16;
3615 		break;
3616 	}
3617 
3618 	link_width_cntl = RREG32_PCIE_P(RADEON_PCIE_LC_LINK_WIDTH_CNTL);
3619 
3620 	if ((link_width_cntl & RADEON_PCIE_LC_LINK_WIDTH_RD_MASK) ==
3621 	    (mask << RADEON_PCIE_LC_LINK_WIDTH_RD_SHIFT))
3622 		return;
3623 
3624 	if (link_width_cntl & R600_PCIE_LC_UPCONFIGURE_DIS)
3625 		return;
3626 
3627 	link_width_cntl &= ~(RADEON_PCIE_LC_LINK_WIDTH_MASK |
3628 			     RADEON_PCIE_LC_RECONFIG_NOW |
3629 			     R600_PCIE_LC_RENEGOTIATE_EN |
3630 			     R600_PCIE_LC_RECONFIG_ARC_MISSING_ESCAPE);
3631 	link_width_cntl |= mask;
3632 
3633 	WREG32_PCIE_P(RADEON_PCIE_LC_LINK_WIDTH_CNTL, link_width_cntl);
3634 
3635         /* some northbridges can renegotiate the link rather than requiring
3636          * a complete re-config.
3637          * e.g., AMD 780/790 northbridges (pci ids: 0x5956, 0x5957, 0x5958, etc.)
3638          */
3639         if (link_width_cntl & R600_PCIE_LC_RENEGOTIATION_SUPPORT)
3640 		link_width_cntl |= R600_PCIE_LC_RENEGOTIATE_EN | R600_PCIE_LC_UPCONFIGURE_SUPPORT;
3641         else
3642 		link_width_cntl |= R600_PCIE_LC_RECONFIG_ARC_MISSING_ESCAPE;
3643 
3644 	WREG32_PCIE_P(RADEON_PCIE_LC_LINK_WIDTH_CNTL, (link_width_cntl |
3645 						       RADEON_PCIE_LC_RECONFIG_NOW));
3646 
3647         if (rdev->family >= CHIP_RV770)
3648 		target_reg = R700_TARGET_AND_CURRENT_PROFILE_INDEX;
3649         else
3650 		target_reg = R600_TARGET_AND_CURRENT_PROFILE_INDEX;
3651 
3652         /* wait for lane set to complete */
3653         link_width_cntl = RREG32(target_reg);
3654         while (link_width_cntl == 0xffffffff)
3655 		link_width_cntl = RREG32(target_reg);
3656 
3657 }
3658 
3659 int r600_get_pcie_lanes(struct radeon_device *rdev)
3660 {
3661 	u32 link_width_cntl;
3662 
3663 	if (rdev->flags & RADEON_IS_IGP)
3664 		return 0;
3665 
3666 	if (!(rdev->flags & RADEON_IS_PCIE))
3667 		return 0;
3668 
3669 	/* x2 cards have a special sequence */
3670 	if (ASIC_IS_X2(rdev))
3671 		return 0;
3672 
3673 	/* FIXME wait for idle */
3674 
3675 	link_width_cntl = RREG32_PCIE_P(RADEON_PCIE_LC_LINK_WIDTH_CNTL);
3676 
3677 	switch ((link_width_cntl & RADEON_PCIE_LC_LINK_WIDTH_RD_MASK) >> RADEON_PCIE_LC_LINK_WIDTH_RD_SHIFT) {
3678 	case RADEON_PCIE_LC_LINK_WIDTH_X0:
3679 		return 0;
3680 	case RADEON_PCIE_LC_LINK_WIDTH_X1:
3681 		return 1;
3682 	case RADEON_PCIE_LC_LINK_WIDTH_X2:
3683 		return 2;
3684 	case RADEON_PCIE_LC_LINK_WIDTH_X4:
3685 		return 4;
3686 	case RADEON_PCIE_LC_LINK_WIDTH_X8:
3687 		return 8;
3688 	case RADEON_PCIE_LC_LINK_WIDTH_X16:
3689 	default:
3690 		return 16;
3691 	}
3692 }
3693 
3694 static void r600_pcie_gen2_enable(struct radeon_device *rdev)
3695 {
3696 	u32 link_width_cntl, lanes, speed_cntl, training_cntl, tmp;
3697 	u16 link_cntl2;
3698 
3699 	if (radeon_pcie_gen2 == 0)
3700 		return;
3701 
3702 	if (rdev->flags & RADEON_IS_IGP)
3703 		return;
3704 
3705 	if (!(rdev->flags & RADEON_IS_PCIE))
3706 		return;
3707 
3708 	/* x2 cards have a special sequence */
3709 	if (ASIC_IS_X2(rdev))
3710 		return;
3711 
3712 	/* only RV6xx+ chips are supported */
3713 	if (rdev->family <= CHIP_R600)
3714 		return;
3715 
3716 	/* 55 nm r6xx asics */
3717 	if ((rdev->family == CHIP_RV670) ||
3718 	    (rdev->family == CHIP_RV620) ||
3719 	    (rdev->family == CHIP_RV635)) {
3720 		/* advertise upconfig capability */
3721 		link_width_cntl = RREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL);
3722 		link_width_cntl &= ~LC_UPCONFIGURE_DIS;
3723 		WREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL, link_width_cntl);
3724 		link_width_cntl = RREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL);
3725 		if (link_width_cntl & LC_RENEGOTIATION_SUPPORT) {
3726 			lanes = (link_width_cntl & LC_LINK_WIDTH_RD_MASK) >> LC_LINK_WIDTH_RD_SHIFT;
3727 			link_width_cntl &= ~(LC_LINK_WIDTH_MASK |
3728 					     LC_RECONFIG_ARC_MISSING_ESCAPE);
3729 			link_width_cntl |= lanes | LC_RECONFIG_NOW | LC_RENEGOTIATE_EN;
3730 			WREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL, link_width_cntl);
3731 		} else {
3732 			link_width_cntl |= LC_UPCONFIGURE_DIS;
3733 			WREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL, link_width_cntl);
3734 		}
3735 	}
3736 
3737 	speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3738 	if ((speed_cntl & LC_OTHER_SIDE_EVER_SENT_GEN2) &&
3739 	    (speed_cntl & LC_OTHER_SIDE_SUPPORTS_GEN2)) {
3740 
3741 		/* 55 nm r6xx asics */
3742 		if ((rdev->family == CHIP_RV670) ||
3743 		    (rdev->family == CHIP_RV620) ||
3744 		    (rdev->family == CHIP_RV635)) {
3745 			WREG32(MM_CFGREGS_CNTL, 0x8);
3746 			link_cntl2 = RREG32(0x4088);
3747 			WREG32(MM_CFGREGS_CNTL, 0);
3748 			/* not supported yet */
3749 			if (link_cntl2 & SELECTABLE_DEEMPHASIS)
3750 				return;
3751 		}
3752 
3753 		speed_cntl &= ~LC_SPEED_CHANGE_ATTEMPTS_ALLOWED_MASK;
3754 		speed_cntl |= (0x3 << LC_SPEED_CHANGE_ATTEMPTS_ALLOWED_SHIFT);
3755 		speed_cntl &= ~LC_VOLTAGE_TIMER_SEL_MASK;
3756 		speed_cntl &= ~LC_FORCE_DIS_HW_SPEED_CHANGE;
3757 		speed_cntl |= LC_FORCE_EN_HW_SPEED_CHANGE;
3758 		WREG32_PCIE_P(PCIE_LC_SPEED_CNTL, speed_cntl);
3759 
3760 		tmp = RREG32(0x541c);
3761 		WREG32(0x541c, tmp | 0x8);
3762 		WREG32(MM_CFGREGS_CNTL, MM_WR_TO_CFG_EN);
3763 		link_cntl2 = RREG16(0x4088);
3764 		link_cntl2 &= ~TARGET_LINK_SPEED_MASK;
3765 		link_cntl2 |= 0x2;
3766 		WREG16(0x4088, link_cntl2);
3767 		WREG32(MM_CFGREGS_CNTL, 0);
3768 
3769 		if ((rdev->family == CHIP_RV670) ||
3770 		    (rdev->family == CHIP_RV620) ||
3771 		    (rdev->family == CHIP_RV635)) {
3772 			training_cntl = RREG32_PCIE_P(PCIE_LC_TRAINING_CNTL);
3773 			training_cntl &= ~LC_POINT_7_PLUS_EN;
3774 			WREG32_PCIE_P(PCIE_LC_TRAINING_CNTL, training_cntl);
3775 		} else {
3776 			speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3777 			speed_cntl &= ~LC_TARGET_LINK_SPEED_OVERRIDE_EN;
3778 			WREG32_PCIE_P(PCIE_LC_SPEED_CNTL, speed_cntl);
3779 		}
3780 
3781 		speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3782 		speed_cntl |= LC_GEN2_EN_STRAP;
3783 		WREG32_PCIE_P(PCIE_LC_SPEED_CNTL, speed_cntl);
3784 
3785 	} else {
3786 		link_width_cntl = RREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL);
3787 		/* XXX: only disable it if gen1 bridge vendor == 0x111d or 0x1106 */
3788 		if (1)
3789 			link_width_cntl |= LC_UPCONFIGURE_DIS;
3790 		else
3791 			link_width_cntl &= ~LC_UPCONFIGURE_DIS;
3792 		WREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL, link_width_cntl);
3793 	}
3794 }
3795