1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  *	drivers/video/aty/radeon_pm.c
4  *
5  *	Copyright 2003,2004 Ben. Herrenschmidt <benh@kernel.crashing.org>
6  *	Copyright 2004 Paul Mackerras <paulus@samba.org>
7  *
8  *	This is the power management code for ATI radeon chipsets. It contains
9  *	some dynamic clock PM enable/disable code similar to what X.org does,
10  *	some D2-state (APM-style) sleep/wakeup code for use on some PowerMacs,
11  *	and the necessary bits to re-initialize from scratch a few chips found
12  *	on PowerMacs as well. The later could be extended to more platforms
13  *	provided the memory controller configuration code be made more generic,
14  *	and you can get the proper mode register commands for your RAMs.
15  *	Those things may be found in the BIOS image...
16  */
17 
18 #include "radeonfb.h"
19 
20 #include <linux/console.h>
21 #include <linux/agp_backend.h>
22 
23 #ifdef CONFIG_PPC_PMAC
24 #include <asm/machdep.h>
25 #include <asm/prom.h>
26 #include <asm/pmac_feature.h>
27 #endif
28 
29 #include "ati_ids.h"
30 
31 /*
32  * Workarounds for bugs in PC laptops:
33  * - enable D2 sleep in some IBM Thinkpads
34  * - special case for Samsung P35
35  *
36  * Whitelist by subsystem vendor/device because
37  * its the subsystem vendor's fault!
38  */
39 
40 #if defined(CONFIG_PM) && defined(CONFIG_X86)
41 static void radeon_reinitialize_M10(struct radeonfb_info *rinfo);
42 
43 struct radeon_device_id {
44         const char *ident;                     /* (arbitrary) Name */
45         const unsigned short subsystem_vendor; /* Subsystem Vendor ID */
46         const unsigned short subsystem_device; /* Subsystem Device ID */
47 	const enum radeon_pm_mode pm_mode_modifier; /* modify pm_mode */
48 	const reinit_function_ptr new_reinit_func;   /* changed reinit_func */
49 };
50 
51 #define BUGFIX(model, sv, sd, pm, fn) { \
52 	.ident = model, \
53 	.subsystem_vendor = sv, \
54 	.subsystem_device = sd, \
55 	.pm_mode_modifier = pm, \
56 	.new_reinit_func  = fn  \
57 }
58 
59 static struct radeon_device_id radeon_workaround_list[] = {
60 	BUGFIX("IBM Thinkpad R32",
61 	       PCI_VENDOR_ID_IBM, 0x1905,
62 	       radeon_pm_d2, NULL),
63 	BUGFIX("IBM Thinkpad R40",
64 	       PCI_VENDOR_ID_IBM, 0x0526,
65 	       radeon_pm_d2, NULL),
66 	BUGFIX("IBM Thinkpad R40",
67 	       PCI_VENDOR_ID_IBM, 0x0527,
68 	       radeon_pm_d2, NULL),
69 	BUGFIX("IBM Thinkpad R50/R51/T40/T41",
70 	       PCI_VENDOR_ID_IBM, 0x0531,
71 	       radeon_pm_d2, NULL),
72 	BUGFIX("IBM Thinkpad R51/T40/T41/T42",
73 	       PCI_VENDOR_ID_IBM, 0x0530,
74 	       radeon_pm_d2, NULL),
75 	BUGFIX("IBM Thinkpad T30",
76 	       PCI_VENDOR_ID_IBM, 0x0517,
77 	       radeon_pm_d2, NULL),
78 	BUGFIX("IBM Thinkpad T40p",
79 	       PCI_VENDOR_ID_IBM, 0x054d,
80 	       radeon_pm_d2, NULL),
81 	BUGFIX("IBM Thinkpad T42",
82 	       PCI_VENDOR_ID_IBM, 0x0550,
83 	       radeon_pm_d2, NULL),
84 	BUGFIX("IBM Thinkpad X31/X32",
85 	       PCI_VENDOR_ID_IBM, 0x052f,
86 	       radeon_pm_d2, NULL),
87 	BUGFIX("Samsung P35",
88 	       PCI_VENDOR_ID_SAMSUNG, 0xc00c,
89 	       radeon_pm_off, radeon_reinitialize_M10),
90 	BUGFIX("Acer Aspire 2010",
91 	       PCI_VENDOR_ID_AI, 0x0061,
92 	       radeon_pm_off, radeon_reinitialize_M10),
93 	BUGFIX("Acer Travelmate 290D/292LMi",
94 	       PCI_VENDOR_ID_AI, 0x005a,
95 	       radeon_pm_off, radeon_reinitialize_M10),
96 	{ .ident = NULL }
97 };
98 
99 static int radeon_apply_workarounds(struct radeonfb_info *rinfo)
100 {
101 	struct radeon_device_id *id;
102 
103 	for (id = radeon_workaround_list; id->ident != NULL; id++ )
104 		if ((id->subsystem_vendor == rinfo->pdev->subsystem_vendor ) &&
105 		    (id->subsystem_device == rinfo->pdev->subsystem_device )) {
106 
107 			/* we found a device that requires workaround */
108 			printk(KERN_DEBUG "radeonfb: %s detected"
109 			       ", enabling workaround\n", id->ident);
110 
111 			rinfo->pm_mode |= id->pm_mode_modifier;
112 
113 			if (id->new_reinit_func != NULL)
114 				rinfo->reinit_func = id->new_reinit_func;
115 
116 			return 1;
117 		}
118 	return 0;  /* not found */
119 }
120 
121 #else  /* defined(CONFIG_PM) && defined(CONFIG_X86) */
122 static inline int radeon_apply_workarounds(struct radeonfb_info *rinfo)
123 {
124         return 0;
125 }
126 #endif /* defined(CONFIG_PM) && defined(CONFIG_X86) */
127 
128 
129 
130 static void radeon_pm_disable_dynamic_mode(struct radeonfb_info *rinfo)
131 {
132 	u32 tmp;
133 
134 	/* RV100 */
135 	if ((rinfo->family == CHIP_FAMILY_RV100) && (!rinfo->is_mobility)) {
136 		if (rinfo->has_CRTC2) {
137 			tmp = INPLL(pllSCLK_CNTL);
138 			tmp &= ~SCLK_CNTL__DYN_STOP_LAT_MASK;
139 			tmp |= SCLK_CNTL__CP_MAX_DYN_STOP_LAT | SCLK_CNTL__FORCEON_MASK;
140 			OUTPLL(pllSCLK_CNTL, tmp);
141 		}
142 		tmp = INPLL(pllMCLK_CNTL);
143 		tmp |= (MCLK_CNTL__FORCE_MCLKA |
144 		        MCLK_CNTL__FORCE_MCLKB |
145 		        MCLK_CNTL__FORCE_YCLKA |
146 		        MCLK_CNTL__FORCE_YCLKB |
147 			MCLK_CNTL__FORCE_AIC |
148 			MCLK_CNTL__FORCE_MC);
149                 OUTPLL(pllMCLK_CNTL, tmp);
150 		return;
151 	}
152 	/* R100 */
153 	if (!rinfo->has_CRTC2) {
154                 tmp = INPLL(pllSCLK_CNTL);
155                 tmp |= (SCLK_CNTL__FORCE_CP	| SCLK_CNTL__FORCE_HDP	|
156 			SCLK_CNTL__FORCE_DISP1	| SCLK_CNTL__FORCE_TOP	|
157                         SCLK_CNTL__FORCE_E2	| SCLK_CNTL__FORCE_SE 	|
158 			SCLK_CNTL__FORCE_IDCT	| SCLK_CNTL__FORCE_VIP	|
159 			SCLK_CNTL__FORCE_RE	| SCLK_CNTL__FORCE_PB 	|
160 			SCLK_CNTL__FORCE_TAM	| SCLK_CNTL__FORCE_TDM	|
161                         SCLK_CNTL__FORCE_RB);
162                 OUTPLL(pllSCLK_CNTL, tmp);
163 		return;
164 	}
165 	/* RV350 (M10/M11) */
166 	if (rinfo->family == CHIP_FAMILY_RV350) {
167                 /* for RV350/M10/M11, no delays are required. */
168                 tmp = INPLL(pllSCLK_CNTL2);
169                 tmp |= (SCLK_CNTL2__R300_FORCE_TCL |
170                         SCLK_CNTL2__R300_FORCE_GA  |
171 			SCLK_CNTL2__R300_FORCE_CBA);
172                 OUTPLL(pllSCLK_CNTL2, tmp);
173 
174                 tmp = INPLL(pllSCLK_CNTL);
175                 tmp |= (SCLK_CNTL__FORCE_DISP2		| SCLK_CNTL__FORCE_CP		|
176                         SCLK_CNTL__FORCE_HDP		| SCLK_CNTL__FORCE_DISP1	|
177                         SCLK_CNTL__FORCE_TOP		| SCLK_CNTL__FORCE_E2		|
178                         SCLK_CNTL__R300_FORCE_VAP	| SCLK_CNTL__FORCE_IDCT    	|
179 			SCLK_CNTL__FORCE_VIP		| SCLK_CNTL__R300_FORCE_SR	|
180 			SCLK_CNTL__R300_FORCE_PX	| SCLK_CNTL__R300_FORCE_TX	|
181 			SCLK_CNTL__R300_FORCE_US	| SCLK_CNTL__FORCE_TV_SCLK	|
182                         SCLK_CNTL__R300_FORCE_SU	| SCLK_CNTL__FORCE_OV0);
183                 OUTPLL(pllSCLK_CNTL, tmp);
184 
185                 tmp = INPLL(pllSCLK_MORE_CNTL);
186 		tmp |= (SCLK_MORE_CNTL__FORCE_DISPREGS	| SCLK_MORE_CNTL__FORCE_MC_GUI	|
187 			SCLK_MORE_CNTL__FORCE_MC_HOST);
188                 OUTPLL(pllSCLK_MORE_CNTL, tmp);
189 
190 		tmp = INPLL(pllMCLK_CNTL);
191 		tmp |= (MCLK_CNTL__FORCE_MCLKA |
192 		        MCLK_CNTL__FORCE_MCLKB |
193 		        MCLK_CNTL__FORCE_YCLKA |
194 		        MCLK_CNTL__FORCE_YCLKB |
195 			MCLK_CNTL__FORCE_MC);
196                 OUTPLL(pllMCLK_CNTL, tmp);
197 
198                 tmp = INPLL(pllVCLK_ECP_CNTL);
199                 tmp &= ~(VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb  |
200                          VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb |
201 			 VCLK_ECP_CNTL__R300_DISP_DAC_PIXCLK_DAC_BLANK_OFF);
202                 OUTPLL(pllVCLK_ECP_CNTL, tmp);
203 
204                 tmp = INPLL(pllPIXCLKS_CNTL);
205                 tmp &= ~(PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb		|
206 			 PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb		|
207 			 PIXCLKS_CNTL__DISP_TVOUT_PIXCLK_TV_ALWAYS_ONb	|
208 			 PIXCLKS_CNTL__R300_DVOCLK_ALWAYS_ONb		|
209 			 PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb		|
210 			 PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb		|
211 			 PIXCLKS_CNTL__R300_PIXCLK_DVO_ALWAYS_ONb	|
212 			 PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb		|
213 			 PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb		|
214 			 PIXCLKS_CNTL__R300_PIXCLK_TRANS_ALWAYS_ONb	|
215 			 PIXCLKS_CNTL__R300_PIXCLK_TVO_ALWAYS_ONb	|
216 			 PIXCLKS_CNTL__R300_P2G2CLK_ALWAYS_ONb		|
217 			 PIXCLKS_CNTL__R300_DISP_DAC_PIXCLK_DAC2_BLANK_OFF);
218                 OUTPLL(pllPIXCLKS_CNTL, tmp);
219 
220 		return;
221 	}
222 
223 	/* Default */
224 
225 	/* Force Core Clocks */
226 	tmp = INPLL(pllSCLK_CNTL);
227 	tmp |= (SCLK_CNTL__FORCE_CP | SCLK_CNTL__FORCE_E2);
228 
229 	/* XFree doesn't do that case, but we had this code from Apple and it
230 	 * seem necessary for proper suspend/resume operations
231 	 */
232 	if (rinfo->is_mobility) {
233 		tmp |= 	SCLK_CNTL__FORCE_HDP|
234 			SCLK_CNTL__FORCE_DISP1|
235 			SCLK_CNTL__FORCE_DISP2|
236 			SCLK_CNTL__FORCE_TOP|
237 			SCLK_CNTL__FORCE_SE|
238 			SCLK_CNTL__FORCE_IDCT|
239 			SCLK_CNTL__FORCE_VIP|
240 			SCLK_CNTL__FORCE_PB|
241 			SCLK_CNTL__FORCE_RE|
242 			SCLK_CNTL__FORCE_TAM|
243 			SCLK_CNTL__FORCE_TDM|
244 			SCLK_CNTL__FORCE_RB|
245 			SCLK_CNTL__FORCE_TV_SCLK|
246 			SCLK_CNTL__FORCE_SUBPIC|
247 			SCLK_CNTL__FORCE_OV0;
248 	}
249 	else if (rinfo->family == CHIP_FAMILY_R300 ||
250 		   rinfo->family == CHIP_FAMILY_R350) {
251 		tmp |=  SCLK_CNTL__FORCE_HDP   |
252 			SCLK_CNTL__FORCE_DISP1 |
253 			SCLK_CNTL__FORCE_DISP2 |
254 			SCLK_CNTL__FORCE_TOP   |
255 			SCLK_CNTL__FORCE_IDCT  |
256 			SCLK_CNTL__FORCE_VIP;
257 	}
258     	OUTPLL(pllSCLK_CNTL, tmp);
259 	radeon_msleep(16);
260 
261 	if (rinfo->family == CHIP_FAMILY_R300 || rinfo->family == CHIP_FAMILY_R350) {
262 		tmp = INPLL(pllSCLK_CNTL2);
263 		tmp |=  SCLK_CNTL2__R300_FORCE_TCL |
264 			SCLK_CNTL2__R300_FORCE_GA  |
265 			SCLK_CNTL2__R300_FORCE_CBA;
266 		OUTPLL(pllSCLK_CNTL2, tmp);
267 		radeon_msleep(16);
268 	}
269 
270 	tmp = INPLL(pllCLK_PIN_CNTL);
271 	tmp &= ~CLK_PIN_CNTL__SCLK_DYN_START_CNTL;
272 	OUTPLL(pllCLK_PIN_CNTL, tmp);
273 	radeon_msleep(15);
274 
275 	if (rinfo->is_IGP) {
276 		/* Weird  ... X is _un_ forcing clocks here, I think it's
277 		 * doing backward. Imitate it for now...
278 		 */
279 		tmp = INPLL(pllMCLK_CNTL);
280 		tmp &= ~(MCLK_CNTL__FORCE_MCLKA |
281 			 MCLK_CNTL__FORCE_YCLKA);
282 		OUTPLL(pllMCLK_CNTL, tmp);
283 		radeon_msleep(16);
284 	}
285 	/* Hrm... same shit, X doesn't do that but I have to */
286 	else if (rinfo->is_mobility) {
287 		tmp = INPLL(pllMCLK_CNTL);
288 		tmp |= (MCLK_CNTL__FORCE_MCLKA |
289 			MCLK_CNTL__FORCE_MCLKB |
290 			MCLK_CNTL__FORCE_YCLKA |
291 			MCLK_CNTL__FORCE_YCLKB);
292 		OUTPLL(pllMCLK_CNTL, tmp);
293 		radeon_msleep(16);
294 
295 		tmp = INPLL(pllMCLK_MISC);
296 		tmp &= 	~(MCLK_MISC__MC_MCLK_MAX_DYN_STOP_LAT|
297 			  MCLK_MISC__IO_MCLK_MAX_DYN_STOP_LAT|
298 			  MCLK_MISC__MC_MCLK_DYN_ENABLE|
299 			  MCLK_MISC__IO_MCLK_DYN_ENABLE);
300 		OUTPLL(pllMCLK_MISC, tmp);
301 		radeon_msleep(15);
302 	}
303 
304 	if (rinfo->is_mobility) {
305 		tmp = INPLL(pllSCLK_MORE_CNTL);
306 		tmp |= 	SCLK_MORE_CNTL__FORCE_DISPREGS|
307 			SCLK_MORE_CNTL__FORCE_MC_GUI|
308 			SCLK_MORE_CNTL__FORCE_MC_HOST;
309 		OUTPLL(pllSCLK_MORE_CNTL, tmp);
310 		radeon_msleep(16);
311 	}
312 
313 	tmp = INPLL(pllPIXCLKS_CNTL);
314 	tmp &= ~(PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb |
315 		 PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb|
316 		 PIXCLKS_CNTL__PIXCLK_DIG_TMDS_ALWAYS_ONb |
317 		 PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb|
318 		 PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb|
319 		 PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb|
320 		 PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb);
321  	OUTPLL(pllPIXCLKS_CNTL, tmp);
322 	radeon_msleep(16);
323 
324 	tmp = INPLL( pllVCLK_ECP_CNTL);
325 	tmp &= ~(VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb |
326 		 VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb);
327 	OUTPLL( pllVCLK_ECP_CNTL, tmp);
328 	radeon_msleep(16);
329 }
330 
331 static void radeon_pm_enable_dynamic_mode(struct radeonfb_info *rinfo)
332 {
333 	u32 tmp;
334 
335 	/* R100 */
336 	if (!rinfo->has_CRTC2) {
337                 tmp = INPLL(pllSCLK_CNTL);
338 
339 		if ((INREG(CNFG_CNTL) & CFG_ATI_REV_ID_MASK) > CFG_ATI_REV_A13)
340                     tmp &= ~(SCLK_CNTL__FORCE_CP	| SCLK_CNTL__FORCE_RB);
341                 tmp &= ~(SCLK_CNTL__FORCE_HDP		| SCLK_CNTL__FORCE_DISP1 |
342 			 SCLK_CNTL__FORCE_TOP		| SCLK_CNTL__FORCE_SE   |
343 			 SCLK_CNTL__FORCE_IDCT		| SCLK_CNTL__FORCE_RE   |
344 			 SCLK_CNTL__FORCE_PB		| SCLK_CNTL__FORCE_TAM  |
345 			 SCLK_CNTL__FORCE_TDM);
346                 OUTPLL(pllSCLK_CNTL, tmp);
347 		return;
348 	}
349 
350 	/* M10/M11 */
351 	if (rinfo->family == CHIP_FAMILY_RV350) {
352 		tmp = INPLL(pllSCLK_CNTL2);
353 		tmp &= ~(SCLK_CNTL2__R300_FORCE_TCL |
354 			 SCLK_CNTL2__R300_FORCE_GA  |
355 			 SCLK_CNTL2__R300_FORCE_CBA);
356 		tmp |=  (SCLK_CNTL2__R300_TCL_MAX_DYN_STOP_LAT |
357 			 SCLK_CNTL2__R300_GA_MAX_DYN_STOP_LAT  |
358 			 SCLK_CNTL2__R300_CBA_MAX_DYN_STOP_LAT);
359 		OUTPLL(pllSCLK_CNTL2, tmp);
360 
361 		tmp = INPLL(pllSCLK_CNTL);
362 		tmp &= ~(SCLK_CNTL__FORCE_DISP2 | SCLK_CNTL__FORCE_CP      |
363 			 SCLK_CNTL__FORCE_HDP   | SCLK_CNTL__FORCE_DISP1   |
364 			 SCLK_CNTL__FORCE_TOP   | SCLK_CNTL__FORCE_E2      |
365 			 SCLK_CNTL__R300_FORCE_VAP | SCLK_CNTL__FORCE_IDCT |
366 			 SCLK_CNTL__FORCE_VIP   | SCLK_CNTL__R300_FORCE_SR |
367 			 SCLK_CNTL__R300_FORCE_PX | SCLK_CNTL__R300_FORCE_TX |
368 			 SCLK_CNTL__R300_FORCE_US | SCLK_CNTL__FORCE_TV_SCLK |
369 			 SCLK_CNTL__R300_FORCE_SU | SCLK_CNTL__FORCE_OV0);
370 		tmp |= SCLK_CNTL__DYN_STOP_LAT_MASK;
371 		OUTPLL(pllSCLK_CNTL, tmp);
372 
373 		tmp = INPLL(pllSCLK_MORE_CNTL);
374 		tmp &= ~SCLK_MORE_CNTL__FORCEON;
375 		tmp |=  SCLK_MORE_CNTL__DISPREGS_MAX_DYN_STOP_LAT |
376 			SCLK_MORE_CNTL__MC_GUI_MAX_DYN_STOP_LAT |
377 			SCLK_MORE_CNTL__MC_HOST_MAX_DYN_STOP_LAT;
378 		OUTPLL(pllSCLK_MORE_CNTL, tmp);
379 
380 		tmp = INPLL(pllVCLK_ECP_CNTL);
381 		tmp |= (VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb |
382 			VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb);
383 		OUTPLL(pllVCLK_ECP_CNTL, tmp);
384 
385 		tmp = INPLL(pllPIXCLKS_CNTL);
386 		tmp |= (PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb         |
387 			PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb     |
388 			PIXCLKS_CNTL__DISP_TVOUT_PIXCLK_TV_ALWAYS_ONb |
389 			PIXCLKS_CNTL__R300_DVOCLK_ALWAYS_ONb            |
390 			PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb    |
391 			PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb       |
392 			PIXCLKS_CNTL__R300_PIXCLK_DVO_ALWAYS_ONb        |
393 			PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb     |
394 			PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb     |
395 			PIXCLKS_CNTL__R300_PIXCLK_TRANS_ALWAYS_ONb      |
396 			PIXCLKS_CNTL__R300_PIXCLK_TVO_ALWAYS_ONb        |
397 			PIXCLKS_CNTL__R300_P2G2CLK_ALWAYS_ONb           |
398 			PIXCLKS_CNTL__R300_P2G2CLK_DAC_ALWAYS_ONb);
399 		OUTPLL(pllPIXCLKS_CNTL, tmp);
400 
401 		tmp = INPLL(pllMCLK_MISC);
402 		tmp |= (MCLK_MISC__MC_MCLK_DYN_ENABLE |
403 			MCLK_MISC__IO_MCLK_DYN_ENABLE);
404 		OUTPLL(pllMCLK_MISC, tmp);
405 
406 		tmp = INPLL(pllMCLK_CNTL);
407 		tmp |= (MCLK_CNTL__FORCE_MCLKA | MCLK_CNTL__FORCE_MCLKB);
408 		tmp &= ~(MCLK_CNTL__FORCE_YCLKA  |
409 			 MCLK_CNTL__FORCE_YCLKB  |
410 			 MCLK_CNTL__FORCE_MC);
411 
412 		/* Some releases of vbios have set DISABLE_MC_MCLKA
413 		 * and DISABLE_MC_MCLKB bits in the vbios table.  Setting these
414 		 * bits will cause H/W hang when reading video memory with dynamic
415 		 * clocking enabled.
416 		 */
417 		if ((tmp & MCLK_CNTL__R300_DISABLE_MC_MCLKA) &&
418 		    (tmp & MCLK_CNTL__R300_DISABLE_MC_MCLKB)) {
419 			/* If both bits are set, then check the active channels */
420 			tmp = INPLL(pllMCLK_CNTL);
421 			if (rinfo->vram_width == 64) {
422 			    if (INREG(MEM_CNTL) & R300_MEM_USE_CD_CH_ONLY)
423 				tmp &= ~MCLK_CNTL__R300_DISABLE_MC_MCLKB;
424 			    else
425 				tmp &= ~MCLK_CNTL__R300_DISABLE_MC_MCLKA;
426 			} else {
427 			    tmp &= ~(MCLK_CNTL__R300_DISABLE_MC_MCLKA |
428 				     MCLK_CNTL__R300_DISABLE_MC_MCLKB);
429 			}
430 		}
431 		OUTPLL(pllMCLK_CNTL, tmp);
432 		return;
433 	}
434 
435 	/* R300 */
436 	if (rinfo->family == CHIP_FAMILY_R300 || rinfo->family == CHIP_FAMILY_R350) {
437 		tmp = INPLL(pllSCLK_CNTL);
438 		tmp &= ~(SCLK_CNTL__R300_FORCE_VAP);
439 		tmp |= SCLK_CNTL__FORCE_CP;
440 		OUTPLL(pllSCLK_CNTL, tmp);
441 		radeon_msleep(15);
442 
443 		tmp = INPLL(pllSCLK_CNTL2);
444 		tmp &= ~(SCLK_CNTL2__R300_FORCE_TCL |
445 			 SCLK_CNTL2__R300_FORCE_GA  |
446 			 SCLK_CNTL2__R300_FORCE_CBA);
447 		OUTPLL(pllSCLK_CNTL2, tmp);
448 	}
449 
450 	/* Others */
451 
452 	tmp = INPLL( pllCLK_PWRMGT_CNTL);
453 	tmp &= ~(CLK_PWRMGT_CNTL__ACTIVE_HILO_LAT_MASK|
454 		 CLK_PWRMGT_CNTL__DISP_DYN_STOP_LAT_MASK|
455 		 CLK_PWRMGT_CNTL__DYN_STOP_MODE_MASK);
456 	tmp |= CLK_PWRMGT_CNTL__ENGINE_DYNCLK_MODE_MASK |
457 	       (0x01 << CLK_PWRMGT_CNTL__ACTIVE_HILO_LAT__SHIFT);
458 	OUTPLL( pllCLK_PWRMGT_CNTL, tmp);
459 	radeon_msleep(15);
460 
461 	tmp = INPLL(pllCLK_PIN_CNTL);
462 	tmp |= CLK_PIN_CNTL__SCLK_DYN_START_CNTL;
463 	OUTPLL(pllCLK_PIN_CNTL, tmp);
464 	radeon_msleep(15);
465 
466 	/* When DRI is enabled, setting DYN_STOP_LAT to zero can cause some R200
467 	 * to lockup randomly, leave them as set by BIOS.
468 	 */
469 	tmp = INPLL(pllSCLK_CNTL);
470 	tmp &= ~SCLK_CNTL__FORCEON_MASK;
471 
472 	/*RAGE_6::A11 A12 A12N1 A13, RV250::A11 A12, R300*/
473 	if ((rinfo->family == CHIP_FAMILY_RV250 &&
474 	     ((INREG(CNFG_CNTL) & CFG_ATI_REV_ID_MASK) < CFG_ATI_REV_A13)) ||
475 	    ((rinfo->family == CHIP_FAMILY_RV100) &&
476 	     ((INREG(CNFG_CNTL) & CFG_ATI_REV_ID_MASK) <= CFG_ATI_REV_A13))) {
477 		tmp |= SCLK_CNTL__FORCE_CP;
478 		tmp |= SCLK_CNTL__FORCE_VIP;
479 	}
480 	OUTPLL(pllSCLK_CNTL, tmp);
481 	radeon_msleep(15);
482 
483 	if ((rinfo->family == CHIP_FAMILY_RV200) ||
484 	    (rinfo->family == CHIP_FAMILY_RV250) ||
485 	    (rinfo->family == CHIP_FAMILY_RV280)) {
486 		tmp = INPLL(pllSCLK_MORE_CNTL);
487 		tmp &= ~SCLK_MORE_CNTL__FORCEON;
488 
489 		/* RV200::A11 A12 RV250::A11 A12 */
490 		if (((rinfo->family == CHIP_FAMILY_RV200) ||
491 		     (rinfo->family == CHIP_FAMILY_RV250)) &&
492 		    ((INREG(CNFG_CNTL) & CFG_ATI_REV_ID_MASK) < CFG_ATI_REV_A13))
493 			tmp |= SCLK_MORE_CNTL__FORCEON;
494 
495 		OUTPLL(pllSCLK_MORE_CNTL, tmp);
496 		radeon_msleep(15);
497 	}
498 
499 
500 	/* RV200::A11 A12, RV250::A11 A12 */
501 	if (((rinfo->family == CHIP_FAMILY_RV200) ||
502 	     (rinfo->family == CHIP_FAMILY_RV250)) &&
503 	    ((INREG(CNFG_CNTL) & CFG_ATI_REV_ID_MASK) < CFG_ATI_REV_A13)) {
504 		tmp = INPLL(pllPLL_PWRMGT_CNTL);
505 		tmp |= PLL_PWRMGT_CNTL__TCL_BYPASS_DISABLE;
506 		OUTPLL(pllPLL_PWRMGT_CNTL, tmp);
507 		radeon_msleep(15);
508 	}
509 
510 	tmp = INPLL(pllPIXCLKS_CNTL);
511 	tmp |=  PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb |
512 		PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb|
513 		PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb|
514 		PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb|
515 		PIXCLKS_CNTL__PIXCLK_DIG_TMDS_ALWAYS_ONb|
516 		PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb|
517 		PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb;
518 	OUTPLL(pllPIXCLKS_CNTL, tmp);
519 	radeon_msleep(15);
520 
521 	tmp = INPLL(pllVCLK_ECP_CNTL);
522 	tmp |=  VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb |
523 		VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb;
524 	OUTPLL(pllVCLK_ECP_CNTL, tmp);
525 
526 	/* X doesn't do that ... hrm, we do on mobility && Macs */
527 #ifdef CONFIG_PPC
528 	if (rinfo->is_mobility) {
529 		tmp  = INPLL(pllMCLK_CNTL);
530 		tmp &= ~(MCLK_CNTL__FORCE_MCLKA |
531 			 MCLK_CNTL__FORCE_MCLKB |
532 			 MCLK_CNTL__FORCE_YCLKA |
533 			 MCLK_CNTL__FORCE_YCLKB);
534 		OUTPLL(pllMCLK_CNTL, tmp);
535 		radeon_msleep(15);
536 
537 		tmp = INPLL(pllMCLK_MISC);
538 		tmp |= 	MCLK_MISC__MC_MCLK_MAX_DYN_STOP_LAT|
539 			MCLK_MISC__IO_MCLK_MAX_DYN_STOP_LAT|
540 			MCLK_MISC__MC_MCLK_DYN_ENABLE|
541 			MCLK_MISC__IO_MCLK_DYN_ENABLE;
542 		OUTPLL(pllMCLK_MISC, tmp);
543 		radeon_msleep(15);
544 	}
545 #endif /* CONFIG_PPC */
546 }
547 
548 #ifdef CONFIG_PM
549 
550 static void OUTMC( struct radeonfb_info *rinfo, u8 indx, u32 value)
551 {
552 	OUTREG( MC_IND_INDEX, indx | MC_IND_INDEX__MC_IND_WR_EN);
553 	OUTREG( MC_IND_DATA, value);
554 }
555 
556 static u32 INMC(struct radeonfb_info *rinfo, u8 indx)
557 {
558 	OUTREG( MC_IND_INDEX, indx);
559 	return INREG( MC_IND_DATA);
560 }
561 
562 static void radeon_pm_save_regs(struct radeonfb_info *rinfo, int saving_for_d3)
563 {
564 	rinfo->save_regs[0] = INPLL(PLL_PWRMGT_CNTL);
565 	rinfo->save_regs[1] = INPLL(CLK_PWRMGT_CNTL);
566 	rinfo->save_regs[2] = INPLL(MCLK_CNTL);
567 	rinfo->save_regs[3] = INPLL(SCLK_CNTL);
568 	rinfo->save_regs[4] = INPLL(CLK_PIN_CNTL);
569 	rinfo->save_regs[5] = INPLL(VCLK_ECP_CNTL);
570 	rinfo->save_regs[6] = INPLL(PIXCLKS_CNTL);
571 	rinfo->save_regs[7] = INPLL(MCLK_MISC);
572 	rinfo->save_regs[8] = INPLL(P2PLL_CNTL);
573 
574 	rinfo->save_regs[9] = INREG(DISP_MISC_CNTL);
575 	rinfo->save_regs[10] = INREG(DISP_PWR_MAN);
576 	rinfo->save_regs[11] = INREG(LVDS_GEN_CNTL);
577 	rinfo->save_regs[13] = INREG(TV_DAC_CNTL);
578 	rinfo->save_regs[14] = INREG(BUS_CNTL1);
579 	rinfo->save_regs[15] = INREG(CRTC_OFFSET_CNTL);
580 	rinfo->save_regs[16] = INREG(AGP_CNTL);
581 	rinfo->save_regs[17] = (INREG(CRTC_GEN_CNTL) & 0xfdffffff) | 0x04000000;
582 	rinfo->save_regs[18] = (INREG(CRTC2_GEN_CNTL) & 0xfdffffff) | 0x04000000;
583 	rinfo->save_regs[19] = INREG(GPIOPAD_A);
584 	rinfo->save_regs[20] = INREG(GPIOPAD_EN);
585 	rinfo->save_regs[21] = INREG(GPIOPAD_MASK);
586 	rinfo->save_regs[22] = INREG(ZV_LCDPAD_A);
587 	rinfo->save_regs[23] = INREG(ZV_LCDPAD_EN);
588 	rinfo->save_regs[24] = INREG(ZV_LCDPAD_MASK);
589 	rinfo->save_regs[25] = INREG(GPIO_VGA_DDC);
590 	rinfo->save_regs[26] = INREG(GPIO_DVI_DDC);
591 	rinfo->save_regs[27] = INREG(GPIO_MONID);
592 	rinfo->save_regs[28] = INREG(GPIO_CRT2_DDC);
593 
594 	rinfo->save_regs[29] = INREG(SURFACE_CNTL);
595 	rinfo->save_regs[30] = INREG(MC_FB_LOCATION);
596 	rinfo->save_regs[31] = INREG(DISPLAY_BASE_ADDR);
597 	rinfo->save_regs[32] = INREG(MC_AGP_LOCATION);
598 	rinfo->save_regs[33] = INREG(CRTC2_DISPLAY_BASE_ADDR);
599 
600 	rinfo->save_regs[34] = INPLL(SCLK_MORE_CNTL);
601 	rinfo->save_regs[35] = INREG(MEM_SDRAM_MODE_REG);
602 	rinfo->save_regs[36] = INREG(BUS_CNTL);
603 	rinfo->save_regs[39] = INREG(RBBM_CNTL);
604 	rinfo->save_regs[40] = INREG(DAC_CNTL);
605 	rinfo->save_regs[41] = INREG(HOST_PATH_CNTL);
606 	rinfo->save_regs[37] = INREG(MPP_TB_CONFIG);
607 	rinfo->save_regs[38] = INREG(FCP_CNTL);
608 
609 	if (rinfo->is_mobility) {
610 		rinfo->save_regs[12] = INREG(LVDS_PLL_CNTL);
611 		rinfo->save_regs[43] = INPLL(pllSSPLL_CNTL);
612 		rinfo->save_regs[44] = INPLL(pllSSPLL_REF_DIV);
613 		rinfo->save_regs[45] = INPLL(pllSSPLL_DIV_0);
614 		rinfo->save_regs[90] = INPLL(pllSS_INT_CNTL);
615 		rinfo->save_regs[91] = INPLL(pllSS_TST_CNTL);
616 		rinfo->save_regs[81] = INREG(LVDS_GEN_CNTL);
617 	}
618 
619 	if (rinfo->family >= CHIP_FAMILY_RV200) {
620 		rinfo->save_regs[42] = INREG(MEM_REFRESH_CNTL);
621 		rinfo->save_regs[46] = INREG(MC_CNTL);
622 		rinfo->save_regs[47] = INREG(MC_INIT_GFX_LAT_TIMER);
623 		rinfo->save_regs[48] = INREG(MC_INIT_MISC_LAT_TIMER);
624 		rinfo->save_regs[49] = INREG(MC_TIMING_CNTL);
625 		rinfo->save_regs[50] = INREG(MC_READ_CNTL_AB);
626 		rinfo->save_regs[51] = INREG(MC_IOPAD_CNTL);
627 		rinfo->save_regs[52] = INREG(MC_CHIP_IO_OE_CNTL_AB);
628 		rinfo->save_regs[53] = INREG(MC_DEBUG);
629 	}
630 	rinfo->save_regs[54] = INREG(PAMAC0_DLY_CNTL);
631 	rinfo->save_regs[55] = INREG(PAMAC1_DLY_CNTL);
632 	rinfo->save_regs[56] = INREG(PAD_CTLR_MISC);
633 	rinfo->save_regs[57] = INREG(FW_CNTL);
634 
635 	if (rinfo->family >= CHIP_FAMILY_R300) {
636 		rinfo->save_regs[58] = INMC(rinfo, ixR300_MC_MC_INIT_WR_LAT_TIMER);
637 		rinfo->save_regs[59] = INMC(rinfo, ixR300_MC_IMP_CNTL);
638 		rinfo->save_regs[60] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_C0);
639 		rinfo->save_regs[61] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_C1);
640 		rinfo->save_regs[62] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_D0);
641 		rinfo->save_regs[63] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_D1);
642 		rinfo->save_regs[64] = INMC(rinfo, ixR300_MC_BIST_CNTL_3);
643 		rinfo->save_regs[65] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_A0);
644 		rinfo->save_regs[66] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_A1);
645 		rinfo->save_regs[67] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_B0);
646 		rinfo->save_regs[68] = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_B1);
647 		rinfo->save_regs[69] = INMC(rinfo, ixR300_MC_DEBUG_CNTL);
648 		rinfo->save_regs[70] = INMC(rinfo, ixR300_MC_DLL_CNTL);
649 		rinfo->save_regs[71] = INMC(rinfo, ixR300_MC_IMP_CNTL_0);
650 		rinfo->save_regs[72] = INMC(rinfo, ixR300_MC_ELPIDA_CNTL);
651 		rinfo->save_regs[96] = INMC(rinfo, ixR300_MC_READ_CNTL_CD);
652 	} else {
653 		rinfo->save_regs[59] = INMC(rinfo, ixMC_IMP_CNTL);
654 		rinfo->save_regs[65] = INMC(rinfo, ixMC_CHP_IO_CNTL_A0);
655 		rinfo->save_regs[66] = INMC(rinfo, ixMC_CHP_IO_CNTL_A1);
656 		rinfo->save_regs[67] = INMC(rinfo, ixMC_CHP_IO_CNTL_B0);
657 		rinfo->save_regs[68] = INMC(rinfo, ixMC_CHP_IO_CNTL_B1);
658 		rinfo->save_regs[71] = INMC(rinfo, ixMC_IMP_CNTL_0);
659 	}
660 
661 	rinfo->save_regs[73] = INPLL(pllMPLL_CNTL);
662 	rinfo->save_regs[74] = INPLL(pllSPLL_CNTL);
663 	rinfo->save_regs[75] = INPLL(pllMPLL_AUX_CNTL);
664 	rinfo->save_regs[76] = INPLL(pllSPLL_AUX_CNTL);
665 	rinfo->save_regs[77] = INPLL(pllM_SPLL_REF_FB_DIV);
666 	rinfo->save_regs[78] = INPLL(pllAGP_PLL_CNTL);
667 	rinfo->save_regs[79] = INREG(PAMAC2_DLY_CNTL);
668 
669 	rinfo->save_regs[80] = INREG(OV0_BASE_ADDR);
670 	rinfo->save_regs[82] = INREG(FP_GEN_CNTL);
671 	rinfo->save_regs[83] = INREG(FP2_GEN_CNTL);
672 	rinfo->save_regs[84] = INREG(TMDS_CNTL);
673 	rinfo->save_regs[85] = INREG(TMDS_TRANSMITTER_CNTL);
674 	rinfo->save_regs[86] = INREG(DISP_OUTPUT_CNTL);
675 	rinfo->save_regs[87] = INREG(DISP_HW_DEBUG);
676 	rinfo->save_regs[88] = INREG(TV_MASTER_CNTL);
677 	rinfo->save_regs[89] = INPLL(pllP2PLL_REF_DIV);
678 	rinfo->save_regs[92] = INPLL(pllPPLL_DIV_0);
679 	rinfo->save_regs[93] = INPLL(pllPPLL_CNTL);
680 	rinfo->save_regs[94] = INREG(GRPH_BUFFER_CNTL);
681 	rinfo->save_regs[95] = INREG(GRPH2_BUFFER_CNTL);
682 	rinfo->save_regs[96] = INREG(HDP_DEBUG);
683 	rinfo->save_regs[97] = INPLL(pllMDLL_CKO);
684 	rinfo->save_regs[98] = INPLL(pllMDLL_RDCKA);
685 	rinfo->save_regs[99] = INPLL(pllMDLL_RDCKB);
686 }
687 
688 static void radeon_pm_restore_regs(struct radeonfb_info *rinfo)
689 {
690 	OUTPLL(P2PLL_CNTL, rinfo->save_regs[8] & 0xFFFFFFFE); /* First */
691 
692 	OUTPLL(PLL_PWRMGT_CNTL, rinfo->save_regs[0]);
693 	OUTPLL(CLK_PWRMGT_CNTL, rinfo->save_regs[1]);
694 	OUTPLL(MCLK_CNTL, rinfo->save_regs[2]);
695 	OUTPLL(SCLK_CNTL, rinfo->save_regs[3]);
696 	OUTPLL(CLK_PIN_CNTL, rinfo->save_regs[4]);
697 	OUTPLL(VCLK_ECP_CNTL, rinfo->save_regs[5]);
698 	OUTPLL(PIXCLKS_CNTL, rinfo->save_regs[6]);
699 	OUTPLL(MCLK_MISC, rinfo->save_regs[7]);
700 	if (rinfo->family == CHIP_FAMILY_RV350)
701 		OUTPLL(SCLK_MORE_CNTL, rinfo->save_regs[34]);
702 
703 	OUTREG(SURFACE_CNTL, rinfo->save_regs[29]);
704 	OUTREG(MC_FB_LOCATION, rinfo->save_regs[30]);
705 	OUTREG(DISPLAY_BASE_ADDR, rinfo->save_regs[31]);
706 	OUTREG(MC_AGP_LOCATION, rinfo->save_regs[32]);
707 	OUTREG(CRTC2_DISPLAY_BASE_ADDR, rinfo->save_regs[33]);
708 	OUTREG(CNFG_MEMSIZE, rinfo->video_ram);
709 
710 	OUTREG(DISP_MISC_CNTL, rinfo->save_regs[9]);
711 	OUTREG(DISP_PWR_MAN, rinfo->save_regs[10]);
712 	OUTREG(LVDS_GEN_CNTL, rinfo->save_regs[11]);
713 	OUTREG(LVDS_PLL_CNTL,rinfo->save_regs[12]);
714 	OUTREG(TV_DAC_CNTL, rinfo->save_regs[13]);
715 	OUTREG(BUS_CNTL1, rinfo->save_regs[14]);
716 	OUTREG(CRTC_OFFSET_CNTL, rinfo->save_regs[15]);
717 	OUTREG(AGP_CNTL, rinfo->save_regs[16]);
718 	OUTREG(CRTC_GEN_CNTL, rinfo->save_regs[17]);
719 	OUTREG(CRTC2_GEN_CNTL, rinfo->save_regs[18]);
720 	OUTPLL(P2PLL_CNTL, rinfo->save_regs[8]);
721 
722 	OUTREG(GPIOPAD_A, rinfo->save_regs[19]);
723 	OUTREG(GPIOPAD_EN, rinfo->save_regs[20]);
724 	OUTREG(GPIOPAD_MASK, rinfo->save_regs[21]);
725 	OUTREG(ZV_LCDPAD_A, rinfo->save_regs[22]);
726 	OUTREG(ZV_LCDPAD_EN, rinfo->save_regs[23]);
727 	OUTREG(ZV_LCDPAD_MASK, rinfo->save_regs[24]);
728 	OUTREG(GPIO_VGA_DDC, rinfo->save_regs[25]);
729 	OUTREG(GPIO_DVI_DDC, rinfo->save_regs[26]);
730 	OUTREG(GPIO_MONID, rinfo->save_regs[27]);
731 	OUTREG(GPIO_CRT2_DDC, rinfo->save_regs[28]);
732 }
733 
734 static void radeon_pm_disable_iopad(struct radeonfb_info *rinfo)
735 {
736 	OUTREG(GPIOPAD_MASK, 0x0001ffff);
737 	OUTREG(GPIOPAD_EN, 0x00000400);
738 	OUTREG(GPIOPAD_A, 0x00000000);
739         OUTREG(ZV_LCDPAD_MASK, 0x00000000);
740         OUTREG(ZV_LCDPAD_EN, 0x00000000);
741       	OUTREG(ZV_LCDPAD_A, 0x00000000);
742 	OUTREG(GPIO_VGA_DDC, 0x00030000);
743 	OUTREG(GPIO_DVI_DDC, 0x00000000);
744 	OUTREG(GPIO_MONID, 0x00030000);
745 	OUTREG(GPIO_CRT2_DDC, 0x00000000);
746 }
747 
748 static void radeon_pm_program_v2clk(struct radeonfb_info *rinfo)
749 {
750 	/* Set v2clk to 65MHz */
751 	if (rinfo->family <= CHIP_FAMILY_RV280) {
752 		OUTPLL(pllPIXCLKS_CNTL,
753 			 __INPLL(rinfo, pllPIXCLKS_CNTL)
754 			 & ~PIXCLKS_CNTL__PIX2CLK_SRC_SEL_MASK);
755 
756 		OUTPLL(pllP2PLL_REF_DIV, 0x0000000c);
757 		OUTPLL(pllP2PLL_CNTL, 0x0000bf00);
758 	} else {
759 		OUTPLL(pllP2PLL_REF_DIV, 0x0000000c);
760 		INPLL(pllP2PLL_REF_DIV);
761 		OUTPLL(pllP2PLL_CNTL, 0x0000a700);
762 	}
763 
764 	OUTPLL(pllP2PLL_DIV_0, 0x00020074 | P2PLL_DIV_0__P2PLL_ATOMIC_UPDATE_W);
765 
766 	OUTPLL(pllP2PLL_CNTL, INPLL(pllP2PLL_CNTL) & ~P2PLL_CNTL__P2PLL_SLEEP);
767 	mdelay(1);
768 
769 	OUTPLL(pllP2PLL_CNTL, INPLL(pllP2PLL_CNTL) & ~P2PLL_CNTL__P2PLL_RESET);
770 	mdelay( 1);
771 
772   	OUTPLL(pllPIXCLKS_CNTL,
773   		(INPLL(pllPIXCLKS_CNTL) & ~PIXCLKS_CNTL__PIX2CLK_SRC_SEL_MASK)
774   		| (0x03 << PIXCLKS_CNTL__PIX2CLK_SRC_SEL__SHIFT));
775 	mdelay( 1);
776 }
777 
778 static void radeon_pm_low_current(struct radeonfb_info *rinfo)
779 {
780 	u32 reg;
781 
782 	reg  = INREG(BUS_CNTL1);
783 	if (rinfo->family <= CHIP_FAMILY_RV280) {
784 		reg &= ~BUS_CNTL1_MOBILE_PLATFORM_SEL_MASK;
785 		reg |= BUS_CNTL1_AGPCLK_VALID | (1<<BUS_CNTL1_MOBILE_PLATFORM_SEL_SHIFT);
786 	} else {
787 		reg |= 0x4080;
788 	}
789 	OUTREG(BUS_CNTL1, reg);
790 
791 	reg  = INPLL(PLL_PWRMGT_CNTL);
792 	reg |= PLL_PWRMGT_CNTL_SPLL_TURNOFF | PLL_PWRMGT_CNTL_PPLL_TURNOFF |
793 		PLL_PWRMGT_CNTL_P2PLL_TURNOFF | PLL_PWRMGT_CNTL_TVPLL_TURNOFF;
794 	reg &= ~PLL_PWRMGT_CNTL_SU_MCLK_USE_BCLK;
795 	reg &= ~PLL_PWRMGT_CNTL_MOBILE_SU;
796 	OUTPLL(PLL_PWRMGT_CNTL, reg);
797 
798 	reg  = INREG(TV_DAC_CNTL);
799 	reg &= ~(TV_DAC_CNTL_BGADJ_MASK |TV_DAC_CNTL_DACADJ_MASK);
800 	reg |=TV_DAC_CNTL_BGSLEEP | TV_DAC_CNTL_RDACPD | TV_DAC_CNTL_GDACPD |
801 		TV_DAC_CNTL_BDACPD |
802 		(8<<TV_DAC_CNTL_BGADJ__SHIFT) | (8<<TV_DAC_CNTL_DACADJ__SHIFT);
803 	OUTREG(TV_DAC_CNTL, reg);
804 
805 	reg  = INREG(TMDS_TRANSMITTER_CNTL);
806 	reg &= ~(TMDS_PLL_EN | TMDS_PLLRST);
807 	OUTREG(TMDS_TRANSMITTER_CNTL, reg);
808 
809 	reg = INREG(DAC_CNTL);
810 	reg &= ~DAC_CMP_EN;
811 	OUTREG(DAC_CNTL, reg);
812 
813 	reg = INREG(DAC_CNTL2);
814 	reg &= ~DAC2_CMP_EN;
815 	OUTREG(DAC_CNTL2, reg);
816 
817 	reg  = INREG(TV_DAC_CNTL);
818 	reg &= ~TV_DAC_CNTL_DETECT;
819 	OUTREG(TV_DAC_CNTL, reg);
820 }
821 
822 static void radeon_pm_setup_for_suspend(struct radeonfb_info *rinfo)
823 {
824 
825 	u32 sclk_cntl, mclk_cntl, sclk_more_cntl;
826 
827 	u32 pll_pwrmgt_cntl;
828 	u32 clk_pwrmgt_cntl;
829 	u32 clk_pin_cntl;
830 	u32 vclk_ecp_cntl;
831 	u32 pixclks_cntl;
832 	u32 disp_mis_cntl;
833 	u32 disp_pwr_man;
834 	u32 tmp;
835 
836 	/* Force Core Clocks */
837 	sclk_cntl = INPLL( pllSCLK_CNTL);
838 	sclk_cntl |= 	SCLK_CNTL__IDCT_MAX_DYN_STOP_LAT|
839 			SCLK_CNTL__VIP_MAX_DYN_STOP_LAT|
840 			SCLK_CNTL__RE_MAX_DYN_STOP_LAT|
841 			SCLK_CNTL__PB_MAX_DYN_STOP_LAT|
842 			SCLK_CNTL__TAM_MAX_DYN_STOP_LAT|
843 			SCLK_CNTL__TDM_MAX_DYN_STOP_LAT|
844 			SCLK_CNTL__RB_MAX_DYN_STOP_LAT|
845 
846 			SCLK_CNTL__FORCE_DISP2|
847 			SCLK_CNTL__FORCE_CP|
848 			SCLK_CNTL__FORCE_HDP|
849 			SCLK_CNTL__FORCE_DISP1|
850 			SCLK_CNTL__FORCE_TOP|
851 			SCLK_CNTL__FORCE_E2|
852 			SCLK_CNTL__FORCE_SE|
853 			SCLK_CNTL__FORCE_IDCT|
854 			SCLK_CNTL__FORCE_VIP|
855 
856 			SCLK_CNTL__FORCE_PB|
857 			SCLK_CNTL__FORCE_TAM|
858 			SCLK_CNTL__FORCE_TDM|
859 			SCLK_CNTL__FORCE_RB|
860 			SCLK_CNTL__FORCE_TV_SCLK|
861 			SCLK_CNTL__FORCE_SUBPIC|
862 			SCLK_CNTL__FORCE_OV0;
863 	if (rinfo->family <= CHIP_FAMILY_RV280)
864 		sclk_cntl |= SCLK_CNTL__FORCE_RE;
865 	else
866 		sclk_cntl |= SCLK_CNTL__SE_MAX_DYN_STOP_LAT |
867 			SCLK_CNTL__E2_MAX_DYN_STOP_LAT |
868 			SCLK_CNTL__TV_MAX_DYN_STOP_LAT |
869 			SCLK_CNTL__HDP_MAX_DYN_STOP_LAT |
870 			SCLK_CNTL__CP_MAX_DYN_STOP_LAT;
871 
872 	OUTPLL( pllSCLK_CNTL, sclk_cntl);
873 
874 	sclk_more_cntl = INPLL(pllSCLK_MORE_CNTL);
875 	sclk_more_cntl |= 	SCLK_MORE_CNTL__FORCE_DISPREGS |
876 				SCLK_MORE_CNTL__FORCE_MC_GUI |
877 				SCLK_MORE_CNTL__FORCE_MC_HOST;
878 
879 	OUTPLL(pllSCLK_MORE_CNTL, sclk_more_cntl);
880 
881 
882 	mclk_cntl = INPLL( pllMCLK_CNTL);
883 	mclk_cntl &= ~(	MCLK_CNTL__FORCE_MCLKA |
884 			MCLK_CNTL__FORCE_MCLKB |
885 			MCLK_CNTL__FORCE_YCLKA |
886 			MCLK_CNTL__FORCE_YCLKB |
887 			MCLK_CNTL__FORCE_MC
888 		      );
889     	OUTPLL( pllMCLK_CNTL, mclk_cntl);
890 
891 	/* Force Display clocks	*/
892 	vclk_ecp_cntl = INPLL( pllVCLK_ECP_CNTL);
893 	vclk_ecp_cntl &= ~(VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb
894 			   | VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb);
895 	vclk_ecp_cntl |= VCLK_ECP_CNTL__ECP_FORCE_ON;
896 	OUTPLL( pllVCLK_ECP_CNTL, vclk_ecp_cntl);
897 
898 
899 	pixclks_cntl = INPLL( pllPIXCLKS_CNTL);
900 	pixclks_cntl &= ~(	PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb |
901 				PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb|
902 				PIXCLKS_CNTL__PIXCLK_DIG_TMDS_ALWAYS_ONb |
903 				PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb|
904 				PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb|
905 				PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb|
906 				PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb);
907 
908  	OUTPLL( pllPIXCLKS_CNTL, pixclks_cntl);
909 
910 	/* Switch off LVDS interface */
911 	OUTREG(LVDS_GEN_CNTL, INREG(LVDS_GEN_CNTL) &
912 	       ~(LVDS_BLON | LVDS_EN | LVDS_ON | LVDS_DIGON));
913 
914 	/* Enable System power management */
915 	pll_pwrmgt_cntl = INPLL( pllPLL_PWRMGT_CNTL);
916 
917 	pll_pwrmgt_cntl |= 	PLL_PWRMGT_CNTL__SPLL_TURNOFF |
918 				PLL_PWRMGT_CNTL__MPLL_TURNOFF|
919 				PLL_PWRMGT_CNTL__PPLL_TURNOFF|
920 				PLL_PWRMGT_CNTL__P2PLL_TURNOFF|
921 				PLL_PWRMGT_CNTL__TVPLL_TURNOFF;
922 
923 	OUTPLL( pllPLL_PWRMGT_CNTL, pll_pwrmgt_cntl);
924 
925 	clk_pwrmgt_cntl	 = INPLL( pllCLK_PWRMGT_CNTL);
926 
927 	clk_pwrmgt_cntl &= ~(	CLK_PWRMGT_CNTL__MPLL_PWRMGT_OFF|
928 				CLK_PWRMGT_CNTL__SPLL_PWRMGT_OFF|
929 				CLK_PWRMGT_CNTL__PPLL_PWRMGT_OFF|
930 				CLK_PWRMGT_CNTL__P2PLL_PWRMGT_OFF|
931 				CLK_PWRMGT_CNTL__MCLK_TURNOFF|
932 				CLK_PWRMGT_CNTL__SCLK_TURNOFF|
933 				CLK_PWRMGT_CNTL__PCLK_TURNOFF|
934 				CLK_PWRMGT_CNTL__P2CLK_TURNOFF|
935 				CLK_PWRMGT_CNTL__TVPLL_PWRMGT_OFF|
936 				CLK_PWRMGT_CNTL__GLOBAL_PMAN_EN|
937 				CLK_PWRMGT_CNTL__ENGINE_DYNCLK_MODE|
938 				CLK_PWRMGT_CNTL__ACTIVE_HILO_LAT_MASK|
939 				CLK_PWRMGT_CNTL__CG_NO1_DEBUG_MASK
940 			);
941 
942 	clk_pwrmgt_cntl |= CLK_PWRMGT_CNTL__GLOBAL_PMAN_EN
943 		| CLK_PWRMGT_CNTL__DISP_PM;
944 
945 	OUTPLL( pllCLK_PWRMGT_CNTL, clk_pwrmgt_cntl);
946 
947 	clk_pin_cntl = INPLL( pllCLK_PIN_CNTL);
948 
949 	clk_pin_cntl &= ~CLK_PIN_CNTL__ACCESS_REGS_IN_SUSPEND;
950 
951 	/* because both INPLL and OUTPLL take the same lock, that's why. */
952 	tmp = INPLL( pllMCLK_MISC) | MCLK_MISC__EN_MCLK_TRISTATE_IN_SUSPEND;
953 	OUTPLL( pllMCLK_MISC, tmp);
954 
955 	/* BUS_CNTL1__MOBILE_PLATORM_SEL setting is northbridge chipset
956 	 * and radeon chip dependent. Thus we only enable it on Mac for
957 	 * now (until we get more info on how to compute the correct
958 	 * value for various X86 bridges).
959 	 */
960 #ifdef CONFIG_PPC_PMAC
961 	if (machine_is(powermac)) {
962 		/* AGP PLL control */
963 		if (rinfo->family <= CHIP_FAMILY_RV280) {
964 			OUTREG(BUS_CNTL1, INREG(BUS_CNTL1) |  BUS_CNTL1__AGPCLK_VALID);
965 			OUTREG(BUS_CNTL1,
966 			       (INREG(BUS_CNTL1) & ~BUS_CNTL1__MOBILE_PLATFORM_SEL_MASK)
967 			       | (2<<BUS_CNTL1__MOBILE_PLATFORM_SEL__SHIFT));	// 440BX
968 		} else {
969 			OUTREG(BUS_CNTL1, INREG(BUS_CNTL1));
970 			OUTREG(BUS_CNTL1, (INREG(BUS_CNTL1) & ~0x4000) | 0x8000);
971 		}
972 	}
973 #endif
974 
975 	OUTREG(CRTC_OFFSET_CNTL, (INREG(CRTC_OFFSET_CNTL)
976 				  & ~CRTC_OFFSET_CNTL__CRTC_STEREO_SYNC_OUT_EN));
977 
978 	clk_pin_cntl &= ~CLK_PIN_CNTL__CG_CLK_TO_OUTPIN;
979 	clk_pin_cntl |= CLK_PIN_CNTL__XTALIN_ALWAYS_ONb;
980 	OUTPLL( pllCLK_PIN_CNTL, clk_pin_cntl);
981 
982 	/* Solano2M */
983 	OUTREG(AGP_CNTL,
984 		(INREG(AGP_CNTL) & ~(AGP_CNTL__MAX_IDLE_CLK_MASK))
985 		| (0x20<<AGP_CNTL__MAX_IDLE_CLK__SHIFT));
986 
987 	/* ACPI mode */
988 	/* because both INPLL and OUTPLL take the same lock, that's why. */
989 	tmp = INPLL( pllPLL_PWRMGT_CNTL) & ~PLL_PWRMGT_CNTL__PM_MODE_SEL;
990 	OUTPLL( pllPLL_PWRMGT_CNTL, tmp);
991 
992 
993 	disp_mis_cntl = INREG(DISP_MISC_CNTL);
994 
995 	disp_mis_cntl &= ~(	DISP_MISC_CNTL__SOFT_RESET_GRPH_PP |
996 				DISP_MISC_CNTL__SOFT_RESET_SUBPIC_PP |
997 				DISP_MISC_CNTL__SOFT_RESET_OV0_PP |
998 				DISP_MISC_CNTL__SOFT_RESET_GRPH_SCLK|
999 				DISP_MISC_CNTL__SOFT_RESET_SUBPIC_SCLK|
1000 				DISP_MISC_CNTL__SOFT_RESET_OV0_SCLK|
1001 				DISP_MISC_CNTL__SOFT_RESET_GRPH2_PP|
1002 				DISP_MISC_CNTL__SOFT_RESET_GRPH2_SCLK|
1003 				DISP_MISC_CNTL__SOFT_RESET_LVDS|
1004 				DISP_MISC_CNTL__SOFT_RESET_TMDS|
1005 				DISP_MISC_CNTL__SOFT_RESET_DIG_TMDS|
1006 				DISP_MISC_CNTL__SOFT_RESET_TV);
1007 
1008 	OUTREG(DISP_MISC_CNTL, disp_mis_cntl);
1009 
1010 	disp_pwr_man = INREG(DISP_PWR_MAN);
1011 
1012 	disp_pwr_man &= ~(	DISP_PWR_MAN__DISP_PWR_MAN_D3_CRTC_EN	|
1013 				DISP_PWR_MAN__DISP2_PWR_MAN_D3_CRTC2_EN |
1014 				DISP_PWR_MAN__DISP_PWR_MAN_DPMS_MASK|
1015 				DISP_PWR_MAN__DISP_D3_RST|
1016 				DISP_PWR_MAN__DISP_D3_REG_RST
1017 				);
1018 
1019 	disp_pwr_man |= DISP_PWR_MAN__DISP_D3_GRPH_RST|
1020 					DISP_PWR_MAN__DISP_D3_SUBPIC_RST|
1021 					DISP_PWR_MAN__DISP_D3_OV0_RST|
1022 					DISP_PWR_MAN__DISP_D1D2_GRPH_RST|
1023 					DISP_PWR_MAN__DISP_D1D2_SUBPIC_RST|
1024 					DISP_PWR_MAN__DISP_D1D2_OV0_RST|
1025 					DISP_PWR_MAN__DIG_TMDS_ENABLE_RST|
1026 					DISP_PWR_MAN__TV_ENABLE_RST|
1027 //					DISP_PWR_MAN__AUTO_PWRUP_EN|
1028 					0;
1029 
1030 	OUTREG(DISP_PWR_MAN, disp_pwr_man);
1031 
1032 	clk_pwrmgt_cntl = INPLL( pllCLK_PWRMGT_CNTL);
1033 	pll_pwrmgt_cntl = INPLL( pllPLL_PWRMGT_CNTL) ;
1034 	clk_pin_cntl 	= INPLL( pllCLK_PIN_CNTL);
1035 	disp_pwr_man	= INREG(DISP_PWR_MAN);
1036 
1037 
1038 	/* D2 */
1039 	clk_pwrmgt_cntl |= CLK_PWRMGT_CNTL__DISP_PM;
1040 	pll_pwrmgt_cntl |= PLL_PWRMGT_CNTL__MOBILE_SU | PLL_PWRMGT_CNTL__SU_SCLK_USE_BCLK;
1041 	clk_pin_cntl	|= CLK_PIN_CNTL__XTALIN_ALWAYS_ONb;
1042 	disp_pwr_man 	&= ~(DISP_PWR_MAN__DISP_PWR_MAN_D3_CRTC_EN_MASK
1043 			     | DISP_PWR_MAN__DISP2_PWR_MAN_D3_CRTC2_EN_MASK);
1044 
1045 	OUTPLL( pllCLK_PWRMGT_CNTL, clk_pwrmgt_cntl);
1046 	OUTPLL( pllPLL_PWRMGT_CNTL, pll_pwrmgt_cntl);
1047 	OUTPLL( pllCLK_PIN_CNTL, clk_pin_cntl);
1048 	OUTREG(DISP_PWR_MAN, disp_pwr_man);
1049 
1050 	/* disable display request & disable display */
1051 	OUTREG( CRTC_GEN_CNTL, (INREG( CRTC_GEN_CNTL) & ~CRTC_GEN_CNTL__CRTC_EN)
1052 		| CRTC_GEN_CNTL__CRTC_DISP_REQ_EN_B);
1053 	OUTREG( CRTC2_GEN_CNTL, (INREG( CRTC2_GEN_CNTL) & ~CRTC2_GEN_CNTL__CRTC2_EN)
1054 		| CRTC2_GEN_CNTL__CRTC2_DISP_REQ_EN_B);
1055 
1056 	mdelay(17);
1057 
1058 }
1059 
1060 static void radeon_pm_yclk_mclk_sync(struct radeonfb_info *rinfo)
1061 {
1062 	u32 mc_chp_io_cntl_a1, mc_chp_io_cntl_b1;
1063 
1064 	mc_chp_io_cntl_a1 = INMC( rinfo, ixMC_CHP_IO_CNTL_A1)
1065 		& ~MC_CHP_IO_CNTL_A1__MEM_SYNC_ENA_MASK;
1066 	mc_chp_io_cntl_b1 = INMC( rinfo, ixMC_CHP_IO_CNTL_B1)
1067 		& ~MC_CHP_IO_CNTL_B1__MEM_SYNC_ENB_MASK;
1068 
1069 	OUTMC( rinfo, ixMC_CHP_IO_CNTL_A1, mc_chp_io_cntl_a1
1070 	       | (1<<MC_CHP_IO_CNTL_A1__MEM_SYNC_ENA__SHIFT));
1071 	OUTMC( rinfo, ixMC_CHP_IO_CNTL_B1, mc_chp_io_cntl_b1
1072 	       | (1<<MC_CHP_IO_CNTL_B1__MEM_SYNC_ENB__SHIFT));
1073 
1074 	OUTMC( rinfo, ixMC_CHP_IO_CNTL_A1, mc_chp_io_cntl_a1);
1075 	OUTMC( rinfo, ixMC_CHP_IO_CNTL_B1, mc_chp_io_cntl_b1);
1076 
1077 	mdelay( 1);
1078 }
1079 
1080 static void radeon_pm_yclk_mclk_sync_m10(struct radeonfb_info *rinfo)
1081 {
1082 	u32 mc_chp_io_cntl_a1, mc_chp_io_cntl_b1;
1083 
1084 	mc_chp_io_cntl_a1 = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_A1)
1085 		& ~MC_CHP_IO_CNTL_A1__MEM_SYNC_ENA_MASK;
1086 	mc_chp_io_cntl_b1 = INMC(rinfo, ixR300_MC_CHP_IO_CNTL_B1)
1087 		& ~MC_CHP_IO_CNTL_B1__MEM_SYNC_ENB_MASK;
1088 
1089 	OUTMC( rinfo, ixR300_MC_CHP_IO_CNTL_A1,
1090 	       mc_chp_io_cntl_a1 | (1<<MC_CHP_IO_CNTL_A1__MEM_SYNC_ENA__SHIFT));
1091 	OUTMC( rinfo, ixR300_MC_CHP_IO_CNTL_B1,
1092 	       mc_chp_io_cntl_b1 | (1<<MC_CHP_IO_CNTL_B1__MEM_SYNC_ENB__SHIFT));
1093 
1094 	OUTMC( rinfo, ixR300_MC_CHP_IO_CNTL_A1, mc_chp_io_cntl_a1);
1095 	OUTMC( rinfo, ixR300_MC_CHP_IO_CNTL_B1, mc_chp_io_cntl_b1);
1096 
1097 	mdelay( 1);
1098 }
1099 
1100 static void radeon_pm_program_mode_reg(struct radeonfb_info *rinfo, u16 value,
1101 				       u8 delay_required)
1102 {
1103 	u32 mem_sdram_mode;
1104 
1105 	mem_sdram_mode  = INREG( MEM_SDRAM_MODE_REG);
1106 
1107 	mem_sdram_mode &= ~MEM_SDRAM_MODE_REG__MEM_MODE_REG_MASK;
1108 	mem_sdram_mode |= (value<<MEM_SDRAM_MODE_REG__MEM_MODE_REG__SHIFT)
1109 		| MEM_SDRAM_MODE_REG__MEM_CFG_TYPE;
1110 	OUTREG( MEM_SDRAM_MODE_REG, mem_sdram_mode);
1111 	if (delay_required >= 2)
1112 		mdelay(1);
1113 
1114 	mem_sdram_mode |=  MEM_SDRAM_MODE_REG__MEM_SDRAM_RESET;
1115 	OUTREG( MEM_SDRAM_MODE_REG, mem_sdram_mode);
1116 	if (delay_required >= 2)
1117 		mdelay(1);
1118 
1119 	mem_sdram_mode &= ~MEM_SDRAM_MODE_REG__MEM_SDRAM_RESET;
1120 	OUTREG( MEM_SDRAM_MODE_REG, mem_sdram_mode);
1121 	if (delay_required >= 2)
1122 		mdelay(1);
1123 
1124 	if (delay_required) {
1125 		do {
1126 			if (delay_required >= 2)
1127 				mdelay(1);
1128 		} while ((INREG(MC_STATUS)
1129 			  & (MC_STATUS__MEM_PWRUP_COMPL_A |
1130 			     MC_STATUS__MEM_PWRUP_COMPL_B)) == 0);
1131 	}
1132 }
1133 
1134 static void radeon_pm_m10_program_mode_wait(struct radeonfb_info *rinfo)
1135 {
1136 	int cnt;
1137 
1138 	for (cnt = 0; cnt < 100; ++cnt) {
1139 		mdelay(1);
1140 		if (INREG(MC_STATUS) & (MC_STATUS__MEM_PWRUP_COMPL_A
1141 					| MC_STATUS__MEM_PWRUP_COMPL_B))
1142 			break;
1143 	}
1144 }
1145 
1146 
1147 static void radeon_pm_enable_dll(struct radeonfb_info *rinfo)
1148 {
1149 #define DLL_RESET_DELAY 	5
1150 #define DLL_SLEEP_DELAY		1
1151 
1152 	u32 cko = INPLL(pllMDLL_CKO)   | MDLL_CKO__MCKOA_SLEEP
1153 		| MDLL_CKO__MCKOA_RESET;
1154 	u32 cka = INPLL(pllMDLL_RDCKA) | MDLL_RDCKA__MRDCKA0_SLEEP
1155 		| MDLL_RDCKA__MRDCKA1_SLEEP | MDLL_RDCKA__MRDCKA0_RESET
1156 		| MDLL_RDCKA__MRDCKA1_RESET;
1157 	u32 ckb = INPLL(pllMDLL_RDCKB) | MDLL_RDCKB__MRDCKB0_SLEEP
1158 		| MDLL_RDCKB__MRDCKB1_SLEEP | MDLL_RDCKB__MRDCKB0_RESET
1159 		| MDLL_RDCKB__MRDCKB1_RESET;
1160 
1161 	/* Setting up the DLL range for write */
1162 	OUTPLL(pllMDLL_CKO,   	cko);
1163 	OUTPLL(pllMDLL_RDCKA,  	cka);
1164 	OUTPLL(pllMDLL_RDCKB,	ckb);
1165 
1166 	mdelay(DLL_RESET_DELAY*2);
1167 
1168 	cko &= ~(MDLL_CKO__MCKOA_SLEEP | MDLL_CKO__MCKOB_SLEEP);
1169 	OUTPLL(pllMDLL_CKO, cko);
1170 	mdelay(DLL_SLEEP_DELAY);
1171 	cko &= ~(MDLL_CKO__MCKOA_RESET | MDLL_CKO__MCKOB_RESET);
1172 	OUTPLL(pllMDLL_CKO, cko);
1173 	mdelay(DLL_RESET_DELAY);
1174 
1175 	cka &= ~(MDLL_RDCKA__MRDCKA0_SLEEP | MDLL_RDCKA__MRDCKA1_SLEEP);
1176 	OUTPLL(pllMDLL_RDCKA, cka);
1177 	mdelay(DLL_SLEEP_DELAY);
1178 	cka &= ~(MDLL_RDCKA__MRDCKA0_RESET | MDLL_RDCKA__MRDCKA1_RESET);
1179 	OUTPLL(pllMDLL_RDCKA, cka);
1180 	mdelay(DLL_RESET_DELAY);
1181 
1182 	ckb &= ~(MDLL_RDCKB__MRDCKB0_SLEEP | MDLL_RDCKB__MRDCKB1_SLEEP);
1183 	OUTPLL(pllMDLL_RDCKB, ckb);
1184 	mdelay(DLL_SLEEP_DELAY);
1185 	ckb &= ~(MDLL_RDCKB__MRDCKB0_RESET | MDLL_RDCKB__MRDCKB1_RESET);
1186 	OUTPLL(pllMDLL_RDCKB, ckb);
1187 	mdelay(DLL_RESET_DELAY);
1188 
1189 
1190 #undef DLL_RESET_DELAY
1191 #undef DLL_SLEEP_DELAY
1192 }
1193 
1194 static void radeon_pm_enable_dll_m10(struct radeonfb_info *rinfo)
1195 {
1196 	u32 dll_value;
1197 	u32 dll_sleep_mask = 0;
1198 	u32 dll_reset_mask = 0;
1199 	u32 mc;
1200 
1201 #define DLL_RESET_DELAY 	5
1202 #define DLL_SLEEP_DELAY		1
1203 
1204 	OUTMC(rinfo, ixR300_MC_DLL_CNTL, rinfo->save_regs[70]);
1205 	mc = INREG(MC_CNTL);
1206 	/* Check which channels are enabled */
1207 	switch (mc & 0x3) {
1208 	case 1:
1209 		if (mc & 0x4)
1210 			break;
1211 		/* fall through */
1212 	case 2:
1213 		dll_sleep_mask |= MDLL_R300_RDCK__MRDCKB_SLEEP;
1214 		dll_reset_mask |= MDLL_R300_RDCK__MRDCKB_RESET;
1215 		/* fall through */
1216 	case 0:
1217 		dll_sleep_mask |= MDLL_R300_RDCK__MRDCKA_SLEEP;
1218 		dll_reset_mask |= MDLL_R300_RDCK__MRDCKA_RESET;
1219 	}
1220 	switch (mc & 0x3) {
1221 	case 1:
1222 		if (!(mc & 0x4))
1223 			break;
1224 		/* fall through */
1225 	case 2:
1226 		dll_sleep_mask |= MDLL_R300_RDCK__MRDCKD_SLEEP;
1227 		dll_reset_mask |= MDLL_R300_RDCK__MRDCKD_RESET;
1228 		dll_sleep_mask |= MDLL_R300_RDCK__MRDCKC_SLEEP;
1229 		dll_reset_mask |= MDLL_R300_RDCK__MRDCKC_RESET;
1230 	}
1231 
1232 	dll_value = INPLL(pllMDLL_RDCKA);
1233 
1234 	/* Power Up */
1235 	dll_value &= ~(dll_sleep_mask);
1236 	OUTPLL(pllMDLL_RDCKA, dll_value);
1237 	mdelay( DLL_SLEEP_DELAY);
1238 
1239 	dll_value &= ~(dll_reset_mask);
1240 	OUTPLL(pllMDLL_RDCKA, dll_value);
1241 	mdelay( DLL_RESET_DELAY);
1242 
1243 #undef DLL_RESET_DELAY
1244 #undef DLL_SLEEP_DELAY
1245 }
1246 
1247 
1248 static void radeon_pm_full_reset_sdram(struct radeonfb_info *rinfo)
1249 {
1250 	u32 crtcGenCntl, crtcGenCntl2, memRefreshCntl, crtc_more_cntl,
1251 		fp_gen_cntl, fp2_gen_cntl;
1252 
1253 	crtcGenCntl  = INREG( CRTC_GEN_CNTL);
1254 	crtcGenCntl2 = INREG( CRTC2_GEN_CNTL);
1255 
1256 	crtc_more_cntl 	= INREG( CRTC_MORE_CNTL);
1257 	fp_gen_cntl 	= INREG( FP_GEN_CNTL);
1258 	fp2_gen_cntl 	= INREG( FP2_GEN_CNTL);
1259 
1260 
1261 	OUTREG( CRTC_MORE_CNTL, 0);
1262 	OUTREG( FP_GEN_CNTL, 0);
1263 	OUTREG( FP2_GEN_CNTL,0);
1264 
1265 	OUTREG( CRTC_GEN_CNTL,  (crtcGenCntl | CRTC_GEN_CNTL__CRTC_DISP_REQ_EN_B) );
1266 	OUTREG( CRTC2_GEN_CNTL, (crtcGenCntl2 | CRTC2_GEN_CNTL__CRTC2_DISP_REQ_EN_B) );
1267 
1268 	/* This is the code for the Aluminium PowerBooks M10 / iBooks M11 */
1269 	if (rinfo->family == CHIP_FAMILY_RV350) {
1270 		u32 sdram_mode_reg = rinfo->save_regs[35];
1271 		static const u32 default_mrtable[] =
1272 			{ 0x21320032,
1273 			  0x21321000, 0xa1321000, 0x21321000, 0xffffffff,
1274 			  0x21320032, 0xa1320032, 0x21320032, 0xffffffff,
1275 			  0x21321002, 0xa1321002, 0x21321002, 0xffffffff,
1276 			  0x21320132, 0xa1320132, 0x21320132, 0xffffffff,
1277 			  0x21320032, 0xa1320032, 0x21320032, 0xffffffff,
1278 			  0x31320032 };
1279 
1280 		const u32 *mrtable = default_mrtable;
1281 		int i, mrtable_size = ARRAY_SIZE(default_mrtable);
1282 
1283 		mdelay(30);
1284 
1285 		/* Disable refresh */
1286 		memRefreshCntl 	= INREG( MEM_REFRESH_CNTL)
1287 			& ~MEM_REFRESH_CNTL__MEM_REFRESH_DIS;
1288 		OUTREG( MEM_REFRESH_CNTL, memRefreshCntl
1289 			| MEM_REFRESH_CNTL__MEM_REFRESH_DIS);
1290 
1291 		/* Configure and enable M & SPLLs */
1292        		radeon_pm_enable_dll_m10(rinfo);
1293 		radeon_pm_yclk_mclk_sync_m10(rinfo);
1294 
1295 #ifdef CONFIG_PPC
1296 		if (rinfo->of_node != NULL) {
1297 			int size;
1298 
1299 			mrtable = of_get_property(rinfo->of_node, "ATY,MRT", &size);
1300 			if (mrtable)
1301 				mrtable_size = size >> 2;
1302 			else
1303 				mrtable = default_mrtable;
1304 		}
1305 #endif /* CONFIG_PPC */
1306 
1307 		/* Program the SDRAM */
1308 		sdram_mode_reg = mrtable[0];
1309 		OUTREG(MEM_SDRAM_MODE_REG, sdram_mode_reg);
1310 		for (i = 0; i < mrtable_size; i++) {
1311 			if (mrtable[i] == 0xffffffffu)
1312 				radeon_pm_m10_program_mode_wait(rinfo);
1313 			else {
1314 				sdram_mode_reg &= ~(MEM_SDRAM_MODE_REG__MEM_MODE_REG_MASK
1315 						    | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
1316 						    | MEM_SDRAM_MODE_REG__MEM_SDRAM_RESET);
1317 				sdram_mode_reg |= mrtable[i];
1318 
1319 				OUTREG(MEM_SDRAM_MODE_REG, sdram_mode_reg);
1320 				mdelay(1);
1321 			}
1322 		}
1323 
1324 		/* Restore memory refresh */
1325 		OUTREG(MEM_REFRESH_CNTL, memRefreshCntl);
1326 		mdelay(30);
1327 
1328 	}
1329 	/* Here come the desktop RV200 "QW" card */
1330 	else if (!rinfo->is_mobility && rinfo->family == CHIP_FAMILY_RV200) {
1331 		/* Disable refresh */
1332 		memRefreshCntl 	= INREG( MEM_REFRESH_CNTL)
1333 			& ~MEM_REFRESH_CNTL__MEM_REFRESH_DIS;
1334 		OUTREG(MEM_REFRESH_CNTL, memRefreshCntl
1335 		       | MEM_REFRESH_CNTL__MEM_REFRESH_DIS);
1336 		mdelay(30);
1337 
1338 		/* Reset memory */
1339 		OUTREG(MEM_SDRAM_MODE_REG,
1340 		       INREG( MEM_SDRAM_MODE_REG) & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1341 
1342 		radeon_pm_program_mode_reg(rinfo, 0x2002, 2);
1343 		radeon_pm_program_mode_reg(rinfo, 0x0132, 2);
1344 		radeon_pm_program_mode_reg(rinfo, 0x0032, 2);
1345 
1346 		OUTREG(MEM_SDRAM_MODE_REG,
1347 		       INREG(MEM_SDRAM_MODE_REG) | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1348 
1349 		OUTREG( MEM_REFRESH_CNTL, 	memRefreshCntl);
1350 
1351 	}
1352 	/* The M6 */
1353 	else if (rinfo->is_mobility && rinfo->family == CHIP_FAMILY_RV100) {
1354 		/* Disable refresh */
1355 		memRefreshCntl = INREG(EXT_MEM_CNTL) & ~(1 << 20);
1356 		OUTREG( EXT_MEM_CNTL, memRefreshCntl | (1 << 20));
1357 
1358 		/* Reset memory */
1359 		OUTREG( MEM_SDRAM_MODE_REG,
1360 			INREG( MEM_SDRAM_MODE_REG)
1361 			& ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1362 
1363 		/* DLL */
1364 		radeon_pm_enable_dll(rinfo);
1365 
1366 		/* MLCK / YCLK sync */
1367 		radeon_pm_yclk_mclk_sync(rinfo);
1368 
1369 		/* Program Mode Register */
1370 		radeon_pm_program_mode_reg(rinfo, 0x2000, 1);
1371 		radeon_pm_program_mode_reg(rinfo, 0x2001, 1);
1372 		radeon_pm_program_mode_reg(rinfo, 0x2002, 1);
1373 		radeon_pm_program_mode_reg(rinfo, 0x0132, 1);
1374 		radeon_pm_program_mode_reg(rinfo, 0x0032, 1);
1375 
1376 		/* Complete & re-enable refresh */
1377 		OUTREG( MEM_SDRAM_MODE_REG,
1378 			INREG( MEM_SDRAM_MODE_REG) | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1379 
1380 		OUTREG(EXT_MEM_CNTL, memRefreshCntl);
1381 	}
1382 	/* And finally, the M7..M9 models, including M9+ (RV280) */
1383 	else if (rinfo->is_mobility) {
1384 
1385 		/* Disable refresh */
1386 		memRefreshCntl 	= INREG( MEM_REFRESH_CNTL)
1387 			& ~MEM_REFRESH_CNTL__MEM_REFRESH_DIS;
1388 		OUTREG( MEM_REFRESH_CNTL, memRefreshCntl
1389 			| MEM_REFRESH_CNTL__MEM_REFRESH_DIS);
1390 
1391 		/* Reset memory */
1392 		OUTREG( MEM_SDRAM_MODE_REG,
1393 			INREG( MEM_SDRAM_MODE_REG)
1394 			& ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1395 
1396 		/* DLL */
1397 		radeon_pm_enable_dll(rinfo);
1398 
1399 		/* MLCK / YCLK sync */
1400 		radeon_pm_yclk_mclk_sync(rinfo);
1401 
1402 		/* M6, M7 and M9 so far ... */
1403 		if (rinfo->family <= CHIP_FAMILY_RV250) {
1404 			radeon_pm_program_mode_reg(rinfo, 0x2000, 1);
1405 			radeon_pm_program_mode_reg(rinfo, 0x2001, 1);
1406 			radeon_pm_program_mode_reg(rinfo, 0x2002, 1);
1407 			radeon_pm_program_mode_reg(rinfo, 0x0132, 1);
1408 			radeon_pm_program_mode_reg(rinfo, 0x0032, 1);
1409 		}
1410 		/* M9+ (iBook G4) */
1411 		else if (rinfo->family == CHIP_FAMILY_RV280) {
1412 			radeon_pm_program_mode_reg(rinfo, 0x2000, 1);
1413 			radeon_pm_program_mode_reg(rinfo, 0x0132, 1);
1414 			radeon_pm_program_mode_reg(rinfo, 0x0032, 1);
1415 		}
1416 
1417 		/* Complete & re-enable refresh */
1418 		OUTREG( MEM_SDRAM_MODE_REG,
1419 			INREG( MEM_SDRAM_MODE_REG) | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1420 
1421 		OUTREG( MEM_REFRESH_CNTL, 	memRefreshCntl);
1422 	}
1423 
1424 	OUTREG( CRTC_GEN_CNTL, 		crtcGenCntl);
1425 	OUTREG( CRTC2_GEN_CNTL, 	crtcGenCntl2);
1426 	OUTREG( FP_GEN_CNTL, 		fp_gen_cntl);
1427 	OUTREG( FP2_GEN_CNTL, 		fp2_gen_cntl);
1428 
1429 	OUTREG( CRTC_MORE_CNTL, 	crtc_more_cntl);
1430 
1431 	mdelay( 15);
1432 }
1433 
1434 #if defined(CONFIG_PM)
1435 #if defined(CONFIG_X86) || defined(CONFIG_PPC_PMAC)
1436 static void radeon_pm_reset_pad_ctlr_strength(struct radeonfb_info *rinfo)
1437 {
1438 	u32 tmp, tmp2;
1439 	int i,j;
1440 
1441 	/* Reset the PAD_CTLR_STRENGTH & wait for it to be stable */
1442 	INREG(PAD_CTLR_STRENGTH);
1443 	OUTREG(PAD_CTLR_STRENGTH, INREG(PAD_CTLR_STRENGTH) & ~PAD_MANUAL_OVERRIDE);
1444 	tmp = INREG(PAD_CTLR_STRENGTH);
1445 	for (i = j = 0; i < 65; ++i) {
1446 		mdelay(1);
1447 		tmp2 = INREG(PAD_CTLR_STRENGTH);
1448 		if (tmp != tmp2) {
1449 			tmp = tmp2;
1450 			i = 0;
1451 			j++;
1452 			if (j > 10) {
1453 				printk(KERN_WARNING "radeon: PAD_CTLR_STRENGTH doesn't "
1454 				       "stabilize !\n");
1455 				break;
1456 			}
1457 		}
1458 	}
1459 }
1460 
1461 static void radeon_pm_all_ppls_off(struct radeonfb_info *rinfo)
1462 {
1463 	u32 tmp;
1464 
1465 	tmp = INPLL(pllPPLL_CNTL);
1466 	OUTPLL(pllPPLL_CNTL, tmp | 0x3);
1467 	tmp = INPLL(pllP2PLL_CNTL);
1468 	OUTPLL(pllP2PLL_CNTL, tmp | 0x3);
1469 	tmp = INPLL(pllSPLL_CNTL);
1470 	OUTPLL(pllSPLL_CNTL, tmp | 0x3);
1471 	tmp = INPLL(pllMPLL_CNTL);
1472 	OUTPLL(pllMPLL_CNTL, tmp | 0x3);
1473 }
1474 
1475 static void radeon_pm_start_mclk_sclk(struct radeonfb_info *rinfo)
1476 {
1477 	u32 tmp;
1478 
1479 	/* Switch SPLL to PCI source */
1480 	tmp = INPLL(pllSCLK_CNTL);
1481 	OUTPLL(pllSCLK_CNTL, tmp & ~SCLK_CNTL__SCLK_SRC_SEL_MASK);
1482 
1483 	/* Reconfigure SPLL charge pump, VCO gain, duty cycle */
1484 	tmp = INPLL(pllSPLL_CNTL);
1485 	OUTREG8(CLOCK_CNTL_INDEX, pllSPLL_CNTL + PLL_WR_EN);
1486 	radeon_pll_errata_after_index(rinfo);
1487 	OUTREG8(CLOCK_CNTL_DATA + 1, (tmp >> 8) & 0xff);
1488 	radeon_pll_errata_after_data(rinfo);
1489 
1490 	/* Set SPLL feedback divider */
1491 	tmp = INPLL(pllM_SPLL_REF_FB_DIV);
1492 	tmp = (tmp & 0xff00fffful) | (rinfo->save_regs[77] & 0x00ff0000ul);
1493 	OUTPLL(pllM_SPLL_REF_FB_DIV, tmp);
1494 
1495 	/* Power up SPLL */
1496 	tmp = INPLL(pllSPLL_CNTL);
1497 	OUTPLL(pllSPLL_CNTL, tmp & ~1);
1498 	(void)INPLL(pllSPLL_CNTL);
1499 
1500 	mdelay(10);
1501 
1502 	/* Release SPLL reset */
1503 	tmp = INPLL(pllSPLL_CNTL);
1504 	OUTPLL(pllSPLL_CNTL, tmp & ~0x2);
1505 	(void)INPLL(pllSPLL_CNTL);
1506 
1507 	mdelay(10);
1508 
1509 	/* Select SCLK source  */
1510 	tmp = INPLL(pllSCLK_CNTL);
1511 	tmp &= ~SCLK_CNTL__SCLK_SRC_SEL_MASK;
1512 	tmp |= rinfo->save_regs[3] & SCLK_CNTL__SCLK_SRC_SEL_MASK;
1513 	OUTPLL(pllSCLK_CNTL, tmp);
1514 	(void)INPLL(pllSCLK_CNTL);
1515 
1516 	mdelay(10);
1517 
1518 	/* Reconfigure MPLL charge pump, VCO gain, duty cycle */
1519 	tmp = INPLL(pllMPLL_CNTL);
1520 	OUTREG8(CLOCK_CNTL_INDEX, pllMPLL_CNTL + PLL_WR_EN);
1521 	radeon_pll_errata_after_index(rinfo);
1522 	OUTREG8(CLOCK_CNTL_DATA + 1, (tmp >> 8) & 0xff);
1523 	radeon_pll_errata_after_data(rinfo);
1524 
1525 	/* Set MPLL feedback divider */
1526 	tmp = INPLL(pllM_SPLL_REF_FB_DIV);
1527 	tmp = (tmp & 0xffff00fful) | (rinfo->save_regs[77] & 0x0000ff00ul);
1528 
1529 	OUTPLL(pllM_SPLL_REF_FB_DIV, tmp);
1530 	/* Power up MPLL */
1531 	tmp = INPLL(pllMPLL_CNTL);
1532 	OUTPLL(pllMPLL_CNTL, tmp & ~0x2);
1533 	(void)INPLL(pllMPLL_CNTL);
1534 
1535 	mdelay(10);
1536 
1537 	/* Un-reset MPLL */
1538 	tmp = INPLL(pllMPLL_CNTL);
1539 	OUTPLL(pllMPLL_CNTL, tmp & ~0x1);
1540 	(void)INPLL(pllMPLL_CNTL);
1541 
1542 	mdelay(10);
1543 
1544 	/* Select source for MCLK */
1545 	tmp = INPLL(pllMCLK_CNTL);
1546 	tmp |= rinfo->save_regs[2] & 0xffff;
1547 	OUTPLL(pllMCLK_CNTL, tmp);
1548 	(void)INPLL(pllMCLK_CNTL);
1549 
1550 	mdelay(10);
1551 }
1552 
1553 static void radeon_pm_m10_disable_spread_spectrum(struct radeonfb_info *rinfo)
1554 {
1555 	u32 r2ec;
1556 
1557 	/* GACK ! I though we didn't have a DDA on Radeon's anymore
1558 	 * here we rewrite with the same value, ... I suppose we clear
1559 	 * some bits that are already clear ? Or maybe this 0x2ec
1560 	 * register is something new ?
1561 	 */
1562 	mdelay(20);
1563 	r2ec = INREG(VGA_DDA_ON_OFF);
1564 	OUTREG(VGA_DDA_ON_OFF, r2ec);
1565 	mdelay(1);
1566 
1567 	/* Spread spectrum PLLL off */
1568 	OUTPLL(pllSSPLL_CNTL, 0xbf03);
1569 
1570 	/* Spread spectrum disabled */
1571 	OUTPLL(pllSS_INT_CNTL, rinfo->save_regs[90] & ~3);
1572 
1573 	/* The trace shows read & rewrite of LVDS_PLL_CNTL here with same
1574 	 * value, not sure what for...
1575 	 */
1576 
1577 	r2ec |= 0x3f0;
1578 	OUTREG(VGA_DDA_ON_OFF, r2ec);
1579 	mdelay(1);
1580 }
1581 
1582 static void radeon_pm_m10_enable_lvds_spread_spectrum(struct radeonfb_info *rinfo)
1583 {
1584 	u32 r2ec, tmp;
1585 
1586 	/* GACK (bis) ! I though we didn't have a DDA on Radeon's anymore
1587 	 * here we rewrite with the same value, ... I suppose we clear/set
1588 	 * some bits that are already clear/set ?
1589 	 */
1590 	r2ec = INREG(VGA_DDA_ON_OFF);
1591 	OUTREG(VGA_DDA_ON_OFF, r2ec);
1592 	mdelay(1);
1593 
1594 	/* Enable spread spectrum */
1595 	OUTPLL(pllSSPLL_CNTL, rinfo->save_regs[43] | 3);
1596 	mdelay(3);
1597 
1598 	OUTPLL(pllSSPLL_REF_DIV, rinfo->save_regs[44]);
1599 	OUTPLL(pllSSPLL_DIV_0, rinfo->save_regs[45]);
1600 	tmp = INPLL(pllSSPLL_CNTL);
1601 	OUTPLL(pllSSPLL_CNTL, tmp & ~0x2);
1602 	mdelay(6);
1603 	tmp = INPLL(pllSSPLL_CNTL);
1604 	OUTPLL(pllSSPLL_CNTL, tmp & ~0x1);
1605 	mdelay(5);
1606 
1607        	OUTPLL(pllSS_INT_CNTL, rinfo->save_regs[90]);
1608 
1609 	r2ec |= 8;
1610 	OUTREG(VGA_DDA_ON_OFF, r2ec);
1611 	mdelay(20);
1612 
1613 	/* Enable LVDS interface */
1614 	tmp = INREG(LVDS_GEN_CNTL);
1615 	OUTREG(LVDS_GEN_CNTL, tmp | LVDS_EN);
1616 
1617 	/* Enable LVDS_PLL */
1618 	tmp = INREG(LVDS_PLL_CNTL);
1619 	tmp &= ~0x30000;
1620 	tmp |= 0x10000;
1621 	OUTREG(LVDS_PLL_CNTL, tmp);
1622 
1623 	OUTPLL(pllSCLK_MORE_CNTL, rinfo->save_regs[34]);
1624 	OUTPLL(pllSS_TST_CNTL, rinfo->save_regs[91]);
1625 
1626 	/* The trace reads that one here, waiting for something to settle down ? */
1627 	INREG(RBBM_STATUS);
1628 
1629 	/* Ugh ? SS_TST_DEC is supposed to be a read register in the
1630 	 * R300 register spec at least...
1631 	 */
1632 	tmp = INPLL(pllSS_TST_CNTL);
1633 	tmp |= 0x00400000;
1634 	OUTPLL(pllSS_TST_CNTL, tmp);
1635 }
1636 
1637 static void radeon_pm_restore_pixel_pll(struct radeonfb_info *rinfo)
1638 {
1639 	u32 tmp;
1640 
1641 	OUTREG8(CLOCK_CNTL_INDEX, pllHTOTAL_CNTL + PLL_WR_EN);
1642 	radeon_pll_errata_after_index(rinfo);
1643 	OUTREG8(CLOCK_CNTL_DATA, 0);
1644 	radeon_pll_errata_after_data(rinfo);
1645 
1646 	tmp = INPLL(pllVCLK_ECP_CNTL);
1647 	OUTPLL(pllVCLK_ECP_CNTL, tmp | 0x80);
1648 	mdelay(5);
1649 
1650 	tmp = INPLL(pllPPLL_REF_DIV);
1651 	tmp = (tmp & ~PPLL_REF_DIV_MASK) | rinfo->pll.ref_div;
1652 	OUTPLL(pllPPLL_REF_DIV, tmp);
1653 	INPLL(pllPPLL_REF_DIV);
1654 
1655 	/* Reconfigure SPLL charge pump, VCO gain, duty cycle,
1656 	 * probably useless since we already did it ...
1657 	 */
1658 	tmp = INPLL(pllPPLL_CNTL);
1659 	OUTREG8(CLOCK_CNTL_INDEX, pllSPLL_CNTL + PLL_WR_EN);
1660 	radeon_pll_errata_after_index(rinfo);
1661 	OUTREG8(CLOCK_CNTL_DATA + 1, (tmp >> 8) & 0xff);
1662 	radeon_pll_errata_after_data(rinfo);
1663 
1664 	/* Restore our "reference" PPLL divider set by firmware
1665 	 * according to proper spread spectrum calculations
1666 	 */
1667 	OUTPLL(pllPPLL_DIV_0, rinfo->save_regs[92]);
1668 
1669 	tmp = INPLL(pllPPLL_CNTL);
1670 	OUTPLL(pllPPLL_CNTL, tmp & ~0x2);
1671 	mdelay(5);
1672 
1673 	tmp = INPLL(pllPPLL_CNTL);
1674 	OUTPLL(pllPPLL_CNTL, tmp & ~0x1);
1675 	mdelay(5);
1676 
1677 	tmp = INPLL(pllVCLK_ECP_CNTL);
1678 	OUTPLL(pllVCLK_ECP_CNTL, tmp | 3);
1679 	mdelay(5);
1680 
1681 	tmp = INPLL(pllVCLK_ECP_CNTL);
1682 	OUTPLL(pllVCLK_ECP_CNTL, tmp | 3);
1683 	mdelay(5);
1684 
1685 	/* Switch pixel clock to firmware default div 0 */
1686 	OUTREG8(CLOCK_CNTL_INDEX+1, 0);
1687 	radeon_pll_errata_after_index(rinfo);
1688 	radeon_pll_errata_after_data(rinfo);
1689 }
1690 
1691 static void radeon_pm_m10_reconfigure_mc(struct radeonfb_info *rinfo)
1692 {
1693 	OUTREG(MC_CNTL, rinfo->save_regs[46]);
1694 	OUTREG(MC_INIT_GFX_LAT_TIMER, rinfo->save_regs[47]);
1695 	OUTREG(MC_INIT_MISC_LAT_TIMER, rinfo->save_regs[48]);
1696 	OUTREG(MEM_SDRAM_MODE_REG,
1697 	       rinfo->save_regs[35] & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1698 	OUTREG(MC_TIMING_CNTL, rinfo->save_regs[49]);
1699 	OUTREG(MEM_REFRESH_CNTL, rinfo->save_regs[42]);
1700 	OUTREG(MC_READ_CNTL_AB, rinfo->save_regs[50]);
1701 	OUTREG(MC_CHIP_IO_OE_CNTL_AB, rinfo->save_regs[52]);
1702 	OUTREG(MC_IOPAD_CNTL, rinfo->save_regs[51]);
1703 	OUTREG(MC_DEBUG, rinfo->save_regs[53]);
1704 
1705 	OUTMC(rinfo, ixR300_MC_MC_INIT_WR_LAT_TIMER, rinfo->save_regs[58]);
1706 	OUTMC(rinfo, ixR300_MC_IMP_CNTL, rinfo->save_regs[59]);
1707 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_C0, rinfo->save_regs[60]);
1708 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_C1, rinfo->save_regs[61]);
1709 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_D0, rinfo->save_regs[62]);
1710 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_D1, rinfo->save_regs[63]);
1711 	OUTMC(rinfo, ixR300_MC_BIST_CNTL_3, rinfo->save_regs[64]);
1712 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_A0, rinfo->save_regs[65]);
1713 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_A1, rinfo->save_regs[66]);
1714 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_B0, rinfo->save_regs[67]);
1715 	OUTMC(rinfo, ixR300_MC_CHP_IO_CNTL_B1, rinfo->save_regs[68]);
1716 	OUTMC(rinfo, ixR300_MC_DEBUG_CNTL, rinfo->save_regs[69]);
1717 	OUTMC(rinfo, ixR300_MC_DLL_CNTL, rinfo->save_regs[70]);
1718 	OUTMC(rinfo, ixR300_MC_IMP_CNTL_0, rinfo->save_regs[71]);
1719 	OUTMC(rinfo, ixR300_MC_ELPIDA_CNTL, rinfo->save_regs[72]);
1720 	OUTMC(rinfo, ixR300_MC_READ_CNTL_CD, rinfo->save_regs[96]);
1721 	OUTREG(MC_IND_INDEX, 0);
1722 }
1723 
1724 static void radeon_reinitialize_M10(struct radeonfb_info *rinfo)
1725 {
1726 	u32 tmp, i;
1727 
1728 	/* Restore a bunch of registers first */
1729 	OUTREG(MC_AGP_LOCATION, rinfo->save_regs[32]);
1730 	OUTREG(DISPLAY_BASE_ADDR, rinfo->save_regs[31]);
1731 	OUTREG(CRTC2_DISPLAY_BASE_ADDR, rinfo->save_regs[33]);
1732 	OUTREG(MC_FB_LOCATION, rinfo->save_regs[30]);
1733 	OUTREG(OV0_BASE_ADDR, rinfo->save_regs[80]);
1734 	OUTREG(CNFG_MEMSIZE, rinfo->video_ram);
1735 	OUTREG(BUS_CNTL, rinfo->save_regs[36]);
1736 	OUTREG(BUS_CNTL1, rinfo->save_regs[14]);
1737 	OUTREG(MPP_TB_CONFIG, rinfo->save_regs[37]);
1738 	OUTREG(FCP_CNTL, rinfo->save_regs[38]);
1739 	OUTREG(RBBM_CNTL, rinfo->save_regs[39]);
1740 	OUTREG(DAC_CNTL, rinfo->save_regs[40]);
1741 	OUTREG(DAC_MACRO_CNTL, (INREG(DAC_MACRO_CNTL) & ~0x6) | 8);
1742 	OUTREG(DAC_MACRO_CNTL, (INREG(DAC_MACRO_CNTL) & ~0x6) | 8);
1743 
1744 	/* Hrm... */
1745 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) | DAC2_EXPAND_MODE);
1746 
1747 	/* Reset the PAD CTLR */
1748 	radeon_pm_reset_pad_ctlr_strength(rinfo);
1749 
1750 	/* Some PLLs are Read & written identically in the trace here...
1751 	 * I suppose it's actually to switch them all off & reset,
1752 	 * let's assume off is what we want. I'm just doing that for all major PLLs now.
1753 	 */
1754 	radeon_pm_all_ppls_off(rinfo);
1755 
1756 	/* Clear tiling, reset swappers */
1757 	INREG(SURFACE_CNTL);
1758 	OUTREG(SURFACE_CNTL, 0);
1759 
1760 	/* Some black magic with TV_DAC_CNTL, we should restore those from backups
1761 	 * rather than hard coding...
1762 	 */
1763 	tmp = INREG(TV_DAC_CNTL) & ~TV_DAC_CNTL_BGADJ_MASK;
1764 	tmp |= 8 << TV_DAC_CNTL_BGADJ__SHIFT;
1765 	OUTREG(TV_DAC_CNTL, tmp);
1766 
1767 	tmp = INREG(TV_DAC_CNTL) & ~TV_DAC_CNTL_DACADJ_MASK;
1768 	tmp |= 7 << TV_DAC_CNTL_DACADJ__SHIFT;
1769 	OUTREG(TV_DAC_CNTL, tmp);
1770 
1771 	/* More registers restored */
1772 	OUTREG(AGP_CNTL, rinfo->save_regs[16]);
1773 	OUTREG(HOST_PATH_CNTL, rinfo->save_regs[41]);
1774 	OUTREG(DISP_MISC_CNTL, rinfo->save_regs[9]);
1775 
1776 	/* Hrmmm ... What is that ? */
1777 	tmp = rinfo->save_regs[1]
1778 		& ~(CLK_PWRMGT_CNTL__ACTIVE_HILO_LAT_MASK |
1779 		    CLK_PWRMGT_CNTL__MC_BUSY);
1780 	OUTPLL(pllCLK_PWRMGT_CNTL, tmp);
1781 
1782 	OUTREG(PAD_CTLR_MISC, rinfo->save_regs[56]);
1783 	OUTREG(FW_CNTL, rinfo->save_regs[57]);
1784 	OUTREG(HDP_DEBUG, rinfo->save_regs[96]);
1785 	OUTREG(PAMAC0_DLY_CNTL, rinfo->save_regs[54]);
1786 	OUTREG(PAMAC1_DLY_CNTL, rinfo->save_regs[55]);
1787 	OUTREG(PAMAC2_DLY_CNTL, rinfo->save_regs[79]);
1788 
1789 	/* Restore Memory Controller configuration */
1790 	radeon_pm_m10_reconfigure_mc(rinfo);
1791 
1792 	/* Make sure CRTC's dont touch memory */
1793 	OUTREG(CRTC_GEN_CNTL, INREG(CRTC_GEN_CNTL)
1794 	       | CRTC_GEN_CNTL__CRTC_DISP_REQ_EN_B);
1795 	OUTREG(CRTC2_GEN_CNTL, INREG(CRTC2_GEN_CNTL)
1796 	       | CRTC2_GEN_CNTL__CRTC2_DISP_REQ_EN_B);
1797 	mdelay(30);
1798 
1799 	/* Disable SDRAM refresh */
1800 	OUTREG(MEM_REFRESH_CNTL, INREG(MEM_REFRESH_CNTL)
1801 	       | MEM_REFRESH_CNTL__MEM_REFRESH_DIS);
1802 
1803 	/* Restore XTALIN routing (CLK_PIN_CNTL) */
1804 	OUTPLL(pllCLK_PIN_CNTL, rinfo->save_regs[4]);
1805 
1806 	/* Switch MCLK, YCLK and SCLK PLLs to PCI source & force them ON */
1807 	tmp = rinfo->save_regs[2] & 0xff000000;
1808 	tmp |=	MCLK_CNTL__FORCE_MCLKA |
1809 		MCLK_CNTL__FORCE_MCLKB |
1810 		MCLK_CNTL__FORCE_YCLKA |
1811 		MCLK_CNTL__FORCE_YCLKB |
1812 		MCLK_CNTL__FORCE_MC;
1813 	OUTPLL(pllMCLK_CNTL, tmp);
1814 
1815 	/* Force all clocks on in SCLK */
1816 	tmp = INPLL(pllSCLK_CNTL);
1817 	tmp |=	SCLK_CNTL__FORCE_DISP2|
1818 		SCLK_CNTL__FORCE_CP|
1819 		SCLK_CNTL__FORCE_HDP|
1820 		SCLK_CNTL__FORCE_DISP1|
1821 		SCLK_CNTL__FORCE_TOP|
1822 		SCLK_CNTL__FORCE_E2|
1823 		SCLK_CNTL__FORCE_SE|
1824 		SCLK_CNTL__FORCE_IDCT|
1825 		SCLK_CNTL__FORCE_VIP|
1826 		SCLK_CNTL__FORCE_PB|
1827 		SCLK_CNTL__FORCE_TAM|
1828 		SCLK_CNTL__FORCE_TDM|
1829 		SCLK_CNTL__FORCE_RB|
1830 		SCLK_CNTL__FORCE_TV_SCLK|
1831 		SCLK_CNTL__FORCE_SUBPIC|
1832 		SCLK_CNTL__FORCE_OV0;
1833 	tmp |=	SCLK_CNTL__CP_MAX_DYN_STOP_LAT  |
1834 		SCLK_CNTL__HDP_MAX_DYN_STOP_LAT |
1835 		SCLK_CNTL__TV_MAX_DYN_STOP_LAT  |
1836 		SCLK_CNTL__E2_MAX_DYN_STOP_LAT  |
1837 		SCLK_CNTL__SE_MAX_DYN_STOP_LAT  |
1838 		SCLK_CNTL__IDCT_MAX_DYN_STOP_LAT|
1839 		SCLK_CNTL__VIP_MAX_DYN_STOP_LAT |
1840 		SCLK_CNTL__RE_MAX_DYN_STOP_LAT  |
1841 		SCLK_CNTL__PB_MAX_DYN_STOP_LAT  |
1842 		SCLK_CNTL__TAM_MAX_DYN_STOP_LAT |
1843 		SCLK_CNTL__TDM_MAX_DYN_STOP_LAT |
1844 		SCLK_CNTL__RB_MAX_DYN_STOP_LAT;
1845 	OUTPLL(pllSCLK_CNTL, tmp);
1846 
1847 	OUTPLL(pllVCLK_ECP_CNTL, 0);
1848 	OUTPLL(pllPIXCLKS_CNTL, 0);
1849 	OUTPLL(pllMCLK_MISC,
1850 	       MCLK_MISC__MC_MCLK_MAX_DYN_STOP_LAT |
1851 	       MCLK_MISC__IO_MCLK_MAX_DYN_STOP_LAT);
1852 
1853 	mdelay(5);
1854 
1855 	/* Restore the M_SPLL_REF_FB_DIV, MPLL_AUX_CNTL and SPLL_AUX_CNTL values */
1856 	OUTPLL(pllM_SPLL_REF_FB_DIV, rinfo->save_regs[77]);
1857 	OUTPLL(pllMPLL_AUX_CNTL, rinfo->save_regs[75]);
1858 	OUTPLL(pllSPLL_AUX_CNTL, rinfo->save_regs[76]);
1859 
1860 	/* Now restore the major PLLs settings, keeping them off & reset though */
1861 	OUTPLL(pllPPLL_CNTL, rinfo->save_regs[93] | 0x3);
1862 	OUTPLL(pllP2PLL_CNTL, rinfo->save_regs[8] | 0x3);
1863 	OUTPLL(pllMPLL_CNTL, rinfo->save_regs[73] | 0x03);
1864 	OUTPLL(pllSPLL_CNTL, rinfo->save_regs[74] | 0x03);
1865 
1866 	/* Restore MC DLL state and switch it off/reset too  */
1867 	OUTMC(rinfo, ixR300_MC_DLL_CNTL, rinfo->save_regs[70]);
1868 
1869 	/* Switch MDLL off & reset */
1870 	OUTPLL(pllMDLL_RDCKA, rinfo->save_regs[98] | 0xff);
1871 	mdelay(5);
1872 
1873 	/* Setup some black magic bits in PLL_PWRMGT_CNTL. Hrm... we saved
1874 	 * 0xa1100007... and MacOS writes 0xa1000007 ..
1875 	 */
1876 	OUTPLL(pllPLL_PWRMGT_CNTL, rinfo->save_regs[0]);
1877 
1878 	/* Restore more stuffs */
1879 	OUTPLL(pllHTOTAL_CNTL, 0);
1880 	OUTPLL(pllHTOTAL2_CNTL, 0);
1881 
1882 	/* More PLL initial configuration */
1883 	tmp = INPLL(pllSCLK_CNTL2); /* What for ? */
1884 	OUTPLL(pllSCLK_CNTL2, tmp);
1885 
1886 	tmp = INPLL(pllSCLK_MORE_CNTL);
1887 	tmp |= 	SCLK_MORE_CNTL__FORCE_DISPREGS |	/* a guess */
1888 		SCLK_MORE_CNTL__FORCE_MC_GUI |
1889 		SCLK_MORE_CNTL__FORCE_MC_HOST;
1890 	OUTPLL(pllSCLK_MORE_CNTL, tmp);
1891 
1892 	/* Now we actually start MCLK and SCLK */
1893 	radeon_pm_start_mclk_sclk(rinfo);
1894 
1895 	/* Full reset sdrams, this also re-inits the MDLL */
1896 	radeon_pm_full_reset_sdram(rinfo);
1897 
1898 	/* Fill palettes */
1899 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) | 0x20);
1900 	for (i=0; i<256; i++)
1901 		OUTREG(PALETTE_30_DATA, 0x15555555);
1902 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) & ~20);
1903 	udelay(20);
1904 	for (i=0; i<256; i++)
1905 		OUTREG(PALETTE_30_DATA, 0x15555555);
1906 
1907 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) & ~0x20);
1908 	mdelay(3);
1909 
1910 	/* Restore TMDS */
1911 	OUTREG(FP_GEN_CNTL, rinfo->save_regs[82]);
1912 	OUTREG(FP2_GEN_CNTL, rinfo->save_regs[83]);
1913 
1914 	/* Set LVDS registers but keep interface & pll down */
1915 	OUTREG(LVDS_GEN_CNTL, rinfo->save_regs[11] &
1916 	       ~(LVDS_EN | LVDS_ON | LVDS_DIGON | LVDS_BLON | LVDS_BL_MOD_EN));
1917 	OUTREG(LVDS_PLL_CNTL, (rinfo->save_regs[12] & ~0xf0000) | 0x20000);
1918 
1919 	OUTREG(DISP_OUTPUT_CNTL, rinfo->save_regs[86]);
1920 
1921 	/* Restore GPIOPAD state */
1922 	OUTREG(GPIOPAD_A, rinfo->save_regs[19]);
1923 	OUTREG(GPIOPAD_EN, rinfo->save_regs[20]);
1924 	OUTREG(GPIOPAD_MASK, rinfo->save_regs[21]);
1925 
1926 	/* write some stuff to the framebuffer... */
1927 	for (i = 0; i < 0x8000; ++i)
1928 		writeb(0, rinfo->fb_base + i);
1929 
1930 	mdelay(40);
1931 	OUTREG(LVDS_GEN_CNTL, INREG(LVDS_GEN_CNTL) | LVDS_DIGON | LVDS_ON);
1932 	mdelay(40);
1933 
1934 	/* Restore a few more things */
1935 	OUTREG(GRPH_BUFFER_CNTL, rinfo->save_regs[94]);
1936 	OUTREG(GRPH2_BUFFER_CNTL, rinfo->save_regs[95]);
1937 
1938 	/* Take care of spread spectrum & PPLLs now */
1939 	radeon_pm_m10_disable_spread_spectrum(rinfo);
1940 	radeon_pm_restore_pixel_pll(rinfo);
1941 
1942 	/* GRRRR... I can't figure out the proper LVDS power sequence, and the
1943 	 * code I have for blank/unblank doesn't quite work on some laptop models
1944 	 * it seems ... Hrm. What I have here works most of the time ...
1945 	 */
1946 	radeon_pm_m10_enable_lvds_spread_spectrum(rinfo);
1947 }
1948 #endif
1949 
1950 #ifdef CONFIG_PPC
1951 #ifdef CONFIG_PPC_PMAC
1952 static void radeon_pm_m9p_reconfigure_mc(struct radeonfb_info *rinfo)
1953 {
1954 	OUTREG(MC_CNTL, rinfo->save_regs[46]);
1955 	OUTREG(MC_INIT_GFX_LAT_TIMER, rinfo->save_regs[47]);
1956 	OUTREG(MC_INIT_MISC_LAT_TIMER, rinfo->save_regs[48]);
1957 	OUTREG(MEM_SDRAM_MODE_REG,
1958 	       rinfo->save_regs[35] & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE);
1959 	OUTREG(MC_TIMING_CNTL, rinfo->save_regs[49]);
1960 	OUTREG(MC_READ_CNTL_AB, rinfo->save_regs[50]);
1961 	OUTREG(MEM_REFRESH_CNTL, rinfo->save_regs[42]);
1962 	OUTREG(MC_IOPAD_CNTL, rinfo->save_regs[51]);
1963 	OUTREG(MC_DEBUG, rinfo->save_regs[53]);
1964 	OUTREG(MC_CHIP_IO_OE_CNTL_AB, rinfo->save_regs[52]);
1965 
1966 	OUTMC(rinfo, ixMC_IMP_CNTL, rinfo->save_regs[59] /*0x00f460d6*/);
1967 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_A0, rinfo->save_regs[65] /*0xfecfa666*/);
1968 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_A1, rinfo->save_regs[66] /*0x141555ff*/);
1969 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_B0, rinfo->save_regs[67] /*0xfecfa666*/);
1970 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_B1, rinfo->save_regs[68] /*0x141555ff*/);
1971 	OUTMC(rinfo, ixMC_IMP_CNTL_0, rinfo->save_regs[71] /*0x00009249*/);
1972 	OUTREG(MC_IND_INDEX, 0);
1973 	OUTREG(CNFG_MEMSIZE, rinfo->video_ram);
1974 
1975 	mdelay(20);
1976 }
1977 
1978 static void radeon_reinitialize_M9P(struct radeonfb_info *rinfo)
1979 {
1980 	u32 tmp, i;
1981 
1982 	/* Restore a bunch of registers first */
1983 	OUTREG(SURFACE_CNTL, rinfo->save_regs[29]);
1984 	OUTREG(MC_AGP_LOCATION, rinfo->save_regs[32]);
1985 	OUTREG(DISPLAY_BASE_ADDR, rinfo->save_regs[31]);
1986 	OUTREG(CRTC2_DISPLAY_BASE_ADDR, rinfo->save_regs[33]);
1987 	OUTREG(MC_FB_LOCATION, rinfo->save_regs[30]);
1988 	OUTREG(OV0_BASE_ADDR, rinfo->save_regs[80]);
1989 	OUTREG(BUS_CNTL, rinfo->save_regs[36]);
1990 	OUTREG(BUS_CNTL1, rinfo->save_regs[14]);
1991 	OUTREG(MPP_TB_CONFIG, rinfo->save_regs[37]);
1992 	OUTREG(FCP_CNTL, rinfo->save_regs[38]);
1993 	OUTREG(RBBM_CNTL, rinfo->save_regs[39]);
1994 
1995 	OUTREG(DAC_CNTL, rinfo->save_regs[40]);
1996 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) | DAC2_EXPAND_MODE);
1997 
1998 	/* Reset the PAD CTLR */
1999 	radeon_pm_reset_pad_ctlr_strength(rinfo);
2000 
2001 	/* Some PLLs are Read & written identically in the trace here...
2002 	 * I suppose it's actually to switch them all off & reset,
2003 	 * let's assume off is what we want. I'm just doing that for all major PLLs now.
2004 	 */
2005 	radeon_pm_all_ppls_off(rinfo);
2006 
2007 	/* Clear tiling, reset swappers */
2008 	INREG(SURFACE_CNTL);
2009 	OUTREG(SURFACE_CNTL, 0);
2010 
2011 	/* Some black magic with TV_DAC_CNTL, we should restore those from backups
2012 	 * rather than hard coding...
2013 	 */
2014 	tmp = INREG(TV_DAC_CNTL) & ~TV_DAC_CNTL_BGADJ_MASK;
2015 	tmp |= 6 << TV_DAC_CNTL_BGADJ__SHIFT;
2016 	OUTREG(TV_DAC_CNTL, tmp);
2017 
2018 	tmp = INREG(TV_DAC_CNTL) & ~TV_DAC_CNTL_DACADJ_MASK;
2019 	tmp |= 6 << TV_DAC_CNTL_DACADJ__SHIFT;
2020 	OUTREG(TV_DAC_CNTL, tmp);
2021 
2022 	OUTPLL(pllAGP_PLL_CNTL, rinfo->save_regs[78]);
2023 
2024 	OUTREG(PAMAC0_DLY_CNTL, rinfo->save_regs[54]);
2025 	OUTREG(PAMAC1_DLY_CNTL, rinfo->save_regs[55]);
2026 	OUTREG(PAMAC2_DLY_CNTL, rinfo->save_regs[79]);
2027 
2028 	OUTREG(AGP_CNTL, rinfo->save_regs[16]);
2029 	OUTREG(HOST_PATH_CNTL, rinfo->save_regs[41]); /* MacOS sets that to 0 !!! */
2030 	OUTREG(DISP_MISC_CNTL, rinfo->save_regs[9]);
2031 
2032 	tmp  = rinfo->save_regs[1]
2033 		& ~(CLK_PWRMGT_CNTL__ACTIVE_HILO_LAT_MASK |
2034 		    CLK_PWRMGT_CNTL__MC_BUSY);
2035 	OUTPLL(pllCLK_PWRMGT_CNTL, tmp);
2036 
2037 	OUTREG(FW_CNTL, rinfo->save_regs[57]);
2038 
2039 	/* Disable SDRAM refresh */
2040 	OUTREG(MEM_REFRESH_CNTL, INREG(MEM_REFRESH_CNTL)
2041 	       | MEM_REFRESH_CNTL__MEM_REFRESH_DIS);
2042 
2043 	/* Restore XTALIN routing (CLK_PIN_CNTL) */
2044        	OUTPLL(pllCLK_PIN_CNTL, rinfo->save_regs[4]);
2045 
2046 	/* Force MCLK to be PCI sourced and forced ON */
2047 	tmp = rinfo->save_regs[2] & 0xff000000;
2048 	tmp |=	MCLK_CNTL__FORCE_MCLKA |
2049 		MCLK_CNTL__FORCE_MCLKB |
2050 		MCLK_CNTL__FORCE_YCLKA |
2051 		MCLK_CNTL__FORCE_YCLKB |
2052 		MCLK_CNTL__FORCE_MC    |
2053 		MCLK_CNTL__FORCE_AIC;
2054 	OUTPLL(pllMCLK_CNTL, tmp);
2055 
2056 	/* Force SCLK to be PCI sourced with a bunch forced */
2057 	tmp =	0 |
2058 		SCLK_CNTL__FORCE_DISP2|
2059 		SCLK_CNTL__FORCE_CP|
2060 		SCLK_CNTL__FORCE_HDP|
2061 		SCLK_CNTL__FORCE_DISP1|
2062 		SCLK_CNTL__FORCE_TOP|
2063 		SCLK_CNTL__FORCE_E2|
2064 		SCLK_CNTL__FORCE_SE|
2065 		SCLK_CNTL__FORCE_IDCT|
2066 		SCLK_CNTL__FORCE_VIP|
2067 		SCLK_CNTL__FORCE_RE|
2068 		SCLK_CNTL__FORCE_PB|
2069 		SCLK_CNTL__FORCE_TAM|
2070 		SCLK_CNTL__FORCE_TDM|
2071 		SCLK_CNTL__FORCE_RB;
2072 	OUTPLL(pllSCLK_CNTL, tmp);
2073 
2074 	/* Clear VCLK_ECP_CNTL & PIXCLKS_CNTL  */
2075 	OUTPLL(pllVCLK_ECP_CNTL, 0);
2076 	OUTPLL(pllPIXCLKS_CNTL, 0);
2077 
2078 	/* Setup MCLK_MISC, non dynamic mode */
2079 	OUTPLL(pllMCLK_MISC,
2080 	       MCLK_MISC__MC_MCLK_MAX_DYN_STOP_LAT |
2081 	       MCLK_MISC__IO_MCLK_MAX_DYN_STOP_LAT);
2082 
2083 	mdelay(5);
2084 
2085 	/* Set back the default clock dividers */
2086 	OUTPLL(pllM_SPLL_REF_FB_DIV, rinfo->save_regs[77]);
2087 	OUTPLL(pllMPLL_AUX_CNTL, rinfo->save_regs[75]);
2088 	OUTPLL(pllSPLL_AUX_CNTL, rinfo->save_regs[76]);
2089 
2090 	/* PPLL and P2PLL default values & off */
2091 	OUTPLL(pllPPLL_CNTL, rinfo->save_regs[93] | 0x3);
2092 	OUTPLL(pllP2PLL_CNTL, rinfo->save_regs[8] | 0x3);
2093 
2094 	/* S and M PLLs are reset & off, configure them */
2095 	OUTPLL(pllMPLL_CNTL, rinfo->save_regs[73] | 0x03);
2096 	OUTPLL(pllSPLL_CNTL, rinfo->save_regs[74] | 0x03);
2097 
2098 	/* Default values for MDLL ... fixme */
2099 	OUTPLL(pllMDLL_CKO, 0x9c009c);
2100 	OUTPLL(pllMDLL_RDCKA, 0x08830883);
2101 	OUTPLL(pllMDLL_RDCKB, 0x08830883);
2102 	mdelay(5);
2103 
2104 	/* Restore PLL_PWRMGT_CNTL */ // XXXX
2105 	tmp = rinfo->save_regs[0];
2106 	tmp &= ~PLL_PWRMGT_CNTL_SU_SCLK_USE_BCLK;
2107 	tmp |= PLL_PWRMGT_CNTL_SU_MCLK_USE_BCLK;
2108 	OUTPLL(PLL_PWRMGT_CNTL,  tmp);
2109 
2110 	/* Clear HTOTAL_CNTL & HTOTAL2_CNTL */
2111 	OUTPLL(pllHTOTAL_CNTL, 0);
2112 	OUTPLL(pllHTOTAL2_CNTL, 0);
2113 
2114 	/* All outputs off */
2115 	OUTREG(CRTC_GEN_CNTL, 0x04000000);
2116 	OUTREG(CRTC2_GEN_CNTL, 0x04000000);
2117 	OUTREG(FP_GEN_CNTL, 0x00004008);
2118 	OUTREG(FP2_GEN_CNTL, 0x00000008);
2119 	OUTREG(LVDS_GEN_CNTL, 0x08000008);
2120 
2121 	/* Restore Memory Controller configuration */
2122 	radeon_pm_m9p_reconfigure_mc(rinfo);
2123 
2124 	/* Now we actually start MCLK and SCLK */
2125 	radeon_pm_start_mclk_sclk(rinfo);
2126 
2127 	/* Full reset sdrams, this also re-inits the MDLL */
2128 	radeon_pm_full_reset_sdram(rinfo);
2129 
2130 	/* Fill palettes */
2131 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) | 0x20);
2132 	for (i=0; i<256; i++)
2133 		OUTREG(PALETTE_30_DATA, 0x15555555);
2134 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) & ~20);
2135 	udelay(20);
2136 	for (i=0; i<256; i++)
2137 		OUTREG(PALETTE_30_DATA, 0x15555555);
2138 
2139 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) & ~0x20);
2140 	mdelay(3);
2141 
2142 	/* Restore TV stuff, make sure TV DAC is down */
2143 	OUTREG(TV_MASTER_CNTL, rinfo->save_regs[88]);
2144 	OUTREG(TV_DAC_CNTL, rinfo->save_regs[13] | 0x07000000);
2145 
2146 	/* Restore GPIOS. MacOS does some magic here with one of the GPIO bits,
2147 	 * possibly related to the weird PLL related workarounds and to the
2148 	 * fact that CLK_PIN_CNTL is tweaked in ways I don't fully understand,
2149 	 * but we keep things the simple way here
2150 	 */
2151 	OUTREG(GPIOPAD_A, rinfo->save_regs[19]);
2152 	OUTREG(GPIOPAD_EN, rinfo->save_regs[20]);
2153 	OUTREG(GPIOPAD_MASK, rinfo->save_regs[21]);
2154 
2155 	/* Now do things with SCLK_MORE_CNTL. Force bits are already set, copy
2156 	 * high bits from backup
2157 	 */
2158 	tmp = INPLL(pllSCLK_MORE_CNTL) & 0x0000ffff;
2159 	tmp |= rinfo->save_regs[34] & 0xffff0000;
2160 	tmp |= SCLK_MORE_CNTL__FORCE_DISPREGS;
2161 	OUTPLL(pllSCLK_MORE_CNTL, tmp);
2162 
2163 	tmp = INPLL(pllSCLK_MORE_CNTL) & 0x0000ffff;
2164 	tmp |= rinfo->save_regs[34] & 0xffff0000;
2165 	tmp |= SCLK_MORE_CNTL__FORCE_DISPREGS;
2166 	OUTPLL(pllSCLK_MORE_CNTL, tmp);
2167 
2168 	OUTREG(LVDS_GEN_CNTL, rinfo->save_regs[11] &
2169 	       ~(LVDS_EN | LVDS_ON | LVDS_DIGON | LVDS_BLON | LVDS_BL_MOD_EN));
2170 	OUTREG(LVDS_GEN_CNTL, INREG(LVDS_GEN_CNTL) | LVDS_BLON);
2171 	OUTREG(LVDS_PLL_CNTL, (rinfo->save_regs[12] & ~0xf0000) | 0x20000);
2172 	mdelay(20);
2173 
2174 	/* write some stuff to the framebuffer... */
2175 	for (i = 0; i < 0x8000; ++i)
2176 		writeb(0, rinfo->fb_base + i);
2177 
2178 	OUTREG(0x2ec, 0x6332a020);
2179 	OUTPLL(pllSSPLL_REF_DIV, rinfo->save_regs[44] /*0x3f */);
2180 	OUTPLL(pllSSPLL_DIV_0, rinfo->save_regs[45] /*0x000081bb */);
2181 	tmp = INPLL(pllSSPLL_CNTL);
2182 	tmp &= ~2;
2183 	OUTPLL(pllSSPLL_CNTL, tmp);
2184 	mdelay(6);
2185 	tmp &= ~1;
2186 	OUTPLL(pllSSPLL_CNTL, tmp);
2187 	mdelay(5);
2188 	tmp |= 3;
2189 	OUTPLL(pllSSPLL_CNTL, tmp);
2190 	mdelay(5);
2191 
2192 	OUTPLL(pllSS_INT_CNTL, rinfo->save_regs[90] & ~3);/*0x0020300c*/
2193 	OUTREG(0x2ec, 0x6332a3f0);
2194 	mdelay(17);
2195 
2196 	OUTPLL(pllPPLL_REF_DIV, rinfo->pll.ref_div);
2197 	OUTPLL(pllPPLL_DIV_0, rinfo->save_regs[92]);
2198 
2199 	mdelay(40);
2200 	OUTREG(LVDS_GEN_CNTL, INREG(LVDS_GEN_CNTL) | LVDS_DIGON | LVDS_ON);
2201 	mdelay(40);
2202 
2203 	/* Restore a few more things */
2204 	OUTREG(GRPH_BUFFER_CNTL, rinfo->save_regs[94]);
2205 	OUTREG(GRPH2_BUFFER_CNTL, rinfo->save_regs[95]);
2206 
2207 	/* Restore PPLL, spread spectrum & LVDS */
2208 	radeon_pm_m10_disable_spread_spectrum(rinfo);
2209 	radeon_pm_restore_pixel_pll(rinfo);
2210 	radeon_pm_m10_enable_lvds_spread_spectrum(rinfo);
2211 }
2212 #endif
2213 #endif
2214 
2215 #if 0 /* Not ready yet */
2216 static void radeon_reinitialize_QW(struct radeonfb_info *rinfo)
2217 {
2218 	int i;
2219 	u32 tmp, tmp2;
2220 	u32 cko, cka, ckb;
2221 	u32 cgc, cec, c2gc;
2222 
2223 	OUTREG(MC_AGP_LOCATION, rinfo->save_regs[32]);
2224 	OUTREG(DISPLAY_BASE_ADDR, rinfo->save_regs[31]);
2225 	OUTREG(CRTC2_DISPLAY_BASE_ADDR, rinfo->save_regs[33]);
2226 	OUTREG(MC_FB_LOCATION, rinfo->save_regs[30]);
2227 	OUTREG(BUS_CNTL, rinfo->save_regs[36]);
2228 	OUTREG(RBBM_CNTL, rinfo->save_regs[39]);
2229 
2230 	INREG(PAD_CTLR_STRENGTH);
2231 	OUTREG(PAD_CTLR_STRENGTH, INREG(PAD_CTLR_STRENGTH) & ~0x10000);
2232 	for (i = 0; i < 65; ++i) {
2233 		mdelay(1);
2234 		INREG(PAD_CTLR_STRENGTH);
2235 	}
2236 
2237 	OUTREG(DISP_TEST_DEBUG_CNTL, INREG(DISP_TEST_DEBUG_CNTL) | 0x10000000);
2238 	OUTREG(OV0_FLAG_CNTRL, INREG(OV0_FLAG_CNTRL) | 0x100);
2239 	OUTREG(CRTC_GEN_CNTL, INREG(CRTC_GEN_CNTL));
2240 	OUTREG(DAC_CNTL, 0xff00410a);
2241 	OUTREG(CRTC2_GEN_CNTL, INREG(CRTC2_GEN_CNTL));
2242 	OUTREG(DAC_CNTL2, INREG(DAC_CNTL2) | 0x4000);
2243 
2244 	OUTREG(SURFACE_CNTL, rinfo->save_regs[29]);
2245 	OUTREG(AGP_CNTL, rinfo->save_regs[16]);
2246 	OUTREG(HOST_PATH_CNTL, rinfo->save_regs[41]);
2247 	OUTREG(DISP_MISC_CNTL, rinfo->save_regs[9]);
2248 
2249 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_A0, 0xf7bb4433);
2250 	OUTREG(MC_IND_INDEX, 0);
2251 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_B0, 0xf7bb4433);
2252 	OUTREG(MC_IND_INDEX, 0);
2253 
2254 	OUTREG(CRTC_MORE_CNTL, INREG(CRTC_MORE_CNTL));
2255 
2256 	tmp = INPLL(pllVCLK_ECP_CNTL);
2257 	OUTPLL(pllVCLK_ECP_CNTL, tmp);
2258 	tmp = INPLL(pllPIXCLKS_CNTL);
2259 	OUTPLL(pllPIXCLKS_CNTL, tmp);
2260 
2261 	OUTPLL(MCLK_CNTL, 0xaa3f0000);
2262 	OUTPLL(SCLK_CNTL, 0xffff0000);
2263 	OUTPLL(pllMPLL_AUX_CNTL, 6);
2264 	OUTPLL(pllSPLL_AUX_CNTL, 1);
2265 	OUTPLL(MDLL_CKO, 0x9f009f);
2266 	OUTPLL(MDLL_RDCKA, 0x830083);
2267 	OUTPLL(pllMDLL_RDCKB, 0x830083);
2268 	OUTPLL(PPLL_CNTL, 0xa433);
2269 	OUTPLL(P2PLL_CNTL, 0xa433);
2270 	OUTPLL(MPLL_CNTL, 0x0400a403);
2271 	OUTPLL(SPLL_CNTL, 0x0400a433);
2272 
2273 	tmp = INPLL(M_SPLL_REF_FB_DIV);
2274 	OUTPLL(M_SPLL_REF_FB_DIV, tmp);
2275 	tmp = INPLL(M_SPLL_REF_FB_DIV);
2276 	OUTPLL(M_SPLL_REF_FB_DIV, tmp | 0xc);
2277 	INPLL(M_SPLL_REF_FB_DIV);
2278 
2279 	tmp = INPLL(MPLL_CNTL);
2280 	OUTREG8(CLOCK_CNTL_INDEX, MPLL_CNTL + PLL_WR_EN);
2281 	radeon_pll_errata_after_index(rinfo);
2282 	OUTREG8(CLOCK_CNTL_DATA + 1, (tmp >> 8) & 0xff);
2283 	radeon_pll_errata_after_data(rinfo);
2284 
2285 	tmp = INPLL(M_SPLL_REF_FB_DIV);
2286 	OUTPLL(M_SPLL_REF_FB_DIV, tmp | 0x5900);
2287 
2288 	tmp = INPLL(MPLL_CNTL);
2289 	OUTPLL(MPLL_CNTL, tmp & ~0x2);
2290 	mdelay(1);
2291 	tmp = INPLL(MPLL_CNTL);
2292 	OUTPLL(MPLL_CNTL, tmp & ~0x1);
2293 	mdelay(10);
2294 
2295 	OUTPLL(MCLK_CNTL, 0xaa3f1212);
2296 	mdelay(1);
2297 
2298 	INPLL(M_SPLL_REF_FB_DIV);
2299 	INPLL(MCLK_CNTL);
2300 	INPLL(M_SPLL_REF_FB_DIV);
2301 
2302 	tmp = INPLL(SPLL_CNTL);
2303 	OUTREG8(CLOCK_CNTL_INDEX, SPLL_CNTL + PLL_WR_EN);
2304 	radeon_pll_errata_after_index(rinfo);
2305 	OUTREG8(CLOCK_CNTL_DATA + 1, (tmp >> 8) & 0xff);
2306 	radeon_pll_errata_after_data(rinfo);
2307 
2308 	tmp = INPLL(M_SPLL_REF_FB_DIV);
2309 	OUTPLL(M_SPLL_REF_FB_DIV, tmp | 0x780000);
2310 
2311 	tmp = INPLL(SPLL_CNTL);
2312 	OUTPLL(SPLL_CNTL, tmp & ~0x1);
2313 	mdelay(1);
2314 	tmp = INPLL(SPLL_CNTL);
2315 	OUTPLL(SPLL_CNTL, tmp & ~0x2);
2316 	mdelay(10);
2317 
2318 	tmp = INPLL(SCLK_CNTL);
2319 	OUTPLL(SCLK_CNTL, tmp | 2);
2320 	mdelay(1);
2321 
2322 	cko = INPLL(pllMDLL_CKO);
2323 	cka = INPLL(pllMDLL_RDCKA);
2324 	ckb = INPLL(pllMDLL_RDCKB);
2325 
2326 	cko &= ~(MDLL_CKO__MCKOA_SLEEP | MDLL_CKO__MCKOB_SLEEP);
2327 	OUTPLL(pllMDLL_CKO, cko);
2328 	mdelay(1);
2329 	cko &= ~(MDLL_CKO__MCKOA_RESET | MDLL_CKO__MCKOB_RESET);
2330 	OUTPLL(pllMDLL_CKO, cko);
2331 	mdelay(5);
2332 
2333 	cka &= ~(MDLL_RDCKA__MRDCKA0_SLEEP | MDLL_RDCKA__MRDCKA1_SLEEP);
2334 	OUTPLL(pllMDLL_RDCKA, cka);
2335 	mdelay(1);
2336 	cka &= ~(MDLL_RDCKA__MRDCKA0_RESET | MDLL_RDCKA__MRDCKA1_RESET);
2337 	OUTPLL(pllMDLL_RDCKA, cka);
2338 	mdelay(5);
2339 
2340 	ckb &= ~(MDLL_RDCKB__MRDCKB0_SLEEP | MDLL_RDCKB__MRDCKB1_SLEEP);
2341 	OUTPLL(pllMDLL_RDCKB, ckb);
2342 	mdelay(1);
2343 	ckb &= ~(MDLL_RDCKB__MRDCKB0_RESET | MDLL_RDCKB__MRDCKB1_RESET);
2344 	OUTPLL(pllMDLL_RDCKB, ckb);
2345 	mdelay(5);
2346 
2347 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_A1, 0x151550ff);
2348 	OUTREG(MC_IND_INDEX, 0);
2349 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_B1, 0x151550ff);
2350 	OUTREG(MC_IND_INDEX, 0);
2351 	mdelay(1);
2352 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_A1, 0x141550ff);
2353 	OUTREG(MC_IND_INDEX, 0);
2354 	OUTMC(rinfo, ixMC_CHP_IO_CNTL_B1, 0x141550ff);
2355 	OUTREG(MC_IND_INDEX, 0);
2356 	mdelay(1);
2357 
2358 	OUTPLL(pllHTOTAL_CNTL, 0);
2359 	OUTPLL(pllHTOTAL2_CNTL, 0);
2360 
2361 	OUTREG(MEM_CNTL, 0x29002901);
2362 	OUTREG(MEM_SDRAM_MODE_REG, 0x45320032);	/* XXX use save_regs[35]? */
2363 	OUTREG(EXT_MEM_CNTL, 0x1a394333);
2364 	OUTREG(MEM_IO_CNTL_A1, 0x0aac0aac);
2365 	OUTREG(MEM_INIT_LATENCY_TIMER, 0x34444444);
2366 	OUTREG(MEM_REFRESH_CNTL, 0x1f1f7218);	/* XXX or save_regs[42]? */
2367 	OUTREG(MC_DEBUG, 0);
2368 	OUTREG(MEM_IO_OE_CNTL, 0x04300430);
2369 
2370 	OUTMC(rinfo, ixMC_IMP_CNTL, 0x00f460d6);
2371 	OUTREG(MC_IND_INDEX, 0);
2372 	OUTMC(rinfo, ixMC_IMP_CNTL_0, 0x00009249);
2373 	OUTREG(MC_IND_INDEX, 0);
2374 
2375 	OUTREG(CNFG_MEMSIZE, rinfo->video_ram);
2376 
2377 	radeon_pm_full_reset_sdram(rinfo);
2378 
2379 	INREG(FP_GEN_CNTL);
2380 	OUTREG(TMDS_CNTL, 0x01000000);	/* XXX ? */
2381 	tmp = INREG(FP_GEN_CNTL);
2382 	tmp |= FP_CRTC_DONT_SHADOW_HEND | FP_CRTC_DONT_SHADOW_VPAR | 0x200;
2383 	OUTREG(FP_GEN_CNTL, tmp);
2384 
2385 	tmp = INREG(DISP_OUTPUT_CNTL);
2386 	tmp &= ~0x400;
2387 	OUTREG(DISP_OUTPUT_CNTL, tmp);
2388 
2389 	OUTPLL(CLK_PIN_CNTL, rinfo->save_regs[4]);
2390 	OUTPLL(CLK_PWRMGT_CNTL, rinfo->save_regs[1]);
2391 	OUTPLL(PLL_PWRMGT_CNTL, rinfo->save_regs[0]);
2392 
2393 	tmp = INPLL(MCLK_MISC);
2394 	tmp |= MCLK_MISC__MC_MCLK_DYN_ENABLE | MCLK_MISC__IO_MCLK_DYN_ENABLE;
2395 	OUTPLL(MCLK_MISC, tmp);
2396 
2397 	tmp = INPLL(SCLK_CNTL);
2398 	OUTPLL(SCLK_CNTL, tmp);
2399 
2400 	OUTREG(CRTC_MORE_CNTL, 0);
2401 	OUTREG8(CRTC_GEN_CNTL+1, 6);
2402 	OUTREG8(CRTC_GEN_CNTL+3, 1);
2403 	OUTREG(CRTC_PITCH, 32);
2404 
2405 	tmp = INPLL(VCLK_ECP_CNTL);
2406 	OUTPLL(VCLK_ECP_CNTL, tmp);
2407 
2408 	tmp = INPLL(PPLL_CNTL);
2409 	OUTPLL(PPLL_CNTL, tmp);
2410 
2411 	/* palette stuff and BIOS_1_SCRATCH... */
2412 
2413 	tmp = INREG(FP_GEN_CNTL);
2414 	tmp2 = INREG(TMDS_TRANSMITTER_CNTL);
2415 	tmp |= 2;
2416 	OUTREG(FP_GEN_CNTL, tmp);
2417 	mdelay(5);
2418 	OUTREG(FP_GEN_CNTL, tmp);
2419 	mdelay(5);
2420 	OUTREG(TMDS_TRANSMITTER_CNTL, tmp2);
2421 	OUTREG(CRTC_MORE_CNTL, 0);
2422 	mdelay(20);
2423 
2424 	tmp = INREG(CRTC_MORE_CNTL);
2425 	OUTREG(CRTC_MORE_CNTL, tmp);
2426 
2427 	cgc = INREG(CRTC_GEN_CNTL);
2428 	cec = INREG(CRTC_EXT_CNTL);
2429 	c2gc = INREG(CRTC2_GEN_CNTL);
2430 
2431 	OUTREG(CRTC_H_SYNC_STRT_WID, 0x008e0580);
2432 	OUTREG(CRTC_H_TOTAL_DISP, 0x009f00d2);
2433 	OUTREG8(CLOCK_CNTL_INDEX, HTOTAL_CNTL + PLL_WR_EN);
2434 	radeon_pll_errata_after_index(rinfo);
2435 	OUTREG8(CLOCK_CNTL_DATA, 0);
2436 	radeon_pll_errata_after_data(rinfo);
2437 	OUTREG(CRTC_V_SYNC_STRT_WID, 0x00830403);
2438 	OUTREG(CRTC_V_TOTAL_DISP, 0x03ff0429);
2439 	OUTREG(FP_CRTC_H_TOTAL_DISP, 0x009f0033);
2440 	OUTREG(FP_H_SYNC_STRT_WID, 0x008e0080);
2441 	OUTREG(CRT_CRTC_H_SYNC_STRT_WID, 0x008e0080);
2442 	OUTREG(FP_CRTC_V_TOTAL_DISP, 0x03ff002a);
2443 	OUTREG(FP_V_SYNC_STRT_WID, 0x00830004);
2444 	OUTREG(CRT_CRTC_V_SYNC_STRT_WID, 0x00830004);
2445 	OUTREG(FP_HORZ_VERT_ACTIVE, 0x009f03ff);
2446 	OUTREG(FP_HORZ_STRETCH, 0);
2447 	OUTREG(FP_VERT_STRETCH, 0);
2448 	OUTREG(OVR_CLR, 0);
2449 	OUTREG(OVR_WID_LEFT_RIGHT, 0);
2450 	OUTREG(OVR_WID_TOP_BOTTOM, 0);
2451 
2452 	tmp = INPLL(PPLL_REF_DIV);
2453 	tmp = (tmp & ~PPLL_REF_DIV_MASK) | rinfo->pll.ref_div;
2454 	OUTPLL(PPLL_REF_DIV, tmp);
2455 	INPLL(PPLL_REF_DIV);
2456 
2457 	OUTREG8(CLOCK_CNTL_INDEX, PPLL_CNTL + PLL_WR_EN);
2458 	radeon_pll_errata_after_index(rinfo);
2459 	OUTREG8(CLOCK_CNTL_DATA + 1, 0xbc);
2460 	radeon_pll_errata_after_data(rinfo);
2461 
2462 	tmp = INREG(CLOCK_CNTL_INDEX);
2463 	radeon_pll_errata_after_index(rinfo);
2464 	OUTREG(CLOCK_CNTL_INDEX, tmp & 0xff);
2465 	radeon_pll_errata_after_index(rinfo);
2466 	radeon_pll_errata_after_data(rinfo);
2467 
2468 	OUTPLL(PPLL_DIV_0, 0x48090);
2469 
2470 	tmp = INPLL(PPLL_CNTL);
2471 	OUTPLL(PPLL_CNTL, tmp & ~0x2);
2472 	mdelay(1);
2473 	tmp = INPLL(PPLL_CNTL);
2474 	OUTPLL(PPLL_CNTL, tmp & ~0x1);
2475 	mdelay(10);
2476 
2477 	tmp = INPLL(VCLK_ECP_CNTL);
2478 	OUTPLL(VCLK_ECP_CNTL, tmp | 3);
2479 	mdelay(1);
2480 
2481 	tmp = INPLL(VCLK_ECP_CNTL);
2482 	OUTPLL(VCLK_ECP_CNTL, tmp);
2483 
2484 	c2gc |= CRTC2_DISP_REQ_EN_B;
2485 	OUTREG(CRTC2_GEN_CNTL, c2gc);
2486 	cgc |= CRTC_EN;
2487 	OUTREG(CRTC_GEN_CNTL, cgc);
2488 	OUTREG(CRTC_EXT_CNTL, cec);
2489 	OUTREG(CRTC_PITCH, 0xa0);
2490 	OUTREG(CRTC_OFFSET, 0);
2491 	OUTREG(CRTC_OFFSET_CNTL, 0);
2492 
2493 	OUTREG(GRPH_BUFFER_CNTL, 0x20117c7c);
2494 	OUTREG(GRPH2_BUFFER_CNTL, 0x00205c5c);
2495 
2496 	tmp2 = INREG(FP_GEN_CNTL);
2497 	tmp = INREG(TMDS_TRANSMITTER_CNTL);
2498 	OUTREG(0x2a8, 0x0000061b);
2499 	tmp |= TMDS_PLL_EN;
2500 	OUTREG(TMDS_TRANSMITTER_CNTL, tmp);
2501 	mdelay(1);
2502 	tmp &= ~TMDS_PLLRST;
2503 	OUTREG(TMDS_TRANSMITTER_CNTL, tmp);
2504 	tmp2 &= ~2;
2505 	tmp2 |= FP_TMDS_EN;
2506 	OUTREG(FP_GEN_CNTL, tmp2);
2507 	mdelay(5);
2508 	tmp2 |= FP_FPON;
2509 	OUTREG(FP_GEN_CNTL, tmp2);
2510 
2511 	OUTREG(CUR_HORZ_VERT_OFF, CUR_LOCK | 1);
2512 	cgc = INREG(CRTC_GEN_CNTL);
2513 	OUTREG(CUR_HORZ_VERT_POSN, 0xbfff0fff);
2514 	cgc |= 0x10000;
2515 	OUTREG(CUR_OFFSET, 0);
2516 }
2517 #endif /* 0 */
2518 
2519 #endif /* CONFIG_PPC */
2520 
2521 static void radeonfb_whack_power_state(struct radeonfb_info *rinfo, pci_power_t state)
2522 {
2523 	u16 pwr_cmd;
2524 
2525 	for (;;) {
2526 		pci_read_config_word(rinfo->pdev,
2527 				     rinfo->pdev->pm_cap + PCI_PM_CTRL,
2528 				     &pwr_cmd);
2529 		if (pwr_cmd & state)
2530 			break;
2531 		pwr_cmd = (pwr_cmd & ~PCI_PM_CTRL_STATE_MASK) | state;
2532 		pci_write_config_word(rinfo->pdev,
2533 				      rinfo->pdev->pm_cap + PCI_PM_CTRL,
2534 				      pwr_cmd);
2535 		msleep(500);
2536 	}
2537 	rinfo->pdev->current_state = state;
2538 }
2539 
2540 static void radeon_set_suspend(struct radeonfb_info *rinfo, int suspend)
2541 {
2542 	u32 tmp;
2543 
2544 	if (!rinfo->pdev->pm_cap)
2545 		return;
2546 
2547 	/* Set the chip into appropriate suspend mode (we use D2,
2548 	 * D3 would require a compete re-initialization of the chip,
2549 	 * including PCI config registers, clocks, AGP conf, ...)
2550 	 */
2551 	if (suspend) {
2552 		printk(KERN_DEBUG "radeonfb (%s): switching to D2 state...\n",
2553 		       pci_name(rinfo->pdev));
2554 
2555 		/* Disable dynamic power management of clocks for the
2556 		 * duration of the suspend/resume process
2557 		 */
2558 		radeon_pm_disable_dynamic_mode(rinfo);
2559 
2560 		/* Save some registers */
2561 		radeon_pm_save_regs(rinfo, 0);
2562 
2563 		/* Prepare mobility chips for suspend.
2564 		 */
2565 		if (rinfo->is_mobility) {
2566 			/* Program V2CLK */
2567 			radeon_pm_program_v2clk(rinfo);
2568 
2569 			/* Disable IO PADs */
2570 			radeon_pm_disable_iopad(rinfo);
2571 
2572 			/* Set low current */
2573 			radeon_pm_low_current(rinfo);
2574 
2575 			/* Prepare chip for power management */
2576 			radeon_pm_setup_for_suspend(rinfo);
2577 
2578 			if (rinfo->family <= CHIP_FAMILY_RV280) {
2579 				/* Reset the MDLL */
2580 				/* because both INPLL and OUTPLL take the same
2581 				 * lock, that's why. */
2582 				tmp = INPLL( pllMDLL_CKO) | MDLL_CKO__MCKOA_RESET
2583 					| MDLL_CKO__MCKOB_RESET;
2584 				OUTPLL( pllMDLL_CKO, tmp );
2585 			}
2586 		}
2587 
2588 		/* Switch PCI power management to D2. */
2589 		pci_disable_device(rinfo->pdev);
2590 		pci_save_state(rinfo->pdev);
2591 		/* The chip seems to need us to whack the PM register
2592 		 * repeatedly until it sticks. We do that -prior- to
2593 		 * calling pci_set_power_state()
2594 		 */
2595 		radeonfb_whack_power_state(rinfo, PCI_D2);
2596 		pci_platform_power_transition(rinfo->pdev, PCI_D2);
2597 	} else {
2598 		printk(KERN_DEBUG "radeonfb (%s): switching to D0 state...\n",
2599 		       pci_name(rinfo->pdev));
2600 
2601 		if (rinfo->family <= CHIP_FAMILY_RV250) {
2602 			/* Reset the SDRAM controller  */
2603 			radeon_pm_full_reset_sdram(rinfo);
2604 
2605 			/* Restore some registers */
2606 			radeon_pm_restore_regs(rinfo);
2607 		} else {
2608 			/* Restore registers first */
2609 			radeon_pm_restore_regs(rinfo);
2610 			/* init sdram controller */
2611 			radeon_pm_full_reset_sdram(rinfo);
2612 		}
2613 	}
2614 }
2615 
2616 int radeonfb_pci_suspend(struct pci_dev *pdev, pm_message_t mesg)
2617 {
2618         struct fb_info *info = pci_get_drvdata(pdev);
2619         struct radeonfb_info *rinfo = info->par;
2620 
2621 	if (mesg.event == pdev->dev.power.power_state.event)
2622 		return 0;
2623 
2624 	printk(KERN_DEBUG "radeonfb (%s): suspending for event: %d...\n",
2625 	       pci_name(pdev), mesg.event);
2626 
2627 	/* For suspend-to-disk, we cheat here. We don't suspend anything and
2628 	 * let fbcon continue drawing until we are all set. That shouldn't
2629 	 * really cause any problem at this point, provided that the wakeup
2630 	 * code knows that any state in memory may not match the HW
2631 	 */
2632 	switch (mesg.event) {
2633 	case PM_EVENT_FREEZE:		/* about to take snapshot */
2634 	case PM_EVENT_PRETHAW:		/* before restoring snapshot */
2635 		goto done;
2636 	}
2637 
2638 	console_lock();
2639 
2640 	fb_set_suspend(info, 1);
2641 
2642 	if (!(info->flags & FBINFO_HWACCEL_DISABLED)) {
2643 		/* Make sure engine is reset */
2644 		radeon_engine_idle();
2645 		radeonfb_engine_reset(rinfo);
2646 		radeon_engine_idle();
2647 	}
2648 
2649 	/* Blank display and LCD */
2650 	radeon_screen_blank(rinfo, FB_BLANK_POWERDOWN, 1);
2651 
2652 	/* Sleep */
2653 	rinfo->asleep = 1;
2654 	rinfo->lock_blank = 1;
2655 	del_timer_sync(&rinfo->lvds_timer);
2656 
2657 #ifdef CONFIG_PPC_PMAC
2658 	/* On powermac, we have hooks to properly suspend/resume AGP now,
2659 	 * use them here. We'll ultimately need some generic support here,
2660 	 * but the generic code isn't quite ready for that yet
2661 	 */
2662 	pmac_suspend_agp_for_card(pdev);
2663 #endif /* CONFIG_PPC_PMAC */
2664 
2665 	/* It's unclear whether or when the generic code will do that, so let's
2666 	 * do it ourselves. We save state before we do any power management
2667 	 */
2668 	pci_save_state(pdev);
2669 
2670 	/* If we support wakeup from poweroff, we save all regs we can including cfg
2671 	 * space
2672 	 */
2673 	if (rinfo->pm_mode & radeon_pm_off) {
2674 		/* Always disable dynamic clocks or weird things are happening when
2675 		 * the chip goes off (basically the panel doesn't shut down properly
2676 		 * and we crash on wakeup),
2677 		 * also, we want the saved regs context to have no dynamic clocks in
2678 		 * it, we'll restore the dynamic clocks state on wakeup
2679 		 */
2680 		radeon_pm_disable_dynamic_mode(rinfo);
2681 		msleep(50);
2682 		radeon_pm_save_regs(rinfo, 1);
2683 
2684 		if (rinfo->is_mobility && !(rinfo->pm_mode & radeon_pm_d2)) {
2685 			/* Switch off LVDS interface */
2686 			usleep_range(1000, 2000);
2687 			OUTREG(LVDS_GEN_CNTL, INREG(LVDS_GEN_CNTL) & ~(LVDS_BL_MOD_EN));
2688 			usleep_range(1000, 2000);
2689 			OUTREG(LVDS_GEN_CNTL, INREG(LVDS_GEN_CNTL) & ~(LVDS_EN | LVDS_ON));
2690 			OUTREG(LVDS_PLL_CNTL, (INREG(LVDS_PLL_CNTL) & ~30000) | 0x20000);
2691 			msleep(20);
2692 			OUTREG(LVDS_GEN_CNTL, INREG(LVDS_GEN_CNTL) & ~(LVDS_DIGON));
2693 		}
2694 		pci_disable_device(pdev);
2695 	}
2696 	/* If we support D2, we go to it (should be fixed later with a flag forcing
2697 	 * D3 only for some laptops)
2698 	 */
2699 	if (rinfo->pm_mode & radeon_pm_d2)
2700 		radeon_set_suspend(rinfo, 1);
2701 
2702 	console_unlock();
2703 
2704  done:
2705 	pdev->dev.power.power_state = mesg;
2706 
2707 	return 0;
2708 }
2709 
2710 static int radeon_check_power_loss(struct radeonfb_info *rinfo)
2711 {
2712 	return rinfo->save_regs[4] != INPLL(CLK_PIN_CNTL) ||
2713 	       rinfo->save_regs[2] != INPLL(MCLK_CNTL) ||
2714 	       rinfo->save_regs[3] != INPLL(SCLK_CNTL);
2715 }
2716 
2717 int radeonfb_pci_resume(struct pci_dev *pdev)
2718 {
2719         struct fb_info *info = pci_get_drvdata(pdev);
2720         struct radeonfb_info *rinfo = info->par;
2721 	int rc = 0;
2722 
2723 	if (pdev->dev.power.power_state.event == PM_EVENT_ON)
2724 		return 0;
2725 
2726 	if (rinfo->no_schedule) {
2727 		if (!console_trylock())
2728 			return 0;
2729 	} else
2730 		console_lock();
2731 
2732 	printk(KERN_DEBUG "radeonfb (%s): resuming from state: %d...\n",
2733 	       pci_name(pdev), pdev->dev.power.power_state.event);
2734 
2735 	/* PCI state will have been restored by the core, so
2736 	 * we should be in D0 now with our config space fully
2737 	 * restored
2738 	 */
2739 	if (pdev->dev.power.power_state.event == PM_EVENT_SUSPEND) {
2740 		/* Wakeup chip */
2741 		if ((rinfo->pm_mode & radeon_pm_off) && radeon_check_power_loss(rinfo)) {
2742 			if (rinfo->reinit_func != NULL)
2743 				rinfo->reinit_func(rinfo);
2744 			else {
2745 				printk(KERN_ERR "radeonfb (%s): can't resume radeon from"
2746 				       " D3 cold, need softboot !", pci_name(pdev));
2747 				rc = -EIO;
2748 				goto bail;
2749 			}
2750 		}
2751 		/* If we support D2, try to resume... we should check what was our
2752 		 * state though... (were we really in D2 state ?). Right now, this code
2753 		 * is only enable on Macs so it's fine.
2754 		 */
2755 		else if (rinfo->pm_mode & radeon_pm_d2)
2756 			radeon_set_suspend(rinfo, 0);
2757 
2758 		rinfo->asleep = 0;
2759 	} else
2760 		radeon_engine_idle();
2761 
2762 	/* Restore display & engine */
2763 	radeon_write_mode (rinfo, &rinfo->state, 1);
2764 	if (!(info->flags & FBINFO_HWACCEL_DISABLED))
2765 		radeonfb_engine_init (rinfo);
2766 
2767 	fb_pan_display(info, &info->var);
2768 	fb_set_cmap(&info->cmap, info);
2769 
2770 	/* Refresh */
2771 	fb_set_suspend(info, 0);
2772 
2773 	/* Unblank */
2774 	rinfo->lock_blank = 0;
2775 	radeon_screen_blank(rinfo, FB_BLANK_UNBLANK, 1);
2776 
2777 #ifdef CONFIG_PPC_PMAC
2778 	/* On powermac, we have hooks to properly suspend/resume AGP now,
2779 	 * use them here. We'll ultimately need some generic support here,
2780 	 * but the generic code isn't quite ready for that yet
2781 	 */
2782 	pmac_resume_agp_for_card(pdev);
2783 #endif /* CONFIG_PPC_PMAC */
2784 
2785 
2786 	/* Check status of dynclk */
2787 	if (rinfo->dynclk == 1)
2788 		radeon_pm_enable_dynamic_mode(rinfo);
2789 	else if (rinfo->dynclk == 0)
2790 		radeon_pm_disable_dynamic_mode(rinfo);
2791 
2792 	pdev->dev.power.power_state = PMSG_ON;
2793 
2794  bail:
2795 	console_unlock();
2796 
2797 	return rc;
2798 }
2799 
2800 #ifdef CONFIG_PPC__disabled
2801 static void radeonfb_early_resume(void *data)
2802 {
2803         struct radeonfb_info *rinfo = data;
2804 
2805 	rinfo->no_schedule = 1;
2806 	pci_restore_state(rinfo->pdev);
2807 	radeonfb_pci_resume(rinfo->pdev);
2808 	rinfo->no_schedule = 0;
2809 }
2810 #endif /* CONFIG_PPC */
2811 
2812 #endif /* CONFIG_PM */
2813 
2814 void radeonfb_pm_init(struct radeonfb_info *rinfo, int dynclk, int ignore_devlist, int force_sleep)
2815 {
2816 	/* Enable/Disable dynamic clocks: TODO add sysfs access */
2817 	if (rinfo->family == CHIP_FAMILY_RS480)
2818 		rinfo->dynclk = -1;
2819 	else
2820 		rinfo->dynclk = dynclk;
2821 
2822 	if (rinfo->dynclk == 1) {
2823 		radeon_pm_enable_dynamic_mode(rinfo);
2824 		printk("radeonfb: Dynamic Clock Power Management enabled\n");
2825 	} else if (rinfo->dynclk == 0) {
2826 		radeon_pm_disable_dynamic_mode(rinfo);
2827 		printk("radeonfb: Dynamic Clock Power Management disabled\n");
2828 	}
2829 
2830 #if defined(CONFIG_PM)
2831 #if defined(CONFIG_PPC_PMAC)
2832 	/* Check if we can power manage on suspend/resume. We can do
2833 	 * D2 on M6, M7 and M9, and we can resume from D3 cold a few other
2834 	 * "Mac" cards, but that's all. We need more infos about what the
2835 	 * BIOS does tho. Right now, all this PM stuff is pmac-only for that
2836 	 * reason. --BenH
2837 	 */
2838 	if (machine_is(powermac) && rinfo->of_node) {
2839 		if (rinfo->is_mobility && rinfo->pdev->pm_cap &&
2840 		    rinfo->family <= CHIP_FAMILY_RV250)
2841 			rinfo->pm_mode |= radeon_pm_d2;
2842 
2843 		/* We can restart Jasper (M10 chip in albooks), BlueStone (7500 chip
2844 		 * in some desktop G4s), Via (M9+ chip on iBook G4) and
2845 		 * Snowy (M11 chip on iBook G4 manufactured after July 2005)
2846 		 */
2847 		if (of_node_name_eq(rinfo->of_node, "ATY,JasperParent") ||
2848 		    of_node_name_eq(rinfo->of_node, "ATY,SnowyParent")) {
2849 			rinfo->reinit_func = radeon_reinitialize_M10;
2850 			rinfo->pm_mode |= radeon_pm_off;
2851 		}
2852 #if 0 /* Not ready yet */
2853 		if (!strcmp(rinfo->of_node->name, "ATY,BlueStoneParent")) {
2854 			rinfo->reinit_func = radeon_reinitialize_QW;
2855 			rinfo->pm_mode |= radeon_pm_off;
2856 		}
2857 #endif
2858 		if (of_node_name_eq(rinfo->of_node, "ATY,ViaParent")) {
2859 			rinfo->reinit_func = radeon_reinitialize_M9P;
2860 			rinfo->pm_mode |= radeon_pm_off;
2861 		}
2862 
2863 		/* If any of the above is set, we assume the machine can sleep/resume.
2864 		 * It's a bit of a "shortcut" but will work fine. Ideally, we need infos
2865 		 * from the platform about what happens to the chip...
2866 		 * Now we tell the platform about our capability
2867 		 */
2868 		if (rinfo->pm_mode != radeon_pm_none) {
2869 			pmac_call_feature(PMAC_FTR_DEVICE_CAN_WAKE, rinfo->of_node, 0, 1);
2870 #if 0 /* Disable the early video resume hack for now as it's causing problems, among
2871        * others we now rely on the PCI core restoring the config space for us, which
2872        * isn't the case with that hack, and that code path causes various things to
2873        * be called with interrupts off while they shouldn't. I'm leaving the code in
2874        * as it can be useful for debugging purposes
2875        */
2876 			pmac_set_early_video_resume(radeonfb_early_resume, rinfo);
2877 #endif
2878 		}
2879 
2880 #if 0
2881 		/* Power down TV DAC, that saves a significant amount of power,
2882 		 * we'll have something better once we actually have some TVOut
2883 		 * support
2884 		 */
2885 		OUTREG(TV_DAC_CNTL, INREG(TV_DAC_CNTL) | 0x07000000);
2886 #endif
2887 	}
2888 #endif /* defined(CONFIG_PPC_PMAC) */
2889 #endif /* defined(CONFIG_PM) */
2890 
2891 	if (ignore_devlist)
2892 		printk(KERN_DEBUG
2893 		       "radeonfb: skipping test for device workarounds\n");
2894 	else
2895 		radeon_apply_workarounds(rinfo);
2896 
2897 	if (force_sleep) {
2898 		printk(KERN_DEBUG
2899 		       "radeonfb: forcefully enabling D2 sleep mode\n");
2900 		rinfo->pm_mode |= radeon_pm_d2;
2901 	}
2902 }
2903 
2904 void radeonfb_pm_exit(struct radeonfb_info *rinfo)
2905 {
2906 #if defined(CONFIG_PM) && defined(CONFIG_PPC_PMAC)
2907 	if (rinfo->pm_mode != radeon_pm_none)
2908 		pmac_set_early_video_resume(NULL, NULL);
2909 #endif
2910 }
2911