?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
spi-topcliff-pch: add recovery processing in case wait-event timeout
[zen-stable.git] / drivers / staging / xgifb / vb_setmode.c
blob67a316c3c1087c844f82ec7201fed06e3d38b580
1
2 #include <linux/io.h>
3 #include <linux/delay.h>
4 #include <linux/types.h>
5 #include "XGIfb.h"
6
7
8 #include "vb_def.h"
9 #include "vgatypes.h"
10 #include "vb_struct.h"
11 #include "vb_init.h"
12 #include "vb_util.h"
13 #include "vb_table.h"
14 #include "vb_setmode.h"
15
16
17 #define IndexMask 0xff
18
19 static const unsigned short XGINew_MDA_DAC[] = {
20 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
21 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15,
22 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15,
23 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
24 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
25 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15,
26 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15,
27 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F};
28
29 static const unsigned short XGINew_CGA_DAC[] = {
30 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x09, 0x15,
31 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x09, 0x15,
32 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F,
33 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F,
34 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x09, 0x15,
35 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x09, 0x15,
36 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F,
37 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F};
38
39 static const unsigned short XGINew_EGA_DAC[] = {
40 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x05, 0x15,
41 0x20, 0x30, 0x24, 0x34, 0x21, 0x31, 0x25, 0x35,
42 0x08, 0x18, 0x0C, 0x1C, 0x09, 0x19, 0x0D, 0x1D,
43 0x28, 0x38, 0x2C, 0x3C, 0x29, 0x39, 0x2D, 0x3D,
44 0x02, 0x12, 0x06, 0x16, 0x03, 0x13, 0x07, 0x17,
45 0x22, 0x32, 0x26, 0x36, 0x23, 0x33, 0x27, 0x37,
46 0x0A, 0x1A, 0x0E, 0x1E, 0x0B, 0x1B, 0x0F, 0x1F,
47 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F};
48
49 static const unsigned short XGINew_VGA_DAC[] = {
50 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x09, 0x15,
51 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F,
52 0x00, 0x05, 0x08, 0x0B, 0x0E, 0x11, 0x14, 0x18,
53 0x1C, 0x20, 0x24, 0x28, 0x2D, 0x32, 0x38, 0x3F,
54 0x00, 0x10, 0x1F, 0x2F, 0x3F, 0x1F, 0x27, 0x2F,
55 0x37, 0x3F, 0x2D, 0x31, 0x36, 0x3A, 0x3F, 0x00,
56 0x07, 0x0E, 0x15, 0x1C, 0x0E, 0x11, 0x15, 0x18,
57 0x1C, 0x14, 0x16, 0x18, 0x1A, 0x1C, 0x00, 0x04,
58 0x08, 0x0C, 0x10, 0x08, 0x0A, 0x0C, 0x0E, 0x10,
59 0x0B, 0x0C, 0x0D, 0x0F, 0x10};
60
61 void InitTo330Pointer(unsigned char ChipType, struct vb_device_info *pVBInfo)
62 {
63 pVBInfo->SModeIDTable = (struct XGI_StStruct *) XGI330_SModeIDTable;
64 pVBInfo->StandTable = (struct XGI_StandTableStruct *) XGI330_StandTable;
65 pVBInfo->EModeIDTable = (struct XGI_ExtStruct *) XGI330_EModeIDTable;
66 pVBInfo->RefIndex = (struct XGI_Ext2Struct *) XGI330_RefIndex;
67 pVBInfo->XGINEWUB_CRT1Table
68 = (struct XGI_CRT1TableStruct *) XGI_CRT1Table;
69
70 pVBInfo->MCLKData = (struct XGI_MCLKDataStruct *) XGI340New_MCLKData;
71 pVBInfo->ECLKData = (struct XGI_ECLKDataStruct *) XGI340_ECLKData;
72 pVBInfo->VCLKData = (struct XGI_VCLKDataStruct *) XGI_VCLKData;
73 pVBInfo->VBVCLKData = (struct XGI_VBVCLKDataStruct *) XGI_VBVCLKData;
74 pVBInfo->ScreenOffset = XGI330_ScreenOffset;
75 pVBInfo->StResInfo = (struct XGI_StResInfoStruct *) XGI330_StResInfo;
76 pVBInfo->ModeResInfo
77 = (struct XGI_ModeResInfoStruct *) XGI330_ModeResInfo;
78
79 pVBInfo->pOutputSelect = &XGI330_OutputSelect;
80 pVBInfo->pSoftSetting = &XGI330_SoftSetting;
81 pVBInfo->pSR07 = &XGI330_SR07;
82 pVBInfo->LCDResInfo = 0;
83 pVBInfo->LCDTypeInfo = 0;
84 pVBInfo->LCDInfo = 0;
85 pVBInfo->VBInfo = 0;
86 pVBInfo->TVInfo = 0;
87
88 pVBInfo->SR15 = XGI340_SR13;
89 pVBInfo->CR40 = XGI340_cr41;
90 pVBInfo->SR25 = XGI330_sr25;
91 pVBInfo->pSR31 = &XGI330_sr31;
92 pVBInfo->pSR32 = &XGI330_sr32;
93 pVBInfo->CR6B = XGI340_CR6B;
94 pVBInfo->CR6E = XGI340_CR6E;
95 pVBInfo->CR6F = XGI340_CR6F;
96 pVBInfo->CR89 = XGI340_CR89;
97 pVBInfo->AGPReg = XGI340_AGPReg;
98 pVBInfo->SR16 = XGI340_SR16;
99 pVBInfo->pCRCF = &XG40_CRCF;
100 pVBInfo->pXGINew_DRAMTypeDefinition = &XG40_DRAMTypeDefinition;
101
102 pVBInfo->CR49 = XGI330_CR49;
103 pVBInfo->pSR1F = &XGI330_SR1F;
104 pVBInfo->pSR21 = &XGI330_SR21;
105 pVBInfo->pSR22 = &XGI330_SR22;
106 pVBInfo->pSR23 = &XGI330_SR23;
107 pVBInfo->pSR24 = &XGI330_SR24;
108 pVBInfo->pSR33 = &XGI330_SR33;
109
110 pVBInfo->pCRT2Data_1_2 = &XGI330_CRT2Data_1_2;
111 pVBInfo->pCRT2Data_4_D = &XGI330_CRT2Data_4_D;
112 pVBInfo->pCRT2Data_4_E = &XGI330_CRT2Data_4_E;
113 pVBInfo->pCRT2Data_4_10 = &XGI330_CRT2Data_4_10;
114 pVBInfo->pRGBSenseData = &XGI330_RGBSenseData;
115 pVBInfo->pVideoSenseData = &XGI330_VideoSenseData;
116 pVBInfo->pYCSenseData = &XGI330_YCSenseData;
117 pVBInfo->pRGBSenseData2 = &XGI330_RGBSenseData2;
118 pVBInfo->pVideoSenseData2 = &XGI330_VideoSenseData2;
119 pVBInfo->pYCSenseData2 = &XGI330_YCSenseData2;
120
121 pVBInfo->NTSCTiming = XGI330_NTSCTiming;
122 pVBInfo->PALTiming = XGI330_PALTiming;
123 pVBInfo->HiTVExtTiming = XGI330_HiTVExtTiming;
124 pVBInfo->HiTVSt1Timing = XGI330_HiTVSt1Timing;
125 pVBInfo->HiTVSt2Timing = XGI330_HiTVSt2Timing;
126 pVBInfo->HiTVTextTiming = XGI330_HiTVTextTiming;
127 pVBInfo->YPbPr750pTiming = XGI330_YPbPr750pTiming;
128 pVBInfo->YPbPr525pTiming = XGI330_YPbPr525pTiming;
129 pVBInfo->YPbPr525iTiming = XGI330_YPbPr525iTiming;
130 pVBInfo->HiTVGroup3Data = XGI330_HiTVGroup3Data;
131 pVBInfo->HiTVGroup3Simu = XGI330_HiTVGroup3Simu;
132 pVBInfo->HiTVGroup3Text = XGI330_HiTVGroup3Text;
133 pVBInfo->Ren525pGroup3 = XGI330_Ren525pGroup3;
134 pVBInfo->Ren750pGroup3 = XGI330_Ren750pGroup3;
135
136 pVBInfo->TimingH = (struct XGI_TimingHStruct *) XGI_TimingH;
137 pVBInfo->TimingV = (struct XGI_TimingVStruct *) XGI_TimingV;
138 pVBInfo->UpdateCRT1 = (struct XGI_XG21CRT1Struct *) XGI_UpdateCRT1Table;
139
140 /* 310 customization related */
141 if ((pVBInfo->VBType & VB_XGI301LV) || (pVBInfo->VBType & VB_XGI302LV))
142 pVBInfo->LCDCapList = XGI_LCDDLCapList;
143 else
144 pVBInfo->LCDCapList = XGI_LCDCapList;
145
146 pVBInfo->XGI_TVDelayList = XGI301TVDelayList;
147 pVBInfo->XGI_TVDelayList2 = XGI301TVDelayList2;
148
149 pVBInfo->pXGINew_I2CDefinition = &XG40_I2CDefinition;
150
151 if (ChipType >= XG20)
152 pVBInfo->pXGINew_CR97 = &XG20_CR97;
153
154 if (ChipType == XG27) {
155 pVBInfo->MCLKData
156 = (struct XGI_MCLKDataStruct *) XGI27New_MCLKData;
157 pVBInfo->CR40 = XGI27_cr41;
158 pVBInfo->pXGINew_CR97 = &XG27_CR97;
159 pVBInfo->pSR36 = &XG27_SR36;
160 pVBInfo->pCR8F = &XG27_CR8F;
161 pVBInfo->pCRD0 = XG27_CRD0;
162 pVBInfo->pCRDE = XG27_CRDE;
163 pVBInfo->pSR40 = &XG27_SR40;
164 pVBInfo->pSR41 = &XG27_SR41;
165
166 }
167
168 if (ChipType >= XG20) {
169 pVBInfo->pDVOSetting = &XG21_DVOSetting;
170 pVBInfo->pCR2E = &XG21_CR2E;
171 pVBInfo->pCR2F = &XG21_CR2F;
172 pVBInfo->pCR46 = &XG21_CR46;
173 pVBInfo->pCR47 = &XG21_CR47;
174 }
175
176 }
177
178 static unsigned char XGI_GetModePtr(unsigned short ModeNo,
179 unsigned short ModeIdIndex,
180 struct vb_device_info *pVBInfo)
181 {
182 unsigned char index;
183
184 if (ModeNo <= 0x13)
185 index = pVBInfo->SModeIDTable[ModeIdIndex].St_StTableIndex;
186 else {
187 if (pVBInfo->ModeType <= 0x02)
188 index = 0x1B; /* 02 -> ModeEGA */
189 else
190 index = 0x0F;
191 }
192 return index; /* Get pVBInfo->StandTable index */
193 }
194
195 static void XGI_SetSeqRegs(unsigned short ModeNo,
196 unsigned short StandTableIndex,
197 unsigned short ModeIdIndex,
198 struct vb_device_info *pVBInfo)
199 {
200 unsigned char tempah, SRdata;
201 unsigned short i, modeflag;
202
203 if (ModeNo <= 0x13)
204 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
205 else
206 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
207
208 xgifb_reg_set(pVBInfo->P3c4, 0x00, 0x03); /* Set SR0 */
209 tempah = pVBInfo->StandTable[StandTableIndex].SR[0];
210
211 i = SetCRT2ToLCDA;
212 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
213 tempah |= 0x01;
214 } else {
215 if (pVBInfo->VBInfo & (SetCRT2ToTV | SetCRT2ToLCD)) {
216 if (pVBInfo->VBInfo & SetInSlaveMode)
217 tempah |= 0x01;
218 }
219 }
220
221 tempah |= 0x20; /* screen off */
222 xgifb_reg_set(pVBInfo->P3c4, 0x01, tempah); /* Set SR1 */
223
224 for (i = 02; i <= 04; i++) {
225 /* Get SR2,3,4 from file */
226 SRdata = pVBInfo->StandTable[StandTableIndex].SR[i - 1];
227 xgifb_reg_set(pVBInfo->P3c4, i, SRdata); /* Set SR2 3 4 */
228 }
229 }
230
231 static void XGI_SetCRTCRegs(struct xgi_hw_device_info *HwDeviceExtension,
232 unsigned short StandTableIndex,
233 struct vb_device_info *pVBInfo)
234 {
235 unsigned char CRTCdata;
236 unsigned short i;
237
238 CRTCdata = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x11);
239 CRTCdata &= 0x7f;
240 xgifb_reg_set(pVBInfo->P3d4, 0x11, CRTCdata); /* Unlock CRTC */
241
242 for (i = 0; i <= 0x18; i++) {
243 /* Get CRTC from file */
244 CRTCdata = pVBInfo->StandTable[StandTableIndex].CRTC[i];
245 xgifb_reg_set(pVBInfo->P3d4, i, CRTCdata); /* Set CRTC(3d4) */
246 }
247 }
248
249 static void XGI_SetATTRegs(unsigned short ModeNo,
250 unsigned short StandTableIndex,
251 unsigned short ModeIdIndex,
252 struct vb_device_info *pVBInfo)
253 {
254 unsigned char ARdata;
255 unsigned short i, modeflag;
256
257 if (ModeNo <= 0x13)
258 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
259 else
260 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
261
262 for (i = 0; i <= 0x13; i++) {
263 ARdata = pVBInfo->StandTable[StandTableIndex].ATTR[i];
264 if (modeflag & Charx8Dot) { /* ifndef Dot9 */
265 if (i == 0x13) {
266 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
267 ARdata = 0;
268 } else {
269 if (pVBInfo->VBInfo & (SetCRT2ToTV
270 | SetCRT2ToLCD)) {
271 if (pVBInfo->VBInfo &
272 SetInSlaveMode)
273 ARdata = 0;
274 }
275 }
276 }
277 }
278
279 inb(pVBInfo->P3da); /* reset 3da */
280 outb(i, pVBInfo->P3c0); /* set index */
281 outb(ARdata, pVBInfo->P3c0); /* set data */
282 }
283
284 inb(pVBInfo->P3da); /* reset 3da */
285 outb(0x14, pVBInfo->P3c0); /* set index */
286 outb(0x00, pVBInfo->P3c0); /* set data */
287 inb(pVBInfo->P3da); /* Enable Attribute */
288 outb(0x20, pVBInfo->P3c0);
289 }
290
291 static void XGI_SetGRCRegs(unsigned short StandTableIndex,
292 struct vb_device_info *pVBInfo)
293 {
294 unsigned char GRdata;
295 unsigned short i;
296
297 for (i = 0; i <= 0x08; i++) {
298 /* Get GR from file */
299 GRdata = pVBInfo->StandTable[StandTableIndex].GRC[i];
300 xgifb_reg_set(pVBInfo->P3ce, i, GRdata); /* Set GR(3ce) */
301 }
302
303 if (pVBInfo->ModeType > ModeVGA) {
304 GRdata = (unsigned char) xgifb_reg_get(pVBInfo->P3ce, 0x05);
305 GRdata &= 0xBF; /* 256 color disable */
306 xgifb_reg_set(pVBInfo->P3ce, 0x05, GRdata);
307 }
308 }
309
310 static void XGI_ClearExt1Regs(struct vb_device_info *pVBInfo)
311 {
312 unsigned short i;
313
314 for (i = 0x0A; i <= 0x0E; i++)
315 xgifb_reg_set(pVBInfo->P3c4, i, 0x00); /* Clear SR0A-SR0E */
316 }
317
318 static unsigned char XGI_SetDefaultVCLK(struct vb_device_info *pVBInfo)
319 {
320
321 xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, 0x20);
322 xgifb_reg_set(pVBInfo->P3c4, 0x2B, pVBInfo->VCLKData[0].SR2B);
323 xgifb_reg_set(pVBInfo->P3c4, 0x2C, pVBInfo->VCLKData[0].SR2C);
324
325 xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, 0x10);
326 xgifb_reg_set(pVBInfo->P3c4, 0x2B, pVBInfo->VCLKData[1].SR2B);
327 xgifb_reg_set(pVBInfo->P3c4, 0x2C, pVBInfo->VCLKData[1].SR2C);
328
329 xgifb_reg_and(pVBInfo->P3c4, 0x31, ~0x30);
330 return 0;
331 }
332
333 static unsigned char XGI_AjustCRT2Rate(unsigned short ModeNo,
334 unsigned short ModeIdIndex,
335 unsigned short RefreshRateTableIndex, unsigned short *i,
336 struct vb_device_info *pVBInfo)
337 {
338 unsigned short tempax, tempbx, resinfo, modeflag, infoflag;
339
340 if (ModeNo <= 0x13)
341 /* si+St_ModeFlag */
342 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
343 else
344 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
345
346 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
347 tempbx = pVBInfo->RefIndex[RefreshRateTableIndex + (*i)].ModeID;
348 tempax = 0;
349
350 if (pVBInfo->IF_DEF_LVDS == 0) {
351 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
352 tempax |= SupportRAMDAC2;
353
354 if (pVBInfo->VBType & VB_XGI301C)
355 tempax |= SupportCRT2in301C;
356 }
357
358 /* 301b */
359 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
360 tempax |= SupportLCD;
361
362 if (pVBInfo->LCDResInfo != Panel1280x1024) {
363 if (pVBInfo->LCDResInfo != Panel1280x960) {
364 if (pVBInfo->LCDInfo &
365 LCDNonExpanding) {
366 if (resinfo >= 9) {
367 tempax = 0;
368 return 0;
369 }
370 }
371 }
372 }
373 }
374
375 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) { /* for HiTV */
376 if ((pVBInfo->VBType & VB_XGI301LV) &&
377 (pVBInfo->VBExtInfo == VB_YPbPr1080i)) {
378 tempax |= SupportYPbPr;
379 if (pVBInfo->VBInfo & SetInSlaveMode) {
380 if (resinfo == 4)
381 return 0;
382
383 if (resinfo == 3)
384 return 0;
385
386 if (resinfo > 7)
387 return 0;
388 }
389 } else {
390 tempax |= SupportHiVisionTV;
391 if (pVBInfo->VBInfo & SetInSlaveMode) {
392 if (resinfo == 4)
393 return 0;
394
395 if (resinfo == 3) {
396 if (pVBInfo->SetFlag
397 & TVSimuMode)
398 return 0;
399 }
400
401 if (resinfo > 7)
402 return 0;
403 }
404 }
405 } else {
406 if (pVBInfo->VBInfo & (SetCRT2ToAVIDEO |
407 SetCRT2ToSVIDEO |
408 SetCRT2ToSCART |
409 SetCRT2ToYPbPr |
410 SetCRT2ToHiVisionTV)) {
411 tempax |= SupportTV;
412
413 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B
414 | VB_XGI301LV | VB_XGI302LV
415 | VB_XGI301C)) {
416 tempax |= SupportTV1024;
417 }
418
419 if (!(pVBInfo->VBInfo & SetPALTV)) {
420 if (modeflag & NoSupportSimuTV) {
421 if (pVBInfo->VBInfo &
422 SetInSlaveMode) {
423 if (!(pVBInfo->VBInfo &
424 SetNotSimuMode)) {
425 return 0;
426 }
427 }
428 }
429 }
430 }
431 }
432 } else { /* for LVDS */
433 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
434 tempax |= SupportLCD;
435
436 if (resinfo > 0x08)
437 return 0; /* 1024x768 */
438
439 if (pVBInfo->LCDResInfo < Panel1024x768) {
440 if (resinfo > 0x07)
441 return 0; /* 800x600 */
442
443 if (resinfo == 0x04)
444 return 0; /* 512x384 */
445 }
446 }
447 }
448
449 for (; pVBInfo->RefIndex[RefreshRateTableIndex + (*i)].ModeID ==
450 tempbx; (*i)--) {
451 infoflag = pVBInfo->RefIndex[RefreshRateTableIndex + (*i)].
452 Ext_InfoFlag;
453 if (infoflag & tempax)
454 return 1;
455
456 if ((*i) == 0)
457 break;
458 }
459
460 for ((*i) = 0;; (*i)++) {
461 infoflag = pVBInfo->RefIndex[RefreshRateTableIndex + (*i)].
462 Ext_InfoFlag;
463 if (pVBInfo->RefIndex[RefreshRateTableIndex + (*i)].ModeID
464 != tempbx) {
465 return 0;
466 }
467
468 if (infoflag & tempax)
469 return 1;
470 }
471 return 1;
472 }
473
474 static void XGI_SetSync(unsigned short RefreshRateTableIndex,
475 struct vb_device_info *pVBInfo)
476 {
477 unsigned short sync, temp;
478
479 /* di+0x00 */
480 sync = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_InfoFlag >> 8;
481 sync &= 0xC0;
482 temp = 0x2F;
483 temp |= sync;
484 outb(temp, pVBInfo->P3c2); /* Set Misc(3c2) */
485 }
486
487 static void XGI_SetCRT1Timing_H(struct vb_device_info *pVBInfo,
488 struct xgi_hw_device_info *HwDeviceExtension)
489 {
490 unsigned char data, data1, pushax;
491 unsigned short i, j;
492
493 /* unlock cr0-7 */
494 data = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x11);
495 data &= 0x7F;
496 xgifb_reg_set(pVBInfo->P3d4, 0x11, data);
497
498 data = pVBInfo->TimingH[0].data[0];
499 xgifb_reg_set(pVBInfo->P3d4, 0, data);
500
501 for (i = 0x01; i <= 0x04; i++) {
502 data = pVBInfo->TimingH[0].data[i];
503 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 1), data);
504 }
505
506 for (i = 0x05; i <= 0x06; i++) {
507 data = pVBInfo->TimingH[0].data[i];
508 xgifb_reg_set(pVBInfo->P3c4, (unsigned short) (i + 6), data);
509 }
510
511 j = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x0e);
512 j &= 0x1F;
513 data = pVBInfo->TimingH[0].data[7];
514 data &= 0xE0;
515 data |= j;
516 xgifb_reg_set(pVBInfo->P3c4, 0x0e, data);
517
518 if (HwDeviceExtension->jChipType >= XG20) {
519 data = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x04);
520 data = data - 1;
521 xgifb_reg_set(pVBInfo->P3d4, 0x04, data);
522 data = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x05);
523 data1 = data;
524 data1 &= 0xE0;
525 data &= 0x1F;
526 if (data == 0) {
527 pushax = data;
528 data = (unsigned char) xgifb_reg_get(pVBInfo->P3c4,
529 0x0c);
530 data &= 0xFB;
531 xgifb_reg_set(pVBInfo->P3c4, 0x0c, data);
532 data = pushax;
533 }
534 data = data - 1;
535 data |= data1;
536 xgifb_reg_set(pVBInfo->P3d4, 0x05, data);
537 data = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x0e);
538 data = data >> 5;
539 data = data + 3;
540 if (data > 7)
541 data = data - 7;
542 data = data << 5;
543 xgifb_reg_and_or(pVBInfo->P3c4, 0x0e, ~0xE0, data);
544 }
545 }
546
547 static void XGI_SetCRT1Timing_V(unsigned short ModeIdIndex,
548 unsigned short ModeNo,
549 struct vb_device_info *pVBInfo)
550 {
551 unsigned char data;
552 unsigned short i, j;
553
554 for (i = 0x00; i <= 0x01; i++) {
555 data = pVBInfo->TimingV[0].data[i];
556 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 6), data);
557 }
558
559 for (i = 0x02; i <= 0x03; i++) {
560 data = pVBInfo->TimingV[0].data[i];
561 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 0x0e), data);
562 }
563
564 for (i = 0x04; i <= 0x05; i++) {
565 data = pVBInfo->TimingV[0].data[i];
566 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 0x11), data);
567 }
568
569 j = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x0a);
570 j &= 0xC0;
571 data = pVBInfo->TimingV[0].data[6];
572 data &= 0x3F;
573 data |= j;
574 xgifb_reg_set(pVBInfo->P3c4, 0x0a, data);
575
576 data = pVBInfo->TimingV[0].data[6];
577 data &= 0x80;
578 data = data >> 2;
579
580 if (ModeNo <= 0x13)
581 i = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
582 else
583 i = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
584
585 i &= DoubleScanMode;
586 if (i)
587 data |= 0x80;
588
589 j = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x09);
590 j &= 0x5F;
591 data |= j;
592 xgifb_reg_set(pVBInfo->P3d4, 0x09, data);
593 }
594
595 static void XGI_SetCRT1CRTC(unsigned short ModeNo, unsigned short ModeIdIndex,
596 unsigned short RefreshRateTableIndex,
597 struct vb_device_info *pVBInfo,
598 struct xgi_hw_device_info *HwDeviceExtension)
599 {
600 unsigned char index, data;
601 unsigned short i;
602
603 /* Get index */
604 index = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
605 index = index & IndexMask;
606
607 data = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x11);
608 data &= 0x7F;
609 xgifb_reg_set(pVBInfo->P3d4, 0x11, data); /* Unlock CRTC */
610
611 for (i = 0; i < 8; i++)
612 pVBInfo->TimingH[0].data[i]
613 = pVBInfo->XGINEWUB_CRT1Table[index].CR[i];
614
615 for (i = 0; i < 7; i++)
616 pVBInfo->TimingV[0].data[i]
617 = pVBInfo->XGINEWUB_CRT1Table[index].CR[i + 8];
618
619 XGI_SetCRT1Timing_H(pVBInfo, HwDeviceExtension);
620
621 XGI_SetCRT1Timing_V(ModeIdIndex, ModeNo, pVBInfo);
622
623 if (pVBInfo->ModeType > 0x03)
624 xgifb_reg_set(pVBInfo->P3d4, 0x14, 0x4F);
625 }
626
627 /* --------------------------------------------------------------------- */
628 /* Function : XGI_SetXG21CRTC */
629 /* Input : Stand or enhance CRTC table */
630 /* Output : Fill CRT Hsync/Vsync to SR2E/SR2F/SR30/SR33/SR34/SR3F */
631 /* Description : Set LCD timing */
632 /* --------------------------------------------------------------------- */
633 static void XGI_SetXG21CRTC(unsigned short ModeNo, unsigned short ModeIdIndex,
634 unsigned short RefreshRateTableIndex,
635 struct vb_device_info *pVBInfo)
636 {
637 unsigned char StandTableIndex, index, Tempax, Tempbx, Tempcx, Tempdx;
638 unsigned short Temp1, Temp2, Temp3;
639
640 if (ModeNo <= 0x13) {
641 StandTableIndex = XGI_GetModePtr(ModeNo, ModeIdIndex, pVBInfo);
642 /* CR04 HRS */
643 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[4];
644 /* SR2E [7:0]->HRS */
645 xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax);
646 /* Tempbx: CR05 HRE */
647 Tempbx = pVBInfo->StandTable[StandTableIndex].CRTC[5];
648 Tempbx &= 0x1F; /* Tempbx: HRE[4:0] */
649 Tempcx = Tempax;
650 Tempcx &= 0xE0; /* Tempcx: HRS[7:5] */
651 Tempdx = Tempcx | Tempbx; /* Tempdx(HRE): HRS[7:5]HRE[4:0] */
652 if (Tempbx < (Tempax & 0x1F)) /* IF HRE < HRS */
653 Tempdx |= 0x20; /* Tempdx: HRE = HRE + 0x20 */
654 Tempdx <<= 2; /* Tempdx << 2 */
655 /* SR2F [7:2]->HRE */
656 xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempdx);
657 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00);
658
659 /* Tempax: CR16 VRS */
660 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[16];
661 Tempbx = Tempax; /* Tempbx=Tempax */
662 Tempax &= 0x01; /* Tempax: VRS[0] */
663 xgifb_reg_or(pVBInfo->P3c4, 0x33, Tempax); /* SR33[0]->VRS */
664
665 /* Tempax: CR7 VRS */
666 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[7];
667 Tempdx = Tempbx >> 1; /* Tempdx: VRS[7:1] */
668 Tempcx = Tempax & 0x04; /* Tempcx: CR7[2] */
669 Tempcx <<= 5; /* Tempcx[7]: VRS[8] */
670 Tempdx |= Tempcx; /* Tempdx: VRS[8:1] */
671 /* SR34[7:0]: VRS[8:1] */
672 xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempdx);
673
674 /* Temp1[8]: VRS[8] unsigned char -> unsigned short */
675 Temp1 = Tempcx << 1;
676 Temp1 |= Tempbx; /* Temp1[8:0]: VRS[8:0] */
677 Tempax &= 0x80; /* Tempax[7]: CR7[7] */
678 Temp2 = Tempax << 2; /* Temp2[9]: VRS[9] */
679 Temp1 |= Temp2; /* Temp1[9:0]: VRS[9:0] */
680
681 /* CR16 VRE */
682 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[17];
683 Tempax &= 0x0F; /* Tempax[3:0]: VRE[3:0] */
684 Temp2 = Temp1 & 0x3F0; /* Temp2[9:4]: VRS[9:4] */
685 Temp2 |= Tempax; /* Temp2[9:0]: VRE[9:0] */
686 Temp3 = Temp1 & 0x0F; /* Temp3[3:0]: VRS[3:0] */
687 if (Tempax < Temp3) /* VRE[3:0]<VRS[3:0] */
688 Temp2 |= 0x10; /* Temp2: VRE + 0x10 */
689 Temp2 &= 0xFF; /* Temp2[7:0]: VRE[7:0] */
690 Tempax = (unsigned char) Temp2; /* Tempax[7:0]: VRE[7:0] */
691 Tempax <<= 2; /* Tempax << 2: VRE[5:0] */
692 Temp1 &= 0x600; /* Temp1[10:9]: VRS[10:9] */
693 Temp1 >>= 9; /* [10:9]->[1:0] */
694 Tempbx = (unsigned char) Temp1; /* Tempbx[1:0]: VRS[10:9] */
695 Tempax |= Tempbx; /* VRE[5:0]VRS[10:9] */
696 Tempax &= 0x7F;
697 /* SR3F D[7:2]->VRE D[1:0]->VRS */
698 xgifb_reg_set(pVBInfo->P3c4, 0x3F, Tempax);
699 } else {
700 index = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
701 /* Tempax: CR4 HRS */
702 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[3];
703 Tempcx = Tempax; /* Tempcx: HRS */
704 /* SR2E[7:0]->HRS */
705 xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax);
706
707 Tempdx = pVBInfo->XGINEWUB_CRT1Table[index].CR[5]; /* SRB */
708 Tempdx &= 0xC0; /* Tempdx[7:6]: SRB[7:6] */
709 Temp1 = Tempdx; /* Temp1[7:6]: HRS[9:8] */
710 Temp1 <<= 2; /* Temp1[9:8]: HRS[9:8] */
711 Temp1 |= Tempax; /* Temp1[9:0]: HRS[9:0] */
712
713 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[4]; /* CR5 HRE */
714 Tempax &= 0x1F; /* Tempax[4:0]: HRE[4:0] */
715
716 Tempbx = pVBInfo->XGINEWUB_CRT1Table[index].CR[6]; /* SRC */
717 Tempbx &= 0x04; /* Tempbx[2]: HRE[5] */
718 Tempbx <<= 3; /* Tempbx[5]: HRE[5] */
719 Tempax |= Tempbx; /* Tempax[5:0]: HRE[5:0] */
720
721 Temp2 = Temp1 & 0x3C0; /* Temp2[9:6]: HRS[9:6] */
722 Temp2 |= Tempax; /* Temp2[9:0]: HRE[9:0] */
723
724 Tempcx &= 0x3F; /* Tempcx[5:0]: HRS[5:0] */
725 if (Tempax < Tempcx) /* HRE < HRS */
726 Temp2 |= 0x40; /* Temp2 + 0x40 */
727
728 Temp2 &= 0xFF;
729 Tempax = (unsigned char) Temp2; /* Tempax: HRE[7:0] */
730 Tempax <<= 2; /* Tempax[7:2]: HRE[5:0] */
731 Tempdx >>= 6; /* Tempdx[7:6]->[1:0] HRS[9:8] */
732 Tempax |= Tempdx; /* HRE[5:0]HRS[9:8] */
733 /* SR2F D[7:2]->HRE, D[1:0]->HRS */
734 xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempax);
735 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00);
736
737 /* CR10 VRS */
738 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[10];
739 Tempbx = Tempax; /* Tempbx: VRS */
740 Tempax &= 0x01; /* Tempax[0]: VRS[0] */
741 xgifb_reg_or(pVBInfo->P3c4, 0x33, Tempax); /* SR33[0]->VRS[0] */
742 /* CR7[2][7] VRE */
743 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[9];
744 Tempcx = Tempbx >> 1; /* Tempcx[6:0]: VRS[7:1] */
745 Tempdx = Tempax & 0x04; /* Tempdx[2]: CR7[2] */
746 Tempdx <<= 5; /* Tempdx[7]: VRS[8] */
747 Tempcx |= Tempdx; /* Tempcx[7:0]: VRS[8:1] */
748 xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempcx); /* SR34[8:1]->VRS */
749
750 Temp1 = Tempdx; /* Temp1[7]: Tempdx[7] */
751 Temp1 <<= 1; /* Temp1[8]: VRS[8] */
752 Temp1 |= Tempbx; /* Temp1[8:0]: VRS[8:0] */
753 Tempax &= 0x80;
754 Temp2 = Tempax << 2; /* Temp2[9]: VRS[9] */
755 Temp1 |= Temp2; /* Temp1[9:0]: VRS[9:0] */
756 /* Tempax: SRA */
757 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[14];
758 Tempax &= 0x08; /* Tempax[3]: VRS[3] */
759 Temp2 = Tempax;
760 Temp2 <<= 7; /* Temp2[10]: VRS[10] */
761 Temp1 |= Temp2; /* Temp1[10:0]: VRS[10:0] */
762
763 /* Tempax: CR11 VRE */
764 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[11];
765 Tempax &= 0x0F; /* Tempax[3:0]: VRE[3:0] */
766 /* Tempbx: SRA */
767 Tempbx = pVBInfo->XGINEWUB_CRT1Table[index].CR[14];
768 Tempbx &= 0x20; /* Tempbx[5]: VRE[5] */
769 Tempbx >>= 1; /* Tempbx[4]: VRE[4] */
770 Tempax |= Tempbx; /* Tempax[4:0]: VRE[4:0] */
771 Temp2 = Temp1 & 0x7E0; /* Temp2[10:5]: VRS[10:5] */
772 Temp2 |= Tempax; /* Temp2[10:5]: VRE[10:5] */
773
774 Temp3 = Temp1 & 0x1F; /* Temp3[4:0]: VRS[4:0] */
775 if (Tempax < Temp3) /* VRE < VRS */
776 Temp2 |= 0x20; /* VRE + 0x20 */
777
778 Temp2 &= 0xFF;
779 Tempax = (unsigned char) Temp2; /* Tempax: VRE[7:0] */
780 Tempax <<= 2; /* Tempax[7:0]; VRE[5:0]00 */
781 Temp1 &= 0x600; /* Temp1[10:9]: VRS[10:9] */
782 Temp1 >>= 9; /* Temp1[1:0]: VRS[10:9] */
783 Tempbx = (unsigned char) Temp1;
784 Tempax |= Tempbx; /* Tempax[7:0]: VRE[5:0]VRS[10:9] */
785 Tempax &= 0x7F;
786 /* SR3F D[7:2]->VRE D[1:0]->VRS */
787 xgifb_reg_set(pVBInfo->P3c4, 0x3F, Tempax);
788 }
789 }
790
791 static void XGI_SetXG27CRTC(unsigned short ModeNo,
792 unsigned short ModeIdIndex,
793 unsigned short RefreshRateTableIndex,
794 struct vb_device_info *pVBInfo)
795 {
796 unsigned short StandTableIndex, index, Tempax, Tempbx, Tempcx, Tempdx;
797
798 if (ModeNo <= 0x13) {
799 StandTableIndex = XGI_GetModePtr(ModeNo, ModeIdIndex, pVBInfo);
800 /* CR04 HRS */
801 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[4];
802 /* SR2E [7:0]->HRS */
803 xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax);
804 /* Tempbx: CR05 HRE */
805 Tempbx = pVBInfo->StandTable[StandTableIndex].CRTC[5];
806 Tempbx &= 0x1F; /* Tempbx: HRE[4:0] */
807 Tempcx = Tempax;
808 Tempcx &= 0xE0; /* Tempcx: HRS[7:5] */
809 Tempdx = Tempcx | Tempbx; /* Tempdx(HRE): HRS[7:5]HRE[4:0] */
810 if (Tempbx < (Tempax & 0x1F)) /* IF HRE < HRS */
811 Tempdx |= 0x20; /* Tempdx: HRE = HRE + 0x20 */
812 Tempdx <<= 2; /* Tempdx << 2 */
813 /* SR2F [7:2]->HRE */
814 xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempdx);
815 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00);
816
817 /* Tempax: CR10 VRS */
818 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[16];
819 xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempax); /* SR34[7:0]->VRS */
820 Tempcx = Tempax; /* Tempcx=Tempax=VRS[7:0] */
821 /* Tempax[7][2]: CR7[7][2] VRS[9][8] */
822 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[7];
823 Tempbx = Tempax; /* Tempbx=CR07 */
824 Tempax &= 0x04; /* Tempax[2]: CR07[2] VRS[8] */
825 Tempax >>= 2;
826 /* SR35 D[0]->VRS D[8] */
827 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x01, Tempax);
828 Tempcx |= (Tempax << 8); /* Tempcx[8] |= VRS[8] */
829 Tempcx |= (Tempbx & 0x80) << 2; /* Tempcx[9] |= VRS[9] */
830
831 /* CR11 VRE */
832 Tempax = pVBInfo->StandTable[StandTableIndex].CRTC[17];
833 Tempax &= 0x0F; /* Tempax: VRE[3:0] */
834 Tempbx = Tempcx; /* Tempbx=Tempcx=VRS[9:0] */
835 Tempbx &= 0x3F0; /* Tempbx[9:4]: VRS[9:4] */
836 Tempbx |= Tempax; /* Tempbx[9:0]: VRE[9:0] */
837 if (Tempax <= (Tempcx & 0x0F)) /* VRE[3:0]<=VRS[3:0] */
838 Tempbx |= 0x10; /* Tempbx: VRE + 0x10 */
839 /* Tempax[7:0]: VRE[7:0] */
840 Tempax = (unsigned char) Tempbx & 0xFF;
841 Tempax <<= 2; /* Tempax << 2: VRE[5:0] */
842 Tempcx = (Tempcx & 0x600) >> 8; /* Tempcx VRS[10:9] */
843 /* SR3F D[7:2]->VRE D[5:0] */
844 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC, Tempax);
845 /* SR35 D[2:1]->VRS[10:9] */
846 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x06, Tempcx);
847 } else {
848 index = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
849 /* Tempax: CR4 HRS */
850 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[3];
851 Tempbx = Tempax; /* Tempbx: HRS[7:0] */
852 /* SR2E[7:0]->HRS */
853 xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax);
854
855 /* SR0B */
856 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[5];
857 Tempax &= 0xC0; /* Tempax[7:6]: SR0B[7:6]: HRS[9:8]*/
858 Tempbx |= (Tempax << 2); /* Tempbx: HRS[9:0] */
859
860 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[4]; /* CR5 HRE */
861 Tempax &= 0x1F; /* Tempax[4:0]: HRE[4:0] */
862 Tempcx = Tempax; /* Tempcx: HRE[4:0] */
863
864 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[6]; /* SRC */
865 Tempax &= 0x04; /* Tempax[2]: HRE[5] */
866 Tempax <<= 3; /* Tempax[5]: HRE[5] */
867 Tempcx |= Tempax; /* Tempcx[5:0]: HRE[5:0] */
868
869 Tempbx = Tempbx & 0x3C0; /* Tempbx[9:6]: HRS[9:6] */
870 Tempbx |= Tempcx; /* Tempbx: HRS[9:6]HRE[5:0] */
871
872 /* Tempax: CR4 HRS */
873 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[3];
874 Tempax &= 0x3F; /* Tempax: HRS[5:0] */
875 if (Tempcx <= Tempax) /* HRE[5:0] < HRS[5:0] */
876 Tempbx += 0x40; /* Tempbx= Tempbx + 0x40 : HRE[9:0]*/
877
878 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[5]; /* SR0B */
879 Tempax &= 0xC0; /* Tempax[7:6]: SR0B[7:6]: HRS[9:8]*/
880 Tempax >>= 6; /* Tempax[1:0]: HRS[9:8]*/
881 Tempax |= ((Tempbx << 2) & 0xFF); /* Tempax[7:2]: HRE[5:0] */
882 /* SR2F [7:2][1:0]: HRE[5:0]HRS[9:8] */
883 xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempax);
884 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00);
885
886 /* CR10 VRS */
887 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[10];
888 /* SR34[7:0]->VRS[7:0] */
889 xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempax);
890
891 Tempcx = Tempax; /* Tempcx <= VRS[7:0] */
892 /* CR7[7][2] VRS[9][8] */
893 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[9];
894 Tempbx = Tempax; /* Tempbx <= CR07[7:0] */
895 Tempax = Tempax & 0x04; /* Tempax[2]: CR7[2]: VRS[8] */
896 Tempax >>= 2; /* Tempax[0]: VRS[8] */
897 /* SR35[0]: VRS[8] */
898 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x01, Tempax);
899 Tempcx |= (Tempax << 8); /* Tempcx <= VRS[8:0] */
900 Tempcx |= ((Tempbx & 0x80) << 2); /* Tempcx <= VRS[9:0] */
901 /* Tempax: SR0A */
902 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[14];
903 Tempax &= 0x08; /* SR0A[3] VRS[10] */
904 Tempcx |= (Tempax << 7); /* Tempcx <= VRS[10:0] */
905
906 /* Tempax: CR11 VRE */
907 Tempax = pVBInfo->XGINEWUB_CRT1Table[index].CR[11];
908 Tempax &= 0x0F; /* Tempax[3:0]: VRE[3:0] */
909 /* Tempbx: SR0A */
910 Tempbx = pVBInfo->XGINEWUB_CRT1Table[index].CR[14];
911 Tempbx &= 0x20; /* Tempbx[5]: SR0A[5]: VRE[4] */
912 Tempbx >>= 1; /* Tempbx[4]: VRE[4] */
913 Tempax |= Tempbx; /* Tempax[4:0]: VRE[4:0] */
914 Tempbx = Tempcx; /* Tempbx: VRS[10:0] */
915 Tempbx &= 0x7E0; /* Tempbx[10:5]: VRS[10:5] */
916 Tempbx |= Tempax; /* Tempbx: VRS[10:5]VRE[4:0] */
917
918 if (Tempbx <= Tempcx) /* VRE <= VRS */
919 Tempbx |= 0x20; /* VRE + 0x20 */
920
921 /* Tempax: Tempax[7:0]; VRE[5:0]00 */
922 Tempax = (Tempbx << 2) & 0xFF;
923 /* SR3F[7:2]:VRE[5:0] */
924 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC, Tempax);
925 Tempax = Tempcx >> 8;
926 /* SR35[2:0]:VRS[10:8] */
927 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x07, Tempax);
928 }
929 }
930
931 static void XGI_SetXG27FPBits(struct vb_device_info *pVBInfo)
932 {
933 unsigned char temp;
934
935 /* D[1:0] 01: 18bit, 00: dual 12, 10: single 24 */
936 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
937 temp = (temp & 3) << 6;
938 /* SR06[7]0: dual 12/1: single 24 [6] 18bit Dither <= 0 h/w recommend */
939 xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0xc0, temp & 0x80);
940 /* SR09[7] enable FP output, SR09[6] 1: sigle 18bits, 0: 24bits */
941 xgifb_reg_and_or(pVBInfo->P3c4, 0x09, ~0xc0, temp | 0x80);
942
943 }
944
945 static void xgifb_set_lcd(int chip_id,
946 struct vb_device_info *pVBInfo,
947 unsigned short RefreshRateTableIndex,
948 unsigned short ModeNo)
949 {
950 unsigned short Data, Temp, b3CC;
951 unsigned short XGI_P3cc;
952
953 XGI_P3cc = pVBInfo->P3cc;
954
955 xgifb_reg_set(pVBInfo->P3d4, 0x2E, 0x00);
956 xgifb_reg_set(pVBInfo->P3d4, 0x2F, 0x00);
957 xgifb_reg_set(pVBInfo->P3d4, 0x46, 0x00);
958 xgifb_reg_set(pVBInfo->P3d4, 0x47, 0x00);
959
960 if (chip_id == XG27) {
961 Temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
962 if ((Temp & 0x03) == 0) { /* dual 12 */
963 xgifb_reg_set(pVBInfo->P3d4, 0x46, 0x13);
964 xgifb_reg_set(pVBInfo->P3d4, 0x47, 0x13);
965 }
966 }
967
968 if (((*pVBInfo->pDVOSetting) & 0xC0) == 0xC0) {
969 xgifb_reg_set(pVBInfo->P3d4, 0x2E, *pVBInfo->pCR2E);
970 xgifb_reg_set(pVBInfo->P3d4, 0x2F, *pVBInfo->pCR2F);
971 xgifb_reg_set(pVBInfo->P3d4, 0x46, *pVBInfo->pCR46);
972 xgifb_reg_set(pVBInfo->P3d4, 0x47, *pVBInfo->pCR47);
973 }
974
975 if (chip_id == XG27) {
976 XGI_SetXG27FPBits(pVBInfo);
977 } else {
978 Temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
979 if (Temp & 0x01) {
980 /* 18 bits FP */
981 xgifb_reg_or(pVBInfo->P3c4, 0x06, 0x40);
982 xgifb_reg_or(pVBInfo->P3c4, 0x09, 0x40);
983 }
984 }
985
986 xgifb_reg_or(pVBInfo->P3c4, 0x1E, 0x01); /* Negative blank polarity */
987
988 xgifb_reg_and(pVBInfo->P3c4, 0x30, ~0x20); /* Hsync polarity */
989 xgifb_reg_and(pVBInfo->P3c4, 0x35, ~0x80); /* Vsync polarity */
990
991 if (ModeNo <= 0x13) {
992 b3CC = (unsigned char) inb(XGI_P3cc);
993 if (b3CC & 0x40)
994 /* Hsync polarity */
995 xgifb_reg_or(pVBInfo->P3c4, 0x30, 0x20);
996 if (b3CC & 0x80)
997 /* Vsync polarity */
998 xgifb_reg_or(pVBInfo->P3c4, 0x35, 0x80);
999 } else {
1000 Data = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
1001 if (Data & 0x4000)
1002 /* Hsync polarity */
1003 xgifb_reg_or(pVBInfo->P3c4, 0x30, 0x20);
1004 if (Data & 0x8000)
1005 /* Vsync polarity */
1006 xgifb_reg_or(pVBInfo->P3c4, 0x35, 0x80);
1007 }
1008 }
1009
1010 /* --------------------------------------------------------------------- */
1011 /* Function : XGI_UpdateXG21CRTC */
1012 /* Input : */
1013 /* Output : CRT1 CRTC */
1014 /* Description : Modify CRT1 Hsync/Vsync to fix LCD mode timing */
1015 /* --------------------------------------------------------------------- */
1016 static void XGI_UpdateXG21CRTC(unsigned short ModeNo,
1017 struct vb_device_info *pVBInfo,
1018 unsigned short RefreshRateTableIndex)
1019 {
1020 int i, index = -1;
1021
1022 xgifb_reg_and(pVBInfo->P3d4, 0x11, 0x7F); /* Unlock CR0~7 */
1023 if (ModeNo <= 0x13) {
1024 for (i = 0; i < 12; i++) {
1025 if (ModeNo == pVBInfo->UpdateCRT1[i].ModeID)
1026 index = i;
1027 }
1028 } else {
1029 if (ModeNo == 0x2E &&
1030 (pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC ==
1031 RES640x480x60))
1032 index = 12;
1033 else if (ModeNo == 0x2E &&
1034 (pVBInfo->RefIndex[RefreshRateTableIndex].
1035 Ext_CRT1CRTC == RES640x480x72))
1036 index = 13;
1037 else if (ModeNo == 0x2F)
1038 index = 14;
1039 else if (ModeNo == 0x50)
1040 index = 15;
1041 else if (ModeNo == 0x59)
1042 index = 16;
1043 }
1044
1045 if (index != -1) {
1046 xgifb_reg_set(pVBInfo->P3d4, 0x02,
1047 pVBInfo->UpdateCRT1[index].CR02);
1048 xgifb_reg_set(pVBInfo->P3d4, 0x03,
1049 pVBInfo->UpdateCRT1[index].CR03);
1050 xgifb_reg_set(pVBInfo->P3d4, 0x15,
1051 pVBInfo->UpdateCRT1[index].CR15);
1052 xgifb_reg_set(pVBInfo->P3d4, 0x16,
1053 pVBInfo->UpdateCRT1[index].CR16);
1054 }
1055 }
1056
1057 static unsigned short XGI_GetResInfo(unsigned short ModeNo,
1058 unsigned short ModeIdIndex, struct vb_device_info *pVBInfo)
1059 {
1060 unsigned short resindex;
1061
1062 if (ModeNo <= 0x13)
1063 /* si+St_ResInfo */
1064 resindex = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
1065 else
1066 /* si+Ext_ResInfo */
1067 resindex = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
1068 return resindex;
1069 }
1070
1071 static void XGI_SetCRT1DE(struct xgi_hw_device_info *HwDeviceExtension,
1072 unsigned short ModeNo, unsigned short ModeIdIndex,
1073 unsigned short RefreshRateTableIndex,
1074 struct vb_device_info *pVBInfo)
1075 {
1076 unsigned short resindex, tempax, tempbx, tempcx, temp, modeflag;
1077
1078 unsigned char data;
1079
1080 resindex = XGI_GetResInfo(ModeNo, ModeIdIndex, pVBInfo);
1081
1082 if (ModeNo <= 0x13) {
1083 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
1084 tempax = pVBInfo->StResInfo[resindex].HTotal;
1085 tempbx = pVBInfo->StResInfo[resindex].VTotal;
1086 } else {
1087 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1088 tempax = pVBInfo->ModeResInfo[resindex].HTotal;
1089 tempbx = pVBInfo->ModeResInfo[resindex].VTotal;
1090 }
1091
1092 if (modeflag & HalfDCLK)
1093 tempax = tempax >> 1;
1094
1095 if (ModeNo > 0x13) {
1096 if (modeflag & HalfDCLK)
1097 tempax = tempax << 1;
1098
1099 temp = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
1100
1101 if (temp & InterlaceMode)
1102 tempbx = tempbx >> 1;
1103
1104 if (modeflag & DoubleScanMode)
1105 tempbx = tempbx << 1;
1106 }
1107
1108 tempcx = 8;
1109
1110 tempax /= tempcx;
1111 tempax -= 1;
1112 tempbx -= 1;
1113 tempcx = tempax;
1114 temp = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x11);
1115 data = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x11);
1116 data &= 0x7F;
1117 xgifb_reg_set(pVBInfo->P3d4, 0x11, data); /* Unlock CRTC */
1118 xgifb_reg_set(pVBInfo->P3d4, 0x01, (unsigned short) (tempcx & 0xff));
1119 xgifb_reg_and_or(pVBInfo->P3d4, 0x0b, ~0x0c,
1120 (unsigned short) ((tempcx & 0x0ff00) >> 10));
1121 xgifb_reg_set(pVBInfo->P3d4, 0x12, (unsigned short) (tempbx & 0xff));
1122 tempax = 0;
1123 tempbx = tempbx >> 8;
1124
1125 if (tempbx & 0x01)
1126 tempax |= 0x02;
1127
1128 if (tempbx & 0x02)
1129 tempax |= 0x40;
1130
1131 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x42, tempax);
1132 data = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x07);
1133 data &= 0xFF;
1134 tempax = 0;
1135
1136 if (tempbx & 0x04)
1137 tempax |= 0x02;
1138
1139 xgifb_reg_and_or(pVBInfo->P3d4, 0x0a, ~0x02, tempax);
1140 xgifb_reg_set(pVBInfo->P3d4, 0x11, temp);
1141 }
1142
1143 static void XGI_SetCRT1Offset(unsigned short ModeNo,
1144 unsigned short ModeIdIndex,
1145 unsigned short RefreshRateTableIndex,
1146 struct xgi_hw_device_info *HwDeviceExtension,
1147 struct vb_device_info *pVBInfo)
1148 {
1149 unsigned short temp, ah, al, temp2, i, DisplayUnit;
1150
1151 /* GetOffset */
1152 temp = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeInfo;
1153 temp = temp >> 8;
1154 temp = pVBInfo->ScreenOffset[temp];
1155
1156 temp2 = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
1157 temp2 &= InterlaceMode;
1158
1159 if (temp2)
1160 temp = temp << 1;
1161
1162 temp2 = pVBInfo->ModeType - ModeEGA;
1163
1164 switch (temp2) {
1165 case 0:
1166 temp2 = 1;
1167 break;
1168 case 1:
1169 temp2 = 2;
1170 break;
1171 case 2:
1172 temp2 = 4;
1173 break;
1174 case 3:
1175 temp2 = 4;
1176 break;
1177 case 4:
1178 temp2 = 6;
1179 break;
1180 case 5:
1181 temp2 = 8;
1182 break;
1183 default:
1184 break;
1185 }
1186
1187 if ((ModeNo >= 0x26) && (ModeNo <= 0x28))
1188 temp = temp * temp2 + temp2 / 2;
1189 else
1190 temp *= temp2;
1191
1192 /* SetOffset */
1193 DisplayUnit = temp;
1194 temp2 = temp;
1195 temp = temp >> 8; /* ah */
1196 temp &= 0x0F;
1197 i = xgifb_reg_get(pVBInfo->P3c4, 0x0E);
1198 i &= 0xF0;
1199 i |= temp;
1200 xgifb_reg_set(pVBInfo->P3c4, 0x0E, i);
1201
1202 temp = (unsigned char) temp2;
1203 temp &= 0xFF; /* al */
1204 xgifb_reg_set(pVBInfo->P3d4, 0x13, temp);
1205
1206 /* SetDisplayUnit */
1207 temp2 = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
1208 temp2 &= InterlaceMode;
1209 if (temp2)
1210 DisplayUnit >>= 1;
1211
1212 DisplayUnit = DisplayUnit << 5;
1213 ah = (DisplayUnit & 0xff00) >> 8;
1214 al = DisplayUnit & 0x00ff;
1215 if (al == 0)
1216 ah += 1;
1217 else
1218 ah += 2;
1219
1220 if (HwDeviceExtension->jChipType >= XG20)
1221 if ((ModeNo == 0x4A) | (ModeNo == 0x49))
1222 ah -= 1;
1223
1224 xgifb_reg_set(pVBInfo->P3c4, 0x10, ah);
1225 }
1226
1227 static unsigned short XGI_GetVCLK2Ptr(unsigned short ModeNo,
1228 unsigned short ModeIdIndex,
1229 unsigned short RefreshRateTableIndex,
1230 struct xgi_hw_device_info *HwDeviceExtension,
1231 struct vb_device_info *pVBInfo)
1232 {
1233 unsigned short LCDXlat1VCLK[4] = { VCLK65 + 2,
1234 VCLK65 + 2,
1235 VCLK65 + 2,
1236 VCLK65 + 2 };
1237 unsigned short LCDXlat2VCLK[4] = { VCLK108_2 + 5,
1238 VCLK108_2 + 5,
1239 VCLK108_2 + 5,
1240 VCLK108_2 + 5 };
1241 unsigned short LVDSXlat1VCLK[4] = { VCLK40, VCLK40, VCLK40, VCLK40 };
1242 unsigned short LVDSXlat2VCLK[4] = { VCLK65 + 2,
1243 VCLK65 + 2,
1244 VCLK65 + 2,
1245 VCLK65 + 2 };
1246 unsigned short LVDSXlat3VCLK[4] = { VCLK65 + 2,
1247 VCLK65 + 2,
1248 VCLK65 + 2,
1249 VCLK65 + 2 };
1250
1251 unsigned short CRT2Index, VCLKIndex;
1252 unsigned short modeflag, resinfo;
1253
1254 if (ModeNo <= 0x13) {
1255 /* si+St_ResInfo */
1256 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
1257 resinfo = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
1258 CRT2Index = pVBInfo->SModeIDTable[ModeIdIndex].St_CRT2CRTC;
1259 } else {
1260 /* si+Ext_ResInfo */
1261 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1262 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
1263 CRT2Index = pVBInfo->RefIndex[RefreshRateTableIndex].
1264 Ext_CRT2CRTC;
1265 }
1266
1267 if (pVBInfo->IF_DEF_LVDS == 0) {
1268 CRT2Index = CRT2Index >> 6; /* for LCD */
1269 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { /*301b*/
1270 if (pVBInfo->LCDResInfo != Panel1024x768)
1271 VCLKIndex = LCDXlat2VCLK[CRT2Index];
1272 else
1273 VCLKIndex = LCDXlat1VCLK[CRT2Index];
1274 } else if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
1275 if (pVBInfo->SetFlag & RPLLDIV2XO) {
1276 VCLKIndex = HiTVVCLKDIV2;
1277 VCLKIndex += 25;
1278 } else {
1279 VCLKIndex = HiTVVCLK;
1280 VCLKIndex += 25;
1281 }
1282
1283 if (pVBInfo->SetFlag & TVSimuMode) {
1284 if (modeflag & Charx8Dot) {
1285 VCLKIndex = HiTVSimuVCLK;
1286 VCLKIndex += 25;
1287 } else {
1288 VCLKIndex = HiTVTextVCLK;
1289 VCLKIndex += 25;
1290 }
1291 }
1292
1293 /* 301lv */
1294 if ((pVBInfo->VBType & VB_XGI301LV) &&
1295 !(pVBInfo->VBExtInfo == VB_YPbPr1080i)) {
1296 if (pVBInfo->VBExtInfo == VB_YPbPr750p)
1297 VCLKIndex = YPbPr750pVCLK;
1298 else if (pVBInfo->VBExtInfo == VB_YPbPr525p)
1299 VCLKIndex = YPbPr525pVCLK;
1300 else if (pVBInfo->SetFlag & RPLLDIV2XO)
1301 VCLKIndex = YPbPr525iVCLK_2;
1302 else
1303 VCLKIndex = YPbPr525iVCLK;
1304 }
1305 } else if (pVBInfo->VBInfo & SetCRT2ToTV) {
1306 if (pVBInfo->SetFlag & RPLLDIV2XO) {
1307 VCLKIndex = TVVCLKDIV2;
1308 VCLKIndex += 25;
1309 } else {
1310 VCLKIndex = TVVCLK;
1311 VCLKIndex += 25;
1312 }
1313 } else { /* for CRT2 */
1314 /* Port 3cch */
1315 VCLKIndex = (unsigned char) inb((pVBInfo->P3ca + 0x02));
1316 VCLKIndex = ((VCLKIndex >> 2) & 0x03);
1317 if (ModeNo > 0x13) {
1318 /* di+Ext_CRTVCLK */
1319 VCLKIndex = pVBInfo->RefIndex[
1320 RefreshRateTableIndex].
1321 Ext_CRTVCLK;
1322 VCLKIndex &= IndexMask;
1323 }
1324 }
1325 } else { /* LVDS */
1326 if (ModeNo <= 0x13)
1327 VCLKIndex = CRT2Index;
1328 else
1329 VCLKIndex = CRT2Index;
1330
1331 VCLKIndex = VCLKIndex >> 6;
1332 if ((pVBInfo->LCDResInfo == Panel800x600) ||
1333 (pVBInfo->LCDResInfo == Panel320x480))
1334 VCLKIndex = LVDSXlat1VCLK[VCLKIndex];
1335 else if ((pVBInfo->LCDResInfo == Panel1024x768) ||
1336 (pVBInfo->LCDResInfo == Panel1024x768x75))
1337 VCLKIndex = LVDSXlat2VCLK[VCLKIndex];
1338 else
1339 VCLKIndex = LVDSXlat3VCLK[VCLKIndex];
1340 }
1341
1342 return VCLKIndex;
1343 }
1344
1345 static void XGI_SetCRT1VCLK(unsigned short ModeNo,
1346 unsigned short ModeIdIndex,
1347 struct xgi_hw_device_info *HwDeviceExtension,
1348 unsigned short RefreshRateTableIndex,
1349 struct vb_device_info *pVBInfo)
1350 {
1351 unsigned char index, data;
1352 unsigned short vclkindex;
1353
1354 if (pVBInfo->IF_DEF_LVDS == 1) {
1355 index = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
1356 data = xgifb_reg_get(pVBInfo->P3c4, 0x31) & 0xCF;
1357 xgifb_reg_set(pVBInfo->P3c4, 0x31, data);
1358 xgifb_reg_set(pVBInfo->P3c4, 0x2B,
1359 pVBInfo->VCLKData[index].SR2B);
1360 xgifb_reg_set(pVBInfo->P3c4, 0x2C,
1361 pVBInfo->VCLKData[index].SR2C);
1362 xgifb_reg_set(pVBInfo->P3c4, 0x2D, 0x01);
1363 } else if ((pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
1364 | VB_XGI302LV | VB_XGI301C)) && (pVBInfo->VBInfo
1365 & SetCRT2ToLCDA)) {
1366 vclkindex = XGI_GetVCLK2Ptr(ModeNo, ModeIdIndex,
1367 RefreshRateTableIndex, HwDeviceExtension,
1368 pVBInfo);
1369 data = xgifb_reg_get(pVBInfo->P3c4, 0x31) & 0xCF;
1370 xgifb_reg_set(pVBInfo->P3c4, 0x31, data);
1371 data = pVBInfo->VBVCLKData[vclkindex].Part4_A;
1372 xgifb_reg_set(pVBInfo->P3c4, 0x2B, data);
1373 data = pVBInfo->VBVCLKData[vclkindex].Part4_B;
1374 xgifb_reg_set(pVBInfo->P3c4, 0x2C, data);
1375 xgifb_reg_set(pVBInfo->P3c4, 0x2D, 0x01);
1376 } else {
1377 index = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
1378 data = xgifb_reg_get(pVBInfo->P3c4, 0x31) & 0xCF;
1379 xgifb_reg_set(pVBInfo->P3c4, 0x31, data);
1380 xgifb_reg_set(pVBInfo->P3c4, 0x2B,
1381 pVBInfo->VCLKData[index].SR2B);
1382 xgifb_reg_set(pVBInfo->P3c4, 0x2C,
1383 pVBInfo->VCLKData[index].SR2C);
1384 xgifb_reg_set(pVBInfo->P3c4, 0x2D, 0x01);
1385 }
1386
1387 if (HwDeviceExtension->jChipType >= XG20) {
1388 if (pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag &
1389 HalfDCLK) {
1390 data = xgifb_reg_get(pVBInfo->P3c4, 0x2B);
1391 xgifb_reg_set(pVBInfo->P3c4, 0x2B, data);
1392 data = xgifb_reg_get(pVBInfo->P3c4, 0x2C);
1393 index = data;
1394 index &= 0xE0;
1395 data &= 0x1F;
1396 data = data << 1;
1397 data += 1;
1398 data |= index;
1399 xgifb_reg_set(pVBInfo->P3c4, 0x2C, data);
1400 }
1401 }
1402 }
1403
1404 static void XGI_SetXG21FPBits(struct vb_device_info *pVBInfo)
1405 {
1406 unsigned char temp;
1407
1408 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37); /* D[0] 1: 18bit */
1409 temp = (temp & 1) << 6;
1410 /* SR06[6] 18bit Dither */
1411 xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0x40, temp);
1412 /* SR09[7] enable FP output, SR09[6] 1: sigle 18bits, 0: dual 12bits */
1413 xgifb_reg_and_or(pVBInfo->P3c4, 0x09, ~0xc0, temp | 0x80);
1414
1415 }
1416
1417 static void XGI_SetCRT1FIFO(unsigned short ModeNo,
1418 struct xgi_hw_device_info *HwDeviceExtension,
1419 struct vb_device_info *pVBInfo)
1420 {
1421 unsigned short data;
1422
1423 data = xgifb_reg_get(pVBInfo->P3c4, 0x3D);
1424 data &= 0xfe;
1425 xgifb_reg_set(pVBInfo->P3c4, 0x3D, data); /* diable auto-threshold */
1426
1427 if (ModeNo > 0x13) {
1428 xgifb_reg_set(pVBInfo->P3c4, 0x08, 0x34);
1429 data = xgifb_reg_get(pVBInfo->P3c4, 0x09);
1430 data &= 0xC0;
1431 xgifb_reg_set(pVBInfo->P3c4, 0x09, data | 0x30);
1432 data = xgifb_reg_get(pVBInfo->P3c4, 0x3D);
1433 data |= 0x01;
1434 xgifb_reg_set(pVBInfo->P3c4, 0x3D, data);
1435 } else {
1436 if (HwDeviceExtension->jChipType == XG27) {
1437 xgifb_reg_set(pVBInfo->P3c4, 0x08, 0x0E);
1438 data = xgifb_reg_get(pVBInfo->P3c4, 0x09);
1439 data &= 0xC0;
1440 xgifb_reg_set(pVBInfo->P3c4, 0x09, data | 0x20);
1441 } else {
1442 xgifb_reg_set(pVBInfo->P3c4, 0x08, 0xAE);
1443 data = xgifb_reg_get(pVBInfo->P3c4, 0x09);
1444 data &= 0xF0;
1445 xgifb_reg_set(pVBInfo->P3c4, 0x09, data);
1446 }
1447 }
1448
1449 if (HwDeviceExtension->jChipType == XG21)
1450 XGI_SetXG21FPBits(pVBInfo); /* Fix SR9[7:6] can't read back */
1451 }
1452
1453 static void XGI_SetVCLKState(struct xgi_hw_device_info *HwDeviceExtension,
1454 unsigned short ModeNo, unsigned short RefreshRateTableIndex,
1455 struct vb_device_info *pVBInfo)
1456 {
1457 unsigned short data, data2 = 0;
1458 short VCLK;
1459
1460 unsigned char index;
1461
1462 if (ModeNo <= 0x13)
1463 VCLK = 0;
1464 else {
1465 index = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
1466 index &= IndexMask;
1467 VCLK = pVBInfo->VCLKData[index].CLOCK;
1468 }
1469
1470 data = xgifb_reg_get(pVBInfo->P3c4, 0x32);
1471 data &= 0xf3;
1472 if (VCLK >= 200)
1473 data |= 0x0c; /* VCLK > 200 */
1474
1475 if (HwDeviceExtension->jChipType >= XG20)
1476 data &= ~0x04; /* 2 pixel mode */
1477
1478 xgifb_reg_set(pVBInfo->P3c4, 0x32, data);
1479
1480 if (HwDeviceExtension->jChipType < XG20) {
1481 data = xgifb_reg_get(pVBInfo->P3c4, 0x1F);
1482 data &= 0xE7;
1483 if (VCLK < 200)
1484 data |= 0x10;
1485 xgifb_reg_set(pVBInfo->P3c4, 0x1F, data);
1486 }
1487
1488 data2 = 0x00;
1489
1490 xgifb_reg_and_or(pVBInfo->P3c4, 0x07, 0xFC, data2);
1491 if (HwDeviceExtension->jChipType >= XG27)
1492 xgifb_reg_and_or(pVBInfo->P3c4, 0x40, 0xFC, data2 & 0x03);
1493
1494 }
1495
1496 static void XGI_SetCRT1ModeRegs(struct xgi_hw_device_info *HwDeviceExtension,
1497 unsigned short ModeNo, unsigned short ModeIdIndex,
1498 unsigned short RefreshRateTableIndex,
1499 struct vb_device_info *pVBInfo)
1500 {
1501 unsigned short data, data2, data3, infoflag = 0, modeflag, resindex,
1502 xres;
1503
1504 if (ModeNo > 0x13) {
1505 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1506 infoflag = pVBInfo->RefIndex[RefreshRateTableIndex].
1507 Ext_InfoFlag;
1508 } else
1509 /* si+St_ModeFlag */
1510 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
1511
1512 if (xgifb_reg_get(pVBInfo->P3d4, 0x31) & 0x01)
1513 xgifb_reg_and_or(pVBInfo->P3c4, 0x1F, 0x3F, 0x00);
1514
1515 if (ModeNo > 0x13)
1516 data = infoflag;
1517 else
1518 data = 0;
1519
1520 data2 = 0;
1521
1522 if (ModeNo > 0x13) {
1523 if (pVBInfo->ModeType > 0x02) {
1524 data2 |= 0x02;
1525 data3 = pVBInfo->ModeType - ModeVGA;
1526 data3 = data3 << 2;
1527 data2 |= data3;
1528 }
1529 }
1530
1531 data &= InterlaceMode;
1532
1533 if (data)
1534 data2 |= 0x20;
1535
1536 xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0x3F, data2);
1537 resindex = XGI_GetResInfo(ModeNo, ModeIdIndex, pVBInfo);
1538 if (ModeNo <= 0x13)
1539 xres = pVBInfo->StResInfo[resindex].HTotal;
1540 else
1541 xres = pVBInfo->ModeResInfo[resindex].HTotal; /* xres->ax */
1542
1543 data = 0x0000;
1544 if (infoflag & InterlaceMode) {
1545 if (xres == 1024)
1546 data = 0x0035;
1547 else if (xres == 1280)
1548 data = 0x0048;
1549 }
1550
1551 data2 = data & 0x00FF;
1552 xgifb_reg_and_or(pVBInfo->P3d4, 0x19, 0xFF, data2);
1553 data2 = (data & 0xFF00) >> 8;
1554 xgifb_reg_and_or(pVBInfo->P3d4, 0x19, 0xFC, data2);
1555
1556 if (modeflag & HalfDCLK)
1557 xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xF7, 0x08);
1558
1559 data2 = 0;
1560
1561 if (modeflag & LineCompareOff)
1562 data2 |= 0x08;
1563
1564 if (ModeNo > 0x13) {
1565 if (pVBInfo->ModeType == ModeEGA)
1566 data2 |= 0x40;
1567 }
1568
1569 xgifb_reg_and_or(pVBInfo->P3c4, 0x0F, ~0x48, data2);
1570 data = 0x60;
1571 if (pVBInfo->ModeType != ModeText) {
1572 data = data ^ 0x60;
1573 if (pVBInfo->ModeType != ModeEGA)
1574 data = data ^ 0xA0;
1575 }
1576 xgifb_reg_and_or(pVBInfo->P3c4, 0x21, 0x1F, data);
1577
1578 XGI_SetVCLKState(HwDeviceExtension, ModeNo, RefreshRateTableIndex,
1579 pVBInfo);
1580
1581 data = xgifb_reg_get(pVBInfo->P3d4, 0x31);
1582
1583 if (HwDeviceExtension->jChipType == XG27) {
1584 if (data & 0x40)
1585 data = 0x2c;
1586 else
1587 data = 0x6c;
1588 xgifb_reg_set(pVBInfo->P3d4, 0x52, data);
1589 xgifb_reg_or(pVBInfo->P3d4, 0x51, 0x10);
1590 } else if (HwDeviceExtension->jChipType >= XG20) {
1591 if (data & 0x40)
1592 data = 0x33;
1593 else
1594 data = 0x73;
1595 xgifb_reg_set(pVBInfo->P3d4, 0x52, data);
1596 xgifb_reg_set(pVBInfo->P3d4, 0x51, 0x02);
1597 } else {
1598 if (data & 0x40)
1599 data = 0x2c;
1600 else
1601 data = 0x6c;
1602 xgifb_reg_set(pVBInfo->P3d4, 0x52, data);
1603 }
1604
1605 }
1606
1607 static void XGI_WriteDAC(unsigned short dl,
1608 unsigned short ah,
1609 unsigned short al,
1610 unsigned short dh,
1611 struct vb_device_info *pVBInfo)
1612 {
1613 unsigned short temp, bh, bl;
1614
1615 bh = ah;
1616 bl = al;
1617
1618 if (dl != 0) {
1619 temp = bh;
1620 bh = dh;
1621 dh = temp;
1622 if (dl == 1) {
1623 temp = bl;
1624 bl = dh;
1625 dh = temp;
1626 } else {
1627 temp = bl;
1628 bl = bh;
1629 bh = temp;
1630 }
1631 }
1632 outb((unsigned short) dh, pVBInfo->P3c9);
1633 outb((unsigned short) bh, pVBInfo->P3c9);
1634 outb((unsigned short) bl, pVBInfo->P3c9);
1635 }
1636
1637 static void XGI_LoadDAC(unsigned short ModeNo, unsigned short ModeIdIndex,
1638 struct vb_device_info *pVBInfo)
1639 {
1640 unsigned short data, data2, time, i, j, k, m, n, o, si, di, bx, dl, al,
1641 ah, dh;
1642 const unsigned short *table = NULL;
1643
1644 if (ModeNo <= 0x13)
1645 data = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
1646 else
1647 data = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1648
1649 data &= DACInfoFlag;
1650 time = 64;
1651
1652 if (data == 0x00)
1653 table = XGINew_MDA_DAC;
1654 else if (data == 0x08)
1655 table = XGINew_CGA_DAC;
1656 else if (data == 0x10)
1657 table = XGINew_EGA_DAC;
1658 else if (data == 0x18) {
1659 time = 256;
1660 table = XGINew_VGA_DAC;
1661 }
1662
1663 if (time == 256)
1664 j = 16;
1665 else
1666 j = time;
1667
1668 outb(0xFF, pVBInfo->P3c6);
1669 outb(0x00, pVBInfo->P3c8);
1670
1671 for (i = 0; i < j; i++) {
1672 data = table[i];
1673
1674 for (k = 0; k < 3; k++) {
1675 data2 = 0;
1676
1677 if (data & 0x01)
1678 data2 = 0x2A;
1679
1680 if (data & 0x02)
1681 data2 += 0x15;
1682
1683 outb(data2, pVBInfo->P3c9);
1684 data = data >> 2;
1685 }
1686 }
1687
1688 if (time == 256) {
1689 for (i = 16; i < 32; i++) {
1690 data = table[i];
1691
1692 for (k = 0; k < 3; k++)
1693 outb(data, pVBInfo->P3c9);
1694 }
1695
1696 si = 32;
1697
1698 for (m = 0; m < 9; m++) {
1699 di = si;
1700 bx = si + 0x04;
1701 dl = 0;
1702
1703 for (n = 0; n < 3; n++) {
1704 for (o = 0; o < 5; o++) {
1705 dh = table[si];
1706 ah = table[di];
1707 al = table[bx];
1708 si++;
1709 XGI_WriteDAC(dl, ah, al, dh, pVBInfo);
1710 }
1711
1712 si -= 2;
1713
1714 for (o = 0; o < 3; o++) {
1715 dh = table[bx];
1716 ah = table[di];
1717 al = table[si];
1718 si--;
1719 XGI_WriteDAC(dl, ah, al, dh, pVBInfo);
1720 }
1721
1722 dl++;
1723 }
1724
1725 si += 5;
1726 }
1727 }
1728 }
1729
1730 static void XGI_GetLVDSResInfo(unsigned short ModeNo,
1731 unsigned short ModeIdIndex,
1732 struct vb_device_info *pVBInfo)
1733 {
1734 unsigned short resindex, xres, yres, modeflag;
1735
1736 if (ModeNo <= 0x13)
1737 /* si+St_ResInfo */
1738 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
1739 else
1740 /* si+Ext_ResInfo */
1741 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
1742
1743 if (ModeNo <= 0x13)
1744 /* si+St_ResInfo */
1745 resindex = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
1746 else
1747 /* si+Ext_ResInfo */
1748 resindex = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
1749
1750 if (ModeNo <= 0x13) {
1751 xres = pVBInfo->StResInfo[resindex].HTotal;
1752 yres = pVBInfo->StResInfo[resindex].VTotal;
1753 } else {
1754 xres = pVBInfo->ModeResInfo[resindex].HTotal;
1755 yres = pVBInfo->ModeResInfo[resindex].VTotal;
1756 }
1757 if (ModeNo > 0x13) {
1758 if (modeflag & HalfDCLK)
1759 xres = xres << 1;
1760
1761 if (modeflag & DoubleScanMode)
1762 yres = yres << 1;
1763 }
1764
1765 if (xres == 720)
1766 xres = 640;
1767
1768 pVBInfo->VGAHDE = xres;
1769 pVBInfo->HDE = xres;
1770 pVBInfo->VGAVDE = yres;
1771 pVBInfo->VDE = yres;
1772 }
1773
1774 static void *XGI_GetLcdPtr(unsigned short BX, unsigned short ModeNo,
1775 unsigned short ModeIdIndex,
1776 unsigned short RefreshRateTableIndex,
1777 struct vb_device_info *pVBInfo)
1778 {
1779 unsigned short i, tempdx, tempcx, tempbx, tempal, modeflag, table;
1780
1781 struct XGI330_LCDDataTablStruct *tempdi = NULL;
1782
1783 tempbx = BX;
1784
1785 if (ModeNo <= 0x13) {
1786 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
1787 tempal = pVBInfo->SModeIDTable[ModeIdIndex].St_CRT2CRTC;
1788 } else {
1789 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1790 tempal = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
1791 }
1792
1793 tempal = tempal & 0x0f;
1794
1795 if (tempbx <= 1) { /* ExpLink */
1796 if (ModeNo <= 0x13) {
1797 /* find no Ext_CRT2CRTC2 */
1798 tempal = pVBInfo->SModeIDTable[ModeIdIndex].St_CRT2CRTC;
1799 } else {
1800 tempal = pVBInfo->RefIndex[RefreshRateTableIndex].
1801 Ext_CRT2CRTC;
1802 }
1803
1804 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
1805 if (ModeNo <= 0x13)
1806 tempal = pVBInfo->SModeIDTable[ModeIdIndex].
1807 St_CRT2CRTC2;
1808 else
1809 tempal = pVBInfo->RefIndex[
1810 RefreshRateTableIndex].
1811 Ext_CRT2CRTC2;
1812 }
1813
1814 if (tempbx & 0x01)
1815 tempal = (tempal >> 4);
1816
1817 tempal = (tempal & 0x0f);
1818 }
1819
1820 tempcx = LCDLenList[tempbx];
1821
1822 if (pVBInfo->LCDInfo & EnableScalingLCD) { /* ScaleLCD */
1823 if ((tempbx == 5) || (tempbx) == 7)
1824 tempcx = LCDDesDataLen2;
1825 else if ((tempbx == 3) || (tempbx == 8))
1826 tempcx = LVDSDesDataLen2;
1827 }
1828
1829 switch (tempbx) {
1830 case 0:
1831 case 1:
1832 tempdi = xgifb_epllcd_crt1;
1833 break;
1834 case 2:
1835 tempdi = XGI_EPLLCDDataPtr;
1836 break;
1837 case 3:
1838 tempdi = XGI_EPLLCDDesDataPtr;
1839 break;
1840 case 4:
1841 tempdi = XGI_LCDDataTable;
1842 break;
1843 case 5:
1844 tempdi = XGI_LCDDesDataTable;
1845 break;
1846 case 6:
1847 tempdi = XGI_EPLCHLCDRegPtr;
1848 break;
1849 case 7:
1850 case 8:
1851 case 9:
1852 tempdi = NULL;
1853 break;
1854 default:
1855 break;
1856 }
1857
1858 if (tempdi == NULL) /* OEMUtil */
1859 return NULL;
1860
1861 table = tempbx;
1862 i = 0;
1863
1864 while (tempdi[i].PANELID != 0xff) {
1865 tempdx = pVBInfo->LCDResInfo;
1866 if (tempbx & 0x0080) { /* OEMUtil */
1867 tempbx &= (~0x0080);
1868 tempdx = pVBInfo->LCDTypeInfo;
1869 }
1870
1871 if (pVBInfo->LCDInfo & EnableScalingLCD)
1872 tempdx &= (~PanelResInfo);
1873
1874 if (tempdi[i].PANELID == tempdx) {
1875 tempbx = tempdi[i].MASK;
1876 tempdx = pVBInfo->LCDInfo;
1877
1878 if (ModeNo <= 0x13) /* alan 09/10/2003 */
1879 tempdx |= SetLCDStdMode;
1880
1881 if (modeflag & HalfDCLK)
1882 tempdx |= SetLCDLowResolution;
1883
1884 tempbx &= tempdx;
1885 if (tempbx == tempdi[i].CAP)
1886 break;
1887 }
1888 i++;
1889 }
1890
1891 if (table == 0) {
1892 switch (tempdi[i].DATAPTR) {
1893 case 0:
1894 return &XGI_LVDSCRT11024x768_1_H[tempal];
1895 break;
1896 case 1:
1897 return &XGI_LVDSCRT11024x768_2_H[tempal];
1898 break;
1899 case 2:
1900 return &XGI_LVDSCRT11280x1024_1_H[tempal];
1901 break;
1902 case 3:
1903 return &XGI_LVDSCRT11280x1024_2_H[tempal];
1904 break;
1905 case 4:
1906 return &XGI_LVDSCRT11400x1050_1_H[tempal];
1907 break;
1908 case 5:
1909 return &XGI_LVDSCRT11400x1050_2_H[tempal];
1910 break;
1911 case 6:
1912 return &XGI_LVDSCRT11600x1200_1_H[tempal];
1913 break;
1914 case 7:
1915 return &XGI_LVDSCRT11024x768_1_Hx75[tempal];
1916 break;
1917 case 8:
1918 return &XGI_LVDSCRT11024x768_2_Hx75[tempal];
1919 break;
1920 case 9:
1921 return &XGI_LVDSCRT11280x1024_1_Hx75[tempal];
1922 break;
1923 case 10:
1924 return &XGI_LVDSCRT11280x1024_2_Hx75[tempal];
1925 break;
1926 default:
1927 break;
1928 }
1929 } else if (table == 1) {
1930 switch (tempdi[i].DATAPTR) {
1931 case 0:
1932 return &XGI_LVDSCRT11024x768_1_V[tempal];
1933 break;
1934 case 1:
1935 return &XGI_LVDSCRT11024x768_2_V[tempal];
1936 break;
1937 case 2:
1938 return &XGI_LVDSCRT11280x1024_1_V[tempal];
1939 break;
1940 case 3:
1941 return &XGI_LVDSCRT11280x1024_2_V[tempal];
1942 break;
1943 case 4:
1944 return &XGI_LVDSCRT11400x1050_1_V[tempal];
1945 break;
1946 case 5:
1947 return &XGI_LVDSCRT11400x1050_2_V[tempal];
1948 break;
1949 case 6:
1950 return &XGI_LVDSCRT11600x1200_1_V[tempal];
1951 break;
1952 case 7:
1953 return &XGI_LVDSCRT11024x768_1_Vx75[tempal];
1954 break;
1955 case 8:
1956 return &XGI_LVDSCRT11024x768_2_Vx75[tempal];
1957 break;
1958 case 9:
1959 return &XGI_LVDSCRT11280x1024_1_Vx75[tempal];
1960 break;
1961 case 10:
1962 return &XGI_LVDSCRT11280x1024_2_Vx75[tempal];
1963 break;
1964 default:
1965 break;
1966 }
1967 } else if (table == 2) {
1968 switch (tempdi[i].DATAPTR) {
1969 case 0:
1970 return &XGI_LVDS1024x768Data_1[tempal];
1971 break;
1972 case 1:
1973 return &XGI_LVDS1024x768Data_2[tempal];
1974 break;
1975 case 2:
1976 return &XGI_LVDS1280x1024Data_1[tempal];
1977 break;
1978 case 3:
1979 return &XGI_LVDS1280x1024Data_2[tempal];
1980 break;
1981 case 4:
1982 return &XGI_LVDS1400x1050Data_1[tempal];
1983 break;
1984 case 5:
1985 return &XGI_LVDS1400x1050Data_2[tempal];
1986 break;
1987 case 6:
1988 return &XGI_LVDS1600x1200Data_1[tempal];
1989 break;
1990 case 7:
1991 return &XGI_LVDSNoScalingData[tempal];
1992 break;
1993 case 8:
1994 return &XGI_LVDS1024x768Data_1x75[tempal];
1995 break;
1996 case 9:
1997 return &XGI_LVDS1024x768Data_2x75[tempal];
1998 break;
1999 case 10:
2000 return &XGI_LVDS1280x1024Data_1x75[tempal];
2001 break;
2002 case 11:
2003 return &XGI_LVDS1280x1024Data_2x75[tempal];
2004 break;
2005 case 12:
2006 return &XGI_LVDSNoScalingDatax75[tempal];
2007 break;
2008 default:
2009 break;
2010 }
2011 } else if (table == 3) {
2012 switch (tempdi[i].DATAPTR) {
2013 case 0:
2014 return &XGI_LVDS1024x768Des_1[tempal];
2015 break;
2016 case 1:
2017 return &XGI_LVDS1024x768Des_3[tempal];
2018 break;
2019 case 2:
2020 return &XGI_LVDS1024x768Des_2[tempal];
2021 break;
2022 case 3:
2023 return &XGI_LVDS1280x1024Des_1[tempal];
2024 break;
2025 case 4:
2026 return &XGI_LVDS1280x1024Des_2[tempal];
2027 break;
2028 case 5:
2029 return &XGI_LVDS1400x1050Des_1[tempal];
2030 break;
2031 case 6:
2032 return &XGI_LVDS1400x1050Des_2[tempal];
2033 break;
2034 case 7:
2035 return &XGI_LVDS1600x1200Des_1[tempal];
2036 break;
2037 case 8:
2038 return &XGI_LVDSNoScalingDesData[tempal];
2039 break;
2040 case 9:
2041 return &XGI_LVDS1024x768Des_1x75[tempal];
2042 break;
2043 case 10:
2044 return &XGI_LVDS1024x768Des_3x75[tempal];
2045 break;
2046 case 11:
2047 return &XGI_LVDS1024x768Des_2x75[tempal];
2048 break;
2049 case 12:
2050 return &XGI_LVDS1280x1024Des_1x75[tempal];
2051 break;
2052 case 13:
2053 return &XGI_LVDS1280x1024Des_2x75[tempal];
2054 break;
2055 case 14:
2056 return &XGI_LVDSNoScalingDesDatax75[tempal];
2057 break;
2058 default:
2059 break;
2060 }
2061 } else if (table == 4) {
2062 switch (tempdi[i].DATAPTR) {
2063 case 0:
2064 return &XGI_ExtLCD1024x768Data[tempal];
2065 break;
2066 case 1:
2067 return &XGI_StLCD1024x768Data[tempal];
2068 break;
2069 case 2:
2070 return &XGI_CetLCD1024x768Data[tempal];
2071 break;
2072 case 3:
2073 return &XGI_ExtLCD1280x1024Data[tempal];
2074 break;
2075 case 4:
2076 return &XGI_StLCD1280x1024Data[tempal];
2077 break;
2078 case 5:
2079 return &XGI_CetLCD1280x1024Data[tempal];
2080 break;
2081 case 6:
2082 case 7:
2083 return &xgifb_lcd_1400x1050[tempal];
2084 break;
2085 case 8:
2086 return &XGI_CetLCD1400x1050Data[tempal];
2087 break;
2088 case 9:
2089 return &XGI_ExtLCD1600x1200Data[tempal];
2090 break;
2091 case 10:
2092 return &XGI_StLCD1600x1200Data[tempal];
2093 break;
2094 case 11:
2095 return &XGI_NoScalingData[tempal];
2096 break;
2097 case 12:
2098 return &XGI_ExtLCD1024x768x75Data[tempal];
2099 break;
2100 case 13:
2101 return &XGI_ExtLCD1024x768x75Data[tempal];
2102 break;
2103 case 14:
2104 return &XGI_CetLCD1024x768x75Data[tempal];
2105 break;
2106 case 15:
2107 case 16:
2108 return &xgifb_lcd_1280x1024x75[tempal];
2109 break;
2110 case 17:
2111 return &XGI_CetLCD1280x1024x75Data[tempal];
2112 break;
2113 case 18:
2114 return &XGI_NoScalingDatax75[tempal];
2115 break;
2116 default:
2117 break;
2118 }
2119 } else if (table == 5) {
2120 switch (tempdi[i].DATAPTR) {
2121 case 0:
2122 return &XGI_ExtLCDDes1024x768Data[tempal];
2123 break;
2124 case 1:
2125 return &XGI_StLCDDes1024x768Data[tempal];
2126 break;
2127 case 2:
2128 return &XGI_CetLCDDes1024x768Data[tempal];
2129 break;
2130 case 3:
2131 if ((pVBInfo->VBType & VB_XGI301LV) ||
2132 (pVBInfo->VBType & VB_XGI302LV))
2133 return &XGI_ExtLCDDLDes1280x1024Data[tempal];
2134 else
2135 return &XGI_ExtLCDDes1280x1024Data[tempal];
2136 break;
2137 case 4:
2138 if ((pVBInfo->VBType & VB_XGI301LV) ||
2139 (pVBInfo->VBType & VB_XGI302LV))
2140 return &XGI_StLCDDLDes1280x1024Data[tempal];
2141 else
2142 return &XGI_StLCDDes1280x1024Data[tempal];
2143 break;
2144 case 5:
2145 if ((pVBInfo->VBType & VB_XGI301LV) ||
2146 (pVBInfo->VBType & VB_XGI302LV))
2147 return &XGI_CetLCDDLDes1280x1024Data[tempal];
2148 else
2149 return &XGI_CetLCDDes1280x1024Data[tempal];
2150 break;
2151 case 6:
2152 case 7:
2153 if ((pVBInfo->VBType & VB_XGI301LV) ||
2154 (pVBInfo->VBType & VB_XGI302LV))
2155 return &xgifb_lcddldes_1400x1050[tempal];
2156 else
2157 return &xgifb_lcddes_1400x1050[tempal];
2158 break;
2159 case 8:
2160 return &XGI_CetLCDDes1400x1050Data[tempal];
2161 break;
2162 case 9:
2163 return &XGI_CetLCDDes1400x1050Data2[tempal];
2164 break;
2165 case 10:
2166 if ((pVBInfo->VBType & VB_XGI301LV) ||
2167 (pVBInfo->VBType & VB_XGI302LV))
2168 return &XGI_ExtLCDDLDes1600x1200Data[tempal];
2169 else
2170 return &XGI_ExtLCDDes1600x1200Data[tempal];
2171 break;
2172 case 11:
2173 if ((pVBInfo->VBType & VB_XGI301LV) ||
2174 (pVBInfo->VBType & VB_XGI302LV))
2175 return &XGI_StLCDDLDes1600x1200Data[tempal];
2176 else
2177 return &XGI_StLCDDes1600x1200Data[tempal];
2178 break;
2179 case 12:
2180 return &XGI_NoScalingDesData[tempal];
2181 break;
2182 case 13:
2183 case 14:
2184 return &xgifb_lcddes_1024x768x75[tempal];
2185 break;
2186 case 15:
2187 return &XGI_CetLCDDes1024x768x75Data[tempal];
2188 break;
2189 case 16:
2190 case 17:
2191 if ((pVBInfo->VBType & VB_XGI301LV) ||
2192 (pVBInfo->VBType & VB_XGI302LV))
2193 return &xgifb_lcddldes_1280x1024x75[tempal];
2194 else
2195 return &xgifb_lcddes_1280x1024x75[tempal];
2196 break;
2197 case 18:
2198 if ((pVBInfo->VBType & VB_XGI301LV) ||
2199 (pVBInfo->VBType & VB_XGI302LV))
2200 return &XGI_CetLCDDLDes1280x1024x75Data[tempal];
2201 else
2202 return &XGI_CetLCDDes1280x1024x75Data[tempal];
2203 break;
2204 case 19:
2205 return &XGI_NoScalingDesDatax75[tempal];
2206 break;
2207 default:
2208 break;
2209 }
2210 } else if (table == 6) {
2211 switch (tempdi[i].DATAPTR) {
2212 case 0:
2213 return &XGI_CH7017LV1024x768[tempal];
2214 break;
2215 case 1:
2216 return &XGI_CH7017LV1400x1050[tempal];
2217 break;
2218 default:
2219 break;
2220 }
2221 }
2222 return NULL;
2223 }
2224
2225 static void *XGI_GetTVPtr(unsigned short BX, unsigned short ModeNo,
2226 unsigned short ModeIdIndex,
2227 unsigned short RefreshRateTableIndex,
2228 struct vb_device_info *pVBInfo)
2229 {
2230 unsigned short i, tempdx, tempbx, tempal, modeflag, table;
2231 struct XGI330_TVDataTablStruct *tempdi = NULL;
2232
2233 tempbx = BX;
2234
2235 if (ModeNo <= 0x13) {
2236 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
2237 tempal = pVBInfo->SModeIDTable[ModeIdIndex].St_CRT2CRTC;
2238 } else {
2239 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2240 tempal = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
2241 }
2242
2243 tempal = tempal & 0x3f;
2244 table = tempbx;
2245
2246 switch (tempbx) {
2247 case 0:
2248 tempdi = NULL;
2249 break;
2250 case 1:
2251 tempdi = NULL;
2252 break;
2253 case 2:
2254 case 6:
2255 tempdi = xgifb_chrontel_tv;
2256 break;
2257 case 3:
2258 tempdi = NULL;
2259 break;
2260 case 4:
2261 tempdi = XGI_TVDataTable;
2262 break;
2263 case 5:
2264 tempdi = NULL;
2265 break;
2266 default:
2267 break;
2268 }
2269
2270 if (tempdi == NULL) /* OEMUtil */
2271 return NULL;
2272
2273 tempdx = pVBInfo->TVInfo;
2274
2275 if (pVBInfo->VBInfo & SetInSlaveMode)
2276 tempdx = tempdx | SetTVLockMode;
2277
2278 if (modeflag & HalfDCLK)
2279 tempdx = tempdx | SetTVLowResolution;
2280
2281 i = 0;
2282
2283 while (tempdi[i].MASK != 0xffff) {
2284 if ((tempdx & tempdi[i].MASK) == tempdi[i].CAP)
2285 break;
2286 i++;
2287 }
2288
2289 /* 07/05/22 */
2290 if (table == 0x04) {
2291 switch (tempdi[i].DATAPTR) {
2292 case 0:
2293 return &XGI_ExtPALData[tempal];
2294 break;
2295 case 1:
2296 return &XGI_ExtNTSCData[tempal];
2297 break;
2298 case 2:
2299 return &XGI_StPALData[tempal];
2300 break;
2301 case 3:
2302 return &XGI_StNTSCData[tempal];
2303 break;
2304 case 4:
2305 return &XGI_ExtHiTVData[tempal];
2306 break;
2307 case 5:
2308 return &XGI_St2HiTVData[tempal];
2309 break;
2310 case 6:
2311 return &XGI_ExtYPbPr525iData[tempal];
2312 break;
2313 case 7:
2314 return &XGI_ExtYPbPr525pData[tempal];
2315 break;
2316 case 8:
2317 return &XGI_ExtYPbPr750pData[tempal];
2318 break;
2319 case 9:
2320 return &XGI_StYPbPr525iData[tempal];
2321 break;
2322 case 10:
2323 return &XGI_StYPbPr525pData[tempal];
2324 break;
2325 case 11:
2326 return &XGI_StYPbPr750pData[tempal];
2327 break;
2328 case 12: /* avoid system hang */
2329 return &XGI_ExtNTSCData[tempal];
2330 break;
2331 case 13:
2332 return &XGI_St1HiTVData[tempal];
2333 break;
2334 default:
2335 break;
2336 }
2337 } else if (table == 0x02) {
2338 switch (tempdi[i].DATAPTR) {
2339 case 0:
2340 return &XGI_CHTVUNTSCData[tempal];
2341 break;
2342 case 1:
2343 return &XGI_CHTVONTSCData[tempal];
2344 break;
2345 case 2:
2346 return &XGI_CHTVUPALData[tempal];
2347 break;
2348 case 3:
2349 return &XGI_CHTVOPALData[tempal];
2350 break;
2351 default:
2352 break;
2353 }
2354 }
2355 return NULL;
2356 }
2357
2358 static void XGI_GetLVDSData(unsigned short ModeNo, unsigned short ModeIdIndex,
2359 unsigned short RefreshRateTableIndex,
2360 struct vb_device_info *pVBInfo)
2361 {
2362 unsigned short tempbx;
2363 struct XGI330_LVDSDataStruct *LCDPtr = NULL;
2364
2365 tempbx = 2;
2366
2367 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
2368 LCDPtr = (struct XGI330_LVDSDataStruct *) XGI_GetLcdPtr(tempbx,
2369 ModeNo, ModeIdIndex, RefreshRateTableIndex,
2370 pVBInfo);
2371 pVBInfo->VGAHT = LCDPtr->VGAHT;
2372 pVBInfo->VGAVT = LCDPtr->VGAVT;
2373 pVBInfo->HT = LCDPtr->LCDHT;
2374 pVBInfo->VT = LCDPtr->LCDVT;
2375 }
2376
2377 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
2378 if (!(pVBInfo->LCDInfo & (SetLCDtoNonExpanding
2379 | EnableScalingLCD))) {
2380 if ((pVBInfo->LCDResInfo == Panel1024x768) ||
2381 (pVBInfo->LCDResInfo == Panel1024x768x75)) {
2382 pVBInfo->HDE = 1024;
2383 pVBInfo->VDE = 768;
2384 } else if ((pVBInfo->LCDResInfo == Panel1280x1024) ||
2385 (pVBInfo->LCDResInfo == Panel1280x1024x75)) {
2386 pVBInfo->HDE = 1280;
2387 pVBInfo->VDE = 1024;
2388 } else if (pVBInfo->LCDResInfo == Panel1400x1050) {
2389 pVBInfo->HDE = 1400;
2390 pVBInfo->VDE = 1050;
2391 } else {
2392 pVBInfo->HDE = 1600;
2393 pVBInfo->VDE = 1200;
2394 }
2395 }
2396 }
2397 }
2398
2399 static void XGI_ModCRT1Regs(unsigned short ModeNo, unsigned short ModeIdIndex,
2400 unsigned short RefreshRateTableIndex,
2401 struct xgi_hw_device_info *HwDeviceExtension,
2402 struct vb_device_info *pVBInfo)
2403 {
2404 unsigned char index;
2405 unsigned short tempbx, i;
2406 struct XGI_LVDSCRT1HDataStruct *LCDPtr = NULL;
2407 struct XGI_LVDSCRT1VDataStruct *LCDPtr1 = NULL;
2408
2409 if (ModeNo <= 0x13)
2410 index = pVBInfo->SModeIDTable[ModeIdIndex].St_CRT2CRTC;
2411 else
2412 index = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
2413
2414 index = index & IndexMask;
2415
2416 tempbx = 0;
2417
2418 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
2419 LCDPtr = (struct XGI_LVDSCRT1HDataStruct *)
2420 XGI_GetLcdPtr(tempbx, ModeNo,
2421 ModeIdIndex,
2422 RefreshRateTableIndex,
2423 pVBInfo);
2424
2425 for (i = 0; i < 8; i++)
2426 pVBInfo->TimingH[0].data[i] = LCDPtr[0].Reg[i];
2427 }
2428
2429 XGI_SetCRT1Timing_H(pVBInfo, HwDeviceExtension);
2430
2431 tempbx = 1;
2432
2433 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
2434 LCDPtr1 = (struct XGI_LVDSCRT1VDataStruct *)
2435 XGI_GetLcdPtr(
2436 tempbx,
2437 ModeNo,
2438 ModeIdIndex,
2439 RefreshRateTableIndex,
2440 pVBInfo);
2441 for (i = 0; i < 7; i++)
2442 pVBInfo->TimingV[0].data[i] = LCDPtr1[0].Reg[i];
2443 }
2444
2445 XGI_SetCRT1Timing_V(ModeIdIndex, ModeNo, pVBInfo);
2446 }
2447
2448 static unsigned short XGI_GetLCDCapPtr(struct vb_device_info *pVBInfo)
2449 {
2450 unsigned char tempal, tempah, tempbl, i;
2451
2452 tempah = xgifb_reg_get(pVBInfo->P3d4, 0x36);
2453 tempal = tempah & 0x0F;
2454 tempah = tempah & 0xF0;
2455 i = 0;
2456 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
2457
2458 while (tempbl != 0xFF) {
2459 if (tempbl & 0x80) { /* OEMUtil */
2460 tempal = tempah;
2461 tempbl = tempbl & ~(0x80);
2462 }
2463
2464 if (tempal == tempbl)
2465 break;
2466
2467 i++;
2468
2469 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
2470 }
2471
2472 return i;
2473 }
2474
2475 static unsigned short XGI_GetLCDCapPtr1(struct vb_device_info *pVBInfo)
2476 {
2477 unsigned short tempah, tempal, tempbl, i;
2478
2479 tempal = pVBInfo->LCDResInfo;
2480 tempah = pVBInfo->LCDTypeInfo;
2481
2482 i = 0;
2483 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
2484
2485 while (tempbl != 0xFF) {
2486 if ((tempbl & 0x80) && (tempbl != 0x80)) {
2487 tempal = tempah;
2488 tempbl &= ~0x80;
2489 }
2490
2491 if (tempal == tempbl)
2492 break;
2493
2494 i++;
2495 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
2496 }
2497
2498 if (tempbl == 0xFF) {
2499 pVBInfo->LCDResInfo = Panel1024x768;
2500 pVBInfo->LCDTypeInfo = 0;
2501 i = 0;
2502 }
2503
2504 return i;
2505 }
2506
2507 static void XGI_GetLCDSync(unsigned short *HSyncWidth,
2508 unsigned short *VSyncWidth,
2509 struct vb_device_info *pVBInfo)
2510 {
2511 unsigned short Index;
2512
2513 Index = XGI_GetLCDCapPtr(pVBInfo);
2514 *HSyncWidth = pVBInfo->LCDCapList[Index].LCD_HSyncWidth;
2515 *VSyncWidth = pVBInfo->LCDCapList[Index].LCD_VSyncWidth;
2516
2517 return;
2518 }
2519
2520 static void XGI_SetLVDSRegs(unsigned short ModeNo, unsigned short ModeIdIndex,
2521 unsigned short RefreshRateTableIndex,
2522 struct vb_device_info *pVBInfo)
2523 {
2524 unsigned short tempbx, tempax, tempcx, tempdx, push1, push2, modeflag;
2525 unsigned long temp, temp1, temp2, temp3, push3;
2526 struct XGI330_LCDDataDesStruct *LCDPtr = NULL;
2527 struct XGI330_LCDDataDesStruct2 *LCDPtr1 = NULL;
2528
2529 if (ModeNo > 0x13)
2530 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2531 else
2532 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
2533
2534 tempbx = 3;
2535 if (pVBInfo->LCDInfo & EnableScalingLCD)
2536 LCDPtr1 =
2537 (struct XGI330_LCDDataDesStruct2 *)
2538 XGI_GetLcdPtr(
2539 tempbx,
2540 ModeNo,
2541 ModeIdIndex,
2542 RefreshRateTableIndex,
2543 pVBInfo);
2544 else
2545 LCDPtr =
2546 (struct XGI330_LCDDataDesStruct *)
2547 XGI_GetLcdPtr(
2548 tempbx,
2549 ModeNo,
2550 ModeIdIndex,
2551 RefreshRateTableIndex,
2552 pVBInfo);
2553
2554 XGI_GetLCDSync(&tempax, &tempbx, pVBInfo);
2555 push1 = tempbx;
2556 push2 = tempax;
2557
2558 /* GetLCDResInfo */
2559 if ((pVBInfo->LCDResInfo == Panel1024x768) ||
2560 (pVBInfo->LCDResInfo == Panel1024x768x75)) {
2561 tempax = 1024;
2562 tempbx = 768;
2563 } else if ((pVBInfo->LCDResInfo == Panel1280x1024) ||
2564 (pVBInfo->LCDResInfo == Panel1280x1024x75)) {
2565 tempax = 1280;
2566 tempbx = 1024;
2567 } else if (pVBInfo->LCDResInfo == Panel1400x1050) {
2568 tempax = 1400;
2569 tempbx = 1050;
2570 } else {
2571 tempax = 1600;
2572 tempbx = 1200;
2573 }
2574
2575 if (pVBInfo->LCDInfo & SetLCDtoNonExpanding) {
2576 pVBInfo->HDE = tempax;
2577 pVBInfo->VDE = tempbx;
2578 pVBInfo->VGAHDE = tempax;
2579 pVBInfo->VGAVDE = tempbx;
2580 }
2581
2582 tempax = pVBInfo->HT;
2583
2584 if (pVBInfo->LCDInfo & EnableScalingLCD)
2585 tempbx = LCDPtr1->LCDHDES;
2586 else
2587 tempbx = LCDPtr->LCDHDES;
2588
2589 tempcx = pVBInfo->HDE;
2590 tempbx = tempbx & 0x0fff;
2591 tempcx += tempbx;
2592
2593 if (tempcx >= tempax)
2594 tempcx -= tempax;
2595
2596 xgifb_reg_set(pVBInfo->Part1Port, 0x1A, tempbx & 0x07);
2597
2598 tempcx = tempcx >> 3;
2599 tempbx = tempbx >> 3;
2600
2601 xgifb_reg_set(pVBInfo->Part1Port, 0x16,
2602 (unsigned short) (tempbx & 0xff));
2603 xgifb_reg_set(pVBInfo->Part1Port, 0x17,
2604 (unsigned short) (tempcx & 0xff));
2605
2606 tempax = pVBInfo->HT;
2607
2608 if (pVBInfo->LCDInfo & EnableScalingLCD)
2609 tempbx = LCDPtr1->LCDHRS;
2610 else
2611 tempbx = LCDPtr->LCDHRS;
2612
2613 tempcx = push2;
2614
2615 if (pVBInfo->LCDInfo & EnableScalingLCD)
2616 tempcx = LCDPtr1->LCDHSync;
2617
2618 tempcx += tempbx;
2619
2620 if (tempcx >= tempax)
2621 tempcx -= tempax;
2622
2623 tempax = tempbx & 0x07;
2624 tempax = tempax >> 5;
2625 tempcx = tempcx >> 3;
2626 tempbx = tempbx >> 3;
2627
2628 tempcx &= 0x1f;
2629 tempax |= tempcx;
2630
2631 xgifb_reg_set(pVBInfo->Part1Port, 0x15, tempax);
2632 xgifb_reg_set(pVBInfo->Part1Port, 0x14,
2633 (unsigned short) (tempbx & 0xff));
2634
2635 tempax = pVBInfo->VT;
2636 if (pVBInfo->LCDInfo & EnableScalingLCD)
2637 tempbx = LCDPtr1->LCDVDES;
2638 else
2639 tempbx = LCDPtr->LCDVDES;
2640 tempcx = pVBInfo->VDE;
2641
2642 tempbx = tempbx & 0x0fff;
2643 tempcx += tempbx;
2644 if (tempcx >= tempax)
2645 tempcx -= tempax;
2646
2647 xgifb_reg_set(pVBInfo->Part1Port, 0x1b,
2648 (unsigned short) (tempbx & 0xff));
2649 xgifb_reg_set(pVBInfo->Part1Port, 0x1c,
2650 (unsigned short) (tempcx & 0xff));
2651
2652 tempbx = (tempbx >> 8) & 0x07;
2653 tempcx = (tempcx >> 8) & 0x07;
2654
2655 xgifb_reg_set(pVBInfo->Part1Port, 0x1d,
2656 (unsigned short) ((tempcx << 3)
2657 | tempbx));
2658
2659 tempax = pVBInfo->VT;
2660 if (pVBInfo->LCDInfo & EnableScalingLCD)
2661 tempbx = LCDPtr1->LCDVRS;
2662 else
2663 tempbx = LCDPtr->LCDVRS;
2664
2665 tempcx = push1;
2666
2667 if (pVBInfo->LCDInfo & EnableScalingLCD)
2668 tempcx = LCDPtr1->LCDVSync;
2669
2670 tempcx += tempbx;
2671 if (tempcx >= tempax)
2672 tempcx -= tempax;
2673
2674 xgifb_reg_set(pVBInfo->Part1Port, 0x18,
2675 (unsigned short) (tempbx & 0xff));
2676 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, ~0x0f,
2677 (unsigned short) (tempcx & 0x0f));
2678
2679 tempax = ((tempbx >> 8) & 0x07) << 3;
2680
2681 tempbx = pVBInfo->VGAVDE;
2682 if (tempbx != pVBInfo->VDE)
2683 tempax |= 0x40;
2684
2685 if (pVBInfo->LCDInfo & EnableLVDSDDA)
2686 tempax |= 0x40;
2687
2688 xgifb_reg_and_or(pVBInfo->Part1Port, 0x1a, 0x07,
2689 tempax);
2690
2691 tempcx = pVBInfo->VGAVT;
2692 tempbx = pVBInfo->VDE;
2693 tempax = pVBInfo->VGAVDE;
2694 tempcx -= tempax;
2695
2696 temp = tempax; /* 0430 ylshieh */
2697 temp1 = (temp << 18) / tempbx;
2698
2699 tempdx = (unsigned short) ((temp << 18) % tempbx);
2700
2701 if (tempdx != 0)
2702 temp1 += 1;
2703
2704 temp2 = temp1;
2705 push3 = temp2;
2706
2707 xgifb_reg_set(pVBInfo->Part1Port, 0x37,
2708 (unsigned short) (temp2 & 0xff));
2709 xgifb_reg_set(pVBInfo->Part1Port, 0x36,
2710 (unsigned short) ((temp2 >> 8) & 0xff));
2711
2712 tempbx = (unsigned short) (temp2 >> 16);
2713 tempax = tempbx & 0x03;
2714
2715 tempbx = pVBInfo->VGAVDE;
2716 if (tempbx == pVBInfo->VDE)
2717 tempax |= 0x04;
2718
2719 xgifb_reg_set(pVBInfo->Part1Port, 0x35, tempax);
2720
2721 if (pVBInfo->VBType & VB_XGI301C) {
2722 temp2 = push3;
2723 xgifb_reg_set(pVBInfo->Part4Port,
2724 0x3c,
2725 (unsigned short) (temp2 & 0xff));
2726 xgifb_reg_set(pVBInfo->Part4Port,
2727 0x3b,
2728 (unsigned short) ((temp2 >> 8) &
2729 0xff));
2730 tempbx = (unsigned short) (temp2 >> 16);
2731 xgifb_reg_and_or(pVBInfo->Part4Port, 0x3a,
2732 ~0xc0,
2733 (unsigned short) ((tempbx &
2734 0xff) << 6));
2735
2736 tempcx = pVBInfo->VGAVDE;
2737 if (tempcx == pVBInfo->VDE)
2738 xgifb_reg_and_or(pVBInfo->Part4Port,
2739 0x30, ~0x0c, 0x00);
2740 else
2741 xgifb_reg_and_or(pVBInfo->Part4Port,
2742 0x30, ~0x0c, 0x08);
2743 }
2744
2745 tempcx = pVBInfo->VGAHDE;
2746 tempbx = pVBInfo->HDE;
2747
2748 temp1 = tempcx << 16;
2749
2750 tempax = (unsigned short) (temp1 / tempbx);
2751
2752 if ((tempbx & 0xffff) == (tempcx & 0xffff))
2753 tempax = 65535;
2754
2755 temp3 = tempax;
2756 temp1 = pVBInfo->VGAHDE << 16;
2757
2758 temp1 /= temp3;
2759 temp3 = temp3 << 16;
2760 temp1 -= 1;
2761
2762 temp3 = (temp3 & 0xffff0000) + (temp1 & 0xffff);
2763
2764 tempax = (unsigned short) (temp3 & 0xff);
2765 xgifb_reg_set(pVBInfo->Part1Port, 0x1f, tempax);
2766
2767 temp1 = pVBInfo->VGAVDE << 18;
2768 temp1 = temp1 / push3;
2769 tempbx = (unsigned short) (temp1 & 0xffff);
2770
2771 if (pVBInfo->LCDResInfo == Panel1024x768)
2772 tempbx -= 1;
2773
2774 tempax = ((tempbx >> 8) & 0xff) << 3;
2775 tempax |= (unsigned short) ((temp3 >> 8) & 0x07);
2776 xgifb_reg_set(pVBInfo->Part1Port, 0x20,
2777 (unsigned short) (tempax & 0xff));
2778 xgifb_reg_set(pVBInfo->Part1Port, 0x21,
2779 (unsigned short) (tempbx & 0xff));
2780
2781 temp3 = temp3 >> 16;
2782
2783 if (modeflag & HalfDCLK)
2784 temp3 = temp3 >> 1;
2785
2786 xgifb_reg_set(pVBInfo->Part1Port, 0x22,
2787 (unsigned short) ((temp3 >> 8) & 0xff));
2788 xgifb_reg_set(pVBInfo->Part1Port, 0x23,
2789 (unsigned short) (temp3 & 0xff));
2790 }
2791
2792 /* --------------------------------------------------------------------- */
2793 /* Function : XGI_GETLCDVCLKPtr */
2794 /* Input : */
2795 /* Output : al -> VCLK Index */
2796 /* Description : */
2797 /* --------------------------------------------------------------------- */
2798 static void XGI_GetLCDVCLKPtr(unsigned char *di_0, unsigned char *di_1,
2799 struct vb_device_info *pVBInfo)
2800 {
2801 unsigned short index;
2802
2803 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
2804 index = XGI_GetLCDCapPtr1(pVBInfo);
2805
2806 if (pVBInfo->VBInfo & SetCRT2ToLCD) { /* LCDB */
2807 *di_0 = pVBInfo->LCDCapList[index].LCUCHAR_VCLKData1;
2808 *di_1 = pVBInfo->LCDCapList[index].LCUCHAR_VCLKData2;
2809 } else { /* LCDA */
2810 *di_0 = pVBInfo->LCDCapList[index].LCDA_VCLKData1;
2811 *di_1 = pVBInfo->LCDCapList[index].LCDA_VCLKData2;
2812 }
2813 }
2814 return;
2815 }
2816
2817 static unsigned char XGI_GetVCLKPtr(unsigned short RefreshRateTableIndex,
2818 unsigned short ModeNo, unsigned short ModeIdIndex,
2819 struct vb_device_info *pVBInfo)
2820 {
2821
2822 unsigned short index, modeflag;
2823 unsigned char tempal;
2824
2825 if (ModeNo <= 0x13)
2826 /* si+St_ResInfo */
2827 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
2828 else
2829 /* si+Ext_ResInfo */
2830 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2831
2832 if ((pVBInfo->SetFlag & ProgrammingCRT2) &&
2833 (!(pVBInfo->LCDInfo & EnableScalingLCD))) { /* {LCDA/LCDB} */
2834 index = XGI_GetLCDCapPtr(pVBInfo);
2835 tempal = pVBInfo->LCDCapList[index].LCD_VCLK;
2836
2837 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA))
2838 return tempal;
2839
2840 /* {TV} */
2841 if (pVBInfo->VBType &
2842 (VB_XGI301B |
2843 VB_XGI302B |
2844 VB_XGI301LV |
2845 VB_XGI302LV |
2846 VB_XGI301C)) {
2847 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
2848 tempal = HiTVVCLKDIV2;
2849 if (!(pVBInfo->TVInfo & RPLLDIV2XO))
2850 tempal = HiTVVCLK;
2851 if (pVBInfo->TVInfo & TVSimuMode) {
2852 tempal = HiTVSimuVCLK;
2853 if (!(modeflag & Charx8Dot))
2854 tempal = HiTVTextVCLK;
2855
2856 }
2857 return tempal;
2858 }
2859
2860 if (pVBInfo->TVInfo & SetYPbPrMode750p) {
2861 tempal = YPbPr750pVCLK;
2862 return tempal;
2863 }
2864
2865 if (pVBInfo->TVInfo & SetYPbPrMode525p) {
2866 tempal = YPbPr525pVCLK;
2867 return tempal;
2868 }
2869
2870 tempal = NTSC1024VCLK;
2871
2872 if (!(pVBInfo->TVInfo & NTSC1024x768)) {
2873 tempal = TVVCLKDIV2;
2874 if (!(pVBInfo->TVInfo & RPLLDIV2XO))
2875 tempal = TVVCLK;
2876 }
2877
2878 if (pVBInfo->VBInfo & SetCRT2ToTV)
2879 return tempal;
2880 }
2881 } /* {End of VB} */
2882
2883 tempal = (unsigned char) inb((pVBInfo->P3ca + 0x02));
2884 tempal = tempal >> 2;
2885 tempal &= 0x03;
2886
2887 /* for Dot8 Scaling LCD */
2888 if ((pVBInfo->LCDInfo & EnableScalingLCD) && (modeflag & Charx8Dot))
2889 tempal = tempal ^ tempal; /* ; set to VCLK25MHz always */
2890
2891 if (ModeNo <= 0x13)
2892 return tempal;
2893
2894 tempal = pVBInfo->RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
2895 return tempal;
2896 }
2897
2898 static void XGI_GetVCLKLen(unsigned char tempal, unsigned char *di_0,
2899 unsigned char *di_1, struct vb_device_info *pVBInfo)
2900 {
2901 if (pVBInfo->VBType & (VB_XGI301 | VB_XGI301B | VB_XGI302B
2902 | VB_XGI301LV | VB_XGI302LV | VB_XGI301C)) {
2903 if ((!(pVBInfo->VBInfo & SetCRT2ToLCDA)) && (pVBInfo->SetFlag
2904 & ProgrammingCRT2)) {
2905 *di_0 = (unsigned char) XGI_VBVCLKData[tempal].SR2B;
2906 *di_1 = XGI_VBVCLKData[tempal].SR2C;
2907 }
2908 } else {
2909 *di_0 = XGI_VCLKData[tempal].SR2B;
2910 *di_1 = XGI_VCLKData[tempal].SR2C;
2911 }
2912 }
2913
2914 static void XGI_SetCRT2ECLK(unsigned short ModeNo, unsigned short ModeIdIndex,
2915 unsigned short RefreshRateTableIndex,
2916 struct vb_device_info *pVBInfo)
2917 {
2918 unsigned char di_0, di_1, tempal;
2919 int i;
2920
2921 tempal = XGI_GetVCLKPtr(RefreshRateTableIndex, ModeNo, ModeIdIndex,
2922 pVBInfo);
2923 XGI_GetVCLKLen(tempal, &di_0, &di_1, pVBInfo);
2924 XGI_GetLCDVCLKPtr(&di_0, &di_1, pVBInfo);
2925
2926 for (i = 0; i < 4; i++) {
2927 xgifb_reg_and_or(pVBInfo->P3d4, 0x31, ~0x30,
2928 (unsigned short) (0x10 * i));
2929 if ((!(pVBInfo->VBInfo & SetCRT2ToLCDA))
2930 && (!(pVBInfo->VBInfo & SetInSlaveMode))) {
2931 xgifb_reg_set(pVBInfo->P3c4, 0x2e, di_0);
2932 xgifb_reg_set(pVBInfo->P3c4, 0x2f, di_1);
2933 } else {
2934 xgifb_reg_set(pVBInfo->P3c4, 0x2b, di_0);
2935 xgifb_reg_set(pVBInfo->P3c4, 0x2c, di_1);
2936 }
2937 }
2938 }
2939
2940 static void XGI_UpdateModeInfo(struct xgi_hw_device_info *HwDeviceExtension,
2941 struct vb_device_info *pVBInfo)
2942 {
2943 unsigned short tempcl, tempch, temp, tempbl, tempax;
2944
2945 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
2946 | VB_XGI302LV | VB_XGI301C)) {
2947 tempcl = 0;
2948 tempch = 0;
2949 temp = xgifb_reg_get(pVBInfo->P3c4, 0x01);
2950
2951 if (!(temp & 0x20)) {
2952 temp = xgifb_reg_get(pVBInfo->P3d4, 0x17);
2953 if (temp & 0x80) {
2954 temp = xgifb_reg_get(pVBInfo->P3d4, 0x53);
2955 if (!(temp & 0x40))
2956 tempcl |= ActiveCRT1;
2957 }
2958 }
2959
2960 temp = xgifb_reg_get(pVBInfo->Part1Port, 0x2e);
2961 temp &= 0x0f;
2962
2963 if (!(temp == 0x08)) {
2964 /* Check ChannelA by Part1_13 [2003/10/03] */
2965 tempax = xgifb_reg_get(pVBInfo->Part1Port, 0x13);
2966 if (tempax & 0x04)
2967 tempcl = tempcl | ActiveLCD;
2968
2969 temp &= 0x05;
2970
2971 if (!(tempcl & ActiveLCD))
2972 if (temp == 0x01)
2973 tempcl |= ActiveCRT2;
2974
2975 if (temp == 0x04)
2976 tempcl |= ActiveLCD;
2977
2978 if (temp == 0x05) {
2979 temp = xgifb_reg_get(pVBInfo->Part2Port, 0x00);
2980
2981 if (!(temp & 0x08))
2982 tempch |= ActiveAVideo;
2983
2984 if (!(temp & 0x04))
2985 tempch |= ActiveSVideo;
2986
2987 if (temp & 0x02)
2988 tempch |= ActiveSCART;
2989
2990 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
2991 if (temp & 0x01)
2992 tempch |= ActiveHiTV;
2993 }
2994
2995 if (pVBInfo->VBInfo & SetCRT2ToYPbPr) {
2996 temp = xgifb_reg_get(
2997 pVBInfo->Part2Port,
2998 0x4d);
2999
3000 if (temp & 0x10)
3001 tempch |= ActiveYPbPr;
3002 }
3003
3004 if (tempch != 0)
3005 tempcl |= ActiveTV;
3006 }
3007 }
3008
3009 temp = xgifb_reg_get(pVBInfo->P3d4, 0x3d);
3010 if (tempcl & ActiveLCD) {
3011 if ((pVBInfo->SetFlag & ReserveTVOption)) {
3012 if (temp & ActiveTV)
3013 tempcl |= ActiveTV;
3014 }
3015 }
3016 temp = tempcl;
3017 tempbl = ~ModeSwitchStatus;
3018 xgifb_reg_and_or(pVBInfo->P3d4, 0x3d, tempbl, temp);
3019
3020 if (!(pVBInfo->SetFlag & ReserveTVOption))
3021 xgifb_reg_set(pVBInfo->P3d4, 0x3e, tempch);
3022 } else {
3023 return;
3024 }
3025 }
3026
3027 void XGI_GetVBType(struct vb_device_info *pVBInfo)
3028 {
3029 unsigned short flag, tempbx, tempah;
3030
3031 if (pVBInfo->IF_DEF_LVDS == 0) {
3032 tempbx = VB_XGI302B;
3033 flag = xgifb_reg_get(pVBInfo->Part4Port, 0x00);
3034 if (flag != 0x02) {
3035 tempbx = VB_XGI301;
3036 flag = xgifb_reg_get(pVBInfo->Part4Port, 0x01);
3037 if (flag >= 0xB0) {
3038 tempbx = VB_XGI301B;
3039 if (flag >= 0xC0) {
3040 tempbx = VB_XGI301C;
3041 if (flag >= 0xD0) {
3042 tempbx = VB_XGI301LV;
3043 if (flag >= 0xE0) {
3044 tempbx = VB_XGI302LV;
3045 tempah = xgifb_reg_get(
3046 pVBInfo->Part4Port,
3047 0x39);
3048 if (tempah != 0xFF)
3049 tempbx =
3050 VB_XGI301C;
3051 }
3052 }
3053 }
3054
3055 if (tempbx & (VB_XGI301B | VB_XGI302B)) {
3056 flag = xgifb_reg_get(
3057 pVBInfo->Part4Port,
3058 0x23);
3059
3060 if (!(flag & 0x02))
3061 tempbx = tempbx | VB_NoLCD;
3062 }
3063 }
3064 }
3065 pVBInfo->VBType = tempbx;
3066 }
3067 }
3068
3069 static void XGI_GetVBInfo(unsigned short ModeNo, unsigned short ModeIdIndex,
3070 struct xgi_hw_device_info *HwDeviceExtension,
3071 struct vb_device_info *pVBInfo)
3072 {
3073 unsigned short tempax, push, tempbx, temp, modeflag;
3074
3075 if (ModeNo <= 0x13)
3076 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
3077 else
3078 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3079
3080 pVBInfo->SetFlag = 0;
3081 pVBInfo->ModeType = modeflag & ModeInfoFlag;
3082 tempbx = 0;
3083
3084 if (pVBInfo->VBType & 0xFFFF) {
3085 /* Check Display Device */
3086 temp = xgifb_reg_get(pVBInfo->P3d4, 0x30);
3087 tempbx = tempbx | temp;
3088 temp = xgifb_reg_get(pVBInfo->P3d4, 0x31);
3089 push = temp;
3090 push = push << 8;
3091 tempax = temp << 8;
3092 tempbx = tempbx | tempax;
3093 temp = (SetCRT2ToDualEdge | SetCRT2ToYPbPr | SetCRT2ToLCDA
3094 | SetInSlaveMode | DisableCRT2Display);
3095 temp = 0xFFFF ^ temp;
3096 tempbx &= temp;
3097
3098 temp = xgifb_reg_get(pVBInfo->P3d4, 0x38);
3099
3100 if (pVBInfo->IF_DEF_LCDA == 1) {
3101
3102 if ((HwDeviceExtension->jChipType >= XG20) ||
3103 (HwDeviceExtension->jChipType >= XG40)) {
3104 if (pVBInfo->IF_DEF_LVDS == 0) {
3105 if (pVBInfo->VBType &
3106 (VB_XGI302B |
3107 VB_XGI301LV |
3108 VB_XGI302LV |
3109 VB_XGI301C)) {
3110 if (temp & EnableDualEdge) {
3111 tempbx |=
3112 SetCRT2ToDualEdge;
3113
3114 if (temp & SetToLCDA)
3115 tempbx |=
3116 SetCRT2ToLCDA;
3117 }
3118 }
3119 }
3120 }
3121 }
3122
3123 if (pVBInfo->IF_DEF_YPbPr == 1) {
3124 /* [Billy] 07/05/04 */
3125 if (((pVBInfo->IF_DEF_LVDS == 0) &&
3126 ((pVBInfo->VBType & VB_XGI301LV) ||
3127 (pVBInfo->VBType & VB_XGI302LV) ||
3128 (pVBInfo->VBType & VB_XGI301C)))) {
3129 if (temp & SetYPbPr) {
3130 if (pVBInfo->IF_DEF_HiVision == 1) {
3131 /* shampoo add for new
3132 * scratch */
3133 temp = xgifb_reg_get(
3134 pVBInfo->P3d4,
3135 0x35);
3136 temp &= YPbPrMode;
3137 tempbx |= SetCRT2ToHiVisionTV;
3138
3139 if (temp != YPbPrMode1080i) {
3140 tempbx &=
3141 (~SetCRT2ToHiVisionTV);
3142 tempbx |=
3143 SetCRT2ToYPbPr;
3144 }
3145 }
3146 }
3147 }
3148 }
3149
3150 tempax = push; /* restore CR31 */
3151
3152 if (pVBInfo->IF_DEF_LVDS == 0) {
3153 if (pVBInfo->IF_DEF_YPbPr == 1) {
3154 if (pVBInfo->IF_DEF_HiVision == 1)
3155 temp = 0x09FC;
3156 else
3157 temp = 0x097C;
3158 } else {
3159 if (pVBInfo->IF_DEF_HiVision == 1)
3160 temp = 0x01FC;
3161 else
3162 temp = 0x017C;
3163 }
3164 } else { /* 3nd party chip */
3165 temp = SetCRT2ToLCD;
3166 }
3167
3168 if (!(tempbx & temp)) {
3169 tempax |= DisableCRT2Display;
3170 tempbx = 0;
3171 }
3172
3173 if (pVBInfo->IF_DEF_LCDA == 1) { /* Select Display Device */
3174 if (!(pVBInfo->VBType & VB_NoLCD)) {
3175 if (tempbx & SetCRT2ToLCDA) {
3176 if (tempbx & SetSimuScanMode)
3177 tempbx &= (~(SetCRT2ToLCD |
3178 SetCRT2ToRAMDAC |
3179 SwitchToCRT2));
3180 else
3181 tempbx &= (~(SetCRT2ToLCD |
3182 SetCRT2ToRAMDAC |
3183 SetCRT2ToTV |
3184 SwitchToCRT2));
3185 }
3186 }
3187 }
3188
3189 /* shampoo add */
3190 /* for driver abnormal */
3191 if (!(tempbx & (SwitchToCRT2 | SetSimuScanMode))) {
3192 if (pVBInfo->IF_DEF_CRT2Monitor == 1) {
3193 if (tempbx & SetCRT2ToRAMDAC) {
3194 tempbx &= (0xFF00 |
3195 SetCRT2ToRAMDAC |
3196 SwitchToCRT2 |
3197 SetSimuScanMode);
3198 tempbx &= (0x00FF | (~SetCRT2ToYPbPr));
3199 }
3200 } else {
3201 tempbx &= (~(SetCRT2ToRAMDAC |
3202 SetCRT2ToLCD |
3203 SetCRT2ToTV));
3204 }
3205 }
3206
3207 if (!(pVBInfo->VBType & VB_NoLCD)) {
3208 if (tempbx & SetCRT2ToLCD) {
3209 tempbx &= (0xFF00 |
3210 SetCRT2ToLCD |
3211 SwitchToCRT2 |
3212 SetSimuScanMode);
3213 tempbx &= (0x00FF | (~SetCRT2ToYPbPr));
3214 }
3215 }
3216
3217 if (tempbx & SetCRT2ToSCART) {
3218 tempbx &= (0xFF00 |
3219 SetCRT2ToSCART |
3220 SwitchToCRT2 |
3221 SetSimuScanMode);
3222 tempbx &= (0x00FF | (~SetCRT2ToYPbPr));
3223 }
3224
3225 if (pVBInfo->IF_DEF_YPbPr == 1) {
3226 if (tempbx & SetCRT2ToYPbPr)
3227 tempbx &= (0xFF00 |
3228 SwitchToCRT2 |
3229 SetSimuScanMode);
3230 }
3231
3232 if (pVBInfo->IF_DEF_HiVision == 1) {
3233 if (tempbx & SetCRT2ToHiVisionTV)
3234 tempbx &= (0xFF00 |
3235 SetCRT2ToHiVisionTV |
3236 SwitchToCRT2 |
3237 SetSimuScanMode);
3238 }
3239
3240 if (tempax & DisableCRT2Display) { /* Set Display Device Info */
3241 if (!(tempbx & (SwitchToCRT2 | SetSimuScanMode)))
3242 tempbx = DisableCRT2Display;
3243 }
3244
3245 if (!(tempbx & DisableCRT2Display)) {
3246 if ((!(tempbx & DriverMode)) ||
3247 (!(modeflag & CRT2Mode))) {
3248 if (pVBInfo->IF_DEF_LCDA == 1) {
3249 if (!(tempbx & SetCRT2ToLCDA))
3250 tempbx |= (SetInSlaveMode |
3251 SetSimuScanMode);
3252 }
3253 }
3254
3255 /* LCD+TV can't support in slave mode
3256 * (Force LCDA+TV->LCDB) */
3257 if ((tempbx & SetInSlaveMode) &&
3258 (tempbx & SetCRT2ToLCDA)) {
3259 tempbx ^= (SetCRT2ToLCD |
3260 SetCRT2ToLCDA |
3261 SetCRT2ToDualEdge);
3262 pVBInfo->SetFlag |= ReserveTVOption;
3263 }
3264 }
3265 }
3266
3267 pVBInfo->VBInfo = tempbx;
3268 }
3269
3270 static void XGI_GetTVInfo(unsigned short ModeNo, unsigned short ModeIdIndex,
3271 struct vb_device_info *pVBInfo)
3272 {
3273 unsigned short temp, tempbx = 0, resinfo = 0, modeflag, index1;
3274
3275 tempbx = 0;
3276 resinfo = 0;
3277
3278 if (pVBInfo->VBInfo & SetCRT2ToTV) {
3279 if (ModeNo <= 0x13) {
3280 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].
3281 St_ModeFlag; /* si+St_ModeFlag */
3282 resinfo = pVBInfo->SModeIDTable[ModeIdIndex].
3283 St_ResInfo; /* si+St_ResInfo */
3284 } else {
3285 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].
3286 Ext_ModeFlag;
3287 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].
3288 Ext_RESINFO; /* si+Ext_ResInfo */
3289 }
3290
3291 if (pVBInfo->VBInfo & SetCRT2ToTV) {
3292 temp = xgifb_reg_get(pVBInfo->P3d4, 0x35);
3293 tempbx = temp;
3294 if (tempbx & SetPALTV) {
3295 tempbx &= (SetCHTVOverScan |
3296 SetPALMTV |
3297 SetPALNTV |
3298 SetPALTV);
3299 if (tempbx & SetPALMTV)
3300 /* set to NTSC if PAL-M */
3301 tempbx &= ~SetPALTV;
3302 } else
3303 tempbx &= (SetCHTVOverScan |
3304 SetNTSCJ |
3305 SetPALTV);
3306 }
3307
3308 if (pVBInfo->IF_DEF_LVDS == 0) {
3309 if (pVBInfo->VBInfo & SetCRT2ToSCART)
3310 tempbx |= SetPALTV;
3311 }
3312
3313 if (pVBInfo->IF_DEF_YPbPr == 1) {
3314 if (pVBInfo->VBInfo & SetCRT2ToYPbPr) {
3315 index1 = xgifb_reg_get(pVBInfo->P3d4, 0x35);
3316 index1 &= YPbPrMode;
3317
3318 if (index1 == YPbPrMode525i)
3319 tempbx |= SetYPbPrMode525i;
3320
3321 if (index1 == YPbPrMode525p)
3322 tempbx = tempbx | SetYPbPrMode525p;
3323 if (index1 == YPbPrMode750p)
3324 tempbx = tempbx | SetYPbPrMode750p;
3325 }
3326 }
3327
3328 if (pVBInfo->IF_DEF_HiVision == 1) {
3329 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV)
3330 tempbx = tempbx | SetYPbPrMode1080i | SetPALTV;
3331 }
3332
3333 if (pVBInfo->IF_DEF_LVDS == 0) { /* shampoo */
3334 if ((pVBInfo->VBInfo & SetInSlaveMode) &&
3335 (!(pVBInfo->VBInfo & SetNotSimuMode)))
3336 tempbx |= TVSimuMode;
3337
3338 if (!(tempbx & SetPALTV) &&
3339 (modeflag > 13) &&
3340 (resinfo == 8)) /* NTSC 1024x768, */
3341 tempbx |= NTSC1024x768;
3342
3343 tempbx |= RPLLDIV2XO;
3344
3345 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
3346 if (pVBInfo->VBInfo & SetInSlaveMode)
3347 tempbx &= (~RPLLDIV2XO);
3348 } else {
3349 if (tempbx &
3350 (SetYPbPrMode525p | SetYPbPrMode750p))
3351 tempbx &= (~RPLLDIV2XO);
3352 else if (!(pVBInfo->VBType &
3353 (VB_XGI301B |
3354 VB_XGI302B |
3355 VB_XGI301LV |
3356 VB_XGI302LV |
3357 VB_XGI301C))) {
3358 if (tempbx & TVSimuMode)
3359 tempbx &= (~RPLLDIV2XO);
3360 }
3361 }
3362 }
3363 }
3364 pVBInfo->TVInfo = tempbx;
3365 }
3366
3367 static unsigned char XGI_GetLCDInfo(unsigned short ModeNo,
3368 unsigned short ModeIdIndex, struct vb_device_info *pVBInfo)
3369 {
3370 unsigned short temp, tempax, tempbx, modeflag, resinfo = 0, LCDIdIndex;
3371
3372 pVBInfo->LCDResInfo = 0;
3373 pVBInfo->LCDTypeInfo = 0;
3374 pVBInfo->LCDInfo = 0;
3375
3376 if (ModeNo <= 0x13) {
3377 /* si+St_ModeFlag // */
3378 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
3379 } else {
3380 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3381 /* si+Ext_ResInfo // */
3382 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
3383 }
3384
3385 temp = xgifb_reg_get(pVBInfo->P3d4, 0x36); /* Get LCD Res.Info */
3386 tempbx = temp & 0x0F;
3387
3388 if (tempbx == 0)
3389 tempbx = Panel1024x768; /* default */
3390
3391 /* LCD75 [2003/8/22] Vicent */
3392 if ((tempbx == Panel1024x768) || (tempbx == Panel1280x1024)) {
3393 if (pVBInfo->VBInfo & DriverMode) {
3394 tempax = xgifb_reg_get(pVBInfo->P3d4, 0x33);
3395 if (pVBInfo->VBInfo & SetCRT2ToLCDA)
3396 tempax &= 0x0F;
3397 else
3398 tempax = tempax >> 4;
3399
3400 if ((resinfo == 6) || (resinfo == 9)) {
3401 if (tempax >= 3)
3402 tempbx |= PanelRef75Hz;
3403 } else if ((resinfo == 7) || (resinfo == 8)) {
3404 if (tempax >= 4)
3405 tempbx |= PanelRef75Hz;
3406 }
3407 }
3408 }
3409
3410 pVBInfo->LCDResInfo = tempbx;
3411
3412 /* End of LCD75 */
3413
3414 if (!(pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)))
3415 return 0;
3416
3417 tempbx = 0;
3418
3419 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
3420
3421 temp &= (ScalingLCD | LCDNonExpanding | LCDSyncBit | SetPWDEnable);
3422
3423 tempbx |= temp;
3424
3425 LCDIdIndex = XGI_GetLCDCapPtr1(pVBInfo);
3426
3427 tempax = pVBInfo->LCDCapList[LCDIdIndex].LCD_Capability;
3428
3429 if (pVBInfo->IF_DEF_LVDS == 0) { /* shampoo */
3430 if (((pVBInfo->VBType & VB_XGI302LV) || (pVBInfo->VBType
3431 & VB_XGI301C)) && (tempax & LCDDualLink)) {
3432 tempbx |= SetLCDDualLink;
3433 }
3434 }
3435
3436 if (pVBInfo->IF_DEF_LVDS == 0) {
3437 if ((pVBInfo->LCDResInfo == Panel1400x1050) && (pVBInfo->VBInfo
3438 & SetCRT2ToLCD) && (ModeNo > 0x13) && (resinfo
3439 == 9) && (!(tempbx & EnableScalingLCD)))
3440 /* set to center in 1280x1024 LCDB for Panel1400x1050 */
3441 tempbx |= SetLCDtoNonExpanding;
3442 }
3443
3444 if (pVBInfo->IF_DEF_ExpLink == 1) {
3445 if (modeflag & HalfDCLK) {
3446 if (!(tempbx & SetLCDtoNonExpanding)) {
3447 tempbx |= EnableLVDSDDA;
3448 } else {
3449 if (ModeNo > 0x13) {
3450 if (pVBInfo->LCDResInfo
3451 == Panel1024x768) {
3452 if (resinfo == 4) {/* 512x384 */
3453 tempbx |= EnableLVDSDDA;
3454 }
3455 }
3456 }
3457 }
3458 }
3459 }
3460
3461 if (pVBInfo->VBInfo & SetInSlaveMode) {
3462 if (pVBInfo->VBInfo & SetNotSimuMode)
3463 tempbx |= LCDVESATiming;
3464 } else {
3465 tempbx |= LCDVESATiming;
3466 }
3467
3468 pVBInfo->LCDInfo = tempbx;
3469
3470 if (pVBInfo->IF_DEF_LVDS == 0) {
3471 if (tempax & (LockLCDBToA | StLCDBToA)) {
3472 if (pVBInfo->VBInfo & SetInSlaveMode) {
3473 if (!(tempax & LockLCDBToA)) {
3474 if (ModeNo <= 0x13) {
3475 pVBInfo->VBInfo &=
3476 ~(SetSimuScanMode |
3477 SetInSlaveMode |
3478 SetCRT2ToLCD);
3479 pVBInfo->VBInfo |=
3480 SetCRT2ToLCDA |
3481 SetCRT2ToDualEdge;
3482 }
3483 }
3484 }
3485 }
3486 }
3487
3488 return 1;
3489 }
3490
3491 unsigned char XGI_SearchModeID(unsigned short ModeNo,
3492 unsigned short *ModeIdIndex, struct vb_device_info *pVBInfo)
3493 {
3494 if (ModeNo <= 5)
3495 ModeNo |= 1;
3496 if (ModeNo <= 0x13) {
3497 for (*ModeIdIndex = 0;; (*ModeIdIndex)++) {
3498 if (pVBInfo->SModeIDTable[*ModeIdIndex].St_ModeID ==
3499 ModeNo)
3500 break;
3501 if (pVBInfo->SModeIDTable[*ModeIdIndex].St_ModeID ==
3502 0xFF)
3503 return 0;
3504 }
3505
3506 if (ModeNo == 0x07)
3507 (*ModeIdIndex)++; /* 400 lines */
3508 if (ModeNo <= 3)
3509 (*ModeIdIndex) += 2; /* 400 lines */
3510 /* else 350 lines */
3511 } else {
3512 for (*ModeIdIndex = 0;; (*ModeIdIndex)++) {
3513 if (pVBInfo->EModeIDTable[*ModeIdIndex].Ext_ModeID ==
3514 ModeNo)
3515 break;
3516 if (pVBInfo->EModeIDTable[*ModeIdIndex].Ext_ModeID ==
3517 0xFF)
3518 return 0;
3519 }
3520 }
3521
3522 return 1;
3523 }
3524
3525 static unsigned char XG21GPIODataTransfer(unsigned char ujDate)
3526 {
3527 unsigned char ujRet = 0;
3528 unsigned char i = 0;
3529
3530 for (i = 0; i < 8; i++) {
3531 ujRet = ujRet << 1;
3532 ujRet |= (ujDate >> i) & 1;
3533 }
3534
3535 return ujRet;
3536 }
3537
3538 /*----------------------------------------------------------------------------*/
3539 /* output */
3540 /* bl[5] : LVDS signal */
3541 /* bl[1] : LVDS backlight */
3542 /* bl[0] : LVDS VDD */
3543 /*----------------------------------------------------------------------------*/
3544 static unsigned char XGI_XG21GetPSCValue(struct vb_device_info *pVBInfo)
3545 {
3546 unsigned char CR4A, temp;
3547
3548 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
3549 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~0x23); /* enable GPIO write */
3550
3551 temp = xgifb_reg_get(pVBInfo->P3d4, 0x48);
3552
3553 temp = XG21GPIODataTransfer(temp);
3554 temp &= 0x23;
3555 xgifb_reg_set(pVBInfo->P3d4, 0x4A, CR4A);
3556 return temp;
3557 }
3558
3559 /*----------------------------------------------------------------------------*/
3560 /* output */
3561 /* bl[5] : LVDS signal */
3562 /* bl[1] : LVDS backlight */
3563 /* bl[0] : LVDS VDD */
3564 /*----------------------------------------------------------------------------*/
3565 static unsigned char XGI_XG27GetPSCValue(struct vb_device_info *pVBInfo)
3566 {
3567 unsigned char CR4A, CRB4, temp;
3568
3569 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
3570 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~0x0C); /* enable GPIO write */
3571
3572 temp = xgifb_reg_get(pVBInfo->P3d4, 0x48);
3573
3574 temp &= 0x0C;
3575 temp >>= 2;
3576 xgifb_reg_set(pVBInfo->P3d4, 0x4A, CR4A);
3577 CRB4 = xgifb_reg_get(pVBInfo->P3d4, 0xB4);
3578 temp |= ((CRB4 & 0x04) << 3);
3579 return temp;
3580 }
3581
3582 /*----------------------------------------------------------------------------*/
3583 /* input */
3584 /* bl[5] : 1;LVDS signal on */
3585 /* bl[1] : 1;LVDS backlight on */
3586 /* bl[0] : 1:LVDS VDD on */
3587 /* bh: 100000b : clear bit 5, to set bit5 */
3588 /* 000010b : clear bit 1, to set bit1 */
3589 /* 000001b : clear bit 0, to set bit0 */
3590 /*----------------------------------------------------------------------------*/
3591 static void XGI_XG21BLSignalVDD(unsigned short tempbh, unsigned short tempbl,
3592 struct vb_device_info *pVBInfo)
3593 {
3594 unsigned char CR4A, temp;
3595
3596 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
3597 tempbh &= 0x23;
3598 tempbl &= 0x23;
3599 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~tempbh); /* enable GPIO write */
3600
3601 if (tempbh & 0x20) {
3602 temp = (tempbl >> 4) & 0x02;
3603
3604 /* CR B4[1] */
3605 xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~0x02, temp);
3606
3607 }
3608
3609 temp = xgifb_reg_get(pVBInfo->P3d4, 0x48);
3610
3611 temp = XG21GPIODataTransfer(temp);
3612 temp &= ~tempbh;
3613 temp |= tempbl;
3614 xgifb_reg_set(pVBInfo->P3d4, 0x48, temp);
3615 }
3616
3617 static void XGI_XG27BLSignalVDD(unsigned short tempbh, unsigned short tempbl,
3618 struct vb_device_info *pVBInfo)
3619 {
3620 unsigned char CR4A, temp;
3621 unsigned short tempbh0, tempbl0;
3622
3623 tempbh0 = tempbh;
3624 tempbl0 = tempbl;
3625 tempbh0 &= 0x20;
3626 tempbl0 &= 0x20;
3627 tempbh0 >>= 3;
3628 tempbl0 >>= 3;
3629
3630 if (tempbh & 0x20) {
3631 temp = (tempbl >> 4) & 0x02;
3632
3633 /* CR B4[1] */
3634 xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~0x02, temp);
3635
3636 }
3637 xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~tempbh0, tempbl0);
3638
3639 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
3640 tempbh &= 0x03;
3641 tempbl &= 0x03;
3642 tempbh <<= 2;
3643 tempbl <<= 2; /* GPIOC,GPIOD */
3644 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~tempbh); /* enable GPIO write */
3645 xgifb_reg_and_or(pVBInfo->P3d4, 0x48, ~tempbh, tempbl);
3646 }
3647
3648 /* --------------------------------------------------------------------- */
3649 /* Function : XGI_XG21SetPanelDelay */
3650 /* Input : */
3651 /* Output : */
3652 /* Description : */
3653 /* I/P : bl : 1 ; T1 : the duration between CPL on and signal on */
3654 /* : bl : 2 ; T2 : the duration signal on and Vdd on */
3655 /* : bl : 3 ; T3 : the duration between CPL off and signal off */
3656 /* : bl : 4 ; T4 : the duration signal off and Vdd off */
3657 /* --------------------------------------------------------------------- */
3658 static void XGI_XG21SetPanelDelay(struct xgifb_video_info *xgifb_info,
3659 unsigned short tempbl,
3660 struct vb_device_info *pVBInfo)
3661 {
3662 if (tempbl == 1)
3663 mdelay(xgifb_info->lvds_data.PSC_S1);
3664
3665 if (tempbl == 2)
3666 mdelay(xgifb_info->lvds_data.PSC_S2);
3667
3668 if (tempbl == 3)
3669 mdelay(xgifb_info->lvds_data.PSC_S3);
3670
3671 if (tempbl == 4)
3672 mdelay(xgifb_info->lvds_data.PSC_S4);
3673 }
3674
3675 static void XGI_DisplayOn(struct xgifb_video_info *xgifb_info,
3676 struct xgi_hw_device_info *pXGIHWDE,
3677 struct vb_device_info *pVBInfo)
3678 {
3679
3680 xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xDF, 0x00);
3681 if (pXGIHWDE->jChipType == XG21) {
3682 if (pVBInfo->IF_DEF_LVDS == 1) {
3683 if (!(XGI_XG21GetPSCValue(pVBInfo) & 0x1)) {
3684 /* LVDS VDD on */
3685 XGI_XG21BLSignalVDD(0x01, 0x01, pVBInfo);
3686 XGI_XG21SetPanelDelay(xgifb_info, 2, pVBInfo);
3687 }
3688 if (!(XGI_XG21GetPSCValue(pVBInfo) & 0x20))
3689 /* LVDS signal on */
3690 XGI_XG21BLSignalVDD(0x20, 0x20, pVBInfo);
3691 XGI_XG21SetPanelDelay(xgifb_info, 3, pVBInfo);
3692 /* LVDS backlight on */
3693 XGI_XG21BLSignalVDD(0x02, 0x02, pVBInfo);
3694 } else {
3695 /* DVO/DVI signal on */
3696 XGI_XG21BLSignalVDD(0x20, 0x20, pVBInfo);
3697 }
3698
3699 }
3700
3701 if (pXGIHWDE->jChipType == XG27) {
3702 if (pVBInfo->IF_DEF_LVDS == 1) {
3703 if (!(XGI_XG27GetPSCValue(pVBInfo) & 0x1)) {
3704 /* LVDS VDD on */
3705 XGI_XG27BLSignalVDD(0x01, 0x01, pVBInfo);
3706 XGI_XG21SetPanelDelay(xgifb_info, 2, pVBInfo);
3707 }
3708 if (!(XGI_XG27GetPSCValue(pVBInfo) & 0x20))
3709 /* LVDS signal on */
3710 XGI_XG27BLSignalVDD(0x20, 0x20, pVBInfo);
3711 XGI_XG21SetPanelDelay(xgifb_info, 3, pVBInfo);
3712 /* LVDS backlight on */
3713 XGI_XG27BLSignalVDD(0x02, 0x02, pVBInfo);
3714 } else {
3715 /* DVO/DVI signal on */
3716 XGI_XG27BLSignalVDD(0x20, 0x20, pVBInfo);
3717 }
3718
3719 }
3720 }
3721
3722 void XGI_DisplayOff(struct xgifb_video_info *xgifb_info,
3723 struct xgi_hw_device_info *pXGIHWDE,
3724 struct vb_device_info *pVBInfo)
3725 {
3726
3727 if (pXGIHWDE->jChipType == XG21) {
3728 if (pVBInfo->IF_DEF_LVDS == 1) {
3729 /* LVDS backlight off */
3730 XGI_XG21BLSignalVDD(0x02, 0x00, pVBInfo);
3731 XGI_XG21SetPanelDelay(xgifb_info, 3, pVBInfo);
3732 } else {
3733 /* DVO/DVI signal off */
3734 XGI_XG21BLSignalVDD(0x20, 0x00, pVBInfo);
3735 }
3736 }
3737
3738 if (pXGIHWDE->jChipType == XG27) {
3739 if ((XGI_XG27GetPSCValue(pVBInfo) & 0x2)) {
3740 /* LVDS backlight off */
3741 XGI_XG27BLSignalVDD(0x02, 0x00, pVBInfo);
3742 XGI_XG21SetPanelDelay(xgifb_info, 3, pVBInfo);
3743 }
3744
3745 if (pVBInfo->IF_DEF_LVDS == 0)
3746 /* DVO/DVI signal off */
3747 XGI_XG27BLSignalVDD(0x20, 0x00, pVBInfo);
3748 }
3749
3750 xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xDF, 0x20);
3751 }
3752
3753 static void XGI_WaitDisply(struct vb_device_info *pVBInfo)
3754 {
3755 while ((inb(pVBInfo->P3da) & 0x01))
3756 break;
3757
3758 while (!(inb(pVBInfo->P3da) & 0x01))
3759 break;
3760 }
3761
3762 static void XGI_AutoThreshold(struct vb_device_info *pVBInfo)
3763 {
3764 xgifb_reg_or(pVBInfo->Part1Port, 0x01, 0x40);
3765 }
3766
3767 static void XGI_SaveCRT2Info(unsigned short ModeNo,
3768 struct vb_device_info *pVBInfo)
3769 {
3770 unsigned short temp1, temp2;
3771
3772 /* reserve CR34 for CRT1 Mode No */
3773 xgifb_reg_set(pVBInfo->P3d4, 0x34, ModeNo);
3774 temp1 = (pVBInfo->VBInfo & SetInSlaveMode) >> 8;
3775 temp2 = ~(SetInSlaveMode >> 8);
3776 xgifb_reg_and_or(pVBInfo->P3d4, 0x31, temp2, temp1);
3777 }
3778
3779 static void XGI_GetCRT2ResInfo(unsigned short ModeNo,
3780 unsigned short ModeIdIndex,
3781 struct vb_device_info *pVBInfo)
3782 {
3783 unsigned short xres, yres, modeflag, resindex;
3784
3785 resindex = XGI_GetResInfo(ModeNo, ModeIdIndex, pVBInfo);
3786 if (ModeNo <= 0x13) {
3787 xres = pVBInfo->StResInfo[resindex].HTotal;
3788 yres = pVBInfo->StResInfo[resindex].VTotal;
3789 } else {
3790 xres = pVBInfo->ModeResInfo[resindex].HTotal; /* xres->ax */
3791 yres = pVBInfo->ModeResInfo[resindex].VTotal; /* yres->bx */
3792 /* si+St_ModeFlag */
3793 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3794
3795 if (modeflag & HalfDCLK)
3796 xres *= 2;
3797
3798 if (modeflag & DoubleScanMode)
3799 yres *= 2;
3800 }
3801
3802 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
3803 if (pVBInfo->IF_DEF_LVDS == 0) {
3804 if (pVBInfo->LCDResInfo == Panel1600x1200) {
3805 if (!(pVBInfo->LCDInfo & LCDVESATiming)) {
3806 if (yres == 1024)
3807 yres = 1056;
3808 }
3809 }
3810
3811 if (pVBInfo->LCDResInfo == Panel1280x1024) {
3812 if (yres == 400)
3813 yres = 405;
3814 else if (yres == 350)
3815 yres = 360;
3816
3817 if (pVBInfo->LCDInfo & LCDVESATiming) {
3818 if (yres == 360)
3819 yres = 375;
3820 }
3821 }
3822
3823 if (pVBInfo->LCDResInfo == Panel1024x768) {
3824 if (!(pVBInfo->LCDInfo & LCDVESATiming)) {
3825 if (!(pVBInfo->LCDInfo
3826 & LCDNonExpanding)) {
3827 if (yres == 350)
3828 yres = 357;
3829 else if (yres == 400)
3830 yres = 420;
3831 else if (yres == 480)
3832 yres = 525;
3833 }
3834 }
3835 }
3836 }
3837
3838 if (xres == 720)
3839 xres = 640;
3840 }
3841
3842 pVBInfo->VGAHDE = xres;
3843 pVBInfo->HDE = xres;
3844 pVBInfo->VGAVDE = yres;
3845 pVBInfo->VDE = yres;
3846 }
3847
3848 static unsigned char XGI_IsLCDDualLink(struct vb_device_info *pVBInfo)
3849 {
3850
3851 if ((pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) &&
3852 (pVBInfo->LCDInfo & SetLCDDualLink)) /* shampoo0129 */
3853 return 1;
3854
3855 return 0;
3856 }
3857
3858 static void XGI_GetRAMDAC2DATA(unsigned short ModeNo,
3859 unsigned short ModeIdIndex,
3860 unsigned short RefreshRateTableIndex,
3861 struct vb_device_info *pVBInfo)
3862 {
3863 unsigned short tempax, tempbx, temp1, temp2, modeflag = 0, tempcx,
3864 StandTableIndex, CRT1Index;
3865
3866 pVBInfo->RVBHCMAX = 1;
3867 pVBInfo->RVBHCFACT = 1;
3868
3869 if (ModeNo <= 0x13) {
3870 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
3871 StandTableIndex = XGI_GetModePtr(ModeNo, ModeIdIndex, pVBInfo);
3872 tempax = pVBInfo->StandTable[StandTableIndex].CRTC[0];
3873 tempbx = pVBInfo->StandTable[StandTableIndex].CRTC[6];
3874 temp1 = pVBInfo->StandTable[StandTableIndex].CRTC[7];
3875 } else {
3876 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3877 CRT1Index = pVBInfo->RefIndex[RefreshRateTableIndex].
3878 Ext_CRT1CRTC;
3879 CRT1Index &= IndexMask;
3880 temp1 = (unsigned short) pVBInfo->
3881 XGINEWUB_CRT1Table[CRT1Index].CR[0];
3882 temp2 = (unsigned short) pVBInfo->
3883 XGINEWUB_CRT1Table[CRT1Index].CR[5];
3884 tempax = (temp1 & 0xFF) | ((temp2 & 0x03) << 8);
3885 tempbx = (unsigned short) pVBInfo->
3886 XGINEWUB_CRT1Table[CRT1Index].CR[8];
3887 tempcx = (unsigned short) pVBInfo->
3888 XGINEWUB_CRT1Table[CRT1Index].CR[14] << 8;
3889 tempcx &= 0x0100;
3890 tempcx = tempcx << 2;
3891 tempbx |= tempcx;
3892 temp1 = (unsigned short) pVBInfo->
3893 XGINEWUB_CRT1Table[CRT1Index].CR[9];
3894 }
3895
3896 if (temp1 & 0x01)
3897 tempbx |= 0x0100;
3898
3899 if (temp1 & 0x20)
3900 tempbx |= 0x0200;
3901 tempax += 5;
3902
3903 if (modeflag & Charx8Dot)
3904 tempax *= 8;
3905 else
3906 tempax *= 9;
3907
3908 pVBInfo->VGAHT = tempax;
3909 pVBInfo->HT = tempax;
3910 tempbx++;
3911 pVBInfo->VGAVT = tempbx;
3912 pVBInfo->VT = tempbx;
3913 }
3914
3915 static void XGI_GetCRT2Data(unsigned short ModeNo, unsigned short ModeIdIndex,
3916 unsigned short RefreshRateTableIndex,
3917 struct vb_device_info *pVBInfo)
3918 {
3919 unsigned short tempax = 0, tempbx, modeflag, resinfo;
3920
3921 struct XGI_LCDDataStruct *LCDPtr = NULL;
3922 struct XGI_TVDataStruct *TVPtr = NULL;
3923
3924 if (ModeNo <= 0x13) {
3925 /* si+St_ResInfo */
3926 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
3927 resinfo = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
3928 } else {
3929 /* si+Ext_ResInfo */
3930 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3931 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
3932 }
3933
3934 pVBInfo->NewFlickerMode = 0;
3935 pVBInfo->RVBHRS = 50;
3936
3937 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
3938 XGI_GetRAMDAC2DATA(ModeNo, ModeIdIndex, RefreshRateTableIndex,
3939 pVBInfo);
3940 return;
3941 }
3942
3943 tempbx = 4;
3944
3945 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
3946 LCDPtr = (struct XGI_LCDDataStruct *) XGI_GetLcdPtr(tempbx,
3947 ModeNo, ModeIdIndex, RefreshRateTableIndex,
3948 pVBInfo);
3949
3950 pVBInfo->RVBHCMAX = LCDPtr->RVBHCMAX;
3951 pVBInfo->RVBHCFACT = LCDPtr->RVBHCFACT;
3952 pVBInfo->VGAHT = LCDPtr->VGAHT;
3953 pVBInfo->VGAVT = LCDPtr->VGAVT;
3954 pVBInfo->HT = LCDPtr->LCDHT;
3955 pVBInfo->VT = LCDPtr->LCDVT;
3956
3957 if (pVBInfo->LCDResInfo == Panel1024x768) {
3958 tempax = 1024;
3959 tempbx = 768;
3960
3961 if (!(pVBInfo->LCDInfo & LCDVESATiming)) {
3962 if (pVBInfo->VGAVDE == 357)
3963 tempbx = 527;
3964 else if (pVBInfo->VGAVDE == 420)
3965 tempbx = 620;
3966 else if (pVBInfo->VGAVDE == 525)
3967 tempbx = 775;
3968 else if (pVBInfo->VGAVDE == 600)
3969 tempbx = 775;
3970 else
3971 tempbx = 768;
3972 } else
3973 tempbx = 768;
3974 } else if (pVBInfo->LCDResInfo == Panel1024x768x75) {
3975 tempax = 1024;
3976 tempbx = 768;
3977 } else if (pVBInfo->LCDResInfo == Panel1280x1024) {
3978 tempax = 1280;
3979 if (pVBInfo->VGAVDE == 360)
3980 tempbx = 768;
3981 else if (pVBInfo->VGAVDE == 375)
3982 tempbx = 800;
3983 else if (pVBInfo->VGAVDE == 405)
3984 tempbx = 864;
3985 else
3986 tempbx = 1024;
3987 } else if (pVBInfo->LCDResInfo == Panel1280x1024x75) {
3988 tempax = 1280;
3989 tempbx = 1024;
3990 } else if (pVBInfo->LCDResInfo == Panel1280x960) {
3991 tempax = 1280;
3992 if (pVBInfo->VGAVDE == 350)
3993 tempbx = 700;
3994 else if (pVBInfo->VGAVDE == 400)
3995 tempbx = 800;
3996 else if (pVBInfo->VGAVDE == 1024)
3997 tempbx = 960;
3998 else
3999 tempbx = 960;
4000 } else if (pVBInfo->LCDResInfo == Panel1400x1050) {
4001 tempax = 1400;
4002 tempbx = 1050;
4003
4004 if (pVBInfo->VGAVDE == 1024) {
4005 tempax = 1280;
4006 tempbx = 1024;
4007 }
4008 } else if (pVBInfo->LCDResInfo == Panel1600x1200) {
4009 tempax = 1600;
4010 tempbx = 1200; /* alan 10/14/2003 */
4011 if (!(pVBInfo->LCDInfo & LCDVESATiming)) {
4012 if (pVBInfo->VGAVDE == 350)
4013 tempbx = 875;
4014 else if (pVBInfo->VGAVDE == 400)
4015 tempbx = 1000;
4016 }
4017 }
4018
4019 if (pVBInfo->LCDInfo & LCDNonExpanding) {
4020 tempax = pVBInfo->VGAHDE;
4021 tempbx = pVBInfo->VGAVDE;
4022 }
4023
4024 pVBInfo->HDE = tempax;
4025 pVBInfo->VDE = tempbx;
4026 return;
4027 }
4028
4029 if (pVBInfo->VBInfo & (SetCRT2ToTV)) {
4030 tempbx = 4;
4031 TVPtr = (struct XGI_TVDataStruct *) XGI_GetTVPtr(tempbx,
4032 ModeNo, ModeIdIndex, RefreshRateTableIndex,
4033 pVBInfo);
4034
4035 pVBInfo->RVBHCMAX = TVPtr->RVBHCMAX;
4036 pVBInfo->RVBHCFACT = TVPtr->RVBHCFACT;
4037 pVBInfo->VGAHT = TVPtr->VGAHT;
4038 pVBInfo->VGAVT = TVPtr->VGAVT;
4039 pVBInfo->HDE = TVPtr->TVHDE;
4040 pVBInfo->VDE = TVPtr->TVVDE;
4041 pVBInfo->RVBHRS = TVPtr->RVBHRS;
4042 pVBInfo->NewFlickerMode = TVPtr->FlickerMode;
4043
4044 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
4045 if (resinfo == 0x08)
4046 pVBInfo->NewFlickerMode = 0x40;
4047 else if (resinfo == 0x09)
4048 pVBInfo->NewFlickerMode = 0x40;
4049 else if (resinfo == 0x12)
4050 pVBInfo->NewFlickerMode = 0x40;
4051
4052 if (pVBInfo->VGAVDE == 350)
4053 pVBInfo->TVInfo |= TVSimuMode;
4054
4055 tempax = ExtHiTVHT;
4056 tempbx = ExtHiTVVT;
4057
4058 if (pVBInfo->VBInfo & SetInSlaveMode) {
4059 if (pVBInfo->TVInfo & TVSimuMode) {
4060 tempax = StHiTVHT;
4061 tempbx = StHiTVVT;
4062
4063 if (!(modeflag & Charx8Dot)) {
4064 tempax = StHiTextTVHT;
4065 tempbx = StHiTextTVVT;
4066 }
4067 }
4068 }
4069 } else if (pVBInfo->VBInfo & SetCRT2ToYPbPr) {
4070 if (pVBInfo->TVInfo & SetYPbPrMode750p) {
4071 tempax = YPbPrTV750pHT; /* Ext750pTVHT */
4072 tempbx = YPbPrTV750pVT; /* Ext750pTVVT */
4073 }
4074
4075 if (pVBInfo->TVInfo & SetYPbPrMode525p) {
4076 tempax = YPbPrTV525pHT; /* Ext525pTVHT */
4077 tempbx = YPbPrTV525pVT; /* Ext525pTVVT */
4078 } else if (pVBInfo->TVInfo & SetYPbPrMode525i) {
4079 tempax = YPbPrTV525iHT; /* Ext525iTVHT */
4080 tempbx = YPbPrTV525iVT; /* Ext525iTVVT */
4081 if (pVBInfo->TVInfo & NTSC1024x768)
4082 tempax = NTSC1024x768HT;
4083 }
4084 } else {
4085 tempax = PALHT;
4086 tempbx = PALVT;
4087 if (!(pVBInfo->TVInfo & SetPALTV)) {
4088 tempax = NTSCHT;
4089 tempbx = NTSCVT;
4090 if (pVBInfo->TVInfo & NTSC1024x768)
4091 tempax = NTSC1024x768HT;
4092 }
4093 }
4094
4095 pVBInfo->HT = tempax;
4096 pVBInfo->VT = tempbx;
4097 return;
4098 }
4099 }
4100
4101 static void XGI_SetCRT2VCLK(unsigned short ModeNo, unsigned short ModeIdIndex,
4102 unsigned short RefreshRateTableIndex,
4103 struct vb_device_info *pVBInfo)
4104 {
4105 unsigned char di_0, di_1, tempal;
4106
4107 tempal = XGI_GetVCLKPtr(RefreshRateTableIndex, ModeNo, ModeIdIndex,
4108 pVBInfo);
4109 XGI_GetVCLKLen(tempal, &di_0, &di_1, pVBInfo);
4110 XGI_GetLCDVCLKPtr(&di_0, &di_1, pVBInfo);
4111
4112 if (pVBInfo->VBType & VB_XGI301) { /* shampoo 0129 */
4113 /* 301 */
4114 xgifb_reg_set(pVBInfo->Part4Port, 0x0A, 0x10);
4115 xgifb_reg_set(pVBInfo->Part4Port, 0x0B, di_1);
4116 xgifb_reg_set(pVBInfo->Part4Port, 0x0A, di_0);
4117 } else { /* 301b/302b/301lv/302lv */
4118 xgifb_reg_set(pVBInfo->Part4Port, 0x0A, di_0);
4119 xgifb_reg_set(pVBInfo->Part4Port, 0x0B, di_1);
4120 }
4121
4122 xgifb_reg_set(pVBInfo->Part4Port, 0x00, 0x12);
4123
4124 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC)
4125 xgifb_reg_or(pVBInfo->Part4Port, 0x12, 0x28);
4126 else
4127 xgifb_reg_or(pVBInfo->Part4Port, 0x12, 0x08);
4128 }
4129
4130 static unsigned short XGI_GetColorDepth(unsigned short ModeNo,
4131 unsigned short ModeIdIndex, struct vb_device_info *pVBInfo)
4132 {
4133 unsigned short ColorDepth[6] = { 1, 2, 4, 4, 6, 8 };
4134 short index;
4135 unsigned short modeflag;
4136
4137 if (ModeNo <= 0x13)
4138 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
4139 else
4140 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4141
4142 index = (modeflag & ModeInfoFlag) - ModeEGA;
4143
4144 if (index < 0)
4145 index = 0;
4146
4147 return ColorDepth[index];
4148 }
4149
4150 static unsigned short XGI_GetOffset(unsigned short ModeNo,
4151 unsigned short ModeIdIndex,
4152 unsigned short RefreshRateTableIndex,
4153 struct xgi_hw_device_info *HwDeviceExtension,
4154 struct vb_device_info *pVBInfo)
4155 {
4156 unsigned short temp, colordepth, modeinfo, index, infoflag,
4157 ColorDepth[] = { 0x01, 0x02, 0x04 };
4158
4159 modeinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeInfo;
4160 if (ModeNo <= 0x14)
4161 infoflag = 0;
4162 else
4163 infoflag = pVBInfo->
4164 RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
4165
4166 index = (modeinfo >> 8) & 0xFF;
4167
4168 temp = pVBInfo->ScreenOffset[index];
4169
4170 if (infoflag & InterlaceMode)
4171 temp = temp << 1;
4172
4173 colordepth = XGI_GetColorDepth(ModeNo, ModeIdIndex, pVBInfo);
4174
4175 if ((ModeNo >= 0x7C) && (ModeNo <= 0x7E)) {
4176 temp = ModeNo - 0x7C;
4177 colordepth = ColorDepth[temp];
4178 temp = 0x6B;
4179 if (infoflag & InterlaceMode)
4180 temp = temp << 1;
4181 return temp * colordepth;
4182 } else {
4183 return temp * colordepth;
4184 }
4185 }
4186
4187 static void XGI_SetCRT2Offset(unsigned short ModeNo,
4188 unsigned short ModeIdIndex,
4189 unsigned short RefreshRateTableIndex,
4190 struct xgi_hw_device_info *HwDeviceExtension,
4191 struct vb_device_info *pVBInfo)
4192 {
4193 unsigned short offset;
4194 unsigned char temp;
4195
4196 if (pVBInfo->VBInfo & SetInSlaveMode)
4197 return;
4198
4199 offset = XGI_GetOffset(ModeNo, ModeIdIndex, RefreshRateTableIndex,
4200 HwDeviceExtension, pVBInfo);
4201 temp = (unsigned char) (offset & 0xFF);
4202 xgifb_reg_set(pVBInfo->Part1Port, 0x07, temp);
4203 temp = (unsigned char) ((offset & 0xFF00) >> 8);
4204 xgifb_reg_set(pVBInfo->Part1Port, 0x09, temp);
4205 temp = (unsigned char) (((offset >> 3) & 0xFF) + 1);
4206 xgifb_reg_set(pVBInfo->Part1Port, 0x03, temp);
4207 }
4208
4209 static void XGI_SetCRT2FIFO(struct vb_device_info *pVBInfo)
4210 {
4211 /* threshold high ,disable auto threshold */
4212 xgifb_reg_set(pVBInfo->Part1Port, 0x01, 0x3B);
4213 /* threshold low default 04h */
4214 xgifb_reg_and_or(pVBInfo->Part1Port, 0x02, ~(0x3F), 0x04);
4215 }
4216
4217 static void XGI_PreSetGroup1(unsigned short ModeNo, unsigned short ModeIdIndex,
4218 struct xgi_hw_device_info *HwDeviceExtension,
4219 unsigned short RefreshRateTableIndex,
4220 struct vb_device_info *pVBInfo)
4221 {
4222 unsigned short tempcx = 0, CRT1Index = 0, resinfo = 0;
4223
4224 if (ModeNo > 0x13) {
4225 CRT1Index = pVBInfo->
4226 RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
4227 CRT1Index &= IndexMask;
4228 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
4229 }
4230
4231 XGI_SetCRT2Offset(ModeNo, ModeIdIndex, RefreshRateTableIndex,
4232 HwDeviceExtension, pVBInfo);
4233 XGI_SetCRT2FIFO(pVBInfo);
4234
4235 for (tempcx = 4; tempcx < 7; tempcx++)
4236 xgifb_reg_set(pVBInfo->Part1Port, tempcx, 0x0);
4237
4238 xgifb_reg_set(pVBInfo->Part1Port, 0x50, 0x00);
4239 xgifb_reg_set(pVBInfo->Part1Port, 0x02, 0x44); /* temp 0206 */
4240 }
4241
4242 static void XGI_SetGroup1(unsigned short ModeNo, unsigned short ModeIdIndex,
4243 struct xgi_hw_device_info *HwDeviceExtension,
4244 unsigned short RefreshRateTableIndex,
4245 struct vb_device_info *pVBInfo)
4246 {
4247 unsigned short temp = 0, tempax = 0, tempbx = 0, tempcx = 0,
4248 pushbx = 0, CRT1Index = 0, modeflag, resinfo = 0;
4249
4250 if (ModeNo > 0x13) {
4251 CRT1Index = pVBInfo->
4252 RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
4253 CRT1Index &= IndexMask;
4254 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
4255 }
4256
4257 if (ModeNo <= 0x13)
4258 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
4259 else
4260 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4261
4262 /* bainy change table name */
4263 if (modeflag & HalfDCLK) {
4264 /* BTVGA2HT 0x08,0x09 */
4265 temp = (pVBInfo->VGAHT / 2 - 1) & 0x0FF;
4266 xgifb_reg_set(pVBInfo->Part1Port, 0x08, temp);
4267 temp = (((pVBInfo->VGAHT / 2 - 1) & 0xFF00) >> 8) << 4;
4268 xgifb_reg_and_or(pVBInfo->Part1Port, 0x09, ~0x0F0, temp);
4269 /* BTVGA2HDEE 0x0A,0x0C */
4270 temp = (pVBInfo->VGAHDE / 2 + 16) & 0x0FF;
4271 xgifb_reg_set(pVBInfo->Part1Port, 0x0A, temp);
4272 tempcx = ((pVBInfo->VGAHT - pVBInfo->VGAHDE) / 2) >> 2;
4273 pushbx = pVBInfo->VGAHDE / 2 + 16;
4274 tempcx = tempcx >> 1;
4275 tempbx = pushbx + tempcx; /* bx BTVGA@HRS 0x0B,0x0C */
4276 tempcx += tempbx;
4277
4278 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
4279 tempbx = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[4];
4280 tempbx |= ((pVBInfo->
4281 XGINEWUB_CRT1Table[CRT1Index].CR[14] &
4282 0xC0) << 2);
4283 tempbx = (tempbx - 3) << 3; /* (VGAHRS-3)*8 */
4284 tempcx = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[5];
4285 tempcx &= 0x1F;
4286 temp = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[15];
4287 temp = (temp & 0x04) << (5 - 2); /* VGAHRE D[5] */
4288 tempcx = ((tempcx | temp) - 3) << 3; /* (VGAHRE-3)*8 */
4289 }
4290
4291 tempbx += 4;
4292 tempcx += 4;
4293
4294 if (tempcx > (pVBInfo->VGAHT / 2))
4295 tempcx = pVBInfo->VGAHT / 2;
4296
4297 temp = tempbx & 0x00FF;
4298
4299 xgifb_reg_set(pVBInfo->Part1Port, 0x0B, temp);
4300 } else {
4301 temp = (pVBInfo->VGAHT - 1) & 0x0FF; /* BTVGA2HT 0x08,0x09 */
4302 xgifb_reg_set(pVBInfo->Part1Port, 0x08, temp);
4303 temp = (((pVBInfo->VGAHT - 1) & 0xFF00) >> 8) << 4;
4304 xgifb_reg_and_or(pVBInfo->Part1Port, 0x09, ~0x0F0, temp);
4305 /* BTVGA2HDEE 0x0A,0x0C */
4306 temp = (pVBInfo->VGAHDE + 16) & 0x0FF;
4307 xgifb_reg_set(pVBInfo->Part1Port, 0x0A, temp);
4308 tempcx = (pVBInfo->VGAHT - pVBInfo->VGAHDE) >> 2; /* cx */
4309 pushbx = pVBInfo->VGAHDE + 16;
4310 tempcx = tempcx >> 1;
4311 tempbx = pushbx + tempcx; /* bx BTVGA@HRS 0x0B,0x0C */
4312 tempcx += tempbx;
4313
4314 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
4315 tempbx = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[3];
4316 tempbx |= ((pVBInfo->
4317 XGINEWUB_CRT1Table[CRT1Index].CR[5] &
4318 0xC0) << 2);
4319 tempbx = (tempbx - 3) << 3; /* (VGAHRS-3)*8 */
4320 tempcx = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[4];
4321 tempcx &= 0x1F;
4322 temp = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[6];
4323 temp = (temp & 0x04) << (5 - 2); /* VGAHRE D[5] */
4324 tempcx = ((tempcx | temp) - 3) << 3; /* (VGAHRE-3)*8 */
4325 tempbx += 16;
4326 tempcx += 16;
4327 }
4328
4329 if (tempcx > pVBInfo->VGAHT)
4330 tempcx = pVBInfo->VGAHT;
4331
4332 temp = tempbx & 0x00FF;
4333 xgifb_reg_set(pVBInfo->Part1Port, 0x0B, temp);
4334 }
4335
4336 tempax = (tempax & 0x00FF) | (tempbx & 0xFF00);
4337 tempbx = pushbx;
4338 tempbx = (tempbx & 0x00FF) | ((tempbx & 0xFF00) << 4);
4339 tempax |= (tempbx & 0xFF00);
4340 temp = (tempax & 0xFF00) >> 8;
4341 xgifb_reg_set(pVBInfo->Part1Port, 0x0C, temp);
4342 temp = tempcx & 0x00FF;
4343 xgifb_reg_set(pVBInfo->Part1Port, 0x0D, temp);
4344 tempcx = (pVBInfo->VGAVT - 1);
4345 temp = tempcx & 0x00FF;
4346
4347 xgifb_reg_set(pVBInfo->Part1Port, 0x0E, temp);
4348 tempbx = pVBInfo->VGAVDE - 1;
4349 temp = tempbx & 0x00FF;
4350 xgifb_reg_set(pVBInfo->Part1Port, 0x0F, temp);
4351 temp = ((tempbx & 0xFF00) << 3) >> 8;
4352 temp |= ((tempcx & 0xFF00) >> 8);
4353 xgifb_reg_set(pVBInfo->Part1Port, 0x12, temp);
4354
4355 tempax = pVBInfo->VGAVDE;
4356 tempbx = pVBInfo->VGAVDE;
4357 tempcx = pVBInfo->VGAVT;
4358 /* BTVGA2VRS 0x10,0x11 */
4359 tempbx = (pVBInfo->VGAVT + pVBInfo->VGAVDE) >> 1;
4360 /* BTVGA2VRE 0x11 */
4361 tempcx = ((pVBInfo->VGAVT - pVBInfo->VGAVDE) >> 4) + tempbx + 1;
4362
4363 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
4364 tempbx = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[10];
4365 temp = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[9];
4366
4367 if (temp & 0x04)
4368 tempbx |= 0x0100;
4369
4370 if (temp & 0x080)
4371 tempbx |= 0x0200;
4372
4373 temp = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[14];
4374
4375 if (temp & 0x08)
4376 tempbx |= 0x0400;
4377
4378 temp = pVBInfo->XGINEWUB_CRT1Table[CRT1Index].CR[11];
4379 tempcx = (tempcx & 0xFF00) | (temp & 0x00FF);
4380 }
4381
4382 temp = tempbx & 0x00FF;
4383 xgifb_reg_set(pVBInfo->Part1Port, 0x10, temp);
4384 temp = ((tempbx & 0xFF00) >> 8) << 4;
4385 temp = ((tempcx & 0x000F) | (temp));
4386 xgifb_reg_set(pVBInfo->Part1Port, 0x11, temp);
4387 tempax = 0;
4388
4389 if (modeflag & DoubleScanMode)
4390 tempax |= 0x80;
4391
4392 if (modeflag & HalfDCLK)
4393 tempax |= 0x40;
4394
4395 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2C, ~0x0C0, tempax);
4396 }
4397
4398 static unsigned short XGI_GetVGAHT2(struct vb_device_info *pVBInfo)
4399 {
4400 unsigned long tempax, tempbx;
4401
4402 tempbx = ((pVBInfo->VGAVT - pVBInfo->VGAVDE) * pVBInfo->RVBHCMAX)
4403 & 0xFFFF;
4404 tempax = (pVBInfo->VT - pVBInfo->VDE) * pVBInfo->RVBHCFACT;
4405 tempax = (tempax * pVBInfo->HT) / tempbx;
4406
4407 return (unsigned short) tempax;
4408 }
4409
4410 static void XGI_SetLockRegs(unsigned short ModeNo, unsigned short ModeIdIndex,
4411 struct xgi_hw_device_info *HwDeviceExtension,
4412 unsigned short RefreshRateTableIndex,
4413 struct vb_device_info *pVBInfo)
4414 {
4415 unsigned short push1, push2, tempax, tempbx = 0, tempcx, temp, resinfo,
4416 modeflag, CRT1Index;
4417
4418 if (ModeNo <= 0x13) {
4419 /* si+St_ResInfo */
4420 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
4421 resinfo = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
4422 } else {
4423 /* si+Ext_ResInfo */
4424 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4425 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
4426 CRT1Index = pVBInfo->
4427 RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
4428 CRT1Index &= IndexMask;
4429 }
4430
4431 if (!(pVBInfo->VBInfo & SetInSlaveMode))
4432 return;
4433
4434 temp = 0xFF; /* set MAX HT */
4435 xgifb_reg_set(pVBInfo->Part1Port, 0x03, temp);
4436 tempcx = 0x08;
4437
4438 if (pVBInfo->VBType & (VB_XGI301LV | VB_XGI302LV | VB_XGI301C))
4439 modeflag |= Charx8Dot;
4440
4441 tempax = pVBInfo->VGAHDE; /* 0x04 Horizontal Display End */
4442
4443 if (modeflag & HalfDCLK)
4444 tempax = tempax >> 1;
4445
4446 tempax = (tempax / tempcx) - 1;
4447 tempbx |= ((tempax & 0x00FF) << 8);
4448 temp = tempax & 0x00FF;
4449 xgifb_reg_set(pVBInfo->Part1Port, 0x04, temp);
4450
4451 temp = (tempbx & 0xFF00) >> 8;
4452
4453 if (pVBInfo->VBInfo & SetCRT2ToTV) {
4454 if (!(pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
4455 | VB_XGI302LV | VB_XGI301C)))
4456 temp += 2;
4457
4458 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
4459 if (pVBInfo->VBType & VB_XGI301LV) {
4460 if (pVBInfo->VBExtInfo == VB_YPbPr1080i) {
4461 if (resinfo == 7)
4462 temp -= 2;
4463 }
4464 } else if (resinfo == 7) {
4465 temp -= 2;
4466 }
4467 }
4468 }
4469
4470 /* 0x05 Horizontal Display Start */
4471 xgifb_reg_set(pVBInfo->Part1Port, 0x05, temp);
4472 /* 0x06 Horizontal Blank end */
4473 xgifb_reg_set(pVBInfo->Part1Port, 0x06, 0x03);
4474
4475 if (!(pVBInfo->VBInfo & DisableCRT2Display)) { /* 030226 bainy */
4476 if (pVBInfo->VBInfo & SetCRT2ToTV)
4477 tempax = pVBInfo->VGAHT;
4478 else
4479 tempax = XGI_GetVGAHT2(pVBInfo);
4480 }
4481
4482 if (tempax >= pVBInfo->VGAHT)
4483 tempax = pVBInfo->VGAHT;
4484
4485 if (modeflag & HalfDCLK)
4486 tempax = tempax >> 1;
4487
4488 tempax = (tempax / tempcx) - 5;
4489 tempcx = tempax; /* 20030401 0x07 horizontal Retrace Start */
4490 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
4491 temp = (tempbx & 0x00FF) - 1;
4492 if (!(modeflag & HalfDCLK)) {
4493 temp -= 6;
4494 if (pVBInfo->TVInfo & TVSimuMode) {
4495 temp -= 4;
4496 if (ModeNo > 0x13)
4497 temp -= 10;
4498 }
4499 }
4500 } else {
4501 tempbx = (tempbx & 0xFF00) >> 8;
4502 tempcx = (tempcx + tempbx) >> 1;
4503 temp = (tempcx & 0x00FF) + 2;
4504
4505 if (pVBInfo->VBInfo & SetCRT2ToTV) {
4506 temp -= 1;
4507 if (!(modeflag & HalfDCLK)) {
4508 if ((modeflag & Charx8Dot)) {
4509 temp += 4;
4510 if (pVBInfo->VGAHDE >= 800)
4511 temp -= 6;
4512 }
4513 }
4514 } else if (!(modeflag & HalfDCLK)) {
4515 temp -= 4;
4516 if (pVBInfo->LCDResInfo != Panel1280x960 &&
4517 pVBInfo->VGAHDE >= 800) {
4518 temp -= 7;
4519 if (pVBInfo->ModeType == ModeEGA &&
4520 pVBInfo->VGAVDE == 1024) {
4521 temp += 15;
4522 if (pVBInfo->LCDResInfo !=
4523 Panel1280x1024)
4524 temp += 7;
4525 }
4526
4527 if (pVBInfo->VGAHDE >= 1280 &&
4528 pVBInfo->LCDResInfo != Panel1280x960 &&
4529 (pVBInfo->LCDInfo & LCDNonExpanding))
4530 temp += 28;
4531 }
4532 }
4533 }
4534
4535 /* 0x07 Horizontal Retrace Start */
4536 xgifb_reg_set(pVBInfo->Part1Port, 0x07, temp);
4537 /* 0x08 Horizontal Retrace End */
4538 xgifb_reg_set(pVBInfo->Part1Port, 0x08, 0);
4539
4540 if (pVBInfo->VBInfo & SetCRT2ToTV) {
4541 if (pVBInfo->TVInfo & TVSimuMode) {
4542 if ((ModeNo == 0x06) || (ModeNo == 0x10) || (ModeNo
4543 == 0x11) || (ModeNo == 0x13) || (ModeNo
4544 == 0x0F)) {
4545 xgifb_reg_set(pVBInfo->Part1Port, 0x07, 0x5b);
4546 xgifb_reg_set(pVBInfo->Part1Port, 0x08, 0x03);
4547 }
4548
4549 if ((ModeNo == 0x00) || (ModeNo == 0x01)) {
4550 if (pVBInfo->TVInfo & SetNTSCTV) {
4551 xgifb_reg_set(pVBInfo->Part1Port,
4552 0x07, 0x2A);
4553 xgifb_reg_set(pVBInfo->Part1Port,
4554 0x08, 0x61);
4555 } else {
4556 xgifb_reg_set(pVBInfo->Part1Port,
4557 0x07, 0x2A);
4558 xgifb_reg_set(pVBInfo->Part1Port,
4559 0x08, 0x41);
4560 xgifb_reg_set(pVBInfo->Part1Port,
4561 0x0C, 0xF0);
4562 }
4563 }
4564
4565 if ((ModeNo == 0x02) || (ModeNo == 0x03) || (ModeNo
4566 == 0x07)) {
4567 if (pVBInfo->TVInfo & SetNTSCTV) {
4568 xgifb_reg_set(pVBInfo->Part1Port,
4569 0x07, 0x54);
4570 xgifb_reg_set(pVBInfo->Part1Port,
4571 0x08, 0x00);
4572 } else {
4573 xgifb_reg_set(pVBInfo->Part1Port,
4574 0x07, 0x55);
4575 xgifb_reg_set(pVBInfo->Part1Port,
4576 0x08, 0x00);
4577 xgifb_reg_set(pVBInfo->Part1Port,
4578 0x0C, 0xF0);
4579 }
4580 }
4581
4582 if ((ModeNo == 0x04) || (ModeNo == 0x05) || (ModeNo
4583 == 0x0D) || (ModeNo == 0x50)) {
4584 if (pVBInfo->TVInfo & SetNTSCTV) {
4585 xgifb_reg_set(pVBInfo->Part1Port,
4586 0x07, 0x30);
4587 xgifb_reg_set(pVBInfo->Part1Port,
4588 0x08, 0x03);
4589 } else {
4590 xgifb_reg_set(pVBInfo->Part1Port,
4591 0x07, 0x2f);
4592 xgifb_reg_set(pVBInfo->Part1Port,
4593 0x08, 0x02);
4594 }
4595 }
4596 }
4597 }
4598
4599 xgifb_reg_set(pVBInfo->Part1Port, 0x18, 0x03); /* 0x18 SR0B */
4600 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, 0xF0, 0x00);
4601 xgifb_reg_set(pVBInfo->Part1Port, 0x09, 0xFF); /* 0x09 Set Max VT */
4602
4603 tempbx = pVBInfo->VGAVT;
4604 push1 = tempbx;
4605 tempcx = 0x121;
4606 tempbx = pVBInfo->VGAVDE; /* 0x0E Virtical Display End */
4607
4608 if (tempbx == 357)
4609 tempbx = 350;
4610 if (tempbx == 360)
4611 tempbx = 350;
4612 if (tempbx == 375)
4613 tempbx = 350;
4614 if (tempbx == 405)
4615 tempbx = 400;
4616 if (tempbx == 525)
4617 tempbx = 480;
4618
4619 push2 = tempbx;
4620
4621 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
4622 if (pVBInfo->LCDResInfo == Panel1024x768) {
4623 if (!(pVBInfo->LCDInfo & LCDVESATiming)) {
4624 if (tempbx == 350)
4625 tempbx += 5;
4626 if (tempbx == 480)
4627 tempbx += 5;
4628 }
4629 }
4630 }
4631 tempbx--;
4632 temp = tempbx & 0x00FF;
4633 tempbx--;
4634 temp = tempbx & 0x00FF;
4635 /* 0x10 vertical Blank Start */
4636 xgifb_reg_set(pVBInfo->Part1Port, 0x10, temp);
4637 tempbx = push2;
4638 tempbx--;
4639 temp = tempbx & 0x00FF;
4640 xgifb_reg_set(pVBInfo->Part1Port, 0x0E, temp);
4641
4642 if (tempbx & 0x0100)
4643 tempcx |= 0x0002;
4644
4645 tempax = 0x000B;
4646
4647 if (modeflag & DoubleScanMode)
4648 tempax |= 0x08000;
4649
4650 if (tempbx & 0x0200)
4651 tempcx |= 0x0040;
4652
4653 temp = (tempax & 0xFF00) >> 8;
4654 xgifb_reg_set(pVBInfo->Part1Port, 0x0B, temp);
4655
4656 if (tempbx & 0x0400)
4657 tempcx |= 0x0600;
4658
4659 /* 0x11 Vertival Blank End */
4660 xgifb_reg_set(pVBInfo->Part1Port, 0x11, 0x00);
4661
4662 tempax = push1;
4663 tempax -= tempbx; /* 0x0C Vertical Retrace Start */
4664 tempax = tempax >> 2;
4665 push1 = tempax; /* push ax */
4666
4667 if (resinfo != 0x09) {
4668 tempax = tempax << 1;
4669 tempbx += tempax;
4670 }
4671
4672 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
4673 if (pVBInfo->VBType & VB_XGI301LV) {
4674 if (pVBInfo->TVInfo & SetYPbPrMode1080i) {
4675 tempbx -= 10;
4676 } else {
4677 if (pVBInfo->TVInfo & TVSimuMode) {
4678 if (pVBInfo->TVInfo & SetPALTV) {
4679 if (pVBInfo->VBType &
4680 VB_XGI301LV) {
4681 if (!(pVBInfo->TVInfo &
4682 (SetYPbPrMode525p |
4683 SetYPbPrMode750p |
4684 SetYPbPrMode1080i)))
4685 tempbx += 40;
4686 } else {
4687 tempbx += 40;
4688 }
4689 }
4690 }
4691 }
4692 } else {
4693 tempbx -= 10;
4694 }
4695 } else {
4696 if (pVBInfo->TVInfo & TVSimuMode) {
4697 if (pVBInfo->TVInfo & SetPALTV) {
4698 if (pVBInfo->VBType & VB_XGI301LV) {
4699 if (!(pVBInfo->TVInfo &
4700 (SetYPbPrMode525p |
4701 SetYPbPrMode750p |
4702 SetYPbPrMode1080i)))
4703 tempbx += 40;
4704 } else {
4705 tempbx += 40;
4706 }
4707 }
4708 }
4709 }
4710 tempax = push1;
4711 tempax = tempax >> 2;
4712 tempax++;
4713 tempax += tempbx;
4714 push1 = tempax; /* push ax */
4715
4716 if ((pVBInfo->TVInfo & SetPALTV)) {
4717 if (tempbx <= 513) {
4718 if (tempax >= 513)
4719 tempbx = 513;
4720 }
4721 }
4722
4723 temp = tempbx & 0x00FF;
4724 xgifb_reg_set(pVBInfo->Part1Port, 0x0C, temp);
4725 tempbx--;
4726 temp = tempbx & 0x00FF;
4727 xgifb_reg_set(pVBInfo->Part1Port, 0x10, temp);
4728
4729 if (tempbx & 0x0100)
4730 tempcx |= 0x0008;
4731
4732 if (tempbx & 0x0200)
4733 xgifb_reg_and_or(pVBInfo->Part1Port, 0x0B, 0x0FF, 0x20);
4734
4735 tempbx++;
4736
4737 if (tempbx & 0x0100)
4738 tempcx |= 0x0004;
4739
4740 if (tempbx & 0x0200)
4741 tempcx |= 0x0080;
4742
4743 if (tempbx & 0x0400)
4744 tempcx |= 0x0C00;
4745
4746 tempbx = push1; /* pop ax */
4747 temp = tempbx & 0x00FF;
4748 temp &= 0x0F;
4749 /* 0x0D vertical Retrace End */
4750 xgifb_reg_set(pVBInfo->Part1Port, 0x0D, temp);
4751
4752 if (tempbx & 0x0010)
4753 tempcx |= 0x2000;
4754
4755 temp = tempcx & 0x00FF;
4756 xgifb_reg_set(pVBInfo->Part1Port, 0x0A, temp); /* 0x0A CR07 */
4757 temp = (tempcx & 0x0FF00) >> 8;
4758 xgifb_reg_set(pVBInfo->Part1Port, 0x17, temp); /* 0x17 SR0A */
4759 tempax = modeflag;
4760 temp = (tempax & 0xFF00) >> 8;
4761
4762 temp = (temp >> 1) & 0x09;
4763
4764 if (pVBInfo->VBType & (VB_XGI301LV | VB_XGI302LV | VB_XGI301C))
4765 temp |= 0x01;
4766
4767 xgifb_reg_set(pVBInfo->Part1Port, 0x16, temp); /* 0x16 SR01 */
4768 xgifb_reg_set(pVBInfo->Part1Port, 0x0F, 0); /* 0x0F CR14 */
4769 xgifb_reg_set(pVBInfo->Part1Port, 0x12, 0); /* 0x12 CR17 */
4770
4771 if (pVBInfo->LCDInfo & LCDRGB18Bit)
4772 temp = 0x80;
4773 else
4774 temp = 0x00;
4775
4776 xgifb_reg_set(pVBInfo->Part1Port, 0x1A, temp); /* 0x1A SR0E */
4777
4778 return;
4779 }
4780
4781 static void XGI_SetGroup2(unsigned short ModeNo, unsigned short ModeIdIndex,
4782 unsigned short RefreshRateTableIndex,
4783 struct xgi_hw_device_info *HwDeviceExtension,
4784 struct vb_device_info *pVBInfo)
4785 {
4786 unsigned short i, j, tempax, tempbx, tempcx, temp, push1, push2,
4787 modeflag, resinfo, crt2crtc;
4788 unsigned char *TimingPoint;
4789
4790 unsigned long longtemp, tempeax, tempebx, temp2, tempecx;
4791
4792 if (ModeNo <= 0x13) {
4793 /* si+St_ResInfo */
4794 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
4795 resinfo = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
4796 crt2crtc = pVBInfo->SModeIDTable[ModeIdIndex].St_CRT2CRTC;
4797 } else {
4798 /* si+Ext_ResInfo */
4799 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4800 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
4801 crt2crtc = pVBInfo->RefIndex[RefreshRateTableIndex].
4802 Ext_CRT2CRTC;
4803 }
4804
4805 tempax = 0;
4806
4807 if (!(pVBInfo->VBInfo & SetCRT2ToAVIDEO))
4808 tempax |= 0x0800;
4809
4810 if (!(pVBInfo->VBInfo & SetCRT2ToSVIDEO))
4811 tempax |= 0x0400;
4812
4813 if (pVBInfo->VBInfo & SetCRT2ToSCART)
4814 tempax |= 0x0200;
4815
4816 if (!(pVBInfo->TVInfo & SetPALTV))
4817 tempax |= 0x1000;
4818
4819 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV)
4820 tempax |= 0x0100;
4821
4822 if (pVBInfo->TVInfo & (SetYPbPrMode525p | SetYPbPrMode750p))
4823 tempax &= 0xfe00;
4824
4825 tempax = (tempax & 0xff00) >> 8;
4826
4827 xgifb_reg_set(pVBInfo->Part2Port, 0x0, tempax);
4828 TimingPoint = pVBInfo->NTSCTiming;
4829
4830 if (pVBInfo->TVInfo & SetPALTV)
4831 TimingPoint = pVBInfo->PALTiming;
4832
4833 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
4834 TimingPoint = pVBInfo->HiTVExtTiming;
4835
4836 if (pVBInfo->VBInfo & SetInSlaveMode)
4837 TimingPoint = pVBInfo->HiTVSt2Timing;
4838
4839 if (pVBInfo->SetFlag & TVSimuMode)
4840 TimingPoint = pVBInfo->HiTVSt1Timing;
4841
4842 if (!(modeflag & Charx8Dot))
4843 TimingPoint = pVBInfo->HiTVTextTiming;
4844 }
4845
4846 if (pVBInfo->VBInfo & SetCRT2ToYPbPr) {
4847 if (pVBInfo->TVInfo & SetYPbPrMode525i)
4848 TimingPoint = pVBInfo->YPbPr525iTiming;
4849
4850 if (pVBInfo->TVInfo & SetYPbPrMode525p)
4851 TimingPoint = pVBInfo->YPbPr525pTiming;
4852
4853 if (pVBInfo->TVInfo & SetYPbPrMode750p)
4854 TimingPoint = pVBInfo->YPbPr750pTiming;
4855 }
4856
4857 for (i = 0x01, j = 0; i <= 0x2D; i++, j++)
4858 xgifb_reg_set(pVBInfo->Part2Port, i, TimingPoint[j]);
4859
4860 for (i = 0x39; i <= 0x45; i++, j++)
4861 /* di->temp2[j] */
4862 xgifb_reg_set(pVBInfo->Part2Port, i, TimingPoint[j]);
4863
4864 if (pVBInfo->VBInfo & SetCRT2ToTV)
4865 xgifb_reg_and_or(pVBInfo->Part2Port, 0x3A, 0x1F, 0x00);
4866
4867 temp = pVBInfo->NewFlickerMode;
4868 temp &= 0x80;
4869 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0A, 0xFF, temp);
4870
4871 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV)
4872 tempax = 950;
4873
4874 if (pVBInfo->TVInfo & SetPALTV)
4875 tempax = 520;
4876 else
4877 tempax = 440;
4878
4879 if (pVBInfo->VDE <= tempax) {
4880 tempax -= pVBInfo->VDE;
4881 tempax = tempax >> 2;
4882 tempax = (tempax & 0x00FF) | ((tempax & 0x00FF) << 8);
4883 push1 = tempax;
4884 temp = (tempax & 0xFF00) >> 8;
4885 temp += (unsigned short) TimingPoint[0];
4886
4887 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
4888 | VB_XGI302LV | VB_XGI301C)) {
4889 if (pVBInfo->VBInfo & (SetCRT2ToAVIDEO
4890 | SetCRT2ToSVIDEO | SetCRT2ToSCART
4891 | SetCRT2ToYPbPr)) {
4892 tempcx = pVBInfo->VGAHDE;
4893 if (tempcx >= 1024) {
4894 temp = 0x17; /* NTSC */
4895 if (pVBInfo->TVInfo & SetPALTV)
4896 temp = 0x19; /* PAL */
4897 }
4898 }
4899 }
4900
4901 xgifb_reg_set(pVBInfo->Part2Port, 0x01, temp);
4902 tempax = push1;
4903 temp = (tempax & 0xFF00) >> 8;
4904 temp += TimingPoint[1];
4905
4906 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
4907 | VB_XGI302LV | VB_XGI301C)) {
4908 if ((pVBInfo->VBInfo & (SetCRT2ToAVIDEO
4909 | SetCRT2ToSVIDEO | SetCRT2ToSCART
4910 | SetCRT2ToYPbPr))) {
4911 tempcx = pVBInfo->VGAHDE;
4912 if (tempcx >= 1024) {
4913 temp = 0x1D; /* NTSC */
4914 if (pVBInfo->TVInfo & SetPALTV)
4915 temp = 0x52; /* PAL */
4916 }
4917 }
4918 }
4919 xgifb_reg_set(pVBInfo->Part2Port, 0x02, temp);
4920 }
4921
4922 /* 301b */
4923 tempcx = pVBInfo->HT;
4924
4925 if (XGI_IsLCDDualLink(pVBInfo))
4926 tempcx = tempcx >> 1;
4927
4928 tempcx -= 2;
4929 temp = tempcx & 0x00FF;
4930 xgifb_reg_set(pVBInfo->Part2Port, 0x1B, temp);
4931
4932 temp = (tempcx & 0xFF00) >> 8;
4933 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1D, ~0x0F, temp);
4934
4935 tempcx = pVBInfo->HT >> 1;
4936 push1 = tempcx; /* push cx */
4937 tempcx += 7;
4938
4939 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV)
4940 tempcx -= 4;
4941
4942 temp = tempcx & 0x00FF;
4943 temp = temp << 4;
4944 xgifb_reg_and_or(pVBInfo->Part2Port, 0x22, 0x0F, temp);
4945
4946 tempbx = TimingPoint[j] | ((TimingPoint[j + 1]) << 8);
4947 tempbx += tempcx;
4948 push2 = tempbx;
4949 temp = tempbx & 0x00FF;
4950 xgifb_reg_set(pVBInfo->Part2Port, 0x24, temp);
4951 temp = (tempbx & 0xFF00) >> 8;
4952 temp = temp << 4;
4953 xgifb_reg_and_or(pVBInfo->Part2Port, 0x25, 0x0F, temp);
4954
4955 tempbx = push2;
4956 tempbx = tempbx + 8;
4957 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
4958 tempbx = tempbx - 4;
4959 tempcx = tempbx;
4960 }
4961
4962 temp = (tempbx & 0x00FF) << 4;
4963 xgifb_reg_and_or(pVBInfo->Part2Port, 0x29, 0x0F, temp);
4964
4965 j += 2;
4966 tempcx += (TimingPoint[j] | ((TimingPoint[j + 1]) << 8));
4967 temp = tempcx & 0x00FF;
4968 xgifb_reg_set(pVBInfo->Part2Port, 0x27, temp);
4969 temp = ((tempcx & 0xFF00) >> 8) << 4;
4970 xgifb_reg_and_or(pVBInfo->Part2Port, 0x28, 0x0F, temp);
4971
4972 tempcx += 8;
4973 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV)
4974 tempcx -= 4;
4975
4976 temp = tempcx & 0xFF;
4977 temp = temp << 4;
4978 xgifb_reg_and_or(pVBInfo->Part2Port, 0x2A, 0x0F, temp);
4979
4980 tempcx = push1; /* pop cx */
4981 j += 2;
4982 temp = TimingPoint[j] | ((TimingPoint[j + 1]) << 8);
4983 tempcx -= temp;
4984 temp = tempcx & 0x00FF;
4985 temp = temp << 4;
4986 xgifb_reg_and_or(pVBInfo->Part2Port, 0x2D, 0x0F, temp);
4987
4988 tempcx -= 11;
4989
4990 if (!(pVBInfo->VBInfo & SetCRT2ToTV)) {
4991 tempax = XGI_GetVGAHT2(pVBInfo);
4992 tempcx = tempax - 1;
4993 }
4994 temp = tempcx & 0x00FF;
4995 xgifb_reg_set(pVBInfo->Part2Port, 0x2E, temp);
4996
4997 tempbx = pVBInfo->VDE;
4998
4999 if (pVBInfo->VGAVDE == 360)
5000 tempbx = 746;
5001 if (pVBInfo->VGAVDE == 375)
5002 tempbx = 746;
5003 if (pVBInfo->VGAVDE == 405)
5004 tempbx = 853;
5005
5006 if (pVBInfo->VBInfo & SetCRT2ToTV) {
5007 if (pVBInfo->VBType &
5008 (VB_XGI301LV | VB_XGI302LV | VB_XGI301C)) {
5009 if (!(pVBInfo->TVInfo &
5010 (SetYPbPrMode525p | SetYPbPrMode750p)))
5011 tempbx = tempbx >> 1;
5012 } else
5013 tempbx = tempbx >> 1;
5014 }
5015
5016 tempbx -= 2;
5017 temp = tempbx & 0x00FF;
5018
5019 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
5020 if (pVBInfo->VBType & VB_XGI301LV) {
5021 if (pVBInfo->TVInfo & SetYPbPrMode1080i) {
5022 if (pVBInfo->VBInfo & SetInSlaveMode) {
5023 if (ModeNo == 0x2f)
5024 temp += 1;
5025 }
5026 }
5027 } else {
5028 if (pVBInfo->VBInfo & SetInSlaveMode) {
5029 if (ModeNo == 0x2f)
5030 temp += 1;
5031 }
5032 }
5033 }
5034
5035 xgifb_reg_set(pVBInfo->Part2Port, 0x2F, temp);
5036
5037 temp = (tempcx & 0xFF00) >> 8;
5038 temp |= ((tempbx & 0xFF00) >> 8) << 6;
5039
5040 if (!(pVBInfo->VBInfo & SetCRT2ToHiVisionTV)) {
5041 if (pVBInfo->VBType & VB_XGI301LV) {
5042 if (pVBInfo->TVInfo & SetYPbPrMode1080i) {
5043 temp |= 0x10;
5044
5045 if (!(pVBInfo->VBInfo & SetCRT2ToSVIDEO))
5046 temp |= 0x20;
5047 }
5048 } else {
5049 temp |= 0x10;
5050 if (!(pVBInfo->VBInfo & SetCRT2ToSVIDEO))
5051 temp |= 0x20;
5052 }
5053 }
5054
5055 xgifb_reg_set(pVBInfo->Part2Port, 0x30, temp);
5056
5057 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
5058 | VB_XGI302LV | VB_XGI301C)) { /* TV gatingno */
5059 tempbx = pVBInfo->VDE;
5060 tempcx = tempbx - 2;
5061
5062 if (pVBInfo->VBInfo & SetCRT2ToTV) {
5063 if (!(pVBInfo->TVInfo & (SetYPbPrMode525p
5064 | SetYPbPrMode750p)))
5065 tempbx = tempbx >> 1;
5066 }
5067
5068 if (pVBInfo->VBType & (VB_XGI302LV | VB_XGI301C)) {
5069 temp = 0;
5070 if (tempcx & 0x0400)
5071 temp |= 0x20;
5072
5073 if (tempbx & 0x0400)
5074 temp |= 0x40;
5075
5076 xgifb_reg_set(pVBInfo->Part4Port, 0x10, temp);
5077 }
5078
5079 temp = (((tempbx - 3) & 0x0300) >> 8) << 5;
5080 xgifb_reg_set(pVBInfo->Part2Port, 0x46, temp);
5081 temp = (tempbx - 3) & 0x00FF;
5082 xgifb_reg_set(pVBInfo->Part2Port, 0x47, temp);
5083 }
5084
5085 tempbx = tempbx & 0x00FF;
5086
5087 if (!(modeflag & HalfDCLK)) {
5088 tempcx = pVBInfo->VGAHDE;
5089 if (tempcx >= pVBInfo->HDE) {
5090 tempbx |= 0x2000;
5091 tempax &= 0x00FF;
5092 }
5093 }
5094
5095 tempcx = 0x0101;
5096
5097 if (pVBInfo->VBInfo & SetCRT2ToTV) { /*301b*/
5098 if (pVBInfo->VGAHDE >= 1024) {
5099 tempcx = 0x1920;
5100 if (pVBInfo->VGAHDE >= 1280) {
5101 tempcx = 0x1420;
5102 tempbx = tempbx & 0xDFFF;
5103 }
5104 }
5105 }
5106
5107 if (!(tempbx & 0x2000)) {
5108 if (modeflag & HalfDCLK)
5109 tempcx = (tempcx & 0xFF00) | ((tempcx & 0x00FF) << 1);
5110
5111 push1 = tempbx;
5112 tempeax = pVBInfo->VGAHDE;
5113 tempebx = (tempcx & 0xFF00) >> 8;
5114 longtemp = tempeax * tempebx;
5115 tempecx = tempcx & 0x00FF;
5116 longtemp = longtemp / tempecx;
5117
5118 /* 301b */
5119 tempecx = 8 * 1024;
5120
5121 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
5122 | VB_XGI302LV | VB_XGI301C)) {
5123 tempecx = tempecx * 8;
5124 }
5125
5126 longtemp = longtemp * tempecx;
5127 tempecx = pVBInfo->HDE;
5128 temp2 = longtemp % tempecx;
5129 tempeax = longtemp / tempecx;
5130 if (temp2 != 0)
5131 tempeax += 1;
5132
5133 tempax = (unsigned short) tempeax;
5134
5135 /* 301b */
5136 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
5137 | VB_XGI302LV | VB_XGI301C)) {
5138 tempcx = ((tempax & 0xFF00) >> 5) >> 8;
5139 }
5140 /* end 301b */
5141
5142 tempbx = push1;
5143 tempbx = (unsigned short) (((tempeax & 0x0000FF00) & 0x1F00)
5144 | (tempbx & 0x00FF));
5145 tempax = (unsigned short) (((tempeax & 0x000000FF) << 8)
5146 | (tempax & 0x00FF));
5147 temp = (tempax & 0xFF00) >> 8;
5148 } else {
5149 temp = (tempax & 0x00FF) >> 8;
5150 }
5151
5152 xgifb_reg_set(pVBInfo->Part2Port, 0x44, temp);
5153 temp = (tempbx & 0xFF00) >> 8;
5154 xgifb_reg_and_or(pVBInfo->Part2Port, 0x45, ~0x03F, temp);
5155 temp = tempcx & 0x00FF;
5156
5157 if (tempbx & 0x2000)
5158 temp = 0;
5159
5160 if (!(pVBInfo->VBInfo & SetCRT2ToLCD))
5161 temp |= 0x18;
5162
5163 xgifb_reg_and_or(pVBInfo->Part2Port, 0x46, ~0x1F, temp);
5164 if (pVBInfo->TVInfo & SetPALTV) {
5165 tempbx = 0x0382;
5166 tempcx = 0x007e;
5167 } else {
5168 tempbx = 0x0369;
5169 tempcx = 0x0061;
5170 }
5171
5172 temp = tempbx & 0x00FF;
5173 xgifb_reg_set(pVBInfo->Part2Port, 0x4b, temp);
5174 temp = tempcx & 0x00FF;
5175 xgifb_reg_set(pVBInfo->Part2Port, 0x4c, temp);
5176
5177 temp = ((tempcx & 0xFF00) >> 8) & 0x03;
5178 temp = temp << 2;
5179 temp |= ((tempbx & 0xFF00) >> 8) & 0x03;
5180
5181 if (pVBInfo->VBInfo & SetCRT2ToYPbPr) {
5182 temp |= 0x10;
5183
5184 if (pVBInfo->TVInfo & SetYPbPrMode525p)
5185 temp |= 0x20;
5186
5187 if (pVBInfo->TVInfo & SetYPbPrMode750p)
5188 temp |= 0x60;
5189 }
5190
5191 xgifb_reg_set(pVBInfo->Part2Port, 0x4d, temp);
5192 temp = xgifb_reg_get(pVBInfo->Part2Port, 0x43); /* 301b change */
5193 xgifb_reg_set(pVBInfo->Part2Port, 0x43, (unsigned short) (temp - 3));
5194
5195 if (!(pVBInfo->TVInfo & (SetYPbPrMode525p | SetYPbPrMode750p))) {
5196 if (pVBInfo->TVInfo & NTSC1024x768) {
5197 TimingPoint = XGI_NTSC1024AdjTime;
5198 for (i = 0x1c, j = 0; i <= 0x30; i++, j++) {
5199 xgifb_reg_set(pVBInfo->Part2Port, i,
5200 TimingPoint[j]);
5201 }
5202 xgifb_reg_set(pVBInfo->Part2Port, 0x43, 0x72);
5203 }
5204 }
5205
5206 /* [ycchen] 01/14/03 Modify for 301C PALM Support */
5207 if (pVBInfo->VBType & VB_XGI301C) {
5208 if (pVBInfo->TVInfo & SetPALMTV)
5209 xgifb_reg_and_or(pVBInfo->Part2Port, 0x4E, ~0x08,
5210 0x08); /* PALM Mode */
5211 }
5212
5213 if (pVBInfo->TVInfo & SetPALMTV) {
5214 tempax = (unsigned char) xgifb_reg_get(pVBInfo->Part2Port,
5215 0x01);
5216 tempax--;
5217 xgifb_reg_and(pVBInfo->Part2Port, 0x01, tempax);
5218
5219 xgifb_reg_and(pVBInfo->Part2Port, 0x00, 0xEF);
5220 }
5221
5222 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) {
5223 if (!(pVBInfo->VBInfo & SetInSlaveMode))
5224 xgifb_reg_set(pVBInfo->Part2Port, 0x0B, 0x00);
5225 }
5226
5227 if (pVBInfo->VBInfo & SetCRT2ToTV)
5228 return;
5229 }
5230
5231 static void XGI_SetLCDRegs(unsigned short ModeNo, unsigned short ModeIdIndex,
5232 struct xgi_hw_device_info *HwDeviceExtension,
5233 unsigned short RefreshRateTableIndex,
5234 struct vb_device_info *pVBInfo)
5235 {
5236 unsigned short push1, push2, pushbx, tempax, tempbx, tempcx, temp,
5237 tempah, tempbh, tempch, resinfo, modeflag, CRT1Index;
5238
5239 struct XGI_LCDDesStruct *LCDBDesPtr = NULL;
5240
5241 if (ModeNo <= 0x13) {
5242 /* si+St_ResInfo */
5243 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
5244 resinfo = pVBInfo->SModeIDTable[ModeIdIndex].St_ResInfo;
5245 } else {
5246 /* si+Ext_ResInfo */
5247 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
5248 resinfo = pVBInfo->EModeIDTable[ModeIdIndex].Ext_RESINFO;
5249 CRT1Index = pVBInfo->RefIndex[RefreshRateTableIndex].
5250 Ext_CRT1CRTC;
5251 CRT1Index &= IndexMask;
5252 }
5253
5254 if (!(pVBInfo->VBInfo & SetCRT2ToLCD))
5255 return;
5256
5257 tempbx = pVBInfo->HDE; /* RHACTE=HDE-1 */
5258
5259 if (XGI_IsLCDDualLink(pVBInfo))
5260 tempbx = tempbx >> 1;
5261
5262 tempbx -= 1;
5263 temp = tempbx & 0x00FF;
5264 xgifb_reg_set(pVBInfo->Part2Port, 0x2C, temp);
5265 temp = (tempbx & 0xFF00) >> 8;
5266 temp = temp << 4;
5267 xgifb_reg_and_or(pVBInfo->Part2Port, 0x2B, 0x0F, temp);
5268 temp = 0x01;
5269
5270 if (pVBInfo->LCDResInfo == Panel1280x1024) {
5271 if (pVBInfo->ModeType == ModeEGA) {
5272 if (pVBInfo->VGAHDE >= 1024) {
5273 temp = 0x02;
5274 if (pVBInfo->LCDInfo & LCDVESATiming)
5275 temp = 0x01;
5276 }
5277 }
5278 }
5279
5280 xgifb_reg_set(pVBInfo->Part2Port, 0x0B, temp);
5281 tempbx = pVBInfo->VDE; /* RTVACTEO=(VDE-1)&0xFF */
5282 push1 = tempbx;
5283 tempbx--;
5284 temp = tempbx & 0x00FF;
5285 xgifb_reg_set(pVBInfo->Part2Port, 0x03, temp);
5286 temp = ((tempbx & 0xFF00) >> 8) & 0x07;
5287 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0C, ~0x07, temp);
5288
5289 tempcx = pVBInfo->VT - 1;
5290 push2 = tempcx + 1;
5291 temp = tempcx & 0x00FF; /* RVTVT=VT-1 */
5292 xgifb_reg_set(pVBInfo->Part2Port, 0x19, temp);
5293 temp = (tempcx & 0xFF00) >> 8;
5294 temp = temp << 5;
5295 xgifb_reg_set(pVBInfo->Part2Port, 0x1A, temp);
5296 xgifb_reg_and_or(pVBInfo->Part2Port, 0x09, 0xF0, 0x00);
5297 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0A, 0xF0, 0x00);
5298 xgifb_reg_and_or(pVBInfo->Part2Port, 0x17, 0xFB, 0x00);
5299 xgifb_reg_and_or(pVBInfo->Part2Port, 0x18, 0xDF, 0x00);
5300
5301 /* Customized LCDB Des no add */
5302 tempbx = 5;
5303 LCDBDesPtr = (struct XGI_LCDDesStruct *) XGI_GetLcdPtr(tempbx, ModeNo,
5304 ModeIdIndex, RefreshRateTableIndex, pVBInfo);
5305 tempah = pVBInfo->LCDResInfo;
5306 tempah &= PanelResInfo;
5307
5308 if ((tempah == Panel1024x768) || (tempah == Panel1024x768x75)) {
5309 tempbx = 1024;
5310 tempcx = 768;
5311 } else if ((tempah == Panel1280x1024) ||
5312 (tempah == Panel1280x1024x75)) {
5313 tempbx = 1280;
5314 tempcx = 1024;
5315 } else if (tempah == Panel1400x1050) {
5316 tempbx = 1400;
5317 tempcx = 1050;
5318 } else {
5319 tempbx = 1600;
5320 tempcx = 1200;
5321 }
5322
5323 if (pVBInfo->LCDInfo & EnableScalingLCD) {
5324 tempbx = pVBInfo->HDE;
5325 tempcx = pVBInfo->VDE;
5326 }
5327
5328 pushbx = tempbx;
5329 tempax = pVBInfo->VT;
5330 pVBInfo->LCDHDES = LCDBDesPtr->LCDHDES;
5331 pVBInfo->LCDHRS = LCDBDesPtr->LCDHRS;
5332 pVBInfo->LCDVDES = LCDBDesPtr->LCDVDES;
5333 pVBInfo->LCDVRS = LCDBDesPtr->LCDVRS;
5334 tempbx = pVBInfo->LCDVDES;
5335 tempcx += tempbx;
5336
5337 if (tempcx >= tempax)
5338 tempcx -= tempax; /* lcdvdes */
5339
5340 temp = tempbx & 0x00FF; /* RVEQ1EQ=lcdvdes */
5341 xgifb_reg_set(pVBInfo->Part2Port, 0x05, temp);
5342 temp = tempcx & 0x00FF;
5343 xgifb_reg_set(pVBInfo->Part2Port, 0x06, temp);
5344 tempch = ((tempcx & 0xFF00) >> 8) & 0x07;
5345 tempbh = ((tempbx & 0xFF00) >> 8) & 0x07;
5346 tempah = tempch;
5347 tempah = tempah << 3;
5348 tempah |= tempbh;
5349 xgifb_reg_set(pVBInfo->Part2Port, 0x02, tempah);
5350
5351 /* getlcdsync() */
5352 XGI_GetLCDSync(&tempax, &tempbx, pVBInfo);
5353 tempcx = tempbx;
5354 tempax = pVBInfo->VT;
5355 tempbx = pVBInfo->LCDVRS;
5356
5357 tempcx += tempbx;
5358 if (tempcx >= tempax)
5359 tempcx -= tempax;
5360
5361 temp = tempbx & 0x00FF; /* RTVACTEE=lcdvrs */
5362 xgifb_reg_set(pVBInfo->Part2Port, 0x04, temp);
5363 temp = (tempbx & 0xFF00) >> 8;
5364 temp = temp << 4;
5365 temp |= (tempcx & 0x000F);
5366 xgifb_reg_set(pVBInfo->Part2Port, 0x01, temp);
5367 tempcx = pushbx;
5368 tempax = pVBInfo->HT;
5369 tempbx = pVBInfo->LCDHDES;
5370 tempbx &= 0x0FFF;
5371
5372 if (XGI_IsLCDDualLink(pVBInfo)) {
5373 tempax = tempax >> 1;
5374 tempbx = tempbx >> 1;
5375 tempcx = tempcx >> 1;
5376 }
5377
5378 if (pVBInfo->VBType & VB_XGI302LV)
5379 tempbx += 1;
5380
5381 if (pVBInfo->VBType & VB_XGI301C) /* tap4 */
5382 tempbx += 1;
5383
5384 tempcx += tempbx;
5385
5386 if (tempcx >= tempax)
5387 tempcx -= tempax;
5388
5389 temp = tempbx & 0x00FF;
5390 xgifb_reg_set(pVBInfo->Part2Port, 0x1F, temp); /* RHBLKE=lcdhdes */
5391 temp = ((tempbx & 0xFF00) >> 8) << 4;
5392 xgifb_reg_set(pVBInfo->Part2Port, 0x20, temp);
5393 temp = tempcx & 0x00FF;
5394 xgifb_reg_set(pVBInfo->Part2Port, 0x23, temp); /* RHEQPLE=lcdhdee */
5395 temp = (tempcx & 0xFF00) >> 8;
5396 xgifb_reg_set(pVBInfo->Part2Port, 0x25, temp);
5397
5398 XGI_GetLCDSync(&tempax, &tempbx, pVBInfo);
5399 tempcx = tempax;
5400 tempax = pVBInfo->HT;
5401 tempbx = pVBInfo->LCDHRS;
5402 if (XGI_IsLCDDualLink(pVBInfo)) {
5403 tempax = tempax >> 1;
5404 tempbx = tempbx >> 1;
5405 tempcx = tempcx >> 1;
5406 }
5407
5408 if (pVBInfo->VBType & VB_XGI302LV)
5409 tempbx += 1;
5410
5411 tempcx += tempbx;
5412
5413 if (tempcx >= tempax)
5414 tempcx -= tempax;
5415
5416 temp = tempbx & 0x00FF; /* RHBURSTS=lcdhrs */
5417 xgifb_reg_set(pVBInfo->Part2Port, 0x1C, temp);
5418
5419 temp = (tempbx & 0xFF00) >> 8;
5420 temp = temp << 4;
5421 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1D, ~0x0F0, temp);
5422 temp = tempcx & 0x00FF; /* RHSYEXP2S=lcdhre */
5423 xgifb_reg_set(pVBInfo->Part2Port, 0x21, temp);
5424
5425 if (!(pVBInfo->LCDInfo & LCDVESATiming)) {
5426 if (pVBInfo->VGAVDE == 525) {
5427 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B
5428 | VB_XGI301LV | VB_XGI302LV
5429 | VB_XGI301C)) {
5430 temp = 0xC6;
5431 } else
5432 temp = 0xC4;
5433
5434 xgifb_reg_set(pVBInfo->Part2Port, 0x2f, temp);
5435 xgifb_reg_set(pVBInfo->Part2Port, 0x30, 0xB3);
5436 }
5437
5438 if (pVBInfo->VGAVDE == 420) {
5439 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B
5440 | VB_XGI301LV | VB_XGI302LV
5441 | VB_XGI301C)) {
5442 temp = 0x4F;
5443 } else
5444 temp = 0x4E;
5445 xgifb_reg_set(pVBInfo->Part2Port, 0x2f, temp);
5446 }
5447 }
5448 }
5449
5450 /* --------------------------------------------------------------------- */
5451 /* Function : XGI_GetTap4Ptr */
5452 /* Input : */
5453 /* Output : di -> Tap4 Reg. Setting Pointer */
5454 /* Description : */
5455 /* --------------------------------------------------------------------- */
5456 static struct XGI301C_Tap4TimingStruct *XGI_GetTap4Ptr(unsigned short tempcx,
5457 struct vb_device_info *pVBInfo)
5458 {
5459 unsigned short tempax, tempbx, i;
5460
5461 struct XGI301C_Tap4TimingStruct *Tap4TimingPtr;
5462
5463 if (tempcx == 0) {
5464 tempax = pVBInfo->VGAHDE;
5465 tempbx = pVBInfo->HDE;
5466 } else {
5467 tempax = pVBInfo->VGAVDE;
5468 tempbx = pVBInfo->VDE;
5469 }
5470
5471 if (tempax <= tempbx)
5472 return &xgifb_tap4_timing[0];
5473 else
5474 Tap4TimingPtr = xgifb_ntsc_525_tap4_timing; /* NTSC */
5475
5476 if (pVBInfo->TVInfo & SetPALTV)
5477 Tap4TimingPtr = PALTap4Timing;
5478
5479 if (pVBInfo->VBInfo & SetCRT2ToYPbPr) {
5480 if ((pVBInfo->TVInfo & SetYPbPrMode525i) ||
5481 (pVBInfo->TVInfo & SetYPbPrMode525p))
5482 Tap4TimingPtr = xgifb_ntsc_525_tap4_timing;
5483 if (pVBInfo->TVInfo & SetYPbPrMode750p)
5484 Tap4TimingPtr = YPbPr750pTap4Timing;
5485 }
5486
5487 if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV)
5488 Tap4TimingPtr = xgifb_tap4_timing;
5489
5490 i = 0;
5491 while (Tap4TimingPtr[i].DE != 0xFFFF) {
5492 if (Tap4TimingPtr[i].DE == tempax)
5493 break;
5494 i++;
5495 }
5496 return &Tap4TimingPtr[i];
5497 }
5498
5499 static void XGI_SetTap4Regs(struct vb_device_info *pVBInfo)
5500 {
5501 unsigned short i, j;
5502
5503 struct XGI301C_Tap4TimingStruct *Tap4TimingPtr;
5504
5505 if (!(pVBInfo->VBType & VB_XGI301C))
5506 return;
5507
5508 Tap4TimingPtr = XGI_GetTap4Ptr(0, pVBInfo); /* Set Horizontal Scaling */
5509 for (i = 0x80, j = 0; i <= 0xBF; i++, j++)
5510 xgifb_reg_set(pVBInfo->Part2Port, i, Tap4TimingPtr->Reg[j]);
5511
5512 if ((pVBInfo->VBInfo & SetCRT2ToTV) &&
5513 (!(pVBInfo->VBInfo & SetCRT2ToHiVisionTV))) {
5514 /* Set Vertical Scaling */
5515 Tap4TimingPtr = XGI_GetTap4Ptr(1, pVBInfo);
5516 for (i = 0xC0, j = 0; i < 0xFF; i++, j++)
5517 xgifb_reg_set(pVBInfo->Part2Port,
5518 i,
5519 Tap4TimingPtr->Reg[j]);
5520 }
5521
5522 if ((pVBInfo->VBInfo & SetCRT2ToTV) &&
5523 (!(pVBInfo->VBInfo & SetCRT2ToHiVisionTV)))
5524 /* Enable V.Scaling */
5525 xgifb_reg_and_or(pVBInfo->Part2Port, 0x4E, ~0x14, 0x04);
5526 else
5527 /* Enable H.Scaling */
5528 xgifb_reg_and_or(pVBInfo->Part2Port, 0x4E, ~0x14, 0x10);
5529 }
5530
5531 static void XGI_SetGroup3(unsigned short ModeNo, unsigned short ModeIdIndex,
5532 struct vb_device_info *pVBInfo)
5533 {
5534 unsigned short i;
5535 unsigned char *tempdi;
5536 unsigned short modeflag;
5537
5538 if (ModeNo <= 0x13)
5539 /* si+St_ResInfo */
5540 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
5541 else
5542 /* si+Ext_ResInfo */
5543 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
5544
5545 xgifb_reg_set(pVBInfo->Part3Port, 0x00, 0x00);
5546 if (pVBInfo->TVInfo & SetPALTV) {
5547 xgifb_reg_set(pVBInfo->Part3Port, 0x13, 0xFA);
5548 xgifb_reg_set(pVBInfo->Part3Port, 0x14, 0xC8);
5549 } else {
5550 xgifb_reg_set(pVBInfo->Part3Port, 0x13, 0xF5);
5551 xgifb_reg_set(pVBInfo->Part3Port, 0x14, 0xB7);
5552 }
5553
5554 if (!(pVBInfo->VBInfo & SetCRT2ToTV))
5555 return;
5556
5557 if (pVBInfo->TVInfo & SetPALMTV) {
5558 xgifb_reg_set(pVBInfo->Part3Port, 0x13, 0xFA);
5559 xgifb_reg_set(pVBInfo->Part3Port, 0x14, 0xC8);
5560 xgifb_reg_set(pVBInfo->Part3Port, 0x3D, 0xA8);
5561 }
5562
5563 if ((pVBInfo->VBInfo & SetCRT2ToHiVisionTV) || (pVBInfo->VBInfo
5564 & SetCRT2ToYPbPr)) {
5565 if (pVBInfo->TVInfo & SetYPbPrMode525i)
5566 return;
5567
5568 tempdi = pVBInfo->HiTVGroup3Data;
5569 if (pVBInfo->SetFlag & TVSimuMode) {
5570 tempdi = pVBInfo->HiTVGroup3Simu;
5571 if (!(modeflag & Charx8Dot))
5572 tempdi = pVBInfo->HiTVGroup3Text;
5573 }
5574
5575 if (pVBInfo->TVInfo & SetYPbPrMode525p)
5576 tempdi = pVBInfo->Ren525pGroup3;
5577
5578 if (pVBInfo->TVInfo & SetYPbPrMode750p)
5579 tempdi = pVBInfo->Ren750pGroup3;
5580
5581 for (i = 0; i <= 0x3E; i++)
5582 xgifb_reg_set(pVBInfo->Part3Port, i, tempdi[i]);
5583
5584 if (pVBInfo->VBType & VB_XGI301C) { /* Marcovision */
5585 if (pVBInfo->TVInfo & SetYPbPrMode525p)
5586 xgifb_reg_set(pVBInfo->Part3Port, 0x28, 0x3f);
5587 }
5588 }
5589 return;
5590 } /* {end of XGI_SetGroup3} */
5591
5592 static void XGI_SetGroup4(unsigned short ModeNo, unsigned short ModeIdIndex,
5593 unsigned short RefreshRateTableIndex,
5594 struct xgi_hw_device_info *HwDeviceExtension,
5595 struct vb_device_info *pVBInfo)
5596 {
5597 unsigned short tempax, tempcx, tempbx, modeflag, temp, temp2;
5598
5599 unsigned long tempebx, tempeax, templong;
5600
5601 if (ModeNo <= 0x13)
5602 /* si+St_ResInfo */
5603 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
5604 else
5605 /* si+Ext_ResInfo */
5606 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
5607
5608 temp = pVBInfo->RVBHCFACT;
5609 xgifb_reg_set(pVBInfo->Part4Port, 0x13, temp);
5610
5611 tempbx = pVBInfo->RVBHCMAX;
5612 temp = tempbx & 0x00FF;
5613 xgifb_reg_set(pVBInfo->Part4Port, 0x14, temp);
5614 temp2 = ((tempbx & 0xFF00) >> 8) << 7;
5615 tempcx = pVBInfo->VGAHT - 1;
5616 temp = tempcx & 0x00FF;
5617 xgifb_reg_set(pVBInfo->Part4Port, 0x16, temp);
5618
5619 temp = ((tempcx & 0xFF00) >> 8) << 3;
5620 temp2 |= temp;
5621
5622 tempcx = pVBInfo->VGAVT - 1;
5623 if (!(pVBInfo->VBInfo & SetCRT2ToTV))
5624 tempcx -= 5;
5625
5626 temp = tempcx & 0x00FF;
5627 xgifb_reg_set(pVBInfo->Part4Port, 0x17, temp);
5628 temp = temp2 | ((tempcx & 0xFF00) >> 8);
5629 xgifb_reg_set(pVBInfo->Part4Port, 0x15, temp);
5630 xgifb_reg_or(pVBInfo->Part4Port, 0x0D, 0x08);
5631 tempcx = pVBInfo->VBInfo;
5632 tempbx = pVBInfo->VGAHDE;
5633
5634 if (modeflag & HalfDCLK)
5635 tempbx = tempbx >> 1;
5636
5637 if (XGI_IsLCDDualLink(pVBInfo))
5638 tempbx = tempbx >> 1;
5639
5640 if (tempcx & SetCRT2ToHiVisionTV) {
5641 temp = 0;
5642 if (tempbx <= 1024)
5643 temp = 0xA0;
5644 if (tempbx == 1280)
5645 temp = 0xC0;
5646 } else if (tempcx & SetCRT2ToTV) {
5647 temp = 0xA0;
5648 if (tempbx <= 800)
5649 temp = 0x80;
5650 } else {
5651 temp = 0x80;
5652 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
5653 temp = 0;
5654 if (tempbx > 800)
5655 temp = 0x60;
5656 }
5657 }
5658
5659 if (pVBInfo->TVInfo & (SetYPbPrMode525p | SetYPbPrMode750p)) {
5660 temp = 0x00;
5661 if (pVBInfo->VGAHDE == 1280)
5662 temp = 0x40;
5663 if (pVBInfo->VGAHDE == 1024)
5664 temp = 0x20;
5665 }
5666 xgifb_reg_and_or(pVBInfo->Part4Port, 0x0E, ~0xEF, temp);
5667
5668 tempebx = pVBInfo->VDE;
5669
5670 if (tempcx & SetCRT2ToHiVisionTV) {
5671 if (!(temp & 0xE000))
5672 tempbx = tempbx >> 1;
5673 }
5674
5675 tempcx = pVBInfo->RVBHRS;
5676 temp = tempcx & 0x00FF;
5677 xgifb_reg_set(pVBInfo->Part4Port, 0x18, temp);
5678
5679 tempeax = pVBInfo->VGAVDE;
5680 tempcx |= 0x04000;
5681
5682 if (tempeax <= tempebx) {
5683 tempcx = (tempcx & (~0x4000));
5684 tempeax = pVBInfo->VGAVDE;
5685 } else {
5686 tempeax -= tempebx;
5687 }
5688
5689 templong = (tempeax * 256 * 1024) % tempebx;
5690 tempeax = (tempeax * 256 * 1024) / tempebx;
5691 tempebx = tempeax;
5692
5693 if (templong != 0)
5694 tempebx++;
5695
5696 temp = (unsigned short) (tempebx & 0x000000FF);
5697 xgifb_reg_set(pVBInfo->Part4Port, 0x1B, temp);
5698
5699 temp = (unsigned short) ((tempebx & 0x0000FF00) >> 8);
5700 xgifb_reg_set(pVBInfo->Part4Port, 0x1A, temp);
5701 tempbx = (unsigned short) (tempebx >> 16);
5702 temp = tempbx & 0x00FF;
5703 temp = temp << 4;
5704 temp |= ((tempcx & 0xFF00) >> 8);
5705 xgifb_reg_set(pVBInfo->Part4Port, 0x19, temp);
5706
5707 /* 301b */
5708 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
5709 | VB_XGI302LV | VB_XGI301C)) {
5710 temp = 0x0028;
5711 xgifb_reg_set(pVBInfo->Part4Port, 0x1C, temp);
5712 tempax = pVBInfo->VGAHDE;
5713 if (modeflag & HalfDCLK)
5714 tempax = tempax >> 1;
5715
5716 if (XGI_IsLCDDualLink(pVBInfo))
5717 tempax = tempax >> 1;
5718
5719 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
5720 if (tempax > 800)
5721 tempax -= 800;
5722 } else {
5723 if (pVBInfo->VGAHDE > 800) {
5724 if (pVBInfo->VGAHDE == 1024)
5725 tempax = (tempax * 25 / 32) - 1;
5726 else
5727 tempax = (tempax * 20 / 32) - 1;
5728 }
5729 }
5730 tempax -= 1;
5731
5732 temp = (tempax & 0xFF00) >> 8;
5733 temp = ((temp & 0x0003) << 4);
5734 xgifb_reg_set(pVBInfo->Part4Port, 0x1E, temp);
5735 temp = (tempax & 0x00FF);
5736 xgifb_reg_set(pVBInfo->Part4Port, 0x1D, temp);
5737
5738 if (pVBInfo->VBInfo & (SetCRT2ToTV | SetCRT2ToHiVisionTV)) {
5739 if (pVBInfo->VGAHDE > 800)
5740 xgifb_reg_or(pVBInfo->Part4Port, 0x1E, 0x08);
5741
5742 }
5743 temp = 0x0036;
5744
5745 if (pVBInfo->VBInfo & SetCRT2ToTV) {
5746 if (!(pVBInfo->TVInfo & (NTSC1024x768
5747 | SetYPbPrMode525p | SetYPbPrMode750p
5748 | SetYPbPrMode1080i))) {
5749 temp |= 0x0001;
5750 if ((pVBInfo->VBInfo & SetInSlaveMode)
5751 && (!(pVBInfo->TVInfo
5752 & TVSimuMode)))
5753 temp &= (~0x0001);
5754 }
5755 }
5756
5757 xgifb_reg_and_or(pVBInfo->Part4Port, 0x1F, 0x00C0, temp);
5758 tempbx = pVBInfo->HT;
5759 if (XGI_IsLCDDualLink(pVBInfo))
5760 tempbx = tempbx >> 1;
5761 tempbx = (tempbx >> 1) - 2;
5762 temp = ((tempbx & 0x0700) >> 8) << 3;
5763 xgifb_reg_and_or(pVBInfo->Part4Port, 0x21, 0x00C0, temp);
5764 temp = tempbx & 0x00FF;
5765 xgifb_reg_set(pVBInfo->Part4Port, 0x22, temp);
5766 }
5767 /* end 301b */
5768
5769 if (pVBInfo->ISXPDOS == 0)
5770 XGI_SetCRT2VCLK(ModeNo, ModeIdIndex, RefreshRateTableIndex,
5771 pVBInfo);
5772 }
5773
5774 static void XGINew_EnableCRT2(struct vb_device_info *pVBInfo)
5775 {
5776 xgifb_reg_and_or(pVBInfo->P3c4, 0x1E, 0xFF, 0x20);
5777 }
5778
5779 static void XGI_SetGroup5(unsigned short ModeNo, unsigned short ModeIdIndex,
5780 struct vb_device_info *pVBInfo)
5781 {
5782 unsigned short Pindex, Pdata;
5783
5784 Pindex = pVBInfo->Part5Port;
5785 Pdata = pVBInfo->Part5Port + 1;
5786 if (pVBInfo->ModeType == ModeVGA) {
5787 if (!(pVBInfo->VBInfo & (SetInSlaveMode | LoadDACFlag
5788 | CRT2DisplayFlag))) {
5789 XGINew_EnableCRT2(pVBInfo);
5790 }
5791 }
5792 return;
5793 }
5794
5795 static void XGI_EnableGatingCRT(struct xgi_hw_device_info *HwDeviceExtension,
5796 struct vb_device_info *pVBInfo)
5797 {
5798 xgifb_reg_and_or(pVBInfo->P3d4, 0x63, 0xBF, 0x40);
5799 }
5800
5801 static void XGI_DisableGatingCRT(struct xgi_hw_device_info *HwDeviceExtension,
5802 struct vb_device_info *pVBInfo)
5803 {
5804
5805 xgifb_reg_and_or(pVBInfo->P3d4, 0x63, 0xBF, 0x00);
5806 }
5807
5808 static unsigned char XGI_XG21CheckLVDSMode(struct xgifb_video_info *xgifb_info,
5809 unsigned short ModeNo, unsigned short ModeIdIndex,
5810 struct vb_device_info *pVBInfo)
5811 {
5812 unsigned short xres, yres, colordepth, modeflag, resindex;
5813
5814 resindex = XGI_GetResInfo(ModeNo, ModeIdIndex, pVBInfo);
5815 if (ModeNo <= 0x13) {
5816 xres = pVBInfo->StResInfo[resindex].HTotal;
5817 yres = pVBInfo->StResInfo[resindex].VTotal;
5818 /* si+St_ResInfo */
5819 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
5820 } else {
5821 xres = pVBInfo->ModeResInfo[resindex].HTotal; /* xres->ax */
5822 yres = pVBInfo->ModeResInfo[resindex].VTotal; /* yres->bx */
5823 /* si+St_ModeFlag */
5824 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
5825 }
5826
5827 if (!(modeflag & Charx8Dot)) {
5828 xres /= 9;
5829 xres *= 8;
5830 }
5831
5832 if (ModeNo > 0x13) {
5833 if ((ModeNo > 0x13) && (modeflag & HalfDCLK))
5834 xres *= 2;
5835
5836 if ((ModeNo > 0x13) && (modeflag & DoubleScanMode))
5837 yres *= 2;
5838
5839 }
5840
5841 if (xres > xgifb_info->lvds_data.LVDSHDE)
5842 return 0;
5843
5844 if (yres > xgifb_info->lvds_data.LVDSVDE)
5845 return 0;
5846
5847 if (ModeNo > 0x13) {
5848 if (xres != xgifb_info->lvds_data.LVDSHDE ||
5849 yres != xgifb_info->lvds_data.LVDSVDE) {
5850 colordepth = XGI_GetColorDepth(ModeNo,
5851 ModeIdIndex,
5852 pVBInfo);
5853 if (colordepth > 2)
5854 return 0;
5855
5856 }
5857 }
5858 return 1;
5859 }
5860
5861 static void xgifb_set_lvds(struct xgifb_video_info *xgifb_info,
5862 int chip_id,
5863 unsigned short ModeNo,
5864 unsigned short ModeIdIndex,
5865 struct vb_device_info *pVBInfo)
5866 {
5867 unsigned char temp, Miscdata;
5868 unsigned short xres, yres, modeflag, resindex;
5869 unsigned short LVDSHT, LVDSHBS, LVDSHRS, LVDSHRE, LVDSHBE;
5870 unsigned short LVDSVT, LVDSVBS, LVDSVRS, LVDSVRE, LVDSVBE;
5871 unsigned short value;
5872
5873 temp = (unsigned char) ((xgifb_info->lvds_data.LVDS_Capability &
5874 (LCDPolarity << 8)) >> 8);
5875 temp &= LCDPolarity;
5876 Miscdata = (unsigned char) inb(pVBInfo->P3cc);
5877
5878 outb((Miscdata & 0x3F) | temp, pVBInfo->P3c2);
5879
5880 temp = xgifb_info->lvds_data.LVDS_Capability & LCDPolarity;
5881 /* SR35[7] FP VSync polarity */
5882 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x80, temp & 0x80);
5883 /* SR30[5] FP HSync polarity */
5884 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, ~0x20, (temp & 0x40) >> 1);
5885
5886 if (chip_id == XG27)
5887 XGI_SetXG27FPBits(pVBInfo);
5888 else
5889 XGI_SetXG21FPBits(pVBInfo);
5890
5891 resindex = XGI_GetResInfo(ModeNo, ModeIdIndex, pVBInfo);
5892 if (ModeNo <= 0x13) {
5893 xres = pVBInfo->StResInfo[resindex].HTotal;
5894 yres = pVBInfo->StResInfo[resindex].VTotal;
5895 /* si+St_ResInfo */
5896 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
5897 } else {
5898 xres = pVBInfo->ModeResInfo[resindex].HTotal; /* xres->ax */
5899 yres = pVBInfo->ModeResInfo[resindex].VTotal; /* yres->bx */
5900 /* si+St_ModeFlag */
5901 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
5902 }
5903
5904 if (!(modeflag & Charx8Dot))
5905 xres = xres * 8 / 9;
5906
5907 LVDSHT = xgifb_info->lvds_data.LVDSHT;
5908
5909 LVDSHBS = xres + (xgifb_info->lvds_data.LVDSHDE - xres) / 2;
5910 if ((ModeNo <= 0x13) && (modeflag & HalfDCLK))
5911 LVDSHBS -= xres / 4;
5912
5913 if (LVDSHBS > LVDSHT)
5914 LVDSHBS -= LVDSHT;
5915
5916 LVDSHRS = LVDSHBS + xgifb_info->lvds_data.LVDSHFP;
5917 if (LVDSHRS > LVDSHT)
5918 LVDSHRS -= LVDSHT;
5919
5920 LVDSHRE = LVDSHRS + xgifb_info->lvds_data.LVDSHSYNC;
5921 if (LVDSHRE > LVDSHT)
5922 LVDSHRE -= LVDSHT;
5923
5924 LVDSHBE = LVDSHBS + LVDSHT - xgifb_info->lvds_data.LVDSHDE;
5925
5926 LVDSVT = xgifb_info->lvds_data.LVDSVT;
5927
5928 LVDSVBS = yres + (xgifb_info->lvds_data.LVDSVDE - yres) / 2;
5929 if ((ModeNo > 0x13) && (modeflag & DoubleScanMode))
5930 LVDSVBS += yres / 2;
5931
5932 if (LVDSVBS > LVDSVT)
5933 LVDSVBS -= LVDSVT;
5934
5935 LVDSVRS = LVDSVBS + xgifb_info->lvds_data.LVDSVFP;
5936 if (LVDSVRS > LVDSVT)
5937 LVDSVRS -= LVDSVT;
5938
5939 LVDSVRE = LVDSVRS + xgifb_info->lvds_data.LVDSVSYNC;
5940 if (LVDSVRE > LVDSVT)
5941 LVDSVRE -= LVDSVT;
5942
5943 LVDSVBE = LVDSVBS + LVDSVT - xgifb_info->lvds_data.LVDSVDE;
5944
5945 temp = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x11);
5946 xgifb_reg_set(pVBInfo->P3d4, 0x11, temp & 0x7f); /* Unlock CRTC */
5947
5948 if (!(modeflag & Charx8Dot))
5949 xgifb_reg_or(pVBInfo->P3c4, 0x1, 0x1);
5950
5951 /* HT SR0B[1:0] CR00 */
5952 value = (LVDSHT >> 3) - 5;
5953 xgifb_reg_and_or(pVBInfo->P3c4, 0x0B, ~0x03, (value & 0x300) >> 8);
5954 xgifb_reg_set(pVBInfo->P3d4, 0x0, (value & 0xFF));
5955
5956 /* HBS SR0B[5:4] CR02 */
5957 value = (LVDSHBS >> 3) - 1;
5958 xgifb_reg_and_or(pVBInfo->P3c4, 0x0B, ~0x30, (value & 0x300) >> 4);
5959 xgifb_reg_set(pVBInfo->P3d4, 0x2, (value & 0xFF));
5960
5961 /* HBE SR0C[1:0] CR05[7] CR03[4:0] */
5962 value = (LVDSHBE >> 3) - 1;
5963 xgifb_reg_and_or(pVBInfo->P3c4, 0x0C, ~0x03, (value & 0xC0) >> 6);
5964 xgifb_reg_and_or(pVBInfo->P3d4, 0x05, ~0x80, (value & 0x20) << 2);
5965 xgifb_reg_and_or(pVBInfo->P3d4, 0x03, ~0x1F, value & 0x1F);
5966
5967 /* HRS SR0B[7:6] CR04 */
5968 value = (LVDSHRS >> 3) + 2;
5969 xgifb_reg_and_or(pVBInfo->P3c4, 0x0B, ~0xC0, (value & 0x300) >> 2);
5970 xgifb_reg_set(pVBInfo->P3d4, 0x4, (value & 0xFF));
5971
5972 /* Panel HRS SR2F[1:0] SR2E[7:0] */
5973 value--;
5974 xgifb_reg_and_or(pVBInfo->P3c4, 0x2F, ~0x03, (value & 0x300) >> 8);
5975 xgifb_reg_set(pVBInfo->P3c4, 0x2E, (value & 0xFF));
5976
5977 /* HRE SR0C[2] CR05[4:0] */
5978 value = (LVDSHRE >> 3) + 2;
5979 xgifb_reg_and_or(pVBInfo->P3c4, 0x0C, ~0x04, (value & 0x20) >> 3);
5980 xgifb_reg_and_or(pVBInfo->P3d4, 0x05, ~0x1F, value & 0x1F);
5981
5982 /* Panel HRE SR2F[7:2] */
5983 value--;
5984 xgifb_reg_and_or(pVBInfo->P3c4, 0x2F, ~0xFC, value << 2);
5985
5986 /* VT SR0A[0] CR07[5][0] CR06 */
5987 value = LVDSVT - 2;
5988 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x01, (value & 0x400) >> 10);
5989 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x20, (value & 0x200) >> 4);
5990 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x01, (value & 0x100) >> 8);
5991 xgifb_reg_set(pVBInfo->P3d4, 0x06, (value & 0xFF));
5992
5993 /* VBS SR0A[2] CR09[5] CR07[3] CR15 */
5994 value = LVDSVBS - 1;
5995 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x04, (value & 0x400) >> 8);
5996 xgifb_reg_and_or(pVBInfo->P3d4, 0x09, ~0x20, (value & 0x200) >> 4);
5997 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x08, (value & 0x100) >> 5);
5998 xgifb_reg_set(pVBInfo->P3d4, 0x15, (value & 0xFF));
5999
6000 /* VBE SR0A[4] CR16 */
6001 value = LVDSVBE - 1;
6002 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x10, (value & 0x100) >> 4);
6003 xgifb_reg_set(pVBInfo->P3d4, 0x16, (value & 0xFF));
6004
6005 /* VRS SR0A[3] CR7[7][2] CR10 */
6006 value = LVDSVRS - 1;
6007 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x08, (value & 0x400) >> 7);
6008 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x80, (value & 0x200) >> 2);
6009 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x04, (value & 0x100) >> 6);
6010 xgifb_reg_set(pVBInfo->P3d4, 0x10, (value & 0xFF));
6011
6012 if (chip_id == XG27) {
6013 /* Panel VRS SR35[2:0] SR34[7:0] */
6014 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x07,
6015 (value & 0x700) >> 8);
6016 xgifb_reg_set(pVBInfo->P3c4, 0x34, value & 0xFF);
6017 } else {
6018 /* Panel VRS SR3F[1:0] SR34[7:0] SR33[0] */
6019 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0x03,
6020 (value & 0x600) >> 9);
6021 xgifb_reg_set(pVBInfo->P3c4, 0x34, (value >> 1) & 0xFF);
6022 xgifb_reg_and_or(pVBInfo->P3d4, 0x33, ~0x01, value & 0x01);
6023 }
6024
6025 /* VRE SR0A[5] CR11[3:0] */
6026 value = LVDSVRE - 1;
6027 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x20, (value & 0x10) << 1);
6028 xgifb_reg_and_or(pVBInfo->P3d4, 0x11, ~0x0F, value & 0x0F);
6029
6030 /* Panel VRE SR3F[7:2] */
6031 if (chip_id == XG27)
6032 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC,
6033 (value << 2) & 0xFC);
6034 else
6035 /* SR3F[7] has to be 0, h/w bug */
6036 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC,
6037 (value << 2) & 0x7C);
6038
6039 for (temp = 0, value = 0; temp < 3; temp++) {
6040
6041 xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, value);
6042 xgifb_reg_set(pVBInfo->P3c4,
6043 0x2B, xgifb_info->lvds_data.VCLKData1);
6044 xgifb_reg_set(pVBInfo->P3c4,
6045 0x2C, xgifb_info->lvds_data.VCLKData2);
6046 value += 0x10;
6047 }
6048
6049 if (!(modeflag & Charx8Dot)) {
6050 inb(pVBInfo->P3da); /* reset 3da */
6051 outb(0x13, pVBInfo->P3c0); /* set index */
6052 /* set data, panning = 0, shift left 1 dot*/
6053 outb(0x00, pVBInfo->P3c0);
6054
6055 inb(pVBInfo->P3da); /* Enable Attribute */
6056 outb(0x20, pVBInfo->P3c0);
6057
6058 inb(pVBInfo->P3da); /* reset 3da */
6059 }
6060
6061 }
6062
6063 /* --------------------------------------------------------------------- */
6064 /* Function : XGI_IsLCDON */
6065 /* Input : */
6066 /* Output : 0 : Skip PSC Control */
6067 /* 1: Disable PSC */
6068 /* Description : */
6069 /* --------------------------------------------------------------------- */
6070 static unsigned char XGI_IsLCDON(struct vb_device_info *pVBInfo)
6071 {
6072 unsigned short tempax;
6073
6074 tempax = pVBInfo->VBInfo;
6075 if (tempax & SetCRT2ToDualEdge)
6076 return 0;
6077 else if (tempax & (DisableCRT2Display | SwitchToCRT2 | SetSimuScanMode))
6078 return 1;
6079
6080 return 0;
6081 }
6082
6083 /* --------------------------------------------------------------------- */
6084 /* Function : XGI_DisableChISLCD */
6085 /* Input : */
6086 /* Output : 0 -> Not LCD Mode */
6087 /* Description : */
6088 /* --------------------------------------------------------------------- */
6089 static unsigned char XGI_DisableChISLCD(struct vb_device_info *pVBInfo)
6090 {
6091 unsigned short tempbx, tempah;
6092
6093 tempbx = pVBInfo->SetFlag & (DisableChA | DisableChB);
6094 tempah = ~((unsigned short) xgifb_reg_get(pVBInfo->Part1Port, 0x2E));
6095
6096 if (tempbx & (EnableChA | DisableChA)) {
6097 if (!(tempah & 0x08)) /* Chk LCDA Mode */
6098 return 0;
6099 }
6100
6101 if (!(tempbx & (EnableChB | DisableChB)))
6102 return 0;
6103
6104 if (tempah & 0x01) /* Chk LCDB Mode */
6105 return 1;
6106
6107 return 0;
6108 }
6109
6110 /* --------------------------------------------------------------------- */
6111 /* Function : XGI_EnableChISLCD */
6112 /* Input : */
6113 /* Output : 0 -> Not LCD mode */
6114 /* Description : */
6115 /* --------------------------------------------------------------------- */
6116 static unsigned char XGI_EnableChISLCD(struct vb_device_info *pVBInfo)
6117 {
6118 unsigned short tempbx, tempah;
6119
6120 tempbx = pVBInfo->SetFlag & (EnableChA | EnableChB);
6121 tempah = ~((unsigned short) xgifb_reg_get(pVBInfo->Part1Port, 0x2E));
6122
6123 if (tempbx & (EnableChA | DisableChA)) {
6124 if (!(tempah & 0x08)) /* Chk LCDA Mode */
6125 return 0;
6126 }
6127
6128 if (!(tempbx & (EnableChB | DisableChB)))
6129 return 0;
6130
6131 if (tempah & 0x01) /* Chk LCDB Mode */
6132 return 1;
6133
6134 return 0;
6135 }
6136
6137 static void XGI_DisableBridge(struct xgifb_video_info *xgifb_info,
6138 struct xgi_hw_device_info *HwDeviceExtension,
6139 struct vb_device_info *pVBInfo)
6140 {
6141 unsigned short tempah = 0;
6142
6143 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
6144 | VB_XGI302LV | VB_XGI301C)) {
6145 tempah = 0x3F;
6146 if (!(pVBInfo->VBInfo &
6147 (DisableCRT2Display | SetSimuScanMode))) {
6148 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
6149 if (pVBInfo->VBInfo & SetCRT2ToDualEdge) {
6150 tempah = 0x7F; /* Disable Channel A */
6151 if (!(pVBInfo->VBInfo & SetCRT2ToLCDA))
6152 /* Disable Channel B */
6153 tempah = 0xBF;
6154
6155 if (pVBInfo->SetFlag & DisableChB)
6156 /* force to disable Cahnnel */
6157 tempah &= 0xBF;
6158
6159 if (pVBInfo->SetFlag & DisableChA)
6160 /* Force to disable Channel B */
6161 tempah &= 0x7F;
6162 }
6163 }
6164 }
6165
6166 /* disable part4_1f */
6167 xgifb_reg_and(pVBInfo->Part4Port, 0x1F, tempah);
6168
6169 if (pVBInfo->VBType & (VB_XGI302LV | VB_XGI301C)) {
6170 if (((pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)))
6171 || (XGI_DisableChISLCD(pVBInfo))
6172 || (XGI_IsLCDON(pVBInfo)))
6173 /* LVDS Driver power down */
6174 xgifb_reg_or(pVBInfo->Part4Port, 0x30, 0x80);
6175 }
6176
6177 if ((pVBInfo->SetFlag & DisableChA) || (pVBInfo->VBInfo
6178 & (DisableCRT2Display | SetCRT2ToLCDA
6179 | SetSimuScanMode))) {
6180 if (pVBInfo->SetFlag & GatingCRT)
6181 XGI_EnableGatingCRT(HwDeviceExtension, pVBInfo);
6182 XGI_DisplayOff(xgifb_info, HwDeviceExtension, pVBInfo);
6183 }
6184
6185 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
6186 if ((pVBInfo->SetFlag & DisableChA) || (pVBInfo->VBInfo
6187 & SetCRT2ToLCDA))
6188 /* Power down */
6189 xgifb_reg_and(pVBInfo->Part1Port, 0x1e, 0xdf);
6190 }
6191
6192 /* disable TV as primary VGA swap */
6193 xgifb_reg_and(pVBInfo->P3c4, 0x32, 0xdf);
6194
6195 if ((pVBInfo->VBInfo & (SetSimuScanMode | SetCRT2ToDualEdge)))
6196 xgifb_reg_and(pVBInfo->Part2Port, 0x00, 0xdf);
6197
6198 if ((pVBInfo->SetFlag & DisableChB) ||
6199 (pVBInfo->VBInfo &
6200 (DisableCRT2Display | SetSimuScanMode)) ||
6201 ((!(pVBInfo->VBInfo & SetCRT2ToLCDA)) &&
6202 (pVBInfo->VBInfo &
6203 (SetCRT2ToRAMDAC | SetCRT2ToLCD | SetCRT2ToTV))))
6204 xgifb_reg_or(pVBInfo->Part1Port, 0x00, 0x80);
6205
6206 if ((pVBInfo->SetFlag & DisableChB) ||
6207 (pVBInfo->VBInfo &
6208 (DisableCRT2Display | SetSimuScanMode)) ||
6209 (!(pVBInfo->VBInfo & SetCRT2ToLCDA)) ||
6210 (pVBInfo->VBInfo &
6211 (SetCRT2ToRAMDAC | SetCRT2ToLCD | SetCRT2ToTV))) {
6212 /* save Part1 index 0 */
6213 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x00);
6214 /* BTDAC = 1, avoid VB reset */
6215 xgifb_reg_or(pVBInfo->Part1Port, 0x00, 0x10);
6216 /* disable CRT2 */
6217 xgifb_reg_and(pVBInfo->Part1Port, 0x1E, 0xDF);
6218 /* restore Part1 index 0 */
6219 xgifb_reg_set(pVBInfo->Part1Port, 0x00, tempah);
6220 }
6221 } else { /* {301} */
6222 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
6223 xgifb_reg_or(pVBInfo->Part1Port, 0x00, 0x80);
6224 /* Disable CRT2 */
6225 xgifb_reg_and(pVBInfo->Part1Port, 0x1E, 0xDF);
6226 /* Disable TV asPrimary VGA swap */
6227 xgifb_reg_and(pVBInfo->P3c4, 0x32, 0xDF);
6228 }
6229
6230 if (pVBInfo->VBInfo & (DisableCRT2Display | SetCRT2ToLCDA
6231 | SetSimuScanMode))
6232 XGI_DisplayOff(xgifb_info, HwDeviceExtension, pVBInfo);
6233 }
6234 }
6235
6236 /* --------------------------------------------------------------------- */
6237 /* Function : XGI_GetTVPtrIndex */
6238 /* Input : */
6239 /* Output : */
6240 /* Description : bx 0 : ExtNTSC */
6241 /* 1 : StNTSC */
6242 /* 2 : ExtPAL */
6243 /* 3 : StPAL */
6244 /* 4 : ExtHiTV */
6245 /* 5 : StHiTV */
6246 /* 6 : Ext525i */
6247 /* 7 : St525i */
6248 /* 8 : Ext525p */
6249 /* 9 : St525p */
6250 /* A : Ext750p */
6251 /* B : St750p */
6252 /* --------------------------------------------------------------------- */
6253 static unsigned short XGI_GetTVPtrIndex(struct vb_device_info *pVBInfo)
6254 {
6255 unsigned short tempbx = 0;
6256
6257 if (pVBInfo->TVInfo & SetPALTV)
6258 tempbx = 2;
6259 if (pVBInfo->TVInfo & SetYPbPrMode1080i)
6260 tempbx = 4;
6261 if (pVBInfo->TVInfo & SetYPbPrMode525i)
6262 tempbx = 6;
6263 if (pVBInfo->TVInfo & SetYPbPrMode525p)
6264 tempbx = 8;
6265 if (pVBInfo->TVInfo & SetYPbPrMode750p)
6266 tempbx = 10;
6267 if (pVBInfo->TVInfo & TVSimuMode)
6268 tempbx++;
6269
6270 return tempbx;
6271 }
6272
6273 /* --------------------------------------------------------------------- */
6274 /* Function : XGI_GetTVPtrIndex2 */
6275 /* Input : */
6276 /* Output : bx 0 : NTSC */
6277 /* 1 : PAL */
6278 /* 2 : PALM */
6279 /* 3 : PALN */
6280 /* 4 : NTSC1024x768 */
6281 /* 5 : PAL-M 1024x768 */
6282 /* 6-7: reserved */
6283 /* cl 0 : YFilter1 */
6284 /* 1 : YFilter2 */
6285 /* ch 0 : 301A */
6286 /* 1 : 301B/302B/301LV/302LV */
6287 /* Description : */
6288 /* --------------------------------------------------------------------- */
6289 static void XGI_GetTVPtrIndex2(unsigned short *tempbx, unsigned char *tempcl,
6290 unsigned char *tempch, struct vb_device_info *pVBInfo)
6291 {
6292 *tempbx = 0;
6293 *tempcl = 0;
6294 *tempch = 0;
6295
6296 if (pVBInfo->TVInfo & SetPALTV)
6297 *tempbx = 1;
6298
6299 if (pVBInfo->TVInfo & SetPALMTV)
6300 *tempbx = 2;
6301
6302 if (pVBInfo->TVInfo & SetPALNTV)
6303 *tempbx = 3;
6304
6305 if (pVBInfo->TVInfo & NTSC1024x768) {
6306 *tempbx = 4;
6307 if (pVBInfo->TVInfo & SetPALMTV)
6308 *tempbx = 5;
6309 }
6310
6311 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
6312 | VB_XGI302LV | VB_XGI301C)) {
6313 if ((!(pVBInfo->VBInfo & SetInSlaveMode)) || (pVBInfo->TVInfo
6314 & TVSimuMode)) {
6315 *tempbx += 8;
6316 *tempcl += 1;
6317 }
6318 }
6319
6320 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
6321 | VB_XGI302LV | VB_XGI301C))
6322 (*tempch)++;
6323 }
6324
6325 static void XGI_SetDelayComp(struct vb_device_info *pVBInfo)
6326 {
6327 unsigned short index;
6328
6329 unsigned char tempah, tempbl, tempbh;
6330
6331 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
6332 | VB_XGI302LV | VB_XGI301C)) {
6333 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA
6334 | SetCRT2ToTV | SetCRT2ToRAMDAC)) {
6335 tempbl = 0;
6336 tempbh = 0;
6337
6338 index = XGI_GetTVPtrIndex(pVBInfo); /* Get TV Delay */
6339 tempbl = pVBInfo->XGI_TVDelayList[index];
6340
6341 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B
6342 | VB_XGI301LV | VB_XGI302LV
6343 | VB_XGI301C))
6344 tempbl = pVBInfo->XGI_TVDelayList2[index];
6345
6346 if (pVBInfo->VBInfo & SetCRT2ToDualEdge)
6347 tempbl = tempbl >> 4;
6348 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
6349 /* Get LCD Delay */
6350 index = XGI_GetLCDCapPtr(pVBInfo);
6351 tempbh = pVBInfo->LCDCapList[index].
6352 LCD_DelayCompensation;
6353
6354 if (!(pVBInfo->VBInfo & SetCRT2ToLCDA))
6355 tempbl = tempbh;
6356 }
6357
6358 tempbl &= 0x0F;
6359 tempbh &= 0xF0;
6360 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x2D);
6361
6362 if (pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToLCD
6363 | SetCRT2ToTV)) { /* Channel B */
6364 tempah &= 0xF0;
6365 tempah |= tempbl;
6366 }
6367
6368 if (pVBInfo->VBInfo & SetCRT2ToLCDA) { /* Channel A */
6369 tempah &= 0x0F;
6370 tempah |= tempbh;
6371 }
6372 xgifb_reg_set(pVBInfo->Part1Port, 0x2D, tempah);
6373 }
6374 } else if (pVBInfo->IF_DEF_LVDS == 1) {
6375 tempbl = 0;
6376 tempbh = 0;
6377 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
6378 /* / Get LCD Delay */
6379 tempah = pVBInfo->LCDCapList[
6380 XGI_GetLCDCapPtr(pVBInfo)].
6381 LCD_DelayCompensation;
6382 tempah &= 0x0f;
6383 tempah = tempah << 4;
6384 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2D, 0x0f,
6385 tempah);
6386 }
6387 }
6388 }
6389
6390 static void XGI_SetLCDCap_A(unsigned short tempcx,
6391 struct vb_device_info *pVBInfo)
6392 {
6393 unsigned short temp;
6394
6395 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
6396
6397 if (temp & LCDRGB18Bit) {
6398 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, 0x0F,
6399 /* Enable Dither */
6400 (unsigned short) (0x20 | (tempcx & 0x00C0)));
6401 xgifb_reg_and_or(pVBInfo->Part1Port, 0x1A, 0x7F, 0x80);
6402 } else {
6403 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, 0x0F,
6404 (unsigned short) (0x30 | (tempcx & 0x00C0)));
6405 xgifb_reg_and_or(pVBInfo->Part1Port, 0x1A, 0x7F, 0x00);
6406 }
6407 }
6408
6409 /* --------------------------------------------------------------------- */
6410 /* Function : XGI_SetLCDCap_B */
6411 /* Input : cx -> LCD Capability */
6412 /* Output : */
6413 /* Description : */
6414 /* --------------------------------------------------------------------- */
6415 static void XGI_SetLCDCap_B(unsigned short tempcx,
6416 struct vb_device_info *pVBInfo)
6417 {
6418 if (tempcx & EnableLCD24bpp) /* 24bits */
6419 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1A, 0xE0,
6420 (unsigned short) (((tempcx & 0x00ff) >> 6)
6421 | 0x0c));
6422 else
6423 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1A, 0xE0,
6424 (unsigned short) (((tempcx & 0x00ff) >> 6)
6425 | 0x18)); /* Enable Dither */
6426 }
6427
6428 static void XGI_LongWait(struct vb_device_info *pVBInfo)
6429 {
6430 unsigned short i;
6431
6432 i = xgifb_reg_get(pVBInfo->P3c4, 0x1F);
6433
6434 if (!(i & 0xC0)) {
6435 for (i = 0; i < 0xFFFF; i++) {
6436 if (!(inb(pVBInfo->P3da) & 0x08))
6437 break;
6438 }
6439
6440 for (i = 0; i < 0xFFFF; i++) {
6441 if ((inb(pVBInfo->P3da) & 0x08))
6442 break;
6443 }
6444 }
6445 }
6446
6447 static void SetSpectrum(struct vb_device_info *pVBInfo)
6448 {
6449 unsigned short index;
6450
6451 index = XGI_GetLCDCapPtr(pVBInfo);
6452
6453 /* disable down spectrum D[4] */
6454 xgifb_reg_and(pVBInfo->Part4Port, 0x30, 0x8F);
6455 XGI_LongWait(pVBInfo);
6456 xgifb_reg_or(pVBInfo->Part4Port, 0x30, 0x20); /* reset spectrum */
6457 XGI_LongWait(pVBInfo);
6458
6459 xgifb_reg_set(pVBInfo->Part4Port, 0x31,
6460 pVBInfo->LCDCapList[index].Spectrum_31);
6461 xgifb_reg_set(pVBInfo->Part4Port, 0x32,
6462 pVBInfo->LCDCapList[index].Spectrum_32);
6463 xgifb_reg_set(pVBInfo->Part4Port, 0x33,
6464 pVBInfo->LCDCapList[index].Spectrum_33);
6465 xgifb_reg_set(pVBInfo->Part4Port, 0x34,
6466 pVBInfo->LCDCapList[index].Spectrum_34);
6467 XGI_LongWait(pVBInfo);
6468 xgifb_reg_or(pVBInfo->Part4Port, 0x30, 0x40); /* enable spectrum */
6469 }
6470
6471 static void XGI_SetLCDCap(struct vb_device_info *pVBInfo)
6472 {
6473 unsigned short tempcx;
6474
6475 tempcx = pVBInfo->LCDCapList[XGI_GetLCDCapPtr(pVBInfo)].LCD_Capability;
6476
6477 if (pVBInfo->VBType &
6478 (VB_XGI301B |
6479 VB_XGI302B |
6480 VB_XGI301LV |
6481 VB_XGI302LV |
6482 VB_XGI301C)) { /* 301LV/302LV only */
6483 if (pVBInfo->VBType &
6484 (VB_XGI301LV | VB_XGI302LV | VB_XGI301C)) {
6485 /* Set 301LV Capability */
6486 xgifb_reg_set(pVBInfo->Part4Port, 0x24,
6487 (unsigned char) (tempcx & 0x1F));
6488 }
6489 /* VB Driving */
6490 xgifb_reg_and_or(pVBInfo->Part4Port, 0x0D,
6491 ~((EnableVBCLKDRVLOW | EnablePLLSPLOW) >> 8),
6492 (unsigned short) ((tempcx & (EnableVBCLKDRVLOW
6493 | EnablePLLSPLOW)) >> 8));
6494 }
6495
6496 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
6497 | VB_XGI302LV | VB_XGI301C)) {
6498 if (pVBInfo->VBInfo & SetCRT2ToLCD)
6499 XGI_SetLCDCap_B(tempcx, pVBInfo);
6500 else if (pVBInfo->VBInfo & SetCRT2ToLCDA)
6501 XGI_SetLCDCap_A(tempcx, pVBInfo);
6502
6503 if (pVBInfo->VBType & (VB_XGI302LV | VB_XGI301C)) {
6504 if (tempcx & EnableSpectrum)
6505 SetSpectrum(pVBInfo);
6506 }
6507 } else {
6508 /* LVDS,CH7017 */
6509 XGI_SetLCDCap_A(tempcx, pVBInfo);
6510 }
6511 }
6512
6513 /* --------------------------------------------------------------------- */
6514 /* Function : XGI_SetAntiFlicker */
6515 /* Input : */
6516 /* Output : */
6517 /* Description : Set TV Customized Param. */
6518 /* --------------------------------------------------------------------- */
6519 static void XGI_SetAntiFlicker(unsigned short ModeNo,
6520 unsigned short ModeIdIndex,
6521 struct vb_device_info *pVBInfo)
6522 {
6523 unsigned short tempbx, index;
6524
6525 unsigned char tempah;
6526
6527 if (pVBInfo->TVInfo & (SetYPbPrMode525p | SetYPbPrMode750p))
6528 return;
6529
6530 tempbx = XGI_GetTVPtrIndex(pVBInfo);
6531 tempbx &= 0xFE;
6532
6533 if (ModeNo <= 0x13)
6534 index = pVBInfo->SModeIDTable[ModeIdIndex].VB_StTVFlickerIndex;
6535 else
6536 index = pVBInfo->EModeIDTable[ModeIdIndex].VB_ExtTVFlickerIndex;
6537
6538 tempbx += index;
6539 tempah = TVAntiFlickList[tempbx];
6540 tempah = tempah << 4;
6541
6542 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0A, 0x8F, tempah);
6543 }
6544
6545 static void XGI_SetEdgeEnhance(unsigned short ModeNo,
6546 unsigned short ModeIdIndex,
6547 struct vb_device_info *pVBInfo)
6548 {
6549 unsigned short tempbx, index;
6550
6551 unsigned char tempah;
6552
6553 tempbx = XGI_GetTVPtrIndex(pVBInfo);
6554 tempbx &= 0xFE;
6555
6556 if (ModeNo <= 0x13)
6557 index = pVBInfo->SModeIDTable[ModeIdIndex].VB_StTVEdgeIndex;
6558 else
6559 index = pVBInfo->EModeIDTable[ModeIdIndex].VB_ExtTVEdgeIndex;
6560
6561 tempbx += index;
6562 tempah = TVEdgeList[tempbx];
6563 tempah = tempah << 5;
6564
6565 xgifb_reg_and_or(pVBInfo->Part2Port, 0x3A, 0x1F, tempah);
6566 }
6567
6568 static void XGI_SetPhaseIncr(struct vb_device_info *pVBInfo)
6569 {
6570 unsigned short tempbx;
6571
6572 unsigned char tempcl, tempch;
6573
6574 unsigned long tempData;
6575
6576 XGI_GetTVPtrIndex2(&tempbx, &tempcl, &tempch, pVBInfo); /* bx, cl, ch */
6577 tempData = TVPhaseList[tempbx];
6578
6579 xgifb_reg_set(pVBInfo->Part2Port, 0x31, (unsigned short) (tempData
6580 & 0x000000FF));
6581 xgifb_reg_set(pVBInfo->Part2Port, 0x32, (unsigned short) ((tempData
6582 & 0x0000FF00) >> 8));
6583 xgifb_reg_set(pVBInfo->Part2Port, 0x33, (unsigned short) ((tempData
6584 & 0x00FF0000) >> 16));
6585 xgifb_reg_set(pVBInfo->Part2Port, 0x34, (unsigned short) ((tempData
6586 & 0xFF000000) >> 24));
6587 }
6588
6589 static void XGI_SetYFilter(unsigned short ModeNo, unsigned short ModeIdIndex,
6590 struct vb_device_info *pVBInfo)
6591 {
6592 unsigned short tempbx, index;
6593
6594 unsigned char tempcl, tempch, tempal, *filterPtr;
6595
6596 XGI_GetTVPtrIndex2(&tempbx, &tempcl, &tempch, pVBInfo); /* bx, cl, ch */
6597
6598 switch (tempbx) {
6599 case 0x00:
6600 case 0x04:
6601 filterPtr = NTSCYFilter1;
6602 break;
6603
6604 case 0x01:
6605 filterPtr = PALYFilter1;
6606 break;
6607
6608 case 0x02:
6609 case 0x05:
6610 case 0x0D:
6611 case 0x03:
6612 filterPtr = xgifb_palmn_yfilter1;
6613 break;
6614
6615 case 0x08:
6616 case 0x0C:
6617 case 0x0A:
6618 case 0x0B:
6619 case 0x09:
6620 filterPtr = xgifb_yfilter2;
6621 break;
6622
6623 default:
6624 return;
6625 }
6626
6627 if (ModeNo <= 0x13)
6628 tempal = pVBInfo->SModeIDTable[ModeIdIndex].
6629 VB_StTVYFilterIndex;
6630 else
6631 tempal = pVBInfo->EModeIDTable[ModeIdIndex].
6632 VB_ExtTVYFilterIndex;
6633
6634 if (tempcl == 0)
6635 index = tempal * 4;
6636 else
6637 index = tempal * 7;
6638
6639 if ((tempcl == 0) && (tempch == 1)) {
6640 xgifb_reg_set(pVBInfo->Part2Port, 0x35, 0);
6641 xgifb_reg_set(pVBInfo->Part2Port, 0x36, 0);
6642 xgifb_reg_set(pVBInfo->Part2Port, 0x37, 0);
6643 xgifb_reg_set(pVBInfo->Part2Port, 0x38, filterPtr[index++]);
6644 } else {
6645 xgifb_reg_set(pVBInfo->Part2Port, 0x35, filterPtr[index++]);
6646 xgifb_reg_set(pVBInfo->Part2Port, 0x36, filterPtr[index++]);
6647 xgifb_reg_set(pVBInfo->Part2Port, 0x37, filterPtr[index++]);
6648 xgifb_reg_set(pVBInfo->Part2Port, 0x38, filterPtr[index++]);
6649 }
6650
6651 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
6652 | VB_XGI302LV | VB_XGI301C)) {
6653 xgifb_reg_set(pVBInfo->Part2Port, 0x48, filterPtr[index++]);
6654 xgifb_reg_set(pVBInfo->Part2Port, 0x49, filterPtr[index++]);
6655 xgifb_reg_set(pVBInfo->Part2Port, 0x4A, filterPtr[index++]);
6656 }
6657 }
6658
6659 /* --------------------------------------------------------------------- */
6660 /* Function : XGI_OEM310Setting */
6661 /* Input : */
6662 /* Output : */
6663 /* Description : Customized Param. for 301 */
6664 /* --------------------------------------------------------------------- */
6665 static void XGI_OEM310Setting(unsigned short ModeNo,
6666 unsigned short ModeIdIndex,
6667 struct vb_device_info *pVBInfo)
6668 {
6669 XGI_SetDelayComp(pVBInfo);
6670
6671 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA))
6672 XGI_SetLCDCap(pVBInfo);
6673
6674 if (pVBInfo->VBInfo & SetCRT2ToTV) {
6675 XGI_SetPhaseIncr(pVBInfo);
6676 XGI_SetYFilter(ModeNo, ModeIdIndex, pVBInfo);
6677 XGI_SetAntiFlicker(ModeNo, ModeIdIndex, pVBInfo);
6678
6679 if (pVBInfo->VBType & VB_XGI301)
6680 XGI_SetEdgeEnhance(ModeNo, ModeIdIndex, pVBInfo);
6681 }
6682 }
6683
6684 /* --------------------------------------------------------------------- */
6685 /* Function : XGI_SetCRT2ModeRegs */
6686 /* Input : */
6687 /* Output : */
6688 /* Description : Origin code for crt2group */
6689 /* --------------------------------------------------------------------- */
6690 static void XGI_SetCRT2ModeRegs(unsigned short ModeNo,
6691 struct xgi_hw_device_info *HwDeviceExtension,
6692 struct vb_device_info *pVBInfo)
6693 {
6694 unsigned short tempbl;
6695 short tempcl;
6696
6697 unsigned char tempah;
6698
6699 tempah = 0;
6700 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
6701 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x00);
6702 tempah &= ~0x10; /* BTRAMDAC */
6703 tempah |= 0x40; /* BTRAM */
6704
6705 if (pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToTV
6706 | SetCRT2ToLCD)) {
6707 tempah = 0x40; /* BTDRAM */
6708 if (ModeNo > 0x13) {
6709 tempcl = pVBInfo->ModeType;
6710 tempcl -= ModeVGA;
6711 if (tempcl >= 0) {
6712 /* BT Color */
6713 tempah = (0x008 >> tempcl);
6714 if (tempah == 0)
6715 tempah = 1;
6716 tempah |= 0x040;
6717 }
6718 }
6719 if (pVBInfo->VBInfo & SetInSlaveMode)
6720 tempah ^= 0x50; /* BTDAC */
6721 }
6722 }
6723
6724 xgifb_reg_set(pVBInfo->Part1Port, 0x00, tempah);
6725 tempah = 0x08;
6726 tempbl = 0xf0;
6727
6728 if (pVBInfo->VBInfo & DisableCRT2Display) {
6729 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2e, tempbl, tempah);
6730 } else {
6731 tempah = 0x00;
6732 tempbl = 0xff;
6733
6734 if (pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToTV
6735 | SetCRT2ToLCD | SetCRT2ToLCDA)) {
6736 if ((pVBInfo->VBInfo & SetCRT2ToLCDA) &&
6737 (!(pVBInfo->VBInfo & SetSimuScanMode))) {
6738 tempbl &= 0xf7;
6739 tempah |= 0x01;
6740 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2e,
6741 tempbl, tempah);
6742 } else {
6743 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
6744 tempbl &= 0xf7;
6745 tempah |= 0x01;
6746 }
6747
6748 if (pVBInfo->VBInfo &
6749 (SetCRT2ToRAMDAC |
6750 SetCRT2ToTV |
6751 SetCRT2ToLCD)) {
6752 tempbl &= 0xf8;
6753 tempah = 0x01;
6754
6755 if (!(pVBInfo->VBInfo & SetInSlaveMode))
6756 tempah |= 0x02;
6757
6758 if (!(pVBInfo->VBInfo &
6759 SetCRT2ToRAMDAC)) {
6760 tempah = tempah ^ 0x05;
6761 if (!(pVBInfo->VBInfo &
6762 SetCRT2ToLCD))
6763 tempah = tempah ^ 0x01;
6764 }
6765
6766 if (!(pVBInfo->VBInfo &
6767 SetCRT2ToDualEdge))
6768 tempah |= 0x08;
6769 xgifb_reg_and_or(pVBInfo->Part1Port,
6770 0x2e, tempbl, tempah);
6771 } else {
6772 xgifb_reg_and_or(pVBInfo->Part1Port,
6773 0x2e, tempbl, tempah);
6774 }
6775 }
6776 } else {
6777 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2e, tempbl,
6778 tempah);
6779 }
6780 }
6781
6782 if (pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToTV | SetCRT2ToLCD
6783 | SetCRT2ToLCDA)) {
6784 tempah &= (~0x08);
6785 if ((pVBInfo->ModeType == ModeVGA) && (!(pVBInfo->VBInfo
6786 & SetInSlaveMode))) {
6787 tempah |= 0x010;
6788 }
6789 tempah |= 0x080;
6790
6791 if (pVBInfo->VBInfo & SetCRT2ToTV) {
6792 tempah |= 0x020;
6793 if (ModeNo > 0x13) {
6794 if (pVBInfo->VBInfo & DriverMode)
6795 tempah = tempah ^ 0x20;
6796 }
6797 }
6798
6799 xgifb_reg_and_or(pVBInfo->Part4Port, 0x0D, ~0x0BF, tempah);
6800 tempah = 0;
6801
6802 if (pVBInfo->LCDInfo & SetLCDDualLink)
6803 tempah |= 0x40;
6804
6805 if (pVBInfo->VBInfo & SetCRT2ToTV) {
6806 if (pVBInfo->TVInfo & RPLLDIV2XO)
6807 tempah |= 0x40;
6808 }
6809
6810 if ((pVBInfo->LCDResInfo == Panel1280x1024)
6811 || (pVBInfo->LCDResInfo == Panel1280x1024x75))
6812 tempah |= 0x80;
6813
6814 if (pVBInfo->LCDResInfo == Panel1280x960)
6815 tempah |= 0x80;
6816
6817 xgifb_reg_set(pVBInfo->Part4Port, 0x0C, tempah);
6818 }
6819
6820 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
6821 | VB_XGI302LV | VB_XGI301C)) {
6822 tempah = 0;
6823 tempbl = 0xfb;
6824
6825 if (pVBInfo->VBInfo & SetCRT2ToDualEdge) {
6826 tempbl = 0xff;
6827 if (pVBInfo->VBInfo & SetCRT2ToLCDA)
6828 tempah |= 0x04; /* shampoo 0129 */
6829 }
6830
6831 xgifb_reg_and_or(pVBInfo->Part1Port, 0x13, tempbl, tempah);
6832 tempah = 0x00;
6833 tempbl = 0xcf;
6834 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
6835 if (pVBInfo->VBInfo & SetCRT2ToDualEdge)
6836 tempah |= 0x30;
6837 }
6838
6839 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2c, tempbl, tempah);
6840 tempah = 0;
6841 tempbl = 0x3f;
6842
6843 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
6844 if (pVBInfo->VBInfo & SetCRT2ToDualEdge)
6845 tempah |= 0xc0;
6846 }
6847 xgifb_reg_and_or(pVBInfo->Part4Port, 0x21, tempbl, tempah);
6848 }
6849
6850 tempah = 0;
6851 tempbl = 0x7f;
6852 if (!(pVBInfo->VBInfo & SetCRT2ToLCDA)) {
6853 tempbl = 0xff;
6854 if (!(pVBInfo->VBInfo & SetCRT2ToDualEdge))
6855 tempah |= 0x80;
6856 }
6857
6858 xgifb_reg_and_or(pVBInfo->Part4Port, 0x23, tempbl, tempah);
6859
6860 if (pVBInfo->VBType & (VB_XGI302LV | VB_XGI301C)) {
6861 if (pVBInfo->LCDInfo & SetLCDDualLink) {
6862 xgifb_reg_or(pVBInfo->Part4Port, 0x27, 0x20);
6863 xgifb_reg_or(pVBInfo->Part4Port, 0x34, 0x10);
6864 }
6865 }
6866 }
6867
6868 static void XGI_CloseCRTC(struct xgi_hw_device_info *HwDeviceExtension,
6869 struct vb_device_info *pVBInfo)
6870 {
6871 unsigned short tempbx;
6872
6873 tempbx = 0;
6874
6875 if (pVBInfo->VBInfo & SetCRT2ToLCDA)
6876 tempbx = 0x08A0;
6877
6878 }
6879
6880 void XGI_UnLockCRT2(struct xgi_hw_device_info *HwDeviceExtension,
6881 struct vb_device_info *pVBInfo)
6882 {
6883
6884 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2f, 0xFF, 0x01);
6885
6886 }
6887
6888 void XGI_LockCRT2(struct xgi_hw_device_info *HwDeviceExtension,
6889 struct vb_device_info *pVBInfo)
6890 {
6891
6892 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2F, 0xFE, 0x00);
6893
6894 }
6895
6896 unsigned char XGI_BridgeIsOn(struct vb_device_info *pVBInfo)
6897 {
6898 unsigned short flag;
6899
6900 if (pVBInfo->IF_DEF_LVDS == 1) {
6901 return 1;
6902 } else {
6903 flag = xgifb_reg_get(pVBInfo->Part4Port, 0x00);
6904 if ((flag == 1) || (flag == 2))
6905 return 1; /* 301b */
6906 else
6907 return 0;
6908 }
6909 }
6910
6911 unsigned short XGI_GetRatePtrCRT2(struct xgi_hw_device_info *pXGIHWDE,
6912 unsigned short ModeNo, unsigned short ModeIdIndex,
6913 struct vb_device_info *pVBInfo)
6914 {
6915 short LCDRefreshIndex[] = { 0x00, 0x00, 0x03, 0x01 },
6916 LCDARefreshIndex[] = { 0x00, 0x00, 0x03, 0x01, 0x01,
6917 0x01, 0x01 };
6918
6919 unsigned short RefreshRateTableIndex, i, modeflag, index, temp;
6920
6921 if (ModeNo <= 0x13)
6922 modeflag = pVBInfo->SModeIDTable[ModeIdIndex].St_ModeFlag;
6923 else
6924 modeflag = pVBInfo->EModeIDTable[ModeIdIndex].Ext_ModeFlag;
6925
6926 if (ModeNo < 0x14)
6927 return 0xFFFF;
6928
6929 index = xgifb_reg_get(pVBInfo->P3d4, 0x33);
6930 index = index >> pVBInfo->SelectCRT2Rate;
6931 index &= 0x0F;
6932
6933 if (pVBInfo->LCDInfo & LCDNonExpanding)
6934 index = 0;
6935
6936 if (index > 0)
6937 index--;
6938
6939 if (pVBInfo->SetFlag & ProgrammingCRT2) {
6940 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
6941 if (pVBInfo->IF_DEF_LVDS == 0) {
6942 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B
6943 | VB_XGI301LV | VB_XGI302LV
6944 | VB_XGI301C))
6945 /* 301b */
6946 temp = LCDARefreshIndex[
6947 pVBInfo->LCDResInfo & 0x0F];
6948 else
6949 temp = LCDRefreshIndex[
6950 pVBInfo->LCDResInfo & 0x0F];
6951
6952 if (index > temp)
6953 index = temp;
6954 } else {
6955 index = 0;
6956 }
6957 }
6958 }
6959
6960 RefreshRateTableIndex = pVBInfo->EModeIDTable[ModeIdIndex].REFindex;
6961 ModeNo = pVBInfo->RefIndex[RefreshRateTableIndex].ModeID;
6962 if (pXGIHWDE->jChipType >= XG20) { /* for XG20, XG21, XG27 */
6963 if ((pVBInfo->RefIndex[RefreshRateTableIndex].XRes == 800) &&
6964 (pVBInfo->RefIndex[RefreshRateTableIndex].YRes == 600)) {
6965 index++;
6966 }
6967 /* Alan 10/19/2007;
6968 * do the similar adjustment like XGISearchCRT1Rate() */
6969 if ((pVBInfo->RefIndex[RefreshRateTableIndex].XRes == 1024) &&
6970 (pVBInfo->RefIndex[RefreshRateTableIndex].YRes == 768)) {
6971 index++;
6972 }
6973 if ((pVBInfo->RefIndex[RefreshRateTableIndex].XRes == 1280) &&
6974 (pVBInfo->RefIndex[RefreshRateTableIndex].YRes == 1024)) {
6975 index++;
6976 }
6977 }
6978
6979 i = 0;
6980 do {
6981 if (pVBInfo->RefIndex[RefreshRateTableIndex + i].
6982 ModeID != ModeNo)
6983 break;
6984 temp = pVBInfo->RefIndex[RefreshRateTableIndex + i].
6985 Ext_InfoFlag;
6986 temp &= ModeInfoFlag;
6987 if (temp < pVBInfo->ModeType)
6988 break;
6989 i++;
6990 index--;
6991
6992 } while (index != 0xFFFF);
6993 if (!(pVBInfo->VBInfo & SetCRT2ToRAMDAC)) {
6994 if (pVBInfo->VBInfo & SetInSlaveMode) {
6995 temp = pVBInfo->RefIndex[RefreshRateTableIndex + i - 1].
6996 Ext_InfoFlag;
6997 if (temp & InterlaceMode)
6998 i++;
6999 }
7000 }
7001 i--;
7002 if ((pVBInfo->SetFlag & ProgrammingCRT2)) {
7003 temp = XGI_AjustCRT2Rate(ModeNo, ModeIdIndex,
7004 RefreshRateTableIndex, &i, pVBInfo);
7005 }
7006 return RefreshRateTableIndex + i;
7007 }
7008
7009 static void XGI_SetLCDAGroup(unsigned short ModeNo, unsigned short ModeIdIndex,
7010 struct xgi_hw_device_info *HwDeviceExtension,
7011 struct vb_device_info *pVBInfo)
7012 {
7013 unsigned short RefreshRateTableIndex;
7014
7015 pVBInfo->SetFlag |= ProgrammingCRT2;
7016 RefreshRateTableIndex = XGI_GetRatePtrCRT2(HwDeviceExtension, ModeNo,
7017 ModeIdIndex, pVBInfo);
7018 XGI_GetLVDSResInfo(ModeNo, ModeIdIndex, pVBInfo);
7019 XGI_GetLVDSData(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
7020 XGI_ModCRT1Regs(ModeNo, ModeIdIndex, RefreshRateTableIndex,
7021 HwDeviceExtension, pVBInfo);
7022 XGI_SetLVDSRegs(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
7023 XGI_SetCRT2ECLK(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
7024 }
7025
7026 static unsigned char XGI_SetCRT2Group301(unsigned short ModeNo,
7027 struct xgi_hw_device_info *HwDeviceExtension,
7028 struct vb_device_info *pVBInfo)
7029 {
7030 unsigned short tempbx, ModeIdIndex, RefreshRateTableIndex;
7031
7032 tempbx = pVBInfo->VBInfo;
7033 pVBInfo->SetFlag |= ProgrammingCRT2;
7034 XGI_SearchModeID(ModeNo, &ModeIdIndex, pVBInfo);
7035 pVBInfo->SelectCRT2Rate = 4;
7036 RefreshRateTableIndex = XGI_GetRatePtrCRT2(HwDeviceExtension, ModeNo,
7037 ModeIdIndex, pVBInfo);
7038 XGI_SaveCRT2Info(ModeNo, pVBInfo);
7039 XGI_GetCRT2ResInfo(ModeNo, ModeIdIndex, pVBInfo);
7040 XGI_GetCRT2Data(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
7041 XGI_PreSetGroup1(ModeNo, ModeIdIndex, HwDeviceExtension,
7042 RefreshRateTableIndex, pVBInfo);
7043 XGI_SetGroup1(ModeNo, ModeIdIndex, HwDeviceExtension,
7044 RefreshRateTableIndex, pVBInfo);
7045 XGI_SetLockRegs(ModeNo, ModeIdIndex, HwDeviceExtension,
7046 RefreshRateTableIndex, pVBInfo);
7047 XGI_SetGroup2(ModeNo, ModeIdIndex, RefreshRateTableIndex,
7048 HwDeviceExtension, pVBInfo);
7049 XGI_SetLCDRegs(ModeNo, ModeIdIndex, HwDeviceExtension,
7050 RefreshRateTableIndex, pVBInfo);
7051 XGI_SetTap4Regs(pVBInfo);
7052 XGI_SetGroup3(ModeNo, ModeIdIndex, pVBInfo);
7053 XGI_SetGroup4(ModeNo, ModeIdIndex, RefreshRateTableIndex,
7054 HwDeviceExtension, pVBInfo);
7055 XGI_SetCRT2VCLK(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
7056 XGI_SetGroup5(ModeNo, ModeIdIndex, pVBInfo);
7057 XGI_AutoThreshold(pVBInfo);
7058 return 1;
7059 }
7060
7061 void XGI_SenseCRT1(struct vb_device_info *pVBInfo)
7062 {
7063 unsigned char CRTCData[17] = { 0x5F, 0x4F, 0x50, 0x82, 0x55, 0x81,
7064 0x0B, 0x3E, 0xE9, 0x0B, 0xDF, 0xE7, 0x04, 0x00, 0x00,
7065 0x05, 0x00 };
7066
7067 unsigned char SR01 = 0, SR1F = 0, SR07 = 0, SR06 = 0;
7068
7069 unsigned char CR17, CR63, SR31;
7070 unsigned short temp;
7071 unsigned char DAC_TEST_PARMS[3] = { 0x0F, 0x0F, 0x0F };
7072
7073 int i;
7074 xgifb_reg_set(pVBInfo->P3c4, 0x05, 0x86);
7075
7076 /* [2004/05/06] Vicent to fix XG42 single LCD sense to CRT+LCD */
7077 xgifb_reg_set(pVBInfo->P3d4, 0x57, 0x4A);
7078 xgifb_reg_set(pVBInfo->P3d4, 0x53, (unsigned char) (xgifb_reg_get(
7079 pVBInfo->P3d4, 0x53) | 0x02));
7080
7081 SR31 = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x31);
7082 CR63 = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x63);
7083 SR01 = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x01);
7084
7085 xgifb_reg_set(pVBInfo->P3c4, 0x01, (unsigned char) (SR01 & 0xDF));
7086 xgifb_reg_set(pVBInfo->P3d4, 0x63, (unsigned char) (CR63 & 0xBF));
7087
7088 CR17 = (unsigned char) xgifb_reg_get(pVBInfo->P3d4, 0x17);
7089 xgifb_reg_set(pVBInfo->P3d4, 0x17, (unsigned char) (CR17 | 0x80));
7090
7091 SR1F = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x1F);
7092 xgifb_reg_set(pVBInfo->P3c4, 0x1F, (unsigned char) (SR1F | 0x04));
7093
7094 SR07 = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x07);
7095 xgifb_reg_set(pVBInfo->P3c4, 0x07, (unsigned char) (SR07 & 0xFB));
7096 SR06 = (unsigned char) xgifb_reg_get(pVBInfo->P3c4, 0x06);
7097 xgifb_reg_set(pVBInfo->P3c4, 0x06, (unsigned char) (SR06 & 0xC3));
7098
7099 xgifb_reg_set(pVBInfo->P3d4, 0x11, 0x00);
7100
7101 for (i = 0; i < 8; i++)
7102 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) i, CRTCData[i]);
7103
7104 for (i = 8; i < 11; i++)
7105 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 8),
7106 CRTCData[i]);
7107
7108 for (i = 11; i < 13; i++)
7109 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 4),
7110 CRTCData[i]);
7111
7112 for (i = 13; i < 16; i++)
7113 xgifb_reg_set(pVBInfo->P3c4, (unsigned short) (i - 3),
7114 CRTCData[i]);
7115
7116 xgifb_reg_set(pVBInfo->P3c4, 0x0E, (unsigned char) (CRTCData[16]
7117 & 0xE0));
7118
7119 xgifb_reg_set(pVBInfo->P3c4, 0x31, 0x00);
7120 xgifb_reg_set(pVBInfo->P3c4, 0x2B, 0x1B);
7121 xgifb_reg_set(pVBInfo->P3c4, 0x2C, 0xE1);
7122
7123 outb(0x00, pVBInfo->P3c8);
7124
7125 for (i = 0; i < 256; i++) {
7126 outb((unsigned char) DAC_TEST_PARMS[0], (pVBInfo->P3c8 + 1));
7127 outb((unsigned char) DAC_TEST_PARMS[1], (pVBInfo->P3c8 + 1));
7128 outb((unsigned char) DAC_TEST_PARMS[2], (pVBInfo->P3c8 + 1));
7129 }
7130
7131 mdelay(1);
7132
7133 XGI_WaitDisply(pVBInfo);
7134 temp = inb(pVBInfo->P3c2);
7135
7136 if (temp & 0x10)
7137 xgifb_reg_and_or(pVBInfo->P3d4, 0x32, 0xDF, 0x20);
7138 else
7139 xgifb_reg_and_or(pVBInfo->P3d4, 0x32, 0xDF, 0x00);
7140
7141 /* alan, avoid display something, set BLACK DAC if not restore DAC */
7142 outb(0x00, pVBInfo->P3c8);
7143
7144 for (i = 0; i < 256; i++) {
7145 outb(0, (pVBInfo->P3c8 + 1));
7146 outb(0, (pVBInfo->P3c8 + 1));
7147 outb(0, (pVBInfo->P3c8 + 1));
7148 }
7149
7150 xgifb_reg_set(pVBInfo->P3c4, 0x01, SR01);
7151 xgifb_reg_set(pVBInfo->P3d4, 0x63, CR63);
7152 xgifb_reg_set(pVBInfo->P3c4, 0x31, SR31);
7153
7154 /* [2004/05/11] Vicent */
7155 xgifb_reg_set(pVBInfo->P3d4, 0x53, (unsigned char) (xgifb_reg_get(
7156 pVBInfo->P3d4, 0x53) & 0xFD));
7157 xgifb_reg_set(pVBInfo->P3c4, 0x1F, (unsigned char) SR1F);
7158 }
7159
7160 static void XGI_EnableBridge(struct xgifb_video_info *xgifb_info,
7161 struct xgi_hw_device_info *HwDeviceExtension,
7162 struct vb_device_info *pVBInfo)
7163 {
7164 unsigned short tempah;
7165
7166 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
7167 | VB_XGI302LV | VB_XGI301C)) {
7168 if (!(pVBInfo->SetFlag & DisableChA)) {
7169 if (pVBInfo->SetFlag & EnableChA) {
7170 /* Power on */
7171 xgifb_reg_set(pVBInfo->Part1Port, 0x1E, 0x20);
7172 } else {
7173 if (pVBInfo->VBInfo & SetCRT2ToDualEdge) {
7174 /* Power on */
7175 xgifb_reg_set(pVBInfo->Part1Port,
7176 0x1E, 0x20);
7177 }
7178 }
7179 }
7180
7181 if (!(pVBInfo->SetFlag & DisableChB)) {
7182 if ((pVBInfo->SetFlag & EnableChB) || (pVBInfo->VBInfo
7183 & (SetCRT2ToLCD | SetCRT2ToTV
7184 | SetCRT2ToRAMDAC))) {
7185 tempah = (unsigned char) xgifb_reg_get(
7186 pVBInfo->P3c4, 0x32);
7187 tempah &= 0xDF;
7188 if (pVBInfo->VBInfo & SetInSlaveMode) {
7189 if (!(pVBInfo->VBInfo &
7190 SetCRT2ToRAMDAC))
7191 tempah |= 0x20;
7192 }
7193 xgifb_reg_set(pVBInfo->P3c4, 0x32, tempah);
7194 xgifb_reg_or(pVBInfo->P3c4, 0x1E, 0x20);
7195
7196 tempah = (unsigned char) xgifb_reg_get(
7197 pVBInfo->Part1Port, 0x2E);
7198
7199 if (!(tempah & 0x80))
7200 xgifb_reg_or(pVBInfo->Part1Port,
7201 0x2E, 0x80);
7202 xgifb_reg_and(pVBInfo->Part1Port, 0x00, 0x7F);
7203 }
7204 }
7205
7206 if ((pVBInfo->SetFlag & (EnableChA | EnableChB))
7207 || (!(pVBInfo->VBInfo & DisableCRT2Display))) {
7208 xgifb_reg_and_or(pVBInfo->Part2Port, 0x00, ~0xE0,
7209 0x20); /* shampoo 0129 */
7210 if (pVBInfo->VBType & (VB_XGI302LV | VB_XGI301C)) {
7211 if (!XGI_DisableChISLCD(pVBInfo)) {
7212 if (XGI_EnableChISLCD(pVBInfo) ||
7213 (pVBInfo->VBInfo &
7214 (SetCRT2ToLCD | SetCRT2ToLCDA)))
7215 /* LVDS PLL power on */
7216 xgifb_reg_and(
7217 pVBInfo->Part4Port,
7218 0x2A,
7219 0x7F);
7220 }
7221 /* LVDS Driver power on */
7222 xgifb_reg_and(pVBInfo->Part4Port, 0x30, 0x7F);
7223 }
7224 }
7225
7226 tempah = 0x00;
7227
7228 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
7229 tempah = 0xc0;
7230
7231 if (!(pVBInfo->VBInfo & SetSimuScanMode)) {
7232 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
7233 if (pVBInfo->VBInfo &
7234 SetCRT2ToDualEdge) {
7235 tempah = tempah & 0x40;
7236 if (pVBInfo->VBInfo &
7237 SetCRT2ToLCDA)
7238 tempah = tempah ^ 0xC0;
7239
7240 if (pVBInfo->SetFlag &
7241 DisableChB)
7242 tempah &= 0xBF;
7243
7244 if (pVBInfo->SetFlag &
7245 DisableChA)
7246 tempah &= 0x7F;
7247
7248 if (pVBInfo->SetFlag &
7249 EnableChB)
7250 tempah |= 0x40;
7251
7252 if (pVBInfo->SetFlag &
7253 EnableChA)
7254 tempah |= 0x80;
7255 }
7256 }
7257 }
7258 }
7259
7260 /* EnablePart4_1F */
7261 xgifb_reg_or(pVBInfo->Part4Port, 0x1F, tempah);
7262
7263 if (!(pVBInfo->SetFlag & DisableChA)) {
7264 if (!(pVBInfo->SetFlag & GatingCRT)) {
7265 XGI_DisableGatingCRT(HwDeviceExtension,
7266 pVBInfo);
7267 XGI_DisplayOn(xgifb_info, HwDeviceExtension,
7268 pVBInfo);
7269 }
7270 }
7271 } /* 301 */
7272 else { /* LVDS */
7273 if (pVBInfo->VBInfo & (SetCRT2ToTV | SetCRT2ToLCD
7274 | SetCRT2ToLCDA))
7275 /* enable CRT2 */
7276 xgifb_reg_or(pVBInfo->Part1Port, 0x1E, 0x20);
7277
7278 tempah = (unsigned char) xgifb_reg_get(pVBInfo->Part1Port,
7279 0x2E);
7280 if (!(tempah & 0x80))
7281 xgifb_reg_or(pVBInfo->Part1Port, 0x2E, 0x80);
7282
7283 xgifb_reg_and(pVBInfo->Part1Port, 0x00, 0x7F);
7284 XGI_DisplayOn(xgifb_info, HwDeviceExtension, pVBInfo);
7285 } /* End of VB */
7286 }
7287
7288 static void XGI_SetCRT1Group(struct xgifb_video_info *xgifb_info,
7289 struct xgi_hw_device_info *HwDeviceExtension,
7290 unsigned short ModeNo, unsigned short ModeIdIndex,
7291 struct vb_device_info *pVBInfo)
7292 {
7293 unsigned short StandTableIndex, RefreshRateTableIndex, b3CC, temp;
7294
7295 unsigned short XGINew_P3cc = pVBInfo->P3cc;
7296
7297 StandTableIndex = XGI_GetModePtr(ModeNo, ModeIdIndex, pVBInfo);
7298 XGI_SetSeqRegs(ModeNo, StandTableIndex, ModeIdIndex, pVBInfo);
7299 outb(pVBInfo->StandTable[StandTableIndex].MISC, pVBInfo->P3c2);
7300 XGI_SetCRTCRegs(HwDeviceExtension, StandTableIndex, pVBInfo);
7301 XGI_SetATTRegs(ModeNo, StandTableIndex, ModeIdIndex, pVBInfo);
7302 XGI_SetGRCRegs(StandTableIndex, pVBInfo);
7303 XGI_ClearExt1Regs(pVBInfo);
7304
7305 if (HwDeviceExtension->jChipType == XG27) {
7306 if (pVBInfo->IF_DEF_LVDS == 0)
7307 XGI_SetDefaultVCLK(pVBInfo);
7308 }
7309
7310 temp = ~ProgrammingCRT2;
7311 pVBInfo->SetFlag &= temp;
7312 pVBInfo->SelectCRT2Rate = 0;
7313
7314 if (pVBInfo->VBType & (VB_XGI301B | VB_XGI302B | VB_XGI301LV
7315 | VB_XGI302LV | VB_XGI301C)) {
7316 if (pVBInfo->VBInfo & (SetSimuScanMode | SetCRT2ToLCDA
7317 | SetInSlaveMode)) {
7318 pVBInfo->SetFlag |= ProgrammingCRT2;
7319 }
7320 }
7321
7322 RefreshRateTableIndex = XGI_GetRatePtrCRT2(HwDeviceExtension, ModeNo,
7323 ModeIdIndex, pVBInfo);
7324 if (RefreshRateTableIndex != 0xFFFF) {
7325 XGI_SetSync(RefreshRateTableIndex, pVBInfo);
7326 XGI_SetCRT1CRTC(ModeNo, ModeIdIndex, RefreshRateTableIndex,
7327 pVBInfo, HwDeviceExtension);
7328 XGI_SetCRT1DE(HwDeviceExtension, ModeNo, ModeIdIndex,
7329 RefreshRateTableIndex, pVBInfo);
7330 XGI_SetCRT1Offset(ModeNo, ModeIdIndex, RefreshRateTableIndex,
7331 HwDeviceExtension, pVBInfo);
7332 XGI_SetCRT1VCLK(ModeNo, ModeIdIndex, HwDeviceExtension,
7333 RefreshRateTableIndex, pVBInfo);
7334 }
7335
7336 if ((HwDeviceExtension->jChipType >= XG20) &&
7337 (HwDeviceExtension->jChipType < XG27)) { /* fix H/W DCLK/2 bug */
7338 if ((ModeNo == 0x00) | (ModeNo == 0x01)) {
7339 xgifb_reg_set(pVBInfo->P3c4, 0x2B, 0x4E);
7340 xgifb_reg_set(pVBInfo->P3c4, 0x2C, 0xE9);
7341 b3CC = (unsigned char) inb(XGINew_P3cc);
7342 outb((b3CC |= 0x0C), XGINew_P3cc);
7343 } else if ((ModeNo == 0x04) | (ModeNo == 0x05) | (ModeNo
7344 == 0x0D)) {
7345 xgifb_reg_set(pVBInfo->P3c4, 0x2B, 0x1B);
7346 xgifb_reg_set(pVBInfo->P3c4, 0x2C, 0xE3);
7347 b3CC = (unsigned char) inb(XGINew_P3cc);
7348 outb((b3CC |= 0x0C), XGINew_P3cc);
7349 }
7350 }
7351
7352 if (HwDeviceExtension->jChipType >= XG21) {
7353 temp = xgifb_reg_get(pVBInfo->P3d4, 0x38);
7354 if (temp & 0xA0) {
7355
7356 if (HwDeviceExtension->jChipType == XG27)
7357 XGI_SetXG27CRTC(ModeNo, ModeIdIndex,
7358 RefreshRateTableIndex, pVBInfo);
7359 else
7360 XGI_SetXG21CRTC(ModeNo, ModeIdIndex,
7361 RefreshRateTableIndex, pVBInfo);
7362
7363 XGI_UpdateXG21CRTC(ModeNo, pVBInfo,
7364 RefreshRateTableIndex);
7365
7366 xgifb_set_lcd(HwDeviceExtension->jChipType,
7367 pVBInfo, RefreshRateTableIndex, ModeNo);
7368
7369 if (pVBInfo->IF_DEF_LVDS == 1)
7370 xgifb_set_lvds(xgifb_info,
7371 HwDeviceExtension->jChipType,
7372 ModeNo, ModeIdIndex, pVBInfo);
7373 }
7374 }
7375
7376 pVBInfo->SetFlag &= (~ProgrammingCRT2);
7377 XGI_SetCRT1FIFO(ModeNo, HwDeviceExtension, pVBInfo);
7378 XGI_SetCRT1ModeRegs(HwDeviceExtension, ModeNo, ModeIdIndex,
7379 RefreshRateTableIndex, pVBInfo);
7380 XGI_LoadDAC(ModeNo, ModeIdIndex, pVBInfo);
7381 }
7382
7383 unsigned char XGISetModeNew(struct xgifb_video_info *xgifb_info,
7384 struct xgi_hw_device_info *HwDeviceExtension,
7385 unsigned short ModeNo)
7386 {
7387 unsigned short ModeIdIndex;
7388 struct vb_device_info VBINF;
7389 struct vb_device_info *pVBInfo = &VBINF;
7390 pVBInfo->BaseAddr = (unsigned long) HwDeviceExtension->pjIOAddress;
7391 pVBInfo->IF_DEF_LVDS = 0;
7392 pVBInfo->IF_DEF_LCDA = 1;
7393
7394 if (HwDeviceExtension->jChipType >= XG20) { /* kuku 2004/06/25 */
7395 pVBInfo->IF_DEF_YPbPr = 0;
7396 pVBInfo->IF_DEF_HiVision = 0;
7397 pVBInfo->IF_DEF_CRT2Monitor = 0;
7398 pVBInfo->VBType = 0; /*set VBType default 0*/
7399 } else {
7400 pVBInfo->IF_DEF_YPbPr = 1;
7401 pVBInfo->IF_DEF_HiVision = 1;
7402 pVBInfo->IF_DEF_CRT2Monitor = 1;
7403 }
7404
7405 pVBInfo->P3c4 = pVBInfo->BaseAddr + 0x14;
7406 pVBInfo->P3d4 = pVBInfo->BaseAddr + 0x24;
7407 pVBInfo->P3c0 = pVBInfo->BaseAddr + 0x10;
7408 pVBInfo->P3ce = pVBInfo->BaseAddr + 0x1e;
7409 pVBInfo->P3c2 = pVBInfo->BaseAddr + 0x12;
7410 pVBInfo->P3cc = pVBInfo->BaseAddr + 0x1C;
7411 pVBInfo->P3ca = pVBInfo->BaseAddr + 0x1a;
7412 pVBInfo->P3c6 = pVBInfo->BaseAddr + 0x16;
7413 pVBInfo->P3c7 = pVBInfo->BaseAddr + 0x17;
7414 pVBInfo->P3c8 = pVBInfo->BaseAddr + 0x18;
7415 pVBInfo->P3c9 = pVBInfo->BaseAddr + 0x19;
7416 pVBInfo->P3da = pVBInfo->BaseAddr + 0x2A;
7417 pVBInfo->Part0Port = pVBInfo->BaseAddr + XGI_CRT2_PORT_00;
7418 pVBInfo->Part1Port = pVBInfo->BaseAddr + XGI_CRT2_PORT_04;
7419 pVBInfo->Part2Port = pVBInfo->BaseAddr + XGI_CRT2_PORT_10;
7420 pVBInfo->Part3Port = pVBInfo->BaseAddr + XGI_CRT2_PORT_12;
7421 pVBInfo->Part4Port = pVBInfo->BaseAddr + XGI_CRT2_PORT_14;
7422 pVBInfo->Part5Port = pVBInfo->BaseAddr + XGI_CRT2_PORT_14 + 2;
7423
7424 /* for x86 Linux, XG21 LVDS */
7425 if (HwDeviceExtension->jChipType == XG21) {
7426 if ((xgifb_reg_get(pVBInfo->P3d4, 0x38) & 0xE0) == 0xC0)
7427 pVBInfo->IF_DEF_LVDS = 1;
7428 }
7429 if (HwDeviceExtension->jChipType == XG27) {
7430 if ((xgifb_reg_get(pVBInfo->P3d4, 0x38) & 0xE0) == 0xC0) {
7431 if (xgifb_reg_get(pVBInfo->P3d4, 0x30) & 0x20)
7432 pVBInfo->IF_DEF_LVDS = 1;
7433 }
7434 }
7435
7436 if (HwDeviceExtension->jChipType < XG20) /* kuku 2004/06/25 */
7437 XGI_GetVBType(pVBInfo);
7438
7439 InitTo330Pointer(HwDeviceExtension->jChipType, pVBInfo);
7440 if (ModeNo & 0x80)
7441 ModeNo = ModeNo & 0x7F;
7442 xgifb_reg_set(pVBInfo->P3c4, 0x05, 0x86);
7443
7444 if (HwDeviceExtension->jChipType < XG20) /* kuku 2004/06/25 1.Openkey */
7445 XGI_UnLockCRT2(HwDeviceExtension, pVBInfo);
7446
7447 XGI_SearchModeID(ModeNo, &ModeIdIndex, pVBInfo);
7448
7449 if (HwDeviceExtension->jChipType < XG20) { /* kuku 2004/06/25 */
7450 XGI_GetVBInfo(ModeNo, ModeIdIndex, HwDeviceExtension, pVBInfo);
7451 XGI_GetTVInfo(ModeNo, ModeIdIndex, pVBInfo);
7452 XGI_GetLCDInfo(ModeNo, ModeIdIndex, pVBInfo);
7453 XGI_DisableBridge(xgifb_info, HwDeviceExtension, pVBInfo);
7454
7455 if (pVBInfo->VBInfo & (SetSimuScanMode | SetCRT2ToLCDA)) {
7456 XGI_SetCRT1Group(xgifb_info, HwDeviceExtension, ModeNo,
7457 ModeIdIndex, pVBInfo);
7458
7459 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
7460 XGI_SetLCDAGroup(ModeNo, ModeIdIndex,
7461 HwDeviceExtension, pVBInfo);
7462 }
7463 } else {
7464 if (!(pVBInfo->VBInfo & SwitchToCRT2)) {
7465 XGI_SetCRT1Group(xgifb_info,
7466 HwDeviceExtension, ModeNo,
7467 ModeIdIndex, pVBInfo);
7468 if (pVBInfo->VBInfo & SetCRT2ToLCDA) {
7469 XGI_SetLCDAGroup(ModeNo, ModeIdIndex,
7470 HwDeviceExtension,
7471 pVBInfo);
7472 }
7473 }
7474 }
7475
7476 if (pVBInfo->VBInfo & (SetSimuScanMode | SwitchToCRT2)) {
7477 switch (HwDeviceExtension->ujVBChipID) {
7478 case VB_CHIP_301:
7479 XGI_SetCRT2Group301(ModeNo, HwDeviceExtension,
7480 pVBInfo); /*add for CRT2 */
7481 break;
7482
7483 case VB_CHIP_302:
7484 XGI_SetCRT2Group301(ModeNo, HwDeviceExtension,
7485 pVBInfo); /*add for CRT2 */
7486 break;
7487
7488 default:
7489 break;
7490 }
7491 }
7492
7493 XGI_SetCRT2ModeRegs(ModeNo, HwDeviceExtension, pVBInfo);
7494 XGI_OEM310Setting(ModeNo, ModeIdIndex, pVBInfo); /*0212*/
7495 XGI_CloseCRTC(HwDeviceExtension, pVBInfo);
7496 XGI_EnableBridge(xgifb_info, HwDeviceExtension, pVBInfo);
7497 } /* !XG20 */
7498 else {
7499 if (pVBInfo->IF_DEF_LVDS == 1)
7500 if (!XGI_XG21CheckLVDSMode(xgifb_info, ModeNo,
7501 ModeIdIndex,
7502 pVBInfo))
7503 return 0;
7504
7505 if (ModeNo <= 0x13) {
7506 pVBInfo->ModeType = pVBInfo->SModeIDTable[ModeIdIndex].
7507 St_ModeFlag & ModeInfoFlag;
7508 } else {
7509 pVBInfo->ModeType = pVBInfo->EModeIDTable[ModeIdIndex].
7510 Ext_ModeFlag & ModeInfoFlag;
7511 }
7512
7513 pVBInfo->SetFlag = 0;
7514 pVBInfo->VBInfo = DisableCRT2Display;
7515
7516 XGI_DisplayOff(xgifb_info, HwDeviceExtension, pVBInfo);
7517
7518 XGI_SetCRT1Group(xgifb_info, HwDeviceExtension, ModeNo,
7519 ModeIdIndex, pVBInfo);
7520
7521 XGI_DisplayOn(xgifb_info, HwDeviceExtension, pVBInfo);
7522 }
7523
7524 XGI_UpdateModeInfo(HwDeviceExtension, pVBInfo);
7525
7526 if (HwDeviceExtension->jChipType < XG20) { /* kuku 2004/06/25 */
7527 XGI_LockCRT2(HwDeviceExtension, pVBInfo);
7528 }
7529
7530 return 1;
7531 }