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