Lines Matching refs:state
2 * linux/drivers/video/vgastate.c -- VGA state save/restore
48 static void save_vga_text(struct vgastate *state, void __iomem *fbbase)
50 struct regstate *saved = (struct regstate *) state->vidstate;
56 misc = vga_r(state->vgabase, VGA_MIS_R);
59 vga_r(state->vgabase, iobase + 0xa);
60 vga_w(state->vgabase, VGA_ATT_W, 0x00);
61 attr10 = vga_rattr(state->vgabase, 0x10);
62 vga_r(state->vgabase, iobase + 0xa);
63 vga_w(state->vgabase, VGA_ATT_W, 0x20);
69 gr4 = vga_rgfx(state->vgabase, VGA_GFX_PLANE_READ);
70 gr5 = vga_rgfx(state->vgabase, VGA_GFX_MODE);
71 gr6 = vga_rgfx(state->vgabase, VGA_GFX_MISC);
72 seq2 = vga_rseq(state->vgabase, VGA_SEQ_PLANE_WRITE);
73 seq4 = vga_rseq(state->vgabase, VGA_SEQ_MEMORY_MODE);
76 seq1 = vga_rseq(state->vgabase, VGA_SEQ_CLOCK_MODE);
77 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
78 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 | 1 << 5);
79 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);
82 if (state->flags & VGA_SAVE_FONT0) {
83 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x4);
84 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
85 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x2);
86 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
87 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
93 if (state->flags & VGA_SAVE_FONT1) {
94 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x8);
95 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
96 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x3);
97 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
98 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
99 for (i = 0; i < state->memsize; i++)
104 if (state->flags & VGA_SAVE_TEXT) {
105 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x1);
106 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
107 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x0);
108 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
109 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
113 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x2);
114 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
115 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x1);
116 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
117 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
123 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, seq2);
124 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, seq4);
126 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, gr4);
127 vga_wgfx(state->vgabase, VGA_GFX_MODE, gr5);
128 vga_wgfx(state->vgabase, VGA_GFX_MISC, gr6);
131 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
132 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 & ~(1 << 5));
133 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);
135 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1);
138 static void restore_vga_text(struct vgastate *state, void __iomem *fbbase)
140 struct regstate *saved = (struct regstate *) state->vidstate;
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);
156 seq1 = vga_rseq(state->vgabase, VGA_SEQ_CLOCK_MODE);
157 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
158 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 | 1 << 5);
159 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);
161 if (state->depth == 4) {
162 vga_wgfx(state->vgabase, VGA_GFX_DATA_ROTATE, 0x0);
163 vga_wgfx(state->vgabase, VGA_GFX_BIT_MASK, 0xff);
164 vga_wgfx(state->vgabase, VGA_GFX_SR_ENABLE, 0x00);
168 if (state->flags & VGA_SAVE_FONT0) {
169 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x4);
170 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
171 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x2);
172 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
173 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
179 if (state->flags & VGA_SAVE_FONT1) {
180 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x8);
181 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
182 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x3);
183 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
184 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
185 for (i = 0; i < state->memsize; i++)
190 if (state->flags & VGA_SAVE_TEXT) {
191 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x1);
192 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
193 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x0);
194 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
195 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
199 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x2);
200 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
201 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x1);
202 vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
203 vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
209 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
210 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 & ~(1 << 5));
211 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);
214 vga_wgfx(state->vgabase, VGA_GFX_SR_ENABLE, gr1);
215 vga_wgfx(state->vgabase, VGA_GFX_DATA_ROTATE, gr3);
216 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, gr4);
217 vga_wgfx(state->vgabase, VGA_GFX_MODE, gr5);
218 vga_wgfx(state->vgabase, VGA_GFX_MISC, gr6);
219 vga_wgfx(state->vgabase, VGA_GFX_BIT_MASK, gr8);
221 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1);
222 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, seq2);
223 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, seq4);
226 static void save_vga_mode(struct vgastate *state)
228 struct regstate *saved = (struct regstate *) state->vidstate;
232 saved->misc = vga_r(state->vgabase, VGA_MIS_R);
238 for (i = 0; i < state->num_crtc; i++)
239 saved->crtc[i] = vga_rcrtcs(state->vgabase, iobase, i);
241 vga_r(state->vgabase, iobase + 0xa);
242 vga_w(state->vgabase, VGA_ATT_W, 0x00);
243 for (i = 0; i < state->num_attr; i++) {
244 vga_r(state->vgabase, iobase + 0xa);
245 saved->attr[i] = vga_rattr(state->vgabase, i);
247 vga_r(state->vgabase, iobase + 0xa);
248 vga_w(state->vgabase, VGA_ATT_W, 0x20);
250 for (i = 0; i < state->num_gfx; i++)
251 saved->gfx[i] = vga_rgfx(state->vgabase, i);
253 for (i = 0; i < state->num_seq; i++)
254 saved->seq[i] = vga_rseq(state->vgabase, i);
257 static void restore_vga_mode(struct vgastate *state)
259 struct regstate *saved = (struct regstate *) state->vidstate;
263 vga_w(state->vgabase, VGA_MIS_W, saved->misc);
271 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE,
275 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x01);
278 vga_r(state->vgabase, iobase + 0xa);
279 vga_w(state->vgabase, VGA_ATT_W, 0x00);
281 for (i = 2; i < state->num_seq; i++)
282 vga_wseq(state->vgabase, i, saved->seq[i]);
286 vga_wcrtcs(state->vgabase, iobase, 17, saved->crtc[17] & ~0x80);
287 for (i = 0; i < state->num_crtc; i++)
288 vga_wcrtcs(state->vgabase, iobase, i, saved->crtc[i]);
290 for (i = 0; i < state->num_gfx; i++)
291 vga_wgfx(state->vgabase, i, saved->gfx[i]);
293 for (i = 0; i < state->num_attr; i++) {
294 vga_r(state->vgabase, iobase + 0xa);
295 vga_wattr(state->vgabase, i, saved->attr[i]);
299 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x03);
301 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE,
305 vga_r(state->vgabase, iobase + 0xa);
306 vga_w(state->vgabase, VGA_ATT_W, 0x20);
309 static void save_vga_cmap(struct vgastate *state)
311 struct regstate *saved = (struct regstate *) state->vidstate;
314 vga_w(state->vgabase, VGA_PEL_MSK, 0xff);
317 vga_w(state->vgabase, VGA_PEL_IR, 0x00);
319 saved->vga_cmap[i] = vga_r(state->vgabase, VGA_PEL_D);
322 static void restore_vga_cmap(struct vgastate *state)
324 struct regstate *saved = (struct regstate *) state->vidstate;
327 vga_w(state->vgabase, VGA_PEL_MSK, 0xff);
330 vga_w(state->vgabase, VGA_PEL_IW, 0x00);
332 vga_w(state->vgabase, VGA_PEL_D, saved->vga_cmap[i]);
335 static void vga_cleanup(struct vgastate *state)
337 if (state->vidstate != NULL) {
338 struct regstate *saved = (struct regstate *) state->vidstate;
346 state->vidstate = NULL;
350 int save_vga(struct vgastate *state)
359 state->vidstate = (void *)saved;
361 if (state->flags & VGA_SAVE_CMAP) {
364 vga_cleanup(state);
367 save_vga_cmap(state);
370 if (state->flags & VGA_SAVE_MODE) {
373 if (state->num_attr < 21)
374 state->num_attr = 21;
375 if (state->num_crtc < 25)
376 state->num_crtc = 25;
377 if (state->num_gfx < 9)
378 state->num_gfx = 9;
379 if (state->num_seq < 5)
380 state->num_seq = 5;
381 total = state->num_attr + state->num_crtc +
382 state->num_gfx + state->num_seq;
386 vga_cleanup(state);
389 saved->crtc = saved->attr + state->num_attr;
390 saved->gfx = saved->crtc + state->num_crtc;
391 saved->seq = saved->gfx + state->num_gfx;
393 save_vga_mode(state);
396 if (state->flags & VGA_SAVE_FONTS) {
400 if (state->memsize && state->memsize < 4 * 8192) {
401 vga_cleanup(state);
404 if (!state->memsize)
405 state->memsize = 8 * 8192;
407 if (!state->membase)
408 state->membase = 0xA0000;
410 fbbase = ioremap(state->membase, state->memsize);
413 vga_cleanup(state);
420 if (state->flags & VGA_SAVE_FONT0) {
424 vga_cleanup(state);
432 if (state->flags & VGA_SAVE_FONT1) {
433 saved->vga_font1 = vmalloc(state->memsize);
436 vga_cleanup(state);
443 if (state->flags & VGA_SAVE_TEXT) {
447 vga_cleanup(state);
452 save_vga_text(state, fbbase);
458 int restore_vga(struct vgastate *state)
460 if (state->vidstate == NULL)
463 if (state->flags & VGA_SAVE_MODE)
464 restore_vga_mode(state);
466 if (state->flags & VGA_SAVE_FONTS) {
467 void __iomem *fbbase = ioremap(state->membase, state->memsize);
470 vga_cleanup(state);
473 restore_vga_text(state, fbbase);
477 if (state->flags & VGA_SAVE_CMAP)
478 restore_vga_cmap(state);
480 vga_cleanup(state);