xref: /linux/drivers/gpu/drm/radeon/evergreen.c (revision f850548ef88e5ff9e40bae9e1a7140bef0653e6b)
1 /*
2  * Copyright 2010 Advanced Micro Devices, Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  * Authors: Alex Deucher
23  */
24 #include <linux/firmware.h>
25 #include <linux/platform_device.h>
26 #include <linux/slab.h>
27 #include "drmP.h"
28 #include "radeon.h"
29 #include "radeon_asic.h"
30 #include "radeon_drm.h"
31 #include "evergreend.h"
32 #include "atom.h"
33 #include "avivod.h"
34 #include "evergreen_reg.h"
35 #include "evergreen_blit_shaders.h"
36 
37 #define EVERGREEN_PFP_UCODE_SIZE 1120
38 #define EVERGREEN_PM4_UCODE_SIZE 1376
39 
40 static void evergreen_gpu_init(struct radeon_device *rdev);
41 void evergreen_fini(struct radeon_device *rdev);
42 static void evergreen_pcie_gen2_enable(struct radeon_device *rdev);
43 
44 void evergreen_pre_page_flip(struct radeon_device *rdev, int crtc)
45 {
46 	/* enable the pflip int */
47 	radeon_irq_kms_pflip_irq_get(rdev, crtc);
48 }
49 
50 void evergreen_post_page_flip(struct radeon_device *rdev, int crtc)
51 {
52 	/* disable the pflip int */
53 	radeon_irq_kms_pflip_irq_put(rdev, crtc);
54 }
55 
56 u32 evergreen_page_flip(struct radeon_device *rdev, int crtc_id, u64 crtc_base)
57 {
58 	struct radeon_crtc *radeon_crtc = rdev->mode_info.crtcs[crtc_id];
59 	u32 tmp = RREG32(EVERGREEN_GRPH_UPDATE + radeon_crtc->crtc_offset);
60 
61 	/* Lock the graphics update lock */
62 	tmp |= EVERGREEN_GRPH_UPDATE_LOCK;
63 	WREG32(EVERGREEN_GRPH_UPDATE + radeon_crtc->crtc_offset, tmp);
64 
65 	/* update the scanout addresses */
66 	WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + radeon_crtc->crtc_offset,
67 	       upper_32_bits(crtc_base));
68 	WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + radeon_crtc->crtc_offset,
69 	       (u32)crtc_base);
70 
71 	WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + radeon_crtc->crtc_offset,
72 	       upper_32_bits(crtc_base));
73 	WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + radeon_crtc->crtc_offset,
74 	       (u32)crtc_base);
75 
76 	/* Wait for update_pending to go high. */
77 	while (!(RREG32(EVERGREEN_GRPH_UPDATE + radeon_crtc->crtc_offset) & EVERGREEN_GRPH_SURFACE_UPDATE_PENDING));
78 	DRM_DEBUG("Update pending now high. Unlocking vupdate_lock.\n");
79 
80 	/* Unlock the lock, so double-buffering can take place inside vblank */
81 	tmp &= ~EVERGREEN_GRPH_UPDATE_LOCK;
82 	WREG32(EVERGREEN_GRPH_UPDATE + radeon_crtc->crtc_offset, tmp);
83 
84 	/* Return current update_pending status: */
85 	return RREG32(EVERGREEN_GRPH_UPDATE + radeon_crtc->crtc_offset) & EVERGREEN_GRPH_SURFACE_UPDATE_PENDING;
86 }
87 
88 /* get temperature in millidegrees */
89 int evergreen_get_temp(struct radeon_device *rdev)
90 {
91 	u32 temp = (RREG32(CG_MULT_THERMAL_STATUS) & ASIC_T_MASK) >>
92 		ASIC_T_SHIFT;
93 	u32 actual_temp = 0;
94 
95 	if (temp & 0x400)
96 		actual_temp = -256;
97 	else if (temp & 0x200)
98 		actual_temp = 255;
99 	else if (temp & 0x100) {
100 		actual_temp = temp & 0x1ff;
101 		actual_temp |= ~0x1ff;
102 	} else
103 		actual_temp = temp & 0xff;
104 
105 	return (actual_temp * 1000) / 2;
106 }
107 
108 int sumo_get_temp(struct radeon_device *rdev)
109 {
110 	u32 temp = RREG32(CG_THERMAL_STATUS) & 0xff;
111 	int actual_temp = temp - 49;
112 
113 	return actual_temp * 1000;
114 }
115 
116 void evergreen_pm_misc(struct radeon_device *rdev)
117 {
118 	int req_ps_idx = rdev->pm.requested_power_state_index;
119 	int req_cm_idx = rdev->pm.requested_clock_mode_index;
120 	struct radeon_power_state *ps = &rdev->pm.power_state[req_ps_idx];
121 	struct radeon_voltage *voltage = &ps->clock_info[req_cm_idx].voltage;
122 
123 	if (voltage->type == VOLTAGE_SW) {
124 		if (voltage->voltage && (voltage->voltage != rdev->pm.current_vddc)) {
125 			radeon_atom_set_voltage(rdev, voltage->voltage, SET_VOLTAGE_TYPE_ASIC_VDDC);
126 			rdev->pm.current_vddc = voltage->voltage;
127 			DRM_DEBUG("Setting: vddc: %d\n", voltage->voltage);
128 		}
129 		if (voltage->vddci && (voltage->vddci != rdev->pm.current_vddci)) {
130 			radeon_atom_set_voltage(rdev, voltage->vddci, SET_VOLTAGE_TYPE_ASIC_VDDCI);
131 			rdev->pm.current_vddci = voltage->vddci;
132 			DRM_DEBUG("Setting: vddci: %d\n", voltage->vddci);
133 		}
134 	}
135 }
136 
137 void evergreen_pm_prepare(struct radeon_device *rdev)
138 {
139 	struct drm_device *ddev = rdev->ddev;
140 	struct drm_crtc *crtc;
141 	struct radeon_crtc *radeon_crtc;
142 	u32 tmp;
143 
144 	/* disable any active CRTCs */
145 	list_for_each_entry(crtc, &ddev->mode_config.crtc_list, head) {
146 		radeon_crtc = to_radeon_crtc(crtc);
147 		if (radeon_crtc->enabled) {
148 			tmp = RREG32(EVERGREEN_CRTC_CONTROL + radeon_crtc->crtc_offset);
149 			tmp |= EVERGREEN_CRTC_DISP_READ_REQUEST_DISABLE;
150 			WREG32(EVERGREEN_CRTC_CONTROL + radeon_crtc->crtc_offset, tmp);
151 		}
152 	}
153 }
154 
155 void evergreen_pm_finish(struct radeon_device *rdev)
156 {
157 	struct drm_device *ddev = rdev->ddev;
158 	struct drm_crtc *crtc;
159 	struct radeon_crtc *radeon_crtc;
160 	u32 tmp;
161 
162 	/* enable any active CRTCs */
163 	list_for_each_entry(crtc, &ddev->mode_config.crtc_list, head) {
164 		radeon_crtc = to_radeon_crtc(crtc);
165 		if (radeon_crtc->enabled) {
166 			tmp = RREG32(EVERGREEN_CRTC_CONTROL + radeon_crtc->crtc_offset);
167 			tmp &= ~EVERGREEN_CRTC_DISP_READ_REQUEST_DISABLE;
168 			WREG32(EVERGREEN_CRTC_CONTROL + radeon_crtc->crtc_offset, tmp);
169 		}
170 	}
171 }
172 
173 bool evergreen_hpd_sense(struct radeon_device *rdev, enum radeon_hpd_id hpd)
174 {
175 	bool connected = false;
176 
177 	switch (hpd) {
178 	case RADEON_HPD_1:
179 		if (RREG32(DC_HPD1_INT_STATUS) & DC_HPDx_SENSE)
180 			connected = true;
181 		break;
182 	case RADEON_HPD_2:
183 		if (RREG32(DC_HPD2_INT_STATUS) & DC_HPDx_SENSE)
184 			connected = true;
185 		break;
186 	case RADEON_HPD_3:
187 		if (RREG32(DC_HPD3_INT_STATUS) & DC_HPDx_SENSE)
188 			connected = true;
189 		break;
190 	case RADEON_HPD_4:
191 		if (RREG32(DC_HPD4_INT_STATUS) & DC_HPDx_SENSE)
192 			connected = true;
193 		break;
194 	case RADEON_HPD_5:
195 		if (RREG32(DC_HPD5_INT_STATUS) & DC_HPDx_SENSE)
196 			connected = true;
197 		break;
198 	case RADEON_HPD_6:
199 		if (RREG32(DC_HPD6_INT_STATUS) & DC_HPDx_SENSE)
200 			connected = true;
201 			break;
202 	default:
203 		break;
204 	}
205 
206 	return connected;
207 }
208 
209 void evergreen_hpd_set_polarity(struct radeon_device *rdev,
210 				enum radeon_hpd_id hpd)
211 {
212 	u32 tmp;
213 	bool connected = evergreen_hpd_sense(rdev, hpd);
214 
215 	switch (hpd) {
216 	case RADEON_HPD_1:
217 		tmp = RREG32(DC_HPD1_INT_CONTROL);
218 		if (connected)
219 			tmp &= ~DC_HPDx_INT_POLARITY;
220 		else
221 			tmp |= DC_HPDx_INT_POLARITY;
222 		WREG32(DC_HPD1_INT_CONTROL, tmp);
223 		break;
224 	case RADEON_HPD_2:
225 		tmp = RREG32(DC_HPD2_INT_CONTROL);
226 		if (connected)
227 			tmp &= ~DC_HPDx_INT_POLARITY;
228 		else
229 			tmp |= DC_HPDx_INT_POLARITY;
230 		WREG32(DC_HPD2_INT_CONTROL, tmp);
231 		break;
232 	case RADEON_HPD_3:
233 		tmp = RREG32(DC_HPD3_INT_CONTROL);
234 		if (connected)
235 			tmp &= ~DC_HPDx_INT_POLARITY;
236 		else
237 			tmp |= DC_HPDx_INT_POLARITY;
238 		WREG32(DC_HPD3_INT_CONTROL, tmp);
239 		break;
240 	case RADEON_HPD_4:
241 		tmp = RREG32(DC_HPD4_INT_CONTROL);
242 		if (connected)
243 			tmp &= ~DC_HPDx_INT_POLARITY;
244 		else
245 			tmp |= DC_HPDx_INT_POLARITY;
246 		WREG32(DC_HPD4_INT_CONTROL, tmp);
247 		break;
248 	case RADEON_HPD_5:
249 		tmp = RREG32(DC_HPD5_INT_CONTROL);
250 		if (connected)
251 			tmp &= ~DC_HPDx_INT_POLARITY;
252 		else
253 			tmp |= DC_HPDx_INT_POLARITY;
254 		WREG32(DC_HPD5_INT_CONTROL, tmp);
255 			break;
256 	case RADEON_HPD_6:
257 		tmp = RREG32(DC_HPD6_INT_CONTROL);
258 		if (connected)
259 			tmp &= ~DC_HPDx_INT_POLARITY;
260 		else
261 			tmp |= DC_HPDx_INT_POLARITY;
262 		WREG32(DC_HPD6_INT_CONTROL, tmp);
263 		break;
264 	default:
265 		break;
266 	}
267 }
268 
269 void evergreen_hpd_init(struct radeon_device *rdev)
270 {
271 	struct drm_device *dev = rdev->ddev;
272 	struct drm_connector *connector;
273 	u32 tmp = DC_HPDx_CONNECTION_TIMER(0x9c4) |
274 		DC_HPDx_RX_INT_TIMER(0xfa) | DC_HPDx_EN;
275 
276 	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
277 		struct radeon_connector *radeon_connector = to_radeon_connector(connector);
278 		switch (radeon_connector->hpd.hpd) {
279 		case RADEON_HPD_1:
280 			WREG32(DC_HPD1_CONTROL, tmp);
281 			rdev->irq.hpd[0] = true;
282 			break;
283 		case RADEON_HPD_2:
284 			WREG32(DC_HPD2_CONTROL, tmp);
285 			rdev->irq.hpd[1] = true;
286 			break;
287 		case RADEON_HPD_3:
288 			WREG32(DC_HPD3_CONTROL, tmp);
289 			rdev->irq.hpd[2] = true;
290 			break;
291 		case RADEON_HPD_4:
292 			WREG32(DC_HPD4_CONTROL, tmp);
293 			rdev->irq.hpd[3] = true;
294 			break;
295 		case RADEON_HPD_5:
296 			WREG32(DC_HPD5_CONTROL, tmp);
297 			rdev->irq.hpd[4] = true;
298 			break;
299 		case RADEON_HPD_6:
300 			WREG32(DC_HPD6_CONTROL, tmp);
301 			rdev->irq.hpd[5] = true;
302 			break;
303 		default:
304 			break;
305 		}
306 	}
307 	if (rdev->irq.installed)
308 		evergreen_irq_set(rdev);
309 }
310 
311 void evergreen_hpd_fini(struct radeon_device *rdev)
312 {
313 	struct drm_device *dev = rdev->ddev;
314 	struct drm_connector *connector;
315 
316 	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
317 		struct radeon_connector *radeon_connector = to_radeon_connector(connector);
318 		switch (radeon_connector->hpd.hpd) {
319 		case RADEON_HPD_1:
320 			WREG32(DC_HPD1_CONTROL, 0);
321 			rdev->irq.hpd[0] = false;
322 			break;
323 		case RADEON_HPD_2:
324 			WREG32(DC_HPD2_CONTROL, 0);
325 			rdev->irq.hpd[1] = false;
326 			break;
327 		case RADEON_HPD_3:
328 			WREG32(DC_HPD3_CONTROL, 0);
329 			rdev->irq.hpd[2] = false;
330 			break;
331 		case RADEON_HPD_4:
332 			WREG32(DC_HPD4_CONTROL, 0);
333 			rdev->irq.hpd[3] = false;
334 			break;
335 		case RADEON_HPD_5:
336 			WREG32(DC_HPD5_CONTROL, 0);
337 			rdev->irq.hpd[4] = false;
338 			break;
339 		case RADEON_HPD_6:
340 			WREG32(DC_HPD6_CONTROL, 0);
341 			rdev->irq.hpd[5] = false;
342 			break;
343 		default:
344 			break;
345 		}
346 	}
347 }
348 
349 /* watermark setup */
350 
351 static u32 evergreen_line_buffer_adjust(struct radeon_device *rdev,
352 					struct radeon_crtc *radeon_crtc,
353 					struct drm_display_mode *mode,
354 					struct drm_display_mode *other_mode)
355 {
356 	u32 tmp;
357 	/*
358 	 * Line Buffer Setup
359 	 * There are 3 line buffers, each one shared by 2 display controllers.
360 	 * DC_LB_MEMORY_SPLIT controls how that line buffer is shared between
361 	 * the display controllers.  The paritioning is done via one of four
362 	 * preset allocations specified in bits 2:0:
363 	 * first display controller
364 	 *  0 - first half of lb (3840 * 2)
365 	 *  1 - first 3/4 of lb (5760 * 2)
366 	 *  2 - whole lb (7680 * 2), other crtc must be disabled
367 	 *  3 - first 1/4 of lb (1920 * 2)
368 	 * second display controller
369 	 *  4 - second half of lb (3840 * 2)
370 	 *  5 - second 3/4 of lb (5760 * 2)
371 	 *  6 - whole lb (7680 * 2), other crtc must be disabled
372 	 *  7 - last 1/4 of lb (1920 * 2)
373 	 */
374 	/* this can get tricky if we have two large displays on a paired group
375 	 * of crtcs.  Ideally for multiple large displays we'd assign them to
376 	 * non-linked crtcs for maximum line buffer allocation.
377 	 */
378 	if (radeon_crtc->base.enabled && mode) {
379 		if (other_mode)
380 			tmp = 0; /* 1/2 */
381 		else
382 			tmp = 2; /* whole */
383 	} else
384 		tmp = 0;
385 
386 	/* second controller of the pair uses second half of the lb */
387 	if (radeon_crtc->crtc_id % 2)
388 		tmp += 4;
389 	WREG32(DC_LB_MEMORY_SPLIT + radeon_crtc->crtc_offset, tmp);
390 
391 	if (radeon_crtc->base.enabled && mode) {
392 		switch (tmp) {
393 		case 0:
394 		case 4:
395 		default:
396 			if (ASIC_IS_DCE5(rdev))
397 				return 4096 * 2;
398 			else
399 				return 3840 * 2;
400 		case 1:
401 		case 5:
402 			if (ASIC_IS_DCE5(rdev))
403 				return 6144 * 2;
404 			else
405 				return 5760 * 2;
406 		case 2:
407 		case 6:
408 			if (ASIC_IS_DCE5(rdev))
409 				return 8192 * 2;
410 			else
411 				return 7680 * 2;
412 		case 3:
413 		case 7:
414 			if (ASIC_IS_DCE5(rdev))
415 				return 2048 * 2;
416 			else
417 				return 1920 * 2;
418 		}
419 	}
420 
421 	/* controller not enabled, so no lb used */
422 	return 0;
423 }
424 
425 static u32 evergreen_get_number_of_dram_channels(struct radeon_device *rdev)
426 {
427 	u32 tmp = RREG32(MC_SHARED_CHMAP);
428 
429 	switch ((tmp & NOOFCHAN_MASK) >> NOOFCHAN_SHIFT) {
430 	case 0:
431 	default:
432 		return 1;
433 	case 1:
434 		return 2;
435 	case 2:
436 		return 4;
437 	case 3:
438 		return 8;
439 	}
440 }
441 
442 struct evergreen_wm_params {
443 	u32 dram_channels; /* number of dram channels */
444 	u32 yclk;          /* bandwidth per dram data pin in kHz */
445 	u32 sclk;          /* engine clock in kHz */
446 	u32 disp_clk;      /* display clock in kHz */
447 	u32 src_width;     /* viewport width */
448 	u32 active_time;   /* active display time in ns */
449 	u32 blank_time;    /* blank time in ns */
450 	bool interlaced;    /* mode is interlaced */
451 	fixed20_12 vsc;    /* vertical scale ratio */
452 	u32 num_heads;     /* number of active crtcs */
453 	u32 bytes_per_pixel; /* bytes per pixel display + overlay */
454 	u32 lb_size;       /* line buffer allocated to pipe */
455 	u32 vtaps;         /* vertical scaler taps */
456 };
457 
458 static u32 evergreen_dram_bandwidth(struct evergreen_wm_params *wm)
459 {
460 	/* Calculate DRAM Bandwidth and the part allocated to display. */
461 	fixed20_12 dram_efficiency; /* 0.7 */
462 	fixed20_12 yclk, dram_channels, bandwidth;
463 	fixed20_12 a;
464 
465 	a.full = dfixed_const(1000);
466 	yclk.full = dfixed_const(wm->yclk);
467 	yclk.full = dfixed_div(yclk, a);
468 	dram_channels.full = dfixed_const(wm->dram_channels * 4);
469 	a.full = dfixed_const(10);
470 	dram_efficiency.full = dfixed_const(7);
471 	dram_efficiency.full = dfixed_div(dram_efficiency, a);
472 	bandwidth.full = dfixed_mul(dram_channels, yclk);
473 	bandwidth.full = dfixed_mul(bandwidth, dram_efficiency);
474 
475 	return dfixed_trunc(bandwidth);
476 }
477 
478 static u32 evergreen_dram_bandwidth_for_display(struct evergreen_wm_params *wm)
479 {
480 	/* Calculate DRAM Bandwidth and the part allocated to display. */
481 	fixed20_12 disp_dram_allocation; /* 0.3 to 0.7 */
482 	fixed20_12 yclk, dram_channels, bandwidth;
483 	fixed20_12 a;
484 
485 	a.full = dfixed_const(1000);
486 	yclk.full = dfixed_const(wm->yclk);
487 	yclk.full = dfixed_div(yclk, a);
488 	dram_channels.full = dfixed_const(wm->dram_channels * 4);
489 	a.full = dfixed_const(10);
490 	disp_dram_allocation.full = dfixed_const(3); /* XXX worse case value 0.3 */
491 	disp_dram_allocation.full = dfixed_div(disp_dram_allocation, a);
492 	bandwidth.full = dfixed_mul(dram_channels, yclk);
493 	bandwidth.full = dfixed_mul(bandwidth, disp_dram_allocation);
494 
495 	return dfixed_trunc(bandwidth);
496 }
497 
498 static u32 evergreen_data_return_bandwidth(struct evergreen_wm_params *wm)
499 {
500 	/* Calculate the display Data return Bandwidth */
501 	fixed20_12 return_efficiency; /* 0.8 */
502 	fixed20_12 sclk, bandwidth;
503 	fixed20_12 a;
504 
505 	a.full = dfixed_const(1000);
506 	sclk.full = dfixed_const(wm->sclk);
507 	sclk.full = dfixed_div(sclk, a);
508 	a.full = dfixed_const(10);
509 	return_efficiency.full = dfixed_const(8);
510 	return_efficiency.full = dfixed_div(return_efficiency, a);
511 	a.full = dfixed_const(32);
512 	bandwidth.full = dfixed_mul(a, sclk);
513 	bandwidth.full = dfixed_mul(bandwidth, return_efficiency);
514 
515 	return dfixed_trunc(bandwidth);
516 }
517 
518 static u32 evergreen_dmif_request_bandwidth(struct evergreen_wm_params *wm)
519 {
520 	/* Calculate the DMIF Request Bandwidth */
521 	fixed20_12 disp_clk_request_efficiency; /* 0.8 */
522 	fixed20_12 disp_clk, bandwidth;
523 	fixed20_12 a;
524 
525 	a.full = dfixed_const(1000);
526 	disp_clk.full = dfixed_const(wm->disp_clk);
527 	disp_clk.full = dfixed_div(disp_clk, a);
528 	a.full = dfixed_const(10);
529 	disp_clk_request_efficiency.full = dfixed_const(8);
530 	disp_clk_request_efficiency.full = dfixed_div(disp_clk_request_efficiency, a);
531 	a.full = dfixed_const(32);
532 	bandwidth.full = dfixed_mul(a, disp_clk);
533 	bandwidth.full = dfixed_mul(bandwidth, disp_clk_request_efficiency);
534 
535 	return dfixed_trunc(bandwidth);
536 }
537 
538 static u32 evergreen_available_bandwidth(struct evergreen_wm_params *wm)
539 {
540 	/* Calculate the Available bandwidth. Display can use this temporarily but not in average. */
541 	u32 dram_bandwidth = evergreen_dram_bandwidth(wm);
542 	u32 data_return_bandwidth = evergreen_data_return_bandwidth(wm);
543 	u32 dmif_req_bandwidth = evergreen_dmif_request_bandwidth(wm);
544 
545 	return min(dram_bandwidth, min(data_return_bandwidth, dmif_req_bandwidth));
546 }
547 
548 static u32 evergreen_average_bandwidth(struct evergreen_wm_params *wm)
549 {
550 	/* Calculate the display mode Average Bandwidth
551 	 * DisplayMode should contain the source and destination dimensions,
552 	 * timing, etc.
553 	 */
554 	fixed20_12 bpp;
555 	fixed20_12 line_time;
556 	fixed20_12 src_width;
557 	fixed20_12 bandwidth;
558 	fixed20_12 a;
559 
560 	a.full = dfixed_const(1000);
561 	line_time.full = dfixed_const(wm->active_time + wm->blank_time);
562 	line_time.full = dfixed_div(line_time, a);
563 	bpp.full = dfixed_const(wm->bytes_per_pixel);
564 	src_width.full = dfixed_const(wm->src_width);
565 	bandwidth.full = dfixed_mul(src_width, bpp);
566 	bandwidth.full = dfixed_mul(bandwidth, wm->vsc);
567 	bandwidth.full = dfixed_div(bandwidth, line_time);
568 
569 	return dfixed_trunc(bandwidth);
570 }
571 
572 static u32 evergreen_latency_watermark(struct evergreen_wm_params *wm)
573 {
574 	/* First calcualte the latency in ns */
575 	u32 mc_latency = 2000; /* 2000 ns. */
576 	u32 available_bandwidth = evergreen_available_bandwidth(wm);
577 	u32 worst_chunk_return_time = (512 * 8 * 1000) / available_bandwidth;
578 	u32 cursor_line_pair_return_time = (128 * 4 * 1000) / available_bandwidth;
579 	u32 dc_latency = 40000000 / wm->disp_clk; /* dc pipe latency */
580 	u32 other_heads_data_return_time = ((wm->num_heads + 1) * worst_chunk_return_time) +
581 		(wm->num_heads * cursor_line_pair_return_time);
582 	u32 latency = mc_latency + other_heads_data_return_time + dc_latency;
583 	u32 max_src_lines_per_dst_line, lb_fill_bw, line_fill_time;
584 	fixed20_12 a, b, c;
585 
586 	if (wm->num_heads == 0)
587 		return 0;
588 
589 	a.full = dfixed_const(2);
590 	b.full = dfixed_const(1);
591 	if ((wm->vsc.full > a.full) ||
592 	    ((wm->vsc.full > b.full) && (wm->vtaps >= 3)) ||
593 	    (wm->vtaps >= 5) ||
594 	    ((wm->vsc.full >= a.full) && wm->interlaced))
595 		max_src_lines_per_dst_line = 4;
596 	else
597 		max_src_lines_per_dst_line = 2;
598 
599 	a.full = dfixed_const(available_bandwidth);
600 	b.full = dfixed_const(wm->num_heads);
601 	a.full = dfixed_div(a, b);
602 
603 	b.full = dfixed_const(1000);
604 	c.full = dfixed_const(wm->disp_clk);
605 	b.full = dfixed_div(c, b);
606 	c.full = dfixed_const(wm->bytes_per_pixel);
607 	b.full = dfixed_mul(b, c);
608 
609 	lb_fill_bw = min(dfixed_trunc(a), dfixed_trunc(b));
610 
611 	a.full = dfixed_const(max_src_lines_per_dst_line * wm->src_width * wm->bytes_per_pixel);
612 	b.full = dfixed_const(1000);
613 	c.full = dfixed_const(lb_fill_bw);
614 	b.full = dfixed_div(c, b);
615 	a.full = dfixed_div(a, b);
616 	line_fill_time = dfixed_trunc(a);
617 
618 	if (line_fill_time < wm->active_time)
619 		return latency;
620 	else
621 		return latency + (line_fill_time - wm->active_time);
622 
623 }
624 
625 static bool evergreen_average_bandwidth_vs_dram_bandwidth_for_display(struct evergreen_wm_params *wm)
626 {
627 	if (evergreen_average_bandwidth(wm) <=
628 	    (evergreen_dram_bandwidth_for_display(wm) / wm->num_heads))
629 		return true;
630 	else
631 		return false;
632 };
633 
634 static bool evergreen_average_bandwidth_vs_available_bandwidth(struct evergreen_wm_params *wm)
635 {
636 	if (evergreen_average_bandwidth(wm) <=
637 	    (evergreen_available_bandwidth(wm) / wm->num_heads))
638 		return true;
639 	else
640 		return false;
641 };
642 
643 static bool evergreen_check_latency_hiding(struct evergreen_wm_params *wm)
644 {
645 	u32 lb_partitions = wm->lb_size / wm->src_width;
646 	u32 line_time = wm->active_time + wm->blank_time;
647 	u32 latency_tolerant_lines;
648 	u32 latency_hiding;
649 	fixed20_12 a;
650 
651 	a.full = dfixed_const(1);
652 	if (wm->vsc.full > a.full)
653 		latency_tolerant_lines = 1;
654 	else {
655 		if (lb_partitions <= (wm->vtaps + 1))
656 			latency_tolerant_lines = 1;
657 		else
658 			latency_tolerant_lines = 2;
659 	}
660 
661 	latency_hiding = (latency_tolerant_lines * line_time + wm->blank_time);
662 
663 	if (evergreen_latency_watermark(wm) <= latency_hiding)
664 		return true;
665 	else
666 		return false;
667 }
668 
669 static void evergreen_program_watermarks(struct radeon_device *rdev,
670 					 struct radeon_crtc *radeon_crtc,
671 					 u32 lb_size, u32 num_heads)
672 {
673 	struct drm_display_mode *mode = &radeon_crtc->base.mode;
674 	struct evergreen_wm_params wm;
675 	u32 pixel_period;
676 	u32 line_time = 0;
677 	u32 latency_watermark_a = 0, latency_watermark_b = 0;
678 	u32 priority_a_mark = 0, priority_b_mark = 0;
679 	u32 priority_a_cnt = PRIORITY_OFF;
680 	u32 priority_b_cnt = PRIORITY_OFF;
681 	u32 pipe_offset = radeon_crtc->crtc_id * 16;
682 	u32 tmp, arb_control3;
683 	fixed20_12 a, b, c;
684 
685 	if (radeon_crtc->base.enabled && num_heads && mode) {
686 		pixel_period = 1000000 / (u32)mode->clock;
687 		line_time = min((u32)mode->crtc_htotal * pixel_period, (u32)65535);
688 		priority_a_cnt = 0;
689 		priority_b_cnt = 0;
690 
691 		wm.yclk = rdev->pm.current_mclk * 10;
692 		wm.sclk = rdev->pm.current_sclk * 10;
693 		wm.disp_clk = mode->clock;
694 		wm.src_width = mode->crtc_hdisplay;
695 		wm.active_time = mode->crtc_hdisplay * pixel_period;
696 		wm.blank_time = line_time - wm.active_time;
697 		wm.interlaced = false;
698 		if (mode->flags & DRM_MODE_FLAG_INTERLACE)
699 			wm.interlaced = true;
700 		wm.vsc = radeon_crtc->vsc;
701 		wm.vtaps = 1;
702 		if (radeon_crtc->rmx_type != RMX_OFF)
703 			wm.vtaps = 2;
704 		wm.bytes_per_pixel = 4; /* XXX: get this from fb config */
705 		wm.lb_size = lb_size;
706 		wm.dram_channels = evergreen_get_number_of_dram_channels(rdev);
707 		wm.num_heads = num_heads;
708 
709 		/* set for high clocks */
710 		latency_watermark_a = min(evergreen_latency_watermark(&wm), (u32)65535);
711 		/* set for low clocks */
712 		/* wm.yclk = low clk; wm.sclk = low clk */
713 		latency_watermark_b = min(evergreen_latency_watermark(&wm), (u32)65535);
714 
715 		/* possibly force display priority to high */
716 		/* should really do this at mode validation time... */
717 		if (!evergreen_average_bandwidth_vs_dram_bandwidth_for_display(&wm) ||
718 		    !evergreen_average_bandwidth_vs_available_bandwidth(&wm) ||
719 		    !evergreen_check_latency_hiding(&wm) ||
720 		    (rdev->disp_priority == 2)) {
721 			DRM_INFO("force priority to high\n");
722 			priority_a_cnt |= PRIORITY_ALWAYS_ON;
723 			priority_b_cnt |= PRIORITY_ALWAYS_ON;
724 		}
725 
726 		a.full = dfixed_const(1000);
727 		b.full = dfixed_const(mode->clock);
728 		b.full = dfixed_div(b, a);
729 		c.full = dfixed_const(latency_watermark_a);
730 		c.full = dfixed_mul(c, b);
731 		c.full = dfixed_mul(c, radeon_crtc->hsc);
732 		c.full = dfixed_div(c, a);
733 		a.full = dfixed_const(16);
734 		c.full = dfixed_div(c, a);
735 		priority_a_mark = dfixed_trunc(c);
736 		priority_a_cnt |= priority_a_mark & PRIORITY_MARK_MASK;
737 
738 		a.full = dfixed_const(1000);
739 		b.full = dfixed_const(mode->clock);
740 		b.full = dfixed_div(b, a);
741 		c.full = dfixed_const(latency_watermark_b);
742 		c.full = dfixed_mul(c, b);
743 		c.full = dfixed_mul(c, radeon_crtc->hsc);
744 		c.full = dfixed_div(c, a);
745 		a.full = dfixed_const(16);
746 		c.full = dfixed_div(c, a);
747 		priority_b_mark = dfixed_trunc(c);
748 		priority_b_cnt |= priority_b_mark & PRIORITY_MARK_MASK;
749 	}
750 
751 	/* select wm A */
752 	arb_control3 = RREG32(PIPE0_ARBITRATION_CONTROL3 + pipe_offset);
753 	tmp = arb_control3;
754 	tmp &= ~LATENCY_WATERMARK_MASK(3);
755 	tmp |= LATENCY_WATERMARK_MASK(1);
756 	WREG32(PIPE0_ARBITRATION_CONTROL3 + pipe_offset, tmp);
757 	WREG32(PIPE0_LATENCY_CONTROL + pipe_offset,
758 	       (LATENCY_LOW_WATERMARK(latency_watermark_a) |
759 		LATENCY_HIGH_WATERMARK(line_time)));
760 	/* select wm B */
761 	tmp = RREG32(PIPE0_ARBITRATION_CONTROL3 + pipe_offset);
762 	tmp &= ~LATENCY_WATERMARK_MASK(3);
763 	tmp |= LATENCY_WATERMARK_MASK(2);
764 	WREG32(PIPE0_ARBITRATION_CONTROL3 + pipe_offset, tmp);
765 	WREG32(PIPE0_LATENCY_CONTROL + pipe_offset,
766 	       (LATENCY_LOW_WATERMARK(latency_watermark_b) |
767 		LATENCY_HIGH_WATERMARK(line_time)));
768 	/* restore original selection */
769 	WREG32(PIPE0_ARBITRATION_CONTROL3 + pipe_offset, arb_control3);
770 
771 	/* write the priority marks */
772 	WREG32(PRIORITY_A_CNT + radeon_crtc->crtc_offset, priority_a_cnt);
773 	WREG32(PRIORITY_B_CNT + radeon_crtc->crtc_offset, priority_b_cnt);
774 
775 }
776 
777 void evergreen_bandwidth_update(struct radeon_device *rdev)
778 {
779 	struct drm_display_mode *mode0 = NULL;
780 	struct drm_display_mode *mode1 = NULL;
781 	u32 num_heads = 0, lb_size;
782 	int i;
783 
784 	radeon_update_display_priority(rdev);
785 
786 	for (i = 0; i < rdev->num_crtc; i++) {
787 		if (rdev->mode_info.crtcs[i]->base.enabled)
788 			num_heads++;
789 	}
790 	for (i = 0; i < rdev->num_crtc; i += 2) {
791 		mode0 = &rdev->mode_info.crtcs[i]->base.mode;
792 		mode1 = &rdev->mode_info.crtcs[i+1]->base.mode;
793 		lb_size = evergreen_line_buffer_adjust(rdev, rdev->mode_info.crtcs[i], mode0, mode1);
794 		evergreen_program_watermarks(rdev, rdev->mode_info.crtcs[i], lb_size, num_heads);
795 		lb_size = evergreen_line_buffer_adjust(rdev, rdev->mode_info.crtcs[i+1], mode1, mode0);
796 		evergreen_program_watermarks(rdev, rdev->mode_info.crtcs[i+1], lb_size, num_heads);
797 	}
798 }
799 
800 int evergreen_mc_wait_for_idle(struct radeon_device *rdev)
801 {
802 	unsigned i;
803 	u32 tmp;
804 
805 	for (i = 0; i < rdev->usec_timeout; i++) {
806 		/* read MC_STATUS */
807 		tmp = RREG32(SRBM_STATUS) & 0x1F00;
808 		if (!tmp)
809 			return 0;
810 		udelay(1);
811 	}
812 	return -1;
813 }
814 
815 /*
816  * GART
817  */
818 void evergreen_pcie_gart_tlb_flush(struct radeon_device *rdev)
819 {
820 	unsigned i;
821 	u32 tmp;
822 
823 	WREG32(HDP_MEM_COHERENCY_FLUSH_CNTL, 0x1);
824 
825 	WREG32(VM_CONTEXT0_REQUEST_RESPONSE, REQUEST_TYPE(1));
826 	for (i = 0; i < rdev->usec_timeout; i++) {
827 		/* read MC_STATUS */
828 		tmp = RREG32(VM_CONTEXT0_REQUEST_RESPONSE);
829 		tmp = (tmp & RESPONSE_TYPE_MASK) >> RESPONSE_TYPE_SHIFT;
830 		if (tmp == 2) {
831 			printk(KERN_WARNING "[drm] r600 flush TLB failed\n");
832 			return;
833 		}
834 		if (tmp) {
835 			return;
836 		}
837 		udelay(1);
838 	}
839 }
840 
841 int evergreen_pcie_gart_enable(struct radeon_device *rdev)
842 {
843 	u32 tmp;
844 	int r;
845 
846 	if (rdev->gart.table.vram.robj == NULL) {
847 		dev_err(rdev->dev, "No VRAM object for PCIE GART.\n");
848 		return -EINVAL;
849 	}
850 	r = radeon_gart_table_vram_pin(rdev);
851 	if (r)
852 		return r;
853 	radeon_gart_restore(rdev);
854 	/* Setup L2 cache */
855 	WREG32(VM_L2_CNTL, ENABLE_L2_CACHE | ENABLE_L2_FRAGMENT_PROCESSING |
856 				ENABLE_L2_PTE_CACHE_LRU_UPDATE_BY_WRITE |
857 				EFFECTIVE_L2_QUEUE_SIZE(7));
858 	WREG32(VM_L2_CNTL2, 0);
859 	WREG32(VM_L2_CNTL3, BANK_SELECT(0) | CACHE_UPDATE_MODE(2));
860 	/* Setup TLB control */
861 	tmp = ENABLE_L1_TLB | ENABLE_L1_FRAGMENT_PROCESSING |
862 		SYSTEM_ACCESS_MODE_NOT_IN_SYS |
863 		SYSTEM_APERTURE_UNMAPPED_ACCESS_PASS_THRU |
864 		EFFECTIVE_L1_TLB_SIZE(5) | EFFECTIVE_L1_QUEUE_SIZE(5);
865 	if (rdev->flags & RADEON_IS_IGP) {
866 		WREG32(FUS_MC_VM_MD_L1_TLB0_CNTL, tmp);
867 		WREG32(FUS_MC_VM_MD_L1_TLB1_CNTL, tmp);
868 		WREG32(FUS_MC_VM_MD_L1_TLB2_CNTL, tmp);
869 	} else {
870 		WREG32(MC_VM_MD_L1_TLB0_CNTL, tmp);
871 		WREG32(MC_VM_MD_L1_TLB1_CNTL, tmp);
872 		WREG32(MC_VM_MD_L1_TLB2_CNTL, tmp);
873 	}
874 	WREG32(MC_VM_MB_L1_TLB0_CNTL, tmp);
875 	WREG32(MC_VM_MB_L1_TLB1_CNTL, tmp);
876 	WREG32(MC_VM_MB_L1_TLB2_CNTL, tmp);
877 	WREG32(MC_VM_MB_L1_TLB3_CNTL, tmp);
878 	WREG32(VM_CONTEXT0_PAGE_TABLE_START_ADDR, rdev->mc.gtt_start >> 12);
879 	WREG32(VM_CONTEXT0_PAGE_TABLE_END_ADDR, rdev->mc.gtt_end >> 12);
880 	WREG32(VM_CONTEXT0_PAGE_TABLE_BASE_ADDR, rdev->gart.table_addr >> 12);
881 	WREG32(VM_CONTEXT0_CNTL, ENABLE_CONTEXT | PAGE_TABLE_DEPTH(0) |
882 				RANGE_PROTECTION_FAULT_ENABLE_DEFAULT);
883 	WREG32(VM_CONTEXT0_PROTECTION_FAULT_DEFAULT_ADDR,
884 			(u32)(rdev->dummy_page.addr >> 12));
885 	WREG32(VM_CONTEXT1_CNTL, 0);
886 
887 	evergreen_pcie_gart_tlb_flush(rdev);
888 	rdev->gart.ready = true;
889 	return 0;
890 }
891 
892 void evergreen_pcie_gart_disable(struct radeon_device *rdev)
893 {
894 	u32 tmp;
895 	int r;
896 
897 	/* Disable all tables */
898 	WREG32(VM_CONTEXT0_CNTL, 0);
899 	WREG32(VM_CONTEXT1_CNTL, 0);
900 
901 	/* Setup L2 cache */
902 	WREG32(VM_L2_CNTL, ENABLE_L2_FRAGMENT_PROCESSING |
903 				EFFECTIVE_L2_QUEUE_SIZE(7));
904 	WREG32(VM_L2_CNTL2, 0);
905 	WREG32(VM_L2_CNTL3, BANK_SELECT(0) | CACHE_UPDATE_MODE(2));
906 	/* Setup TLB control */
907 	tmp = EFFECTIVE_L1_TLB_SIZE(5) | EFFECTIVE_L1_QUEUE_SIZE(5);
908 	WREG32(MC_VM_MD_L1_TLB0_CNTL, tmp);
909 	WREG32(MC_VM_MD_L1_TLB1_CNTL, tmp);
910 	WREG32(MC_VM_MD_L1_TLB2_CNTL, tmp);
911 	WREG32(MC_VM_MB_L1_TLB0_CNTL, tmp);
912 	WREG32(MC_VM_MB_L1_TLB1_CNTL, tmp);
913 	WREG32(MC_VM_MB_L1_TLB2_CNTL, tmp);
914 	WREG32(MC_VM_MB_L1_TLB3_CNTL, tmp);
915 	if (rdev->gart.table.vram.robj) {
916 		r = radeon_bo_reserve(rdev->gart.table.vram.robj, false);
917 		if (likely(r == 0)) {
918 			radeon_bo_kunmap(rdev->gart.table.vram.robj);
919 			radeon_bo_unpin(rdev->gart.table.vram.robj);
920 			radeon_bo_unreserve(rdev->gart.table.vram.robj);
921 		}
922 	}
923 }
924 
925 void evergreen_pcie_gart_fini(struct radeon_device *rdev)
926 {
927 	evergreen_pcie_gart_disable(rdev);
928 	radeon_gart_table_vram_free(rdev);
929 	radeon_gart_fini(rdev);
930 }
931 
932 
933 void evergreen_agp_enable(struct radeon_device *rdev)
934 {
935 	u32 tmp;
936 
937 	/* Setup L2 cache */
938 	WREG32(VM_L2_CNTL, ENABLE_L2_CACHE | ENABLE_L2_FRAGMENT_PROCESSING |
939 				ENABLE_L2_PTE_CACHE_LRU_UPDATE_BY_WRITE |
940 				EFFECTIVE_L2_QUEUE_SIZE(7));
941 	WREG32(VM_L2_CNTL2, 0);
942 	WREG32(VM_L2_CNTL3, BANK_SELECT(0) | CACHE_UPDATE_MODE(2));
943 	/* Setup TLB control */
944 	tmp = ENABLE_L1_TLB | ENABLE_L1_FRAGMENT_PROCESSING |
945 		SYSTEM_ACCESS_MODE_NOT_IN_SYS |
946 		SYSTEM_APERTURE_UNMAPPED_ACCESS_PASS_THRU |
947 		EFFECTIVE_L1_TLB_SIZE(5) | EFFECTIVE_L1_QUEUE_SIZE(5);
948 	WREG32(MC_VM_MD_L1_TLB0_CNTL, tmp);
949 	WREG32(MC_VM_MD_L1_TLB1_CNTL, tmp);
950 	WREG32(MC_VM_MD_L1_TLB2_CNTL, tmp);
951 	WREG32(MC_VM_MB_L1_TLB0_CNTL, tmp);
952 	WREG32(MC_VM_MB_L1_TLB1_CNTL, tmp);
953 	WREG32(MC_VM_MB_L1_TLB2_CNTL, tmp);
954 	WREG32(MC_VM_MB_L1_TLB3_CNTL, tmp);
955 	WREG32(VM_CONTEXT0_CNTL, 0);
956 	WREG32(VM_CONTEXT1_CNTL, 0);
957 }
958 
959 void evergreen_mc_stop(struct radeon_device *rdev, struct evergreen_mc_save *save)
960 {
961 	save->vga_control[0] = RREG32(D1VGA_CONTROL);
962 	save->vga_control[1] = RREG32(D2VGA_CONTROL);
963 	save->vga_control[2] = RREG32(EVERGREEN_D3VGA_CONTROL);
964 	save->vga_control[3] = RREG32(EVERGREEN_D4VGA_CONTROL);
965 	save->vga_control[4] = RREG32(EVERGREEN_D5VGA_CONTROL);
966 	save->vga_control[5] = RREG32(EVERGREEN_D6VGA_CONTROL);
967 	save->vga_render_control = RREG32(VGA_RENDER_CONTROL);
968 	save->vga_hdp_control = RREG32(VGA_HDP_CONTROL);
969 	save->crtc_control[0] = RREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC0_REGISTER_OFFSET);
970 	save->crtc_control[1] = RREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC1_REGISTER_OFFSET);
971 	if (!(rdev->flags & RADEON_IS_IGP)) {
972 		save->crtc_control[2] = RREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC2_REGISTER_OFFSET);
973 		save->crtc_control[3] = RREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC3_REGISTER_OFFSET);
974 		save->crtc_control[4] = RREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC4_REGISTER_OFFSET);
975 		save->crtc_control[5] = RREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC5_REGISTER_OFFSET);
976 	}
977 
978 	/* Stop all video */
979 	WREG32(VGA_RENDER_CONTROL, 0);
980 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC0_REGISTER_OFFSET, 1);
981 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC1_REGISTER_OFFSET, 1);
982 	if (!(rdev->flags & RADEON_IS_IGP)) {
983 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC2_REGISTER_OFFSET, 1);
984 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC3_REGISTER_OFFSET, 1);
985 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC4_REGISTER_OFFSET, 1);
986 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC5_REGISTER_OFFSET, 1);
987 	}
988 	WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC0_REGISTER_OFFSET, 0);
989 	WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC1_REGISTER_OFFSET, 0);
990 	if (!(rdev->flags & RADEON_IS_IGP)) {
991 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC2_REGISTER_OFFSET, 0);
992 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC3_REGISTER_OFFSET, 0);
993 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC4_REGISTER_OFFSET, 0);
994 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC5_REGISTER_OFFSET, 0);
995 	}
996 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC0_REGISTER_OFFSET, 0);
997 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC1_REGISTER_OFFSET, 0);
998 	if (!(rdev->flags & RADEON_IS_IGP)) {
999 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC2_REGISTER_OFFSET, 0);
1000 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC3_REGISTER_OFFSET, 0);
1001 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC4_REGISTER_OFFSET, 0);
1002 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC5_REGISTER_OFFSET, 0);
1003 	}
1004 
1005 	WREG32(D1VGA_CONTROL, 0);
1006 	WREG32(D2VGA_CONTROL, 0);
1007 	WREG32(EVERGREEN_D3VGA_CONTROL, 0);
1008 	WREG32(EVERGREEN_D4VGA_CONTROL, 0);
1009 	WREG32(EVERGREEN_D5VGA_CONTROL, 0);
1010 	WREG32(EVERGREEN_D6VGA_CONTROL, 0);
1011 }
1012 
1013 void evergreen_mc_resume(struct radeon_device *rdev, struct evergreen_mc_save *save)
1014 {
1015 	WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC0_REGISTER_OFFSET,
1016 	       upper_32_bits(rdev->mc.vram_start));
1017 	WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC0_REGISTER_OFFSET,
1018 	       upper_32_bits(rdev->mc.vram_start));
1019 	WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + EVERGREEN_CRTC0_REGISTER_OFFSET,
1020 	       (u32)rdev->mc.vram_start);
1021 	WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + EVERGREEN_CRTC0_REGISTER_OFFSET,
1022 	       (u32)rdev->mc.vram_start);
1023 
1024 	WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC1_REGISTER_OFFSET,
1025 	       upper_32_bits(rdev->mc.vram_start));
1026 	WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC1_REGISTER_OFFSET,
1027 	       upper_32_bits(rdev->mc.vram_start));
1028 	WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + EVERGREEN_CRTC1_REGISTER_OFFSET,
1029 	       (u32)rdev->mc.vram_start);
1030 	WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + EVERGREEN_CRTC1_REGISTER_OFFSET,
1031 	       (u32)rdev->mc.vram_start);
1032 
1033 	if (!(rdev->flags & RADEON_IS_IGP)) {
1034 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC2_REGISTER_OFFSET,
1035 		       upper_32_bits(rdev->mc.vram_start));
1036 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC2_REGISTER_OFFSET,
1037 		       upper_32_bits(rdev->mc.vram_start));
1038 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + EVERGREEN_CRTC2_REGISTER_OFFSET,
1039 		       (u32)rdev->mc.vram_start);
1040 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + EVERGREEN_CRTC2_REGISTER_OFFSET,
1041 		       (u32)rdev->mc.vram_start);
1042 
1043 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC3_REGISTER_OFFSET,
1044 		       upper_32_bits(rdev->mc.vram_start));
1045 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC3_REGISTER_OFFSET,
1046 		       upper_32_bits(rdev->mc.vram_start));
1047 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + EVERGREEN_CRTC3_REGISTER_OFFSET,
1048 		       (u32)rdev->mc.vram_start);
1049 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + EVERGREEN_CRTC3_REGISTER_OFFSET,
1050 		       (u32)rdev->mc.vram_start);
1051 
1052 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC4_REGISTER_OFFSET,
1053 		       upper_32_bits(rdev->mc.vram_start));
1054 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC4_REGISTER_OFFSET,
1055 		       upper_32_bits(rdev->mc.vram_start));
1056 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + EVERGREEN_CRTC4_REGISTER_OFFSET,
1057 		       (u32)rdev->mc.vram_start);
1058 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + EVERGREEN_CRTC4_REGISTER_OFFSET,
1059 		       (u32)rdev->mc.vram_start);
1060 
1061 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC5_REGISTER_OFFSET,
1062 		       upper_32_bits(rdev->mc.vram_start));
1063 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS_HIGH + EVERGREEN_CRTC5_REGISTER_OFFSET,
1064 		       upper_32_bits(rdev->mc.vram_start));
1065 		WREG32(EVERGREEN_GRPH_PRIMARY_SURFACE_ADDRESS + EVERGREEN_CRTC5_REGISTER_OFFSET,
1066 		       (u32)rdev->mc.vram_start);
1067 		WREG32(EVERGREEN_GRPH_SECONDARY_SURFACE_ADDRESS + EVERGREEN_CRTC5_REGISTER_OFFSET,
1068 		       (u32)rdev->mc.vram_start);
1069 	}
1070 
1071 	WREG32(EVERGREEN_VGA_MEMORY_BASE_ADDRESS_HIGH, upper_32_bits(rdev->mc.vram_start));
1072 	WREG32(EVERGREEN_VGA_MEMORY_BASE_ADDRESS, (u32)rdev->mc.vram_start);
1073 	/* Unlock host access */
1074 	WREG32(VGA_HDP_CONTROL, save->vga_hdp_control);
1075 	mdelay(1);
1076 	/* Restore video state */
1077 	WREG32(D1VGA_CONTROL, save->vga_control[0]);
1078 	WREG32(D2VGA_CONTROL, save->vga_control[1]);
1079 	WREG32(EVERGREEN_D3VGA_CONTROL, save->vga_control[2]);
1080 	WREG32(EVERGREEN_D4VGA_CONTROL, save->vga_control[3]);
1081 	WREG32(EVERGREEN_D5VGA_CONTROL, save->vga_control[4]);
1082 	WREG32(EVERGREEN_D6VGA_CONTROL, save->vga_control[5]);
1083 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC0_REGISTER_OFFSET, 1);
1084 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC1_REGISTER_OFFSET, 1);
1085 	if (!(rdev->flags & RADEON_IS_IGP)) {
1086 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC2_REGISTER_OFFSET, 1);
1087 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC3_REGISTER_OFFSET, 1);
1088 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC4_REGISTER_OFFSET, 1);
1089 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC5_REGISTER_OFFSET, 1);
1090 	}
1091 	WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC0_REGISTER_OFFSET, save->crtc_control[0]);
1092 	WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC1_REGISTER_OFFSET, save->crtc_control[1]);
1093 	if (!(rdev->flags & RADEON_IS_IGP)) {
1094 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC2_REGISTER_OFFSET, save->crtc_control[2]);
1095 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC3_REGISTER_OFFSET, save->crtc_control[3]);
1096 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC4_REGISTER_OFFSET, save->crtc_control[4]);
1097 		WREG32(EVERGREEN_CRTC_CONTROL + EVERGREEN_CRTC5_REGISTER_OFFSET, save->crtc_control[5]);
1098 	}
1099 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC0_REGISTER_OFFSET, 0);
1100 	WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC1_REGISTER_OFFSET, 0);
1101 	if (!(rdev->flags & RADEON_IS_IGP)) {
1102 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC2_REGISTER_OFFSET, 0);
1103 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC3_REGISTER_OFFSET, 0);
1104 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC4_REGISTER_OFFSET, 0);
1105 		WREG32(EVERGREEN_CRTC_UPDATE_LOCK + EVERGREEN_CRTC5_REGISTER_OFFSET, 0);
1106 	}
1107 	WREG32(VGA_RENDER_CONTROL, save->vga_render_control);
1108 }
1109 
1110 void evergreen_mc_program(struct radeon_device *rdev)
1111 {
1112 	struct evergreen_mc_save save;
1113 	u32 tmp;
1114 	int i, j;
1115 
1116 	/* Initialize HDP */
1117 	for (i = 0, j = 0; i < 32; i++, j += 0x18) {
1118 		WREG32((0x2c14 + j), 0x00000000);
1119 		WREG32((0x2c18 + j), 0x00000000);
1120 		WREG32((0x2c1c + j), 0x00000000);
1121 		WREG32((0x2c20 + j), 0x00000000);
1122 		WREG32((0x2c24 + j), 0x00000000);
1123 	}
1124 	WREG32(HDP_REG_COHERENCY_FLUSH_CNTL, 0);
1125 
1126 	evergreen_mc_stop(rdev, &save);
1127 	if (evergreen_mc_wait_for_idle(rdev)) {
1128 		dev_warn(rdev->dev, "Wait for MC idle timedout !\n");
1129 	}
1130 	/* Lockout access through VGA aperture*/
1131 	WREG32(VGA_HDP_CONTROL, VGA_MEMORY_DISABLE);
1132 	/* Update configuration */
1133 	if (rdev->flags & RADEON_IS_AGP) {
1134 		if (rdev->mc.vram_start < rdev->mc.gtt_start) {
1135 			/* VRAM before AGP */
1136 			WREG32(MC_VM_SYSTEM_APERTURE_LOW_ADDR,
1137 				rdev->mc.vram_start >> 12);
1138 			WREG32(MC_VM_SYSTEM_APERTURE_HIGH_ADDR,
1139 				rdev->mc.gtt_end >> 12);
1140 		} else {
1141 			/* VRAM after AGP */
1142 			WREG32(MC_VM_SYSTEM_APERTURE_LOW_ADDR,
1143 				rdev->mc.gtt_start >> 12);
1144 			WREG32(MC_VM_SYSTEM_APERTURE_HIGH_ADDR,
1145 				rdev->mc.vram_end >> 12);
1146 		}
1147 	} else {
1148 		WREG32(MC_VM_SYSTEM_APERTURE_LOW_ADDR,
1149 			rdev->mc.vram_start >> 12);
1150 		WREG32(MC_VM_SYSTEM_APERTURE_HIGH_ADDR,
1151 			rdev->mc.vram_end >> 12);
1152 	}
1153 	WREG32(MC_VM_SYSTEM_APERTURE_DEFAULT_ADDR, 0);
1154 	if (rdev->flags & RADEON_IS_IGP) {
1155 		tmp = RREG32(MC_FUS_VM_FB_OFFSET) & 0x000FFFFF;
1156 		tmp |= ((rdev->mc.vram_end >> 20) & 0xF) << 24;
1157 		tmp |= ((rdev->mc.vram_start >> 20) & 0xF) << 20;
1158 		WREG32(MC_FUS_VM_FB_OFFSET, tmp);
1159 	}
1160 	tmp = ((rdev->mc.vram_end >> 24) & 0xFFFF) << 16;
1161 	tmp |= ((rdev->mc.vram_start >> 24) & 0xFFFF);
1162 	WREG32(MC_VM_FB_LOCATION, tmp);
1163 	WREG32(HDP_NONSURFACE_BASE, (rdev->mc.vram_start >> 8));
1164 	WREG32(HDP_NONSURFACE_INFO, (2 << 7) | (1 << 30));
1165 	WREG32(HDP_NONSURFACE_SIZE, 0x3FFFFFFF);
1166 	if (rdev->flags & RADEON_IS_AGP) {
1167 		WREG32(MC_VM_AGP_TOP, rdev->mc.gtt_end >> 16);
1168 		WREG32(MC_VM_AGP_BOT, rdev->mc.gtt_start >> 16);
1169 		WREG32(MC_VM_AGP_BASE, rdev->mc.agp_base >> 22);
1170 	} else {
1171 		WREG32(MC_VM_AGP_BASE, 0);
1172 		WREG32(MC_VM_AGP_TOP, 0x0FFFFFFF);
1173 		WREG32(MC_VM_AGP_BOT, 0x0FFFFFFF);
1174 	}
1175 	if (evergreen_mc_wait_for_idle(rdev)) {
1176 		dev_warn(rdev->dev, "Wait for MC idle timedout !\n");
1177 	}
1178 	evergreen_mc_resume(rdev, &save);
1179 	/* we need to own VRAM, so turn off the VGA renderer here
1180 	 * to stop it overwriting our objects */
1181 	rv515_vga_render_disable(rdev);
1182 }
1183 
1184 /*
1185  * CP.
1186  */
1187 void evergreen_ring_ib_execute(struct radeon_device *rdev, struct radeon_ib *ib)
1188 {
1189 	/* set to DX10/11 mode */
1190 	radeon_ring_write(rdev, PACKET3(PACKET3_MODE_CONTROL, 0));
1191 	radeon_ring_write(rdev, 1);
1192 	/* FIXME: implement */
1193 	radeon_ring_write(rdev, PACKET3(PACKET3_INDIRECT_BUFFER, 2));
1194 	radeon_ring_write(rdev,
1195 #ifdef __BIG_ENDIAN
1196 			  (2 << 0) |
1197 #endif
1198 			  (ib->gpu_addr & 0xFFFFFFFC));
1199 	radeon_ring_write(rdev, upper_32_bits(ib->gpu_addr) & 0xFF);
1200 	radeon_ring_write(rdev, ib->length_dw);
1201 }
1202 
1203 
1204 static int evergreen_cp_load_microcode(struct radeon_device *rdev)
1205 {
1206 	const __be32 *fw_data;
1207 	int i;
1208 
1209 	if (!rdev->me_fw || !rdev->pfp_fw)
1210 		return -EINVAL;
1211 
1212 	r700_cp_stop(rdev);
1213 	WREG32(CP_RB_CNTL,
1214 #ifdef __BIG_ENDIAN
1215 	       BUF_SWAP_32BIT |
1216 #endif
1217 	       RB_NO_UPDATE | RB_BLKSZ(15) | RB_BUFSZ(3));
1218 
1219 	fw_data = (const __be32 *)rdev->pfp_fw->data;
1220 	WREG32(CP_PFP_UCODE_ADDR, 0);
1221 	for (i = 0; i < EVERGREEN_PFP_UCODE_SIZE; i++)
1222 		WREG32(CP_PFP_UCODE_DATA, be32_to_cpup(fw_data++));
1223 	WREG32(CP_PFP_UCODE_ADDR, 0);
1224 
1225 	fw_data = (const __be32 *)rdev->me_fw->data;
1226 	WREG32(CP_ME_RAM_WADDR, 0);
1227 	for (i = 0; i < EVERGREEN_PM4_UCODE_SIZE; i++)
1228 		WREG32(CP_ME_RAM_DATA, be32_to_cpup(fw_data++));
1229 
1230 	WREG32(CP_PFP_UCODE_ADDR, 0);
1231 	WREG32(CP_ME_RAM_WADDR, 0);
1232 	WREG32(CP_ME_RAM_RADDR, 0);
1233 	return 0;
1234 }
1235 
1236 static int evergreen_cp_start(struct radeon_device *rdev)
1237 {
1238 	int r, i;
1239 	uint32_t cp_me;
1240 
1241 	r = radeon_ring_lock(rdev, 7);
1242 	if (r) {
1243 		DRM_ERROR("radeon: cp failed to lock ring (%d).\n", r);
1244 		return r;
1245 	}
1246 	radeon_ring_write(rdev, PACKET3(PACKET3_ME_INITIALIZE, 5));
1247 	radeon_ring_write(rdev, 0x1);
1248 	radeon_ring_write(rdev, 0x0);
1249 	radeon_ring_write(rdev, rdev->config.evergreen.max_hw_contexts - 1);
1250 	radeon_ring_write(rdev, PACKET3_ME_INITIALIZE_DEVICE_ID(1));
1251 	radeon_ring_write(rdev, 0);
1252 	radeon_ring_write(rdev, 0);
1253 	radeon_ring_unlock_commit(rdev);
1254 
1255 	cp_me = 0xff;
1256 	WREG32(CP_ME_CNTL, cp_me);
1257 
1258 	r = radeon_ring_lock(rdev, evergreen_default_size + 19);
1259 	if (r) {
1260 		DRM_ERROR("radeon: cp failed to lock ring (%d).\n", r);
1261 		return r;
1262 	}
1263 
1264 	/* setup clear context state */
1265 	radeon_ring_write(rdev, PACKET3(PACKET3_PREAMBLE_CNTL, 0));
1266 	radeon_ring_write(rdev, PACKET3_PREAMBLE_BEGIN_CLEAR_STATE);
1267 
1268 	for (i = 0; i < evergreen_default_size; i++)
1269 		radeon_ring_write(rdev, evergreen_default_state[i]);
1270 
1271 	radeon_ring_write(rdev, PACKET3(PACKET3_PREAMBLE_CNTL, 0));
1272 	radeon_ring_write(rdev, PACKET3_PREAMBLE_END_CLEAR_STATE);
1273 
1274 	/* set clear context state */
1275 	radeon_ring_write(rdev, PACKET3(PACKET3_CLEAR_STATE, 0));
1276 	radeon_ring_write(rdev, 0);
1277 
1278 	/* SQ_VTX_BASE_VTX_LOC */
1279 	radeon_ring_write(rdev, 0xc0026f00);
1280 	radeon_ring_write(rdev, 0x00000000);
1281 	radeon_ring_write(rdev, 0x00000000);
1282 	radeon_ring_write(rdev, 0x00000000);
1283 
1284 	/* Clear consts */
1285 	radeon_ring_write(rdev, 0xc0036f00);
1286 	radeon_ring_write(rdev, 0x00000bc4);
1287 	radeon_ring_write(rdev, 0xffffffff);
1288 	radeon_ring_write(rdev, 0xffffffff);
1289 	radeon_ring_write(rdev, 0xffffffff);
1290 
1291 	radeon_ring_write(rdev, 0xc0026900);
1292 	radeon_ring_write(rdev, 0x00000316);
1293 	radeon_ring_write(rdev, 0x0000000e); /* VGT_VERTEX_REUSE_BLOCK_CNTL */
1294 	radeon_ring_write(rdev, 0x00000010); /*  */
1295 
1296 	radeon_ring_unlock_commit(rdev);
1297 
1298 	return 0;
1299 }
1300 
1301 int evergreen_cp_resume(struct radeon_device *rdev)
1302 {
1303 	u32 tmp;
1304 	u32 rb_bufsz;
1305 	int r;
1306 
1307 	/* Reset cp; if cp is reset, then PA, SH, VGT also need to be reset */
1308 	WREG32(GRBM_SOFT_RESET, (SOFT_RESET_CP |
1309 				 SOFT_RESET_PA |
1310 				 SOFT_RESET_SH |
1311 				 SOFT_RESET_VGT |
1312 				 SOFT_RESET_SX));
1313 	RREG32(GRBM_SOFT_RESET);
1314 	mdelay(15);
1315 	WREG32(GRBM_SOFT_RESET, 0);
1316 	RREG32(GRBM_SOFT_RESET);
1317 
1318 	/* Set ring buffer size */
1319 	rb_bufsz = drm_order(rdev->cp.ring_size / 8);
1320 	tmp = (drm_order(RADEON_GPU_PAGE_SIZE/8) << 8) | rb_bufsz;
1321 #ifdef __BIG_ENDIAN
1322 	tmp |= BUF_SWAP_32BIT;
1323 #endif
1324 	WREG32(CP_RB_CNTL, tmp);
1325 	WREG32(CP_SEM_WAIT_TIMER, 0x4);
1326 
1327 	/* Set the write pointer delay */
1328 	WREG32(CP_RB_WPTR_DELAY, 0);
1329 
1330 	/* Initialize the ring buffer's read and write pointers */
1331 	WREG32(CP_RB_CNTL, tmp | RB_RPTR_WR_ENA);
1332 	WREG32(CP_RB_RPTR_WR, 0);
1333 	WREG32(CP_RB_WPTR, 0);
1334 
1335 	/* set the wb address wether it's enabled or not */
1336 	WREG32(CP_RB_RPTR_ADDR,
1337 #ifdef __BIG_ENDIAN
1338 	       RB_RPTR_SWAP(2) |
1339 #endif
1340 	       ((rdev->wb.gpu_addr + RADEON_WB_CP_RPTR_OFFSET) & 0xFFFFFFFC));
1341 	WREG32(CP_RB_RPTR_ADDR_HI, upper_32_bits(rdev->wb.gpu_addr + RADEON_WB_CP_RPTR_OFFSET) & 0xFF);
1342 	WREG32(SCRATCH_ADDR, ((rdev->wb.gpu_addr + RADEON_WB_SCRATCH_OFFSET) >> 8) & 0xFFFFFFFF);
1343 
1344 	if (rdev->wb.enabled)
1345 		WREG32(SCRATCH_UMSK, 0xff);
1346 	else {
1347 		tmp |= RB_NO_UPDATE;
1348 		WREG32(SCRATCH_UMSK, 0);
1349 	}
1350 
1351 	mdelay(1);
1352 	WREG32(CP_RB_CNTL, tmp);
1353 
1354 	WREG32(CP_RB_BASE, rdev->cp.gpu_addr >> 8);
1355 	WREG32(CP_DEBUG, (1 << 27) | (1 << 28));
1356 
1357 	rdev->cp.rptr = RREG32(CP_RB_RPTR);
1358 	rdev->cp.wptr = RREG32(CP_RB_WPTR);
1359 
1360 	evergreen_cp_start(rdev);
1361 	rdev->cp.ready = true;
1362 	r = radeon_ring_test(rdev);
1363 	if (r) {
1364 		rdev->cp.ready = false;
1365 		return r;
1366 	}
1367 	return 0;
1368 }
1369 
1370 /*
1371  * Core functions
1372  */
1373 static u32 evergreen_get_tile_pipe_to_backend_map(struct radeon_device *rdev,
1374 						  u32 num_tile_pipes,
1375 						  u32 num_backends,
1376 						  u32 backend_disable_mask)
1377 {
1378 	u32 backend_map = 0;
1379 	u32 enabled_backends_mask = 0;
1380 	u32 enabled_backends_count = 0;
1381 	u32 cur_pipe;
1382 	u32 swizzle_pipe[EVERGREEN_MAX_PIPES];
1383 	u32 cur_backend = 0;
1384 	u32 i;
1385 	bool force_no_swizzle;
1386 
1387 	if (num_tile_pipes > EVERGREEN_MAX_PIPES)
1388 		num_tile_pipes = EVERGREEN_MAX_PIPES;
1389 	if (num_tile_pipes < 1)
1390 		num_tile_pipes = 1;
1391 	if (num_backends > EVERGREEN_MAX_BACKENDS)
1392 		num_backends = EVERGREEN_MAX_BACKENDS;
1393 	if (num_backends < 1)
1394 		num_backends = 1;
1395 
1396 	for (i = 0; i < EVERGREEN_MAX_BACKENDS; ++i) {
1397 		if (((backend_disable_mask >> i) & 1) == 0) {
1398 			enabled_backends_mask |= (1 << i);
1399 			++enabled_backends_count;
1400 		}
1401 		if (enabled_backends_count == num_backends)
1402 			break;
1403 	}
1404 
1405 	if (enabled_backends_count == 0) {
1406 		enabled_backends_mask = 1;
1407 		enabled_backends_count = 1;
1408 	}
1409 
1410 	if (enabled_backends_count != num_backends)
1411 		num_backends = enabled_backends_count;
1412 
1413 	memset((uint8_t *)&swizzle_pipe[0], 0, sizeof(u32) * EVERGREEN_MAX_PIPES);
1414 	switch (rdev->family) {
1415 	case CHIP_CEDAR:
1416 	case CHIP_REDWOOD:
1417 	case CHIP_PALM:
1418 	case CHIP_TURKS:
1419 	case CHIP_CAICOS:
1420 		force_no_swizzle = false;
1421 		break;
1422 	case CHIP_CYPRESS:
1423 	case CHIP_HEMLOCK:
1424 	case CHIP_JUNIPER:
1425 	case CHIP_BARTS:
1426 	default:
1427 		force_no_swizzle = true;
1428 		break;
1429 	}
1430 	if (force_no_swizzle) {
1431 		bool last_backend_enabled = false;
1432 
1433 		force_no_swizzle = false;
1434 		for (i = 0; i < EVERGREEN_MAX_BACKENDS; ++i) {
1435 			if (((enabled_backends_mask >> i) & 1) == 1) {
1436 				if (last_backend_enabled)
1437 					force_no_swizzle = true;
1438 				last_backend_enabled = true;
1439 			} else
1440 				last_backend_enabled = false;
1441 		}
1442 	}
1443 
1444 	switch (num_tile_pipes) {
1445 	case 1:
1446 	case 3:
1447 	case 5:
1448 	case 7:
1449 		DRM_ERROR("odd number of pipes!\n");
1450 		break;
1451 	case 2:
1452 		swizzle_pipe[0] = 0;
1453 		swizzle_pipe[1] = 1;
1454 		break;
1455 	case 4:
1456 		if (force_no_swizzle) {
1457 			swizzle_pipe[0] = 0;
1458 			swizzle_pipe[1] = 1;
1459 			swizzle_pipe[2] = 2;
1460 			swizzle_pipe[3] = 3;
1461 		} else {
1462 			swizzle_pipe[0] = 0;
1463 			swizzle_pipe[1] = 2;
1464 			swizzle_pipe[2] = 1;
1465 			swizzle_pipe[3] = 3;
1466 		}
1467 		break;
1468 	case 6:
1469 		if (force_no_swizzle) {
1470 			swizzle_pipe[0] = 0;
1471 			swizzle_pipe[1] = 1;
1472 			swizzle_pipe[2] = 2;
1473 			swizzle_pipe[3] = 3;
1474 			swizzle_pipe[4] = 4;
1475 			swizzle_pipe[5] = 5;
1476 		} else {
1477 			swizzle_pipe[0] = 0;
1478 			swizzle_pipe[1] = 2;
1479 			swizzle_pipe[2] = 4;
1480 			swizzle_pipe[3] = 1;
1481 			swizzle_pipe[4] = 3;
1482 			swizzle_pipe[5] = 5;
1483 		}
1484 		break;
1485 	case 8:
1486 		if (force_no_swizzle) {
1487 			swizzle_pipe[0] = 0;
1488 			swizzle_pipe[1] = 1;
1489 			swizzle_pipe[2] = 2;
1490 			swizzle_pipe[3] = 3;
1491 			swizzle_pipe[4] = 4;
1492 			swizzle_pipe[5] = 5;
1493 			swizzle_pipe[6] = 6;
1494 			swizzle_pipe[7] = 7;
1495 		} else {
1496 			swizzle_pipe[0] = 0;
1497 			swizzle_pipe[1] = 2;
1498 			swizzle_pipe[2] = 4;
1499 			swizzle_pipe[3] = 6;
1500 			swizzle_pipe[4] = 1;
1501 			swizzle_pipe[5] = 3;
1502 			swizzle_pipe[6] = 5;
1503 			swizzle_pipe[7] = 7;
1504 		}
1505 		break;
1506 	}
1507 
1508 	for (cur_pipe = 0; cur_pipe < num_tile_pipes; ++cur_pipe) {
1509 		while (((1 << cur_backend) & enabled_backends_mask) == 0)
1510 			cur_backend = (cur_backend + 1) % EVERGREEN_MAX_BACKENDS;
1511 
1512 		backend_map |= (((cur_backend & 0xf) << (swizzle_pipe[cur_pipe] * 4)));
1513 
1514 		cur_backend = (cur_backend + 1) % EVERGREEN_MAX_BACKENDS;
1515 	}
1516 
1517 	return backend_map;
1518 }
1519 
1520 static void evergreen_program_channel_remap(struct radeon_device *rdev)
1521 {
1522 	u32 tcp_chan_steer_lo, tcp_chan_steer_hi, mc_shared_chremap, tmp;
1523 
1524 	tmp = RREG32(MC_SHARED_CHMAP);
1525 	switch ((tmp & NOOFCHAN_MASK) >> NOOFCHAN_SHIFT) {
1526 	case 0:
1527 	case 1:
1528 	case 2:
1529 	case 3:
1530 	default:
1531 		/* default mapping */
1532 		mc_shared_chremap = 0x00fac688;
1533 		break;
1534 	}
1535 
1536 	switch (rdev->family) {
1537 	case CHIP_HEMLOCK:
1538 	case CHIP_CYPRESS:
1539 	case CHIP_BARTS:
1540 		tcp_chan_steer_lo = 0x54763210;
1541 		tcp_chan_steer_hi = 0x0000ba98;
1542 		break;
1543 	case CHIP_JUNIPER:
1544 	case CHIP_REDWOOD:
1545 	case CHIP_CEDAR:
1546 	case CHIP_PALM:
1547 	case CHIP_TURKS:
1548 	case CHIP_CAICOS:
1549 	default:
1550 		tcp_chan_steer_lo = 0x76543210;
1551 		tcp_chan_steer_hi = 0x0000ba98;
1552 		break;
1553 	}
1554 
1555 	WREG32(TCP_CHAN_STEER_LO, tcp_chan_steer_lo);
1556 	WREG32(TCP_CHAN_STEER_HI, tcp_chan_steer_hi);
1557 	WREG32(MC_SHARED_CHREMAP, mc_shared_chremap);
1558 }
1559 
1560 static void evergreen_gpu_init(struct radeon_device *rdev)
1561 {
1562 	u32 cc_rb_backend_disable = 0;
1563 	u32 cc_gc_shader_pipe_config;
1564 	u32 gb_addr_config = 0;
1565 	u32 mc_shared_chmap, mc_arb_ramcfg;
1566 	u32 gb_backend_map;
1567 	u32 grbm_gfx_index;
1568 	u32 sx_debug_1;
1569 	u32 smx_dc_ctl0;
1570 	u32 sq_config;
1571 	u32 sq_lds_resource_mgmt;
1572 	u32 sq_gpr_resource_mgmt_1;
1573 	u32 sq_gpr_resource_mgmt_2;
1574 	u32 sq_gpr_resource_mgmt_3;
1575 	u32 sq_thread_resource_mgmt;
1576 	u32 sq_thread_resource_mgmt_2;
1577 	u32 sq_stack_resource_mgmt_1;
1578 	u32 sq_stack_resource_mgmt_2;
1579 	u32 sq_stack_resource_mgmt_3;
1580 	u32 vgt_cache_invalidation;
1581 	u32 hdp_host_path_cntl;
1582 	int i, j, num_shader_engines, ps_thread_count;
1583 
1584 	switch (rdev->family) {
1585 	case CHIP_CYPRESS:
1586 	case CHIP_HEMLOCK:
1587 		rdev->config.evergreen.num_ses = 2;
1588 		rdev->config.evergreen.max_pipes = 4;
1589 		rdev->config.evergreen.max_tile_pipes = 8;
1590 		rdev->config.evergreen.max_simds = 10;
1591 		rdev->config.evergreen.max_backends = 4 * rdev->config.evergreen.num_ses;
1592 		rdev->config.evergreen.max_gprs = 256;
1593 		rdev->config.evergreen.max_threads = 248;
1594 		rdev->config.evergreen.max_gs_threads = 32;
1595 		rdev->config.evergreen.max_stack_entries = 512;
1596 		rdev->config.evergreen.sx_num_of_sets = 4;
1597 		rdev->config.evergreen.sx_max_export_size = 256;
1598 		rdev->config.evergreen.sx_max_export_pos_size = 64;
1599 		rdev->config.evergreen.sx_max_export_smx_size = 192;
1600 		rdev->config.evergreen.max_hw_contexts = 8;
1601 		rdev->config.evergreen.sq_num_cf_insts = 2;
1602 
1603 		rdev->config.evergreen.sc_prim_fifo_size = 0x100;
1604 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1605 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1606 		break;
1607 	case CHIP_JUNIPER:
1608 		rdev->config.evergreen.num_ses = 1;
1609 		rdev->config.evergreen.max_pipes = 4;
1610 		rdev->config.evergreen.max_tile_pipes = 4;
1611 		rdev->config.evergreen.max_simds = 10;
1612 		rdev->config.evergreen.max_backends = 4 * rdev->config.evergreen.num_ses;
1613 		rdev->config.evergreen.max_gprs = 256;
1614 		rdev->config.evergreen.max_threads = 248;
1615 		rdev->config.evergreen.max_gs_threads = 32;
1616 		rdev->config.evergreen.max_stack_entries = 512;
1617 		rdev->config.evergreen.sx_num_of_sets = 4;
1618 		rdev->config.evergreen.sx_max_export_size = 256;
1619 		rdev->config.evergreen.sx_max_export_pos_size = 64;
1620 		rdev->config.evergreen.sx_max_export_smx_size = 192;
1621 		rdev->config.evergreen.max_hw_contexts = 8;
1622 		rdev->config.evergreen.sq_num_cf_insts = 2;
1623 
1624 		rdev->config.evergreen.sc_prim_fifo_size = 0x100;
1625 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1626 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1627 		break;
1628 	case CHIP_REDWOOD:
1629 		rdev->config.evergreen.num_ses = 1;
1630 		rdev->config.evergreen.max_pipes = 4;
1631 		rdev->config.evergreen.max_tile_pipes = 4;
1632 		rdev->config.evergreen.max_simds = 5;
1633 		rdev->config.evergreen.max_backends = 2 * rdev->config.evergreen.num_ses;
1634 		rdev->config.evergreen.max_gprs = 256;
1635 		rdev->config.evergreen.max_threads = 248;
1636 		rdev->config.evergreen.max_gs_threads = 32;
1637 		rdev->config.evergreen.max_stack_entries = 256;
1638 		rdev->config.evergreen.sx_num_of_sets = 4;
1639 		rdev->config.evergreen.sx_max_export_size = 256;
1640 		rdev->config.evergreen.sx_max_export_pos_size = 64;
1641 		rdev->config.evergreen.sx_max_export_smx_size = 192;
1642 		rdev->config.evergreen.max_hw_contexts = 8;
1643 		rdev->config.evergreen.sq_num_cf_insts = 2;
1644 
1645 		rdev->config.evergreen.sc_prim_fifo_size = 0x100;
1646 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1647 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1648 		break;
1649 	case CHIP_CEDAR:
1650 	default:
1651 		rdev->config.evergreen.num_ses = 1;
1652 		rdev->config.evergreen.max_pipes = 2;
1653 		rdev->config.evergreen.max_tile_pipes = 2;
1654 		rdev->config.evergreen.max_simds = 2;
1655 		rdev->config.evergreen.max_backends = 1 * rdev->config.evergreen.num_ses;
1656 		rdev->config.evergreen.max_gprs = 256;
1657 		rdev->config.evergreen.max_threads = 192;
1658 		rdev->config.evergreen.max_gs_threads = 16;
1659 		rdev->config.evergreen.max_stack_entries = 256;
1660 		rdev->config.evergreen.sx_num_of_sets = 4;
1661 		rdev->config.evergreen.sx_max_export_size = 128;
1662 		rdev->config.evergreen.sx_max_export_pos_size = 32;
1663 		rdev->config.evergreen.sx_max_export_smx_size = 96;
1664 		rdev->config.evergreen.max_hw_contexts = 4;
1665 		rdev->config.evergreen.sq_num_cf_insts = 1;
1666 
1667 		rdev->config.evergreen.sc_prim_fifo_size = 0x40;
1668 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1669 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1670 		break;
1671 	case CHIP_PALM:
1672 		rdev->config.evergreen.num_ses = 1;
1673 		rdev->config.evergreen.max_pipes = 2;
1674 		rdev->config.evergreen.max_tile_pipes = 2;
1675 		rdev->config.evergreen.max_simds = 2;
1676 		rdev->config.evergreen.max_backends = 1 * rdev->config.evergreen.num_ses;
1677 		rdev->config.evergreen.max_gprs = 256;
1678 		rdev->config.evergreen.max_threads = 192;
1679 		rdev->config.evergreen.max_gs_threads = 16;
1680 		rdev->config.evergreen.max_stack_entries = 256;
1681 		rdev->config.evergreen.sx_num_of_sets = 4;
1682 		rdev->config.evergreen.sx_max_export_size = 128;
1683 		rdev->config.evergreen.sx_max_export_pos_size = 32;
1684 		rdev->config.evergreen.sx_max_export_smx_size = 96;
1685 		rdev->config.evergreen.max_hw_contexts = 4;
1686 		rdev->config.evergreen.sq_num_cf_insts = 1;
1687 
1688 		rdev->config.evergreen.sc_prim_fifo_size = 0x40;
1689 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1690 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1691 		break;
1692 	case CHIP_BARTS:
1693 		rdev->config.evergreen.num_ses = 2;
1694 		rdev->config.evergreen.max_pipes = 4;
1695 		rdev->config.evergreen.max_tile_pipes = 8;
1696 		rdev->config.evergreen.max_simds = 7;
1697 		rdev->config.evergreen.max_backends = 4 * rdev->config.evergreen.num_ses;
1698 		rdev->config.evergreen.max_gprs = 256;
1699 		rdev->config.evergreen.max_threads = 248;
1700 		rdev->config.evergreen.max_gs_threads = 32;
1701 		rdev->config.evergreen.max_stack_entries = 512;
1702 		rdev->config.evergreen.sx_num_of_sets = 4;
1703 		rdev->config.evergreen.sx_max_export_size = 256;
1704 		rdev->config.evergreen.sx_max_export_pos_size = 64;
1705 		rdev->config.evergreen.sx_max_export_smx_size = 192;
1706 		rdev->config.evergreen.max_hw_contexts = 8;
1707 		rdev->config.evergreen.sq_num_cf_insts = 2;
1708 
1709 		rdev->config.evergreen.sc_prim_fifo_size = 0x100;
1710 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1711 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1712 		break;
1713 	case CHIP_TURKS:
1714 		rdev->config.evergreen.num_ses = 1;
1715 		rdev->config.evergreen.max_pipes = 4;
1716 		rdev->config.evergreen.max_tile_pipes = 4;
1717 		rdev->config.evergreen.max_simds = 6;
1718 		rdev->config.evergreen.max_backends = 2 * rdev->config.evergreen.num_ses;
1719 		rdev->config.evergreen.max_gprs = 256;
1720 		rdev->config.evergreen.max_threads = 248;
1721 		rdev->config.evergreen.max_gs_threads = 32;
1722 		rdev->config.evergreen.max_stack_entries = 256;
1723 		rdev->config.evergreen.sx_num_of_sets = 4;
1724 		rdev->config.evergreen.sx_max_export_size = 256;
1725 		rdev->config.evergreen.sx_max_export_pos_size = 64;
1726 		rdev->config.evergreen.sx_max_export_smx_size = 192;
1727 		rdev->config.evergreen.max_hw_contexts = 8;
1728 		rdev->config.evergreen.sq_num_cf_insts = 2;
1729 
1730 		rdev->config.evergreen.sc_prim_fifo_size = 0x100;
1731 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1732 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1733 		break;
1734 	case CHIP_CAICOS:
1735 		rdev->config.evergreen.num_ses = 1;
1736 		rdev->config.evergreen.max_pipes = 4;
1737 		rdev->config.evergreen.max_tile_pipes = 2;
1738 		rdev->config.evergreen.max_simds = 2;
1739 		rdev->config.evergreen.max_backends = 1 * rdev->config.evergreen.num_ses;
1740 		rdev->config.evergreen.max_gprs = 256;
1741 		rdev->config.evergreen.max_threads = 192;
1742 		rdev->config.evergreen.max_gs_threads = 16;
1743 		rdev->config.evergreen.max_stack_entries = 256;
1744 		rdev->config.evergreen.sx_num_of_sets = 4;
1745 		rdev->config.evergreen.sx_max_export_size = 128;
1746 		rdev->config.evergreen.sx_max_export_pos_size = 32;
1747 		rdev->config.evergreen.sx_max_export_smx_size = 96;
1748 		rdev->config.evergreen.max_hw_contexts = 4;
1749 		rdev->config.evergreen.sq_num_cf_insts = 1;
1750 
1751 		rdev->config.evergreen.sc_prim_fifo_size = 0x40;
1752 		rdev->config.evergreen.sc_hiz_tile_fifo_size = 0x30;
1753 		rdev->config.evergreen.sc_earlyz_tile_fifo_size = 0x130;
1754 		break;
1755 	}
1756 
1757 	/* Initialize HDP */
1758 	for (i = 0, j = 0; i < 32; i++, j += 0x18) {
1759 		WREG32((0x2c14 + j), 0x00000000);
1760 		WREG32((0x2c18 + j), 0x00000000);
1761 		WREG32((0x2c1c + j), 0x00000000);
1762 		WREG32((0x2c20 + j), 0x00000000);
1763 		WREG32((0x2c24 + j), 0x00000000);
1764 	}
1765 
1766 	WREG32(GRBM_CNTL, GRBM_READ_TIMEOUT(0xff));
1767 
1768 	cc_gc_shader_pipe_config = RREG32(CC_GC_SHADER_PIPE_CONFIG) & ~2;
1769 
1770 	cc_gc_shader_pipe_config |=
1771 		INACTIVE_QD_PIPES((EVERGREEN_MAX_PIPES_MASK << rdev->config.evergreen.max_pipes)
1772 				  & EVERGREEN_MAX_PIPES_MASK);
1773 	cc_gc_shader_pipe_config |=
1774 		INACTIVE_SIMDS((EVERGREEN_MAX_SIMDS_MASK << rdev->config.evergreen.max_simds)
1775 			       & EVERGREEN_MAX_SIMDS_MASK);
1776 
1777 	cc_rb_backend_disable =
1778 		BACKEND_DISABLE((EVERGREEN_MAX_BACKENDS_MASK << rdev->config.evergreen.max_backends)
1779 				& EVERGREEN_MAX_BACKENDS_MASK);
1780 
1781 
1782 	mc_shared_chmap = RREG32(MC_SHARED_CHMAP);
1783 	mc_arb_ramcfg = RREG32(MC_ARB_RAMCFG);
1784 
1785 	switch (rdev->config.evergreen.max_tile_pipes) {
1786 	case 1:
1787 	default:
1788 		gb_addr_config |= NUM_PIPES(0);
1789 		break;
1790 	case 2:
1791 		gb_addr_config |= NUM_PIPES(1);
1792 		break;
1793 	case 4:
1794 		gb_addr_config |= NUM_PIPES(2);
1795 		break;
1796 	case 8:
1797 		gb_addr_config |= NUM_PIPES(3);
1798 		break;
1799 	}
1800 
1801 	gb_addr_config |= PIPE_INTERLEAVE_SIZE((mc_arb_ramcfg & BURSTLENGTH_MASK) >> BURSTLENGTH_SHIFT);
1802 	gb_addr_config |= BANK_INTERLEAVE_SIZE(0);
1803 	gb_addr_config |= NUM_SHADER_ENGINES(rdev->config.evergreen.num_ses - 1);
1804 	gb_addr_config |= SHADER_ENGINE_TILE_SIZE(1);
1805 	gb_addr_config |= NUM_GPUS(0); /* Hemlock? */
1806 	gb_addr_config |= MULTI_GPU_TILE_SIZE(2);
1807 
1808 	if (((mc_arb_ramcfg & NOOFCOLS_MASK) >> NOOFCOLS_SHIFT) > 2)
1809 		gb_addr_config |= ROW_SIZE(2);
1810 	else
1811 		gb_addr_config |= ROW_SIZE((mc_arb_ramcfg & NOOFCOLS_MASK) >> NOOFCOLS_SHIFT);
1812 
1813 	if (rdev->ddev->pdev->device == 0x689e) {
1814 		u32 efuse_straps_4;
1815 		u32 efuse_straps_3;
1816 		u8 efuse_box_bit_131_124;
1817 
1818 		WREG32(RCU_IND_INDEX, 0x204);
1819 		efuse_straps_4 = RREG32(RCU_IND_DATA);
1820 		WREG32(RCU_IND_INDEX, 0x203);
1821 		efuse_straps_3 = RREG32(RCU_IND_DATA);
1822 		efuse_box_bit_131_124 = (u8)(((efuse_straps_4 & 0xf) << 4) | ((efuse_straps_3 & 0xf0000000) >> 28));
1823 
1824 		switch(efuse_box_bit_131_124) {
1825 		case 0x00:
1826 			gb_backend_map = 0x76543210;
1827 			break;
1828 		case 0x55:
1829 			gb_backend_map = 0x77553311;
1830 			break;
1831 		case 0x56:
1832 			gb_backend_map = 0x77553300;
1833 			break;
1834 		case 0x59:
1835 			gb_backend_map = 0x77552211;
1836 			break;
1837 		case 0x66:
1838 			gb_backend_map = 0x77443300;
1839 			break;
1840 		case 0x99:
1841 			gb_backend_map = 0x66552211;
1842 			break;
1843 		case 0x5a:
1844 			gb_backend_map = 0x77552200;
1845 			break;
1846 		case 0xaa:
1847 			gb_backend_map = 0x66442200;
1848 			break;
1849 		case 0x95:
1850 			gb_backend_map = 0x66553311;
1851 			break;
1852 		default:
1853 			DRM_ERROR("bad backend map, using default\n");
1854 			gb_backend_map =
1855 				evergreen_get_tile_pipe_to_backend_map(rdev,
1856 								       rdev->config.evergreen.max_tile_pipes,
1857 								       rdev->config.evergreen.max_backends,
1858 								       ((EVERGREEN_MAX_BACKENDS_MASK <<
1859 								   rdev->config.evergreen.max_backends) &
1860 									EVERGREEN_MAX_BACKENDS_MASK));
1861 			break;
1862 		}
1863 	} else if (rdev->ddev->pdev->device == 0x68b9) {
1864 		u32 efuse_straps_3;
1865 		u8 efuse_box_bit_127_124;
1866 
1867 		WREG32(RCU_IND_INDEX, 0x203);
1868 		efuse_straps_3 = RREG32(RCU_IND_DATA);
1869 		efuse_box_bit_127_124 = (u8)((efuse_straps_3 & 0xF0000000) >> 28);
1870 
1871 		switch(efuse_box_bit_127_124) {
1872 		case 0x0:
1873 			gb_backend_map = 0x00003210;
1874 			break;
1875 		case 0x5:
1876 		case 0x6:
1877 		case 0x9:
1878 		case 0xa:
1879 			gb_backend_map = 0x00003311;
1880 			break;
1881 		default:
1882 			DRM_ERROR("bad backend map, using default\n");
1883 			gb_backend_map =
1884 				evergreen_get_tile_pipe_to_backend_map(rdev,
1885 								       rdev->config.evergreen.max_tile_pipes,
1886 								       rdev->config.evergreen.max_backends,
1887 								       ((EVERGREEN_MAX_BACKENDS_MASK <<
1888 								   rdev->config.evergreen.max_backends) &
1889 									EVERGREEN_MAX_BACKENDS_MASK));
1890 			break;
1891 		}
1892 	} else {
1893 		switch (rdev->family) {
1894 		case CHIP_CYPRESS:
1895 		case CHIP_HEMLOCK:
1896 		case CHIP_BARTS:
1897 			gb_backend_map = 0x66442200;
1898 			break;
1899 		case CHIP_JUNIPER:
1900 			gb_backend_map = 0x00006420;
1901 			break;
1902 		default:
1903 			gb_backend_map =
1904 				evergreen_get_tile_pipe_to_backend_map(rdev,
1905 								       rdev->config.evergreen.max_tile_pipes,
1906 								       rdev->config.evergreen.max_backends,
1907 								       ((EVERGREEN_MAX_BACKENDS_MASK <<
1908 									 rdev->config.evergreen.max_backends) &
1909 									EVERGREEN_MAX_BACKENDS_MASK));
1910 		}
1911 	}
1912 
1913 	/* setup tiling info dword.  gb_addr_config is not adequate since it does
1914 	 * not have bank info, so create a custom tiling dword.
1915 	 * bits 3:0   num_pipes
1916 	 * bits 7:4   num_banks
1917 	 * bits 11:8  group_size
1918 	 * bits 15:12 row_size
1919 	 */
1920 	rdev->config.evergreen.tile_config = 0;
1921 	switch (rdev->config.evergreen.max_tile_pipes) {
1922 	case 1:
1923 	default:
1924 		rdev->config.evergreen.tile_config |= (0 << 0);
1925 		break;
1926 	case 2:
1927 		rdev->config.evergreen.tile_config |= (1 << 0);
1928 		break;
1929 	case 4:
1930 		rdev->config.evergreen.tile_config |= (2 << 0);
1931 		break;
1932 	case 8:
1933 		rdev->config.evergreen.tile_config |= (3 << 0);
1934 		break;
1935 	}
1936 	rdev->config.evergreen.tile_config |=
1937 		((mc_arb_ramcfg & NOOFBANK_MASK) >> NOOFBANK_SHIFT) << 4;
1938 	rdev->config.evergreen.tile_config |=
1939 		((mc_arb_ramcfg & BURSTLENGTH_MASK) >> BURSTLENGTH_SHIFT) << 8;
1940 	rdev->config.evergreen.tile_config |=
1941 		((gb_addr_config & 0x30000000) >> 28) << 12;
1942 
1943 	WREG32(GB_BACKEND_MAP, gb_backend_map);
1944 	WREG32(GB_ADDR_CONFIG, gb_addr_config);
1945 	WREG32(DMIF_ADDR_CONFIG, gb_addr_config);
1946 	WREG32(HDP_ADDR_CONFIG, gb_addr_config);
1947 
1948 	evergreen_program_channel_remap(rdev);
1949 
1950 	num_shader_engines = ((RREG32(GB_ADDR_CONFIG) & NUM_SHADER_ENGINES(3)) >> 12) + 1;
1951 	grbm_gfx_index = INSTANCE_BROADCAST_WRITES;
1952 
1953 	for (i = 0; i < rdev->config.evergreen.num_ses; i++) {
1954 		u32 rb = cc_rb_backend_disable | (0xf0 << 16);
1955 		u32 sp = cc_gc_shader_pipe_config;
1956 		u32 gfx = grbm_gfx_index | SE_INDEX(i);
1957 
1958 		if (i == num_shader_engines) {
1959 			rb |= BACKEND_DISABLE(EVERGREEN_MAX_BACKENDS_MASK);
1960 			sp |= INACTIVE_SIMDS(EVERGREEN_MAX_SIMDS_MASK);
1961 		}
1962 
1963 		WREG32(GRBM_GFX_INDEX, gfx);
1964 		WREG32(RLC_GFX_INDEX, gfx);
1965 
1966 		WREG32(CC_RB_BACKEND_DISABLE, rb);
1967 		WREG32(CC_SYS_RB_BACKEND_DISABLE, rb);
1968 		WREG32(GC_USER_RB_BACKEND_DISABLE, rb);
1969 		WREG32(CC_GC_SHADER_PIPE_CONFIG, sp);
1970         }
1971 
1972 	grbm_gfx_index |= SE_BROADCAST_WRITES;
1973 	WREG32(GRBM_GFX_INDEX, grbm_gfx_index);
1974 	WREG32(RLC_GFX_INDEX, grbm_gfx_index);
1975 
1976 	WREG32(CGTS_SYS_TCC_DISABLE, 0);
1977 	WREG32(CGTS_TCC_DISABLE, 0);
1978 	WREG32(CGTS_USER_SYS_TCC_DISABLE, 0);
1979 	WREG32(CGTS_USER_TCC_DISABLE, 0);
1980 
1981 	/* set HW defaults for 3D engine */
1982 	WREG32(CP_QUEUE_THRESHOLDS, (ROQ_IB1_START(0x16) |
1983 				     ROQ_IB2_START(0x2b)));
1984 
1985 	WREG32(CP_MEQ_THRESHOLDS, STQ_SPLIT(0x30));
1986 
1987 	WREG32(TA_CNTL_AUX, (DISABLE_CUBE_ANISO |
1988 			     SYNC_GRADIENT |
1989 			     SYNC_WALKER |
1990 			     SYNC_ALIGNER));
1991 
1992 	sx_debug_1 = RREG32(SX_DEBUG_1);
1993 	sx_debug_1 |= ENABLE_NEW_SMX_ADDRESS;
1994 	WREG32(SX_DEBUG_1, sx_debug_1);
1995 
1996 
1997 	smx_dc_ctl0 = RREG32(SMX_DC_CTL0);
1998 	smx_dc_ctl0 &= ~NUMBER_OF_SETS(0x1ff);
1999 	smx_dc_ctl0 |= NUMBER_OF_SETS(rdev->config.evergreen.sx_num_of_sets);
2000 	WREG32(SMX_DC_CTL0, smx_dc_ctl0);
2001 
2002 	WREG32(SX_EXPORT_BUFFER_SIZES, (COLOR_BUFFER_SIZE((rdev->config.evergreen.sx_max_export_size / 4) - 1) |
2003 					POSITION_BUFFER_SIZE((rdev->config.evergreen.sx_max_export_pos_size / 4) - 1) |
2004 					SMX_BUFFER_SIZE((rdev->config.evergreen.sx_max_export_smx_size / 4) - 1)));
2005 
2006 	WREG32(PA_SC_FIFO_SIZE, (SC_PRIM_FIFO_SIZE(rdev->config.evergreen.sc_prim_fifo_size) |
2007 				 SC_HIZ_TILE_FIFO_SIZE(rdev->config.evergreen.sc_hiz_tile_fifo_size) |
2008 				 SC_EARLYZ_TILE_FIFO_SIZE(rdev->config.evergreen.sc_earlyz_tile_fifo_size)));
2009 
2010 	WREG32(VGT_NUM_INSTANCES, 1);
2011 	WREG32(SPI_CONFIG_CNTL, 0);
2012 	WREG32(SPI_CONFIG_CNTL_1, VTX_DONE_DELAY(4));
2013 	WREG32(CP_PERFMON_CNTL, 0);
2014 
2015 	WREG32(SQ_MS_FIFO_SIZES, (CACHE_FIFO_SIZE(16 * rdev->config.evergreen.sq_num_cf_insts) |
2016 				  FETCH_FIFO_HIWATER(0x4) |
2017 				  DONE_FIFO_HIWATER(0xe0) |
2018 				  ALU_UPDATE_FIFO_HIWATER(0x8)));
2019 
2020 	sq_config = RREG32(SQ_CONFIG);
2021 	sq_config &= ~(PS_PRIO(3) |
2022 		       VS_PRIO(3) |
2023 		       GS_PRIO(3) |
2024 		       ES_PRIO(3));
2025 	sq_config |= (VC_ENABLE |
2026 		      EXPORT_SRC_C |
2027 		      PS_PRIO(0) |
2028 		      VS_PRIO(1) |
2029 		      GS_PRIO(2) |
2030 		      ES_PRIO(3));
2031 
2032 	switch (rdev->family) {
2033 	case CHIP_CEDAR:
2034 	case CHIP_PALM:
2035 	case CHIP_CAICOS:
2036 		/* no vertex cache */
2037 		sq_config &= ~VC_ENABLE;
2038 		break;
2039 	default:
2040 		break;
2041 	}
2042 
2043 	sq_lds_resource_mgmt = RREG32(SQ_LDS_RESOURCE_MGMT);
2044 
2045 	sq_gpr_resource_mgmt_1 = NUM_PS_GPRS((rdev->config.evergreen.max_gprs - (4 * 2))* 12 / 32);
2046 	sq_gpr_resource_mgmt_1 |= NUM_VS_GPRS((rdev->config.evergreen.max_gprs - (4 * 2)) * 6 / 32);
2047 	sq_gpr_resource_mgmt_1 |= NUM_CLAUSE_TEMP_GPRS(4);
2048 	sq_gpr_resource_mgmt_2 = NUM_GS_GPRS((rdev->config.evergreen.max_gprs - (4 * 2)) * 4 / 32);
2049 	sq_gpr_resource_mgmt_2 |= NUM_ES_GPRS((rdev->config.evergreen.max_gprs - (4 * 2)) * 4 / 32);
2050 	sq_gpr_resource_mgmt_3 = NUM_HS_GPRS((rdev->config.evergreen.max_gprs - (4 * 2)) * 3 / 32);
2051 	sq_gpr_resource_mgmt_3 |= NUM_LS_GPRS((rdev->config.evergreen.max_gprs - (4 * 2)) * 3 / 32);
2052 
2053 	switch (rdev->family) {
2054 	case CHIP_CEDAR:
2055 	case CHIP_PALM:
2056 		ps_thread_count = 96;
2057 		break;
2058 	default:
2059 		ps_thread_count = 128;
2060 		break;
2061 	}
2062 
2063 	sq_thread_resource_mgmt = NUM_PS_THREADS(ps_thread_count);
2064 	sq_thread_resource_mgmt |= NUM_VS_THREADS((((rdev->config.evergreen.max_threads - ps_thread_count) / 6) / 8) * 8);
2065 	sq_thread_resource_mgmt |= NUM_GS_THREADS((((rdev->config.evergreen.max_threads - ps_thread_count) / 6) / 8) * 8);
2066 	sq_thread_resource_mgmt |= NUM_ES_THREADS((((rdev->config.evergreen.max_threads - ps_thread_count) / 6) / 8) * 8);
2067 	sq_thread_resource_mgmt_2 = NUM_HS_THREADS((((rdev->config.evergreen.max_threads - ps_thread_count) / 6) / 8) * 8);
2068 	sq_thread_resource_mgmt_2 |= NUM_LS_THREADS((((rdev->config.evergreen.max_threads - ps_thread_count) / 6) / 8) * 8);
2069 
2070 	sq_stack_resource_mgmt_1 = NUM_PS_STACK_ENTRIES((rdev->config.evergreen.max_stack_entries * 1) / 6);
2071 	sq_stack_resource_mgmt_1 |= NUM_VS_STACK_ENTRIES((rdev->config.evergreen.max_stack_entries * 1) / 6);
2072 	sq_stack_resource_mgmt_2 = NUM_GS_STACK_ENTRIES((rdev->config.evergreen.max_stack_entries * 1) / 6);
2073 	sq_stack_resource_mgmt_2 |= NUM_ES_STACK_ENTRIES((rdev->config.evergreen.max_stack_entries * 1) / 6);
2074 	sq_stack_resource_mgmt_3 = NUM_HS_STACK_ENTRIES((rdev->config.evergreen.max_stack_entries * 1) / 6);
2075 	sq_stack_resource_mgmt_3 |= NUM_LS_STACK_ENTRIES((rdev->config.evergreen.max_stack_entries * 1) / 6);
2076 
2077 	WREG32(SQ_CONFIG, sq_config);
2078 	WREG32(SQ_GPR_RESOURCE_MGMT_1, sq_gpr_resource_mgmt_1);
2079 	WREG32(SQ_GPR_RESOURCE_MGMT_2, sq_gpr_resource_mgmt_2);
2080 	WREG32(SQ_GPR_RESOURCE_MGMT_3, sq_gpr_resource_mgmt_3);
2081 	WREG32(SQ_THREAD_RESOURCE_MGMT, sq_thread_resource_mgmt);
2082 	WREG32(SQ_THREAD_RESOURCE_MGMT_2, sq_thread_resource_mgmt_2);
2083 	WREG32(SQ_STACK_RESOURCE_MGMT_1, sq_stack_resource_mgmt_1);
2084 	WREG32(SQ_STACK_RESOURCE_MGMT_2, sq_stack_resource_mgmt_2);
2085 	WREG32(SQ_STACK_RESOURCE_MGMT_3, sq_stack_resource_mgmt_3);
2086 	WREG32(SQ_DYN_GPR_CNTL_PS_FLUSH_REQ, 0);
2087 	WREG32(SQ_LDS_RESOURCE_MGMT, sq_lds_resource_mgmt);
2088 
2089 	WREG32(PA_SC_FORCE_EOV_MAX_CNTS, (FORCE_EOV_MAX_CLK_CNT(4095) |
2090 					  FORCE_EOV_MAX_REZ_CNT(255)));
2091 
2092 	switch (rdev->family) {
2093 	case CHIP_CEDAR:
2094 	case CHIP_PALM:
2095 	case CHIP_CAICOS:
2096 		vgt_cache_invalidation = CACHE_INVALIDATION(TC_ONLY);
2097 		break;
2098 	default:
2099 		vgt_cache_invalidation = CACHE_INVALIDATION(VC_AND_TC);
2100 		break;
2101 	}
2102 	vgt_cache_invalidation |= AUTO_INVLD_EN(ES_AND_GS_AUTO);
2103 	WREG32(VGT_CACHE_INVALIDATION, vgt_cache_invalidation);
2104 
2105 	WREG32(VGT_GS_VERTEX_REUSE, 16);
2106 	WREG32(PA_SU_LINE_STIPPLE_VALUE, 0);
2107 	WREG32(PA_SC_LINE_STIPPLE_STATE, 0);
2108 
2109 	WREG32(VGT_VERTEX_REUSE_BLOCK_CNTL, 14);
2110 	WREG32(VGT_OUT_DEALLOC_CNTL, 16);
2111 
2112 	WREG32(CB_PERF_CTR0_SEL_0, 0);
2113 	WREG32(CB_PERF_CTR0_SEL_1, 0);
2114 	WREG32(CB_PERF_CTR1_SEL_0, 0);
2115 	WREG32(CB_PERF_CTR1_SEL_1, 0);
2116 	WREG32(CB_PERF_CTR2_SEL_0, 0);
2117 	WREG32(CB_PERF_CTR2_SEL_1, 0);
2118 	WREG32(CB_PERF_CTR3_SEL_0, 0);
2119 	WREG32(CB_PERF_CTR3_SEL_1, 0);
2120 
2121 	/* clear render buffer base addresses */
2122 	WREG32(CB_COLOR0_BASE, 0);
2123 	WREG32(CB_COLOR1_BASE, 0);
2124 	WREG32(CB_COLOR2_BASE, 0);
2125 	WREG32(CB_COLOR3_BASE, 0);
2126 	WREG32(CB_COLOR4_BASE, 0);
2127 	WREG32(CB_COLOR5_BASE, 0);
2128 	WREG32(CB_COLOR6_BASE, 0);
2129 	WREG32(CB_COLOR7_BASE, 0);
2130 	WREG32(CB_COLOR8_BASE, 0);
2131 	WREG32(CB_COLOR9_BASE, 0);
2132 	WREG32(CB_COLOR10_BASE, 0);
2133 	WREG32(CB_COLOR11_BASE, 0);
2134 
2135 	/* set the shader const cache sizes to 0 */
2136 	for (i = SQ_ALU_CONST_BUFFER_SIZE_PS_0; i < 0x28200; i += 4)
2137 		WREG32(i, 0);
2138 	for (i = SQ_ALU_CONST_BUFFER_SIZE_HS_0; i < 0x29000; i += 4)
2139 		WREG32(i, 0);
2140 
2141 	hdp_host_path_cntl = RREG32(HDP_HOST_PATH_CNTL);
2142 	WREG32(HDP_HOST_PATH_CNTL, hdp_host_path_cntl);
2143 
2144 	WREG32(PA_CL_ENHANCE, CLIP_VTX_REORDER_ENA | NUM_CLIP_SEQ(3));
2145 
2146 	udelay(50);
2147 
2148 }
2149 
2150 int evergreen_mc_init(struct radeon_device *rdev)
2151 {
2152 	u32 tmp;
2153 	int chansize, numchan;
2154 
2155 	/* Get VRAM informations */
2156 	rdev->mc.vram_is_ddr = true;
2157 	tmp = RREG32(MC_ARB_RAMCFG);
2158 	if (tmp & CHANSIZE_OVERRIDE) {
2159 		chansize = 16;
2160 	} else if (tmp & CHANSIZE_MASK) {
2161 		chansize = 64;
2162 	} else {
2163 		chansize = 32;
2164 	}
2165 	tmp = RREG32(MC_SHARED_CHMAP);
2166 	switch ((tmp & NOOFCHAN_MASK) >> NOOFCHAN_SHIFT) {
2167 	case 0:
2168 	default:
2169 		numchan = 1;
2170 		break;
2171 	case 1:
2172 		numchan = 2;
2173 		break;
2174 	case 2:
2175 		numchan = 4;
2176 		break;
2177 	case 3:
2178 		numchan = 8;
2179 		break;
2180 	}
2181 	rdev->mc.vram_width = numchan * chansize;
2182 	/* Could aper size report 0 ? */
2183 	rdev->mc.aper_base = pci_resource_start(rdev->pdev, 0);
2184 	rdev->mc.aper_size = pci_resource_len(rdev->pdev, 0);
2185 	/* Setup GPU memory space */
2186 	if (rdev->flags & RADEON_IS_IGP) {
2187 		/* size in bytes on fusion */
2188 		rdev->mc.mc_vram_size = RREG32(CONFIG_MEMSIZE);
2189 		rdev->mc.real_vram_size = RREG32(CONFIG_MEMSIZE);
2190 	} else {
2191 		/* size in MB on evergreen */
2192 		rdev->mc.mc_vram_size = RREG32(CONFIG_MEMSIZE) * 1024 * 1024;
2193 		rdev->mc.real_vram_size = RREG32(CONFIG_MEMSIZE) * 1024 * 1024;
2194 	}
2195 	rdev->mc.visible_vram_size = rdev->mc.aper_size;
2196 	r700_vram_gtt_location(rdev, &rdev->mc);
2197 	radeon_update_bandwidth_info(rdev);
2198 
2199 	return 0;
2200 }
2201 
2202 bool evergreen_gpu_is_lockup(struct radeon_device *rdev)
2203 {
2204 	u32 srbm_status;
2205 	u32 grbm_status;
2206 	u32 grbm_status_se0, grbm_status_se1;
2207 	struct r100_gpu_lockup *lockup = &rdev->config.evergreen.lockup;
2208 	int r;
2209 
2210 	srbm_status = RREG32(SRBM_STATUS);
2211 	grbm_status = RREG32(GRBM_STATUS);
2212 	grbm_status_se0 = RREG32(GRBM_STATUS_SE0);
2213 	grbm_status_se1 = RREG32(GRBM_STATUS_SE1);
2214 	if (!(grbm_status & GUI_ACTIVE)) {
2215 		r100_gpu_lockup_update(lockup, &rdev->cp);
2216 		return false;
2217 	}
2218 	/* force CP activities */
2219 	r = radeon_ring_lock(rdev, 2);
2220 	if (!r) {
2221 		/* PACKET2 NOP */
2222 		radeon_ring_write(rdev, 0x80000000);
2223 		radeon_ring_write(rdev, 0x80000000);
2224 		radeon_ring_unlock_commit(rdev);
2225 	}
2226 	rdev->cp.rptr = RREG32(CP_RB_RPTR);
2227 	return r100_gpu_cp_is_lockup(rdev, lockup, &rdev->cp);
2228 }
2229 
2230 static int evergreen_gpu_soft_reset(struct radeon_device *rdev)
2231 {
2232 	struct evergreen_mc_save save;
2233 	u32 grbm_reset = 0;
2234 
2235 	if (!(RREG32(GRBM_STATUS) & GUI_ACTIVE))
2236 		return 0;
2237 
2238 	dev_info(rdev->dev, "GPU softreset \n");
2239 	dev_info(rdev->dev, "  GRBM_STATUS=0x%08X\n",
2240 		RREG32(GRBM_STATUS));
2241 	dev_info(rdev->dev, "  GRBM_STATUS_SE0=0x%08X\n",
2242 		RREG32(GRBM_STATUS_SE0));
2243 	dev_info(rdev->dev, "  GRBM_STATUS_SE1=0x%08X\n",
2244 		RREG32(GRBM_STATUS_SE1));
2245 	dev_info(rdev->dev, "  SRBM_STATUS=0x%08X\n",
2246 		RREG32(SRBM_STATUS));
2247 	evergreen_mc_stop(rdev, &save);
2248 	if (evergreen_mc_wait_for_idle(rdev)) {
2249 		dev_warn(rdev->dev, "Wait for MC idle timedout !\n");
2250 	}
2251 	/* Disable CP parsing/prefetching */
2252 	WREG32(CP_ME_CNTL, CP_ME_HALT | CP_PFP_HALT);
2253 
2254 	/* reset all the gfx blocks */
2255 	grbm_reset = (SOFT_RESET_CP |
2256 		      SOFT_RESET_CB |
2257 		      SOFT_RESET_DB |
2258 		      SOFT_RESET_PA |
2259 		      SOFT_RESET_SC |
2260 		      SOFT_RESET_SPI |
2261 		      SOFT_RESET_SH |
2262 		      SOFT_RESET_SX |
2263 		      SOFT_RESET_TC |
2264 		      SOFT_RESET_TA |
2265 		      SOFT_RESET_VC |
2266 		      SOFT_RESET_VGT);
2267 
2268 	dev_info(rdev->dev, "  GRBM_SOFT_RESET=0x%08X\n", grbm_reset);
2269 	WREG32(GRBM_SOFT_RESET, grbm_reset);
2270 	(void)RREG32(GRBM_SOFT_RESET);
2271 	udelay(50);
2272 	WREG32(GRBM_SOFT_RESET, 0);
2273 	(void)RREG32(GRBM_SOFT_RESET);
2274 	/* Wait a little for things to settle down */
2275 	udelay(50);
2276 	dev_info(rdev->dev, "  GRBM_STATUS=0x%08X\n",
2277 		RREG32(GRBM_STATUS));
2278 	dev_info(rdev->dev, "  GRBM_STATUS_SE0=0x%08X\n",
2279 		RREG32(GRBM_STATUS_SE0));
2280 	dev_info(rdev->dev, "  GRBM_STATUS_SE1=0x%08X\n",
2281 		RREG32(GRBM_STATUS_SE1));
2282 	dev_info(rdev->dev, "  SRBM_STATUS=0x%08X\n",
2283 		RREG32(SRBM_STATUS));
2284 	evergreen_mc_resume(rdev, &save);
2285 	return 0;
2286 }
2287 
2288 int evergreen_asic_reset(struct radeon_device *rdev)
2289 {
2290 	return evergreen_gpu_soft_reset(rdev);
2291 }
2292 
2293 /* Interrupts */
2294 
2295 u32 evergreen_get_vblank_counter(struct radeon_device *rdev, int crtc)
2296 {
2297 	switch (crtc) {
2298 	case 0:
2299 		return RREG32(CRTC_STATUS_FRAME_COUNT + EVERGREEN_CRTC0_REGISTER_OFFSET);
2300 	case 1:
2301 		return RREG32(CRTC_STATUS_FRAME_COUNT + EVERGREEN_CRTC1_REGISTER_OFFSET);
2302 	case 2:
2303 		return RREG32(CRTC_STATUS_FRAME_COUNT + EVERGREEN_CRTC2_REGISTER_OFFSET);
2304 	case 3:
2305 		return RREG32(CRTC_STATUS_FRAME_COUNT + EVERGREEN_CRTC3_REGISTER_OFFSET);
2306 	case 4:
2307 		return RREG32(CRTC_STATUS_FRAME_COUNT + EVERGREEN_CRTC4_REGISTER_OFFSET);
2308 	case 5:
2309 		return RREG32(CRTC_STATUS_FRAME_COUNT + EVERGREEN_CRTC5_REGISTER_OFFSET);
2310 	default:
2311 		return 0;
2312 	}
2313 }
2314 
2315 void evergreen_disable_interrupt_state(struct radeon_device *rdev)
2316 {
2317 	u32 tmp;
2318 
2319 	WREG32(CP_INT_CNTL, CNTX_BUSY_INT_ENABLE | CNTX_EMPTY_INT_ENABLE);
2320 	WREG32(GRBM_INT_CNTL, 0);
2321 	WREG32(INT_MASK + EVERGREEN_CRTC0_REGISTER_OFFSET, 0);
2322 	WREG32(INT_MASK + EVERGREEN_CRTC1_REGISTER_OFFSET, 0);
2323 	if (!(rdev->flags & RADEON_IS_IGP)) {
2324 		WREG32(INT_MASK + EVERGREEN_CRTC2_REGISTER_OFFSET, 0);
2325 		WREG32(INT_MASK + EVERGREEN_CRTC3_REGISTER_OFFSET, 0);
2326 		WREG32(INT_MASK + EVERGREEN_CRTC4_REGISTER_OFFSET, 0);
2327 		WREG32(INT_MASK + EVERGREEN_CRTC5_REGISTER_OFFSET, 0);
2328 	}
2329 
2330 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC0_REGISTER_OFFSET, 0);
2331 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC1_REGISTER_OFFSET, 0);
2332 	if (!(rdev->flags & RADEON_IS_IGP)) {
2333 		WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC2_REGISTER_OFFSET, 0);
2334 		WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC3_REGISTER_OFFSET, 0);
2335 		WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC4_REGISTER_OFFSET, 0);
2336 		WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC5_REGISTER_OFFSET, 0);
2337 	}
2338 
2339 	WREG32(DACA_AUTODETECT_INT_CONTROL, 0);
2340 	WREG32(DACB_AUTODETECT_INT_CONTROL, 0);
2341 
2342 	tmp = RREG32(DC_HPD1_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2343 	WREG32(DC_HPD1_INT_CONTROL, tmp);
2344 	tmp = RREG32(DC_HPD2_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2345 	WREG32(DC_HPD2_INT_CONTROL, tmp);
2346 	tmp = RREG32(DC_HPD3_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2347 	WREG32(DC_HPD3_INT_CONTROL, tmp);
2348 	tmp = RREG32(DC_HPD4_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2349 	WREG32(DC_HPD4_INT_CONTROL, tmp);
2350 	tmp = RREG32(DC_HPD5_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2351 	WREG32(DC_HPD5_INT_CONTROL, tmp);
2352 	tmp = RREG32(DC_HPD6_INT_CONTROL) & DC_HPDx_INT_POLARITY;
2353 	WREG32(DC_HPD6_INT_CONTROL, tmp);
2354 
2355 }
2356 
2357 int evergreen_irq_set(struct radeon_device *rdev)
2358 {
2359 	u32 cp_int_cntl = CNTX_BUSY_INT_ENABLE | CNTX_EMPTY_INT_ENABLE;
2360 	u32 crtc1 = 0, crtc2 = 0, crtc3 = 0, crtc4 = 0, crtc5 = 0, crtc6 = 0;
2361 	u32 hpd1, hpd2, hpd3, hpd4, hpd5, hpd6;
2362 	u32 grbm_int_cntl = 0;
2363 	u32 grph1 = 0, grph2 = 0, grph3 = 0, grph4 = 0, grph5 = 0, grph6 = 0;
2364 
2365 	if (!rdev->irq.installed) {
2366 		WARN(1, "Can't enable IRQ/MSI because no handler is installed\n");
2367 		return -EINVAL;
2368 	}
2369 	/* don't enable anything if the ih is disabled */
2370 	if (!rdev->ih.enabled) {
2371 		r600_disable_interrupts(rdev);
2372 		/* force the active interrupt state to all disabled */
2373 		evergreen_disable_interrupt_state(rdev);
2374 		return 0;
2375 	}
2376 
2377 	hpd1 = RREG32(DC_HPD1_INT_CONTROL) & ~DC_HPDx_INT_EN;
2378 	hpd2 = RREG32(DC_HPD2_INT_CONTROL) & ~DC_HPDx_INT_EN;
2379 	hpd3 = RREG32(DC_HPD3_INT_CONTROL) & ~DC_HPDx_INT_EN;
2380 	hpd4 = RREG32(DC_HPD4_INT_CONTROL) & ~DC_HPDx_INT_EN;
2381 	hpd5 = RREG32(DC_HPD5_INT_CONTROL) & ~DC_HPDx_INT_EN;
2382 	hpd6 = RREG32(DC_HPD6_INT_CONTROL) & ~DC_HPDx_INT_EN;
2383 
2384 	if (rdev->irq.sw_int) {
2385 		DRM_DEBUG("evergreen_irq_set: sw int\n");
2386 		cp_int_cntl |= RB_INT_ENABLE;
2387 		cp_int_cntl |= TIME_STAMP_INT_ENABLE;
2388 	}
2389 	if (rdev->irq.crtc_vblank_int[0] ||
2390 	    rdev->irq.pflip[0]) {
2391 		DRM_DEBUG("evergreen_irq_set: vblank 0\n");
2392 		crtc1 |= VBLANK_INT_MASK;
2393 	}
2394 	if (rdev->irq.crtc_vblank_int[1] ||
2395 	    rdev->irq.pflip[1]) {
2396 		DRM_DEBUG("evergreen_irq_set: vblank 1\n");
2397 		crtc2 |= VBLANK_INT_MASK;
2398 	}
2399 	if (rdev->irq.crtc_vblank_int[2] ||
2400 	    rdev->irq.pflip[2]) {
2401 		DRM_DEBUG("evergreen_irq_set: vblank 2\n");
2402 		crtc3 |= VBLANK_INT_MASK;
2403 	}
2404 	if (rdev->irq.crtc_vblank_int[3] ||
2405 	    rdev->irq.pflip[3]) {
2406 		DRM_DEBUG("evergreen_irq_set: vblank 3\n");
2407 		crtc4 |= VBLANK_INT_MASK;
2408 	}
2409 	if (rdev->irq.crtc_vblank_int[4] ||
2410 	    rdev->irq.pflip[4]) {
2411 		DRM_DEBUG("evergreen_irq_set: vblank 4\n");
2412 		crtc5 |= VBLANK_INT_MASK;
2413 	}
2414 	if (rdev->irq.crtc_vblank_int[5] ||
2415 	    rdev->irq.pflip[5]) {
2416 		DRM_DEBUG("evergreen_irq_set: vblank 5\n");
2417 		crtc6 |= VBLANK_INT_MASK;
2418 	}
2419 	if (rdev->irq.hpd[0]) {
2420 		DRM_DEBUG("evergreen_irq_set: hpd 1\n");
2421 		hpd1 |= DC_HPDx_INT_EN;
2422 	}
2423 	if (rdev->irq.hpd[1]) {
2424 		DRM_DEBUG("evergreen_irq_set: hpd 2\n");
2425 		hpd2 |= DC_HPDx_INT_EN;
2426 	}
2427 	if (rdev->irq.hpd[2]) {
2428 		DRM_DEBUG("evergreen_irq_set: hpd 3\n");
2429 		hpd3 |= DC_HPDx_INT_EN;
2430 	}
2431 	if (rdev->irq.hpd[3]) {
2432 		DRM_DEBUG("evergreen_irq_set: hpd 4\n");
2433 		hpd4 |= DC_HPDx_INT_EN;
2434 	}
2435 	if (rdev->irq.hpd[4]) {
2436 		DRM_DEBUG("evergreen_irq_set: hpd 5\n");
2437 		hpd5 |= DC_HPDx_INT_EN;
2438 	}
2439 	if (rdev->irq.hpd[5]) {
2440 		DRM_DEBUG("evergreen_irq_set: hpd 6\n");
2441 		hpd6 |= DC_HPDx_INT_EN;
2442 	}
2443 	if (rdev->irq.gui_idle) {
2444 		DRM_DEBUG("gui idle\n");
2445 		grbm_int_cntl |= GUI_IDLE_INT_ENABLE;
2446 	}
2447 
2448 	WREG32(CP_INT_CNTL, cp_int_cntl);
2449 	WREG32(GRBM_INT_CNTL, grbm_int_cntl);
2450 
2451 	WREG32(INT_MASK + EVERGREEN_CRTC0_REGISTER_OFFSET, crtc1);
2452 	WREG32(INT_MASK + EVERGREEN_CRTC1_REGISTER_OFFSET, crtc2);
2453 	if (!(rdev->flags & RADEON_IS_IGP)) {
2454 		WREG32(INT_MASK + EVERGREEN_CRTC2_REGISTER_OFFSET, crtc3);
2455 		WREG32(INT_MASK + EVERGREEN_CRTC3_REGISTER_OFFSET, crtc4);
2456 		WREG32(INT_MASK + EVERGREEN_CRTC4_REGISTER_OFFSET, crtc5);
2457 		WREG32(INT_MASK + EVERGREEN_CRTC5_REGISTER_OFFSET, crtc6);
2458 	}
2459 
2460 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC0_REGISTER_OFFSET, grph1);
2461 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC1_REGISTER_OFFSET, grph2);
2462 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC2_REGISTER_OFFSET, grph3);
2463 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC3_REGISTER_OFFSET, grph4);
2464 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC4_REGISTER_OFFSET, grph5);
2465 	WREG32(GRPH_INT_CONTROL + EVERGREEN_CRTC5_REGISTER_OFFSET, grph6);
2466 
2467 	WREG32(DC_HPD1_INT_CONTROL, hpd1);
2468 	WREG32(DC_HPD2_INT_CONTROL, hpd2);
2469 	WREG32(DC_HPD3_INT_CONTROL, hpd3);
2470 	WREG32(DC_HPD4_INT_CONTROL, hpd4);
2471 	WREG32(DC_HPD5_INT_CONTROL, hpd5);
2472 	WREG32(DC_HPD6_INT_CONTROL, hpd6);
2473 
2474 	return 0;
2475 }
2476 
2477 static inline void evergreen_irq_ack(struct radeon_device *rdev)
2478 {
2479 	u32 tmp;
2480 
2481 	rdev->irq.stat_regs.evergreen.disp_int = RREG32(DISP_INTERRUPT_STATUS);
2482 	rdev->irq.stat_regs.evergreen.disp_int_cont = RREG32(DISP_INTERRUPT_STATUS_CONTINUE);
2483 	rdev->irq.stat_regs.evergreen.disp_int_cont2 = RREG32(DISP_INTERRUPT_STATUS_CONTINUE2);
2484 	rdev->irq.stat_regs.evergreen.disp_int_cont3 = RREG32(DISP_INTERRUPT_STATUS_CONTINUE3);
2485 	rdev->irq.stat_regs.evergreen.disp_int_cont4 = RREG32(DISP_INTERRUPT_STATUS_CONTINUE4);
2486 	rdev->irq.stat_regs.evergreen.disp_int_cont5 = RREG32(DISP_INTERRUPT_STATUS_CONTINUE5);
2487 	rdev->irq.stat_regs.evergreen.d1grph_int = RREG32(GRPH_INT_STATUS + EVERGREEN_CRTC0_REGISTER_OFFSET);
2488 	rdev->irq.stat_regs.evergreen.d2grph_int = RREG32(GRPH_INT_STATUS + EVERGREEN_CRTC1_REGISTER_OFFSET);
2489 	rdev->irq.stat_regs.evergreen.d3grph_int = RREG32(GRPH_INT_STATUS + EVERGREEN_CRTC2_REGISTER_OFFSET);
2490 	rdev->irq.stat_regs.evergreen.d4grph_int = RREG32(GRPH_INT_STATUS + EVERGREEN_CRTC3_REGISTER_OFFSET);
2491 	rdev->irq.stat_regs.evergreen.d5grph_int = RREG32(GRPH_INT_STATUS + EVERGREEN_CRTC4_REGISTER_OFFSET);
2492 	rdev->irq.stat_regs.evergreen.d6grph_int = RREG32(GRPH_INT_STATUS + EVERGREEN_CRTC5_REGISTER_OFFSET);
2493 
2494 	if (rdev->irq.stat_regs.evergreen.d1grph_int & GRPH_PFLIP_INT_OCCURRED)
2495 		WREG32(GRPH_INT_STATUS + EVERGREEN_CRTC0_REGISTER_OFFSET, GRPH_PFLIP_INT_CLEAR);
2496 	if (rdev->irq.stat_regs.evergreen.d2grph_int & GRPH_PFLIP_INT_OCCURRED)
2497 		WREG32(GRPH_INT_STATUS + EVERGREEN_CRTC1_REGISTER_OFFSET, GRPH_PFLIP_INT_CLEAR);
2498 	if (rdev->irq.stat_regs.evergreen.d3grph_int & GRPH_PFLIP_INT_OCCURRED)
2499 		WREG32(GRPH_INT_STATUS + EVERGREEN_CRTC2_REGISTER_OFFSET, GRPH_PFLIP_INT_CLEAR);
2500 	if (rdev->irq.stat_regs.evergreen.d4grph_int & GRPH_PFLIP_INT_OCCURRED)
2501 		WREG32(GRPH_INT_STATUS + EVERGREEN_CRTC3_REGISTER_OFFSET, GRPH_PFLIP_INT_CLEAR);
2502 	if (rdev->irq.stat_regs.evergreen.d5grph_int & GRPH_PFLIP_INT_OCCURRED)
2503 		WREG32(GRPH_INT_STATUS + EVERGREEN_CRTC4_REGISTER_OFFSET, GRPH_PFLIP_INT_CLEAR);
2504 	if (rdev->irq.stat_regs.evergreen.d6grph_int & GRPH_PFLIP_INT_OCCURRED)
2505 		WREG32(GRPH_INT_STATUS + EVERGREEN_CRTC5_REGISTER_OFFSET, GRPH_PFLIP_INT_CLEAR);
2506 
2507 	if (rdev->irq.stat_regs.evergreen.disp_int & LB_D1_VBLANK_INTERRUPT)
2508 		WREG32(VBLANK_STATUS + EVERGREEN_CRTC0_REGISTER_OFFSET, VBLANK_ACK);
2509 	if (rdev->irq.stat_regs.evergreen.disp_int & LB_D1_VLINE_INTERRUPT)
2510 		WREG32(VLINE_STATUS + EVERGREEN_CRTC0_REGISTER_OFFSET, VLINE_ACK);
2511 
2512 	if (rdev->irq.stat_regs.evergreen.disp_int_cont & LB_D2_VBLANK_INTERRUPT)
2513 		WREG32(VBLANK_STATUS + EVERGREEN_CRTC1_REGISTER_OFFSET, VBLANK_ACK);
2514 	if (rdev->irq.stat_regs.evergreen.disp_int_cont & LB_D2_VLINE_INTERRUPT)
2515 		WREG32(VLINE_STATUS + EVERGREEN_CRTC1_REGISTER_OFFSET, VLINE_ACK);
2516 
2517 	if (rdev->irq.stat_regs.evergreen.disp_int_cont2 & LB_D3_VBLANK_INTERRUPT)
2518 		WREG32(VBLANK_STATUS + EVERGREEN_CRTC2_REGISTER_OFFSET, VBLANK_ACK);
2519 	if (rdev->irq.stat_regs.evergreen.disp_int_cont2 & LB_D3_VLINE_INTERRUPT)
2520 		WREG32(VLINE_STATUS + EVERGREEN_CRTC2_REGISTER_OFFSET, VLINE_ACK);
2521 
2522 	if (rdev->irq.stat_regs.evergreen.disp_int_cont3 & LB_D4_VBLANK_INTERRUPT)
2523 		WREG32(VBLANK_STATUS + EVERGREEN_CRTC3_REGISTER_OFFSET, VBLANK_ACK);
2524 	if (rdev->irq.stat_regs.evergreen.disp_int_cont3 & LB_D4_VLINE_INTERRUPT)
2525 		WREG32(VLINE_STATUS + EVERGREEN_CRTC3_REGISTER_OFFSET, VLINE_ACK);
2526 
2527 	if (rdev->irq.stat_regs.evergreen.disp_int_cont4 & LB_D5_VBLANK_INTERRUPT)
2528 		WREG32(VBLANK_STATUS + EVERGREEN_CRTC4_REGISTER_OFFSET, VBLANK_ACK);
2529 	if (rdev->irq.stat_regs.evergreen.disp_int_cont4 & LB_D5_VLINE_INTERRUPT)
2530 		WREG32(VLINE_STATUS + EVERGREEN_CRTC4_REGISTER_OFFSET, VLINE_ACK);
2531 
2532 	if (rdev->irq.stat_regs.evergreen.disp_int_cont5 & LB_D6_VBLANK_INTERRUPT)
2533 		WREG32(VBLANK_STATUS + EVERGREEN_CRTC5_REGISTER_OFFSET, VBLANK_ACK);
2534 	if (rdev->irq.stat_regs.evergreen.disp_int_cont5 & LB_D6_VLINE_INTERRUPT)
2535 		WREG32(VLINE_STATUS + EVERGREEN_CRTC5_REGISTER_OFFSET, VLINE_ACK);
2536 
2537 	if (rdev->irq.stat_regs.evergreen.disp_int & DC_HPD1_INTERRUPT) {
2538 		tmp = RREG32(DC_HPD1_INT_CONTROL);
2539 		tmp |= DC_HPDx_INT_ACK;
2540 		WREG32(DC_HPD1_INT_CONTROL, tmp);
2541 	}
2542 	if (rdev->irq.stat_regs.evergreen.disp_int_cont & DC_HPD2_INTERRUPT) {
2543 		tmp = RREG32(DC_HPD2_INT_CONTROL);
2544 		tmp |= DC_HPDx_INT_ACK;
2545 		WREG32(DC_HPD2_INT_CONTROL, tmp);
2546 	}
2547 	if (rdev->irq.stat_regs.evergreen.disp_int_cont2 & DC_HPD3_INTERRUPT) {
2548 		tmp = RREG32(DC_HPD3_INT_CONTROL);
2549 		tmp |= DC_HPDx_INT_ACK;
2550 		WREG32(DC_HPD3_INT_CONTROL, tmp);
2551 	}
2552 	if (rdev->irq.stat_regs.evergreen.disp_int_cont3 & DC_HPD4_INTERRUPT) {
2553 		tmp = RREG32(DC_HPD4_INT_CONTROL);
2554 		tmp |= DC_HPDx_INT_ACK;
2555 		WREG32(DC_HPD4_INT_CONTROL, tmp);
2556 	}
2557 	if (rdev->irq.stat_regs.evergreen.disp_int_cont4 & DC_HPD5_INTERRUPT) {
2558 		tmp = RREG32(DC_HPD5_INT_CONTROL);
2559 		tmp |= DC_HPDx_INT_ACK;
2560 		WREG32(DC_HPD5_INT_CONTROL, tmp);
2561 	}
2562 	if (rdev->irq.stat_regs.evergreen.disp_int_cont5 & DC_HPD6_INTERRUPT) {
2563 		tmp = RREG32(DC_HPD5_INT_CONTROL);
2564 		tmp |= DC_HPDx_INT_ACK;
2565 		WREG32(DC_HPD6_INT_CONTROL, tmp);
2566 	}
2567 }
2568 
2569 void evergreen_irq_disable(struct radeon_device *rdev)
2570 {
2571 	r600_disable_interrupts(rdev);
2572 	/* Wait and acknowledge irq */
2573 	mdelay(1);
2574 	evergreen_irq_ack(rdev);
2575 	evergreen_disable_interrupt_state(rdev);
2576 }
2577 
2578 void evergreen_irq_suspend(struct radeon_device *rdev)
2579 {
2580 	evergreen_irq_disable(rdev);
2581 	r600_rlc_stop(rdev);
2582 }
2583 
2584 static inline u32 evergreen_get_ih_wptr(struct radeon_device *rdev)
2585 {
2586 	u32 wptr, tmp;
2587 
2588 	if (rdev->wb.enabled)
2589 		wptr = le32_to_cpu(rdev->wb.wb[R600_WB_IH_WPTR_OFFSET/4]);
2590 	else
2591 		wptr = RREG32(IH_RB_WPTR);
2592 
2593 	if (wptr & RB_OVERFLOW) {
2594 		/* When a ring buffer overflow happen start parsing interrupt
2595 		 * from the last not overwritten vector (wptr + 16). Hopefully
2596 		 * this should allow us to catchup.
2597 		 */
2598 		dev_warn(rdev->dev, "IH ring buffer overflow (0x%08X, %d, %d)\n",
2599 			wptr, rdev->ih.rptr, (wptr + 16) + rdev->ih.ptr_mask);
2600 		rdev->ih.rptr = (wptr + 16) & rdev->ih.ptr_mask;
2601 		tmp = RREG32(IH_RB_CNTL);
2602 		tmp |= IH_WPTR_OVERFLOW_CLEAR;
2603 		WREG32(IH_RB_CNTL, tmp);
2604 	}
2605 	return (wptr & rdev->ih.ptr_mask);
2606 }
2607 
2608 int evergreen_irq_process(struct radeon_device *rdev)
2609 {
2610 	u32 wptr = evergreen_get_ih_wptr(rdev);
2611 	u32 rptr = rdev->ih.rptr;
2612 	u32 src_id, src_data;
2613 	u32 ring_index;
2614 	unsigned long flags;
2615 	bool queue_hotplug = false;
2616 
2617 	DRM_DEBUG("r600_irq_process start: rptr %d, wptr %d\n", rptr, wptr);
2618 	if (!rdev->ih.enabled)
2619 		return IRQ_NONE;
2620 
2621 	spin_lock_irqsave(&rdev->ih.lock, flags);
2622 
2623 	if (rptr == wptr) {
2624 		spin_unlock_irqrestore(&rdev->ih.lock, flags);
2625 		return IRQ_NONE;
2626 	}
2627 	if (rdev->shutdown) {
2628 		spin_unlock_irqrestore(&rdev->ih.lock, flags);
2629 		return IRQ_NONE;
2630 	}
2631 
2632 restart_ih:
2633 	/* display interrupts */
2634 	evergreen_irq_ack(rdev);
2635 
2636 	rdev->ih.wptr = wptr;
2637 	while (rptr != wptr) {
2638 		/* wptr/rptr are in bytes! */
2639 		ring_index = rptr / 4;
2640 		src_id =  le32_to_cpu(rdev->ih.ring[ring_index]) & 0xff;
2641 		src_data = le32_to_cpu(rdev->ih.ring[ring_index + 1]) & 0xfffffff;
2642 
2643 		switch (src_id) {
2644 		case 1: /* D1 vblank/vline */
2645 			switch (src_data) {
2646 			case 0: /* D1 vblank */
2647 				if (rdev->irq.stat_regs.evergreen.disp_int & LB_D1_VBLANK_INTERRUPT) {
2648 					if (rdev->irq.crtc_vblank_int[0]) {
2649 						drm_handle_vblank(rdev->ddev, 0);
2650 						rdev->pm.vblank_sync = true;
2651 						wake_up(&rdev->irq.vblank_queue);
2652 					}
2653 					if (rdev->irq.pflip[0])
2654 						radeon_crtc_handle_flip(rdev, 0);
2655 					rdev->irq.stat_regs.evergreen.disp_int &= ~LB_D1_VBLANK_INTERRUPT;
2656 					DRM_DEBUG("IH: D1 vblank\n");
2657 				}
2658 				break;
2659 			case 1: /* D1 vline */
2660 				if (rdev->irq.stat_regs.evergreen.disp_int & LB_D1_VLINE_INTERRUPT) {
2661 					rdev->irq.stat_regs.evergreen.disp_int &= ~LB_D1_VLINE_INTERRUPT;
2662 					DRM_DEBUG("IH: D1 vline\n");
2663 				}
2664 				break;
2665 			default:
2666 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2667 				break;
2668 			}
2669 			break;
2670 		case 2: /* D2 vblank/vline */
2671 			switch (src_data) {
2672 			case 0: /* D2 vblank */
2673 				if (rdev->irq.stat_regs.evergreen.disp_int_cont & LB_D2_VBLANK_INTERRUPT) {
2674 					if (rdev->irq.crtc_vblank_int[1]) {
2675 						drm_handle_vblank(rdev->ddev, 1);
2676 						rdev->pm.vblank_sync = true;
2677 						wake_up(&rdev->irq.vblank_queue);
2678 					}
2679 					if (rdev->irq.pflip[1])
2680 						radeon_crtc_handle_flip(rdev, 1);
2681 					rdev->irq.stat_regs.evergreen.disp_int_cont &= ~LB_D2_VBLANK_INTERRUPT;
2682 					DRM_DEBUG("IH: D2 vblank\n");
2683 				}
2684 				break;
2685 			case 1: /* D2 vline */
2686 				if (rdev->irq.stat_regs.evergreen.disp_int_cont & LB_D2_VLINE_INTERRUPT) {
2687 					rdev->irq.stat_regs.evergreen.disp_int_cont &= ~LB_D2_VLINE_INTERRUPT;
2688 					DRM_DEBUG("IH: D2 vline\n");
2689 				}
2690 				break;
2691 			default:
2692 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2693 				break;
2694 			}
2695 			break;
2696 		case 3: /* D3 vblank/vline */
2697 			switch (src_data) {
2698 			case 0: /* D3 vblank */
2699 				if (rdev->irq.stat_regs.evergreen.disp_int_cont2 & LB_D3_VBLANK_INTERRUPT) {
2700 					if (rdev->irq.crtc_vblank_int[2]) {
2701 						drm_handle_vblank(rdev->ddev, 2);
2702 						rdev->pm.vblank_sync = true;
2703 						wake_up(&rdev->irq.vblank_queue);
2704 					}
2705 					if (rdev->irq.pflip[2])
2706 						radeon_crtc_handle_flip(rdev, 2);
2707 					rdev->irq.stat_regs.evergreen.disp_int_cont2 &= ~LB_D3_VBLANK_INTERRUPT;
2708 					DRM_DEBUG("IH: D3 vblank\n");
2709 				}
2710 				break;
2711 			case 1: /* D3 vline */
2712 				if (rdev->irq.stat_regs.evergreen.disp_int_cont2 & LB_D3_VLINE_INTERRUPT) {
2713 					rdev->irq.stat_regs.evergreen.disp_int_cont2 &= ~LB_D3_VLINE_INTERRUPT;
2714 					DRM_DEBUG("IH: D3 vline\n");
2715 				}
2716 				break;
2717 			default:
2718 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2719 				break;
2720 			}
2721 			break;
2722 		case 4: /* D4 vblank/vline */
2723 			switch (src_data) {
2724 			case 0: /* D4 vblank */
2725 				if (rdev->irq.stat_regs.evergreen.disp_int_cont3 & LB_D4_VBLANK_INTERRUPT) {
2726 					if (rdev->irq.crtc_vblank_int[3]) {
2727 						drm_handle_vblank(rdev->ddev, 3);
2728 						rdev->pm.vblank_sync = true;
2729 						wake_up(&rdev->irq.vblank_queue);
2730 					}
2731 					if (rdev->irq.pflip[3])
2732 						radeon_crtc_handle_flip(rdev, 3);
2733 					rdev->irq.stat_regs.evergreen.disp_int_cont3 &= ~LB_D4_VBLANK_INTERRUPT;
2734 					DRM_DEBUG("IH: D4 vblank\n");
2735 				}
2736 				break;
2737 			case 1: /* D4 vline */
2738 				if (rdev->irq.stat_regs.evergreen.disp_int_cont3 & LB_D4_VLINE_INTERRUPT) {
2739 					rdev->irq.stat_regs.evergreen.disp_int_cont3 &= ~LB_D4_VLINE_INTERRUPT;
2740 					DRM_DEBUG("IH: D4 vline\n");
2741 				}
2742 				break;
2743 			default:
2744 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2745 				break;
2746 			}
2747 			break;
2748 		case 5: /* D5 vblank/vline */
2749 			switch (src_data) {
2750 			case 0: /* D5 vblank */
2751 				if (rdev->irq.stat_regs.evergreen.disp_int_cont4 & LB_D5_VBLANK_INTERRUPT) {
2752 					if (rdev->irq.crtc_vblank_int[4]) {
2753 						drm_handle_vblank(rdev->ddev, 4);
2754 						rdev->pm.vblank_sync = true;
2755 						wake_up(&rdev->irq.vblank_queue);
2756 					}
2757 					if (rdev->irq.pflip[4])
2758 						radeon_crtc_handle_flip(rdev, 4);
2759 					rdev->irq.stat_regs.evergreen.disp_int_cont4 &= ~LB_D5_VBLANK_INTERRUPT;
2760 					DRM_DEBUG("IH: D5 vblank\n");
2761 				}
2762 				break;
2763 			case 1: /* D5 vline */
2764 				if (rdev->irq.stat_regs.evergreen.disp_int_cont4 & LB_D5_VLINE_INTERRUPT) {
2765 					rdev->irq.stat_regs.evergreen.disp_int_cont4 &= ~LB_D5_VLINE_INTERRUPT;
2766 					DRM_DEBUG("IH: D5 vline\n");
2767 				}
2768 				break;
2769 			default:
2770 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2771 				break;
2772 			}
2773 			break;
2774 		case 6: /* D6 vblank/vline */
2775 			switch (src_data) {
2776 			case 0: /* D6 vblank */
2777 				if (rdev->irq.stat_regs.evergreen.disp_int_cont5 & LB_D6_VBLANK_INTERRUPT) {
2778 					if (rdev->irq.crtc_vblank_int[5]) {
2779 						drm_handle_vblank(rdev->ddev, 5);
2780 						rdev->pm.vblank_sync = true;
2781 						wake_up(&rdev->irq.vblank_queue);
2782 					}
2783 					if (rdev->irq.pflip[5])
2784 						radeon_crtc_handle_flip(rdev, 5);
2785 					rdev->irq.stat_regs.evergreen.disp_int_cont5 &= ~LB_D6_VBLANK_INTERRUPT;
2786 					DRM_DEBUG("IH: D6 vblank\n");
2787 				}
2788 				break;
2789 			case 1: /* D6 vline */
2790 				if (rdev->irq.stat_regs.evergreen.disp_int_cont5 & LB_D6_VLINE_INTERRUPT) {
2791 					rdev->irq.stat_regs.evergreen.disp_int_cont5 &= ~LB_D6_VLINE_INTERRUPT;
2792 					DRM_DEBUG("IH: D6 vline\n");
2793 				}
2794 				break;
2795 			default:
2796 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2797 				break;
2798 			}
2799 			break;
2800 		case 42: /* HPD hotplug */
2801 			switch (src_data) {
2802 			case 0:
2803 				if (rdev->irq.stat_regs.evergreen.disp_int & DC_HPD1_INTERRUPT) {
2804 					rdev->irq.stat_regs.evergreen.disp_int &= ~DC_HPD1_INTERRUPT;
2805 					queue_hotplug = true;
2806 					DRM_DEBUG("IH: HPD1\n");
2807 				}
2808 				break;
2809 			case 1:
2810 				if (rdev->irq.stat_regs.evergreen.disp_int_cont & DC_HPD2_INTERRUPT) {
2811 					rdev->irq.stat_regs.evergreen.disp_int_cont &= ~DC_HPD2_INTERRUPT;
2812 					queue_hotplug = true;
2813 					DRM_DEBUG("IH: HPD2\n");
2814 				}
2815 				break;
2816 			case 2:
2817 				if (rdev->irq.stat_regs.evergreen.disp_int_cont2 & DC_HPD3_INTERRUPT) {
2818 					rdev->irq.stat_regs.evergreen.disp_int_cont2 &= ~DC_HPD3_INTERRUPT;
2819 					queue_hotplug = true;
2820 					DRM_DEBUG("IH: HPD3\n");
2821 				}
2822 				break;
2823 			case 3:
2824 				if (rdev->irq.stat_regs.evergreen.disp_int_cont3 & DC_HPD4_INTERRUPT) {
2825 					rdev->irq.stat_regs.evergreen.disp_int_cont3 &= ~DC_HPD4_INTERRUPT;
2826 					queue_hotplug = true;
2827 					DRM_DEBUG("IH: HPD4\n");
2828 				}
2829 				break;
2830 			case 4:
2831 				if (rdev->irq.stat_regs.evergreen.disp_int_cont4 & DC_HPD5_INTERRUPT) {
2832 					rdev->irq.stat_regs.evergreen.disp_int_cont4 &= ~DC_HPD5_INTERRUPT;
2833 					queue_hotplug = true;
2834 					DRM_DEBUG("IH: HPD5\n");
2835 				}
2836 				break;
2837 			case 5:
2838 				if (rdev->irq.stat_regs.evergreen.disp_int_cont5 & DC_HPD6_INTERRUPT) {
2839 					rdev->irq.stat_regs.evergreen.disp_int_cont5 &= ~DC_HPD6_INTERRUPT;
2840 					queue_hotplug = true;
2841 					DRM_DEBUG("IH: HPD6\n");
2842 				}
2843 				break;
2844 			default:
2845 				DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2846 				break;
2847 			}
2848 			break;
2849 		case 176: /* CP_INT in ring buffer */
2850 		case 177: /* CP_INT in IB1 */
2851 		case 178: /* CP_INT in IB2 */
2852 			DRM_DEBUG("IH: CP int: 0x%08x\n", src_data);
2853 			radeon_fence_process(rdev);
2854 			break;
2855 		case 181: /* CP EOP event */
2856 			DRM_DEBUG("IH: CP EOP\n");
2857 			radeon_fence_process(rdev);
2858 			break;
2859 		case 233: /* GUI IDLE */
2860 			DRM_DEBUG("IH: CP EOP\n");
2861 			rdev->pm.gui_idle = true;
2862 			wake_up(&rdev->irq.idle_queue);
2863 			break;
2864 		default:
2865 			DRM_DEBUG("Unhandled interrupt: %d %d\n", src_id, src_data);
2866 			break;
2867 		}
2868 
2869 		/* wptr/rptr are in bytes! */
2870 		rptr += 16;
2871 		rptr &= rdev->ih.ptr_mask;
2872 	}
2873 	/* make sure wptr hasn't changed while processing */
2874 	wptr = evergreen_get_ih_wptr(rdev);
2875 	if (wptr != rdev->ih.wptr)
2876 		goto restart_ih;
2877 	if (queue_hotplug)
2878 		schedule_work(&rdev->hotplug_work);
2879 	rdev->ih.rptr = rptr;
2880 	WREG32(IH_RB_RPTR, rdev->ih.rptr);
2881 	spin_unlock_irqrestore(&rdev->ih.lock, flags);
2882 	return IRQ_HANDLED;
2883 }
2884 
2885 static int evergreen_startup(struct radeon_device *rdev)
2886 {
2887 	int r;
2888 
2889 	/* enable pcie gen2 link */
2890 	if (!ASIC_IS_DCE5(rdev))
2891 		evergreen_pcie_gen2_enable(rdev);
2892 
2893 	if (ASIC_IS_DCE5(rdev)) {
2894 		if (!rdev->me_fw || !rdev->pfp_fw || !rdev->rlc_fw || !rdev->mc_fw) {
2895 			r = ni_init_microcode(rdev);
2896 			if (r) {
2897 				DRM_ERROR("Failed to load firmware!\n");
2898 				return r;
2899 			}
2900 		}
2901 		r = ni_mc_load_microcode(rdev);
2902 		if (r) {
2903 			DRM_ERROR("Failed to load MC firmware!\n");
2904 			return r;
2905 		}
2906 	} else {
2907 		if (!rdev->me_fw || !rdev->pfp_fw || !rdev->rlc_fw) {
2908 			r = r600_init_microcode(rdev);
2909 			if (r) {
2910 				DRM_ERROR("Failed to load firmware!\n");
2911 				return r;
2912 			}
2913 		}
2914 	}
2915 
2916 	evergreen_mc_program(rdev);
2917 	if (rdev->flags & RADEON_IS_AGP) {
2918 		evergreen_agp_enable(rdev);
2919 	} else {
2920 		r = evergreen_pcie_gart_enable(rdev);
2921 		if (r)
2922 			return r;
2923 	}
2924 	evergreen_gpu_init(rdev);
2925 
2926 	r = evergreen_blit_init(rdev);
2927 	if (r) {
2928 		evergreen_blit_fini(rdev);
2929 		rdev->asic->copy = NULL;
2930 		dev_warn(rdev->dev, "failed blitter (%d) falling back to memcpy\n", r);
2931 	}
2932 
2933 	/* allocate wb buffer */
2934 	r = radeon_wb_init(rdev);
2935 	if (r)
2936 		return r;
2937 
2938 	/* Enable IRQ */
2939 	r = r600_irq_init(rdev);
2940 	if (r) {
2941 		DRM_ERROR("radeon: IH init failed (%d).\n", r);
2942 		radeon_irq_kms_fini(rdev);
2943 		return r;
2944 	}
2945 	evergreen_irq_set(rdev);
2946 
2947 	r = radeon_ring_init(rdev, rdev->cp.ring_size);
2948 	if (r)
2949 		return r;
2950 	r = evergreen_cp_load_microcode(rdev);
2951 	if (r)
2952 		return r;
2953 	r = evergreen_cp_resume(rdev);
2954 	if (r)
2955 		return r;
2956 
2957 	return 0;
2958 }
2959 
2960 int evergreen_resume(struct radeon_device *rdev)
2961 {
2962 	int r;
2963 
2964 	/* reset the asic, the gfx blocks are often in a bad state
2965 	 * after the driver is unloaded or after a resume
2966 	 */
2967 	if (radeon_asic_reset(rdev))
2968 		dev_warn(rdev->dev, "GPU reset failed !\n");
2969 	/* Do not reset GPU before posting, on rv770 hw unlike on r500 hw,
2970 	 * posting will perform necessary task to bring back GPU into good
2971 	 * shape.
2972 	 */
2973 	/* post card */
2974 	atom_asic_init(rdev->mode_info.atom_context);
2975 
2976 	r = evergreen_startup(rdev);
2977 	if (r) {
2978 		DRM_ERROR("evergreen startup failed on resume\n");
2979 		return r;
2980 	}
2981 
2982 	r = r600_ib_test(rdev);
2983 	if (r) {
2984 		DRM_ERROR("radeon: failed testing IB (%d).\n", r);
2985 		return r;
2986 	}
2987 
2988 	return r;
2989 
2990 }
2991 
2992 int evergreen_suspend(struct radeon_device *rdev)
2993 {
2994 	int r;
2995 
2996 	/* FIXME: we should wait for ring to be empty */
2997 	r700_cp_stop(rdev);
2998 	rdev->cp.ready = false;
2999 	evergreen_irq_suspend(rdev);
3000 	radeon_wb_disable(rdev);
3001 	evergreen_pcie_gart_disable(rdev);
3002 
3003 	/* unpin shaders bo */
3004 	r = radeon_bo_reserve(rdev->r600_blit.shader_obj, false);
3005 	if (likely(r == 0)) {
3006 		radeon_bo_unpin(rdev->r600_blit.shader_obj);
3007 		radeon_bo_unreserve(rdev->r600_blit.shader_obj);
3008 	}
3009 
3010 	return 0;
3011 }
3012 
3013 int evergreen_copy_blit(struct radeon_device *rdev,
3014 			uint64_t src_offset, uint64_t dst_offset,
3015 			unsigned num_pages, struct radeon_fence *fence)
3016 {
3017 	int r;
3018 
3019 	mutex_lock(&rdev->r600_blit.mutex);
3020 	rdev->r600_blit.vb_ib = NULL;
3021 	r = evergreen_blit_prepare_copy(rdev, num_pages * RADEON_GPU_PAGE_SIZE);
3022 	if (r) {
3023 		if (rdev->r600_blit.vb_ib)
3024 			radeon_ib_free(rdev, &rdev->r600_blit.vb_ib);
3025 		mutex_unlock(&rdev->r600_blit.mutex);
3026 		return r;
3027 	}
3028 	evergreen_kms_blit_copy(rdev, src_offset, dst_offset, num_pages * RADEON_GPU_PAGE_SIZE);
3029 	evergreen_blit_done_copy(rdev, fence);
3030 	mutex_unlock(&rdev->r600_blit.mutex);
3031 	return 0;
3032 }
3033 
3034 /* Plan is to move initialization in that function and use
3035  * helper function so that radeon_device_init pretty much
3036  * do nothing more than calling asic specific function. This
3037  * should also allow to remove a bunch of callback function
3038  * like vram_info.
3039  */
3040 int evergreen_init(struct radeon_device *rdev)
3041 {
3042 	int r;
3043 
3044 	/* This don't do much */
3045 	r = radeon_gem_init(rdev);
3046 	if (r)
3047 		return r;
3048 	/* Read BIOS */
3049 	if (!radeon_get_bios(rdev)) {
3050 		if (ASIC_IS_AVIVO(rdev))
3051 			return -EINVAL;
3052 	}
3053 	/* Must be an ATOMBIOS */
3054 	if (!rdev->is_atom_bios) {
3055 		dev_err(rdev->dev, "Expecting atombios for evergreen GPU\n");
3056 		return -EINVAL;
3057 	}
3058 	r = radeon_atombios_init(rdev);
3059 	if (r)
3060 		return r;
3061 	/* reset the asic, the gfx blocks are often in a bad state
3062 	 * after the driver is unloaded or after a resume
3063 	 */
3064 	if (radeon_asic_reset(rdev))
3065 		dev_warn(rdev->dev, "GPU reset failed !\n");
3066 	/* Post card if necessary */
3067 	if (!radeon_card_posted(rdev)) {
3068 		if (!rdev->bios) {
3069 			dev_err(rdev->dev, "Card not posted and no BIOS - ignoring\n");
3070 			return -EINVAL;
3071 		}
3072 		DRM_INFO("GPU not posted. posting now...\n");
3073 		atom_asic_init(rdev->mode_info.atom_context);
3074 	}
3075 	/* Initialize scratch registers */
3076 	r600_scratch_init(rdev);
3077 	/* Initialize surface registers */
3078 	radeon_surface_init(rdev);
3079 	/* Initialize clocks */
3080 	radeon_get_clock_info(rdev->ddev);
3081 	/* Fence driver */
3082 	r = radeon_fence_driver_init(rdev);
3083 	if (r)
3084 		return r;
3085 	/* initialize AGP */
3086 	if (rdev->flags & RADEON_IS_AGP) {
3087 		r = radeon_agp_init(rdev);
3088 		if (r)
3089 			radeon_agp_disable(rdev);
3090 	}
3091 	/* initialize memory controller */
3092 	r = evergreen_mc_init(rdev);
3093 	if (r)
3094 		return r;
3095 	/* Memory manager */
3096 	r = radeon_bo_init(rdev);
3097 	if (r)
3098 		return r;
3099 
3100 	r = radeon_irq_kms_init(rdev);
3101 	if (r)
3102 		return r;
3103 
3104 	rdev->cp.ring_obj = NULL;
3105 	r600_ring_init(rdev, 1024 * 1024);
3106 
3107 	rdev->ih.ring_obj = NULL;
3108 	r600_ih_ring_init(rdev, 64 * 1024);
3109 
3110 	r = r600_pcie_gart_init(rdev);
3111 	if (r)
3112 		return r;
3113 
3114 	rdev->accel_working = true;
3115 	r = evergreen_startup(rdev);
3116 	if (r) {
3117 		dev_err(rdev->dev, "disabling GPU acceleration\n");
3118 		r700_cp_fini(rdev);
3119 		r600_irq_fini(rdev);
3120 		radeon_wb_fini(rdev);
3121 		radeon_irq_kms_fini(rdev);
3122 		evergreen_pcie_gart_fini(rdev);
3123 		rdev->accel_working = false;
3124 	}
3125 	if (rdev->accel_working) {
3126 		r = radeon_ib_pool_init(rdev);
3127 		if (r) {
3128 			DRM_ERROR("radeon: failed initializing IB pool (%d).\n", r);
3129 			rdev->accel_working = false;
3130 		}
3131 		r = r600_ib_test(rdev);
3132 		if (r) {
3133 			DRM_ERROR("radeon: failed testing IB (%d).\n", r);
3134 			rdev->accel_working = false;
3135 		}
3136 	}
3137 	return 0;
3138 }
3139 
3140 void evergreen_fini(struct radeon_device *rdev)
3141 {
3142 	evergreen_blit_fini(rdev);
3143 	r700_cp_fini(rdev);
3144 	r600_irq_fini(rdev);
3145 	radeon_wb_fini(rdev);
3146 	radeon_irq_kms_fini(rdev);
3147 	evergreen_pcie_gart_fini(rdev);
3148 	radeon_gem_fini(rdev);
3149 	radeon_fence_driver_fini(rdev);
3150 	radeon_agp_fini(rdev);
3151 	radeon_bo_fini(rdev);
3152 	radeon_atombios_fini(rdev);
3153 	kfree(rdev->bios);
3154 	rdev->bios = NULL;
3155 }
3156 
3157 static void evergreen_pcie_gen2_enable(struct radeon_device *rdev)
3158 {
3159 	u32 link_width_cntl, speed_cntl;
3160 
3161 	if (radeon_pcie_gen2 == 0)
3162 		return;
3163 
3164 	if (rdev->flags & RADEON_IS_IGP)
3165 		return;
3166 
3167 	if (!(rdev->flags & RADEON_IS_PCIE))
3168 		return;
3169 
3170 	/* x2 cards have a special sequence */
3171 	if (ASIC_IS_X2(rdev))
3172 		return;
3173 
3174 	speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3175 	if ((speed_cntl & LC_OTHER_SIDE_EVER_SENT_GEN2) ||
3176 	    (speed_cntl & LC_OTHER_SIDE_SUPPORTS_GEN2)) {
3177 
3178 		link_width_cntl = RREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL);
3179 		link_width_cntl &= ~LC_UPCONFIGURE_DIS;
3180 		WREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL, link_width_cntl);
3181 
3182 		speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3183 		speed_cntl &= ~LC_TARGET_LINK_SPEED_OVERRIDE_EN;
3184 		WREG32_PCIE_P(PCIE_LC_SPEED_CNTL, speed_cntl);
3185 
3186 		speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3187 		speed_cntl |= LC_CLR_FAILED_SPD_CHANGE_CNT;
3188 		WREG32_PCIE_P(PCIE_LC_SPEED_CNTL, speed_cntl);
3189 
3190 		speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3191 		speed_cntl &= ~LC_CLR_FAILED_SPD_CHANGE_CNT;
3192 		WREG32_PCIE_P(PCIE_LC_SPEED_CNTL, speed_cntl);
3193 
3194 		speed_cntl = RREG32_PCIE_P(PCIE_LC_SPEED_CNTL);
3195 		speed_cntl |= LC_GEN2_EN_STRAP;
3196 		WREG32_PCIE_P(PCIE_LC_SPEED_CNTL, speed_cntl);
3197 
3198 	} else {
3199 		link_width_cntl = RREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL);
3200 		/* XXX: only disable it if gen1 bridge vendor == 0x111d or 0x1106 */
3201 		if (1)
3202 			link_width_cntl |= LC_UPCONFIGURE_DIS;
3203 		else
3204 			link_width_cntl &= ~LC_UPCONFIGURE_DIS;
3205 		WREG32_PCIE_P(PCIE_LC_LINK_WIDTH_CNTL, link_width_cntl);
3206 	}
3207 }
3208