diff options
Diffstat (limited to 'drivers/gpu/drm/i915/i915_suspend.c')
-rw-r--r-- | drivers/gpu/drm/i915/i915_suspend.c | 509 |
1 files changed, 509 insertions, 0 deletions
diff --git a/drivers/gpu/drm/i915/i915_suspend.c b/drivers/gpu/drm/i915/i915_suspend.c new file mode 100644 index 000000000000..603fe742ccd4 --- /dev/null +++ b/drivers/gpu/drm/i915/i915_suspend.c | |||
@@ -0,0 +1,509 @@ | |||
1 | /* | ||
2 | * | ||
3 | * Copyright 2008 (c) Intel Corporation | ||
4 | * Jesse Barnes <jbarnes@virtuousgeek.org> | ||
5 | * | ||
6 | * Permission is hereby granted, free of charge, to any person obtaining a | ||
7 | * copy of this software and associated documentation files (the | ||
8 | * "Software"), to deal in the Software without restriction, including | ||
9 | * without limitation the rights to use, copy, modify, merge, publish, | ||
10 | * distribute, sub license, and/or sell copies of the Software, and to | ||
11 | * permit persons to whom the Software is furnished to do so, subject to | ||
12 | * the following conditions: | ||
13 | * | ||
14 | * The above copyright notice and this permission notice (including the | ||
15 | * next paragraph) shall be included in all copies or substantial portions | ||
16 | * of the Software. | ||
17 | * | ||
18 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS | ||
19 | * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
20 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. | ||
21 | * IN NO EVENT SHALL TUNGSTEN GRAPHICS AND/OR ITS SUPPLIERS BE LIABLE FOR | ||
22 | * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, | ||
23 | * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE | ||
24 | * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | ||
25 | */ | ||
26 | |||
27 | #include "drmP.h" | ||
28 | #include "drm.h" | ||
29 | #include "i915_drm.h" | ||
30 | #include "i915_drv.h" | ||
31 | |||
32 | static bool i915_pipe_enabled(struct drm_device *dev, enum pipe pipe) | ||
33 | { | ||
34 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
35 | |||
36 | if (pipe == PIPE_A) | ||
37 | return (I915_READ(DPLL_A) & DPLL_VCO_ENABLE); | ||
38 | else | ||
39 | return (I915_READ(DPLL_B) & DPLL_VCO_ENABLE); | ||
40 | } | ||
41 | |||
42 | static void i915_save_palette(struct drm_device *dev, enum pipe pipe) | ||
43 | { | ||
44 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
45 | unsigned long reg = (pipe == PIPE_A ? PALETTE_A : PALETTE_B); | ||
46 | u32 *array; | ||
47 | int i; | ||
48 | |||
49 | if (!i915_pipe_enabled(dev, pipe)) | ||
50 | return; | ||
51 | |||
52 | if (pipe == PIPE_A) | ||
53 | array = dev_priv->save_palette_a; | ||
54 | else | ||
55 | array = dev_priv->save_palette_b; | ||
56 | |||
57 | for(i = 0; i < 256; i++) | ||
58 | array[i] = I915_READ(reg + (i << 2)); | ||
59 | } | ||
60 | |||
61 | static void i915_restore_palette(struct drm_device *dev, enum pipe pipe) | ||
62 | { | ||
63 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
64 | unsigned long reg = (pipe == PIPE_A ? PALETTE_A : PALETTE_B); | ||
65 | u32 *array; | ||
66 | int i; | ||
67 | |||
68 | if (!i915_pipe_enabled(dev, pipe)) | ||
69 | return; | ||
70 | |||
71 | if (pipe == PIPE_A) | ||
72 | array = dev_priv->save_palette_a; | ||
73 | else | ||
74 | array = dev_priv->save_palette_b; | ||
75 | |||
76 | for(i = 0; i < 256; i++) | ||
77 | I915_WRITE(reg + (i << 2), array[i]); | ||
78 | } | ||
79 | |||
80 | static u8 i915_read_indexed(struct drm_device *dev, u16 index_port, u16 data_port, u8 reg) | ||
81 | { | ||
82 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
83 | |||
84 | I915_WRITE8(index_port, reg); | ||
85 | return I915_READ8(data_port); | ||
86 | } | ||
87 | |||
88 | static u8 i915_read_ar(struct drm_device *dev, u16 st01, u8 reg, u16 palette_enable) | ||
89 | { | ||
90 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
91 | |||
92 | I915_READ8(st01); | ||
93 | I915_WRITE8(VGA_AR_INDEX, palette_enable | reg); | ||
94 | return I915_READ8(VGA_AR_DATA_READ); | ||
95 | } | ||
96 | |||
97 | static void i915_write_ar(struct drm_device *dev, u16 st01, u8 reg, u8 val, u16 palette_enable) | ||
98 | { | ||
99 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
100 | |||
101 | I915_READ8(st01); | ||
102 | I915_WRITE8(VGA_AR_INDEX, palette_enable | reg); | ||
103 | I915_WRITE8(VGA_AR_DATA_WRITE, val); | ||
104 | } | ||
105 | |||
106 | static void i915_write_indexed(struct drm_device *dev, u16 index_port, u16 data_port, u8 reg, u8 val) | ||
107 | { | ||
108 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
109 | |||
110 | I915_WRITE8(index_port, reg); | ||
111 | I915_WRITE8(data_port, val); | ||
112 | } | ||
113 | |||
114 | static void i915_save_vga(struct drm_device *dev) | ||
115 | { | ||
116 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
117 | int i; | ||
118 | u16 cr_index, cr_data, st01; | ||
119 | |||
120 | /* VGA color palette registers */ | ||
121 | dev_priv->saveDACMASK = I915_READ8(VGA_DACMASK); | ||
122 | /* DACCRX automatically increments during read */ | ||
123 | I915_WRITE8(VGA_DACRX, 0); | ||
124 | /* Read 3 bytes of color data from each index */ | ||
125 | for (i = 0; i < 256 * 3; i++) | ||
126 | dev_priv->saveDACDATA[i] = I915_READ8(VGA_DACDATA); | ||
127 | |||
128 | /* MSR bits */ | ||
129 | dev_priv->saveMSR = I915_READ8(VGA_MSR_READ); | ||
130 | if (dev_priv->saveMSR & VGA_MSR_CGA_MODE) { | ||
131 | cr_index = VGA_CR_INDEX_CGA; | ||
132 | cr_data = VGA_CR_DATA_CGA; | ||
133 | st01 = VGA_ST01_CGA; | ||
134 | } else { | ||
135 | cr_index = VGA_CR_INDEX_MDA; | ||
136 | cr_data = VGA_CR_DATA_MDA; | ||
137 | st01 = VGA_ST01_MDA; | ||
138 | } | ||
139 | |||
140 | /* CRT controller regs */ | ||
141 | i915_write_indexed(dev, cr_index, cr_data, 0x11, | ||
142 | i915_read_indexed(dev, cr_index, cr_data, 0x11) & | ||
143 | (~0x80)); | ||
144 | for (i = 0; i <= 0x24; i++) | ||
145 | dev_priv->saveCR[i] = | ||
146 | i915_read_indexed(dev, cr_index, cr_data, i); | ||
147 | /* Make sure we don't turn off CR group 0 writes */ | ||
148 | dev_priv->saveCR[0x11] &= ~0x80; | ||
149 | |||
150 | /* Attribute controller registers */ | ||
151 | I915_READ8(st01); | ||
152 | dev_priv->saveAR_INDEX = I915_READ8(VGA_AR_INDEX); | ||
153 | for (i = 0; i <= 0x14; i++) | ||
154 | dev_priv->saveAR[i] = i915_read_ar(dev, st01, i, 0); | ||
155 | I915_READ8(st01); | ||
156 | I915_WRITE8(VGA_AR_INDEX, dev_priv->saveAR_INDEX); | ||
157 | I915_READ8(st01); | ||
158 | |||
159 | /* Graphics controller registers */ | ||
160 | for (i = 0; i < 9; i++) | ||
161 | dev_priv->saveGR[i] = | ||
162 | i915_read_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, i); | ||
163 | |||
164 | dev_priv->saveGR[0x10] = | ||
165 | i915_read_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, 0x10); | ||
166 | dev_priv->saveGR[0x11] = | ||
167 | i915_read_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, 0x11); | ||
168 | dev_priv->saveGR[0x18] = | ||
169 | i915_read_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, 0x18); | ||
170 | |||
171 | /* Sequencer registers */ | ||
172 | for (i = 0; i < 8; i++) | ||
173 | dev_priv->saveSR[i] = | ||
174 | i915_read_indexed(dev, VGA_SR_INDEX, VGA_SR_DATA, i); | ||
175 | } | ||
176 | |||
177 | static void i915_restore_vga(struct drm_device *dev) | ||
178 | { | ||
179 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
180 | int i; | ||
181 | u16 cr_index, cr_data, st01; | ||
182 | |||
183 | /* MSR bits */ | ||
184 | I915_WRITE8(VGA_MSR_WRITE, dev_priv->saveMSR); | ||
185 | if (dev_priv->saveMSR & VGA_MSR_CGA_MODE) { | ||
186 | cr_index = VGA_CR_INDEX_CGA; | ||
187 | cr_data = VGA_CR_DATA_CGA; | ||
188 | st01 = VGA_ST01_CGA; | ||
189 | } else { | ||
190 | cr_index = VGA_CR_INDEX_MDA; | ||
191 | cr_data = VGA_CR_DATA_MDA; | ||
192 | st01 = VGA_ST01_MDA; | ||
193 | } | ||
194 | |||
195 | /* Sequencer registers, don't write SR07 */ | ||
196 | for (i = 0; i < 7; i++) | ||
197 | i915_write_indexed(dev, VGA_SR_INDEX, VGA_SR_DATA, i, | ||
198 | dev_priv->saveSR[i]); | ||
199 | |||
200 | /* CRT controller regs */ | ||
201 | /* Enable CR group 0 writes */ | ||
202 | i915_write_indexed(dev, cr_index, cr_data, 0x11, dev_priv->saveCR[0x11]); | ||
203 | for (i = 0; i <= 0x24; i++) | ||
204 | i915_write_indexed(dev, cr_index, cr_data, i, dev_priv->saveCR[i]); | ||
205 | |||
206 | /* Graphics controller regs */ | ||
207 | for (i = 0; i < 9; i++) | ||
208 | i915_write_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, i, | ||
209 | dev_priv->saveGR[i]); | ||
210 | |||
211 | i915_write_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, 0x10, | ||
212 | dev_priv->saveGR[0x10]); | ||
213 | i915_write_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, 0x11, | ||
214 | dev_priv->saveGR[0x11]); | ||
215 | i915_write_indexed(dev, VGA_GR_INDEX, VGA_GR_DATA, 0x18, | ||
216 | dev_priv->saveGR[0x18]); | ||
217 | |||
218 | /* Attribute controller registers */ | ||
219 | I915_READ8(st01); /* switch back to index mode */ | ||
220 | for (i = 0; i <= 0x14; i++) | ||
221 | i915_write_ar(dev, st01, i, dev_priv->saveAR[i], 0); | ||
222 | I915_READ8(st01); /* switch back to index mode */ | ||
223 | I915_WRITE8(VGA_AR_INDEX, dev_priv->saveAR_INDEX | 0x20); | ||
224 | I915_READ8(st01); | ||
225 | |||
226 | /* VGA color palette registers */ | ||
227 | I915_WRITE8(VGA_DACMASK, dev_priv->saveDACMASK); | ||
228 | /* DACCRX automatically increments during read */ | ||
229 | I915_WRITE8(VGA_DACWX, 0); | ||
230 | /* Read 3 bytes of color data from each index */ | ||
231 | for (i = 0; i < 256 * 3; i++) | ||
232 | I915_WRITE8(VGA_DACDATA, dev_priv->saveDACDATA[i]); | ||
233 | |||
234 | } | ||
235 | |||
236 | int i915_save_state(struct drm_device *dev) | ||
237 | { | ||
238 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
239 | int i; | ||
240 | |||
241 | pci_read_config_byte(dev->pdev, LBB, &dev_priv->saveLBB); | ||
242 | |||
243 | /* Display arbitration control */ | ||
244 | dev_priv->saveDSPARB = I915_READ(DSPARB); | ||
245 | |||
246 | /* Pipe & plane A info */ | ||
247 | dev_priv->savePIPEACONF = I915_READ(PIPEACONF); | ||
248 | dev_priv->savePIPEASRC = I915_READ(PIPEASRC); | ||
249 | dev_priv->saveFPA0 = I915_READ(FPA0); | ||
250 | dev_priv->saveFPA1 = I915_READ(FPA1); | ||
251 | dev_priv->saveDPLL_A = I915_READ(DPLL_A); | ||
252 | if (IS_I965G(dev)) | ||
253 | dev_priv->saveDPLL_A_MD = I915_READ(DPLL_A_MD); | ||
254 | dev_priv->saveHTOTAL_A = I915_READ(HTOTAL_A); | ||
255 | dev_priv->saveHBLANK_A = I915_READ(HBLANK_A); | ||
256 | dev_priv->saveHSYNC_A = I915_READ(HSYNC_A); | ||
257 | dev_priv->saveVTOTAL_A = I915_READ(VTOTAL_A); | ||
258 | dev_priv->saveVBLANK_A = I915_READ(VBLANK_A); | ||
259 | dev_priv->saveVSYNC_A = I915_READ(VSYNC_A); | ||
260 | dev_priv->saveBCLRPAT_A = I915_READ(BCLRPAT_A); | ||
261 | |||
262 | dev_priv->saveDSPACNTR = I915_READ(DSPACNTR); | ||
263 | dev_priv->saveDSPASTRIDE = I915_READ(DSPASTRIDE); | ||
264 | dev_priv->saveDSPASIZE = I915_READ(DSPASIZE); | ||
265 | dev_priv->saveDSPAPOS = I915_READ(DSPAPOS); | ||
266 | dev_priv->saveDSPAADDR = I915_READ(DSPAADDR); | ||
267 | if (IS_I965G(dev)) { | ||
268 | dev_priv->saveDSPASURF = I915_READ(DSPASURF); | ||
269 | dev_priv->saveDSPATILEOFF = I915_READ(DSPATILEOFF); | ||
270 | } | ||
271 | i915_save_palette(dev, PIPE_A); | ||
272 | dev_priv->savePIPEASTAT = I915_READ(PIPEASTAT); | ||
273 | |||
274 | /* Pipe & plane B info */ | ||
275 | dev_priv->savePIPEBCONF = I915_READ(PIPEBCONF); | ||
276 | dev_priv->savePIPEBSRC = I915_READ(PIPEBSRC); | ||
277 | dev_priv->saveFPB0 = I915_READ(FPB0); | ||
278 | dev_priv->saveFPB1 = I915_READ(FPB1); | ||
279 | dev_priv->saveDPLL_B = I915_READ(DPLL_B); | ||
280 | if (IS_I965G(dev)) | ||
281 | dev_priv->saveDPLL_B_MD = I915_READ(DPLL_B_MD); | ||
282 | dev_priv->saveHTOTAL_B = I915_READ(HTOTAL_B); | ||
283 | dev_priv->saveHBLANK_B = I915_READ(HBLANK_B); | ||
284 | dev_priv->saveHSYNC_B = I915_READ(HSYNC_B); | ||
285 | dev_priv->saveVTOTAL_B = I915_READ(VTOTAL_B); | ||
286 | dev_priv->saveVBLANK_B = I915_READ(VBLANK_B); | ||
287 | dev_priv->saveVSYNC_B = I915_READ(VSYNC_B); | ||
288 | dev_priv->saveBCLRPAT_A = I915_READ(BCLRPAT_A); | ||
289 | |||
290 | dev_priv->saveDSPBCNTR = I915_READ(DSPBCNTR); | ||
291 | dev_priv->saveDSPBSTRIDE = I915_READ(DSPBSTRIDE); | ||
292 | dev_priv->saveDSPBSIZE = I915_READ(DSPBSIZE); | ||
293 | dev_priv->saveDSPBPOS = I915_READ(DSPBPOS); | ||
294 | dev_priv->saveDSPBADDR = I915_READ(DSPBADDR); | ||
295 | if (IS_I965GM(dev) || IS_GM45(dev)) { | ||
296 | dev_priv->saveDSPBSURF = I915_READ(DSPBSURF); | ||
297 | dev_priv->saveDSPBTILEOFF = I915_READ(DSPBTILEOFF); | ||
298 | } | ||
299 | i915_save_palette(dev, PIPE_B); | ||
300 | dev_priv->savePIPEBSTAT = I915_READ(PIPEBSTAT); | ||
301 | |||
302 | /* CRT state */ | ||
303 | dev_priv->saveADPA = I915_READ(ADPA); | ||
304 | |||
305 | /* LVDS state */ | ||
306 | dev_priv->savePP_CONTROL = I915_READ(PP_CONTROL); | ||
307 | dev_priv->savePFIT_PGM_RATIOS = I915_READ(PFIT_PGM_RATIOS); | ||
308 | dev_priv->saveBLC_PWM_CTL = I915_READ(BLC_PWM_CTL); | ||
309 | if (IS_I965G(dev)) | ||
310 | dev_priv->saveBLC_PWM_CTL2 = I915_READ(BLC_PWM_CTL2); | ||
311 | if (IS_MOBILE(dev) && !IS_I830(dev)) | ||
312 | dev_priv->saveLVDS = I915_READ(LVDS); | ||
313 | if (!IS_I830(dev) && !IS_845G(dev)) | ||
314 | dev_priv->savePFIT_CONTROL = I915_READ(PFIT_CONTROL); | ||
315 | dev_priv->savePP_ON_DELAYS = I915_READ(PP_ON_DELAYS); | ||
316 | dev_priv->savePP_OFF_DELAYS = I915_READ(PP_OFF_DELAYS); | ||
317 | dev_priv->savePP_DIVISOR = I915_READ(PP_DIVISOR); | ||
318 | |||
319 | /* FIXME: save TV & SDVO state */ | ||
320 | |||
321 | /* FBC state */ | ||
322 | dev_priv->saveFBC_CFB_BASE = I915_READ(FBC_CFB_BASE); | ||
323 | dev_priv->saveFBC_LL_BASE = I915_READ(FBC_LL_BASE); | ||
324 | dev_priv->saveFBC_CONTROL2 = I915_READ(FBC_CONTROL2); | ||
325 | dev_priv->saveFBC_CONTROL = I915_READ(FBC_CONTROL); | ||
326 | |||
327 | /* Interrupt state */ | ||
328 | dev_priv->saveIIR = I915_READ(IIR); | ||
329 | dev_priv->saveIER = I915_READ(IER); | ||
330 | dev_priv->saveIMR = I915_READ(IMR); | ||
331 | |||
332 | /* VGA state */ | ||
333 | dev_priv->saveVGA0 = I915_READ(VGA0); | ||
334 | dev_priv->saveVGA1 = I915_READ(VGA1); | ||
335 | dev_priv->saveVGA_PD = I915_READ(VGA_PD); | ||
336 | dev_priv->saveVGACNTRL = I915_READ(VGACNTRL); | ||
337 | |||
338 | /* Clock gating state */ | ||
339 | dev_priv->saveD_STATE = I915_READ(D_STATE); | ||
340 | dev_priv->saveCG_2D_DIS = I915_READ(CG_2D_DIS); | ||
341 | |||
342 | /* Cache mode state */ | ||
343 | dev_priv->saveCACHE_MODE_0 = I915_READ(CACHE_MODE_0); | ||
344 | |||
345 | /* Memory Arbitration state */ | ||
346 | dev_priv->saveMI_ARB_STATE = I915_READ(MI_ARB_STATE); | ||
347 | |||
348 | /* Scratch space */ | ||
349 | for (i = 0; i < 16; i++) { | ||
350 | dev_priv->saveSWF0[i] = I915_READ(SWF00 + (i << 2)); | ||
351 | dev_priv->saveSWF1[i] = I915_READ(SWF10 + (i << 2)); | ||
352 | } | ||
353 | for (i = 0; i < 3; i++) | ||
354 | dev_priv->saveSWF2[i] = I915_READ(SWF30 + (i << 2)); | ||
355 | |||
356 | i915_save_vga(dev); | ||
357 | |||
358 | return 0; | ||
359 | } | ||
360 | |||
361 | int i915_restore_state(struct drm_device *dev) | ||
362 | { | ||
363 | struct drm_i915_private *dev_priv = dev->dev_private; | ||
364 | int i; | ||
365 | |||
366 | pci_write_config_byte(dev->pdev, LBB, dev_priv->saveLBB); | ||
367 | |||
368 | I915_WRITE(DSPARB, dev_priv->saveDSPARB); | ||
369 | |||
370 | /* Pipe & plane A info */ | ||
371 | /* Prime the clock */ | ||
372 | if (dev_priv->saveDPLL_A & DPLL_VCO_ENABLE) { | ||
373 | I915_WRITE(DPLL_A, dev_priv->saveDPLL_A & | ||
374 | ~DPLL_VCO_ENABLE); | ||
375 | DRM_UDELAY(150); | ||
376 | } | ||
377 | I915_WRITE(FPA0, dev_priv->saveFPA0); | ||
378 | I915_WRITE(FPA1, dev_priv->saveFPA1); | ||
379 | /* Actually enable it */ | ||
380 | I915_WRITE(DPLL_A, dev_priv->saveDPLL_A); | ||
381 | DRM_UDELAY(150); | ||
382 | if (IS_I965G(dev)) | ||
383 | I915_WRITE(DPLL_A_MD, dev_priv->saveDPLL_A_MD); | ||
384 | DRM_UDELAY(150); | ||
385 | |||
386 | /* Restore mode */ | ||
387 | I915_WRITE(HTOTAL_A, dev_priv->saveHTOTAL_A); | ||
388 | I915_WRITE(HBLANK_A, dev_priv->saveHBLANK_A); | ||
389 | I915_WRITE(HSYNC_A, dev_priv->saveHSYNC_A); | ||
390 | I915_WRITE(VTOTAL_A, dev_priv->saveVTOTAL_A); | ||
391 | I915_WRITE(VBLANK_A, dev_priv->saveVBLANK_A); | ||
392 | I915_WRITE(VSYNC_A, dev_priv->saveVSYNC_A); | ||
393 | I915_WRITE(BCLRPAT_A, dev_priv->saveBCLRPAT_A); | ||
394 | |||
395 | /* Restore plane info */ | ||
396 | I915_WRITE(DSPASIZE, dev_priv->saveDSPASIZE); | ||
397 | I915_WRITE(DSPAPOS, dev_priv->saveDSPAPOS); | ||
398 | I915_WRITE(PIPEASRC, dev_priv->savePIPEASRC); | ||
399 | I915_WRITE(DSPAADDR, dev_priv->saveDSPAADDR); | ||
400 | I915_WRITE(DSPASTRIDE, dev_priv->saveDSPASTRIDE); | ||
401 | if (IS_I965G(dev)) { | ||
402 | I915_WRITE(DSPASURF, dev_priv->saveDSPASURF); | ||
403 | I915_WRITE(DSPATILEOFF, dev_priv->saveDSPATILEOFF); | ||
404 | } | ||
405 | |||
406 | I915_WRITE(PIPEACONF, dev_priv->savePIPEACONF); | ||
407 | |||
408 | i915_restore_palette(dev, PIPE_A); | ||
409 | /* Enable the plane */ | ||
410 | I915_WRITE(DSPACNTR, dev_priv->saveDSPACNTR); | ||
411 | I915_WRITE(DSPAADDR, I915_READ(DSPAADDR)); | ||
412 | |||
413 | /* Pipe & plane B info */ | ||
414 | if (dev_priv->saveDPLL_B & DPLL_VCO_ENABLE) { | ||
415 | I915_WRITE(DPLL_B, dev_priv->saveDPLL_B & | ||
416 | ~DPLL_VCO_ENABLE); | ||
417 | DRM_UDELAY(150); | ||
418 | } | ||
419 | I915_WRITE(FPB0, dev_priv->saveFPB0); | ||
420 | I915_WRITE(FPB1, dev_priv->saveFPB1); | ||
421 | /* Actually enable it */ | ||
422 | I915_WRITE(DPLL_B, dev_priv->saveDPLL_B); | ||
423 | DRM_UDELAY(150); | ||
424 | if (IS_I965G(dev)) | ||
425 | I915_WRITE(DPLL_B_MD, dev_priv->saveDPLL_B_MD); | ||
426 | DRM_UDELAY(150); | ||
427 | |||
428 | /* Restore mode */ | ||
429 | I915_WRITE(HTOTAL_B, dev_priv->saveHTOTAL_B); | ||
430 | I915_WRITE(HBLANK_B, dev_priv->saveHBLANK_B); | ||
431 | I915_WRITE(HSYNC_B, dev_priv->saveHSYNC_B); | ||
432 | I915_WRITE(VTOTAL_B, dev_priv->saveVTOTAL_B); | ||
433 | I915_WRITE(VBLANK_B, dev_priv->saveVBLANK_B); | ||
434 | I915_WRITE(VSYNC_B, dev_priv->saveVSYNC_B); | ||
435 | I915_WRITE(BCLRPAT_B, dev_priv->saveBCLRPAT_B); | ||
436 | |||
437 | /* Restore plane info */ | ||
438 | I915_WRITE(DSPBSIZE, dev_priv->saveDSPBSIZE); | ||
439 | I915_WRITE(DSPBPOS, dev_priv->saveDSPBPOS); | ||
440 | I915_WRITE(PIPEBSRC, dev_priv->savePIPEBSRC); | ||
441 | I915_WRITE(DSPBADDR, dev_priv->saveDSPBADDR); | ||
442 | I915_WRITE(DSPBSTRIDE, dev_priv->saveDSPBSTRIDE); | ||
443 | if (IS_I965G(dev)) { | ||
444 | I915_WRITE(DSPBSURF, dev_priv->saveDSPBSURF); | ||
445 | I915_WRITE(DSPBTILEOFF, dev_priv->saveDSPBTILEOFF); | ||
446 | } | ||
447 | |||
448 | I915_WRITE(PIPEBCONF, dev_priv->savePIPEBCONF); | ||
449 | |||
450 | i915_restore_palette(dev, PIPE_B); | ||
451 | /* Enable the plane */ | ||
452 | I915_WRITE(DSPBCNTR, dev_priv->saveDSPBCNTR); | ||
453 | I915_WRITE(DSPBADDR, I915_READ(DSPBADDR)); | ||
454 | |||
455 | /* CRT state */ | ||
456 | I915_WRITE(ADPA, dev_priv->saveADPA); | ||
457 | |||
458 | /* LVDS state */ | ||
459 | if (IS_I965G(dev)) | ||
460 | I915_WRITE(BLC_PWM_CTL2, dev_priv->saveBLC_PWM_CTL2); | ||
461 | if (IS_MOBILE(dev) && !IS_I830(dev)) | ||
462 | I915_WRITE(LVDS, dev_priv->saveLVDS); | ||
463 | if (!IS_I830(dev) && !IS_845G(dev)) | ||
464 | I915_WRITE(PFIT_CONTROL, dev_priv->savePFIT_CONTROL); | ||
465 | |||
466 | I915_WRITE(PFIT_PGM_RATIOS, dev_priv->savePFIT_PGM_RATIOS); | ||
467 | I915_WRITE(BLC_PWM_CTL, dev_priv->saveBLC_PWM_CTL); | ||
468 | I915_WRITE(PP_ON_DELAYS, dev_priv->savePP_ON_DELAYS); | ||
469 | I915_WRITE(PP_OFF_DELAYS, dev_priv->savePP_OFF_DELAYS); | ||
470 | I915_WRITE(PP_DIVISOR, dev_priv->savePP_DIVISOR); | ||
471 | I915_WRITE(PP_CONTROL, dev_priv->savePP_CONTROL); | ||
472 | |||
473 | /* FIXME: restore TV & SDVO state */ | ||
474 | |||
475 | /* FBC info */ | ||
476 | I915_WRITE(FBC_CFB_BASE, dev_priv->saveFBC_CFB_BASE); | ||
477 | I915_WRITE(FBC_LL_BASE, dev_priv->saveFBC_LL_BASE); | ||
478 | I915_WRITE(FBC_CONTROL2, dev_priv->saveFBC_CONTROL2); | ||
479 | I915_WRITE(FBC_CONTROL, dev_priv->saveFBC_CONTROL); | ||
480 | |||
481 | /* VGA state */ | ||
482 | I915_WRITE(VGACNTRL, dev_priv->saveVGACNTRL); | ||
483 | I915_WRITE(VGA0, dev_priv->saveVGA0); | ||
484 | I915_WRITE(VGA1, dev_priv->saveVGA1); | ||
485 | I915_WRITE(VGA_PD, dev_priv->saveVGA_PD); | ||
486 | DRM_UDELAY(150); | ||
487 | |||
488 | /* Clock gating state */ | ||
489 | I915_WRITE (D_STATE, dev_priv->saveD_STATE); | ||
490 | I915_WRITE (CG_2D_DIS, dev_priv->saveCG_2D_DIS); | ||
491 | |||
492 | /* Cache mode state */ | ||
493 | I915_WRITE (CACHE_MODE_0, dev_priv->saveCACHE_MODE_0 | 0xffff0000); | ||
494 | |||
495 | /* Memory arbitration state */ | ||
496 | I915_WRITE (MI_ARB_STATE, dev_priv->saveMI_ARB_STATE | 0xffff0000); | ||
497 | |||
498 | for (i = 0; i < 16; i++) { | ||
499 | I915_WRITE(SWF00 + (i << 2), dev_priv->saveSWF0[i]); | ||
500 | I915_WRITE(SWF10 + (i << 2), dev_priv->saveSWF1[i+7]); | ||
501 | } | ||
502 | for (i = 0; i < 3; i++) | ||
503 | I915_WRITE(SWF30 + (i << 2), dev_priv->saveSWF2[i]); | ||
504 | |||
505 | i915_restore_vga(dev); | ||
506 | |||
507 | return 0; | ||
508 | } | ||
509 | |||