aboutsummaryrefslogtreecommitdiffstats
path: root/drivers
diff options
context:
space:
mode:
authorAntonino A. Daplas <adaplas@gmail.com>2006-06-26 03:26:23 -0400
committerLinus Torvalds <torvalds@g5.osdl.org>2006-06-26 12:58:28 -0400
commit2356614b08bf8769790c4f1f55c83d95f802bc51 (patch)
treeb91aaa653189fabe3cb09fc9ed015fa384b22b01 /drivers
parent1ba70a019599b4fa3e091c6dbc4a04e2c607eea3 (diff)
[PATCH] savagefb: Allocate space for current and saved register states
Allocate space for 2 register states: 'current' for the current state of the hardware, and 'saved', to be used for restoring the hardware to a sane state. This is in preparation for the addition of state save and restore hooks to make savagefb work together with the latest Xorg savage driver. Signed-off-by: Antonino Daplas <adaplas@pol.net> Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
Diffstat (limited to 'drivers')
-rw-r--r--drivers/video/savage/savagefb.h45
-rw-r--r--drivers/video/savage/savagefb_driver.c515
2 files changed, 282 insertions, 278 deletions
diff --git a/drivers/video/savage/savagefb.h b/drivers/video/savage/savagefb.h
index 58cfdfb41833..e648a6c0f6d9 100644
--- a/drivers/video/savage/savagefb.h
+++ b/drivers/video/savage/savagefb.h
@@ -147,7 +147,27 @@ struct xtimings {
147 int interlaced; 147 int interlaced;
148}; 148};
149 149
150struct savage_reg {
151 unsigned char MiscOutReg; /* Misc */
152 unsigned char CRTC[25]; /* Crtc Controller */
153 unsigned char Sequencer[5]; /* Video Sequencer */
154 unsigned char Graphics[9]; /* Video Graphics */
155 unsigned char Attribute[21]; /* Video Atribute */
150 156
157 unsigned int mode, refresh;
158 unsigned char SR08, SR0E, SR0F;
159 unsigned char SR10, SR11, SR12, SR13, SR15, SR18, SR29, SR30;
160 unsigned char SR54[8];
161 unsigned char Clock;
162 unsigned char CR31, CR32, CR33, CR34, CR36, CR3A, CR3B, CR3C;
163 unsigned char CR40, CR41, CR42, CR43, CR45;
164 unsigned char CR50, CR51, CR53, CR55, CR58, CR5B, CR5D, CR5E;
165 unsigned char CR60, CR63, CR65, CR66, CR67, CR68, CR69, CR6D, CR6F;
166 unsigned char CR86, CR88;
167 unsigned char CR90, CR91, CRB0;
168 unsigned int STREAMS[22]; /* yuck, streams regs */
169 unsigned int MMPR0, MMPR1, MMPR2, MMPR3;
170};
151/* --------------------------------------------------------------------- */ 171/* --------------------------------------------------------------------- */
152 172
153#define NR_PALETTE 256 173#define NR_PALETTE 256
@@ -167,6 +187,8 @@ struct savagefb_par {
167 struct pci_dev *pcidev; 187 struct pci_dev *pcidev;
168 savage_chipset chip; 188 savage_chipset chip;
169 struct savagefb_i2c_chan chan; 189 struct savagefb_i2c_chan chan;
190 struct savage_reg state;
191 struct savage_reg save;
170 unsigned char *edid; 192 unsigned char *edid;
171 u32 pseudo_palette[16]; 193 u32 pseudo_palette[16];
172 int paletteEnabled; 194 int paletteEnabled;
@@ -179,6 +201,7 @@ struct savagefb_par {
179 int minClock; 201 int minClock;
180 int numClocks; 202 int numClocks;
181 int clock[4]; 203 int clock[4];
204 int MCLK, REFCLK, LCDclk;
182 struct { 205 struct {
183 u8 __iomem *vbase; 206 u8 __iomem *vbase;
184 u32 pbase; 207 u32 pbase;
@@ -196,7 +219,6 @@ struct savagefb_par {
196 219
197 volatile u32 __iomem *bci_base; 220 volatile u32 __iomem *bci_base;
198 unsigned int bci_ptr; 221 unsigned int bci_ptr;
199
200 u32 cob_offset; 222 u32 cob_offset;
201 u32 cob_size; 223 u32 cob_size;
202 int cob_index; 224 int cob_index;
@@ -204,7 +226,6 @@ struct savagefb_par {
204 void (*SavageWaitIdle) (struct savagefb_par *par); 226 void (*SavageWaitIdle) (struct savagefb_par *par);
205 void (*SavageWaitFifo) (struct savagefb_par *par, int space); 227 void (*SavageWaitFifo) (struct savagefb_par *par, int space);
206 228
207 int MCLK, REFCLK, LCDclk;
208 int HorizScaleFactor; 229 int HorizScaleFactor;
209 230
210 /* Panels size */ 231 /* Panels size */
@@ -217,26 +238,6 @@ struct savagefb_par {
217 238
218 int depth; 239 int depth;
219 int vwidth; 240 int vwidth;
220
221 unsigned char MiscOutReg; /* Misc */
222 unsigned char CRTC[25]; /* Crtc Controller */
223 unsigned char Sequencer[5]; /* Video Sequencer */
224 unsigned char Graphics[9]; /* Video Graphics */
225 unsigned char Attribute[21]; /* Video Atribute */
226
227 unsigned int mode, refresh;
228 unsigned char SR08, SR0E, SR0F;
229 unsigned char SR10, SR11, SR12, SR13, SR15, SR18, SR29, SR30;
230 unsigned char SR54[8];
231 unsigned char Clock;
232 unsigned char CR31, CR32, CR33, CR34, CR36, CR3A, CR3B, CR3C;
233 unsigned char CR40, CR41, CR42, CR43, CR45;
234 unsigned char CR50, CR51, CR53, CR55, CR58, CR5B, CR5D, CR5E;
235 unsigned char CR60, CR63, CR65, CR66, CR67, CR68, CR69, CR6D, CR6F;
236 unsigned char CR86, CR88;
237 unsigned char CR90, CR91, CRB0;
238 unsigned int STREAMS[22]; /* yuck, streams regs */
239 unsigned int MMPR0, MMPR1, MMPR2, MMPR3;
240}; 241};
241 242
242#define BCI_BD_BW_DISABLE 0x10000000 243#define BCI_BD_BW_DISABLE 0x10000000
diff --git a/drivers/video/savage/savagefb_driver.c b/drivers/video/savage/savagefb_driver.c
index 0da624e6524f..267d4e5c9991 100644
--- a/drivers/video/savage/savagefb_driver.c
+++ b/drivers/video/savage/savagefb_driver.c
@@ -122,66 +122,67 @@ static void vgaHWProtect (struct savagefb_par *par, int on)
122 } 122 }
123} 123}
124 124
125static void vgaHWRestore (struct savagefb_par *par) 125static void vgaHWRestore (struct savagefb_par *par, struct savage_reg *reg)
126{ 126{
127 int i; 127 int i;
128 128
129 VGAwMISC (par->MiscOutReg, par); 129 VGAwMISC (reg->MiscOutReg, par);
130 130
131 for (i = 1; i < 5; i++) 131 for (i = 1; i < 5; i++)
132 VGAwSEQ (i, par->Sequencer[i], par); 132 VGAwSEQ (i, reg->Sequencer[i], par);
133 133
134 /* Ensure CRTC registers 0-7 are unlocked by clearing bit 7 or 134 /* Ensure CRTC registers 0-7 are unlocked by clearing bit 7 or
135 CRTC[17] */ 135 CRTC[17] */
136 VGAwCR (17, par->CRTC[17] & ~0x80, par); 136 VGAwCR (17, reg->CRTC[17] & ~0x80, par);
137 137
138 for (i = 0; i < 25; i++) 138 for (i = 0; i < 25; i++)
139 VGAwCR (i, par->CRTC[i], par); 139 VGAwCR (i, reg->CRTC[i], par);
140 140
141 for (i = 0; i < 9; i++) 141 for (i = 0; i < 9; i++)
142 VGAwGR (i, par->Graphics[i], par); 142 VGAwGR (i, reg->Graphics[i], par);
143 143
144 VGAenablePalette(par); 144 VGAenablePalette(par);
145 145
146 for (i = 0; i < 21; i++) 146 for (i = 0; i < 21; i++)
147 VGAwATTR (i, par->Attribute[i], par); 147 VGAwATTR (i, reg->Attribute[i], par);
148 148
149 VGAdisablePalette(par); 149 VGAdisablePalette(par);
150} 150}
151 151
152static void vgaHWInit (struct fb_var_screeninfo *var, 152static void vgaHWInit (struct fb_var_screeninfo *var,
153 struct savagefb_par *par, 153 struct savagefb_par *par,
154 struct xtimings *timings) 154 struct xtimings *timings,
155 struct savage_reg *reg)
155{ 156{
156 par->MiscOutReg = 0x23; 157 reg->MiscOutReg = 0x23;
157 158
158 if (!(timings->sync & FB_SYNC_HOR_HIGH_ACT)) 159 if (!(timings->sync & FB_SYNC_HOR_HIGH_ACT))
159 par->MiscOutReg |= 0x40; 160 reg->MiscOutReg |= 0x40;
160 161
161 if (!(timings->sync & FB_SYNC_VERT_HIGH_ACT)) 162 if (!(timings->sync & FB_SYNC_VERT_HIGH_ACT))
162 par->MiscOutReg |= 0x80; 163 reg->MiscOutReg |= 0x80;
163 164
164 /* 165 /*
165 * Time Sequencer 166 * Time Sequencer
166 */ 167 */
167 par->Sequencer[0x00] = 0x00; 168 reg->Sequencer[0x00] = 0x00;
168 par->Sequencer[0x01] = 0x01; 169 reg->Sequencer[0x01] = 0x01;
169 par->Sequencer[0x02] = 0x0F; 170 reg->Sequencer[0x02] = 0x0F;
170 par->Sequencer[0x03] = 0x00; /* Font select */ 171 reg->Sequencer[0x03] = 0x00; /* Font select */
171 par->Sequencer[0x04] = 0x0E; /* Misc */ 172 reg->Sequencer[0x04] = 0x0E; /* Misc */
172 173
173 /* 174 /*
174 * CRTC Controller 175 * CRTC Controller
175 */ 176 */
176 par->CRTC[0x00] = (timings->HTotal >> 3) - 5; 177 reg->CRTC[0x00] = (timings->HTotal >> 3) - 5;
177 par->CRTC[0x01] = (timings->HDisplay >> 3) - 1; 178 reg->CRTC[0x01] = (timings->HDisplay >> 3) - 1;
178 par->CRTC[0x02] = (timings->HSyncStart >> 3) - 1; 179 reg->CRTC[0x02] = (timings->HSyncStart >> 3) - 1;
179 par->CRTC[0x03] = (((timings->HSyncEnd >> 3) - 1) & 0x1f) | 0x80; 180 reg->CRTC[0x03] = (((timings->HSyncEnd >> 3) - 1) & 0x1f) | 0x80;
180 par->CRTC[0x04] = (timings->HSyncStart >> 3); 181 reg->CRTC[0x04] = (timings->HSyncStart >> 3);
181 par->CRTC[0x05] = ((((timings->HSyncEnd >> 3) - 1) & 0x20) << 2) | 182 reg->CRTC[0x05] = ((((timings->HSyncEnd >> 3) - 1) & 0x20) << 2) |
182 (((timings->HSyncEnd >> 3)) & 0x1f); 183 (((timings->HSyncEnd >> 3)) & 0x1f);
183 par->CRTC[0x06] = (timings->VTotal - 2) & 0xFF; 184 reg->CRTC[0x06] = (timings->VTotal - 2) & 0xFF;
184 par->CRTC[0x07] = (((timings->VTotal - 2) & 0x100) >> 8) | 185 reg->CRTC[0x07] = (((timings->VTotal - 2) & 0x100) >> 8) |
185 (((timings->VDisplay - 1) & 0x100) >> 7) | 186 (((timings->VDisplay - 1) & 0x100) >> 7) |
186 ((timings->VSyncStart & 0x100) >> 6) | 187 ((timings->VSyncStart & 0x100) >> 6) |
187 (((timings->VSyncStart - 1) & 0x100) >> 5) | 188 (((timings->VSyncStart - 1) & 0x100) >> 5) |
@@ -189,27 +190,27 @@ static void vgaHWInit (struct fb_var_screeninfo *var,
189 (((timings->VTotal - 2) & 0x200) >> 4) | 190 (((timings->VTotal - 2) & 0x200) >> 4) |
190 (((timings->VDisplay - 1) & 0x200) >> 3) | 191 (((timings->VDisplay - 1) & 0x200) >> 3) |
191 ((timings->VSyncStart & 0x200) >> 2); 192 ((timings->VSyncStart & 0x200) >> 2);
192 par->CRTC[0x08] = 0x00; 193 reg->CRTC[0x08] = 0x00;
193 par->CRTC[0x09] = (((timings->VSyncStart - 1) & 0x200) >> 4) | 0x40; 194 reg->CRTC[0x09] = (((timings->VSyncStart - 1) & 0x200) >> 4) | 0x40;
194 195
195 if (timings->dblscan) 196 if (timings->dblscan)
196 par->CRTC[0x09] |= 0x80; 197 reg->CRTC[0x09] |= 0x80;
197 198
198 par->CRTC[0x0a] = 0x00; 199 reg->CRTC[0x0a] = 0x00;
199 par->CRTC[0x0b] = 0x00; 200 reg->CRTC[0x0b] = 0x00;
200 par->CRTC[0x0c] = 0x00; 201 reg->CRTC[0x0c] = 0x00;
201 par->CRTC[0x0d] = 0x00; 202 reg->CRTC[0x0d] = 0x00;
202 par->CRTC[0x0e] = 0x00; 203 reg->CRTC[0x0e] = 0x00;
203 par->CRTC[0x0f] = 0x00; 204 reg->CRTC[0x0f] = 0x00;
204 par->CRTC[0x10] = timings->VSyncStart & 0xff; 205 reg->CRTC[0x10] = timings->VSyncStart & 0xff;
205 par->CRTC[0x11] = (timings->VSyncEnd & 0x0f) | 0x20; 206 reg->CRTC[0x11] = (timings->VSyncEnd & 0x0f) | 0x20;
206 par->CRTC[0x12] = (timings->VDisplay - 1) & 0xff; 207 reg->CRTC[0x12] = (timings->VDisplay - 1) & 0xff;
207 par->CRTC[0x13] = var->xres_virtual >> 4; 208 reg->CRTC[0x13] = var->xres_virtual >> 4;
208 par->CRTC[0x14] = 0x00; 209 reg->CRTC[0x14] = 0x00;
209 par->CRTC[0x15] = (timings->VSyncStart - 1) & 0xff; 210 reg->CRTC[0x15] = (timings->VSyncStart - 1) & 0xff;
210 par->CRTC[0x16] = (timings->VSyncEnd - 1) & 0xff; 211 reg->CRTC[0x16] = (timings->VSyncEnd - 1) & 0xff;
211 par->CRTC[0x17] = 0xc3; 212 reg->CRTC[0x17] = 0xc3;
212 par->CRTC[0x18] = 0xff; 213 reg->CRTC[0x18] = 0xff;
213 214
214 /* 215 /*
215 * are these unnecessary? 216 * are these unnecessary?
@@ -220,38 +221,38 @@ static void vgaHWInit (struct fb_var_screeninfo *var,
220 /* 221 /*
221 * Graphics Display Controller 222 * Graphics Display Controller
222 */ 223 */
223 par->Graphics[0x00] = 0x00; 224 reg->Graphics[0x00] = 0x00;
224 par->Graphics[0x01] = 0x00; 225 reg->Graphics[0x01] = 0x00;
225 par->Graphics[0x02] = 0x00; 226 reg->Graphics[0x02] = 0x00;
226 par->Graphics[0x03] = 0x00; 227 reg->Graphics[0x03] = 0x00;
227 par->Graphics[0x04] = 0x00; 228 reg->Graphics[0x04] = 0x00;
228 par->Graphics[0x05] = 0x40; 229 reg->Graphics[0x05] = 0x40;
229 par->Graphics[0x06] = 0x05; /* only map 64k VGA memory !!!! */ 230 reg->Graphics[0x06] = 0x05; /* only map 64k VGA memory !!!! */
230 par->Graphics[0x07] = 0x0F; 231 reg->Graphics[0x07] = 0x0F;
231 par->Graphics[0x08] = 0xFF; 232 reg->Graphics[0x08] = 0xFF;
232 233
233 234
234 par->Attribute[0x00] = 0x00; /* standard colormap translation */ 235 reg->Attribute[0x00] = 0x00; /* standard colormap translation */
235 par->Attribute[0x01] = 0x01; 236 reg->Attribute[0x01] = 0x01;
236 par->Attribute[0x02] = 0x02; 237 reg->Attribute[0x02] = 0x02;
237 par->Attribute[0x03] = 0x03; 238 reg->Attribute[0x03] = 0x03;
238 par->Attribute[0x04] = 0x04; 239 reg->Attribute[0x04] = 0x04;
239 par->Attribute[0x05] = 0x05; 240 reg->Attribute[0x05] = 0x05;
240 par->Attribute[0x06] = 0x06; 241 reg->Attribute[0x06] = 0x06;
241 par->Attribute[0x07] = 0x07; 242 reg->Attribute[0x07] = 0x07;
242 par->Attribute[0x08] = 0x08; 243 reg->Attribute[0x08] = 0x08;
243 par->Attribute[0x09] = 0x09; 244 reg->Attribute[0x09] = 0x09;
244 par->Attribute[0x0a] = 0x0A; 245 reg->Attribute[0x0a] = 0x0A;
245 par->Attribute[0x0b] = 0x0B; 246 reg->Attribute[0x0b] = 0x0B;
246 par->Attribute[0x0c] = 0x0C; 247 reg->Attribute[0x0c] = 0x0C;
247 par->Attribute[0x0d] = 0x0D; 248 reg->Attribute[0x0d] = 0x0D;
248 par->Attribute[0x0e] = 0x0E; 249 reg->Attribute[0x0e] = 0x0E;
249 par->Attribute[0x0f] = 0x0F; 250 reg->Attribute[0x0f] = 0x0F;
250 par->Attribute[0x10] = 0x41; 251 reg->Attribute[0x10] = 0x41;
251 par->Attribute[0x11] = 0xFF; 252 reg->Attribute[0x11] = 0xFF;
252 par->Attribute[0x12] = 0x0F; 253 reg->Attribute[0x12] = 0x0F;
253 par->Attribute[0x13] = 0x00; 254 reg->Attribute[0x13] = 0x00;
254 par->Attribute[0x14] = 0x00; 255 reg->Attribute[0x14] = 0x00;
255} 256}
256 257
257/* -------------------- Hardware specific routines ------------------------- */ 258/* -------------------- Hardware specific routines ------------------------- */
@@ -513,7 +514,7 @@ static void SavagePrintRegs(void)
513 514
514/* --------------------------------------------------------------------- */ 515/* --------------------------------------------------------------------- */
515 516
516static void savage_get_default_par(struct savagefb_par *par) 517static void savage_get_default_par(struct savagefb_par *par, struct savage_reg *reg)
517{ 518{
518 unsigned char cr3a, cr53, cr66; 519 unsigned char cr3a, cr53, cr66;
519 520
@@ -543,96 +544,96 @@ static void savage_get_default_par(struct savagefb_par *par)
543 544
544 /* unlock extended seq regs */ 545 /* unlock extended seq regs */
545 vga_out8 (0x3c4, 0x08, par); 546 vga_out8 (0x3c4, 0x08, par);
546 par->SR08 = vga_in8 (0x3c5, par); 547 reg->SR08 = vga_in8 (0x3c5, par);
547 vga_out8 (0x3c5, 0x06, par); 548 vga_out8 (0x3c5, 0x06, par);
548 549
549 /* now save all the extended regs we need */ 550 /* now save all the extended regs we need */
550 vga_out8 (0x3d4, 0x31, par); 551 vga_out8 (0x3d4, 0x31, par);
551 par->CR31 = vga_in8 (0x3d5, par); 552 reg->CR31 = vga_in8 (0x3d5, par);
552 vga_out8 (0x3d4, 0x32, par); 553 vga_out8 (0x3d4, 0x32, par);
553 par->CR32 = vga_in8 (0x3d5, par); 554 reg->CR32 = vga_in8 (0x3d5, par);
554 vga_out8 (0x3d4, 0x34, par); 555 vga_out8 (0x3d4, 0x34, par);
555 par->CR34 = vga_in8 (0x3d5, par); 556 reg->CR34 = vga_in8 (0x3d5, par);
556 vga_out8 (0x3d4, 0x36, par); 557 vga_out8 (0x3d4, 0x36, par);
557 par->CR36 = vga_in8 (0x3d5, par); 558 reg->CR36 = vga_in8 (0x3d5, par);
558 vga_out8 (0x3d4, 0x3a, par); 559 vga_out8 (0x3d4, 0x3a, par);
559 par->CR3A = vga_in8 (0x3d5, par); 560 reg->CR3A = vga_in8 (0x3d5, par);
560 vga_out8 (0x3d4, 0x40, par); 561 vga_out8 (0x3d4, 0x40, par);
561 par->CR40 = vga_in8 (0x3d5, par); 562 reg->CR40 = vga_in8 (0x3d5, par);
562 vga_out8 (0x3d4, 0x42, par); 563 vga_out8 (0x3d4, 0x42, par);
563 par->CR42 = vga_in8 (0x3d5, par); 564 reg->CR42 = vga_in8 (0x3d5, par);
564 vga_out8 (0x3d4, 0x45, par); 565 vga_out8 (0x3d4, 0x45, par);
565 par->CR45 = vga_in8 (0x3d5, par); 566 reg->CR45 = vga_in8 (0x3d5, par);
566 vga_out8 (0x3d4, 0x50, par); 567 vga_out8 (0x3d4, 0x50, par);
567 par->CR50 = vga_in8 (0x3d5, par); 568 reg->CR50 = vga_in8 (0x3d5, par);
568 vga_out8 (0x3d4, 0x51, par); 569 vga_out8 (0x3d4, 0x51, par);
569 par->CR51 = vga_in8 (0x3d5, par); 570 reg->CR51 = vga_in8 (0x3d5, par);
570 vga_out8 (0x3d4, 0x53, par); 571 vga_out8 (0x3d4, 0x53, par);
571 par->CR53 = vga_in8 (0x3d5, par); 572 reg->CR53 = vga_in8 (0x3d5, par);
572 vga_out8 (0x3d4, 0x58, par); 573 vga_out8 (0x3d4, 0x58, par);
573 par->CR58 = vga_in8 (0x3d5, par); 574 reg->CR58 = vga_in8 (0x3d5, par);
574 vga_out8 (0x3d4, 0x60, par); 575 vga_out8 (0x3d4, 0x60, par);
575 par->CR60 = vga_in8 (0x3d5, par); 576 reg->CR60 = vga_in8 (0x3d5, par);
576 vga_out8 (0x3d4, 0x66, par); 577 vga_out8 (0x3d4, 0x66, par);
577 par->CR66 = vga_in8 (0x3d5, par); 578 reg->CR66 = vga_in8 (0x3d5, par);
578 vga_out8 (0x3d4, 0x67, par); 579 vga_out8 (0x3d4, 0x67, par);
579 par->CR67 = vga_in8 (0x3d5, par); 580 reg->CR67 = vga_in8 (0x3d5, par);
580 vga_out8 (0x3d4, 0x68, par); 581 vga_out8 (0x3d4, 0x68, par);
581 par->CR68 = vga_in8 (0x3d5, par); 582 reg->CR68 = vga_in8 (0x3d5, par);
582 vga_out8 (0x3d4, 0x69, par); 583 vga_out8 (0x3d4, 0x69, par);
583 par->CR69 = vga_in8 (0x3d5, par); 584 reg->CR69 = vga_in8 (0x3d5, par);
584 vga_out8 (0x3d4, 0x6f, par); 585 vga_out8 (0x3d4, 0x6f, par);
585 par->CR6F = vga_in8 (0x3d5, par); 586 reg->CR6F = vga_in8 (0x3d5, par);
586 587
587 vga_out8 (0x3d4, 0x33, par); 588 vga_out8 (0x3d4, 0x33, par);
588 par->CR33 = vga_in8 (0x3d5, par); 589 reg->CR33 = vga_in8 (0x3d5, par);
589 vga_out8 (0x3d4, 0x86, par); 590 vga_out8 (0x3d4, 0x86, par);
590 par->CR86 = vga_in8 (0x3d5, par); 591 reg->CR86 = vga_in8 (0x3d5, par);
591 vga_out8 (0x3d4, 0x88, par); 592 vga_out8 (0x3d4, 0x88, par);
592 par->CR88 = vga_in8 (0x3d5, par); 593 reg->CR88 = vga_in8 (0x3d5, par);
593 vga_out8 (0x3d4, 0x90, par); 594 vga_out8 (0x3d4, 0x90, par);
594 par->CR90 = vga_in8 (0x3d5, par); 595 reg->CR90 = vga_in8 (0x3d5, par);
595 vga_out8 (0x3d4, 0x91, par); 596 vga_out8 (0x3d4, 0x91, par);
596 par->CR91 = vga_in8 (0x3d5, par); 597 reg->CR91 = vga_in8 (0x3d5, par);
597 vga_out8 (0x3d4, 0xb0, par); 598 vga_out8 (0x3d4, 0xb0, par);
598 par->CRB0 = vga_in8 (0x3d5, par) | 0x80; 599 reg->CRB0 = vga_in8 (0x3d5, par) | 0x80;
599 600
600 /* extended mode timing regs */ 601 /* extended mode timing regs */
601 vga_out8 (0x3d4, 0x3b, par); 602 vga_out8 (0x3d4, 0x3b, par);
602 par->CR3B = vga_in8 (0x3d5, par); 603 reg->CR3B = vga_in8 (0x3d5, par);
603 vga_out8 (0x3d4, 0x3c, par); 604 vga_out8 (0x3d4, 0x3c, par);
604 par->CR3C = vga_in8 (0x3d5, par); 605 reg->CR3C = vga_in8 (0x3d5, par);
605 vga_out8 (0x3d4, 0x43, par); 606 vga_out8 (0x3d4, 0x43, par);
606 par->CR43 = vga_in8 (0x3d5, par); 607 reg->CR43 = vga_in8 (0x3d5, par);
607 vga_out8 (0x3d4, 0x5d, par); 608 vga_out8 (0x3d4, 0x5d, par);
608 par->CR5D = vga_in8 (0x3d5, par); 609 reg->CR5D = vga_in8 (0x3d5, par);
609 vga_out8 (0x3d4, 0x5e, par); 610 vga_out8 (0x3d4, 0x5e, par);
610 par->CR5E = vga_in8 (0x3d5, par); 611 reg->CR5E = vga_in8 (0x3d5, par);
611 vga_out8 (0x3d4, 0x65, par); 612 vga_out8 (0x3d4, 0x65, par);
612 par->CR65 = vga_in8 (0x3d5, par); 613 reg->CR65 = vga_in8 (0x3d5, par);
613 614
614 /* save seq extended regs for DCLK PLL programming */ 615 /* save seq extended regs for DCLK PLL programming */
615 vga_out8 (0x3c4, 0x0e, par); 616 vga_out8 (0x3c4, 0x0e, par);
616 par->SR0E = vga_in8 (0x3c5, par); 617 reg->SR0E = vga_in8 (0x3c5, par);
617 vga_out8 (0x3c4, 0x0f, par); 618 vga_out8 (0x3c4, 0x0f, par);
618 par->SR0F = vga_in8 (0x3c5, par); 619 reg->SR0F = vga_in8 (0x3c5, par);
619 vga_out8 (0x3c4, 0x10, par); 620 vga_out8 (0x3c4, 0x10, par);
620 par->SR10 = vga_in8 (0x3c5, par); 621 reg->SR10 = vga_in8 (0x3c5, par);
621 vga_out8 (0x3c4, 0x11, par); 622 vga_out8 (0x3c4, 0x11, par);
622 par->SR11 = vga_in8 (0x3c5, par); 623 reg->SR11 = vga_in8 (0x3c5, par);
623 vga_out8 (0x3c4, 0x12, par); 624 vga_out8 (0x3c4, 0x12, par);
624 par->SR12 = vga_in8 (0x3c5, par); 625 reg->SR12 = vga_in8 (0x3c5, par);
625 vga_out8 (0x3c4, 0x13, par); 626 vga_out8 (0x3c4, 0x13, par);
626 par->SR13 = vga_in8 (0x3c5, par); 627 reg->SR13 = vga_in8 (0x3c5, par);
627 vga_out8 (0x3c4, 0x29, par); 628 vga_out8 (0x3c4, 0x29, par);
628 par->SR29 = vga_in8 (0x3c5, par); 629 reg->SR29 = vga_in8 (0x3c5, par);
629 630
630 vga_out8 (0x3c4, 0x15, par); 631 vga_out8 (0x3c4, 0x15, par);
631 par->SR15 = vga_in8 (0x3c5, par); 632 reg->SR15 = vga_in8 (0x3c5, par);
632 vga_out8 (0x3c4, 0x30, par); 633 vga_out8 (0x3c4, 0x30, par);
633 par->SR30 = vga_in8 (0x3c5, par); 634 reg->SR30 = vga_in8 (0x3c5, par);
634 vga_out8 (0x3c4, 0x18, par); 635 vga_out8 (0x3c4, 0x18, par);
635 par->SR18 = vga_in8 (0x3c5, par); 636 reg->SR18 = vga_in8 (0x3c5, par);
636 637
637 /* Save flat panel expansion regsters. */ 638 /* Save flat panel expansion regsters. */
638 if (par->chip == S3_SAVAGE_MX) { 639 if (par->chip == S3_SAVAGE_MX) {
@@ -640,7 +641,7 @@ static void savage_get_default_par(struct savagefb_par *par)
640 641
641 for (i = 0; i < 8; i++) { 642 for (i = 0; i < 8; i++) {
642 vga_out8 (0x3c4, 0x54+i, par); 643 vga_out8 (0x3c4, 0x54+i, par);
643 par->SR54[i] = vga_in8 (0x3c5, par); 644 reg->SR54[i] = vga_in8 (0x3c5, par);
644 } 645 }
645 } 646 }
646 647
@@ -653,10 +654,10 @@ static void savage_get_default_par(struct savagefb_par *par)
653 654
654 /* now save MIU regs */ 655 /* now save MIU regs */
655 if (par->chip != S3_SAVAGE_MX) { 656 if (par->chip != S3_SAVAGE_MX) {
656 par->MMPR0 = savage_in32(FIFO_CONTROL_REG, par); 657 reg->MMPR0 = savage_in32(FIFO_CONTROL_REG, par);
657 par->MMPR1 = savage_in32(MIU_CONTROL_REG, par); 658 reg->MMPR1 = savage_in32(MIU_CONTROL_REG, par);
658 par->MMPR2 = savage_in32(STREAMS_TIMEOUT_REG, par); 659 reg->MMPR2 = savage_in32(STREAMS_TIMEOUT_REG, par);
659 par->MMPR3 = savage_in32(MISC_TIMEOUT_REG, par); 660 reg->MMPR3 = savage_in32(MISC_TIMEOUT_REG, par);
660 } 661 }
661 662
662 vga_out8 (0x3d4, 0x3a, par); 663 vga_out8 (0x3d4, 0x3a, par);
@@ -789,7 +790,8 @@ static int savagefb_check_var (struct fb_var_screeninfo *var,
789 790
790 791
791static int savagefb_decode_var (struct fb_var_screeninfo *var, 792static int savagefb_decode_var (struct fb_var_screeninfo *var,
792 struct savagefb_par *par) 793 struct savagefb_par *par,
794 struct savage_reg *reg)
793{ 795{
794 struct xtimings timings; 796 struct xtimings timings;
795 int width, dclk, i, j; /*, refresh; */ 797 int width, dclk, i, j; /*, refresh; */
@@ -831,39 +833,39 @@ static int savagefb_decode_var (struct fb_var_screeninfo *var,
831 * This will allocate the datastructure and initialize all of the 833 * This will allocate the datastructure and initialize all of the
832 * generic VGA registers. 834 * generic VGA registers.
833 */ 835 */
834 vgaHWInit (var, par, &timings); 836 vgaHWInit (var, par, &timings, reg);
835 837
836 /* We need to set CR67 whether or not we use the BIOS. */ 838 /* We need to set CR67 whether or not we use the BIOS. */
837 839
838 dclk = timings.Clock; 840 dclk = timings.Clock;
839 par->CR67 = 0x00; 841 reg->CR67 = 0x00;
840 842
841 switch( var->bits_per_pixel ) { 843 switch( var->bits_per_pixel ) {
842 case 8: 844 case 8:
843 if( (par->chip == S3_SAVAGE2000) && (dclk >= 230000) ) 845 if( (par->chip == S3_SAVAGE2000) && (dclk >= 230000) )
844 par->CR67 = 0x10; /* 8bpp, 2 pixels/clock */ 846 reg->CR67 = 0x10; /* 8bpp, 2 pixels/clock */
845 else 847 else
846 par->CR67 = 0x00; /* 8bpp, 1 pixel/clock */ 848 reg->CR67 = 0x00; /* 8bpp, 1 pixel/clock */
847 break; 849 break;
848 case 15: 850 case 15:
849 if ( S3_SAVAGE_MOBILE_SERIES(par->chip) || 851 if ( S3_SAVAGE_MOBILE_SERIES(par->chip) ||
850 ((par->chip == S3_SAVAGE2000) && (dclk >= 230000)) ) 852 ((par->chip == S3_SAVAGE2000) && (dclk >= 230000)) )
851 par->CR67 = 0x30; /* 15bpp, 2 pixel/clock */ 853 reg->CR67 = 0x30; /* 15bpp, 2 pixel/clock */
852 else 854 else
853 par->CR67 = 0x20; /* 15bpp, 1 pixels/clock */ 855 reg->CR67 = 0x20; /* 15bpp, 1 pixels/clock */
854 break; 856 break;
855 case 16: 857 case 16:
856 if( S3_SAVAGE_MOBILE_SERIES(par->chip) || 858 if( S3_SAVAGE_MOBILE_SERIES(par->chip) ||
857 ((par->chip == S3_SAVAGE2000) && (dclk >= 230000)) ) 859 ((par->chip == S3_SAVAGE2000) && (dclk >= 230000)) )
858 par->CR67 = 0x50; /* 16bpp, 2 pixel/clock */ 860 reg->CR67 = 0x50; /* 16bpp, 2 pixel/clock */
859 else 861 else
860 par->CR67 = 0x40; /* 16bpp, 1 pixels/clock */ 862 reg->CR67 = 0x40; /* 16bpp, 1 pixels/clock */
861 break; 863 break;
862 case 24: 864 case 24:
863 par->CR67 = 0x70; 865 reg->CR67 = 0x70;
864 break; 866 break;
865 case 32: 867 case 32:
866 par->CR67 = 0xd0; 868 reg->CR67 = 0xd0;
867 break; 869 break;
868 } 870 }
869 871
@@ -875,58 +877,58 @@ static int savagefb_decode_var (struct fb_var_screeninfo *var,
875 vga_out8 (0x3d4, 0x3a, par); 877 vga_out8 (0x3d4, 0x3a, par);
876 tmp = vga_in8 (0x3d5, par); 878 tmp = vga_in8 (0x3d5, par);
877 if (1 /*FIXME:psav->pci_burst*/) 879 if (1 /*FIXME:psav->pci_burst*/)
878 par->CR3A = (tmp & 0x7f) | 0x15; 880 reg->CR3A = (tmp & 0x7f) | 0x15;
879 else 881 else
880 par->CR3A = tmp | 0x95; 882 reg->CR3A = tmp | 0x95;
881 883
882 par->CR53 = 0x00; 884 reg->CR53 = 0x00;
883 par->CR31 = 0x8c; 885 reg->CR31 = 0x8c;
884 par->CR66 = 0x89; 886 reg->CR66 = 0x89;
885 887
886 vga_out8 (0x3d4, 0x58, par); 888 vga_out8 (0x3d4, 0x58, par);
887 par->CR58 = vga_in8 (0x3d5, par) & 0x80; 889 reg->CR58 = vga_in8 (0x3d5, par) & 0x80;
888 par->CR58 |= 0x13; 890 reg->CR58 |= 0x13;
889 891
890 par->SR15 = 0x03 | 0x80; 892 reg->SR15 = 0x03 | 0x80;
891 par->SR18 = 0x00; 893 reg->SR18 = 0x00;
892 par->CR43 = par->CR45 = par->CR65 = 0x00; 894 reg->CR43 = reg->CR45 = reg->CR65 = 0x00;
893 895
894 vga_out8 (0x3d4, 0x40, par); 896 vga_out8 (0x3d4, 0x40, par);
895 par->CR40 = vga_in8 (0x3d5, par) & ~0x01; 897 reg->CR40 = vga_in8 (0x3d5, par) & ~0x01;
896 898
897 par->MMPR0 = 0x010400; 899 reg->MMPR0 = 0x010400;
898 par->MMPR1 = 0x00; 900 reg->MMPR1 = 0x00;
899 par->MMPR2 = 0x0808; 901 reg->MMPR2 = 0x0808;
900 par->MMPR3 = 0x08080810; 902 reg->MMPR3 = 0x08080810;
901 903
902 SavageCalcClock (dclk, 1, 1, 127, 0, 4, 180000, 360000, &m, &n, &r); 904 SavageCalcClock (dclk, 1, 1, 127, 0, 4, 180000, 360000, &m, &n, &r);
903 /* m = 107; n = 4; r = 2; */ 905 /* m = 107; n = 4; r = 2; */
904 906
905 if (par->MCLK <= 0) { 907 if (par->MCLK <= 0) {
906 par->SR10 = 255; 908 reg->SR10 = 255;
907 par->SR11 = 255; 909 reg->SR11 = 255;
908 } else { 910 } else {
909 common_calc_clock (par->MCLK, 1, 1, 31, 0, 3, 135000, 270000, 911 common_calc_clock (par->MCLK, 1, 1, 31, 0, 3, 135000, 270000,
910 &par->SR11, &par->SR10); 912 &reg->SR11, &reg->SR10);
911 /* par->SR10 = 80; // MCLK == 286000 */ 913 /* reg->SR10 = 80; // MCLK == 286000 */
912 /* par->SR11 = 125; */ 914 /* reg->SR11 = 125; */
913 } 915 }
914 916
915 par->SR12 = (r << 6) | (n & 0x3f); 917 reg->SR12 = (r << 6) | (n & 0x3f);
916 par->SR13 = m & 0xff; 918 reg->SR13 = m & 0xff;
917 par->SR29 = (r & 4) | (m & 0x100) >> 5 | (n & 0x40) >> 2; 919 reg->SR29 = (r & 4) | (m & 0x100) >> 5 | (n & 0x40) >> 2;
918 920
919 if (var->bits_per_pixel < 24) 921 if (var->bits_per_pixel < 24)
920 par->MMPR0 -= 0x8000; 922 reg->MMPR0 -= 0x8000;
921 else 923 else
922 par->MMPR0 -= 0x4000; 924 reg->MMPR0 -= 0x4000;
923 925
924 if (timings.interlaced) 926 if (timings.interlaced)
925 par->CR42 = 0x20; 927 reg->CR42 = 0x20;
926 else 928 else
927 par->CR42 = 0x00; 929 reg->CR42 = 0x00;
928 930
929 par->CR34 = 0x10; /* display fifo */ 931 reg->CR34 = 0x10; /* display fifo */
930 932
931 i = ((((timings.HTotal >> 3) - 5) & 0x100) >> 8) | 933 i = ((((timings.HTotal >> 3) - 5) & 0x100) >> 8) |
932 ((((timings.HDisplay >> 3) - 1) & 0x100) >> 7) | 934 ((((timings.HDisplay >> 3) - 1) & 0x100) >> 7) |
@@ -938,77 +940,77 @@ static int savagefb_decode_var (struct fb_var_screeninfo *var,
938 if ((timings.HSyncEnd >> 3) - (timings.HSyncStart >> 3) > 32) 940 if ((timings.HSyncEnd >> 3) - (timings.HSyncStart >> 3) > 32)
939 i |= 0x20; 941 i |= 0x20;
940 942
941 j = (par->CRTC[0] + ((i & 0x01) << 8) + 943 j = (reg->CRTC[0] + ((i & 0x01) << 8) +
942 par->CRTC[4] + ((i & 0x10) << 4) + 1) / 2; 944 reg->CRTC[4] + ((i & 0x10) << 4) + 1) / 2;
943 945
944 if (j - (par->CRTC[4] + ((i & 0x10) << 4)) < 4) { 946 if (j - (reg->CRTC[4] + ((i & 0x10) << 4)) < 4) {
945 if (par->CRTC[4] + ((i & 0x10) << 4) + 4 <= 947 if (reg->CRTC[4] + ((i & 0x10) << 4) + 4 <=
946 par->CRTC[0] + ((i & 0x01) << 8)) 948 reg->CRTC[0] + ((i & 0x01) << 8))
947 j = par->CRTC[4] + ((i & 0x10) << 4) + 4; 949 j = reg->CRTC[4] + ((i & 0x10) << 4) + 4;
948 else 950 else
949 j = par->CRTC[0] + ((i & 0x01) << 8) + 1; 951 j = reg->CRTC[0] + ((i & 0x01) << 8) + 1;
950 } 952 }
951 953
952 par->CR3B = j & 0xff; 954 reg->CR3B = j & 0xff;
953 i |= (j & 0x100) >> 2; 955 i |= (j & 0x100) >> 2;
954 par->CR3C = (par->CRTC[0] + ((i & 0x01) << 8)) / 2; 956 reg->CR3C = (reg->CRTC[0] + ((i & 0x01) << 8)) / 2;
955 par->CR5D = i; 957 reg->CR5D = i;
956 par->CR5E = (((timings.VTotal - 2) & 0x400) >> 10) | 958 reg->CR5E = (((timings.VTotal - 2) & 0x400) >> 10) |
957 (((timings.VDisplay - 1) & 0x400) >> 9) | 959 (((timings.VDisplay - 1) & 0x400) >> 9) |
958 (((timings.VSyncStart) & 0x400) >> 8) | 960 (((timings.VSyncStart) & 0x400) >> 8) |
959 (((timings.VSyncStart) & 0x400) >> 6) | 0x40; 961 (((timings.VSyncStart) & 0x400) >> 6) | 0x40;
960 width = (var->xres_virtual * ((var->bits_per_pixel+7) / 8)) >> 3; 962 width = (var->xres_virtual * ((var->bits_per_pixel+7) / 8)) >> 3;
961 par->CR91 = par->CRTC[19] = 0xff & width; 963 reg->CR91 = reg->CRTC[19] = 0xff & width;
962 par->CR51 = (0x300 & width) >> 4; 964 reg->CR51 = (0x300 & width) >> 4;
963 par->CR90 = 0x80 | (width >> 8); 965 reg->CR90 = 0x80 | (width >> 8);
964 par->MiscOutReg |= 0x0c; 966 reg->MiscOutReg |= 0x0c;
965 967
966 /* Set frame buffer description. */ 968 /* Set frame buffer description. */
967 969
968 if (var->bits_per_pixel <= 8) 970 if (var->bits_per_pixel <= 8)
969 par->CR50 = 0; 971 reg->CR50 = 0;
970 else if (var->bits_per_pixel <= 16) 972 else if (var->bits_per_pixel <= 16)
971 par->CR50 = 0x10; 973 reg->CR50 = 0x10;
972 else 974 else
973 par->CR50 = 0x30; 975 reg->CR50 = 0x30;
974 976
975 if (var->xres_virtual <= 640) 977 if (var->xres_virtual <= 640)
976 par->CR50 |= 0x40; 978 reg->CR50 |= 0x40;
977 else if (var->xres_virtual == 800) 979 else if (var->xres_virtual == 800)
978 par->CR50 |= 0x80; 980 reg->CR50 |= 0x80;
979 else if (var->xres_virtual == 1024) 981 else if (var->xres_virtual == 1024)
980 par->CR50 |= 0x00; 982 reg->CR50 |= 0x00;
981 else if (var->xres_virtual == 1152) 983 else if (var->xres_virtual == 1152)
982 par->CR50 |= 0x01; 984 reg->CR50 |= 0x01;
983 else if (var->xres_virtual == 1280) 985 else if (var->xres_virtual == 1280)
984 par->CR50 |= 0xc0; 986 reg->CR50 |= 0xc0;
985 else if (var->xres_virtual == 1600) 987 else if (var->xres_virtual == 1600)
986 par->CR50 |= 0x81; 988 reg->CR50 |= 0x81;
987 else 989 else
988 par->CR50 |= 0xc1; /* Use GBD */ 990 reg->CR50 |= 0xc1; /* Use GBD */
989 991
990 if( par->chip == S3_SAVAGE2000 ) 992 if( par->chip == S3_SAVAGE2000 )
991 par->CR33 = 0x08; 993 reg->CR33 = 0x08;
992 else 994 else
993 par->CR33 = 0x20; 995 reg->CR33 = 0x20;
994 996
995 par->CRTC[0x17] = 0xeb; 997 reg->CRTC[0x17] = 0xeb;
996 998
997 par->CR67 |= 1; 999 reg->CR67 |= 1;
998 1000
999 vga_out8(0x3d4, 0x36, par); 1001 vga_out8(0x3d4, 0x36, par);
1000 par->CR36 = vga_in8 (0x3d5, par); 1002 reg->CR36 = vga_in8 (0x3d5, par);
1001 vga_out8 (0x3d4, 0x68, par); 1003 vga_out8 (0x3d4, 0x68, par);
1002 par->CR68 = vga_in8 (0x3d5, par); 1004 reg->CR68 = vga_in8 (0x3d5, par);
1003 par->CR69 = 0; 1005 reg->CR69 = 0;
1004 vga_out8 (0x3d4, 0x6f, par); 1006 vga_out8 (0x3d4, 0x6f, par);
1005 par->CR6F = vga_in8 (0x3d5, par); 1007 reg->CR6F = vga_in8 (0x3d5, par);
1006 vga_out8 (0x3d4, 0x86, par); 1008 vga_out8 (0x3d4, 0x86, par);
1007 par->CR86 = vga_in8 (0x3d5, par); 1009 reg->CR86 = vga_in8 (0x3d5, par);
1008 vga_out8 (0x3d4, 0x88, par); 1010 vga_out8 (0x3d4, 0x88, par);
1009 par->CR88 = vga_in8 (0x3d5, par) | 0x08; 1011 reg->CR88 = vga_in8 (0x3d5, par) | 0x08;
1010 vga_out8 (0x3d4, 0xb0, par); 1012 vga_out8 (0x3d4, 0xb0, par);
1011 par->CRB0 = vga_in8 (0x3d5, par) | 0x80; 1013 reg->CRB0 = vga_in8 (0x3d5, par) | 0x80;
1012 1014
1013 return 0; 1015 return 0;
1014} 1016}
@@ -1075,7 +1077,7 @@ static int savagefb_setcolreg(unsigned regno,
1075 return 0; 1077 return 0;
1076} 1078}
1077 1079
1078static void savagefb_set_par_int (struct savagefb_par *par) 1080static void savagefb_set_par_int (struct savagefb_par *par, struct savage_reg *reg)
1079{ 1081{
1080 unsigned char tmp, cr3a, cr66, cr67; 1082 unsigned char tmp, cr3a, cr66, cr67;
1081 1083
@@ -1110,30 +1112,30 @@ static void savagefb_set_par_int (struct savagefb_par *par)
1110 1112
1111 /* restore extended regs */ 1113 /* restore extended regs */
1112 vga_out8 (0x3d4, 0x66, par); 1114 vga_out8 (0x3d4, 0x66, par);
1113 vga_out8 (0x3d5, par->CR66, par); 1115 vga_out8 (0x3d5, reg->CR66, par);
1114 vga_out8 (0x3d4, 0x3a, par); 1116 vga_out8 (0x3d4, 0x3a, par);
1115 vga_out8 (0x3d5, par->CR3A, par); 1117 vga_out8 (0x3d5, reg->CR3A, par);
1116 vga_out8 (0x3d4, 0x31, par); 1118 vga_out8 (0x3d4, 0x31, par);
1117 vga_out8 (0x3d5, par->CR31, par); 1119 vga_out8 (0x3d5, reg->CR31, par);
1118 vga_out8 (0x3d4, 0x32, par); 1120 vga_out8 (0x3d4, 0x32, par);
1119 vga_out8 (0x3d5, par->CR32, par); 1121 vga_out8 (0x3d5, reg->CR32, par);
1120 vga_out8 (0x3d4, 0x58, par); 1122 vga_out8 (0x3d4, 0x58, par);
1121 vga_out8 (0x3d5, par->CR58, par); 1123 vga_out8 (0x3d5, reg->CR58, par);
1122 vga_out8 (0x3d4, 0x53, par); 1124 vga_out8 (0x3d4, 0x53, par);
1123 vga_out8 (0x3d5, par->CR53 & 0x7f, par); 1125 vga_out8 (0x3d5, reg->CR53 & 0x7f, par);
1124 1126
1125 vga_out16 (0x3c4, 0x0608, par); 1127 vga_out16 (0x3c4, 0x0608, par);
1126 1128
1127 /* Restore DCLK registers. */ 1129 /* Restore DCLK registers. */
1128 1130
1129 vga_out8 (0x3c4, 0x0e, par); 1131 vga_out8 (0x3c4, 0x0e, par);
1130 vga_out8 (0x3c5, par->SR0E, par); 1132 vga_out8 (0x3c5, reg->SR0E, par);
1131 vga_out8 (0x3c4, 0x0f, par); 1133 vga_out8 (0x3c4, 0x0f, par);
1132 vga_out8 (0x3c5, par->SR0F, par); 1134 vga_out8 (0x3c5, reg->SR0F, par);
1133 vga_out8 (0x3c4, 0x29, par); 1135 vga_out8 (0x3c4, 0x29, par);
1134 vga_out8 (0x3c5, par->SR29, par); 1136 vga_out8 (0x3c5, reg->SR29, par);
1135 vga_out8 (0x3c4, 0x15, par); 1137 vga_out8 (0x3c4, 0x15, par);
1136 vga_out8 (0x3c5, par->SR15, par); 1138 vga_out8 (0x3c5, reg->SR15, par);
1137 1139
1138 /* Restore flat panel expansion regsters. */ 1140 /* Restore flat panel expansion regsters. */
1139 if( par->chip == S3_SAVAGE_MX ) { 1141 if( par->chip == S3_SAVAGE_MX ) {
@@ -1141,27 +1143,27 @@ static void savagefb_set_par_int (struct savagefb_par *par)
1141 1143
1142 for( i = 0; i < 8; i++ ) { 1144 for( i = 0; i < 8; i++ ) {
1143 vga_out8 (0x3c4, 0x54+i, par); 1145 vga_out8 (0x3c4, 0x54+i, par);
1144 vga_out8 (0x3c5, par->SR54[i], par); 1146 vga_out8 (0x3c5, reg->SR54[i], par);
1145 } 1147 }
1146 } 1148 }
1147 1149
1148 vgaHWRestore (par); 1150 vgaHWRestore (par, reg);
1149 1151
1150 /* extended mode timing registers */ 1152 /* extended mode timing registers */
1151 vga_out8 (0x3d4, 0x53, par); 1153 vga_out8 (0x3d4, 0x53, par);
1152 vga_out8 (0x3d5, par->CR53, par); 1154 vga_out8 (0x3d5, reg->CR53, par);
1153 vga_out8 (0x3d4, 0x5d, par); 1155 vga_out8 (0x3d4, 0x5d, par);
1154 vga_out8 (0x3d5, par->CR5D, par); 1156 vga_out8 (0x3d5, reg->CR5D, par);
1155 vga_out8 (0x3d4, 0x5e, par); 1157 vga_out8 (0x3d4, 0x5e, par);
1156 vga_out8 (0x3d5, par->CR5E, par); 1158 vga_out8 (0x3d5, reg->CR5E, par);
1157 vga_out8 (0x3d4, 0x3b, par); 1159 vga_out8 (0x3d4, 0x3b, par);
1158 vga_out8 (0x3d5, par->CR3B, par); 1160 vga_out8 (0x3d5, reg->CR3B, par);
1159 vga_out8 (0x3d4, 0x3c, par); 1161 vga_out8 (0x3d4, 0x3c, par);
1160 vga_out8 (0x3d5, par->CR3C, par); 1162 vga_out8 (0x3d5, reg->CR3C, par);
1161 vga_out8 (0x3d4, 0x43, par); 1163 vga_out8 (0x3d4, 0x43, par);
1162 vga_out8 (0x3d5, par->CR43, par); 1164 vga_out8 (0x3d5, reg->CR43, par);
1163 vga_out8 (0x3d4, 0x65, par); 1165 vga_out8 (0x3d4, 0x65, par);
1164 vga_out8 (0x3d5, par->CR65, par); 1166 vga_out8 (0x3d5, reg->CR65, par);
1165 1167
1166 /* restore the desired video mode with cr67 */ 1168 /* restore the desired video mode with cr67 */
1167 vga_out8 (0x3d4, 0x67, par); 1169 vga_out8 (0x3d4, 0x67, par);
@@ -1171,52 +1173,52 @@ static void savagefb_set_par_int (struct savagefb_par *par)
1171 udelay (10000); 1173 udelay (10000);
1172 vga_out8 (0x3d4, 0x67, par); 1174 vga_out8 (0x3d4, 0x67, par);
1173 /* end of part */ 1175 /* end of part */
1174 vga_out8 (0x3d5, par->CR67 & ~0x0c, par); 1176 vga_out8 (0x3d5, reg->CR67 & ~0x0c, par);
1175 1177
1176 /* other mode timing and extended regs */ 1178 /* other mode timing and extended regs */
1177 vga_out8 (0x3d4, 0x34, par); 1179 vga_out8 (0x3d4, 0x34, par);
1178 vga_out8 (0x3d5, par->CR34, par); 1180 vga_out8 (0x3d5, reg->CR34, par);
1179 vga_out8 (0x3d4, 0x40, par); 1181 vga_out8 (0x3d4, 0x40, par);
1180 vga_out8 (0x3d5, par->CR40, par); 1182 vga_out8 (0x3d5, reg->CR40, par);
1181 vga_out8 (0x3d4, 0x42, par); 1183 vga_out8 (0x3d4, 0x42, par);
1182 vga_out8 (0x3d5, par->CR42, par); 1184 vga_out8 (0x3d5, reg->CR42, par);
1183 vga_out8 (0x3d4, 0x45, par); 1185 vga_out8 (0x3d4, 0x45, par);
1184 vga_out8 (0x3d5, par->CR45, par); 1186 vga_out8 (0x3d5, reg->CR45, par);
1185 vga_out8 (0x3d4, 0x50, par); 1187 vga_out8 (0x3d4, 0x50, par);
1186 vga_out8 (0x3d5, par->CR50, par); 1188 vga_out8 (0x3d5, reg->CR50, par);
1187 vga_out8 (0x3d4, 0x51, par); 1189 vga_out8 (0x3d4, 0x51, par);
1188 vga_out8 (0x3d5, par->CR51, par); 1190 vga_out8 (0x3d5, reg->CR51, par);
1189 1191
1190 /* memory timings */ 1192 /* memory timings */
1191 vga_out8 (0x3d4, 0x36, par); 1193 vga_out8 (0x3d4, 0x36, par);
1192 vga_out8 (0x3d5, par->CR36, par); 1194 vga_out8 (0x3d5, reg->CR36, par);
1193 vga_out8 (0x3d4, 0x60, par); 1195 vga_out8 (0x3d4, 0x60, par);
1194 vga_out8 (0x3d5, par->CR60, par); 1196 vga_out8 (0x3d5, reg->CR60, par);
1195 vga_out8 (0x3d4, 0x68, par); 1197 vga_out8 (0x3d4, 0x68, par);
1196 vga_out8 (0x3d5, par->CR68, par); 1198 vga_out8 (0x3d5, reg->CR68, par);
1197 vga_out8 (0x3d4, 0x69, par); 1199 vga_out8 (0x3d4, 0x69, par);
1198 vga_out8 (0x3d5, par->CR69, par); 1200 vga_out8 (0x3d5, reg->CR69, par);
1199 vga_out8 (0x3d4, 0x6f, par); 1201 vga_out8 (0x3d4, 0x6f, par);
1200 vga_out8 (0x3d5, par->CR6F, par); 1202 vga_out8 (0x3d5, reg->CR6F, par);
1201 1203
1202 vga_out8 (0x3d4, 0x33, par); 1204 vga_out8 (0x3d4, 0x33, par);
1203 vga_out8 (0x3d5, par->CR33, par); 1205 vga_out8 (0x3d5, reg->CR33, par);
1204 vga_out8 (0x3d4, 0x86, par); 1206 vga_out8 (0x3d4, 0x86, par);
1205 vga_out8 (0x3d5, par->CR86, par); 1207 vga_out8 (0x3d5, reg->CR86, par);
1206 vga_out8 (0x3d4, 0x88, par); 1208 vga_out8 (0x3d4, 0x88, par);
1207 vga_out8 (0x3d5, par->CR88, par); 1209 vga_out8 (0x3d5, reg->CR88, par);
1208 vga_out8 (0x3d4, 0x90, par); 1210 vga_out8 (0x3d4, 0x90, par);
1209 vga_out8 (0x3d5, par->CR90, par); 1211 vga_out8 (0x3d5, reg->CR90, par);
1210 vga_out8 (0x3d4, 0x91, par); 1212 vga_out8 (0x3d4, 0x91, par);
1211 vga_out8 (0x3d5, par->CR91, par); 1213 vga_out8 (0x3d5, reg->CR91, par);
1212 1214
1213 if (par->chip == S3_SAVAGE4) { 1215 if (par->chip == S3_SAVAGE4) {
1214 vga_out8 (0x3d4, 0xb0, par); 1216 vga_out8 (0x3d4, 0xb0, par);
1215 vga_out8 (0x3d5, par->CRB0, par); 1217 vga_out8 (0x3d5, reg->CRB0, par);
1216 } 1218 }
1217 1219
1218 vga_out8 (0x3d4, 0x32, par); 1220 vga_out8 (0x3d4, 0x32, par);
1219 vga_out8 (0x3d5, par->CR32, par); 1221 vga_out8 (0x3d5, reg->CR32, par);
1220 1222
1221 /* unlock extended seq regs */ 1223 /* unlock extended seq regs */
1222 vga_out8 (0x3c4, 0x08, par); 1224 vga_out8 (0x3c4, 0x08, par);
@@ -1225,27 +1227,27 @@ static void savagefb_set_par_int (struct savagefb_par *par)
1225 /* Restore extended sequencer regs for MCLK. SR10 == 255 indicates 1227 /* Restore extended sequencer regs for MCLK. SR10 == 255 indicates
1226 * that we should leave the default SR10 and SR11 values there. 1228 * that we should leave the default SR10 and SR11 values there.
1227 */ 1229 */
1228 if (par->SR10 != 255) { 1230 if (reg->SR10 != 255) {
1229 vga_out8 (0x3c4, 0x10, par); 1231 vga_out8 (0x3c4, 0x10, par);
1230 vga_out8 (0x3c5, par->SR10, par); 1232 vga_out8 (0x3c5, reg->SR10, par);
1231 vga_out8 (0x3c4, 0x11, par); 1233 vga_out8 (0x3c4, 0x11, par);
1232 vga_out8 (0x3c5, par->SR11, par); 1234 vga_out8 (0x3c5, reg->SR11, par);
1233 } 1235 }
1234 1236
1235 /* restore extended seq regs for dclk */ 1237 /* restore extended seq regs for dclk */
1236 vga_out8 (0x3c4, 0x0e, par); 1238 vga_out8 (0x3c4, 0x0e, par);
1237 vga_out8 (0x3c5, par->SR0E, par); 1239 vga_out8 (0x3c5, reg->SR0E, par);
1238 vga_out8 (0x3c4, 0x0f, par); 1240 vga_out8 (0x3c4, 0x0f, par);
1239 vga_out8 (0x3c5, par->SR0F, par); 1241 vga_out8 (0x3c5, reg->SR0F, par);
1240 vga_out8 (0x3c4, 0x12, par); 1242 vga_out8 (0x3c4, 0x12, par);
1241 vga_out8 (0x3c5, par->SR12, par); 1243 vga_out8 (0x3c5, reg->SR12, par);
1242 vga_out8 (0x3c4, 0x13, par); 1244 vga_out8 (0x3c4, 0x13, par);
1243 vga_out8 (0x3c5, par->SR13, par); 1245 vga_out8 (0x3c5, reg->SR13, par);
1244 vga_out8 (0x3c4, 0x29, par); 1246 vga_out8 (0x3c4, 0x29, par);
1245 vga_out8 (0x3c5, par->SR29, par); 1247 vga_out8 (0x3c5, reg->SR29, par);
1246 1248
1247 vga_out8 (0x3c4, 0x18, par); 1249 vga_out8 (0x3c4, 0x18, par);
1248 vga_out8 (0x3c5, par->SR18, par); 1250 vga_out8 (0x3c5, reg->SR18, par);
1249 1251
1250 /* load new m, n pll values for dclk & mclk */ 1252 /* load new m, n pll values for dclk & mclk */
1251 vga_out8 (0x3c4, 0x15, par); 1253 vga_out8 (0x3c4, 0x15, par);
@@ -1254,18 +1256,18 @@ static void savagefb_set_par_int (struct savagefb_par *par)
1254 vga_out8 (0x3c5, tmp | 0x03, par); 1256 vga_out8 (0x3c5, tmp | 0x03, par);
1255 vga_out8 (0x3c5, tmp | 0x23, par); 1257 vga_out8 (0x3c5, tmp | 0x23, par);
1256 vga_out8 (0x3c5, tmp | 0x03, par); 1258 vga_out8 (0x3c5, tmp | 0x03, par);
1257 vga_out8 (0x3c5, par->SR15, par); 1259 vga_out8 (0x3c5, reg->SR15, par);
1258 udelay (100); 1260 udelay (100);
1259 1261
1260 vga_out8 (0x3c4, 0x30, par); 1262 vga_out8 (0x3c4, 0x30, par);
1261 vga_out8 (0x3c5, par->SR30, par); 1263 vga_out8 (0x3c5, reg->SR30, par);
1262 vga_out8 (0x3c4, 0x08, par); 1264 vga_out8 (0x3c4, 0x08, par);
1263 vga_out8 (0x3c5, par->SR08, par); 1265 vga_out8 (0x3c5, reg->SR08, par);
1264 1266
1265 /* now write out cr67 in full, possibly starting STREAMS */ 1267 /* now write out cr67 in full, possibly starting STREAMS */
1266 VerticalRetraceWait(par); 1268 VerticalRetraceWait(par);
1267 vga_out8 (0x3d4, 0x67, par); 1269 vga_out8 (0x3d4, 0x67, par);
1268 vga_out8 (0x3d5, par->CR67, par); 1270 vga_out8 (0x3d5, reg->CR67, par);
1269 1271
1270 vga_out8 (0x3d4, 0x66, par); 1272 vga_out8 (0x3d4, 0x66, par);
1271 cr66 = vga_in8 (0x3d5, par); 1273 cr66 = vga_in8 (0x3d5, par);
@@ -1276,13 +1278,13 @@ static void savagefb_set_par_int (struct savagefb_par *par)
1276 1278
1277 if (par->chip != S3_SAVAGE_MX) { 1279 if (par->chip != S3_SAVAGE_MX) {
1278 VerticalRetraceWait(par); 1280 VerticalRetraceWait(par);
1279 savage_out32 (FIFO_CONTROL_REG, par->MMPR0, par); 1281 savage_out32 (FIFO_CONTROL_REG, reg->MMPR0, par);
1280 par->SavageWaitIdle (par); 1282 par->SavageWaitIdle (par);
1281 savage_out32 (MIU_CONTROL_REG, par->MMPR1, par); 1283 savage_out32 (MIU_CONTROL_REG, reg->MMPR1, par);
1282 par->SavageWaitIdle (par); 1284 par->SavageWaitIdle (par);
1283 savage_out32 (STREAMS_TIMEOUT_REG, par->MMPR2, par); 1285 savage_out32 (STREAMS_TIMEOUT_REG, reg->MMPR2, par);
1284 par->SavageWaitIdle (par); 1286 par->SavageWaitIdle (par);
1285 savage_out32 (MISC_TIMEOUT_REG, par->MMPR3, par); 1287 savage_out32 (MISC_TIMEOUT_REG, reg->MMPR3, par);
1286 } 1288 }
1287 1289
1288 vga_out8 (0x3d4, 0x66, par); 1290 vga_out8 (0x3d4, 0x66, par);
@@ -1347,7 +1349,7 @@ static int savagefb_set_par (struct fb_info *info)
1347 int err; 1349 int err;
1348 1350
1349 DBG("savagefb_set_par"); 1351 DBG("savagefb_set_par");
1350 err = savagefb_decode_var (var, par); 1352 err = savagefb_decode_var (var, par, &par->state);
1351 if (err) 1353 if (err)
1352 return err; 1354 return err;
1353 1355
@@ -1366,7 +1368,7 @@ static int savagefb_set_par (struct fb_info *info)
1366 par->maxClock = par->dacSpeedBpp; 1368 par->maxClock = par->dacSpeedBpp;
1367 par->minClock = 10000; 1369 par->minClock = 10000;
1368 1370
1369 savagefb_set_par_int (par); 1371 savagefb_set_par_int (par, &par->state);
1370 fb_set_cmap (&info->cmap, info); 1372 fb_set_cmap (&info->cmap, info);
1371 savagefb_set_fix(info); 1373 savagefb_set_fix(info);
1372 savagefb_set_clip(info); 1374 savagefb_set_clip(info);
@@ -1824,7 +1826,8 @@ static int savage_init_hw (struct savagefb_par *par)
1824 par->display_type = DISP_CRT; 1826 par->display_type = DISP_CRT;
1825 } 1827 }
1826 1828
1827 savage_get_default_par (par); 1829 savage_get_default_par (par, &par->state);
1830 par->save = par->state;
1828 1831
1829 if( S3_SAVAGE4_SERIES(par->chip) ) { 1832 if( S3_SAVAGE4_SERIES(par->chip) ) {
1830 /* 1833 /*