1 // SPDX-License-Identifier: GPL-2.0
3 * drivers/video/aty/radeon_pm.c
5 * Copyright 2003,2004 Ben. Herrenschmidt <benh@kernel.crashing.org>
6 * Copyright 2004 Paul Mackerras <paulus@samba.org>
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...
20 #include <linux/console.h>
21 #include <linux/agp_backend.h>
23 #ifdef CONFIG_PPC_PMAC
24 #include <asm/machdep.h>
26 #include <asm/pmac_feature.h>
32 * Workarounds for bugs in PC laptops:
33 * - enable D2 sleep in some IBM Thinkpads
34 * - special case for Samsung P35
36 * Whitelist by subsystem vendor/device because
37 * its the subsystem vendor's fault!
40 #if defined(CONFIG_PM) && defined(CONFIG_X86)
41 static void radeon_reinitialize_M10(struct radeonfb_info
*rinfo
);
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 */
51 #define BUGFIX(model, sv, sd, pm, fn) { \
53 .subsystem_vendor = sv, \
54 .subsystem_device = sd, \
55 .pm_mode_modifier = pm, \
56 .new_reinit_func = fn \
59 static struct radeon_device_id radeon_workaround_list
[] = {
60 BUGFIX("IBM Thinkpad R32",
61 PCI_VENDOR_ID_IBM
, 0x1905,
63 BUGFIX("IBM Thinkpad R40",
64 PCI_VENDOR_ID_IBM
, 0x0526,
66 BUGFIX("IBM Thinkpad R40",
67 PCI_VENDOR_ID_IBM
, 0x0527,
69 BUGFIX("IBM Thinkpad R50/R51/T40/T41",
70 PCI_VENDOR_ID_IBM
, 0x0531,
72 BUGFIX("IBM Thinkpad R51/T40/T41/T42",
73 PCI_VENDOR_ID_IBM
, 0x0530,
75 BUGFIX("IBM Thinkpad T30",
76 PCI_VENDOR_ID_IBM
, 0x0517,
78 BUGFIX("IBM Thinkpad T40p",
79 PCI_VENDOR_ID_IBM
, 0x054d,
81 BUGFIX("IBM Thinkpad T42",
82 PCI_VENDOR_ID_IBM
, 0x0550,
84 BUGFIX("IBM Thinkpad X31/X32",
85 PCI_VENDOR_ID_IBM
, 0x052f,
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
),
99 static int radeon_apply_workarounds(struct radeonfb_info
*rinfo
)
101 struct radeon_device_id
*id
;
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
)) {
107 /* we found a device that requires workaround */
108 printk(KERN_DEBUG
"radeonfb: %s detected"
109 ", enabling workaround\n", id
->ident
);
111 rinfo
->pm_mode
|= id
->pm_mode_modifier
;
113 if (id
->new_reinit_func
!= NULL
)
114 rinfo
->reinit_func
= id
->new_reinit_func
;
118 return 0; /* not found */
121 #else /* defined(CONFIG_PM) && defined(CONFIG_X86) */
122 static inline int radeon_apply_workarounds(struct radeonfb_info
*rinfo
)
126 #endif /* defined(CONFIG_PM) && defined(CONFIG_X86) */
130 static void radeon_pm_disable_dynamic_mode(struct radeonfb_info
*rinfo
)
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
225 /* Force Core Clocks */
226 tmp
= INPLL(pllSCLK_CNTL
);
227 tmp
|= (SCLK_CNTL__FORCE_CP
| SCLK_CNTL__FORCE_E2
);
229 /* XFree doesn't do that case, but we had this code from Apple and it
230 * seem necessary for proper suspend/resume operations
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
|
238 SCLK_CNTL__FORCE_IDCT
|
239 SCLK_CNTL__FORCE_VIP
|
242 SCLK_CNTL__FORCE_TAM
|
243 SCLK_CNTL__FORCE_TDM
|
245 SCLK_CNTL__FORCE_TV_SCLK
|
246 SCLK_CNTL__FORCE_SUBPIC
|
247 SCLK_CNTL__FORCE_OV0
;
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
;
258 OUTPLL(pllSCLK_CNTL
, tmp
);
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
);
270 tmp
= INPLL(pllCLK_PIN_CNTL
);
271 tmp
&= ~CLK_PIN_CNTL__SCLK_DYN_START_CNTL
;
272 OUTPLL(pllCLK_PIN_CNTL
, tmp
);
276 /* Weird ... X is _un_ forcing clocks here, I think it's
277 * doing backward. Imitate it for now...
279 tmp
= INPLL(pllMCLK_CNTL
);
280 tmp
&= ~(MCLK_CNTL__FORCE_MCLKA
|
281 MCLK_CNTL__FORCE_YCLKA
);
282 OUTPLL(pllMCLK_CNTL
, tmp
);
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
);
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
);
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
);
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
);
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
);
331 static void radeon_pm_enable_dynamic_mode(struct radeonfb_info
*rinfo
)
336 if (!rinfo
->has_CRTC2
) {
337 tmp
= INPLL(pllSCLK_CNTL
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
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
;
425 tmp
&= ~MCLK_CNTL__R300_DISABLE_MC_MCLKA
;
427 tmp
&= ~(MCLK_CNTL__R300_DISABLE_MC_MCLKA
|
428 MCLK_CNTL__R300_DISABLE_MC_MCLKB
);
431 OUTPLL(pllMCLK_CNTL
, tmp
);
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
);
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
);
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
);
461 tmp
= INPLL(pllCLK_PIN_CNTL
);
462 tmp
|= CLK_PIN_CNTL__SCLK_DYN_START_CNTL
;
463 OUTPLL(pllCLK_PIN_CNTL
, tmp
);
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.
469 tmp
= INPLL(pllSCLK_CNTL
);
470 tmp
&= ~SCLK_CNTL__FORCEON_MASK
;
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
;
480 OUTPLL(pllSCLK_CNTL
, tmp
);
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
;
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
;
495 OUTPLL(pllSCLK_MORE_CNTL
, tmp
);
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
);
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
);
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
);
526 /* X doesn't do that ... hrm, we do on mobility && Macs */
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
);
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
);
545 #endif /* CONFIG_PPC */
550 static void OUTMC( struct radeonfb_info
*rinfo
, u8 indx
, u32 value
)
552 OUTREG( MC_IND_INDEX
, indx
| MC_IND_INDEX__MC_IND_WR_EN
);
553 OUTREG( MC_IND_DATA
, value
);
556 static u32
INMC(struct radeonfb_info
*rinfo
, u8 indx
)
558 OUTREG( MC_IND_INDEX
, indx
);
559 return INREG( MC_IND_DATA
);
562 static void radeon_pm_save_regs(struct radeonfb_info
*rinfo
, int saving_for_d3
)
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
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
);
688 static void radeon_pm_restore_regs(struct radeonfb_info
*rinfo
)
690 OUTPLL(P2PLL_CNTL
, rinfo
->save_regs
[8] & 0xFFFFFFFE); /* First */
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]);
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
);
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]);
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]);
734 static void radeon_pm_disable_iopad(struct radeonfb_info
*rinfo
)
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);
748 static void radeon_pm_program_v2clk(struct radeonfb_info
*rinfo
)
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
);
756 OUTPLL(pllP2PLL_REF_DIV
, 0x0000000c);
757 OUTPLL(pllP2PLL_CNTL
, 0x0000bf00);
759 OUTPLL(pllP2PLL_REF_DIV
, 0x0000000c);
760 INPLL(pllP2PLL_REF_DIV
);
761 OUTPLL(pllP2PLL_CNTL
, 0x0000a700);
764 OUTPLL(pllP2PLL_DIV_0
, 0x00020074 | P2PLL_DIV_0__P2PLL_ATOMIC_UPDATE_W
);
766 OUTPLL(pllP2PLL_CNTL
, INPLL(pllP2PLL_CNTL
) & ~P2PLL_CNTL__P2PLL_SLEEP
);
769 OUTPLL(pllP2PLL_CNTL
, INPLL(pllP2PLL_CNTL
) & ~P2PLL_CNTL__P2PLL_RESET
);
772 OUTPLL(pllPIXCLKS_CNTL
,
773 (INPLL(pllPIXCLKS_CNTL
) & ~PIXCLKS_CNTL__PIX2CLK_SRC_SEL_MASK
)
774 | (0x03 << PIXCLKS_CNTL__PIX2CLK_SRC_SEL__SHIFT
));
778 static void radeon_pm_low_current(struct radeonfb_info
*rinfo
)
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
);
789 OUTREG(BUS_CNTL1
, reg
);
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
);
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
|
802 (8<<TV_DAC_CNTL_BGADJ__SHIFT
) | (8<<TV_DAC_CNTL_DACADJ__SHIFT
);
803 OUTREG(TV_DAC_CNTL
, reg
);
805 reg
= INREG(TMDS_TRANSMITTER_CNTL
);
806 reg
&= ~(TMDS_PLL_EN
| TMDS_PLLRST
);
807 OUTREG(TMDS_TRANSMITTER_CNTL
, reg
);
809 reg
= INREG(DAC_CNTL
);
811 OUTREG(DAC_CNTL
, reg
);
813 reg
= INREG(DAC_CNTL2
);
815 OUTREG(DAC_CNTL2
, reg
);
817 reg
= INREG(TV_DAC_CNTL
);
818 reg
&= ~TV_DAC_CNTL_DETECT
;
819 OUTREG(TV_DAC_CNTL
, reg
);
822 static void radeon_pm_setup_for_suspend(struct radeonfb_info
*rinfo
)
825 u32 sclk_cntl
, mclk_cntl
, sclk_more_cntl
;
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
|
846 SCLK_CNTL__FORCE_DISP2
|
848 SCLK_CNTL__FORCE_HDP
|
849 SCLK_CNTL__FORCE_DISP1
|
850 SCLK_CNTL__FORCE_TOP
|
853 SCLK_CNTL__FORCE_IDCT
|
854 SCLK_CNTL__FORCE_VIP
|
857 SCLK_CNTL__FORCE_TAM
|
858 SCLK_CNTL__FORCE_TDM
|
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
;
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
;
872 OUTPLL( pllSCLK_CNTL
, sclk_cntl
);
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
;
879 OUTPLL(pllSCLK_MORE_CNTL
, sclk_more_cntl
);
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
|
889 OUTPLL( pllMCLK_CNTL
, mclk_cntl
);
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
);
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
);
908 OUTPLL( pllPIXCLKS_CNTL
, pixclks_cntl
);
910 /* Switch off LVDS interface */
911 OUTREG(LVDS_GEN_CNTL
, INREG(LVDS_GEN_CNTL
) &
912 ~(LVDS_BLON
| LVDS_EN
| LVDS_ON
| LVDS_DIGON
));
914 /* Enable System power management */
915 pll_pwrmgt_cntl
= INPLL( pllPLL_PWRMGT_CNTL
);
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
;
923 OUTPLL( pllPLL_PWRMGT_CNTL
, pll_pwrmgt_cntl
);
925 clk_pwrmgt_cntl
= INPLL( pllCLK_PWRMGT_CNTL
);
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
942 clk_pwrmgt_cntl
|= CLK_PWRMGT_CNTL__GLOBAL_PMAN_EN
943 | CLK_PWRMGT_CNTL__DISP_PM
;
945 OUTPLL( pllCLK_PWRMGT_CNTL
, clk_pwrmgt_cntl
);
947 clk_pin_cntl
= INPLL( pllCLK_PIN_CNTL
);
949 clk_pin_cntl
&= ~CLK_PIN_CNTL__ACCESS_REGS_IN_SUSPEND
;
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
);
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).
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
);
966 (INREG(BUS_CNTL1
) & ~BUS_CNTL1__MOBILE_PLATFORM_SEL_MASK
)
967 | (2<<BUS_CNTL1__MOBILE_PLATFORM_SEL__SHIFT
)); // 440BX
969 OUTREG(BUS_CNTL1
, INREG(BUS_CNTL1
));
970 OUTREG(BUS_CNTL1
, (INREG(BUS_CNTL1
) & ~0x4000) | 0x8000);
975 OUTREG(CRTC_OFFSET_CNTL
, (INREG(CRTC_OFFSET_CNTL
)
976 & ~CRTC_OFFSET_CNTL__CRTC_STEREO_SYNC_OUT_EN
));
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
);
984 (INREG(AGP_CNTL
) & ~(AGP_CNTL__MAX_IDLE_CLK_MASK
))
985 | (0x20<<AGP_CNTL__MAX_IDLE_CLK__SHIFT
));
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
);
993 disp_mis_cntl
= INREG(DISP_MISC_CNTL
);
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
);
1008 OUTREG(DISP_MISC_CNTL
, disp_mis_cntl
);
1010 disp_pwr_man
= INREG(DISP_PWR_MAN
);
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
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|
1030 OUTREG(DISP_PWR_MAN
, disp_pwr_man
);
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
);
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
);
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
);
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
);
1060 static void radeon_pm_yclk_mclk_sync(struct radeonfb_info
*rinfo
)
1062 u32 mc_chp_io_cntl_a1
, mc_chp_io_cntl_b1
;
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
;
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
));
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
);
1080 static void radeon_pm_yclk_mclk_sync_m10(struct radeonfb_info
*rinfo
)
1082 u32 mc_chp_io_cntl_a1
, mc_chp_io_cntl_b1
;
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
;
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
));
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
);
1100 static void radeon_pm_program_mode_reg(struct radeonfb_info
*rinfo
, u16 value
,
1105 mem_sdram_mode
= INREG( MEM_SDRAM_MODE_REG
);
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)
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)
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)
1124 if (delay_required
) {
1126 if (delay_required
>= 2)
1128 } while ((INREG(MC_STATUS
)
1129 & (MC_STATUS__MEM_PWRUP_COMPL_A
|
1130 MC_STATUS__MEM_PWRUP_COMPL_B
)) == 0);
1134 static void radeon_pm_m10_program_mode_wait(struct radeonfb_info
*rinfo
)
1138 for (cnt
= 0; cnt
< 100; ++cnt
) {
1140 if (INREG(MC_STATUS
) & (MC_STATUS__MEM_PWRUP_COMPL_A
1141 | MC_STATUS__MEM_PWRUP_COMPL_B
))
1147 static void radeon_pm_enable_dll(struct radeonfb_info
*rinfo
)
1149 #define DLL_RESET_DELAY 5
1150 #define DLL_SLEEP_DELAY 1
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
;
1161 /* Setting up the DLL range for write */
1162 OUTPLL(pllMDLL_CKO
, cko
);
1163 OUTPLL(pllMDLL_RDCKA
, cka
);
1164 OUTPLL(pllMDLL_RDCKB
, ckb
);
1166 mdelay(DLL_RESET_DELAY
*2);
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
);
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
);
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
);
1190 #undef DLL_RESET_DELAY
1191 #undef DLL_SLEEP_DELAY
1194 static void radeon_pm_enable_dll_m10(struct radeonfb_info
*rinfo
)
1197 u32 dll_sleep_mask
= 0;
1198 u32 dll_reset_mask
= 0;
1201 #define DLL_RESET_DELAY 5
1202 #define DLL_SLEEP_DELAY 1
1204 OUTMC(rinfo
, ixR300_MC_DLL_CNTL
, rinfo
->save_regs
[70]);
1205 mc
= INREG(MC_CNTL
);
1206 /* Check which channels are enabled */
1212 dll_sleep_mask
|= MDLL_R300_RDCK__MRDCKB_SLEEP
;
1213 dll_reset_mask
|= MDLL_R300_RDCK__MRDCKB_RESET
;
1215 dll_sleep_mask
|= MDLL_R300_RDCK__MRDCKA_SLEEP
;
1216 dll_reset_mask
|= MDLL_R300_RDCK__MRDCKA_RESET
;
1223 dll_sleep_mask
|= MDLL_R300_RDCK__MRDCKD_SLEEP
;
1224 dll_reset_mask
|= MDLL_R300_RDCK__MRDCKD_RESET
;
1225 dll_sleep_mask
|= MDLL_R300_RDCK__MRDCKC_SLEEP
;
1226 dll_reset_mask
|= MDLL_R300_RDCK__MRDCKC_RESET
;
1229 dll_value
= INPLL(pllMDLL_RDCKA
);
1232 dll_value
&= ~(dll_sleep_mask
);
1233 OUTPLL(pllMDLL_RDCKA
, dll_value
);
1234 mdelay( DLL_SLEEP_DELAY
);
1236 dll_value
&= ~(dll_reset_mask
);
1237 OUTPLL(pllMDLL_RDCKA
, dll_value
);
1238 mdelay( DLL_RESET_DELAY
);
1240 #undef DLL_RESET_DELAY
1241 #undef DLL_SLEEP_DELAY
1245 static void radeon_pm_full_reset_sdram(struct radeonfb_info
*rinfo
)
1247 u32 crtcGenCntl
, crtcGenCntl2
, memRefreshCntl
, crtc_more_cntl
,
1248 fp_gen_cntl
, fp2_gen_cntl
;
1250 crtcGenCntl
= INREG( CRTC_GEN_CNTL
);
1251 crtcGenCntl2
= INREG( CRTC2_GEN_CNTL
);
1253 crtc_more_cntl
= INREG( CRTC_MORE_CNTL
);
1254 fp_gen_cntl
= INREG( FP_GEN_CNTL
);
1255 fp2_gen_cntl
= INREG( FP2_GEN_CNTL
);
1258 OUTREG( CRTC_MORE_CNTL
, 0);
1259 OUTREG( FP_GEN_CNTL
, 0);
1260 OUTREG( FP2_GEN_CNTL
,0);
1262 OUTREG( CRTC_GEN_CNTL
, (crtcGenCntl
| CRTC_GEN_CNTL__CRTC_DISP_REQ_EN_B
) );
1263 OUTREG( CRTC2_GEN_CNTL
, (crtcGenCntl2
| CRTC2_GEN_CNTL__CRTC2_DISP_REQ_EN_B
) );
1265 /* This is the code for the Aluminium PowerBooks M10 / iBooks M11 */
1266 if (rinfo
->family
== CHIP_FAMILY_RV350
) {
1267 u32 sdram_mode_reg
= rinfo
->save_regs
[35];
1268 static const u32 default_mrtable
[] =
1270 0x21321000, 0xa1321000, 0x21321000, 0xffffffff,
1271 0x21320032, 0xa1320032, 0x21320032, 0xffffffff,
1272 0x21321002, 0xa1321002, 0x21321002, 0xffffffff,
1273 0x21320132, 0xa1320132, 0x21320132, 0xffffffff,
1274 0x21320032, 0xa1320032, 0x21320032, 0xffffffff,
1277 const u32
*mrtable
= default_mrtable
;
1278 int i
, mrtable_size
= ARRAY_SIZE(default_mrtable
);
1282 /* Disable refresh */
1283 memRefreshCntl
= INREG( MEM_REFRESH_CNTL
)
1284 & ~MEM_REFRESH_CNTL__MEM_REFRESH_DIS
;
1285 OUTREG( MEM_REFRESH_CNTL
, memRefreshCntl
1286 | MEM_REFRESH_CNTL__MEM_REFRESH_DIS
);
1288 /* Configure and enable M & SPLLs */
1289 radeon_pm_enable_dll_m10(rinfo
);
1290 radeon_pm_yclk_mclk_sync_m10(rinfo
);
1293 if (rinfo
->of_node
!= NULL
) {
1296 mrtable
= of_get_property(rinfo
->of_node
, "ATY,MRT", &size
);
1298 mrtable_size
= size
>> 2;
1300 mrtable
= default_mrtable
;
1302 #endif /* CONFIG_PPC */
1304 /* Program the SDRAM */
1305 sdram_mode_reg
= mrtable
[0];
1306 OUTREG(MEM_SDRAM_MODE_REG
, sdram_mode_reg
);
1307 for (i
= 0; i
< mrtable_size
; i
++) {
1308 if (mrtable
[i
] == 0xffffffffu
)
1309 radeon_pm_m10_program_mode_wait(rinfo
);
1311 sdram_mode_reg
&= ~(MEM_SDRAM_MODE_REG__MEM_MODE_REG_MASK
1312 | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
1313 | MEM_SDRAM_MODE_REG__MEM_SDRAM_RESET
);
1314 sdram_mode_reg
|= mrtable
[i
];
1316 OUTREG(MEM_SDRAM_MODE_REG
, sdram_mode_reg
);
1321 /* Restore memory refresh */
1322 OUTREG(MEM_REFRESH_CNTL
, memRefreshCntl
);
1326 /* Here come the desktop RV200 "QW" card */
1327 else if (!rinfo
->is_mobility
&& rinfo
->family
== CHIP_FAMILY_RV200
) {
1328 /* Disable refresh */
1329 memRefreshCntl
= INREG( MEM_REFRESH_CNTL
)
1330 & ~MEM_REFRESH_CNTL__MEM_REFRESH_DIS
;
1331 OUTREG(MEM_REFRESH_CNTL
, memRefreshCntl
1332 | MEM_REFRESH_CNTL__MEM_REFRESH_DIS
);
1336 OUTREG(MEM_SDRAM_MODE_REG
,
1337 INREG( MEM_SDRAM_MODE_REG
) & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1339 radeon_pm_program_mode_reg(rinfo
, 0x2002, 2);
1340 radeon_pm_program_mode_reg(rinfo
, 0x0132, 2);
1341 radeon_pm_program_mode_reg(rinfo
, 0x0032, 2);
1343 OUTREG(MEM_SDRAM_MODE_REG
,
1344 INREG(MEM_SDRAM_MODE_REG
) | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1346 OUTREG( MEM_REFRESH_CNTL
, memRefreshCntl
);
1350 else if (rinfo
->is_mobility
&& rinfo
->family
== CHIP_FAMILY_RV100
) {
1351 /* Disable refresh */
1352 memRefreshCntl
= INREG(EXT_MEM_CNTL
) & ~(1 << 20);
1353 OUTREG( EXT_MEM_CNTL
, memRefreshCntl
| (1 << 20));
1356 OUTREG( MEM_SDRAM_MODE_REG
,
1357 INREG( MEM_SDRAM_MODE_REG
)
1358 & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1361 radeon_pm_enable_dll(rinfo
);
1363 /* MLCK / YCLK sync */
1364 radeon_pm_yclk_mclk_sync(rinfo
);
1366 /* Program Mode Register */
1367 radeon_pm_program_mode_reg(rinfo
, 0x2000, 1);
1368 radeon_pm_program_mode_reg(rinfo
, 0x2001, 1);
1369 radeon_pm_program_mode_reg(rinfo
, 0x2002, 1);
1370 radeon_pm_program_mode_reg(rinfo
, 0x0132, 1);
1371 radeon_pm_program_mode_reg(rinfo
, 0x0032, 1);
1373 /* Complete & re-enable refresh */
1374 OUTREG( MEM_SDRAM_MODE_REG
,
1375 INREG( MEM_SDRAM_MODE_REG
) | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1377 OUTREG(EXT_MEM_CNTL
, memRefreshCntl
);
1379 /* And finally, the M7..M9 models, including M9+ (RV280) */
1380 else if (rinfo
->is_mobility
) {
1382 /* Disable refresh */
1383 memRefreshCntl
= INREG( MEM_REFRESH_CNTL
)
1384 & ~MEM_REFRESH_CNTL__MEM_REFRESH_DIS
;
1385 OUTREG( MEM_REFRESH_CNTL
, memRefreshCntl
1386 | MEM_REFRESH_CNTL__MEM_REFRESH_DIS
);
1389 OUTREG( MEM_SDRAM_MODE_REG
,
1390 INREG( MEM_SDRAM_MODE_REG
)
1391 & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1394 radeon_pm_enable_dll(rinfo
);
1396 /* MLCK / YCLK sync */
1397 radeon_pm_yclk_mclk_sync(rinfo
);
1399 /* M6, M7 and M9 so far ... */
1400 if (rinfo
->family
<= CHIP_FAMILY_RV250
) {
1401 radeon_pm_program_mode_reg(rinfo
, 0x2000, 1);
1402 radeon_pm_program_mode_reg(rinfo
, 0x2001, 1);
1403 radeon_pm_program_mode_reg(rinfo
, 0x2002, 1);
1404 radeon_pm_program_mode_reg(rinfo
, 0x0132, 1);
1405 radeon_pm_program_mode_reg(rinfo
, 0x0032, 1);
1407 /* M9+ (iBook G4) */
1408 else if (rinfo
->family
== CHIP_FAMILY_RV280
) {
1409 radeon_pm_program_mode_reg(rinfo
, 0x2000, 1);
1410 radeon_pm_program_mode_reg(rinfo
, 0x0132, 1);
1411 radeon_pm_program_mode_reg(rinfo
, 0x0032, 1);
1414 /* Complete & re-enable refresh */
1415 OUTREG( MEM_SDRAM_MODE_REG
,
1416 INREG( MEM_SDRAM_MODE_REG
) | MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1418 OUTREG( MEM_REFRESH_CNTL
, memRefreshCntl
);
1421 OUTREG( CRTC_GEN_CNTL
, crtcGenCntl
);
1422 OUTREG( CRTC2_GEN_CNTL
, crtcGenCntl2
);
1423 OUTREG( FP_GEN_CNTL
, fp_gen_cntl
);
1424 OUTREG( FP2_GEN_CNTL
, fp2_gen_cntl
);
1426 OUTREG( CRTC_MORE_CNTL
, crtc_more_cntl
);
1431 #if defined(CONFIG_PM)
1432 #if defined(CONFIG_X86) || defined(CONFIG_PPC_PMAC)
1433 static void radeon_pm_reset_pad_ctlr_strength(struct radeonfb_info
*rinfo
)
1438 /* Reset the PAD_CTLR_STRENGTH & wait for it to be stable */
1439 INREG(PAD_CTLR_STRENGTH
);
1440 OUTREG(PAD_CTLR_STRENGTH
, INREG(PAD_CTLR_STRENGTH
) & ~PAD_MANUAL_OVERRIDE
);
1441 tmp
= INREG(PAD_CTLR_STRENGTH
);
1442 for (i
= j
= 0; i
< 65; ++i
) {
1444 tmp2
= INREG(PAD_CTLR_STRENGTH
);
1450 printk(KERN_WARNING
"radeon: PAD_CTLR_STRENGTH doesn't "
1458 static void radeon_pm_all_ppls_off(struct radeonfb_info
*rinfo
)
1462 tmp
= INPLL(pllPPLL_CNTL
);
1463 OUTPLL(pllPPLL_CNTL
, tmp
| 0x3);
1464 tmp
= INPLL(pllP2PLL_CNTL
);
1465 OUTPLL(pllP2PLL_CNTL
, tmp
| 0x3);
1466 tmp
= INPLL(pllSPLL_CNTL
);
1467 OUTPLL(pllSPLL_CNTL
, tmp
| 0x3);
1468 tmp
= INPLL(pllMPLL_CNTL
);
1469 OUTPLL(pllMPLL_CNTL
, tmp
| 0x3);
1472 static void radeon_pm_start_mclk_sclk(struct radeonfb_info
*rinfo
)
1476 /* Switch SPLL to PCI source */
1477 tmp
= INPLL(pllSCLK_CNTL
);
1478 OUTPLL(pllSCLK_CNTL
, tmp
& ~SCLK_CNTL__SCLK_SRC_SEL_MASK
);
1480 /* Reconfigure SPLL charge pump, VCO gain, duty cycle */
1481 tmp
= INPLL(pllSPLL_CNTL
);
1482 OUTREG8(CLOCK_CNTL_INDEX
, pllSPLL_CNTL
+ PLL_WR_EN
);
1483 radeon_pll_errata_after_index(rinfo
);
1484 OUTREG8(CLOCK_CNTL_DATA
+ 1, (tmp
>> 8) & 0xff);
1485 radeon_pll_errata_after_data(rinfo
);
1487 /* Set SPLL feedback divider */
1488 tmp
= INPLL(pllM_SPLL_REF_FB_DIV
);
1489 tmp
= (tmp
& 0xff00fffful
) | (rinfo
->save_regs
[77] & 0x00ff0000ul
);
1490 OUTPLL(pllM_SPLL_REF_FB_DIV
, tmp
);
1493 tmp
= INPLL(pllSPLL_CNTL
);
1494 OUTPLL(pllSPLL_CNTL
, tmp
& ~1);
1495 (void)INPLL(pllSPLL_CNTL
);
1499 /* Release SPLL reset */
1500 tmp
= INPLL(pllSPLL_CNTL
);
1501 OUTPLL(pllSPLL_CNTL
, tmp
& ~0x2);
1502 (void)INPLL(pllSPLL_CNTL
);
1506 /* Select SCLK source */
1507 tmp
= INPLL(pllSCLK_CNTL
);
1508 tmp
&= ~SCLK_CNTL__SCLK_SRC_SEL_MASK
;
1509 tmp
|= rinfo
->save_regs
[3] & SCLK_CNTL__SCLK_SRC_SEL_MASK
;
1510 OUTPLL(pllSCLK_CNTL
, tmp
);
1511 (void)INPLL(pllSCLK_CNTL
);
1515 /* Reconfigure MPLL charge pump, VCO gain, duty cycle */
1516 tmp
= INPLL(pllMPLL_CNTL
);
1517 OUTREG8(CLOCK_CNTL_INDEX
, pllMPLL_CNTL
+ PLL_WR_EN
);
1518 radeon_pll_errata_after_index(rinfo
);
1519 OUTREG8(CLOCK_CNTL_DATA
+ 1, (tmp
>> 8) & 0xff);
1520 radeon_pll_errata_after_data(rinfo
);
1522 /* Set MPLL feedback divider */
1523 tmp
= INPLL(pllM_SPLL_REF_FB_DIV
);
1524 tmp
= (tmp
& 0xffff00fful
) | (rinfo
->save_regs
[77] & 0x0000ff00ul
);
1526 OUTPLL(pllM_SPLL_REF_FB_DIV
, tmp
);
1528 tmp
= INPLL(pllMPLL_CNTL
);
1529 OUTPLL(pllMPLL_CNTL
, tmp
& ~0x2);
1530 (void)INPLL(pllMPLL_CNTL
);
1535 tmp
= INPLL(pllMPLL_CNTL
);
1536 OUTPLL(pllMPLL_CNTL
, tmp
& ~0x1);
1537 (void)INPLL(pllMPLL_CNTL
);
1541 /* Select source for MCLK */
1542 tmp
= INPLL(pllMCLK_CNTL
);
1543 tmp
|= rinfo
->save_regs
[2] & 0xffff;
1544 OUTPLL(pllMCLK_CNTL
, tmp
);
1545 (void)INPLL(pllMCLK_CNTL
);
1550 static void radeon_pm_m10_disable_spread_spectrum(struct radeonfb_info
*rinfo
)
1554 /* GACK ! I though we didn't have a DDA on Radeon's anymore
1555 * here we rewrite with the same value, ... I suppose we clear
1556 * some bits that are already clear ? Or maybe this 0x2ec
1557 * register is something new ?
1560 r2ec
= INREG(VGA_DDA_ON_OFF
);
1561 OUTREG(VGA_DDA_ON_OFF
, r2ec
);
1564 /* Spread spectrum PLLL off */
1565 OUTPLL(pllSSPLL_CNTL
, 0xbf03);
1567 /* Spread spectrum disabled */
1568 OUTPLL(pllSS_INT_CNTL
, rinfo
->save_regs
[90] & ~3);
1570 /* The trace shows read & rewrite of LVDS_PLL_CNTL here with same
1571 * value, not sure what for...
1575 OUTREG(VGA_DDA_ON_OFF
, r2ec
);
1579 static void radeon_pm_m10_enable_lvds_spread_spectrum(struct radeonfb_info
*rinfo
)
1583 /* GACK (bis) ! I though we didn't have a DDA on Radeon's anymore
1584 * here we rewrite with the same value, ... I suppose we clear/set
1585 * some bits that are already clear/set ?
1587 r2ec
= INREG(VGA_DDA_ON_OFF
);
1588 OUTREG(VGA_DDA_ON_OFF
, r2ec
);
1591 /* Enable spread spectrum */
1592 OUTPLL(pllSSPLL_CNTL
, rinfo
->save_regs
[43] | 3);
1595 OUTPLL(pllSSPLL_REF_DIV
, rinfo
->save_regs
[44]);
1596 OUTPLL(pllSSPLL_DIV_0
, rinfo
->save_regs
[45]);
1597 tmp
= INPLL(pllSSPLL_CNTL
);
1598 OUTPLL(pllSSPLL_CNTL
, tmp
& ~0x2);
1600 tmp
= INPLL(pllSSPLL_CNTL
);
1601 OUTPLL(pllSSPLL_CNTL
, tmp
& ~0x1);
1604 OUTPLL(pllSS_INT_CNTL
, rinfo
->save_regs
[90]);
1607 OUTREG(VGA_DDA_ON_OFF
, r2ec
);
1610 /* Enable LVDS interface */
1611 tmp
= INREG(LVDS_GEN_CNTL
);
1612 OUTREG(LVDS_GEN_CNTL
, tmp
| LVDS_EN
);
1614 /* Enable LVDS_PLL */
1615 tmp
= INREG(LVDS_PLL_CNTL
);
1618 OUTREG(LVDS_PLL_CNTL
, tmp
);
1620 OUTPLL(pllSCLK_MORE_CNTL
, rinfo
->save_regs
[34]);
1621 OUTPLL(pllSS_TST_CNTL
, rinfo
->save_regs
[91]);
1623 /* The trace reads that one here, waiting for something to settle down ? */
1626 /* Ugh ? SS_TST_DEC is supposed to be a read register in the
1627 * R300 register spec at least...
1629 tmp
= INPLL(pllSS_TST_CNTL
);
1631 OUTPLL(pllSS_TST_CNTL
, tmp
);
1634 static void radeon_pm_restore_pixel_pll(struct radeonfb_info
*rinfo
)
1638 OUTREG8(CLOCK_CNTL_INDEX
, pllHTOTAL_CNTL
+ PLL_WR_EN
);
1639 radeon_pll_errata_after_index(rinfo
);
1640 OUTREG8(CLOCK_CNTL_DATA
, 0);
1641 radeon_pll_errata_after_data(rinfo
);
1643 tmp
= INPLL(pllVCLK_ECP_CNTL
);
1644 OUTPLL(pllVCLK_ECP_CNTL
, tmp
| 0x80);
1647 tmp
= INPLL(pllPPLL_REF_DIV
);
1648 tmp
= (tmp
& ~PPLL_REF_DIV_MASK
) | rinfo
->pll
.ref_div
;
1649 OUTPLL(pllPPLL_REF_DIV
, tmp
);
1650 INPLL(pllPPLL_REF_DIV
);
1652 /* Reconfigure SPLL charge pump, VCO gain, duty cycle,
1653 * probably useless since we already did it ...
1655 tmp
= INPLL(pllPPLL_CNTL
);
1656 OUTREG8(CLOCK_CNTL_INDEX
, pllSPLL_CNTL
+ PLL_WR_EN
);
1657 radeon_pll_errata_after_index(rinfo
);
1658 OUTREG8(CLOCK_CNTL_DATA
+ 1, (tmp
>> 8) & 0xff);
1659 radeon_pll_errata_after_data(rinfo
);
1661 /* Restore our "reference" PPLL divider set by firmware
1662 * according to proper spread spectrum calculations
1664 OUTPLL(pllPPLL_DIV_0
, rinfo
->save_regs
[92]);
1666 tmp
= INPLL(pllPPLL_CNTL
);
1667 OUTPLL(pllPPLL_CNTL
, tmp
& ~0x2);
1670 tmp
= INPLL(pllPPLL_CNTL
);
1671 OUTPLL(pllPPLL_CNTL
, tmp
& ~0x1);
1674 tmp
= INPLL(pllVCLK_ECP_CNTL
);
1675 OUTPLL(pllVCLK_ECP_CNTL
, tmp
| 3);
1678 tmp
= INPLL(pllVCLK_ECP_CNTL
);
1679 OUTPLL(pllVCLK_ECP_CNTL
, tmp
| 3);
1682 /* Switch pixel clock to firmware default div 0 */
1683 OUTREG8(CLOCK_CNTL_INDEX
+1, 0);
1684 radeon_pll_errata_after_index(rinfo
);
1685 radeon_pll_errata_after_data(rinfo
);
1688 static void radeon_pm_m10_reconfigure_mc(struct radeonfb_info
*rinfo
)
1690 OUTREG(MC_CNTL
, rinfo
->save_regs
[46]);
1691 OUTREG(MC_INIT_GFX_LAT_TIMER
, rinfo
->save_regs
[47]);
1692 OUTREG(MC_INIT_MISC_LAT_TIMER
, rinfo
->save_regs
[48]);
1693 OUTREG(MEM_SDRAM_MODE_REG
,
1694 rinfo
->save_regs
[35] & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1695 OUTREG(MC_TIMING_CNTL
, rinfo
->save_regs
[49]);
1696 OUTREG(MEM_REFRESH_CNTL
, rinfo
->save_regs
[42]);
1697 OUTREG(MC_READ_CNTL_AB
, rinfo
->save_regs
[50]);
1698 OUTREG(MC_CHIP_IO_OE_CNTL_AB
, rinfo
->save_regs
[52]);
1699 OUTREG(MC_IOPAD_CNTL
, rinfo
->save_regs
[51]);
1700 OUTREG(MC_DEBUG
, rinfo
->save_regs
[53]);
1702 OUTMC(rinfo
, ixR300_MC_MC_INIT_WR_LAT_TIMER
, rinfo
->save_regs
[58]);
1703 OUTMC(rinfo
, ixR300_MC_IMP_CNTL
, rinfo
->save_regs
[59]);
1704 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_C0
, rinfo
->save_regs
[60]);
1705 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_C1
, rinfo
->save_regs
[61]);
1706 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_D0
, rinfo
->save_regs
[62]);
1707 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_D1
, rinfo
->save_regs
[63]);
1708 OUTMC(rinfo
, ixR300_MC_BIST_CNTL_3
, rinfo
->save_regs
[64]);
1709 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_A0
, rinfo
->save_regs
[65]);
1710 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_A1
, rinfo
->save_regs
[66]);
1711 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_B0
, rinfo
->save_regs
[67]);
1712 OUTMC(rinfo
, ixR300_MC_CHP_IO_CNTL_B1
, rinfo
->save_regs
[68]);
1713 OUTMC(rinfo
, ixR300_MC_DEBUG_CNTL
, rinfo
->save_regs
[69]);
1714 OUTMC(rinfo
, ixR300_MC_DLL_CNTL
, rinfo
->save_regs
[70]);
1715 OUTMC(rinfo
, ixR300_MC_IMP_CNTL_0
, rinfo
->save_regs
[71]);
1716 OUTMC(rinfo
, ixR300_MC_ELPIDA_CNTL
, rinfo
->save_regs
[72]);
1717 OUTMC(rinfo
, ixR300_MC_READ_CNTL_CD
, rinfo
->save_regs
[96]);
1718 OUTREG(MC_IND_INDEX
, 0);
1721 static void radeon_reinitialize_M10(struct radeonfb_info
*rinfo
)
1725 /* Restore a bunch of registers first */
1726 OUTREG(MC_AGP_LOCATION
, rinfo
->save_regs
[32]);
1727 OUTREG(DISPLAY_BASE_ADDR
, rinfo
->save_regs
[31]);
1728 OUTREG(CRTC2_DISPLAY_BASE_ADDR
, rinfo
->save_regs
[33]);
1729 OUTREG(MC_FB_LOCATION
, rinfo
->save_regs
[30]);
1730 OUTREG(OV0_BASE_ADDR
, rinfo
->save_regs
[80]);
1731 OUTREG(CNFG_MEMSIZE
, rinfo
->video_ram
);
1732 OUTREG(BUS_CNTL
, rinfo
->save_regs
[36]);
1733 OUTREG(BUS_CNTL1
, rinfo
->save_regs
[14]);
1734 OUTREG(MPP_TB_CONFIG
, rinfo
->save_regs
[37]);
1735 OUTREG(FCP_CNTL
, rinfo
->save_regs
[38]);
1736 OUTREG(RBBM_CNTL
, rinfo
->save_regs
[39]);
1737 OUTREG(DAC_CNTL
, rinfo
->save_regs
[40]);
1738 OUTREG(DAC_MACRO_CNTL
, (INREG(DAC_MACRO_CNTL
) & ~0x6) | 8);
1739 OUTREG(DAC_MACRO_CNTL
, (INREG(DAC_MACRO_CNTL
) & ~0x6) | 8);
1742 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) | DAC2_EXPAND_MODE
);
1744 /* Reset the PAD CTLR */
1745 radeon_pm_reset_pad_ctlr_strength(rinfo
);
1747 /* Some PLLs are Read & written identically in the trace here...
1748 * I suppose it's actually to switch them all off & reset,
1749 * let's assume off is what we want. I'm just doing that for all major PLLs now.
1751 radeon_pm_all_ppls_off(rinfo
);
1753 /* Clear tiling, reset swappers */
1754 INREG(SURFACE_CNTL
);
1755 OUTREG(SURFACE_CNTL
, 0);
1757 /* Some black magic with TV_DAC_CNTL, we should restore those from backups
1758 * rather than hard coding...
1760 tmp
= INREG(TV_DAC_CNTL
) & ~TV_DAC_CNTL_BGADJ_MASK
;
1761 tmp
|= 8 << TV_DAC_CNTL_BGADJ__SHIFT
;
1762 OUTREG(TV_DAC_CNTL
, tmp
);
1764 tmp
= INREG(TV_DAC_CNTL
) & ~TV_DAC_CNTL_DACADJ_MASK
;
1765 tmp
|= 7 << TV_DAC_CNTL_DACADJ__SHIFT
;
1766 OUTREG(TV_DAC_CNTL
, tmp
);
1768 /* More registers restored */
1769 OUTREG(AGP_CNTL
, rinfo
->save_regs
[16]);
1770 OUTREG(HOST_PATH_CNTL
, rinfo
->save_regs
[41]);
1771 OUTREG(DISP_MISC_CNTL
, rinfo
->save_regs
[9]);
1773 /* Hrmmm ... What is that ? */
1774 tmp
= rinfo
->save_regs
[1]
1775 & ~(CLK_PWRMGT_CNTL__ACTIVE_HILO_LAT_MASK
|
1776 CLK_PWRMGT_CNTL__MC_BUSY
);
1777 OUTPLL(pllCLK_PWRMGT_CNTL
, tmp
);
1779 OUTREG(PAD_CTLR_MISC
, rinfo
->save_regs
[56]);
1780 OUTREG(FW_CNTL
, rinfo
->save_regs
[57]);
1781 OUTREG(HDP_DEBUG
, rinfo
->save_regs
[96]);
1782 OUTREG(PAMAC0_DLY_CNTL
, rinfo
->save_regs
[54]);
1783 OUTREG(PAMAC1_DLY_CNTL
, rinfo
->save_regs
[55]);
1784 OUTREG(PAMAC2_DLY_CNTL
, rinfo
->save_regs
[79]);
1786 /* Restore Memory Controller configuration */
1787 radeon_pm_m10_reconfigure_mc(rinfo
);
1789 /* Make sure CRTC's dont touch memory */
1790 OUTREG(CRTC_GEN_CNTL
, INREG(CRTC_GEN_CNTL
)
1791 | CRTC_GEN_CNTL__CRTC_DISP_REQ_EN_B
);
1792 OUTREG(CRTC2_GEN_CNTL
, INREG(CRTC2_GEN_CNTL
)
1793 | CRTC2_GEN_CNTL__CRTC2_DISP_REQ_EN_B
);
1796 /* Disable SDRAM refresh */
1797 OUTREG(MEM_REFRESH_CNTL
, INREG(MEM_REFRESH_CNTL
)
1798 | MEM_REFRESH_CNTL__MEM_REFRESH_DIS
);
1800 /* Restore XTALIN routing (CLK_PIN_CNTL) */
1801 OUTPLL(pllCLK_PIN_CNTL
, rinfo
->save_regs
[4]);
1803 /* Switch MCLK, YCLK and SCLK PLLs to PCI source & force them ON */
1804 tmp
= rinfo
->save_regs
[2] & 0xff000000;
1805 tmp
|= MCLK_CNTL__FORCE_MCLKA
|
1806 MCLK_CNTL__FORCE_MCLKB
|
1807 MCLK_CNTL__FORCE_YCLKA
|
1808 MCLK_CNTL__FORCE_YCLKB
|
1809 MCLK_CNTL__FORCE_MC
;
1810 OUTPLL(pllMCLK_CNTL
, tmp
);
1812 /* Force all clocks on in SCLK */
1813 tmp
= INPLL(pllSCLK_CNTL
);
1814 tmp
|= SCLK_CNTL__FORCE_DISP2
|
1815 SCLK_CNTL__FORCE_CP
|
1816 SCLK_CNTL__FORCE_HDP
|
1817 SCLK_CNTL__FORCE_DISP1
|
1818 SCLK_CNTL__FORCE_TOP
|
1819 SCLK_CNTL__FORCE_E2
|
1820 SCLK_CNTL__FORCE_SE
|
1821 SCLK_CNTL__FORCE_IDCT
|
1822 SCLK_CNTL__FORCE_VIP
|
1823 SCLK_CNTL__FORCE_PB
|
1824 SCLK_CNTL__FORCE_TAM
|
1825 SCLK_CNTL__FORCE_TDM
|
1826 SCLK_CNTL__FORCE_RB
|
1827 SCLK_CNTL__FORCE_TV_SCLK
|
1828 SCLK_CNTL__FORCE_SUBPIC
|
1829 SCLK_CNTL__FORCE_OV0
;
1830 tmp
|= SCLK_CNTL__CP_MAX_DYN_STOP_LAT
|
1831 SCLK_CNTL__HDP_MAX_DYN_STOP_LAT
|
1832 SCLK_CNTL__TV_MAX_DYN_STOP_LAT
|
1833 SCLK_CNTL__E2_MAX_DYN_STOP_LAT
|
1834 SCLK_CNTL__SE_MAX_DYN_STOP_LAT
|
1835 SCLK_CNTL__IDCT_MAX_DYN_STOP_LAT
|
1836 SCLK_CNTL__VIP_MAX_DYN_STOP_LAT
|
1837 SCLK_CNTL__RE_MAX_DYN_STOP_LAT
|
1838 SCLK_CNTL__PB_MAX_DYN_STOP_LAT
|
1839 SCLK_CNTL__TAM_MAX_DYN_STOP_LAT
|
1840 SCLK_CNTL__TDM_MAX_DYN_STOP_LAT
|
1841 SCLK_CNTL__RB_MAX_DYN_STOP_LAT
;
1842 OUTPLL(pllSCLK_CNTL
, tmp
);
1844 OUTPLL(pllVCLK_ECP_CNTL
, 0);
1845 OUTPLL(pllPIXCLKS_CNTL
, 0);
1846 OUTPLL(pllMCLK_MISC
,
1847 MCLK_MISC__MC_MCLK_MAX_DYN_STOP_LAT
|
1848 MCLK_MISC__IO_MCLK_MAX_DYN_STOP_LAT
);
1852 /* Restore the M_SPLL_REF_FB_DIV, MPLL_AUX_CNTL and SPLL_AUX_CNTL values */
1853 OUTPLL(pllM_SPLL_REF_FB_DIV
, rinfo
->save_regs
[77]);
1854 OUTPLL(pllMPLL_AUX_CNTL
, rinfo
->save_regs
[75]);
1855 OUTPLL(pllSPLL_AUX_CNTL
, rinfo
->save_regs
[76]);
1857 /* Now restore the major PLLs settings, keeping them off & reset though */
1858 OUTPLL(pllPPLL_CNTL
, rinfo
->save_regs
[93] | 0x3);
1859 OUTPLL(pllP2PLL_CNTL
, rinfo
->save_regs
[8] | 0x3);
1860 OUTPLL(pllMPLL_CNTL
, rinfo
->save_regs
[73] | 0x03);
1861 OUTPLL(pllSPLL_CNTL
, rinfo
->save_regs
[74] | 0x03);
1863 /* Restore MC DLL state and switch it off/reset too */
1864 OUTMC(rinfo
, ixR300_MC_DLL_CNTL
, rinfo
->save_regs
[70]);
1866 /* Switch MDLL off & reset */
1867 OUTPLL(pllMDLL_RDCKA
, rinfo
->save_regs
[98] | 0xff);
1870 /* Setup some black magic bits in PLL_PWRMGT_CNTL. Hrm... we saved
1871 * 0xa1100007... and MacOS writes 0xa1000007 ..
1873 OUTPLL(pllPLL_PWRMGT_CNTL
, rinfo
->save_regs
[0]);
1875 /* Restore more stuffs */
1876 OUTPLL(pllHTOTAL_CNTL
, 0);
1877 OUTPLL(pllHTOTAL2_CNTL
, 0);
1879 /* More PLL initial configuration */
1880 tmp
= INPLL(pllSCLK_CNTL2
); /* What for ? */
1881 OUTPLL(pllSCLK_CNTL2
, tmp
);
1883 tmp
= INPLL(pllSCLK_MORE_CNTL
);
1884 tmp
|= SCLK_MORE_CNTL__FORCE_DISPREGS
| /* a guess */
1885 SCLK_MORE_CNTL__FORCE_MC_GUI
|
1886 SCLK_MORE_CNTL__FORCE_MC_HOST
;
1887 OUTPLL(pllSCLK_MORE_CNTL
, tmp
);
1889 /* Now we actually start MCLK and SCLK */
1890 radeon_pm_start_mclk_sclk(rinfo
);
1892 /* Full reset sdrams, this also re-inits the MDLL */
1893 radeon_pm_full_reset_sdram(rinfo
);
1896 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) | 0x20);
1897 for (i
=0; i
<256; i
++)
1898 OUTREG(PALETTE_30_DATA
, 0x15555555);
1899 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) & ~20);
1901 for (i
=0; i
<256; i
++)
1902 OUTREG(PALETTE_30_DATA
, 0x15555555);
1904 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) & ~0x20);
1908 OUTREG(FP_GEN_CNTL
, rinfo
->save_regs
[82]);
1909 OUTREG(FP2_GEN_CNTL
, rinfo
->save_regs
[83]);
1911 /* Set LVDS registers but keep interface & pll down */
1912 OUTREG(LVDS_GEN_CNTL
, rinfo
->save_regs
[11] &
1913 ~(LVDS_EN
| LVDS_ON
| LVDS_DIGON
| LVDS_BLON
| LVDS_BL_MOD_EN
));
1914 OUTREG(LVDS_PLL_CNTL
, (rinfo
->save_regs
[12] & ~0xf0000) | 0x20000);
1916 OUTREG(DISP_OUTPUT_CNTL
, rinfo
->save_regs
[86]);
1918 /* Restore GPIOPAD state */
1919 OUTREG(GPIOPAD_A
, rinfo
->save_regs
[19]);
1920 OUTREG(GPIOPAD_EN
, rinfo
->save_regs
[20]);
1921 OUTREG(GPIOPAD_MASK
, rinfo
->save_regs
[21]);
1923 /* write some stuff to the framebuffer... */
1924 for (i
= 0; i
< 0x8000; ++i
)
1925 writeb(0, rinfo
->fb_base
+ i
);
1928 OUTREG(LVDS_GEN_CNTL
, INREG(LVDS_GEN_CNTL
) | LVDS_DIGON
| LVDS_ON
);
1931 /* Restore a few more things */
1932 OUTREG(GRPH_BUFFER_CNTL
, rinfo
->save_regs
[94]);
1933 OUTREG(GRPH2_BUFFER_CNTL
, rinfo
->save_regs
[95]);
1935 /* Take care of spread spectrum & PPLLs now */
1936 radeon_pm_m10_disable_spread_spectrum(rinfo
);
1937 radeon_pm_restore_pixel_pll(rinfo
);
1939 /* GRRRR... I can't figure out the proper LVDS power sequence, and the
1940 * code I have for blank/unblank doesn't quite work on some laptop models
1941 * it seems ... Hrm. What I have here works most of the time ...
1943 radeon_pm_m10_enable_lvds_spread_spectrum(rinfo
);
1948 #ifdef CONFIG_PPC_PMAC
1949 static void radeon_pm_m9p_reconfigure_mc(struct radeonfb_info
*rinfo
)
1951 OUTREG(MC_CNTL
, rinfo
->save_regs
[46]);
1952 OUTREG(MC_INIT_GFX_LAT_TIMER
, rinfo
->save_regs
[47]);
1953 OUTREG(MC_INIT_MISC_LAT_TIMER
, rinfo
->save_regs
[48]);
1954 OUTREG(MEM_SDRAM_MODE_REG
,
1955 rinfo
->save_regs
[35] & ~MEM_SDRAM_MODE_REG__MC_INIT_COMPLETE
);
1956 OUTREG(MC_TIMING_CNTL
, rinfo
->save_regs
[49]);
1957 OUTREG(MC_READ_CNTL_AB
, rinfo
->save_regs
[50]);
1958 OUTREG(MEM_REFRESH_CNTL
, rinfo
->save_regs
[42]);
1959 OUTREG(MC_IOPAD_CNTL
, rinfo
->save_regs
[51]);
1960 OUTREG(MC_DEBUG
, rinfo
->save_regs
[53]);
1961 OUTREG(MC_CHIP_IO_OE_CNTL_AB
, rinfo
->save_regs
[52]);
1963 OUTMC(rinfo
, ixMC_IMP_CNTL
, rinfo
->save_regs
[59] /*0x00f460d6*/);
1964 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_A0
, rinfo
->save_regs
[65] /*0xfecfa666*/);
1965 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_A1
, rinfo
->save_regs
[66] /*0x141555ff*/);
1966 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_B0
, rinfo
->save_regs
[67] /*0xfecfa666*/);
1967 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_B1
, rinfo
->save_regs
[68] /*0x141555ff*/);
1968 OUTMC(rinfo
, ixMC_IMP_CNTL_0
, rinfo
->save_regs
[71] /*0x00009249*/);
1969 OUTREG(MC_IND_INDEX
, 0);
1970 OUTREG(CNFG_MEMSIZE
, rinfo
->video_ram
);
1975 static void radeon_reinitialize_M9P(struct radeonfb_info
*rinfo
)
1979 /* Restore a bunch of registers first */
1980 OUTREG(SURFACE_CNTL
, rinfo
->save_regs
[29]);
1981 OUTREG(MC_AGP_LOCATION
, rinfo
->save_regs
[32]);
1982 OUTREG(DISPLAY_BASE_ADDR
, rinfo
->save_regs
[31]);
1983 OUTREG(CRTC2_DISPLAY_BASE_ADDR
, rinfo
->save_regs
[33]);
1984 OUTREG(MC_FB_LOCATION
, rinfo
->save_regs
[30]);
1985 OUTREG(OV0_BASE_ADDR
, rinfo
->save_regs
[80]);
1986 OUTREG(BUS_CNTL
, rinfo
->save_regs
[36]);
1987 OUTREG(BUS_CNTL1
, rinfo
->save_regs
[14]);
1988 OUTREG(MPP_TB_CONFIG
, rinfo
->save_regs
[37]);
1989 OUTREG(FCP_CNTL
, rinfo
->save_regs
[38]);
1990 OUTREG(RBBM_CNTL
, rinfo
->save_regs
[39]);
1992 OUTREG(DAC_CNTL
, rinfo
->save_regs
[40]);
1993 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) | DAC2_EXPAND_MODE
);
1995 /* Reset the PAD CTLR */
1996 radeon_pm_reset_pad_ctlr_strength(rinfo
);
1998 /* Some PLLs are Read & written identically in the trace here...
1999 * I suppose it's actually to switch them all off & reset,
2000 * let's assume off is what we want. I'm just doing that for all major PLLs now.
2002 radeon_pm_all_ppls_off(rinfo
);
2004 /* Clear tiling, reset swappers */
2005 INREG(SURFACE_CNTL
);
2006 OUTREG(SURFACE_CNTL
, 0);
2008 /* Some black magic with TV_DAC_CNTL, we should restore those from backups
2009 * rather than hard coding...
2011 tmp
= INREG(TV_DAC_CNTL
) & ~TV_DAC_CNTL_BGADJ_MASK
;
2012 tmp
|= 6 << TV_DAC_CNTL_BGADJ__SHIFT
;
2013 OUTREG(TV_DAC_CNTL
, tmp
);
2015 tmp
= INREG(TV_DAC_CNTL
) & ~TV_DAC_CNTL_DACADJ_MASK
;
2016 tmp
|= 6 << TV_DAC_CNTL_DACADJ__SHIFT
;
2017 OUTREG(TV_DAC_CNTL
, tmp
);
2019 OUTPLL(pllAGP_PLL_CNTL
, rinfo
->save_regs
[78]);
2021 OUTREG(PAMAC0_DLY_CNTL
, rinfo
->save_regs
[54]);
2022 OUTREG(PAMAC1_DLY_CNTL
, rinfo
->save_regs
[55]);
2023 OUTREG(PAMAC2_DLY_CNTL
, rinfo
->save_regs
[79]);
2025 OUTREG(AGP_CNTL
, rinfo
->save_regs
[16]);
2026 OUTREG(HOST_PATH_CNTL
, rinfo
->save_regs
[41]); /* MacOS sets that to 0 !!! */
2027 OUTREG(DISP_MISC_CNTL
, rinfo
->save_regs
[9]);
2029 tmp
= rinfo
->save_regs
[1]
2030 & ~(CLK_PWRMGT_CNTL__ACTIVE_HILO_LAT_MASK
|
2031 CLK_PWRMGT_CNTL__MC_BUSY
);
2032 OUTPLL(pllCLK_PWRMGT_CNTL
, tmp
);
2034 OUTREG(FW_CNTL
, rinfo
->save_regs
[57]);
2036 /* Disable SDRAM refresh */
2037 OUTREG(MEM_REFRESH_CNTL
, INREG(MEM_REFRESH_CNTL
)
2038 | MEM_REFRESH_CNTL__MEM_REFRESH_DIS
);
2040 /* Restore XTALIN routing (CLK_PIN_CNTL) */
2041 OUTPLL(pllCLK_PIN_CNTL
, rinfo
->save_regs
[4]);
2043 /* Force MCLK to be PCI sourced and forced ON */
2044 tmp
= rinfo
->save_regs
[2] & 0xff000000;
2045 tmp
|= MCLK_CNTL__FORCE_MCLKA
|
2046 MCLK_CNTL__FORCE_MCLKB
|
2047 MCLK_CNTL__FORCE_YCLKA
|
2048 MCLK_CNTL__FORCE_YCLKB
|
2049 MCLK_CNTL__FORCE_MC
|
2050 MCLK_CNTL__FORCE_AIC
;
2051 OUTPLL(pllMCLK_CNTL
, tmp
);
2053 /* Force SCLK to be PCI sourced with a bunch forced */
2055 SCLK_CNTL__FORCE_DISP2
|
2056 SCLK_CNTL__FORCE_CP
|
2057 SCLK_CNTL__FORCE_HDP
|
2058 SCLK_CNTL__FORCE_DISP1
|
2059 SCLK_CNTL__FORCE_TOP
|
2060 SCLK_CNTL__FORCE_E2
|
2061 SCLK_CNTL__FORCE_SE
|
2062 SCLK_CNTL__FORCE_IDCT
|
2063 SCLK_CNTL__FORCE_VIP
|
2064 SCLK_CNTL__FORCE_RE
|
2065 SCLK_CNTL__FORCE_PB
|
2066 SCLK_CNTL__FORCE_TAM
|
2067 SCLK_CNTL__FORCE_TDM
|
2068 SCLK_CNTL__FORCE_RB
;
2069 OUTPLL(pllSCLK_CNTL
, tmp
);
2071 /* Clear VCLK_ECP_CNTL & PIXCLKS_CNTL */
2072 OUTPLL(pllVCLK_ECP_CNTL
, 0);
2073 OUTPLL(pllPIXCLKS_CNTL
, 0);
2075 /* Setup MCLK_MISC, non dynamic mode */
2076 OUTPLL(pllMCLK_MISC
,
2077 MCLK_MISC__MC_MCLK_MAX_DYN_STOP_LAT
|
2078 MCLK_MISC__IO_MCLK_MAX_DYN_STOP_LAT
);
2082 /* Set back the default clock dividers */
2083 OUTPLL(pllM_SPLL_REF_FB_DIV
, rinfo
->save_regs
[77]);
2084 OUTPLL(pllMPLL_AUX_CNTL
, rinfo
->save_regs
[75]);
2085 OUTPLL(pllSPLL_AUX_CNTL
, rinfo
->save_regs
[76]);
2087 /* PPLL and P2PLL default values & off */
2088 OUTPLL(pllPPLL_CNTL
, rinfo
->save_regs
[93] | 0x3);
2089 OUTPLL(pllP2PLL_CNTL
, rinfo
->save_regs
[8] | 0x3);
2091 /* S and M PLLs are reset & off, configure them */
2092 OUTPLL(pllMPLL_CNTL
, rinfo
->save_regs
[73] | 0x03);
2093 OUTPLL(pllSPLL_CNTL
, rinfo
->save_regs
[74] | 0x03);
2095 /* Default values for MDLL ... fixme */
2096 OUTPLL(pllMDLL_CKO
, 0x9c009c);
2097 OUTPLL(pllMDLL_RDCKA
, 0x08830883);
2098 OUTPLL(pllMDLL_RDCKB
, 0x08830883);
2101 /* Restore PLL_PWRMGT_CNTL */ // XXXX
2102 tmp
= rinfo
->save_regs
[0];
2103 tmp
&= ~PLL_PWRMGT_CNTL_SU_SCLK_USE_BCLK
;
2104 tmp
|= PLL_PWRMGT_CNTL_SU_MCLK_USE_BCLK
;
2105 OUTPLL(PLL_PWRMGT_CNTL
, tmp
);
2107 /* Clear HTOTAL_CNTL & HTOTAL2_CNTL */
2108 OUTPLL(pllHTOTAL_CNTL
, 0);
2109 OUTPLL(pllHTOTAL2_CNTL
, 0);
2111 /* All outputs off */
2112 OUTREG(CRTC_GEN_CNTL
, 0x04000000);
2113 OUTREG(CRTC2_GEN_CNTL
, 0x04000000);
2114 OUTREG(FP_GEN_CNTL
, 0x00004008);
2115 OUTREG(FP2_GEN_CNTL
, 0x00000008);
2116 OUTREG(LVDS_GEN_CNTL
, 0x08000008);
2118 /* Restore Memory Controller configuration */
2119 radeon_pm_m9p_reconfigure_mc(rinfo
);
2121 /* Now we actually start MCLK and SCLK */
2122 radeon_pm_start_mclk_sclk(rinfo
);
2124 /* Full reset sdrams, this also re-inits the MDLL */
2125 radeon_pm_full_reset_sdram(rinfo
);
2128 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) | 0x20);
2129 for (i
=0; i
<256; i
++)
2130 OUTREG(PALETTE_30_DATA
, 0x15555555);
2131 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) & ~20);
2133 for (i
=0; i
<256; i
++)
2134 OUTREG(PALETTE_30_DATA
, 0x15555555);
2136 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) & ~0x20);
2139 /* Restore TV stuff, make sure TV DAC is down */
2140 OUTREG(TV_MASTER_CNTL
, rinfo
->save_regs
[88]);
2141 OUTREG(TV_DAC_CNTL
, rinfo
->save_regs
[13] | 0x07000000);
2143 /* Restore GPIOS. MacOS does some magic here with one of the GPIO bits,
2144 * possibly related to the weird PLL related workarounds and to the
2145 * fact that CLK_PIN_CNTL is tweaked in ways I don't fully understand,
2146 * but we keep things the simple way here
2148 OUTREG(GPIOPAD_A
, rinfo
->save_regs
[19]);
2149 OUTREG(GPIOPAD_EN
, rinfo
->save_regs
[20]);
2150 OUTREG(GPIOPAD_MASK
, rinfo
->save_regs
[21]);
2152 /* Now do things with SCLK_MORE_CNTL. Force bits are already set, copy
2153 * high bits from backup
2155 tmp
= INPLL(pllSCLK_MORE_CNTL
) & 0x0000ffff;
2156 tmp
|= rinfo
->save_regs
[34] & 0xffff0000;
2157 tmp
|= SCLK_MORE_CNTL__FORCE_DISPREGS
;
2158 OUTPLL(pllSCLK_MORE_CNTL
, tmp
);
2160 tmp
= INPLL(pllSCLK_MORE_CNTL
) & 0x0000ffff;
2161 tmp
|= rinfo
->save_regs
[34] & 0xffff0000;
2162 tmp
|= SCLK_MORE_CNTL__FORCE_DISPREGS
;
2163 OUTPLL(pllSCLK_MORE_CNTL
, tmp
);
2165 OUTREG(LVDS_GEN_CNTL
, rinfo
->save_regs
[11] &
2166 ~(LVDS_EN
| LVDS_ON
| LVDS_DIGON
| LVDS_BLON
| LVDS_BL_MOD_EN
));
2167 OUTREG(LVDS_GEN_CNTL
, INREG(LVDS_GEN_CNTL
) | LVDS_BLON
);
2168 OUTREG(LVDS_PLL_CNTL
, (rinfo
->save_regs
[12] & ~0xf0000) | 0x20000);
2171 /* write some stuff to the framebuffer... */
2172 for (i
= 0; i
< 0x8000; ++i
)
2173 writeb(0, rinfo
->fb_base
+ i
);
2175 OUTREG(0x2ec, 0x6332a020);
2176 OUTPLL(pllSSPLL_REF_DIV
, rinfo
->save_regs
[44] /*0x3f */);
2177 OUTPLL(pllSSPLL_DIV_0
, rinfo
->save_regs
[45] /*0x000081bb */);
2178 tmp
= INPLL(pllSSPLL_CNTL
);
2180 OUTPLL(pllSSPLL_CNTL
, tmp
);
2183 OUTPLL(pllSSPLL_CNTL
, tmp
);
2186 OUTPLL(pllSSPLL_CNTL
, tmp
);
2189 OUTPLL(pllSS_INT_CNTL
, rinfo
->save_regs
[90] & ~3);/*0x0020300c*/
2190 OUTREG(0x2ec, 0x6332a3f0);
2193 OUTPLL(pllPPLL_REF_DIV
, rinfo
->pll
.ref_div
);
2194 OUTPLL(pllPPLL_DIV_0
, rinfo
->save_regs
[92]);
2197 OUTREG(LVDS_GEN_CNTL
, INREG(LVDS_GEN_CNTL
) | LVDS_DIGON
| LVDS_ON
);
2200 /* Restore a few more things */
2201 OUTREG(GRPH_BUFFER_CNTL
, rinfo
->save_regs
[94]);
2202 OUTREG(GRPH2_BUFFER_CNTL
, rinfo
->save_regs
[95]);
2204 /* Restore PPLL, spread spectrum & LVDS */
2205 radeon_pm_m10_disable_spread_spectrum(rinfo
);
2206 radeon_pm_restore_pixel_pll(rinfo
);
2207 radeon_pm_m10_enable_lvds_spread_spectrum(rinfo
);
2212 #if 0 /* Not ready yet */
2213 static void radeon_reinitialize_QW(struct radeonfb_info
*rinfo
)
2220 OUTREG(MC_AGP_LOCATION
, rinfo
->save_regs
[32]);
2221 OUTREG(DISPLAY_BASE_ADDR
, rinfo
->save_regs
[31]);
2222 OUTREG(CRTC2_DISPLAY_BASE_ADDR
, rinfo
->save_regs
[33]);
2223 OUTREG(MC_FB_LOCATION
, rinfo
->save_regs
[30]);
2224 OUTREG(BUS_CNTL
, rinfo
->save_regs
[36]);
2225 OUTREG(RBBM_CNTL
, rinfo
->save_regs
[39]);
2227 INREG(PAD_CTLR_STRENGTH
);
2228 OUTREG(PAD_CTLR_STRENGTH
, INREG(PAD_CTLR_STRENGTH
) & ~0x10000);
2229 for (i
= 0; i
< 65; ++i
) {
2231 INREG(PAD_CTLR_STRENGTH
);
2234 OUTREG(DISP_TEST_DEBUG_CNTL
, INREG(DISP_TEST_DEBUG_CNTL
) | 0x10000000);
2235 OUTREG(OV0_FLAG_CNTRL
, INREG(OV0_FLAG_CNTRL
) | 0x100);
2236 OUTREG(CRTC_GEN_CNTL
, INREG(CRTC_GEN_CNTL
));
2237 OUTREG(DAC_CNTL
, 0xff00410a);
2238 OUTREG(CRTC2_GEN_CNTL
, INREG(CRTC2_GEN_CNTL
));
2239 OUTREG(DAC_CNTL2
, INREG(DAC_CNTL2
) | 0x4000);
2241 OUTREG(SURFACE_CNTL
, rinfo
->save_regs
[29]);
2242 OUTREG(AGP_CNTL
, rinfo
->save_regs
[16]);
2243 OUTREG(HOST_PATH_CNTL
, rinfo
->save_regs
[41]);
2244 OUTREG(DISP_MISC_CNTL
, rinfo
->save_regs
[9]);
2246 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_A0
, 0xf7bb4433);
2247 OUTREG(MC_IND_INDEX
, 0);
2248 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_B0
, 0xf7bb4433);
2249 OUTREG(MC_IND_INDEX
, 0);
2251 OUTREG(CRTC_MORE_CNTL
, INREG(CRTC_MORE_CNTL
));
2253 tmp
= INPLL(pllVCLK_ECP_CNTL
);
2254 OUTPLL(pllVCLK_ECP_CNTL
, tmp
);
2255 tmp
= INPLL(pllPIXCLKS_CNTL
);
2256 OUTPLL(pllPIXCLKS_CNTL
, tmp
);
2258 OUTPLL(MCLK_CNTL
, 0xaa3f0000);
2259 OUTPLL(SCLK_CNTL
, 0xffff0000);
2260 OUTPLL(pllMPLL_AUX_CNTL
, 6);
2261 OUTPLL(pllSPLL_AUX_CNTL
, 1);
2262 OUTPLL(MDLL_CKO
, 0x9f009f);
2263 OUTPLL(MDLL_RDCKA
, 0x830083);
2264 OUTPLL(pllMDLL_RDCKB
, 0x830083);
2265 OUTPLL(PPLL_CNTL
, 0xa433);
2266 OUTPLL(P2PLL_CNTL
, 0xa433);
2267 OUTPLL(MPLL_CNTL
, 0x0400a403);
2268 OUTPLL(SPLL_CNTL
, 0x0400a433);
2270 tmp
= INPLL(M_SPLL_REF_FB_DIV
);
2271 OUTPLL(M_SPLL_REF_FB_DIV
, tmp
);
2272 tmp
= INPLL(M_SPLL_REF_FB_DIV
);
2273 OUTPLL(M_SPLL_REF_FB_DIV
, tmp
| 0xc);
2274 INPLL(M_SPLL_REF_FB_DIV
);
2276 tmp
= INPLL(MPLL_CNTL
);
2277 OUTREG8(CLOCK_CNTL_INDEX
, MPLL_CNTL
+ PLL_WR_EN
);
2278 radeon_pll_errata_after_index(rinfo
);
2279 OUTREG8(CLOCK_CNTL_DATA
+ 1, (tmp
>> 8) & 0xff);
2280 radeon_pll_errata_after_data(rinfo
);
2282 tmp
= INPLL(M_SPLL_REF_FB_DIV
);
2283 OUTPLL(M_SPLL_REF_FB_DIV
, tmp
| 0x5900);
2285 tmp
= INPLL(MPLL_CNTL
);
2286 OUTPLL(MPLL_CNTL
, tmp
& ~0x2);
2288 tmp
= INPLL(MPLL_CNTL
);
2289 OUTPLL(MPLL_CNTL
, tmp
& ~0x1);
2292 OUTPLL(MCLK_CNTL
, 0xaa3f1212);
2295 INPLL(M_SPLL_REF_FB_DIV
);
2297 INPLL(M_SPLL_REF_FB_DIV
);
2299 tmp
= INPLL(SPLL_CNTL
);
2300 OUTREG8(CLOCK_CNTL_INDEX
, SPLL_CNTL
+ PLL_WR_EN
);
2301 radeon_pll_errata_after_index(rinfo
);
2302 OUTREG8(CLOCK_CNTL_DATA
+ 1, (tmp
>> 8) & 0xff);
2303 radeon_pll_errata_after_data(rinfo
);
2305 tmp
= INPLL(M_SPLL_REF_FB_DIV
);
2306 OUTPLL(M_SPLL_REF_FB_DIV
, tmp
| 0x780000);
2308 tmp
= INPLL(SPLL_CNTL
);
2309 OUTPLL(SPLL_CNTL
, tmp
& ~0x1);
2311 tmp
= INPLL(SPLL_CNTL
);
2312 OUTPLL(SPLL_CNTL
, tmp
& ~0x2);
2315 tmp
= INPLL(SCLK_CNTL
);
2316 OUTPLL(SCLK_CNTL
, tmp
| 2);
2319 cko
= INPLL(pllMDLL_CKO
);
2320 cka
= INPLL(pllMDLL_RDCKA
);
2321 ckb
= INPLL(pllMDLL_RDCKB
);
2323 cko
&= ~(MDLL_CKO__MCKOA_SLEEP
| MDLL_CKO__MCKOB_SLEEP
);
2324 OUTPLL(pllMDLL_CKO
, cko
);
2326 cko
&= ~(MDLL_CKO__MCKOA_RESET
| MDLL_CKO__MCKOB_RESET
);
2327 OUTPLL(pllMDLL_CKO
, cko
);
2330 cka
&= ~(MDLL_RDCKA__MRDCKA0_SLEEP
| MDLL_RDCKA__MRDCKA1_SLEEP
);
2331 OUTPLL(pllMDLL_RDCKA
, cka
);
2333 cka
&= ~(MDLL_RDCKA__MRDCKA0_RESET
| MDLL_RDCKA__MRDCKA1_RESET
);
2334 OUTPLL(pllMDLL_RDCKA
, cka
);
2337 ckb
&= ~(MDLL_RDCKB__MRDCKB0_SLEEP
| MDLL_RDCKB__MRDCKB1_SLEEP
);
2338 OUTPLL(pllMDLL_RDCKB
, ckb
);
2340 ckb
&= ~(MDLL_RDCKB__MRDCKB0_RESET
| MDLL_RDCKB__MRDCKB1_RESET
);
2341 OUTPLL(pllMDLL_RDCKB
, ckb
);
2344 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_A1
, 0x151550ff);
2345 OUTREG(MC_IND_INDEX
, 0);
2346 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_B1
, 0x151550ff);
2347 OUTREG(MC_IND_INDEX
, 0);
2349 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_A1
, 0x141550ff);
2350 OUTREG(MC_IND_INDEX
, 0);
2351 OUTMC(rinfo
, ixMC_CHP_IO_CNTL_B1
, 0x141550ff);
2352 OUTREG(MC_IND_INDEX
, 0);
2355 OUTPLL(pllHTOTAL_CNTL
, 0);
2356 OUTPLL(pllHTOTAL2_CNTL
, 0);
2358 OUTREG(MEM_CNTL
, 0x29002901);
2359 OUTREG(MEM_SDRAM_MODE_REG
, 0x45320032); /* XXX use save_regs[35]? */
2360 OUTREG(EXT_MEM_CNTL
, 0x1a394333);
2361 OUTREG(MEM_IO_CNTL_A1
, 0x0aac0aac);
2362 OUTREG(MEM_INIT_LATENCY_TIMER
, 0x34444444);
2363 OUTREG(MEM_REFRESH_CNTL
, 0x1f1f7218); /* XXX or save_regs[42]? */
2364 OUTREG(MC_DEBUG
, 0);
2365 OUTREG(MEM_IO_OE_CNTL
, 0x04300430);
2367 OUTMC(rinfo
, ixMC_IMP_CNTL
, 0x00f460d6);
2368 OUTREG(MC_IND_INDEX
, 0);
2369 OUTMC(rinfo
, ixMC_IMP_CNTL_0
, 0x00009249);
2370 OUTREG(MC_IND_INDEX
, 0);
2372 OUTREG(CNFG_MEMSIZE
, rinfo
->video_ram
);
2374 radeon_pm_full_reset_sdram(rinfo
);
2377 OUTREG(TMDS_CNTL
, 0x01000000); /* XXX ? */
2378 tmp
= INREG(FP_GEN_CNTL
);
2379 tmp
|= FP_CRTC_DONT_SHADOW_HEND
| FP_CRTC_DONT_SHADOW_VPAR
| 0x200;
2380 OUTREG(FP_GEN_CNTL
, tmp
);
2382 tmp
= INREG(DISP_OUTPUT_CNTL
);
2384 OUTREG(DISP_OUTPUT_CNTL
, tmp
);
2386 OUTPLL(CLK_PIN_CNTL
, rinfo
->save_regs
[4]);
2387 OUTPLL(CLK_PWRMGT_CNTL
, rinfo
->save_regs
[1]);
2388 OUTPLL(PLL_PWRMGT_CNTL
, rinfo
->save_regs
[0]);
2390 tmp
= INPLL(MCLK_MISC
);
2391 tmp
|= MCLK_MISC__MC_MCLK_DYN_ENABLE
| MCLK_MISC__IO_MCLK_DYN_ENABLE
;
2392 OUTPLL(MCLK_MISC
, tmp
);
2394 tmp
= INPLL(SCLK_CNTL
);
2395 OUTPLL(SCLK_CNTL
, tmp
);
2397 OUTREG(CRTC_MORE_CNTL
, 0);
2398 OUTREG8(CRTC_GEN_CNTL
+1, 6);
2399 OUTREG8(CRTC_GEN_CNTL
+3, 1);
2400 OUTREG(CRTC_PITCH
, 32);
2402 tmp
= INPLL(VCLK_ECP_CNTL
);
2403 OUTPLL(VCLK_ECP_CNTL
, tmp
);
2405 tmp
= INPLL(PPLL_CNTL
);
2406 OUTPLL(PPLL_CNTL
, tmp
);
2408 /* palette stuff and BIOS_1_SCRATCH... */
2410 tmp
= INREG(FP_GEN_CNTL
);
2411 tmp2
= INREG(TMDS_TRANSMITTER_CNTL
);
2413 OUTREG(FP_GEN_CNTL
, tmp
);
2415 OUTREG(FP_GEN_CNTL
, tmp
);
2417 OUTREG(TMDS_TRANSMITTER_CNTL
, tmp2
);
2418 OUTREG(CRTC_MORE_CNTL
, 0);
2421 tmp
= INREG(CRTC_MORE_CNTL
);
2422 OUTREG(CRTC_MORE_CNTL
, tmp
);
2424 cgc
= INREG(CRTC_GEN_CNTL
);
2425 cec
= INREG(CRTC_EXT_CNTL
);
2426 c2gc
= INREG(CRTC2_GEN_CNTL
);
2428 OUTREG(CRTC_H_SYNC_STRT_WID
, 0x008e0580);
2429 OUTREG(CRTC_H_TOTAL_DISP
, 0x009f00d2);
2430 OUTREG8(CLOCK_CNTL_INDEX
, HTOTAL_CNTL
+ PLL_WR_EN
);
2431 radeon_pll_errata_after_index(rinfo
);
2432 OUTREG8(CLOCK_CNTL_DATA
, 0);
2433 radeon_pll_errata_after_data(rinfo
);
2434 OUTREG(CRTC_V_SYNC_STRT_WID
, 0x00830403);
2435 OUTREG(CRTC_V_TOTAL_DISP
, 0x03ff0429);
2436 OUTREG(FP_CRTC_H_TOTAL_DISP
, 0x009f0033);
2437 OUTREG(FP_H_SYNC_STRT_WID
, 0x008e0080);
2438 OUTREG(CRT_CRTC_H_SYNC_STRT_WID
, 0x008e0080);
2439 OUTREG(FP_CRTC_V_TOTAL_DISP
, 0x03ff002a);
2440 OUTREG(FP_V_SYNC_STRT_WID
, 0x00830004);
2441 OUTREG(CRT_CRTC_V_SYNC_STRT_WID
, 0x00830004);
2442 OUTREG(FP_HORZ_VERT_ACTIVE
, 0x009f03ff);
2443 OUTREG(FP_HORZ_STRETCH
, 0);
2444 OUTREG(FP_VERT_STRETCH
, 0);
2446 OUTREG(OVR_WID_LEFT_RIGHT
, 0);
2447 OUTREG(OVR_WID_TOP_BOTTOM
, 0);
2449 tmp
= INPLL(PPLL_REF_DIV
);
2450 tmp
= (tmp
& ~PPLL_REF_DIV_MASK
) | rinfo
->pll
.ref_div
;
2451 OUTPLL(PPLL_REF_DIV
, tmp
);
2452 INPLL(PPLL_REF_DIV
);
2454 OUTREG8(CLOCK_CNTL_INDEX
, PPLL_CNTL
+ PLL_WR_EN
);
2455 radeon_pll_errata_after_index(rinfo
);
2456 OUTREG8(CLOCK_CNTL_DATA
+ 1, 0xbc);
2457 radeon_pll_errata_after_data(rinfo
);
2459 tmp
= INREG(CLOCK_CNTL_INDEX
);
2460 radeon_pll_errata_after_index(rinfo
);
2461 OUTREG(CLOCK_CNTL_INDEX
, tmp
& 0xff);
2462 radeon_pll_errata_after_index(rinfo
);
2463 radeon_pll_errata_after_data(rinfo
);
2465 OUTPLL(PPLL_DIV_0
, 0x48090);
2467 tmp
= INPLL(PPLL_CNTL
);
2468 OUTPLL(PPLL_CNTL
, tmp
& ~0x2);
2470 tmp
= INPLL(PPLL_CNTL
);
2471 OUTPLL(PPLL_CNTL
, tmp
& ~0x1);
2474 tmp
= INPLL(VCLK_ECP_CNTL
);
2475 OUTPLL(VCLK_ECP_CNTL
, tmp
| 3);
2478 tmp
= INPLL(VCLK_ECP_CNTL
);
2479 OUTPLL(VCLK_ECP_CNTL
, tmp
);
2481 c2gc
|= CRTC2_DISP_REQ_EN_B
;
2482 OUTREG(CRTC2_GEN_CNTL
, c2gc
);
2484 OUTREG(CRTC_GEN_CNTL
, cgc
);
2485 OUTREG(CRTC_EXT_CNTL
, cec
);
2486 OUTREG(CRTC_PITCH
, 0xa0);
2487 OUTREG(CRTC_OFFSET
, 0);
2488 OUTREG(CRTC_OFFSET_CNTL
, 0);
2490 OUTREG(GRPH_BUFFER_CNTL
, 0x20117c7c);
2491 OUTREG(GRPH2_BUFFER_CNTL
, 0x00205c5c);
2493 tmp2
= INREG(FP_GEN_CNTL
);
2494 tmp
= INREG(TMDS_TRANSMITTER_CNTL
);
2495 OUTREG(0x2a8, 0x0000061b);
2497 OUTREG(TMDS_TRANSMITTER_CNTL
, tmp
);
2499 tmp
&= ~TMDS_PLLRST
;
2500 OUTREG(TMDS_TRANSMITTER_CNTL
, tmp
);
2503 OUTREG(FP_GEN_CNTL
, tmp2
);
2506 OUTREG(FP_GEN_CNTL
, tmp2
);
2508 OUTREG(CUR_HORZ_VERT_OFF
, CUR_LOCK
| 1);
2509 cgc
= INREG(CRTC_GEN_CNTL
);
2510 OUTREG(CUR_HORZ_VERT_POSN
, 0xbfff0fff);
2512 OUTREG(CUR_OFFSET
, 0);
2516 #endif /* CONFIG_PPC */
2518 static void radeonfb_whack_power_state(struct radeonfb_info
*rinfo
, pci_power_t state
)
2523 pci_read_config_word(rinfo
->pdev
,
2524 rinfo
->pdev
->pm_cap
+ PCI_PM_CTRL
,
2526 if (pwr_cmd
& state
)
2528 pwr_cmd
= (pwr_cmd
& ~PCI_PM_CTRL_STATE_MASK
) | state
;
2529 pci_write_config_word(rinfo
->pdev
,
2530 rinfo
->pdev
->pm_cap
+ PCI_PM_CTRL
,
2534 rinfo
->pdev
->current_state
= state
;
2537 static void radeon_set_suspend(struct radeonfb_info
*rinfo
, int suspend
)
2541 if (!rinfo
->pdev
->pm_cap
)
2544 /* Set the chip into appropriate suspend mode (we use D2,
2545 * D3 would require a compete re-initialization of the chip,
2546 * including PCI config registers, clocks, AGP conf, ...)
2549 printk(KERN_DEBUG
"radeonfb (%s): switching to D2 state...\n",
2550 pci_name(rinfo
->pdev
));
2552 /* Disable dynamic power management of clocks for the
2553 * duration of the suspend/resume process
2555 radeon_pm_disable_dynamic_mode(rinfo
);
2557 /* Save some registers */
2558 radeon_pm_save_regs(rinfo
, 0);
2560 /* Prepare mobility chips for suspend.
2562 if (rinfo
->is_mobility
) {
2564 radeon_pm_program_v2clk(rinfo
);
2566 /* Disable IO PADs */
2567 radeon_pm_disable_iopad(rinfo
);
2569 /* Set low current */
2570 radeon_pm_low_current(rinfo
);
2572 /* Prepare chip for power management */
2573 radeon_pm_setup_for_suspend(rinfo
);
2575 if (rinfo
->family
<= CHIP_FAMILY_RV280
) {
2576 /* Reset the MDLL */
2577 /* because both INPLL and OUTPLL take the same
2578 * lock, that's why. */
2579 tmp
= INPLL( pllMDLL_CKO
) | MDLL_CKO__MCKOA_RESET
2580 | MDLL_CKO__MCKOB_RESET
;
2581 OUTPLL( pllMDLL_CKO
, tmp
);
2585 /* Switch PCI power management to D2. */
2586 pci_disable_device(rinfo
->pdev
);
2587 pci_save_state(rinfo
->pdev
);
2588 /* The chip seems to need us to whack the PM register
2589 * repeatedly until it sticks. We do that -prior- to
2590 * calling pci_set_power_state()
2592 radeonfb_whack_power_state(rinfo
, PCI_D2
);
2593 __pci_complete_power_transition(rinfo
->pdev
, PCI_D2
);
2595 printk(KERN_DEBUG
"radeonfb (%s): switching to D0 state...\n",
2596 pci_name(rinfo
->pdev
));
2598 if (rinfo
->family
<= CHIP_FAMILY_RV250
) {
2599 /* Reset the SDRAM controller */
2600 radeon_pm_full_reset_sdram(rinfo
);
2602 /* Restore some registers */
2603 radeon_pm_restore_regs(rinfo
);
2605 /* Restore registers first */
2606 radeon_pm_restore_regs(rinfo
);
2607 /* init sdram controller */
2608 radeon_pm_full_reset_sdram(rinfo
);
2613 int radeonfb_pci_suspend(struct pci_dev
*pdev
, pm_message_t mesg
)
2615 struct fb_info
*info
= pci_get_drvdata(pdev
);
2616 struct radeonfb_info
*rinfo
= info
->par
;
2618 if (mesg
.event
== pdev
->dev
.power
.power_state
.event
)
2621 printk(KERN_DEBUG
"radeonfb (%s): suspending for event: %d...\n",
2622 pci_name(pdev
), mesg
.event
);
2624 /* For suspend-to-disk, we cheat here. We don't suspend anything and
2625 * let fbcon continue drawing until we are all set. That shouldn't
2626 * really cause any problem at this point, provided that the wakeup
2627 * code knows that any state in memory may not match the HW
2629 switch (mesg
.event
) {
2630 case PM_EVENT_FREEZE
: /* about to take snapshot */
2631 case PM_EVENT_PRETHAW
: /* before restoring snapshot */
2637 fb_set_suspend(info
, 1);
2639 if (!(info
->flags
& FBINFO_HWACCEL_DISABLED
)) {
2640 /* Make sure engine is reset */
2641 radeon_engine_idle();
2642 radeonfb_engine_reset(rinfo
);
2643 radeon_engine_idle();
2646 /* Blank display and LCD */
2647 radeon_screen_blank(rinfo
, FB_BLANK_POWERDOWN
, 1);
2651 rinfo
->lock_blank
= 1;
2652 del_timer_sync(&rinfo
->lvds_timer
);
2654 #ifdef CONFIG_PPC_PMAC
2655 /* On powermac, we have hooks to properly suspend/resume AGP now,
2656 * use them here. We'll ultimately need some generic support here,
2657 * but the generic code isn't quite ready for that yet
2659 pmac_suspend_agp_for_card(pdev
);
2660 #endif /* CONFIG_PPC_PMAC */
2662 /* It's unclear whether or when the generic code will do that, so let's
2663 * do it ourselves. We save state before we do any power management
2665 pci_save_state(pdev
);
2667 /* If we support wakeup from poweroff, we save all regs we can including cfg
2670 if (rinfo
->pm_mode
& radeon_pm_off
) {
2671 /* Always disable dynamic clocks or weird things are happening when
2672 * the chip goes off (basically the panel doesn't shut down properly
2673 * and we crash on wakeup),
2674 * also, we want the saved regs context to have no dynamic clocks in
2675 * it, we'll restore the dynamic clocks state on wakeup
2677 radeon_pm_disable_dynamic_mode(rinfo
);
2679 radeon_pm_save_regs(rinfo
, 1);
2681 if (rinfo
->is_mobility
&& !(rinfo
->pm_mode
& radeon_pm_d2
)) {
2682 /* Switch off LVDS interface */
2684 OUTREG(LVDS_GEN_CNTL
, INREG(LVDS_GEN_CNTL
) & ~(LVDS_BL_MOD_EN
));
2686 OUTREG(LVDS_GEN_CNTL
, INREG(LVDS_GEN_CNTL
) & ~(LVDS_EN
| LVDS_ON
));
2687 OUTREG(LVDS_PLL_CNTL
, (INREG(LVDS_PLL_CNTL
) & ~30000) | 0x20000);
2689 OUTREG(LVDS_GEN_CNTL
, INREG(LVDS_GEN_CNTL
) & ~(LVDS_DIGON
));
2691 pci_disable_device(pdev
);
2693 /* If we support D2, we go to it (should be fixed later with a flag forcing
2694 * D3 only for some laptops)
2696 if (rinfo
->pm_mode
& radeon_pm_d2
)
2697 radeon_set_suspend(rinfo
, 1);
2702 pdev
->dev
.power
.power_state
= mesg
;
2707 static int radeon_check_power_loss(struct radeonfb_info
*rinfo
)
2709 return rinfo
->save_regs
[4] != INPLL(CLK_PIN_CNTL
) ||
2710 rinfo
->save_regs
[2] != INPLL(MCLK_CNTL
) ||
2711 rinfo
->save_regs
[3] != INPLL(SCLK_CNTL
);
2714 int radeonfb_pci_resume(struct pci_dev
*pdev
)
2716 struct fb_info
*info
= pci_get_drvdata(pdev
);
2717 struct radeonfb_info
*rinfo
= info
->par
;
2720 if (pdev
->dev
.power
.power_state
.event
== PM_EVENT_ON
)
2723 if (rinfo
->no_schedule
) {
2724 if (!console_trylock())
2729 printk(KERN_DEBUG
"radeonfb (%s): resuming from state: %d...\n",
2730 pci_name(pdev
), pdev
->dev
.power
.power_state
.event
);
2732 /* PCI state will have been restored by the core, so
2733 * we should be in D0 now with our config space fully
2736 if (pdev
->dev
.power
.power_state
.event
== PM_EVENT_SUSPEND
) {
2738 if ((rinfo
->pm_mode
& radeon_pm_off
) && radeon_check_power_loss(rinfo
)) {
2739 if (rinfo
->reinit_func
!= NULL
)
2740 rinfo
->reinit_func(rinfo
);
2742 printk(KERN_ERR
"radeonfb (%s): can't resume radeon from"
2743 " D3 cold, need softboot !", pci_name(pdev
));
2748 /* If we support D2, try to resume... we should check what was our
2749 * state though... (were we really in D2 state ?). Right now, this code
2750 * is only enable on Macs so it's fine.
2752 else if (rinfo
->pm_mode
& radeon_pm_d2
)
2753 radeon_set_suspend(rinfo
, 0);
2757 radeon_engine_idle();
2759 /* Restore display & engine */
2760 radeon_write_mode (rinfo
, &rinfo
->state
, 1);
2761 if (!(info
->flags
& FBINFO_HWACCEL_DISABLED
))
2762 radeonfb_engine_init (rinfo
);
2764 fb_pan_display(info
, &info
->var
);
2765 fb_set_cmap(&info
->cmap
, info
);
2768 fb_set_suspend(info
, 0);
2771 rinfo
->lock_blank
= 0;
2772 radeon_screen_blank(rinfo
, FB_BLANK_UNBLANK
, 1);
2774 #ifdef CONFIG_PPC_PMAC
2775 /* On powermac, we have hooks to properly suspend/resume AGP now,
2776 * use them here. We'll ultimately need some generic support here,
2777 * but the generic code isn't quite ready for that yet
2779 pmac_resume_agp_for_card(pdev
);
2780 #endif /* CONFIG_PPC_PMAC */
2783 /* Check status of dynclk */
2784 if (rinfo
->dynclk
== 1)
2785 radeon_pm_enable_dynamic_mode(rinfo
);
2786 else if (rinfo
->dynclk
== 0)
2787 radeon_pm_disable_dynamic_mode(rinfo
);
2789 pdev
->dev
.power
.power_state
= PMSG_ON
;
2797 #ifdef CONFIG_PPC__disabled
2798 static void radeonfb_early_resume(void *data
)
2800 struct radeonfb_info
*rinfo
= data
;
2802 rinfo
->no_schedule
= 1;
2803 pci_restore_state(rinfo
->pdev
);
2804 radeonfb_pci_resume(rinfo
->pdev
);
2805 rinfo
->no_schedule
= 0;
2807 #endif /* CONFIG_PPC */
2809 #endif /* CONFIG_PM */
2811 void radeonfb_pm_init(struct radeonfb_info
*rinfo
, int dynclk
, int ignore_devlist
, int force_sleep
)
2813 /* Enable/Disable dynamic clocks: TODO add sysfs access */
2814 if (rinfo
->family
== CHIP_FAMILY_RS480
)
2817 rinfo
->dynclk
= dynclk
;
2819 if (rinfo
->dynclk
== 1) {
2820 radeon_pm_enable_dynamic_mode(rinfo
);
2821 printk("radeonfb: Dynamic Clock Power Management enabled\n");
2822 } else if (rinfo
->dynclk
== 0) {
2823 radeon_pm_disable_dynamic_mode(rinfo
);
2824 printk("radeonfb: Dynamic Clock Power Management disabled\n");
2827 #if defined(CONFIG_PM)
2828 #if defined(CONFIG_PPC_PMAC)
2829 /* Check if we can power manage on suspend/resume. We can do
2830 * D2 on M6, M7 and M9, and we can resume from D3 cold a few other
2831 * "Mac" cards, but that's all. We need more infos about what the
2832 * BIOS does tho. Right now, all this PM stuff is pmac-only for that
2835 if (machine_is(powermac
) && rinfo
->of_node
) {
2836 if (rinfo
->is_mobility
&& rinfo
->pdev
->pm_cap
&&
2837 rinfo
->family
<= CHIP_FAMILY_RV250
)
2838 rinfo
->pm_mode
|= radeon_pm_d2
;
2840 /* We can restart Jasper (M10 chip in albooks), BlueStone (7500 chip
2841 * in some desktop G4s), Via (M9+ chip on iBook G4) and
2842 * Snowy (M11 chip on iBook G4 manufactured after July 2005)
2844 if (!strcmp(rinfo
->of_node
->name
, "ATY,JasperParent") ||
2845 !strcmp(rinfo
->of_node
->name
, "ATY,SnowyParent")) {
2846 rinfo
->reinit_func
= radeon_reinitialize_M10
;
2847 rinfo
->pm_mode
|= radeon_pm_off
;
2849 #if 0 /* Not ready yet */
2850 if (!strcmp(rinfo
->of_node
->name
, "ATY,BlueStoneParent")) {
2851 rinfo
->reinit_func
= radeon_reinitialize_QW
;
2852 rinfo
->pm_mode
|= radeon_pm_off
;
2855 if (!strcmp(rinfo
->of_node
->name
, "ATY,ViaParent")) {
2856 rinfo
->reinit_func
= radeon_reinitialize_M9P
;
2857 rinfo
->pm_mode
|= radeon_pm_off
;
2860 /* If any of the above is set, we assume the machine can sleep/resume.
2861 * It's a bit of a "shortcut" but will work fine. Ideally, we need infos
2862 * from the platform about what happens to the chip...
2863 * Now we tell the platform about our capability
2865 if (rinfo
->pm_mode
!= radeon_pm_none
) {
2866 pmac_call_feature(PMAC_FTR_DEVICE_CAN_WAKE
, rinfo
->of_node
, 0, 1);
2867 #if 0 /* Disable the early video resume hack for now as it's causing problems, among
2868 * others we now rely on the PCI core restoring the config space for us, which
2869 * isn't the case with that hack, and that code path causes various things to
2870 * be called with interrupts off while they shouldn't. I'm leaving the code in
2871 * as it can be useful for debugging purposes
2873 pmac_set_early_video_resume(radeonfb_early_resume
, rinfo
);
2878 /* Power down TV DAC, that saves a significant amount of power,
2879 * we'll have something better once we actually have some TVOut
2882 OUTREG(TV_DAC_CNTL
, INREG(TV_DAC_CNTL
) | 0x07000000);
2885 #endif /* defined(CONFIG_PPC_PMAC) */
2886 #endif /* defined(CONFIG_PM) */
2890 "radeonfb: skipping test for device workarounds\n");
2892 radeon_apply_workarounds(rinfo
);
2896 "radeonfb: forcefully enabling D2 sleep mode\n");
2897 rinfo
->pm_mode
|= radeon_pm_d2
;
2901 void radeonfb_pm_exit(struct radeonfb_info
*rinfo
)
2903 #if defined(CONFIG_PM) && defined(CONFIG_PPC_PMAC)
2904 if (rinfo
->pm_mode
!= radeon_pm_none
)
2905 pmac_set_early_video_resume(NULL
, NULL
);