2 * linux/drivers/video/vgastate.c -- VGA state save/restore
4 * Copyright 2002 James Simmons
6 * Copyright history from vga16fb.c:
7 * Copyright 1999 Ben Pfaff and Petr Vandrovec
8 * Based on VGA info at http://www.goodnet.com/~tinara/FreeVGA/home.htm
9 * Based on VESA framebuffer (c) 1998 Gerd Knorr
11 * This file is subject to the terms and conditions of the GNU General
12 * Public License. See the file COPYING in the main directory of this
13 * archive for more details.
16 #include <linux/config.h>
17 #include <linux/module.h>
18 #include <linux/slab.h>
20 #include <linux/vmalloc.h>
21 #include <video/vga.h>
35 static inline unsigned char vga_rcrtcs(void __iomem
*regbase
, unsigned short iobase
,
38 vga_w(regbase
, iobase
+ 0x4, reg
);
39 return vga_r(regbase
, iobase
+ 0x5);
42 static inline void vga_wcrtcs(void __iomem
*regbase
, unsigned short iobase
,
43 unsigned char reg
, unsigned char val
)
45 vga_w(regbase
, iobase
+ 0x4, reg
);
46 vga_w(regbase
, iobase
+ 0x5, val
);
49 static void save_vga_text(struct vgastate
*state
, void __iomem
*fbbase
)
51 struct regstate
*saved
= (struct regstate
*) state
->vidstate
;
53 u8 misc
, attr10
, gr4
, gr5
, gr6
, seq1
, seq2
, seq4
;
55 /* if in graphics mode, no need to save */
56 attr10
= vga_rattr(state
->vgabase
, 0x10);
61 misc
= vga_r(state
->vgabase
, VGA_MIS_R
);
62 gr4
= vga_rgfx(state
->vgabase
, VGA_GFX_PLANE_READ
);
63 gr5
= vga_rgfx(state
->vgabase
, VGA_GFX_MODE
);
64 gr6
= vga_rgfx(state
->vgabase
, VGA_GFX_MISC
);
65 seq2
= vga_rseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
);
66 seq4
= vga_rseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
);
68 /* force graphics mode */
69 vga_w(state
->vgabase
, VGA_MIS_W
, misc
| 1);
72 seq1
= vga_rseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
);
73 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x1);
74 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
, seq1
| 1 << 5);
75 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x3);
77 /* save font at plane 2 */
78 if (state
->flags
& VGA_SAVE_FONT0
) {
79 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x4);
80 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
81 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x2);
82 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
83 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
84 for (i
= 0; i
< 4 * 8192; i
++)
85 saved
->vga_font0
[i
] = vga_r(fbbase
, i
);
88 /* save font at plane 3 */
89 if (state
->flags
& VGA_SAVE_FONT1
) {
90 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x8);
91 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
92 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x3);
93 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
94 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
95 for (i
= 0; i
< state
->memsize
; i
++)
96 saved
->vga_font1
[i
] = vga_r(fbbase
, i
);
99 /* save font at plane 0/1 */
100 if (state
->flags
& VGA_SAVE_TEXT
) {
101 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x1);
102 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
103 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x0);
104 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
105 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
106 for (i
= 0; i
< 8192; i
++)
107 saved
->vga_text
[i
] = vga_r(fbbase
, i
);
109 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x2);
110 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
111 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x1);
112 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
113 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
114 for (i
= 0; i
< 8192; i
++)
115 saved
->vga_text
[8192+i
] = vga_r(fbbase
+ 2 * 8192, i
);
119 vga_wattr(state
->vgabase
, 0x10, attr10
);
121 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, seq2
);
122 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, seq4
);
124 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, gr4
);
125 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, gr5
);
126 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, gr6
);
127 vga_w(state
->vgabase
, VGA_MIS_W
, misc
);
130 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x1);
131 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
, seq1
& ~(1 << 5));
132 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x3);
134 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
, seq1
);
137 static void restore_vga_text(struct vgastate
*state
, void __iomem
*fbbase
)
139 struct regstate
*saved
= (struct regstate
*) state
->vidstate
;
141 u8 misc
, gr1
, gr3
, gr4
, gr5
, gr6
, gr8
;
145 misc
= vga_r(state
->vgabase
, VGA_MIS_R
);
146 gr1
= vga_rgfx(state
->vgabase
, VGA_GFX_SR_ENABLE
);
147 gr3
= vga_rgfx(state
->vgabase
, VGA_GFX_DATA_ROTATE
);
148 gr4
= vga_rgfx(state
->vgabase
, VGA_GFX_PLANE_READ
);
149 gr5
= vga_rgfx(state
->vgabase
, VGA_GFX_MODE
);
150 gr6
= vga_rgfx(state
->vgabase
, VGA_GFX_MISC
);
151 gr8
= vga_rgfx(state
->vgabase
, VGA_GFX_BIT_MASK
);
152 seq2
= vga_rseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
);
153 seq4
= vga_rseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
);
155 /* force graphics mode */
156 vga_w(state
->vgabase
, VGA_MIS_W
, misc
| 1);
159 seq1
= vga_rseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
);
160 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x1);
161 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
, seq1
| 1 << 5);
162 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x3);
164 if (state
->depth
== 4) {
165 vga_wgfx(state
->vgabase
, VGA_GFX_DATA_ROTATE
, 0x0);
166 vga_wgfx(state
->vgabase
, VGA_GFX_BIT_MASK
, 0xff);
167 vga_wgfx(state
->vgabase
, VGA_GFX_SR_ENABLE
, 0x00);
170 /* restore font at plane 2 */
171 if (state
->flags
& VGA_SAVE_FONT0
) {
172 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x4);
173 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
174 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x2);
175 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
176 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
177 for (i
= 0; i
< 4 * 8192; i
++)
178 vga_w(fbbase
, i
, saved
->vga_font0
[i
]);
181 /* restore font at plane 3 */
182 if (state
->flags
& VGA_SAVE_FONT1
) {
183 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x8);
184 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
185 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x3);
186 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
187 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
188 for (i
= 0; i
< state
->memsize
; i
++)
189 vga_w(fbbase
, i
, saved
->vga_font1
[i
]);
192 /* restore font at plane 0/1 */
193 if (state
->flags
& VGA_SAVE_TEXT
) {
194 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x1);
195 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
196 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x0);
197 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
198 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
199 for (i
= 0; i
< 8192; i
++)
200 vga_w(fbbase
, i
, saved
->vga_text
[i
]);
202 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, 0x2);
203 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, 0x6);
204 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, 0x1);
205 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, 0x0);
206 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, 0x5);
207 for (i
= 0; i
< 8192; i
++)
208 vga_w(fbbase
, i
, saved
->vga_text
[8192+i
]);
212 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x1);
213 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
, seq1
& ~(1 << 5));
214 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x3);
217 vga_w(state
->vgabase
, VGA_MIS_W
, misc
);
219 vga_wgfx(state
->vgabase
, VGA_GFX_SR_ENABLE
, gr1
);
220 vga_wgfx(state
->vgabase
, VGA_GFX_DATA_ROTATE
, gr3
);
221 vga_wgfx(state
->vgabase
, VGA_GFX_PLANE_READ
, gr4
);
222 vga_wgfx(state
->vgabase
, VGA_GFX_MODE
, gr5
);
223 vga_wgfx(state
->vgabase
, VGA_GFX_MISC
, gr6
);
224 vga_wgfx(state
->vgabase
, VGA_GFX_BIT_MASK
, gr8
);
226 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
, seq1
);
227 vga_wseq(state
->vgabase
, VGA_SEQ_PLANE_WRITE
, seq2
);
228 vga_wseq(state
->vgabase
, VGA_SEQ_MEMORY_MODE
, seq4
);
231 static void save_vga_mode(struct vgastate
*state
)
233 struct regstate
*saved
= (struct regstate
*) state
->vidstate
;
234 unsigned short iobase
;
237 saved
->misc
= vga_r(state
->vgabase
, VGA_MIS_R
);
243 for (i
= 0; i
< state
->num_crtc
; i
++)
244 saved
->crtc
[i
] = vga_rcrtcs(state
->vgabase
, iobase
, i
);
246 vga_r(state
->vgabase
, iobase
+ 0xa);
247 vga_w(state
->vgabase
, VGA_ATT_W
, 0x00);
248 for (i
= 0; i
< state
->num_attr
; i
++) {
249 vga_r(state
->vgabase
, iobase
+ 0xa);
250 saved
->attr
[i
] = vga_rattr(state
->vgabase
, i
);
252 vga_r(state
->vgabase
, iobase
+ 0xa);
253 vga_w(state
->vgabase
, VGA_ATT_W
, 0x20);
255 for (i
= 0; i
< state
->num_gfx
; i
++)
256 saved
->gfx
[i
] = vga_rgfx(state
->vgabase
, i
);
258 for (i
= 0; i
< state
->num_seq
; i
++)
259 saved
->seq
[i
] = vga_rseq(state
->vgabase
, i
);
262 static void restore_vga_mode(struct vgastate
*state
)
264 struct regstate
*saved
= (struct regstate
*) state
->vidstate
;
265 unsigned short iobase
;
268 vga_w(state
->vgabase
, VGA_MIS_W
, saved
->misc
);
275 /* turn off display */
276 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
,
277 saved
->seq
[VGA_SEQ_CLOCK_MODE
] | 0x20);
279 /* disable sequencer */
280 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x01);
282 /* enable palette addressing */
283 vga_r(state
->vgabase
, iobase
+ 0xa);
284 vga_w(state
->vgabase
, VGA_ATT_W
, 0x00);
286 for (i
= 2; i
< state
->num_seq
; i
++)
287 vga_wseq(state
->vgabase
, i
, saved
->seq
[i
]);
290 /* unprotect vga regs */
291 vga_wcrtcs(state
->vgabase
, iobase
, 17, saved
->crtc
[17] & ~0x80);
292 for (i
= 0; i
< state
->num_crtc
; i
++)
293 vga_wcrtcs(state
->vgabase
, iobase
, i
, saved
->crtc
[i
]);
295 for (i
= 0; i
< state
->num_gfx
; i
++)
296 vga_wgfx(state
->vgabase
, i
, saved
->gfx
[i
]);
298 for (i
= 0; i
< state
->num_attr
; i
++) {
299 vga_r(state
->vgabase
, iobase
+ 0xa);
300 vga_wattr(state
->vgabase
, i
, saved
->attr
[i
]);
303 /* reenable sequencer */
304 vga_wseq(state
->vgabase
, VGA_SEQ_RESET
, 0x03);
305 /* turn display on */
306 vga_wseq(state
->vgabase
, VGA_SEQ_CLOCK_MODE
,
307 saved
->seq
[VGA_SEQ_CLOCK_MODE
] & ~(1 << 5));
309 /* disable video/palette source */
310 vga_r(state
->vgabase
, iobase
+ 0xa);
311 vga_w(state
->vgabase
, VGA_ATT_W
, 0x20);
314 static void save_vga_cmap(struct vgastate
*state
)
316 struct regstate
*saved
= (struct regstate
*) state
->vidstate
;
319 vga_w(state
->vgabase
, VGA_PEL_MSK
, 0xff);
321 /* assumes DAC is readable and writable */
322 vga_w(state
->vgabase
, VGA_PEL_IR
, 0x00);
323 for (i
= 0; i
< 768; i
++)
324 saved
->vga_cmap
[i
] = vga_r(state
->vgabase
, VGA_PEL_D
);
327 static void restore_vga_cmap(struct vgastate
*state
)
329 struct regstate
*saved
= (struct regstate
*) state
->vidstate
;
332 vga_w(state
->vgabase
, VGA_PEL_MSK
, 0xff);
334 /* assumes DAC is readable and writable */
335 vga_w(state
->vgabase
, VGA_PEL_IW
, 0x00);
336 for (i
= 0; i
< 768; i
++)
337 vga_w(state
->vgabase
, VGA_PEL_D
, saved
->vga_cmap
[i
]);
340 static void vga_cleanup(struct vgastate
*state
)
342 if (state
->vidstate
!= NULL
) {
343 struct regstate
*saved
= (struct regstate
*) state
->vidstate
;
345 vfree(saved
->vga_font0
);
346 vfree(saved
->vga_font1
);
347 vfree(saved
->vga_text
);
348 vfree(saved
->vga_cmap
);
351 state
->vidstate
= NULL
;
355 int save_vga(struct vgastate
*state
)
357 struct regstate
*saved
;
359 saved
= kzalloc(sizeof(struct regstate
), GFP_KERNEL
);
364 state
->vidstate
= (void *)saved
;
366 if (state
->flags
& VGA_SAVE_CMAP
) {
367 saved
->vga_cmap
= vmalloc(768);
368 if (!saved
->vga_cmap
) {
372 save_vga_cmap(state
);
375 if (state
->flags
& VGA_SAVE_MODE
) {
378 if (state
->num_attr
< 21)
379 state
->num_attr
= 21;
380 if (state
->num_crtc
< 25)
381 state
->num_crtc
= 25;
382 if (state
->num_gfx
< 9)
384 if (state
->num_seq
< 5)
386 total
= state
->num_attr
+ state
->num_crtc
+
387 state
->num_gfx
+ state
->num_seq
;
389 saved
->attr
= vmalloc(total
);
394 saved
->crtc
= saved
->attr
+ state
->num_attr
;
395 saved
->gfx
= saved
->crtc
+ state
->num_crtc
;
396 saved
->seq
= saved
->gfx
+ state
->num_gfx
;
398 save_vga_mode(state
);
401 if (state
->flags
& VGA_SAVE_FONTS
) {
402 void __iomem
*fbbase
;
404 /* exit if window is less than 32K */
405 if (state
->memsize
&& state
->memsize
< 4 * 8192) {
410 state
->memsize
= 8 * 8192;
413 state
->membase
= 0xA0000;
415 fbbase
= ioremap(state
->membase
, state
->memsize
);
423 * save only first 32K used by vgacon
425 if (state
->flags
& VGA_SAVE_FONT0
) {
426 saved
->vga_font0
= vmalloc(4 * 8192);
427 if (!saved
->vga_font0
) {
434 * largely unused, but if required by the caller
435 * we'll just save everything.
437 if (state
->flags
& VGA_SAVE_FONT1
) {
438 saved
->vga_font1
= vmalloc(state
->memsize
);
439 if (!saved
->vga_font1
) {
446 * Save 8K at plane0[0], and 8K at plane1[16K]
448 if (state
->flags
& VGA_SAVE_TEXT
) {
449 saved
->vga_text
= vmalloc(8192 * 2);
450 if (!saved
->vga_text
) {
457 save_vga_text(state
, fbbase
);
463 int restore_vga (struct vgastate
*state
)
465 if (state
->vidstate
== NULL
)
468 if (state
->flags
& VGA_SAVE_MODE
)
469 restore_vga_mode(state
);
471 if (state
->flags
& VGA_SAVE_FONTS
) {
472 void __iomem
*fbbase
= ioremap(state
->membase
, state
->memsize
);
478 restore_vga_text(state
, fbbase
);
482 if (state
->flags
& VGA_SAVE_CMAP
)
483 restore_vga_cmap(state
);
489 EXPORT_SYMBOL(save_vga
);
490 EXPORT_SYMBOL(restore_vga
);
492 MODULE_AUTHOR("James Simmons <jsimmons@users.sf.net>");
493 MODULE_DESCRIPTION("VGA State Save/Restore");
494 MODULE_LICENSE("GPL");
This page took 0.041159 seconds and 6 git commands to generate.