1 #include <linux/delay.h>
8 #include "vb_setmode.h"
10 #define IndexMask 0xff
11 #define TVCLKBASE_315_25 (TVCLKBASE_315 + 25)
13 static const unsigned short XGINew_VGA_DAC[] = {
14 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x09, 0x15,
15 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F,
16 0x00, 0x05, 0x08, 0x0B, 0x0E, 0x11, 0x14, 0x18,
17 0x1C, 0x20, 0x24, 0x28, 0x2D, 0x32, 0x38, 0x3F,
18 0x00, 0x10, 0x1F, 0x2F, 0x3F, 0x1F, 0x27, 0x2F,
19 0x37, 0x3F, 0x2D, 0x31, 0x36, 0x3A, 0x3F, 0x00,
20 0x07, 0x0E, 0x15, 0x1C, 0x0E, 0x11, 0x15, 0x18,
21 0x1C, 0x14, 0x16, 0x18, 0x1A, 0x1C, 0x00, 0x04,
22 0x08, 0x0C, 0x10, 0x08, 0x0A, 0x0C, 0x0E, 0x10,
23 0x0B, 0x0C, 0x0D, 0x0F, 0x10};
25 void InitTo330Pointer(unsigned char ChipType, struct vb_device_info *pVBInfo)
27 pVBInfo->MCLKData = XGI340New_MCLKData;
29 pVBInfo->LCDResInfo = 0;
30 pVBInfo->LCDTypeInfo = 0;
35 pVBInfo->SR18 = XGI340_SR18;
36 pVBInfo->CR40 = XGI340_cr41;
39 XGI_GetVBType(pVBInfo);
41 /* 310 customization related */
42 if ((pVBInfo->VBType & VB_SIS301LV) || (pVBInfo->VBType & VB_SIS302LV))
43 pVBInfo->LCDCapList = XGI_LCDDLCapList;
45 pVBInfo->LCDCapList = XGI_LCDCapList;
48 pVBInfo->XGINew_CR97 = 0x10;
50 if (ChipType == XG27) {
52 pVBInfo->MCLKData = XGI27New_MCLKData;
53 pVBInfo->CR40 = XGI27_cr41;
54 pVBInfo->XGINew_CR97 = 0xc1;
55 pVBInfo->SR18 = XG27_SR18;
58 temp = xgifb_reg_get(pVBInfo->P3c4, 0x3B);
59 /* SR3B[7][3]MAA15 MAA11 (Power on Trapping) */
60 if (((temp & 0x88) == 0x80) || ((temp & 0x88) == 0x08))
61 pVBInfo->XGINew_CR97 = 0x80;
66 static void XGI_SetSeqRegs(unsigned short ModeNo,
67 unsigned short ModeIdIndex,
68 struct vb_device_info *pVBInfo)
70 unsigned char SRdata, i;
72 xgifb_reg_set(pVBInfo->P3c4, 0x00, 0x03); /* Set SR0 */
74 for (i = 0; i < 4; i++) {
75 /* Get SR1,2,3,4 from file */
76 /* SR1 is with screen off 0x20 */
77 SRdata = XGI330_StandTable.SR[i];
78 xgifb_reg_set(pVBInfo->P3c4, i+1, SRdata); /* Set SR 1 2 3 4 */
82 static void XGI_SetCRTCRegs(struct xgi_hw_device_info *HwDeviceExtension,
83 struct vb_device_info *pVBInfo)
85 unsigned char CRTCdata;
88 CRTCdata = xgifb_reg_get(pVBInfo->P3d4, 0x11);
90 xgifb_reg_set(pVBInfo->P3d4, 0x11, CRTCdata); /* Unlock CRTC */
92 for (i = 0; i <= 0x18; i++) {
93 /* Get CRTC from file */
94 CRTCdata = XGI330_StandTable.CRTC[i];
95 xgifb_reg_set(pVBInfo->P3d4, i, CRTCdata); /* Set CRTC(3d4) */
99 static void XGI_SetATTRegs(unsigned short ModeNo,
100 unsigned short ModeIdIndex,
101 struct vb_device_info *pVBInfo)
103 unsigned char ARdata;
104 unsigned short i, modeflag;
106 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
108 for (i = 0; i <= 0x13; i++) {
109 ARdata = XGI330_StandTable.ATTR[i];
111 if ((modeflag & Charx8Dot) && i == 0x13) { /* ifndef Dot9 */
112 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) {
114 } else if ((pVBInfo->VBInfo &
115 (SetCRT2ToTV | SetCRT2ToLCD)) &&
116 (pVBInfo->VBInfo & SetInSlaveMode)) {
121 inb(pVBInfo->P3da); /* reset 3da */
122 outb(i, pVBInfo->P3c0); /* set index */
123 outb(ARdata, pVBInfo->P3c0); /* set data */
126 inb(pVBInfo->P3da); /* reset 3da */
127 outb(0x14, pVBInfo->P3c0); /* set index */
128 outb(0x00, pVBInfo->P3c0); /* set data */
129 inb(pVBInfo->P3da); /* Enable Attribute */
130 outb(0x20, pVBInfo->P3c0);
133 static void XGI_SetGRCRegs(struct vb_device_info *pVBInfo)
135 unsigned char GRdata;
138 for (i = 0; i <= 0x08; i++) {
139 /* Get GR from file */
140 GRdata = XGI330_StandTable.GRC[i];
141 xgifb_reg_set(pVBInfo->P3ce, i, GRdata); /* Set GR(3ce) */
144 if (pVBInfo->ModeType > ModeVGA) {
145 GRdata = xgifb_reg_get(pVBInfo->P3ce, 0x05);
146 GRdata &= 0xBF; /* 256 color disable */
147 xgifb_reg_set(pVBInfo->P3ce, 0x05, GRdata);
151 static void XGI_ClearExt1Regs(struct vb_device_info *pVBInfo)
155 for (i = 0x0A; i <= 0x0E; i++)
156 xgifb_reg_set(pVBInfo->P3c4, i, 0x00); /* Clear SR0A-SR0E */
159 static unsigned char XGI_SetDefaultVCLK(struct vb_device_info *pVBInfo)
162 xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, 0x20);
163 xgifb_reg_set(pVBInfo->P3c4, 0x2B, XGI_VCLKData[0].SR2B);
164 xgifb_reg_set(pVBInfo->P3c4, 0x2C, XGI_VCLKData[0].SR2C);
166 xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, 0x10);
167 xgifb_reg_set(pVBInfo->P3c4, 0x2B, XGI_VCLKData[1].SR2B);
168 xgifb_reg_set(pVBInfo->P3c4, 0x2C, XGI_VCLKData[1].SR2C);
170 xgifb_reg_and(pVBInfo->P3c4, 0x31, ~0x30);
174 static unsigned char XGI_AjustCRT2Rate(unsigned short ModeNo,
175 unsigned short ModeIdIndex,
176 unsigned short RefreshRateTableIndex, unsigned short *i,
177 struct vb_device_info *pVBInfo)
179 unsigned short tempax, tempbx, resinfo, modeflag, infoflag;
181 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
182 resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
183 tempbx = XGI330_RefIndex[RefreshRateTableIndex + (*i)].ModeID;
186 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
187 tempax |= SupportRAMDAC2;
189 if (pVBInfo->VBType & VB_XGI301C)
190 tempax |= SupportCRT2in301C;
194 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) {
195 tempax |= SupportLCD;
197 if (pVBInfo->LCDResInfo != Panel_1280x1024 &&
198 pVBInfo->LCDResInfo != Panel_1280x960 &&
199 (pVBInfo->LCDInfo & LCDNonExpanding) &&
204 if (pVBInfo->VBInfo & SetCRT2ToHiVision) { /* for HiTV */
205 tempax |= SupportHiVision;
206 if ((pVBInfo->VBInfo & SetInSlaveMode) &&
208 (resinfo == 3 && (pVBInfo->SetFlag & TVSimuMode)) ||
211 } else if (pVBInfo->VBInfo & (SetCRT2ToAVIDEO | SetCRT2ToSVIDEO |
212 SetCRT2ToSCART | SetCRT2ToYPbPr525750 |
213 SetCRT2ToHiVision)) {
216 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV |
217 VB_SIS302LV | VB_XGI301C))
218 tempax |= SupportTV1024;
220 if (!(pVBInfo->VBInfo & TVSetPAL) &&
221 (modeflag & NoSupportSimuTV) &&
222 (pVBInfo->VBInfo & SetInSlaveMode) &&
223 (!(pVBInfo->VBInfo & SetNotSimuMode)))
227 for (; XGI330_RefIndex[RefreshRateTableIndex + (*i)].ModeID ==
229 infoflag = XGI330_RefIndex[RefreshRateTableIndex + (*i)].
231 if (infoflag & tempax)
238 for ((*i) = 0;; (*i)++) {
239 infoflag = XGI330_RefIndex[RefreshRateTableIndex + (*i)].
241 if (XGI330_RefIndex[RefreshRateTableIndex + (*i)].ModeID
246 if (infoflag & tempax)
252 static void XGI_SetSync(unsigned short RefreshRateTableIndex,
253 struct vb_device_info *pVBInfo)
255 unsigned short sync, temp;
258 sync = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag >> 8;
262 outb(temp, pVBInfo->P3c2); /* Set Misc(3c2) */
265 static void XGI_SetCRT1Timing_H(struct vb_device_info *pVBInfo,
266 struct xgi_hw_device_info *HwDeviceExtension)
268 unsigned char data, data1, pushax;
272 data = xgifb_reg_get(pVBInfo->P3d4, 0x11);
274 xgifb_reg_set(pVBInfo->P3d4, 0x11, data);
276 data = pVBInfo->TimingH.data[0];
277 xgifb_reg_set(pVBInfo->P3d4, 0, data);
279 for (i = 0x01; i <= 0x04; i++) {
280 data = pVBInfo->TimingH.data[i];
281 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 1), data);
284 for (i = 0x05; i <= 0x06; i++) {
285 data = pVBInfo->TimingH.data[i];
286 xgifb_reg_set(pVBInfo->P3c4, (unsigned short) (i + 6), data);
289 j = xgifb_reg_get(pVBInfo->P3c4, 0x0e);
291 data = pVBInfo->TimingH.data[7];
294 xgifb_reg_set(pVBInfo->P3c4, 0x0e, data);
296 if (HwDeviceExtension->jChipType >= XG20) {
297 data = xgifb_reg_get(pVBInfo->P3d4, 0x04);
299 xgifb_reg_set(pVBInfo->P3d4, 0x04, data);
300 data = xgifb_reg_get(pVBInfo->P3d4, 0x05);
306 data = xgifb_reg_get(pVBInfo->P3c4, 0x0c);
308 xgifb_reg_set(pVBInfo->P3c4, 0x0c, data);
313 xgifb_reg_set(pVBInfo->P3d4, 0x05, data);
314 data = xgifb_reg_get(pVBInfo->P3c4, 0x0e);
320 xgifb_reg_and_or(pVBInfo->P3c4, 0x0e, ~0xE0, data);
324 static void XGI_SetCRT1Timing_V(unsigned short ModeIdIndex,
325 unsigned short ModeNo,
326 struct vb_device_info *pVBInfo)
331 for (i = 0x00; i <= 0x01; i++) {
332 data = pVBInfo->TimingV.data[i];
333 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 6), data);
336 for (i = 0x02; i <= 0x03; i++) {
337 data = pVBInfo->TimingV.data[i];
338 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 0x0e), data);
341 for (i = 0x04; i <= 0x05; i++) {
342 data = pVBInfo->TimingV.data[i];
343 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 0x11), data);
346 j = xgifb_reg_get(pVBInfo->P3c4, 0x0a);
348 data = pVBInfo->TimingV.data[6];
351 xgifb_reg_set(pVBInfo->P3c4, 0x0a, data);
353 data = pVBInfo->TimingV.data[6];
357 i = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
362 j = xgifb_reg_get(pVBInfo->P3d4, 0x09);
365 xgifb_reg_set(pVBInfo->P3d4, 0x09, data);
368 static void XGI_SetCRT1CRTC(unsigned short ModeNo, unsigned short ModeIdIndex,
369 unsigned short RefreshRateTableIndex,
370 struct vb_device_info *pVBInfo,
371 struct xgi_hw_device_info *HwDeviceExtension)
373 unsigned char index, data;
377 index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
378 index = index & IndexMask;
380 data = xgifb_reg_get(pVBInfo->P3d4, 0x11);
382 xgifb_reg_set(pVBInfo->P3d4, 0x11, data); /* Unlock CRTC */
384 for (i = 0; i < 8; i++)
385 pVBInfo->TimingH.data[i]
386 = XGI_CRT1Table[index].CR[i];
388 for (i = 0; i < 7; i++)
389 pVBInfo->TimingV.data[i]
390 = XGI_CRT1Table[index].CR[i + 8];
392 XGI_SetCRT1Timing_H(pVBInfo, HwDeviceExtension);
394 XGI_SetCRT1Timing_V(ModeIdIndex, ModeNo, pVBInfo);
396 if (pVBInfo->ModeType > 0x03)
397 xgifb_reg_set(pVBInfo->P3d4, 0x14, 0x4F);
400 /* --------------------------------------------------------------------- */
401 /* Function : XGI_SetXG21CRTC */
402 /* Input : Stand or enhance CRTC table */
403 /* Output : Fill CRT Hsync/Vsync to SR2E/SR2F/SR30/SR33/SR34/SR3F */
404 /* Description : Set LCD timing */
405 /* --------------------------------------------------------------------- */
406 static void XGI_SetXG21CRTC(unsigned short ModeNo, unsigned short ModeIdIndex,
407 unsigned short RefreshRateTableIndex,
408 struct vb_device_info *pVBInfo)
410 unsigned char index, Tempax, Tempbx, Tempcx, Tempdx;
411 unsigned short Temp1, Temp2, Temp3;
413 index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
414 /* Tempax: CR4 HRS */
415 Tempax = XGI_CRT1Table[index].CR[3];
416 Tempcx = Tempax; /* Tempcx: HRS */
418 xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax);
420 Tempdx = XGI_CRT1Table[index].CR[5]; /* SRB */
421 Tempdx &= 0xC0; /* Tempdx[7:6]: SRB[7:6] */
422 Temp1 = Tempdx; /* Temp1[7:6]: HRS[9:8] */
423 Temp1 <<= 2; /* Temp1[9:8]: HRS[9:8] */
424 Temp1 |= Tempax; /* Temp1[9:0]: HRS[9:0] */
426 Tempax = XGI_CRT1Table[index].CR[4]; /* CR5 HRE */
427 Tempax &= 0x1F; /* Tempax[4:0]: HRE[4:0] */
429 Tempbx = XGI_CRT1Table[index].CR[6]; /* SRC */
430 Tempbx &= 0x04; /* Tempbx[2]: HRE[5] */
431 Tempbx <<= 3; /* Tempbx[5]: HRE[5] */
432 Tempax |= Tempbx; /* Tempax[5:0]: HRE[5:0] */
434 Temp2 = Temp1 & 0x3C0; /* Temp2[9:6]: HRS[9:6] */
435 Temp2 |= Tempax; /* Temp2[9:0]: HRE[9:0] */
437 Tempcx &= 0x3F; /* Tempcx[5:0]: HRS[5:0] */
438 if (Tempax < Tempcx) /* HRE < HRS */
439 Temp2 |= 0x40; /* Temp2 + 0x40 */
442 Tempax = (unsigned char) Temp2; /* Tempax: HRE[7:0] */
443 Tempax <<= 2; /* Tempax[7:2]: HRE[5:0] */
444 Tempdx >>= 6; /* Tempdx[7:6]->[1:0] HRS[9:8] */
445 Tempax |= Tempdx; /* HRE[5:0]HRS[9:8] */
446 /* SR2F D[7:2]->HRE, D[1:0]->HRS */
447 xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempax);
448 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00);
451 Tempax = XGI_CRT1Table[index].CR[10];
452 Tempbx = Tempax; /* Tempbx: VRS */
453 Tempax &= 0x01; /* Tempax[0]: VRS[0] */
454 xgifb_reg_or(pVBInfo->P3c4, 0x33, Tempax); /* SR33[0]->VRS[0] */
456 Tempax = XGI_CRT1Table[index].CR[9];
457 Tempcx = Tempbx >> 1; /* Tempcx[6:0]: VRS[7:1] */
458 Tempdx = Tempax & 0x04; /* Tempdx[2]: CR7[2] */
459 Tempdx <<= 5; /* Tempdx[7]: VRS[8] */
460 Tempcx |= Tempdx; /* Tempcx[7:0]: VRS[8:1] */
461 xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempcx); /* SR34[8:1]->VRS */
463 Temp1 = Tempdx; /* Temp1[7]: Tempdx[7] */
464 Temp1 <<= 1; /* Temp1[8]: VRS[8] */
465 Temp1 |= Tempbx; /* Temp1[8:0]: VRS[8:0] */
467 Temp2 = Tempax << 2; /* Temp2[9]: VRS[9] */
468 Temp1 |= Temp2; /* Temp1[9:0]: VRS[9:0] */
470 Tempax = XGI_CRT1Table[index].CR[14];
471 Tempax &= 0x08; /* Tempax[3]: VRS[3] */
473 Temp2 <<= 7; /* Temp2[10]: VRS[10] */
474 Temp1 |= Temp2; /* Temp1[10:0]: VRS[10:0] */
476 /* Tempax: CR11 VRE */
477 Tempax = XGI_CRT1Table[index].CR[11];
478 Tempax &= 0x0F; /* Tempax[3:0]: VRE[3:0] */
480 Tempbx = XGI_CRT1Table[index].CR[14];
481 Tempbx &= 0x20; /* Tempbx[5]: VRE[5] */
482 Tempbx >>= 1; /* Tempbx[4]: VRE[4] */
483 Tempax |= Tempbx; /* Tempax[4:0]: VRE[4:0] */
484 Temp2 = Temp1 & 0x7E0; /* Temp2[10:5]: VRS[10:5] */
485 Temp2 |= Tempax; /* Temp2[10:5]: VRE[10:5] */
487 Temp3 = Temp1 & 0x1F; /* Temp3[4:0]: VRS[4:0] */
488 if (Tempax < Temp3) /* VRE < VRS */
489 Temp2 |= 0x20; /* VRE + 0x20 */
492 Tempax = (unsigned char) Temp2; /* Tempax: VRE[7:0] */
493 Tempax <<= 2; /* Tempax[7:0]; VRE[5:0]00 */
494 Temp1 &= 0x600; /* Temp1[10:9]: VRS[10:9] */
495 Temp1 >>= 9; /* Temp1[1:0]: VRS[10:9] */
496 Tempbx = (unsigned char) Temp1;
497 Tempax |= Tempbx; /* Tempax[7:0]: VRE[5:0]VRS[10:9] */
499 /* SR3F D[7:2]->VRE D[1:0]->VRS */
500 xgifb_reg_set(pVBInfo->P3c4, 0x3F, Tempax);
503 static void XGI_SetXG27CRTC(unsigned short ModeNo,
504 unsigned short ModeIdIndex,
505 unsigned short RefreshRateTableIndex,
506 struct vb_device_info *pVBInfo)
508 unsigned short index, Tempax, Tempbx, Tempcx;
510 index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
511 /* Tempax: CR4 HRS */
512 Tempax = XGI_CRT1Table[index].CR[3];
513 Tempbx = Tempax; /* Tempbx: HRS[7:0] */
515 xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax);
518 Tempax = XGI_CRT1Table[index].CR[5];
519 Tempax &= 0xC0; /* Tempax[7:6]: SR0B[7:6]: HRS[9:8]*/
520 Tempbx |= (Tempax << 2); /* Tempbx: HRS[9:0] */
522 Tempax = XGI_CRT1Table[index].CR[4]; /* CR5 HRE */
523 Tempax &= 0x1F; /* Tempax[4:0]: HRE[4:0] */
524 Tempcx = Tempax; /* Tempcx: HRE[4:0] */
526 Tempax = XGI_CRT1Table[index].CR[6]; /* SRC */
527 Tempax &= 0x04; /* Tempax[2]: HRE[5] */
528 Tempax <<= 3; /* Tempax[5]: HRE[5] */
529 Tempcx |= Tempax; /* Tempcx[5:0]: HRE[5:0] */
531 Tempbx = Tempbx & 0x3C0; /* Tempbx[9:6]: HRS[9:6] */
532 Tempbx |= Tempcx; /* Tempbx: HRS[9:6]HRE[5:0] */
534 /* Tempax: CR4 HRS */
535 Tempax = XGI_CRT1Table[index].CR[3];
536 Tempax &= 0x3F; /* Tempax: HRS[5:0] */
537 if (Tempcx <= Tempax) /* HRE[5:0] < HRS[5:0] */
538 Tempbx += 0x40; /* Tempbx= Tempbx + 0x40 : HRE[9:0]*/
540 Tempax = XGI_CRT1Table[index].CR[5]; /* SR0B */
541 Tempax &= 0xC0; /* Tempax[7:6]: SR0B[7:6]: HRS[9:8]*/
542 Tempax >>= 6; /* Tempax[1:0]: HRS[9:8]*/
543 Tempax |= ((Tempbx << 2) & 0xFF); /* Tempax[7:2]: HRE[5:0] */
544 /* SR2F [7:2][1:0]: HRE[5:0]HRS[9:8] */
545 xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempax);
546 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00);
549 Tempax = XGI_CRT1Table[index].CR[10];
550 /* SR34[7:0]->VRS[7:0] */
551 xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempax);
553 Tempcx = Tempax; /* Tempcx <= VRS[7:0] */
554 /* CR7[7][2] VRS[9][8] */
555 Tempax = XGI_CRT1Table[index].CR[9];
556 Tempbx = Tempax; /* Tempbx <= CR07[7:0] */
557 Tempax = Tempax & 0x04; /* Tempax[2]: CR7[2]: VRS[8] */
558 Tempax >>= 2; /* Tempax[0]: VRS[8] */
559 /* SR35[0]: VRS[8] */
560 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x01, Tempax);
561 Tempcx |= (Tempax << 8); /* Tempcx <= VRS[8:0] */
562 Tempcx |= ((Tempbx & 0x80) << 2); /* Tempcx <= VRS[9:0] */
564 Tempax = XGI_CRT1Table[index].CR[14];
565 Tempax &= 0x08; /* SR0A[3] VRS[10] */
566 Tempcx |= (Tempax << 7); /* Tempcx <= VRS[10:0] */
568 /* Tempax: CR11 VRE */
569 Tempax = XGI_CRT1Table[index].CR[11];
570 Tempax &= 0x0F; /* Tempax[3:0]: VRE[3:0] */
572 Tempbx = XGI_CRT1Table[index].CR[14];
573 Tempbx &= 0x20; /* Tempbx[5]: SR0A[5]: VRE[4] */
574 Tempbx >>= 1; /* Tempbx[4]: VRE[4] */
575 Tempax |= Tempbx; /* Tempax[4:0]: VRE[4:0] */
576 Tempbx = Tempcx; /* Tempbx: VRS[10:0] */
577 Tempbx &= 0x7E0; /* Tempbx[10:5]: VRS[10:5] */
578 Tempbx |= Tempax; /* Tempbx: VRS[10:5]VRE[4:0] */
580 if (Tempbx <= Tempcx) /* VRE <= VRS */
581 Tempbx |= 0x20; /* VRE + 0x20 */
583 /* Tempax: Tempax[7:0]; VRE[5:0]00 */
584 Tempax = (Tempbx << 2) & 0xFF;
585 /* SR3F[7:2]:VRE[5:0] */
586 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC, Tempax);
587 Tempax = Tempcx >> 8;
588 /* SR35[2:0]:VRS[10:8] */
589 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x07, Tempax);
592 static void XGI_SetXG27FPBits(struct vb_device_info *pVBInfo)
596 /* D[1:0] 01: 18bit, 00: dual 12, 10: single 24 */
597 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
598 temp = (temp & 3) << 6;
599 /* SR06[7]0: dual 12/1: single 24 [6] 18bit Dither <= 0 h/w recommend */
600 xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0xc0, temp & 0x80);
601 /* SR09[7] enable FP output, SR09[6] 1: sigle 18bits, 0: 24bits */
602 xgifb_reg_and_or(pVBInfo->P3c4, 0x09, ~0xc0, temp | 0x80);
606 static void xgifb_set_lcd(int chip_id,
607 struct vb_device_info *pVBInfo,
608 unsigned short RefreshRateTableIndex,
609 unsigned short ModeNo)
613 xgifb_reg_set(pVBInfo->P3d4, 0x2E, 0x00);
614 xgifb_reg_set(pVBInfo->P3d4, 0x2F, 0x00);
615 xgifb_reg_set(pVBInfo->P3d4, 0x46, 0x00);
616 xgifb_reg_set(pVBInfo->P3d4, 0x47, 0x00);
618 if (chip_id == XG27) {
619 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
620 if ((temp & 0x03) == 0) { /* dual 12 */
621 xgifb_reg_set(pVBInfo->P3d4, 0x46, 0x13);
622 xgifb_reg_set(pVBInfo->P3d4, 0x47, 0x13);
626 if (chip_id == XG27) {
627 XGI_SetXG27FPBits(pVBInfo);
629 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
632 xgifb_reg_or(pVBInfo->P3c4, 0x06, 0x40);
633 xgifb_reg_or(pVBInfo->P3c4, 0x09, 0x40);
637 xgifb_reg_or(pVBInfo->P3c4, 0x1E, 0x01); /* Negative blank polarity */
639 xgifb_reg_and(pVBInfo->P3c4, 0x30, ~0x20); /* Hsync polarity */
640 xgifb_reg_and(pVBInfo->P3c4, 0x35, ~0x80); /* Vsync polarity */
642 temp = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
645 xgifb_reg_or(pVBInfo->P3c4, 0x30, 0x20);
648 xgifb_reg_or(pVBInfo->P3c4, 0x35, 0x80);
651 /* --------------------------------------------------------------------- */
652 /* Function : XGI_UpdateXG21CRTC */
654 /* Output : CRT1 CRTC */
655 /* Description : Modify CRT1 Hsync/Vsync to fix LCD mode timing */
656 /* --------------------------------------------------------------------- */
657 static void XGI_UpdateXG21CRTC(unsigned short ModeNo,
658 struct vb_device_info *pVBInfo,
659 unsigned short RefreshRateTableIndex)
663 xgifb_reg_and(pVBInfo->P3d4, 0x11, 0x7F); /* Unlock CR0~7 */
664 if (ModeNo == 0x2E &&
665 (XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC ==
668 else if (ModeNo == 0x2E && (XGI330_RefIndex[RefreshRateTableIndex].
669 Ext_CRT1CRTC == RES640x480x72))
671 else if (ModeNo == 0x2F)
673 else if (ModeNo == 0x50)
675 else if (ModeNo == 0x59)
679 xgifb_reg_set(pVBInfo->P3d4, 0x02,
680 XGI_UpdateCRT1Table[index].CR02);
681 xgifb_reg_set(pVBInfo->P3d4, 0x03,
682 XGI_UpdateCRT1Table[index].CR03);
683 xgifb_reg_set(pVBInfo->P3d4, 0x15,
684 XGI_UpdateCRT1Table[index].CR15);
685 xgifb_reg_set(pVBInfo->P3d4, 0x16,
686 XGI_UpdateCRT1Table[index].CR16);
690 static void XGI_SetCRT1DE(struct xgi_hw_device_info *HwDeviceExtension,
691 unsigned short ModeNo, unsigned short ModeIdIndex,
692 unsigned short RefreshRateTableIndex,
693 struct vb_device_info *pVBInfo)
695 unsigned short resindex, tempax, tempbx, tempcx, temp, modeflag;
699 resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
701 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
702 tempax = XGI330_ModeResInfo[resindex].HTotal;
703 tempbx = XGI330_ModeResInfo[resindex].VTotal;
705 if (modeflag & HalfDCLK)
706 tempax = tempax >> 1;
708 if (modeflag & HalfDCLK)
709 tempax = tempax << 1;
711 temp = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
713 if (temp & InterlaceMode)
714 tempbx = tempbx >> 1;
716 if (modeflag & DoubleScanMode)
717 tempbx = tempbx << 1;
725 temp = xgifb_reg_get(pVBInfo->P3d4, 0x11);
726 data = xgifb_reg_get(pVBInfo->P3d4, 0x11);
728 xgifb_reg_set(pVBInfo->P3d4, 0x11, data); /* Unlock CRTC */
729 xgifb_reg_set(pVBInfo->P3d4, 0x01, (unsigned short) (tempcx & 0xff));
730 xgifb_reg_and_or(pVBInfo->P3d4, 0x0b, ~0x0c,
731 (unsigned short) ((tempcx & 0x0ff00) >> 10));
732 xgifb_reg_set(pVBInfo->P3d4, 0x12, (unsigned short) (tempbx & 0xff));
734 tempbx = tempbx >> 8;
742 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x42, tempax);
743 data = xgifb_reg_get(pVBInfo->P3d4, 0x07);
749 xgifb_reg_and_or(pVBInfo->P3d4, 0x0a, ~0x02, tempax);
750 xgifb_reg_set(pVBInfo->P3d4, 0x11, temp);
753 static void XGI_SetCRT1Offset(unsigned short ModeNo,
754 unsigned short ModeIdIndex,
755 unsigned short RefreshRateTableIndex,
756 struct xgi_hw_device_info *HwDeviceExtension,
757 struct vb_device_info *pVBInfo)
759 unsigned short temp, ah, al, temp2, i, DisplayUnit;
762 temp = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeInfo;
764 temp = XGI330_ScreenOffset[temp];
766 temp2 = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
767 temp2 &= InterlaceMode;
772 temp2 = pVBInfo->ModeType - ModeEGA;
797 if ((ModeNo >= 0x26) && (ModeNo <= 0x28))
798 temp = temp * temp2 + temp2 / 2;
805 temp = temp >> 8; /* ah */
807 i = xgifb_reg_get(pVBInfo->P3c4, 0x0E);
810 xgifb_reg_set(pVBInfo->P3c4, 0x0E, i);
812 temp = (unsigned char) temp2;
813 temp &= 0xFF; /* al */
814 xgifb_reg_set(pVBInfo->P3d4, 0x13, temp);
817 temp2 = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
818 temp2 &= InterlaceMode;
822 DisplayUnit = DisplayUnit << 5;
823 ah = (DisplayUnit & 0xff00) >> 8;
824 al = DisplayUnit & 0x00ff;
830 if (HwDeviceExtension->jChipType >= XG20)
831 if ((ModeNo == 0x4A) | (ModeNo == 0x49))
834 xgifb_reg_set(pVBInfo->P3c4, 0x10, ah);
837 static unsigned short XGI_GetVCLK2Ptr(unsigned short ModeNo,
838 unsigned short ModeIdIndex,
839 unsigned short RefreshRateTableIndex,
840 struct xgi_hw_device_info *HwDeviceExtension,
841 struct vb_device_info *pVBInfo)
843 unsigned short VCLKIndex, modeflag;
846 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
848 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) { /*301b*/
849 if (pVBInfo->LCDResInfo != Panel_1024x768)
851 VCLKIndex = VCLK108_2_315 + 5;
853 VCLKIndex = VCLK65_315 + 2; /* LCDXlat1VCLK */
854 } else if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
855 if (pVBInfo->SetFlag & RPLLDIV2XO)
856 VCLKIndex = TVCLKBASE_315_25 + HiTVVCLKDIV2;
858 VCLKIndex = TVCLKBASE_315_25 + HiTVVCLK;
860 if (pVBInfo->SetFlag & TVSimuMode) {
861 if (modeflag & Charx8Dot) {
862 VCLKIndex = TVCLKBASE_315_25 + HiTVSimuVCLK;
864 VCLKIndex = TVCLKBASE_315_25 + HiTVTextVCLK;
869 if (pVBInfo->VBType & VB_SIS301LV) {
870 if (pVBInfo->SetFlag & RPLLDIV2XO)
871 VCLKIndex = YPbPr525iVCLK_2;
873 VCLKIndex = YPbPr525iVCLK;
875 } else if (pVBInfo->VBInfo & SetCRT2ToTV) {
876 if (pVBInfo->SetFlag & RPLLDIV2XO)
877 VCLKIndex = TVCLKBASE_315_25 + TVVCLKDIV2;
879 VCLKIndex = TVCLKBASE_315_25 + TVVCLK;
880 } else { /* for CRT2 */
882 VCLKIndex = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
883 VCLKIndex &= IndexMask;
889 static void XGI_SetCRT1VCLK(unsigned short ModeNo,
890 unsigned short ModeIdIndex,
891 struct xgi_hw_device_info *HwDeviceExtension,
892 unsigned short RefreshRateTableIndex,
893 struct vb_device_info *pVBInfo)
895 unsigned char index, data;
896 unsigned short vclkindex;
898 if ((pVBInfo->IF_DEF_LVDS == 0) &&
899 (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV |
900 VB_SIS302LV | VB_XGI301C)) &&
901 (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) {
902 vclkindex = XGI_GetVCLK2Ptr(ModeNo, ModeIdIndex,
903 RefreshRateTableIndex, HwDeviceExtension,
905 data = xgifb_reg_get(pVBInfo->P3c4, 0x31) & 0xCF;
906 xgifb_reg_set(pVBInfo->P3c4, 0x31, data);
907 data = XGI_VBVCLKData[vclkindex].Part4_A;
908 xgifb_reg_set(pVBInfo->P3c4, 0x2B, data);
909 data = XGI_VBVCLKData[vclkindex].Part4_B;
910 xgifb_reg_set(pVBInfo->P3c4, 0x2C, data);
911 xgifb_reg_set(pVBInfo->P3c4, 0x2D, 0x01);
913 index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
914 data = xgifb_reg_get(pVBInfo->P3c4, 0x31) & 0xCF;
915 xgifb_reg_set(pVBInfo->P3c4, 0x31, data);
916 xgifb_reg_set(pVBInfo->P3c4, 0x2B, XGI_VCLKData[index].SR2B);
917 xgifb_reg_set(pVBInfo->P3c4, 0x2C, XGI_VCLKData[index].SR2C);
918 xgifb_reg_set(pVBInfo->P3c4, 0x2D, 0x01);
921 if (HwDeviceExtension->jChipType >= XG20) {
922 if (XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag &
924 data = xgifb_reg_get(pVBInfo->P3c4, 0x2B);
925 xgifb_reg_set(pVBInfo->P3c4, 0x2B, data);
926 data = xgifb_reg_get(pVBInfo->P3c4, 0x2C);
933 xgifb_reg_set(pVBInfo->P3c4, 0x2C, data);
938 static void XGI_SetXG21FPBits(struct vb_device_info *pVBInfo)
942 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37); /* D[0] 1: 18bit */
943 temp = (temp & 1) << 6;
944 /* SR06[6] 18bit Dither */
945 xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0x40, temp);
946 /* SR09[7] enable FP output, SR09[6] 1: sigle 18bits, 0: dual 12bits */
947 xgifb_reg_and_or(pVBInfo->P3c4, 0x09, ~0xc0, temp | 0x80);
951 static void XGI_SetCRT1FIFO(unsigned short ModeNo,
952 struct xgi_hw_device_info *HwDeviceExtension,
953 struct vb_device_info *pVBInfo)
957 data = xgifb_reg_get(pVBInfo->P3c4, 0x3D);
959 xgifb_reg_set(pVBInfo->P3c4, 0x3D, data); /* diable auto-threshold */
961 xgifb_reg_set(pVBInfo->P3c4, 0x08, 0x34);
962 data = xgifb_reg_get(pVBInfo->P3c4, 0x09);
964 xgifb_reg_set(pVBInfo->P3c4, 0x09, data | 0x30);
965 data = xgifb_reg_get(pVBInfo->P3c4, 0x3D);
967 xgifb_reg_set(pVBInfo->P3c4, 0x3D, data);
969 if (HwDeviceExtension->jChipType == XG21)
970 XGI_SetXG21FPBits(pVBInfo); /* Fix SR9[7:6] can't read back */
973 static void XGI_SetVCLKState(struct xgi_hw_device_info *HwDeviceExtension,
974 unsigned short ModeNo, unsigned short RefreshRateTableIndex,
975 struct vb_device_info *pVBInfo)
977 unsigned short data, data2 = 0;
982 index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
984 VCLK = XGI_VCLKData[index].CLOCK;
986 data = xgifb_reg_get(pVBInfo->P3c4, 0x32);
989 data |= 0x0c; /* VCLK > 200 */
991 if (HwDeviceExtension->jChipType >= XG20)
992 data &= ~0x04; /* 2 pixel mode */
994 xgifb_reg_set(pVBInfo->P3c4, 0x32, data);
996 if (HwDeviceExtension->jChipType < XG20) {
997 data = xgifb_reg_get(pVBInfo->P3c4, 0x1F);
1001 xgifb_reg_set(pVBInfo->P3c4, 0x1F, data);
1006 xgifb_reg_and_or(pVBInfo->P3c4, 0x07, 0xFC, data2);
1007 if (HwDeviceExtension->jChipType >= XG27)
1008 xgifb_reg_and_or(pVBInfo->P3c4, 0x40, 0xFC, data2 & 0x03);
1012 static void XGI_SetCRT1ModeRegs(struct xgi_hw_device_info *HwDeviceExtension,
1013 unsigned short ModeNo, unsigned short ModeIdIndex,
1014 unsigned short RefreshRateTableIndex,
1015 struct vb_device_info *pVBInfo)
1017 unsigned short data, data2, data3, infoflag = 0, modeflag, resindex,
1020 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1021 infoflag = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
1023 if (xgifb_reg_get(pVBInfo->P3d4, 0x31) & 0x01)
1024 xgifb_reg_and_or(pVBInfo->P3c4, 0x1F, 0x3F, 0x00);
1029 data3 = pVBInfo->ModeType - ModeVGA;
1032 data &= InterlaceMode;
1037 xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0x3F, data2);
1038 resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
1039 xres = XGI330_ModeResInfo[resindex].HTotal; /* xres->ax */
1042 if (infoflag & InterlaceMode) {
1045 else if (xres == 1280)
1049 xgifb_reg_and_or(pVBInfo->P3d4, 0x19, 0xFF, data);
1050 xgifb_reg_and_or(pVBInfo->P3d4, 0x19, 0xFC, 0);
1052 if (modeflag & HalfDCLK)
1053 xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xF7, 0x08);
1057 if (modeflag & LineCompareOff)
1060 xgifb_reg_and_or(pVBInfo->P3c4, 0x0F, ~0x48, data2);
1064 xgifb_reg_and_or(pVBInfo->P3c4, 0x21, 0x1F, data);
1066 XGI_SetVCLKState(HwDeviceExtension, ModeNo, RefreshRateTableIndex,
1069 data = xgifb_reg_get(pVBInfo->P3d4, 0x31);
1071 if (HwDeviceExtension->jChipType == XG27) {
1076 xgifb_reg_set(pVBInfo->P3d4, 0x52, data);
1077 xgifb_reg_or(pVBInfo->P3d4, 0x51, 0x10);
1078 } else if (HwDeviceExtension->jChipType >= XG20) {
1083 xgifb_reg_set(pVBInfo->P3d4, 0x52, data);
1084 xgifb_reg_set(pVBInfo->P3d4, 0x51, 0x02);
1090 xgifb_reg_set(pVBInfo->P3d4, 0x52, data);
1095 static void XGI_WriteDAC(unsigned short dl,
1099 struct vb_device_info *pVBInfo)
1101 unsigned short temp, bh, bl;
1120 outb((unsigned short) dh, pVBInfo->P3c9);
1121 outb((unsigned short) bh, pVBInfo->P3c9);
1122 outb((unsigned short) bl, pVBInfo->P3c9);
1125 static void XGI_LoadDAC(unsigned short ModeNo, unsigned short ModeIdIndex,
1126 struct vb_device_info *pVBInfo)
1128 unsigned short data, data2, i, k, m, n, o, si, di, bx, dl, al, ah, dh;
1129 const unsigned short *table = XGINew_VGA_DAC;
1131 outb(0xFF, pVBInfo->P3c6);
1132 outb(0x00, pVBInfo->P3c8);
1134 for (i = 0; i < 16; i++) {
1137 for (k = 0; k < 3; k++) {
1146 outb(data2, pVBInfo->P3c9);
1151 for (i = 16; i < 32; i++) {
1154 for (k = 0; k < 3; k++)
1155 outb(data, pVBInfo->P3c9);
1160 for (m = 0; m < 9; m++) {
1165 for (n = 0; n < 3; n++) {
1166 for (o = 0; o < 5; o++) {
1171 XGI_WriteDAC(dl, ah, al, dh, pVBInfo);
1176 for (o = 0; o < 3; o++) {
1181 XGI_WriteDAC(dl, ah, al, dh, pVBInfo);
1191 static void XGI_GetLVDSResInfo(unsigned short ModeNo,
1192 unsigned short ModeIdIndex,
1193 struct vb_device_info *pVBInfo)
1195 unsigned short resindex, xres, yres, modeflag;
1197 /* si+Ext_ResInfo */
1198 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
1200 /* si+Ext_ResInfo */
1201 resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
1203 xres = XGI330_ModeResInfo[resindex].HTotal;
1204 yres = XGI330_ModeResInfo[resindex].VTotal;
1206 if (modeflag & HalfDCLK)
1209 if (modeflag & DoubleScanMode)
1215 pVBInfo->VGAHDE = xres;
1216 pVBInfo->HDE = xres;
1217 pVBInfo->VGAVDE = yres;
1218 pVBInfo->VDE = yres;
1221 static void const *XGI_GetLcdPtr(struct XGI330_LCDDataTablStruct const *table,
1222 unsigned short ModeNo,
1223 unsigned short ModeIdIndex,
1224 unsigned short RefreshRateTableIndex,
1225 struct vb_device_info *pVBInfo)
1227 unsigned short i, tempdx, tempbx, modeflag;
1231 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1235 while (table[i].PANELID != 0xff) {
1236 tempdx = pVBInfo->LCDResInfo;
1237 if (tempbx & 0x0080) { /* OEMUtil */
1238 tempbx &= (~0x0080);
1239 tempdx = pVBInfo->LCDTypeInfo;
1242 if (pVBInfo->LCDInfo & EnableScalingLCD)
1243 tempdx &= (~PanelResInfo);
1245 if (table[i].PANELID == tempdx) {
1246 tempbx = table[i].MASK;
1247 tempdx = pVBInfo->LCDInfo;
1249 if (modeflag & HalfDCLK)
1250 tempdx |= SetLCDLowResolution;
1253 if (tempbx == table[i].CAP)
1259 return table[i].DATAPTR;
1262 static struct SiS_TVData const *XGI_GetTVPtr(unsigned short ModeNo,
1263 unsigned short ModeIdIndex,
1264 unsigned short RefreshRateTableIndex,
1265 struct vb_device_info *pVBInfo)
1267 unsigned short i, tempdx, tempal, modeflag;
1269 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1270 tempal = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
1271 tempal = tempal & 0x3f;
1272 tempdx = pVBInfo->TVInfo;
1274 if (pVBInfo->VBInfo & SetInSlaveMode)
1275 tempdx = tempdx | SetTVLockMode;
1277 if (modeflag & HalfDCLK)
1278 tempdx = tempdx | SetTVLowResolution;
1282 while (XGI_TVDataTable[i].MASK != 0xffff) {
1283 if ((tempdx & XGI_TVDataTable[i].MASK) ==
1284 XGI_TVDataTable[i].CAP)
1289 return &XGI_TVDataTable[i].DATAPTR[tempal];
1292 static void XGI_GetLVDSData(unsigned short ModeNo, unsigned short ModeIdIndex,
1293 unsigned short RefreshRateTableIndex,
1294 struct vb_device_info *pVBInfo)
1296 struct SiS_LVDSData const *LCDPtr;
1298 if (!(pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)))
1301 LCDPtr = XGI_GetLcdPtr(XGI_EPLLCDDataPtr, ModeNo, ModeIdIndex,
1302 RefreshRateTableIndex, pVBInfo);
1303 pVBInfo->VGAHT = LCDPtr->VGAHT;
1304 pVBInfo->VGAVT = LCDPtr->VGAVT;
1305 pVBInfo->HT = LCDPtr->LCDHT;
1306 pVBInfo->VT = LCDPtr->LCDVT;
1308 if (pVBInfo->LCDInfo & (SetLCDtoNonExpanding | EnableScalingLCD))
1311 if ((pVBInfo->LCDResInfo == Panel_1024x768) ||
1312 (pVBInfo->LCDResInfo == Panel_1024x768x75)) {
1313 pVBInfo->HDE = 1024;
1315 } else if ((pVBInfo->LCDResInfo == Panel_1280x1024) ||
1316 (pVBInfo->LCDResInfo == Panel_1280x1024x75)) {
1317 pVBInfo->HDE = 1280;
1318 pVBInfo->VDE = 1024;
1319 } else if (pVBInfo->LCDResInfo == Panel_1400x1050) {
1320 pVBInfo->HDE = 1400;
1321 pVBInfo->VDE = 1050;
1323 pVBInfo->HDE = 1600;
1324 pVBInfo->VDE = 1200;
1328 static void XGI_ModCRT1Regs(unsigned short ModeNo, unsigned short ModeIdIndex,
1329 unsigned short RefreshRateTableIndex,
1330 struct xgi_hw_device_info *HwDeviceExtension,
1331 struct vb_device_info *pVBInfo)
1334 struct XGI_LVDSCRT1HDataStruct const *LCDPtr = NULL;
1335 struct XGI_LVDSCRT1VDataStruct const *LCDPtr1 = NULL;
1337 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) {
1338 LCDPtr = XGI_GetLcdPtr(xgifb_epllcd_crt1_h, ModeNo, ModeIdIndex,
1339 RefreshRateTableIndex, pVBInfo);
1341 for (i = 0; i < 8; i++)
1342 pVBInfo->TimingH.data[i] = LCDPtr[0].Reg[i];
1345 XGI_SetCRT1Timing_H(pVBInfo, HwDeviceExtension);
1347 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) {
1348 LCDPtr1 = XGI_GetLcdPtr(xgifb_epllcd_crt1_v, ModeNo,
1349 ModeIdIndex, RefreshRateTableIndex,
1351 for (i = 0; i < 7; i++)
1352 pVBInfo->TimingV.data[i] = LCDPtr1[0].Reg[i];
1355 XGI_SetCRT1Timing_V(ModeIdIndex, ModeNo, pVBInfo);
1358 static unsigned short XGI_GetLCDCapPtr(struct vb_device_info *pVBInfo)
1360 unsigned char tempal, tempah, tempbl, i;
1362 tempah = xgifb_reg_get(pVBInfo->P3d4, 0x36);
1363 tempal = tempah & 0x0F;
1364 tempah = tempah & 0xF0;
1366 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
1368 while (tempbl != 0xFF) {
1369 if (tempbl & 0x80) { /* OEMUtil */
1371 tempbl = tempbl & ~(0x80);
1374 if (tempal == tempbl)
1379 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
1385 static unsigned short XGI_GetLCDCapPtr1(struct vb_device_info *pVBInfo)
1387 unsigned short tempah, tempal, tempbl, i;
1389 tempal = pVBInfo->LCDResInfo;
1390 tempah = pVBInfo->LCDTypeInfo;
1393 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
1395 while (tempbl != 0xFF) {
1396 if ((tempbl & 0x80) && (tempbl != 0x80)) {
1401 if (tempal == tempbl)
1405 tempbl = pVBInfo->LCDCapList[i].LCD_ID;
1408 if (tempbl == 0xFF) {
1409 pVBInfo->LCDResInfo = Panel_1024x768;
1410 pVBInfo->LCDTypeInfo = 0;
1417 static void XGI_GetLCDSync(unsigned short *HSyncWidth,
1418 unsigned short *VSyncWidth,
1419 struct vb_device_info *pVBInfo)
1421 unsigned short Index;
1423 Index = XGI_GetLCDCapPtr(pVBInfo);
1424 *HSyncWidth = pVBInfo->LCDCapList[Index].LCD_HSyncWidth;
1425 *VSyncWidth = pVBInfo->LCDCapList[Index].LCD_VSyncWidth;
1430 static void XGI_SetLVDSRegs(unsigned short ModeNo, unsigned short ModeIdIndex,
1431 unsigned short RefreshRateTableIndex,
1432 struct vb_device_info *pVBInfo)
1434 unsigned short tempbx, tempax, tempcx, tempdx, push1, push2, modeflag;
1435 unsigned long temp, temp1, temp2, temp3, push3;
1436 struct XGI330_LCDDataDesStruct2 const *LCDPtr1 = NULL;
1438 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1439 LCDPtr1 = XGI_GetLcdPtr(XGI_EPLLCDDesDataPtr, ModeNo, ModeIdIndex,
1440 RefreshRateTableIndex, pVBInfo);
1442 XGI_GetLCDSync(&tempax, &tempbx, pVBInfo);
1447 if ((pVBInfo->LCDResInfo == Panel_1024x768) ||
1448 (pVBInfo->LCDResInfo == Panel_1024x768x75)) {
1451 } else if ((pVBInfo->LCDResInfo == Panel_1280x1024) ||
1452 (pVBInfo->LCDResInfo == Panel_1280x1024x75)) {
1455 } else if (pVBInfo->LCDResInfo == Panel_1400x1050) {
1463 if (pVBInfo->LCDInfo & SetLCDtoNonExpanding) {
1464 pVBInfo->HDE = tempax;
1465 pVBInfo->VDE = tempbx;
1466 pVBInfo->VGAHDE = tempax;
1467 pVBInfo->VGAVDE = tempbx;
1470 tempax = pVBInfo->HT;
1472 tempbx = LCDPtr1->LCDHDES;
1474 tempcx = pVBInfo->HDE;
1475 tempbx = tempbx & 0x0fff;
1478 if (tempcx >= tempax)
1481 xgifb_reg_set(pVBInfo->Part1Port, 0x1A, tempbx & 0x07);
1483 tempcx = tempcx >> 3;
1484 tempbx = tempbx >> 3;
1486 xgifb_reg_set(pVBInfo->Part1Port, 0x16,
1487 (unsigned short) (tempbx & 0xff));
1488 xgifb_reg_set(pVBInfo->Part1Port, 0x17,
1489 (unsigned short) (tempcx & 0xff));
1491 tempax = pVBInfo->HT;
1493 tempbx = LCDPtr1->LCDHRS;
1497 if (pVBInfo->LCDInfo & EnableScalingLCD)
1498 tempcx = LCDPtr1->LCDHSync;
1502 if (tempcx >= tempax)
1505 tempax = tempbx & 0x07;
1506 tempax = tempax >> 5;
1507 tempcx = tempcx >> 3;
1508 tempbx = tempbx >> 3;
1513 xgifb_reg_set(pVBInfo->Part1Port, 0x15, tempax);
1514 xgifb_reg_set(pVBInfo->Part1Port, 0x14,
1515 (unsigned short) (tempbx & 0xff));
1517 tempax = pVBInfo->VT;
1518 tempbx = LCDPtr1->LCDVDES;
1519 tempcx = pVBInfo->VDE;
1521 tempbx = tempbx & 0x0fff;
1523 if (tempcx >= tempax)
1526 xgifb_reg_set(pVBInfo->Part1Port, 0x1b,
1527 (unsigned short) (tempbx & 0xff));
1528 xgifb_reg_set(pVBInfo->Part1Port, 0x1c,
1529 (unsigned short) (tempcx & 0xff));
1531 tempbx = (tempbx >> 8) & 0x07;
1532 tempcx = (tempcx >> 8) & 0x07;
1534 xgifb_reg_set(pVBInfo->Part1Port, 0x1d,
1535 (unsigned short) ((tempcx << 3)
1538 tempax = pVBInfo->VT;
1539 tempbx = LCDPtr1->LCDVRS;
1543 if (pVBInfo->LCDInfo & EnableScalingLCD)
1544 tempcx = LCDPtr1->LCDVSync;
1547 if (tempcx >= tempax)
1550 xgifb_reg_set(pVBInfo->Part1Port, 0x18,
1551 (unsigned short) (tempbx & 0xff));
1552 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, ~0x0f,
1553 (unsigned short) (tempcx & 0x0f));
1555 tempax = ((tempbx >> 8) & 0x07) << 3;
1557 tempbx = pVBInfo->VGAVDE;
1558 if (tempbx != pVBInfo->VDE)
1561 if (pVBInfo->LCDInfo & XGI_EnableLVDSDDA)
1564 xgifb_reg_and_or(pVBInfo->Part1Port, 0x1a, 0x07,
1567 tempbx = pVBInfo->VDE;
1568 tempax = pVBInfo->VGAVDE;
1570 temp = tempax; /* 0430 ylshieh */
1571 temp1 = (temp << 18) / tempbx;
1573 tempdx = (unsigned short) ((temp << 18) % tempbx);
1581 xgifb_reg_set(pVBInfo->Part1Port, 0x37,
1582 (unsigned short) (temp2 & 0xff));
1583 xgifb_reg_set(pVBInfo->Part1Port, 0x36,
1584 (unsigned short) ((temp2 >> 8) & 0xff));
1586 tempbx = (unsigned short) (temp2 >> 16);
1587 tempax = tempbx & 0x03;
1589 tempbx = pVBInfo->VGAVDE;
1590 if (tempbx == pVBInfo->VDE)
1593 xgifb_reg_set(pVBInfo->Part1Port, 0x35, tempax);
1595 if (pVBInfo->VBType & VB_XGI301C) {
1597 xgifb_reg_set(pVBInfo->Part4Port,
1599 (unsigned short) (temp2 & 0xff));
1600 xgifb_reg_set(pVBInfo->Part4Port,
1602 (unsigned short) ((temp2 >> 8) &
1604 tempbx = (unsigned short) (temp2 >> 16);
1605 xgifb_reg_and_or(pVBInfo->Part4Port, 0x3a,
1607 (unsigned short) ((tempbx &
1610 tempcx = pVBInfo->VGAVDE;
1611 if (tempcx == pVBInfo->VDE)
1612 xgifb_reg_and_or(pVBInfo->Part4Port,
1615 xgifb_reg_and_or(pVBInfo->Part4Port,
1619 tempcx = pVBInfo->VGAHDE;
1620 tempbx = pVBInfo->HDE;
1622 temp1 = tempcx << 16;
1624 tempax = (unsigned short) (temp1 / tempbx);
1626 if ((tempbx & 0xffff) == (tempcx & 0xffff))
1630 temp1 = pVBInfo->VGAHDE << 16;
1633 temp3 = temp3 << 16;
1636 temp3 = (temp3 & 0xffff0000) + (temp1 & 0xffff);
1638 tempax = (unsigned short) (temp3 & 0xff);
1639 xgifb_reg_set(pVBInfo->Part1Port, 0x1f, tempax);
1641 temp1 = pVBInfo->VGAVDE << 18;
1642 temp1 = temp1 / push3;
1643 tempbx = (unsigned short) (temp1 & 0xffff);
1645 if (pVBInfo->LCDResInfo == Panel_1024x768)
1648 tempax = ((tempbx >> 8) & 0xff) << 3;
1649 tempax |= (unsigned short) ((temp3 >> 8) & 0x07);
1650 xgifb_reg_set(pVBInfo->Part1Port, 0x20,
1651 (unsigned short) (tempax & 0xff));
1652 xgifb_reg_set(pVBInfo->Part1Port, 0x21,
1653 (unsigned short) (tempbx & 0xff));
1655 temp3 = temp3 >> 16;
1657 if (modeflag & HalfDCLK)
1660 xgifb_reg_set(pVBInfo->Part1Port, 0x22,
1661 (unsigned short) ((temp3 >> 8) & 0xff));
1662 xgifb_reg_set(pVBInfo->Part1Port, 0x23,
1663 (unsigned short) (temp3 & 0xff));
1666 /* --------------------------------------------------------------------- */
1667 /* Function : XGI_GETLCDVCLKPtr */
1669 /* Output : al -> VCLK Index */
1671 /* --------------------------------------------------------------------- */
1672 static void XGI_GetLCDVCLKPtr(unsigned char *di_0, unsigned char *di_1,
1673 struct vb_device_info *pVBInfo)
1675 unsigned short index;
1677 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) {
1678 index = XGI_GetLCDCapPtr1(pVBInfo);
1680 if (pVBInfo->VBInfo & SetCRT2ToLCD) { /* LCDB */
1681 *di_0 = pVBInfo->LCDCapList[index].LCUCHAR_VCLKData1;
1682 *di_1 = pVBInfo->LCDCapList[index].LCUCHAR_VCLKData2;
1684 *di_0 = pVBInfo->LCDCapList[index].LCDA_VCLKData1;
1685 *di_1 = pVBInfo->LCDCapList[index].LCDA_VCLKData2;
1691 static unsigned char XGI_GetVCLKPtr(unsigned short RefreshRateTableIndex,
1692 unsigned short ModeNo, unsigned short ModeIdIndex,
1693 struct vb_device_info *pVBInfo)
1696 unsigned short index, modeflag;
1697 unsigned char tempal;
1699 /* si+Ext_ResInfo */
1700 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1702 if ((pVBInfo->SetFlag & ProgrammingCRT2) &&
1703 (!(pVBInfo->LCDInfo & EnableScalingLCD))) { /* {LCDA/LCDB} */
1704 index = XGI_GetLCDCapPtr(pVBInfo);
1705 tempal = pVBInfo->LCDCapList[index].LCD_VCLK;
1707 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA))
1711 if (pVBInfo->VBType &
1717 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
1718 tempal = TVCLKBASE_315 + HiTVVCLKDIV2;
1719 if (!(pVBInfo->TVInfo & RPLLDIV2XO))
1720 tempal = TVCLKBASE_315 + HiTVVCLK;
1721 if (pVBInfo->TVInfo & TVSimuMode) {
1722 tempal = TVCLKBASE_315 + HiTVSimuVCLK;
1723 if (!(modeflag & Charx8Dot))
1724 tempal = TVCLKBASE_315 +
1731 if (pVBInfo->TVInfo & TVSetYPbPr750p) {
1732 tempal = XGI_YPbPr750pVCLK;
1736 if (pVBInfo->TVInfo & TVSetYPbPr525p) {
1737 tempal = YPbPr525pVCLK;
1741 tempal = NTSC1024VCLK;
1743 if (!(pVBInfo->TVInfo & NTSC1024x768)) {
1744 tempal = TVCLKBASE_315 + TVVCLKDIV2;
1745 if (!(pVBInfo->TVInfo & RPLLDIV2XO))
1746 tempal = TVCLKBASE_315 + TVVCLK;
1749 if (pVBInfo->VBInfo & SetCRT2ToTV)
1754 inb((pVBInfo->P3ca + 0x02));
1755 tempal = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
1759 static void XGI_GetVCLKLen(unsigned char tempal, unsigned char *di_0,
1760 unsigned char *di_1, struct vb_device_info *pVBInfo)
1762 if (pVBInfo->VBType & (VB_SIS301 | VB_SIS301B | VB_SIS302B
1763 | VB_SIS301LV | VB_SIS302LV | VB_XGI301C)) {
1764 if ((!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) &&
1765 (pVBInfo->SetFlag & ProgrammingCRT2)) {
1766 *di_0 = XGI_VBVCLKData[tempal].Part4_A;
1767 *di_1 = XGI_VBVCLKData[tempal].Part4_B;
1770 *di_0 = XGI_VCLKData[tempal].SR2B;
1771 *di_1 = XGI_VCLKData[tempal].SR2C;
1775 static void XGI_SetCRT2ECLK(unsigned short ModeNo, unsigned short ModeIdIndex,
1776 unsigned short RefreshRateTableIndex,
1777 struct vb_device_info *pVBInfo)
1779 unsigned char di_0, di_1, tempal;
1782 tempal = XGI_GetVCLKPtr(RefreshRateTableIndex, ModeNo, ModeIdIndex,
1784 XGI_GetVCLKLen(tempal, &di_0, &di_1, pVBInfo);
1785 XGI_GetLCDVCLKPtr(&di_0, &di_1, pVBInfo);
1787 for (i = 0; i < 4; i++) {
1788 xgifb_reg_and_or(pVBInfo->P3d4, 0x31, ~0x30,
1789 (unsigned short) (0x10 * i));
1790 if ((!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA))
1791 && (!(pVBInfo->VBInfo & SetInSlaveMode))) {
1792 xgifb_reg_set(pVBInfo->P3c4, 0x2e, di_0);
1793 xgifb_reg_set(pVBInfo->P3c4, 0x2f, di_1);
1795 xgifb_reg_set(pVBInfo->P3c4, 0x2b, di_0);
1796 xgifb_reg_set(pVBInfo->P3c4, 0x2c, di_1);
1801 static void XGI_UpdateModeInfo(struct xgi_hw_device_info *HwDeviceExtension,
1802 struct vb_device_info *pVBInfo)
1804 unsigned short tempcl, tempch, temp, tempbl, tempax;
1806 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
1807 | VB_SIS302LV | VB_XGI301C)) {
1810 temp = xgifb_reg_get(pVBInfo->P3c4, 0x01);
1812 if (!(temp & 0x20)) {
1813 temp = xgifb_reg_get(pVBInfo->P3d4, 0x17);
1815 temp = xgifb_reg_get(pVBInfo->P3d4, 0x53);
1817 tempcl |= ActiveCRT1;
1821 temp = xgifb_reg_get(pVBInfo->Part1Port, 0x2e);
1824 if (!(temp == 0x08)) {
1825 /* Check ChannelA */
1826 tempax = xgifb_reg_get(pVBInfo->Part1Port, 0x13);
1828 tempcl = tempcl | ActiveLCD;
1832 if (!(tempcl & ActiveLCD))
1834 tempcl |= ActiveCRT2;
1837 tempcl |= ActiveLCD;
1840 temp = xgifb_reg_get(pVBInfo->Part2Port, 0x00);
1843 tempch |= ActiveAVideo;
1846 tempch |= ActiveSVideo;
1849 tempch |= ActiveSCART;
1851 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
1853 tempch |= ActiveHiTV;
1856 if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) {
1857 temp = xgifb_reg_get(
1862 tempch |= ActiveYPbPr;
1870 temp = xgifb_reg_get(pVBInfo->P3d4, 0x3d);
1871 if (tempcl & ActiveLCD) {
1872 if ((pVBInfo->SetFlag & ReserveTVOption)) {
1873 if (temp & ActiveTV)
1878 tempbl = ~XGI_ModeSwitchStatus;
1879 xgifb_reg_and_or(pVBInfo->P3d4, 0x3d, tempbl, temp);
1881 if (!(pVBInfo->SetFlag & ReserveTVOption))
1882 xgifb_reg_set(pVBInfo->P3d4, 0x3e, tempch);
1888 void XGI_GetVBType(struct vb_device_info *pVBInfo)
1890 unsigned short flag, tempbx, tempah;
1892 tempbx = VB_SIS302B;
1893 flag = xgifb_reg_get(pVBInfo->Part4Port, 0x00);
1898 flag = xgifb_reg_get(pVBInfo->Part4Port, 0x01);
1902 tempbx = VB_SIS301B;
1904 goto bigger_than_0xB0;
1906 tempbx = VB_XGI301C;
1908 goto bigger_than_0xB0;
1910 tempbx = VB_SIS301LV;
1912 goto bigger_than_0xB0;
1914 tempbx = VB_SIS302LV;
1915 tempah = xgifb_reg_get(pVBInfo->Part4Port, 0x39);
1917 tempbx = VB_XGI301C;
1920 if (tempbx & (VB_SIS301B | VB_SIS302B)) {
1921 flag = xgifb_reg_get(pVBInfo->Part4Port, 0x23);
1923 tempbx = tempbx | VB_NoLCD;
1927 pVBInfo->VBType = tempbx;
1930 static void XGI_GetVBInfo(unsigned short ModeNo, unsigned short ModeIdIndex,
1931 struct xgi_hw_device_info *HwDeviceExtension,
1932 struct vb_device_info *pVBInfo)
1934 unsigned short tempax, push, tempbx, temp, modeflag;
1936 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1937 pVBInfo->SetFlag = 0;
1938 pVBInfo->ModeType = modeflag & ModeTypeMask;
1941 if (!(pVBInfo->VBType & 0xFFFF))
1944 /* Check Display Device */
1945 temp = xgifb_reg_get(pVBInfo->P3d4, 0x30);
1946 tempbx = tempbx | temp;
1947 temp = xgifb_reg_get(pVBInfo->P3d4, 0x31);
1951 tempbx = tempbx | tempax;
1952 temp = (SetCRT2ToDualEdge | SetCRT2ToYPbPr525750 | XGI_SetCRT2ToLCDA
1953 | SetInSlaveMode | DisableCRT2Display);
1954 temp = 0xFFFF ^ temp;
1957 temp = xgifb_reg_get(pVBInfo->P3d4, 0x38);
1959 if (pVBInfo->VBType & (VB_SIS302B | VB_SIS301LV | VB_SIS302LV |
1961 if (temp & EnableDualEdge) {
1962 tempbx |= SetCRT2ToDualEdge;
1963 if (temp & SetToLCDA)
1964 tempbx |= XGI_SetCRT2ToLCDA;
1968 if (pVBInfo->IF_DEF_YPbPr == 1) {
1969 if (pVBInfo->VBType & (VB_SIS301LV|VB_SIS302LV|VB_XGI301C)) {
1970 if (temp & SetYPbPr) {
1971 if (pVBInfo->IF_DEF_HiVision == 1) {
1972 /* shampoo add for new scratch */
1973 temp = xgifb_reg_get(pVBInfo->P3d4,
1976 tempbx |= SetCRT2ToHiVision;
1978 if (temp != YPbPrMode1080i) {
1979 tempbx &= (~SetCRT2ToHiVision);
1980 tempbx |= SetCRT2ToYPbPr525750;
1987 tempax = push; /* restore CR31 */
1989 if (pVBInfo->IF_DEF_YPbPr == 1) {
1990 if (pVBInfo->IF_DEF_HiVision == 1)
1994 } else if (pVBInfo->IF_DEF_HiVision == 1) {
2000 if (!(tempbx & temp)) {
2001 tempax |= DisableCRT2Display;
2005 if (!(pVBInfo->VBType & VB_NoLCD)) {
2006 if (tempbx & XGI_SetCRT2ToLCDA) {
2007 if (tempbx & SetSimuScanMode)
2008 tempbx &= (~(SetCRT2ToLCD | SetCRT2ToRAMDAC |
2011 tempbx &= (~(SetCRT2ToLCD | SetCRT2ToRAMDAC |
2012 SetCRT2ToTV | SwitchCRT2));
2017 /* for driver abnormal */
2018 if (!(tempbx & (SwitchCRT2 | SetSimuScanMode))) {
2019 if (pVBInfo->IF_DEF_CRT2Monitor == 1) {
2020 if (tempbx & SetCRT2ToRAMDAC) {
2021 tempbx &= (0xFF00 | SetCRT2ToRAMDAC |
2022 SwitchCRT2 | SetSimuScanMode);
2023 tempbx &= (0x00FF | (~SetCRT2ToYPbPr525750));
2026 tempbx &= (~(SetCRT2ToRAMDAC | SetCRT2ToLCD |
2031 if (!(pVBInfo->VBType & VB_NoLCD)) {
2032 if (tempbx & SetCRT2ToLCD) {
2033 tempbx &= (0xFF00 | SetCRT2ToLCD | SwitchCRT2 |
2035 tempbx &= (0x00FF | (~SetCRT2ToYPbPr525750));
2039 if (tempbx & SetCRT2ToSCART) {
2040 tempbx &= (0xFF00 | SetCRT2ToSCART | SwitchCRT2 |
2042 tempbx &= (0x00FF | (~SetCRT2ToYPbPr525750));
2045 if (pVBInfo->IF_DEF_YPbPr == 1) {
2046 if (tempbx & SetCRT2ToYPbPr525750)
2047 tempbx &= (0xFF00 | SwitchCRT2 | SetSimuScanMode);
2050 if (pVBInfo->IF_DEF_HiVision == 1) {
2051 if (tempbx & SetCRT2ToHiVision)
2052 tempbx &= (0xFF00 | SetCRT2ToHiVision | SwitchCRT2 |
2056 if (tempax & DisableCRT2Display) { /* Set Display Device Info */
2057 if (!(tempbx & (SwitchCRT2 | SetSimuScanMode)))
2058 tempbx = DisableCRT2Display;
2061 if (!(tempbx & DisableCRT2Display)) {
2062 if ((!(tempbx & DriverMode)) || (!(modeflag & CRT2Mode))) {
2063 if (!(tempbx & XGI_SetCRT2ToLCDA))
2064 tempbx |= (SetInSlaveMode | SetSimuScanMode);
2067 /* LCD+TV can't support in slave mode
2068 * (Force LCDA+TV->LCDB) */
2069 if ((tempbx & SetInSlaveMode) && (tempbx & XGI_SetCRT2ToLCDA)) {
2070 tempbx ^= (SetCRT2ToLCD | XGI_SetCRT2ToLCDA |
2072 pVBInfo->SetFlag |= ReserveTVOption;
2076 pVBInfo->VBInfo = tempbx;
2079 static void XGI_GetTVInfo(unsigned short ModeNo, unsigned short ModeIdIndex,
2080 struct vb_device_info *pVBInfo)
2082 unsigned short tempbx = 0, resinfo = 0, modeflag, index1;
2084 if (pVBInfo->VBInfo & SetCRT2ToTV) {
2085 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2086 resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
2088 tempbx = xgifb_reg_get(pVBInfo->P3d4, 0x35);
2089 if (tempbx & TVSetPAL) {
2090 tempbx &= (SetCHTVOverScan |
2094 if (tempbx & TVSetPALM)
2095 /* set to NTSC if PAL-M */
2096 tempbx &= ~TVSetPAL;
2098 tempbx &= (SetCHTVOverScan |
2102 if (pVBInfo->VBInfo & SetCRT2ToSCART)
2105 if (pVBInfo->IF_DEF_YPbPr == 1) {
2106 if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) {
2107 index1 = xgifb_reg_get(pVBInfo->P3d4, 0x35);
2108 index1 &= YPbPrMode;
2110 if (index1 == YPbPrMode525i)
2111 tempbx |= TVSetYPbPr525i;
2113 if (index1 == YPbPrMode525p)
2114 tempbx = tempbx | TVSetYPbPr525p;
2115 if (index1 == YPbPrMode750p)
2116 tempbx = tempbx | TVSetYPbPr750p;
2120 if (pVBInfo->IF_DEF_HiVision == 1) {
2121 if (pVBInfo->VBInfo & SetCRT2ToHiVision)
2122 tempbx = tempbx | TVSetHiVision | TVSetPAL;
2125 if ((pVBInfo->VBInfo & SetInSlaveMode) &&
2126 (!(pVBInfo->VBInfo & SetNotSimuMode)))
2127 tempbx |= TVSimuMode;
2129 if (!(tempbx & TVSetPAL) && (modeflag > 13) && (resinfo == 8))
2130 /* NTSC 1024x768, */
2131 tempbx |= NTSC1024x768;
2133 tempbx |= RPLLDIV2XO;
2135 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
2136 if (pVBInfo->VBInfo & SetInSlaveMode)
2137 tempbx &= (~RPLLDIV2XO);
2138 } else if (tempbx & (TVSetYPbPr525p | TVSetYPbPr750p)) {
2139 tempbx &= (~RPLLDIV2XO);
2140 } else if (!(pVBInfo->VBType & (VB_SIS301B | VB_SIS302B |
2141 VB_SIS301LV | VB_SIS302LV |
2143 if (tempbx & TVSimuMode)
2144 tempbx &= (~RPLLDIV2XO);
2147 pVBInfo->TVInfo = tempbx;
2150 static unsigned char XGI_GetLCDInfo(unsigned short ModeNo,
2151 unsigned short ModeIdIndex, struct vb_device_info *pVBInfo)
2153 unsigned short temp, tempax, tempbx, resinfo = 0, LCDIdIndex;
2155 pVBInfo->LCDResInfo = 0;
2156 pVBInfo->LCDTypeInfo = 0;
2157 pVBInfo->LCDInfo = 0;
2159 /* si+Ext_ResInfo // */
2160 resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
2161 temp = xgifb_reg_get(pVBInfo->P3d4, 0x36); /* Get LCD Res.Info */
2162 tempbx = temp & 0x0F;
2165 tempbx = Panel_1024x768; /* default */
2168 if ((tempbx == Panel_1024x768) || (tempbx == Panel_1280x1024)) {
2169 if (pVBInfo->VBInfo & DriverMode) {
2170 tempax = xgifb_reg_get(pVBInfo->P3d4, 0x33);
2171 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)
2174 tempax = tempax >> 4;
2176 if ((resinfo == 6) || (resinfo == 9)) {
2178 tempbx |= PanelRef75Hz;
2179 } else if ((resinfo == 7) || (resinfo == 8)) {
2181 tempbx |= PanelRef75Hz;
2186 pVBInfo->LCDResInfo = tempbx;
2190 if (!(pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)))
2195 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
2197 temp &= (ScalingLCD | LCDNonExpanding | LCDSyncBit | SetPWDEnable);
2201 LCDIdIndex = XGI_GetLCDCapPtr1(pVBInfo);
2203 tempax = pVBInfo->LCDCapList[LCDIdIndex].LCD_Capability;
2205 if (((pVBInfo->VBType & VB_SIS302LV) ||
2206 (pVBInfo->VBType & VB_XGI301C)) && (tempax & XGI_LCDDualLink))
2207 tempbx |= SetLCDDualLink;
2209 if ((pVBInfo->LCDResInfo == Panel_1400x1050) &&
2210 (pVBInfo->VBInfo & SetCRT2ToLCD) && (resinfo == 9) &&
2211 (!(tempbx & EnableScalingLCD)))
2213 * set to center in 1280x1024 LCDB
2214 * for Panel_1400x1050
2216 tempbx |= SetLCDtoNonExpanding;
2218 if (pVBInfo->VBInfo & SetInSlaveMode) {
2219 if (pVBInfo->VBInfo & SetNotSimuMode)
2220 tempbx |= XGI_LCDVESATiming;
2222 tempbx |= XGI_LCDVESATiming;
2225 pVBInfo->LCDInfo = tempbx;
2230 unsigned char XGI_SearchModeID(unsigned short ModeNo,
2231 unsigned short *ModeIdIndex, struct vb_device_info *pVBInfo)
2233 for (*ModeIdIndex = 0;; (*ModeIdIndex)++) {
2234 if (XGI330_EModeIDTable[*ModeIdIndex].Ext_ModeID == ModeNo)
2236 if (XGI330_EModeIDTable[*ModeIdIndex].Ext_ModeID == 0xFF)
2243 static unsigned char XG21GPIODataTransfer(unsigned char ujDate)
2245 unsigned char ujRet = 0;
2246 unsigned char i = 0;
2248 for (i = 0; i < 8; i++) {
2250 ujRet |= (ujDate >> i) & 1;
2256 /*----------------------------------------------------------------------------*/
2258 /* bl[5] : LVDS signal */
2259 /* bl[1] : LVDS backlight */
2260 /* bl[0] : LVDS VDD */
2261 /*----------------------------------------------------------------------------*/
2262 static unsigned char XGI_XG21GetPSCValue(struct vb_device_info *pVBInfo)
2264 unsigned char CR4A, temp;
2266 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
2267 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~0x23); /* enable GPIO write */
2269 temp = xgifb_reg_get(pVBInfo->P3d4, 0x48);
2271 temp = XG21GPIODataTransfer(temp);
2273 xgifb_reg_set(pVBInfo->P3d4, 0x4A, CR4A);
2277 /*----------------------------------------------------------------------------*/
2279 /* bl[5] : LVDS signal */
2280 /* bl[1] : LVDS backlight */
2281 /* bl[0] : LVDS VDD */
2282 /*----------------------------------------------------------------------------*/
2283 static unsigned char XGI_XG27GetPSCValue(struct vb_device_info *pVBInfo)
2285 unsigned char CR4A, CRB4, temp;
2287 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
2288 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~0x0C); /* enable GPIO write */
2290 temp = xgifb_reg_get(pVBInfo->P3d4, 0x48);
2294 xgifb_reg_set(pVBInfo->P3d4, 0x4A, CR4A);
2295 CRB4 = xgifb_reg_get(pVBInfo->P3d4, 0xB4);
2296 temp |= ((CRB4 & 0x04) << 3);
2300 /*----------------------------------------------------------------------------*/
2302 /* bl[5] : 1;LVDS signal on */
2303 /* bl[1] : 1;LVDS backlight on */
2304 /* bl[0] : 1:LVDS VDD on */
2305 /* bh: 100000b : clear bit 5, to set bit5 */
2306 /* 000010b : clear bit 1, to set bit1 */
2307 /* 000001b : clear bit 0, to set bit0 */
2308 /*----------------------------------------------------------------------------*/
2309 static void XGI_XG21BLSignalVDD(unsigned short tempbh, unsigned short tempbl,
2310 struct vb_device_info *pVBInfo)
2312 unsigned char CR4A, temp;
2314 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
2317 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~tempbh); /* enable GPIO write */
2319 if (tempbh & 0x20) {
2320 temp = (tempbl >> 4) & 0x02;
2323 xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~0x02, temp);
2327 temp = xgifb_reg_get(pVBInfo->P3d4, 0x48);
2329 temp = XG21GPIODataTransfer(temp);
2332 xgifb_reg_set(pVBInfo->P3d4, 0x48, temp);
2335 static void XGI_XG27BLSignalVDD(unsigned short tempbh, unsigned short tempbl,
2336 struct vb_device_info *pVBInfo)
2338 unsigned char CR4A, temp;
2339 unsigned short tempbh0, tempbl0;
2348 if (tempbh & 0x20) {
2349 temp = (tempbl >> 4) & 0x02;
2352 xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~0x02, temp);
2355 xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~tempbh0, tempbl0);
2357 CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A);
2361 tempbl <<= 2; /* GPIOC,GPIOD */
2362 xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~tempbh); /* enable GPIO write */
2363 xgifb_reg_and_or(pVBInfo->P3d4, 0x48, ~tempbh, tempbl);
2366 static void XGI_DisplayOn(struct xgifb_video_info *xgifb_info,
2367 struct xgi_hw_device_info *pXGIHWDE,
2368 struct vb_device_info *pVBInfo)
2371 xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xDF, 0x00);
2372 if (pXGIHWDE->jChipType == XG21) {
2373 if (pVBInfo->IF_DEF_LVDS == 1) {
2374 if (!(XGI_XG21GetPSCValue(pVBInfo) & 0x1)) {
2376 XGI_XG21BLSignalVDD(0x01, 0x01, pVBInfo);
2377 mdelay(xgifb_info->lvds_data.PSC_S2);
2379 if (!(XGI_XG21GetPSCValue(pVBInfo) & 0x20))
2380 /* LVDS signal on */
2381 XGI_XG21BLSignalVDD(0x20, 0x20, pVBInfo);
2382 mdelay(xgifb_info->lvds_data.PSC_S3);
2383 /* LVDS backlight on */
2384 XGI_XG21BLSignalVDD(0x02, 0x02, pVBInfo);
2386 /* DVO/DVI signal on */
2387 XGI_XG21BLSignalVDD(0x20, 0x20, pVBInfo);
2392 if (pXGIHWDE->jChipType == XG27) {
2393 if (pVBInfo->IF_DEF_LVDS == 1) {
2394 if (!(XGI_XG27GetPSCValue(pVBInfo) & 0x1)) {
2396 XGI_XG27BLSignalVDD(0x01, 0x01, pVBInfo);
2397 mdelay(xgifb_info->lvds_data.PSC_S2);
2399 if (!(XGI_XG27GetPSCValue(pVBInfo) & 0x20))
2400 /* LVDS signal on */
2401 XGI_XG27BLSignalVDD(0x20, 0x20, pVBInfo);
2402 mdelay(xgifb_info->lvds_data.PSC_S3);
2403 /* LVDS backlight on */
2404 XGI_XG27BLSignalVDD(0x02, 0x02, pVBInfo);
2406 /* DVO/DVI signal on */
2407 XGI_XG27BLSignalVDD(0x20, 0x20, pVBInfo);
2413 void XGI_DisplayOff(struct xgifb_video_info *xgifb_info,
2414 struct xgi_hw_device_info *pXGIHWDE,
2415 struct vb_device_info *pVBInfo)
2418 if (pXGIHWDE->jChipType == XG21) {
2419 if (pVBInfo->IF_DEF_LVDS == 1) {
2420 /* LVDS backlight off */
2421 XGI_XG21BLSignalVDD(0x02, 0x00, pVBInfo);
2422 mdelay(xgifb_info->lvds_data.PSC_S3);
2424 /* DVO/DVI signal off */
2425 XGI_XG21BLSignalVDD(0x20, 0x00, pVBInfo);
2429 if (pXGIHWDE->jChipType == XG27) {
2430 if ((XGI_XG27GetPSCValue(pVBInfo) & 0x2)) {
2431 /* LVDS backlight off */
2432 XGI_XG27BLSignalVDD(0x02, 0x00, pVBInfo);
2433 mdelay(xgifb_info->lvds_data.PSC_S3);
2436 if (pVBInfo->IF_DEF_LVDS == 0)
2437 /* DVO/DVI signal off */
2438 XGI_XG27BLSignalVDD(0x20, 0x00, pVBInfo);
2441 xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xDF, 0x20);
2444 static void XGI_WaitDisply(struct vb_device_info *pVBInfo)
2446 while ((inb(pVBInfo->P3da) & 0x01))
2449 while (!(inb(pVBInfo->P3da) & 0x01))
2453 static void XGI_AutoThreshold(struct vb_device_info *pVBInfo)
2455 xgifb_reg_or(pVBInfo->Part1Port, 0x01, 0x40);
2458 static void XGI_SaveCRT2Info(unsigned short ModeNo,
2459 struct vb_device_info *pVBInfo)
2461 unsigned short temp1, temp2;
2463 /* reserve CR34 for CRT1 Mode No */
2464 xgifb_reg_set(pVBInfo->P3d4, 0x34, ModeNo);
2465 temp1 = (pVBInfo->VBInfo & SetInSlaveMode) >> 8;
2466 temp2 = ~(SetInSlaveMode >> 8);
2467 xgifb_reg_and_or(pVBInfo->P3d4, 0x31, temp2, temp1);
2470 static void XGI_GetCRT2ResInfo(unsigned short ModeNo,
2471 unsigned short ModeIdIndex,
2472 struct vb_device_info *pVBInfo)
2474 unsigned short xres, yres, modeflag, resindex;
2476 resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
2477 xres = XGI330_ModeResInfo[resindex].HTotal; /* xres->ax */
2478 yres = XGI330_ModeResInfo[resindex].VTotal; /* yres->bx */
2479 /* si+St_ModeFlag */
2480 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2482 if (modeflag & HalfDCLK)
2485 if (modeflag & DoubleScanMode)
2488 if (!(pVBInfo->VBInfo & SetCRT2ToLCD))
2491 if (pVBInfo->LCDResInfo == Panel_1600x1200) {
2492 if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) {
2498 if (pVBInfo->LCDResInfo == Panel_1280x1024) {
2501 else if (yres == 350)
2504 if (pVBInfo->LCDInfo & XGI_LCDVESATiming) {
2510 if (pVBInfo->LCDResInfo == Panel_1024x768) {
2511 if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) {
2512 if (!(pVBInfo->LCDInfo & LCDNonExpanding)) {
2515 else if (yres == 400)
2517 else if (yres == 480)
2527 pVBInfo->VGAHDE = xres;
2528 pVBInfo->HDE = xres;
2529 pVBInfo->VGAVDE = yres;
2530 pVBInfo->VDE = yres;
2533 static unsigned char XGI_IsLCDDualLink(struct vb_device_info *pVBInfo)
2536 if ((pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) &&
2537 (pVBInfo->LCDInfo & SetLCDDualLink)) /* shampoo0129 */
2543 static void XGI_GetRAMDAC2DATA(unsigned short ModeNo,
2544 unsigned short ModeIdIndex,
2545 unsigned short RefreshRateTableIndex,
2546 struct vb_device_info *pVBInfo)
2548 unsigned short tempax, tempbx, temp1, temp2, modeflag = 0, tempcx,
2551 pVBInfo->RVBHCMAX = 1;
2552 pVBInfo->RVBHCFACT = 1;
2553 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2554 CRT1Index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
2555 CRT1Index &= IndexMask;
2556 temp1 = (unsigned short) XGI_CRT1Table[CRT1Index].CR[0];
2557 temp2 = (unsigned short) XGI_CRT1Table[CRT1Index].CR[5];
2558 tempax = (temp1 & 0xFF) | ((temp2 & 0x03) << 8);
2559 tempbx = (unsigned short) XGI_CRT1Table[CRT1Index].CR[8];
2560 tempcx = (unsigned short)
2561 XGI_CRT1Table[CRT1Index].CR[14] << 8;
2563 tempcx = tempcx << 2;
2565 temp1 = (unsigned short) XGI_CRT1Table[CRT1Index].CR[9];
2574 if (modeflag & Charx8Dot)
2579 pVBInfo->VGAHT = tempax;
2580 pVBInfo->HT = tempax;
2582 pVBInfo->VGAVT = tempbx;
2583 pVBInfo->VT = tempbx;
2586 static void XGI_GetCRT2Data(unsigned short ModeNo, unsigned short ModeIdIndex,
2587 unsigned short RefreshRateTableIndex,
2588 struct vb_device_info *pVBInfo)
2590 unsigned short tempax = 0, tempbx = 0, modeflag, resinfo;
2592 struct SiS_LCDData const *LCDPtr = NULL;
2594 /* si+Ext_ResInfo */
2595 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2596 resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
2597 pVBInfo->NewFlickerMode = 0;
2598 pVBInfo->RVBHRS = 50;
2600 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
2601 XGI_GetRAMDAC2DATA(ModeNo, ModeIdIndex, RefreshRateTableIndex,
2606 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) {
2607 LCDPtr = XGI_GetLcdPtr(XGI_LCDDataTable, ModeNo, ModeIdIndex,
2608 RefreshRateTableIndex, pVBInfo);
2610 pVBInfo->RVBHCMAX = LCDPtr->RVBHCMAX;
2611 pVBInfo->RVBHCFACT = LCDPtr->RVBHCFACT;
2612 pVBInfo->VGAHT = LCDPtr->VGAHT;
2613 pVBInfo->VGAVT = LCDPtr->VGAVT;
2614 pVBInfo->HT = LCDPtr->LCDHT;
2615 pVBInfo->VT = LCDPtr->LCDVT;
2617 if (pVBInfo->LCDResInfo == Panel_1024x768) {
2621 if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) {
2622 if (pVBInfo->VGAVDE == 357)
2624 else if (pVBInfo->VGAVDE == 420)
2626 else if (pVBInfo->VGAVDE == 525)
2628 else if (pVBInfo->VGAVDE == 600)
2631 } else if (pVBInfo->LCDResInfo == Panel_1024x768x75) {
2634 } else if (pVBInfo->LCDResInfo == Panel_1280x1024) {
2636 if (pVBInfo->VGAVDE == 360)
2638 else if (pVBInfo->VGAVDE == 375)
2640 else if (pVBInfo->VGAVDE == 405)
2644 } else if (pVBInfo->LCDResInfo == Panel_1280x1024x75) {
2647 } else if (pVBInfo->LCDResInfo == Panel_1280x960) {
2649 if (pVBInfo->VGAVDE == 350)
2651 else if (pVBInfo->VGAVDE == 400)
2653 else if (pVBInfo->VGAVDE == 1024)
2657 } else if (pVBInfo->LCDResInfo == Panel_1400x1050) {
2661 if (pVBInfo->VGAVDE == 1024) {
2665 } else if (pVBInfo->LCDResInfo == Panel_1600x1200) {
2667 tempbx = 1200; /* alan 10/14/2003 */
2668 if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) {
2669 if (pVBInfo->VGAVDE == 350)
2671 else if (pVBInfo->VGAVDE == 400)
2676 if (pVBInfo->LCDInfo & LCDNonExpanding) {
2677 tempax = pVBInfo->VGAHDE;
2678 tempbx = pVBInfo->VGAVDE;
2681 pVBInfo->HDE = tempax;
2682 pVBInfo->VDE = tempbx;
2686 if (pVBInfo->VBInfo & (SetCRT2ToTV)) {
2687 struct SiS_TVData const *TVPtr;
2689 TVPtr = XGI_GetTVPtr(ModeNo, ModeIdIndex, RefreshRateTableIndex,
2692 pVBInfo->RVBHCMAX = TVPtr->RVBHCMAX;
2693 pVBInfo->RVBHCFACT = TVPtr->RVBHCFACT;
2694 pVBInfo->VGAHT = TVPtr->VGAHT;
2695 pVBInfo->VGAVT = TVPtr->VGAVT;
2696 pVBInfo->HDE = TVPtr->TVHDE;
2697 pVBInfo->VDE = TVPtr->TVVDE;
2698 pVBInfo->RVBHRS = TVPtr->RVBHRS;
2699 pVBInfo->NewFlickerMode = TVPtr->FlickerMode;
2701 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
2702 if (resinfo == 0x08)
2703 pVBInfo->NewFlickerMode = 0x40;
2704 else if (resinfo == 0x09)
2705 pVBInfo->NewFlickerMode = 0x40;
2706 else if (resinfo == 0x12)
2707 pVBInfo->NewFlickerMode = 0x40;
2709 if (pVBInfo->VGAVDE == 350)
2710 pVBInfo->TVInfo |= TVSimuMode;
2715 if (pVBInfo->VBInfo & SetInSlaveMode) {
2716 if (pVBInfo->TVInfo & TVSimuMode) {
2720 if (!(modeflag & Charx8Dot)) {
2721 tempax = StHiTextTVHT;
2722 tempbx = StHiTextTVVT;
2726 } else if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) {
2727 if (pVBInfo->TVInfo & TVSetYPbPr750p) {
2728 tempax = YPbPrTV750pHT; /* Ext750pTVHT */
2729 tempbx = YPbPrTV750pVT; /* Ext750pTVVT */
2732 if (pVBInfo->TVInfo & TVSetYPbPr525p) {
2733 tempax = YPbPrTV525pHT; /* Ext525pTVHT */
2734 tempbx = YPbPrTV525pVT; /* Ext525pTVVT */
2735 } else if (pVBInfo->TVInfo & TVSetYPbPr525i) {
2736 tempax = YPbPrTV525iHT; /* Ext525iTVHT */
2737 tempbx = YPbPrTV525iVT; /* Ext525iTVVT */
2738 if (pVBInfo->TVInfo & NTSC1024x768)
2739 tempax = NTSC1024x768HT;
2744 if (!(pVBInfo->TVInfo & TVSetPAL)) {
2747 if (pVBInfo->TVInfo & NTSC1024x768)
2748 tempax = NTSC1024x768HT;
2752 pVBInfo->HT = tempax;
2753 pVBInfo->VT = tempbx;
2758 static void XGI_SetCRT2VCLK(unsigned short ModeNo, unsigned short ModeIdIndex,
2759 unsigned short RefreshRateTableIndex,
2760 struct vb_device_info *pVBInfo)
2762 unsigned char di_0, di_1, tempal;
2764 tempal = XGI_GetVCLKPtr(RefreshRateTableIndex, ModeNo, ModeIdIndex,
2766 XGI_GetVCLKLen(tempal, &di_0, &di_1, pVBInfo);
2767 XGI_GetLCDVCLKPtr(&di_0, &di_1, pVBInfo);
2769 if (pVBInfo->VBType & VB_SIS301) { /* shampoo 0129 */
2771 xgifb_reg_set(pVBInfo->Part4Port, 0x0A, 0x10);
2772 xgifb_reg_set(pVBInfo->Part4Port, 0x0B, di_1);
2773 xgifb_reg_set(pVBInfo->Part4Port, 0x0A, di_0);
2774 } else { /* 301b/302b/301lv/302lv */
2775 xgifb_reg_set(pVBInfo->Part4Port, 0x0A, di_0);
2776 xgifb_reg_set(pVBInfo->Part4Port, 0x0B, di_1);
2779 xgifb_reg_set(pVBInfo->Part4Port, 0x00, 0x12);
2781 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC)
2782 xgifb_reg_or(pVBInfo->Part4Port, 0x12, 0x28);
2784 xgifb_reg_or(pVBInfo->Part4Port, 0x12, 0x08);
2787 static unsigned short XGI_GetColorDepth(unsigned short ModeNo,
2788 unsigned short ModeIdIndex, struct vb_device_info *pVBInfo)
2790 unsigned short ColorDepth[6] = { 1, 2, 4, 4, 6, 8 };
2792 unsigned short modeflag;
2794 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2795 index = (modeflag & ModeTypeMask) - ModeEGA;
2800 return ColorDepth[index];
2803 static unsigned short XGI_GetOffset(unsigned short ModeNo,
2804 unsigned short ModeIdIndex,
2805 unsigned short RefreshRateTableIndex,
2806 struct xgi_hw_device_info *HwDeviceExtension,
2807 struct vb_device_info *pVBInfo)
2809 unsigned short temp, colordepth, modeinfo, index, infoflag,
2810 ColorDepth[] = { 0x01, 0x02, 0x04 };
2812 modeinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeInfo;
2813 infoflag = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
2815 index = (modeinfo >> 8) & 0xFF;
2817 temp = XGI330_ScreenOffset[index];
2819 if (infoflag & InterlaceMode)
2822 colordepth = XGI_GetColorDepth(ModeNo, ModeIdIndex, pVBInfo);
2824 if ((ModeNo >= 0x7C) && (ModeNo <= 0x7E)) {
2825 temp = ModeNo - 0x7C;
2826 colordepth = ColorDepth[temp];
2828 if (infoflag & InterlaceMode)
2831 return temp * colordepth;
2834 static void XGI_SetCRT2Offset(unsigned short ModeNo,
2835 unsigned short ModeIdIndex,
2836 unsigned short RefreshRateTableIndex,
2837 struct xgi_hw_device_info *HwDeviceExtension,
2838 struct vb_device_info *pVBInfo)
2840 unsigned short offset;
2843 if (pVBInfo->VBInfo & SetInSlaveMode)
2846 offset = XGI_GetOffset(ModeNo, ModeIdIndex, RefreshRateTableIndex,
2847 HwDeviceExtension, pVBInfo);
2848 temp = (unsigned char) (offset & 0xFF);
2849 xgifb_reg_set(pVBInfo->Part1Port, 0x07, temp);
2850 temp = (unsigned char) ((offset & 0xFF00) >> 8);
2851 xgifb_reg_set(pVBInfo->Part1Port, 0x09, temp);
2852 temp = (unsigned char) (((offset >> 3) & 0xFF) + 1);
2853 xgifb_reg_set(pVBInfo->Part1Port, 0x03, temp);
2856 static void XGI_SetCRT2FIFO(struct vb_device_info *pVBInfo)
2858 /* threshold high ,disable auto threshold */
2859 xgifb_reg_set(pVBInfo->Part1Port, 0x01, 0x3B);
2860 /* threshold low default 04h */
2861 xgifb_reg_and_or(pVBInfo->Part1Port, 0x02, ~(0x3F), 0x04);
2864 static void XGI_PreSetGroup1(unsigned short ModeNo, unsigned short ModeIdIndex,
2865 struct xgi_hw_device_info *HwDeviceExtension,
2866 unsigned short RefreshRateTableIndex,
2867 struct vb_device_info *pVBInfo)
2871 XGI_SetCRT2Offset(ModeNo, ModeIdIndex, RefreshRateTableIndex,
2872 HwDeviceExtension, pVBInfo);
2873 XGI_SetCRT2FIFO(pVBInfo);
2875 for (tempcx = 4; tempcx < 7; tempcx++)
2876 xgifb_reg_set(pVBInfo->Part1Port, tempcx, 0x0);
2878 xgifb_reg_set(pVBInfo->Part1Port, 0x50, 0x00);
2879 xgifb_reg_set(pVBInfo->Part1Port, 0x02, 0x44); /* temp 0206 */
2882 static void XGI_SetGroup1(unsigned short ModeNo, unsigned short ModeIdIndex,
2883 struct xgi_hw_device_info *HwDeviceExtension,
2884 unsigned short RefreshRateTableIndex,
2885 struct vb_device_info *pVBInfo)
2887 unsigned short temp = 0, tempax = 0, tempbx = 0, tempcx = 0,
2888 pushbx = 0, CRT1Index, modeflag;
2890 CRT1Index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
2891 CRT1Index &= IndexMask;
2892 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2894 /* bainy change table name */
2895 if (modeflag & HalfDCLK) {
2896 /* BTVGA2HT 0x08,0x09 */
2897 temp = (pVBInfo->VGAHT / 2 - 1) & 0x0FF;
2898 xgifb_reg_set(pVBInfo->Part1Port, 0x08, temp);
2899 temp = (((pVBInfo->VGAHT / 2 - 1) & 0xFF00) >> 8) << 4;
2900 xgifb_reg_and_or(pVBInfo->Part1Port, 0x09, ~0x0F0, temp);
2901 /* BTVGA2HDEE 0x0A,0x0C */
2902 temp = (pVBInfo->VGAHDE / 2 + 16) & 0x0FF;
2903 xgifb_reg_set(pVBInfo->Part1Port, 0x0A, temp);
2904 tempcx = ((pVBInfo->VGAHT - pVBInfo->VGAHDE) / 2) >> 2;
2905 pushbx = pVBInfo->VGAHDE / 2 + 16;
2906 tempcx = tempcx >> 1;
2907 tempbx = pushbx + tempcx; /* bx BTVGA@HRS 0x0B,0x0C */
2910 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
2911 tempbx = XGI_CRT1Table[CRT1Index].CR[4];
2912 tempbx |= ((XGI_CRT1Table[CRT1Index].CR[14] &
2914 tempbx = (tempbx - 3) << 3; /* (VGAHRS-3)*8 */
2915 tempcx = XGI_CRT1Table[CRT1Index].CR[5];
2917 temp = XGI_CRT1Table[CRT1Index].CR[15];
2918 temp = (temp & 0x04) << (5 - 2); /* VGAHRE D[5] */
2919 tempcx = ((tempcx | temp) - 3) << 3; /* (VGAHRE-3)*8 */
2925 if (tempcx > (pVBInfo->VGAHT / 2))
2926 tempcx = pVBInfo->VGAHT / 2;
2928 temp = tempbx & 0x00FF;
2930 xgifb_reg_set(pVBInfo->Part1Port, 0x0B, temp);
2932 temp = (pVBInfo->VGAHT - 1) & 0x0FF; /* BTVGA2HT 0x08,0x09 */
2933 xgifb_reg_set(pVBInfo->Part1Port, 0x08, temp);
2934 temp = (((pVBInfo->VGAHT - 1) & 0xFF00) >> 8) << 4;
2935 xgifb_reg_and_or(pVBInfo->Part1Port, 0x09, ~0x0F0, temp);
2936 /* BTVGA2HDEE 0x0A,0x0C */
2937 temp = (pVBInfo->VGAHDE + 16) & 0x0FF;
2938 xgifb_reg_set(pVBInfo->Part1Port, 0x0A, temp);
2939 tempcx = (pVBInfo->VGAHT - pVBInfo->VGAHDE) >> 2; /* cx */
2940 pushbx = pVBInfo->VGAHDE + 16;
2941 tempcx = tempcx >> 1;
2942 tempbx = pushbx + tempcx; /* bx BTVGA@HRS 0x0B,0x0C */
2945 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
2946 tempbx = XGI_CRT1Table[CRT1Index].CR[3];
2947 tempbx |= ((XGI_CRT1Table[CRT1Index].CR[5] &
2949 tempbx = (tempbx - 3) << 3; /* (VGAHRS-3)*8 */
2950 tempcx = XGI_CRT1Table[CRT1Index].CR[4];
2952 temp = XGI_CRT1Table[CRT1Index].CR[6];
2953 temp = (temp & 0x04) << (5 - 2); /* VGAHRE D[5] */
2954 tempcx = ((tempcx | temp) - 3) << 3; /* (VGAHRE-3)*8 */
2959 if (tempcx > pVBInfo->VGAHT)
2960 tempcx = pVBInfo->VGAHT;
2962 temp = tempbx & 0x00FF;
2963 xgifb_reg_set(pVBInfo->Part1Port, 0x0B, temp);
2966 tempax = (tempax & 0x00FF) | (tempbx & 0xFF00);
2968 tempbx = (tempbx & 0x00FF) | ((tempbx & 0xFF00) << 4);
2969 tempax |= (tempbx & 0xFF00);
2970 temp = (tempax & 0xFF00) >> 8;
2971 xgifb_reg_set(pVBInfo->Part1Port, 0x0C, temp);
2972 temp = tempcx & 0x00FF;
2973 xgifb_reg_set(pVBInfo->Part1Port, 0x0D, temp);
2974 tempcx = (pVBInfo->VGAVT - 1);
2975 temp = tempcx & 0x00FF;
2977 xgifb_reg_set(pVBInfo->Part1Port, 0x0E, temp);
2978 tempbx = pVBInfo->VGAVDE - 1;
2979 temp = tempbx & 0x00FF;
2980 xgifb_reg_set(pVBInfo->Part1Port, 0x0F, temp);
2981 temp = ((tempbx & 0xFF00) << 3) >> 8;
2982 temp |= ((tempcx & 0xFF00) >> 8);
2983 xgifb_reg_set(pVBInfo->Part1Port, 0x12, temp);
2985 /* BTVGA2VRS 0x10,0x11 */
2986 tempbx = (pVBInfo->VGAVT + pVBInfo->VGAVDE) >> 1;
2987 /* BTVGA2VRE 0x11 */
2988 tempcx = ((pVBInfo->VGAVT - pVBInfo->VGAVDE) >> 4) + tempbx + 1;
2990 if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) {
2991 tempbx = XGI_CRT1Table[CRT1Index].CR[10];
2992 temp = XGI_CRT1Table[CRT1Index].CR[9];
3000 temp = XGI_CRT1Table[CRT1Index].CR[14];
3005 temp = XGI_CRT1Table[CRT1Index].CR[11];
3006 tempcx = (tempcx & 0xFF00) | (temp & 0x00FF);
3009 temp = tempbx & 0x00FF;
3010 xgifb_reg_set(pVBInfo->Part1Port, 0x10, temp);
3011 temp = ((tempbx & 0xFF00) >> 8) << 4;
3012 temp = ((tempcx & 0x000F) | (temp));
3013 xgifb_reg_set(pVBInfo->Part1Port, 0x11, temp);
3016 if (modeflag & DoubleScanMode)
3019 if (modeflag & HalfDCLK)
3022 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2C, ~0x0C0, tempax);
3025 static unsigned short XGI_GetVGAHT2(struct vb_device_info *pVBInfo)
3027 unsigned long tempax, tempbx;
3029 tempbx = ((pVBInfo->VGAVT - pVBInfo->VGAVDE) * pVBInfo->RVBHCMAX)
3031 tempax = (pVBInfo->VT - pVBInfo->VDE) * pVBInfo->RVBHCFACT;
3032 tempax = (tempax * pVBInfo->HT) / tempbx;
3034 return (unsigned short) tempax;
3037 static void XGI_SetLockRegs(unsigned short ModeNo, unsigned short ModeIdIndex,
3038 struct xgi_hw_device_info *HwDeviceExtension,
3039 unsigned short RefreshRateTableIndex,
3040 struct vb_device_info *pVBInfo)
3042 unsigned short push1, push2, tempax, tempbx = 0, tempcx, temp, resinfo,
3045 /* si+Ext_ResInfo */
3046 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3047 resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
3049 if (!(pVBInfo->VBInfo & SetInSlaveMode))
3052 temp = 0xFF; /* set MAX HT */
3053 xgifb_reg_set(pVBInfo->Part1Port, 0x03, temp);
3056 if (pVBInfo->VBType & (VB_SIS301LV | VB_SIS302LV | VB_XGI301C))
3057 modeflag |= Charx8Dot;
3059 tempax = pVBInfo->VGAHDE; /* 0x04 Horizontal Display End */
3061 if (modeflag & HalfDCLK)
3062 tempax = tempax >> 1;
3064 tempax = (tempax / tempcx) - 1;
3065 tempbx |= ((tempax & 0x00FF) << 8);
3066 temp = tempax & 0x00FF;
3067 xgifb_reg_set(pVBInfo->Part1Port, 0x04, temp);
3069 temp = (tempbx & 0xFF00) >> 8;
3071 if (pVBInfo->VBInfo & SetCRT2ToTV) {
3072 if (!(pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
3073 | VB_SIS302LV | VB_XGI301C)))
3076 if ((pVBInfo->VBInfo & SetCRT2ToHiVision) &&
3077 !(pVBInfo->VBType & VB_SIS301LV) && (resinfo == 7))
3081 /* 0x05 Horizontal Display Start */
3082 xgifb_reg_set(pVBInfo->Part1Port, 0x05, temp);
3083 /* 0x06 Horizontal Blank end */
3084 xgifb_reg_set(pVBInfo->Part1Port, 0x06, 0x03);
3086 if (!(pVBInfo->VBInfo & DisableCRT2Display)) { /* 030226 bainy */
3087 if (pVBInfo->VBInfo & SetCRT2ToTV)
3088 tempax = pVBInfo->VGAHT;
3090 tempax = XGI_GetVGAHT2(pVBInfo);
3093 if (tempax >= pVBInfo->VGAHT)
3094 tempax = pVBInfo->VGAHT;
3096 if (modeflag & HalfDCLK)
3097 tempax = tempax >> 1;
3099 tempax = (tempax / tempcx) - 5;
3100 tempcx = tempax; /* 20030401 0x07 horizontal Retrace Start */
3101 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
3102 temp = (tempbx & 0x00FF) - 1;
3103 if (!(modeflag & HalfDCLK)) {
3105 if (pVBInfo->TVInfo & TVSimuMode) {
3111 tempbx = (tempbx & 0xFF00) >> 8;
3112 tempcx = (tempcx + tempbx) >> 1;
3113 temp = (tempcx & 0x00FF) + 2;
3115 if (pVBInfo->VBInfo & SetCRT2ToTV) {
3117 if (!(modeflag & HalfDCLK)) {
3118 if ((modeflag & Charx8Dot)) {
3120 if (pVBInfo->VGAHDE >= 800)
3124 } else if (!(modeflag & HalfDCLK)) {
3126 if (pVBInfo->LCDResInfo != Panel_1280x960 &&
3127 pVBInfo->VGAHDE >= 800) {
3129 if (pVBInfo->VGAHDE >= 1280 &&
3130 pVBInfo->LCDResInfo != Panel_1280x960 &&
3131 (pVBInfo->LCDInfo & LCDNonExpanding))
3137 /* 0x07 Horizontal Retrace Start */
3138 xgifb_reg_set(pVBInfo->Part1Port, 0x07, temp);
3139 /* 0x08 Horizontal Retrace End */
3140 xgifb_reg_set(pVBInfo->Part1Port, 0x08, 0);
3142 if (pVBInfo->VBInfo & SetCRT2ToTV) {
3143 if (pVBInfo->TVInfo & TVSimuMode) {
3144 if (ModeNo == 0x50) {
3145 if (pVBInfo->TVInfo == SetNTSCTV) {
3146 xgifb_reg_set(pVBInfo->Part1Port,
3148 xgifb_reg_set(pVBInfo->Part1Port,
3151 xgifb_reg_set(pVBInfo->Part1Port,
3153 xgifb_reg_set(pVBInfo->Part1Port,
3160 xgifb_reg_set(pVBInfo->Part1Port, 0x18, 0x03); /* 0x18 SR0B */
3161 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, 0xF0, 0x00);
3162 xgifb_reg_set(pVBInfo->Part1Port, 0x09, 0xFF); /* 0x09 Set Max VT */
3164 tempbx = pVBInfo->VGAVT;
3167 tempbx = pVBInfo->VGAVDE; /* 0x0E Virtical Display End */
3182 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
3183 if (pVBInfo->LCDResInfo == Panel_1024x768) {
3184 if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) {
3194 temp = tempbx & 0x00FF;
3195 /* 0x10 vertical Blank Start */
3196 xgifb_reg_set(pVBInfo->Part1Port, 0x10, temp);
3199 temp = tempbx & 0x00FF;
3200 xgifb_reg_set(pVBInfo->Part1Port, 0x0E, temp);
3202 if (tempbx & 0x0100)
3207 if (modeflag & DoubleScanMode)
3210 if (tempbx & 0x0200)
3213 temp = (tempax & 0xFF00) >> 8;
3214 xgifb_reg_set(pVBInfo->Part1Port, 0x0B, temp);
3216 if (tempbx & 0x0400)
3219 /* 0x11 Vertival Blank End */
3220 xgifb_reg_set(pVBInfo->Part1Port, 0x11, 0x00);
3223 tempax -= tempbx; /* 0x0C Vertical Retrace Start */
3224 tempax = tempax >> 2;
3225 push1 = tempax; /* push ax */
3227 if (resinfo != 0x09) {
3228 tempax = tempax << 1;
3232 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
3233 if ((pVBInfo->VBType & VB_SIS301LV) &&
3234 !(pVBInfo->TVInfo & TVSetHiVision)) {
3235 if ((pVBInfo->TVInfo & TVSimuMode) &&
3236 (pVBInfo->TVInfo & TVSetPAL)) {
3237 if (!(pVBInfo->VBType & VB_SIS301LV) ||
3247 } else if (pVBInfo->TVInfo & TVSimuMode) {
3248 if (pVBInfo->TVInfo & TVSetPAL) {
3249 if (pVBInfo->VBType & VB_SIS301LV) {
3250 if (!(pVBInfo->TVInfo &
3261 tempax = tempax >> 2;
3264 push1 = tempax; /* push ax */
3266 if ((pVBInfo->TVInfo & TVSetPAL)) {
3267 if (tempbx <= 513) {
3273 temp = tempbx & 0x00FF;
3274 xgifb_reg_set(pVBInfo->Part1Port, 0x0C, temp);
3276 temp = tempbx & 0x00FF;
3277 xgifb_reg_set(pVBInfo->Part1Port, 0x10, temp);
3279 if (tempbx & 0x0100)
3282 if (tempbx & 0x0200)
3283 xgifb_reg_and_or(pVBInfo->Part1Port, 0x0B, 0x0FF, 0x20);
3287 if (tempbx & 0x0100)
3290 if (tempbx & 0x0200)
3293 if (tempbx & 0x0400)
3296 tempbx = push1; /* pop ax */
3297 temp = tempbx & 0x00FF;
3299 /* 0x0D vertical Retrace End */
3300 xgifb_reg_set(pVBInfo->Part1Port, 0x0D, temp);
3302 if (tempbx & 0x0010)
3305 temp = tempcx & 0x00FF;
3306 xgifb_reg_set(pVBInfo->Part1Port, 0x0A, temp); /* 0x0A CR07 */
3307 temp = (tempcx & 0x0FF00) >> 8;
3308 xgifb_reg_set(pVBInfo->Part1Port, 0x17, temp); /* 0x17 SR0A */
3310 temp = (tempax & 0xFF00) >> 8;
3312 temp = (temp >> 1) & 0x09;
3314 if (pVBInfo->VBType & (VB_SIS301LV | VB_SIS302LV | VB_XGI301C))
3317 xgifb_reg_set(pVBInfo->Part1Port, 0x16, temp); /* 0x16 SR01 */
3318 xgifb_reg_set(pVBInfo->Part1Port, 0x0F, 0); /* 0x0F CR14 */
3319 xgifb_reg_set(pVBInfo->Part1Port, 0x12, 0); /* 0x12 CR17 */
3321 if (pVBInfo->LCDInfo & LCDRGB18Bit)
3326 xgifb_reg_set(pVBInfo->Part1Port, 0x1A, temp); /* 0x1A SR0E */
3331 static void XGI_SetGroup2(unsigned short ModeNo, unsigned short ModeIdIndex,
3332 unsigned short RefreshRateTableIndex,
3333 struct xgi_hw_device_info *HwDeviceExtension,
3334 struct vb_device_info *pVBInfo)
3336 unsigned short i, j, tempax, tempbx, tempcx, temp, push1, push2,
3338 unsigned char const *TimingPoint;
3340 unsigned long longtemp, tempeax, tempebx, temp2, tempecx;
3342 /* si+Ext_ResInfo */
3343 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3347 if (!(pVBInfo->VBInfo & SetCRT2ToAVIDEO))
3350 if (!(pVBInfo->VBInfo & SetCRT2ToSVIDEO))
3353 if (pVBInfo->VBInfo & SetCRT2ToSCART)
3356 if (!(pVBInfo->TVInfo & TVSetPAL))
3359 if (pVBInfo->VBInfo & SetCRT2ToHiVision)
3362 if (pVBInfo->TVInfo & (TVSetYPbPr525p | TVSetYPbPr750p))
3365 tempax = (tempax & 0xff00) >> 8;
3367 xgifb_reg_set(pVBInfo->Part2Port, 0x0, tempax);
3368 TimingPoint = XGI330_NTSCTiming;
3370 if (pVBInfo->TVInfo & TVSetPAL)
3371 TimingPoint = XGI330_PALTiming;
3373 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
3374 TimingPoint = XGI330_HiTVExtTiming;
3376 if (pVBInfo->VBInfo & SetInSlaveMode)
3377 TimingPoint = XGI330_HiTVSt2Timing;
3379 if (pVBInfo->SetFlag & TVSimuMode)
3380 TimingPoint = XGI330_HiTVSt1Timing;
3382 if (!(modeflag & Charx8Dot))
3383 TimingPoint = XGI330_HiTVTextTiming;
3386 if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) {
3387 if (pVBInfo->TVInfo & TVSetYPbPr525i)
3388 TimingPoint = XGI330_YPbPr525iTiming;
3390 if (pVBInfo->TVInfo & TVSetYPbPr525p)
3391 TimingPoint = XGI330_YPbPr525pTiming;
3393 if (pVBInfo->TVInfo & TVSetYPbPr750p)
3394 TimingPoint = XGI330_YPbPr750pTiming;
3397 for (i = 0x01, j = 0; i <= 0x2D; i++, j++)
3398 xgifb_reg_set(pVBInfo->Part2Port, i, TimingPoint[j]);
3400 for (i = 0x39; i <= 0x45; i++, j++)
3402 xgifb_reg_set(pVBInfo->Part2Port, i, TimingPoint[j]);
3404 if (pVBInfo->VBInfo & SetCRT2ToTV)
3405 xgifb_reg_and_or(pVBInfo->Part2Port, 0x3A, 0x1F, 0x00);
3407 temp = pVBInfo->NewFlickerMode;
3409 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0A, 0xFF, temp);
3411 if (pVBInfo->TVInfo & TVSetPAL)
3416 if (pVBInfo->VDE <= tempax) {
3417 tempax -= pVBInfo->VDE;
3418 tempax = tempax >> 2;
3419 tempax = (tempax & 0x00FF) | ((tempax & 0x00FF) << 8);
3421 temp = (tempax & 0xFF00) >> 8;
3422 temp += (unsigned short) TimingPoint[0];
3424 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
3425 | VB_SIS302LV | VB_XGI301C)) {
3426 if (pVBInfo->VBInfo & (SetCRT2ToAVIDEO
3427 | SetCRT2ToSVIDEO | SetCRT2ToSCART
3428 | SetCRT2ToYPbPr525750)) {
3429 tempcx = pVBInfo->VGAHDE;
3430 if (tempcx >= 1024) {
3431 temp = 0x17; /* NTSC */
3432 if (pVBInfo->TVInfo & TVSetPAL)
3433 temp = 0x19; /* PAL */
3438 xgifb_reg_set(pVBInfo->Part2Port, 0x01, temp);
3440 temp = (tempax & 0xFF00) >> 8;
3441 temp += TimingPoint[1];
3443 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
3444 | VB_SIS302LV | VB_XGI301C)) {
3445 if ((pVBInfo->VBInfo & (SetCRT2ToAVIDEO
3446 | SetCRT2ToSVIDEO | SetCRT2ToSCART
3447 | SetCRT2ToYPbPr525750))) {
3448 tempcx = pVBInfo->VGAHDE;
3449 if (tempcx >= 1024) {
3450 temp = 0x1D; /* NTSC */
3451 if (pVBInfo->TVInfo & TVSetPAL)
3452 temp = 0x52; /* PAL */
3456 xgifb_reg_set(pVBInfo->Part2Port, 0x02, temp);
3460 tempcx = pVBInfo->HT;
3462 if (XGI_IsLCDDualLink(pVBInfo))
3463 tempcx = tempcx >> 1;
3466 temp = tempcx & 0x00FF;
3467 xgifb_reg_set(pVBInfo->Part2Port, 0x1B, temp);
3469 temp = (tempcx & 0xFF00) >> 8;
3470 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1D, ~0x0F, temp);
3472 tempcx = pVBInfo->HT >> 1;
3473 push1 = tempcx; /* push cx */
3476 if (pVBInfo->VBInfo & SetCRT2ToHiVision)
3479 temp = tempcx & 0x00FF;
3481 xgifb_reg_and_or(pVBInfo->Part2Port, 0x22, 0x0F, temp);
3483 tempbx = TimingPoint[j] | ((TimingPoint[j + 1]) << 8);
3486 temp = tempbx & 0x00FF;
3487 xgifb_reg_set(pVBInfo->Part2Port, 0x24, temp);
3488 temp = (tempbx & 0xFF00) >> 8;
3490 xgifb_reg_and_or(pVBInfo->Part2Port, 0x25, 0x0F, temp);
3493 tempbx = tempbx + 8;
3494 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
3495 tempbx = tempbx - 4;
3499 temp = (tempbx & 0x00FF) << 4;
3500 xgifb_reg_and_or(pVBInfo->Part2Port, 0x29, 0x0F, temp);
3503 tempcx += (TimingPoint[j] | ((TimingPoint[j + 1]) << 8));
3504 temp = tempcx & 0x00FF;
3505 xgifb_reg_set(pVBInfo->Part2Port, 0x27, temp);
3506 temp = ((tempcx & 0xFF00) >> 8) << 4;
3507 xgifb_reg_and_or(pVBInfo->Part2Port, 0x28, 0x0F, temp);
3510 if (pVBInfo->VBInfo & SetCRT2ToHiVision)
3513 temp = tempcx & 0xFF;
3515 xgifb_reg_and_or(pVBInfo->Part2Port, 0x2A, 0x0F, temp);
3517 tempcx = push1; /* pop cx */
3519 temp = TimingPoint[j] | ((TimingPoint[j + 1]) << 8);
3521 temp = tempcx & 0x00FF;
3523 xgifb_reg_and_or(pVBInfo->Part2Port, 0x2D, 0x0F, temp);
3527 if (!(pVBInfo->VBInfo & SetCRT2ToTV)) {
3528 tempax = XGI_GetVGAHT2(pVBInfo);
3529 tempcx = tempax - 1;
3531 temp = tempcx & 0x00FF;
3532 xgifb_reg_set(pVBInfo->Part2Port, 0x2E, temp);
3534 tempbx = pVBInfo->VDE;
3536 if (pVBInfo->VGAVDE == 360)
3538 if (pVBInfo->VGAVDE == 375)
3540 if (pVBInfo->VGAVDE == 405)
3543 if (pVBInfo->VBInfo & SetCRT2ToTV) {
3544 if (pVBInfo->VBType &
3545 (VB_SIS301LV | VB_SIS302LV | VB_XGI301C)) {
3546 if (!(pVBInfo->TVInfo &
3547 (TVSetYPbPr525p | TVSetYPbPr750p)))
3548 tempbx = tempbx >> 1;
3550 tempbx = tempbx >> 1;
3554 temp = tempbx & 0x00FF;
3556 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
3557 if (pVBInfo->VBType & VB_SIS301LV) {
3558 if (pVBInfo->TVInfo & TVSetHiVision) {
3559 if (pVBInfo->VBInfo & SetInSlaveMode) {
3564 } else if (pVBInfo->VBInfo & SetInSlaveMode) {
3570 xgifb_reg_set(pVBInfo->Part2Port, 0x2F, temp);
3572 temp = (tempcx & 0xFF00) >> 8;
3573 temp |= ((tempbx & 0xFF00) >> 8) << 6;
3575 if (!(pVBInfo->VBInfo & SetCRT2ToHiVision)) {
3576 if (pVBInfo->VBType & VB_SIS301LV) {
3577 if (pVBInfo->TVInfo & TVSetHiVision) {
3580 if (!(pVBInfo->VBInfo & SetCRT2ToSVIDEO))
3585 if (!(pVBInfo->VBInfo & SetCRT2ToSVIDEO))
3590 xgifb_reg_set(pVBInfo->Part2Port, 0x30, temp);
3592 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
3593 | VB_SIS302LV | VB_XGI301C)) { /* TV gatingno */
3594 tempbx = pVBInfo->VDE;
3595 tempcx = tempbx - 2;
3597 if (pVBInfo->VBInfo & SetCRT2ToTV) {
3598 if (!(pVBInfo->TVInfo & (TVSetYPbPr525p
3600 tempbx = tempbx >> 1;
3603 if (pVBInfo->VBType & (VB_SIS302LV | VB_XGI301C)) {
3605 if (tempcx & 0x0400)
3608 if (tempbx & 0x0400)
3611 xgifb_reg_set(pVBInfo->Part4Port, 0x10, temp);
3614 temp = (((tempbx - 3) & 0x0300) >> 8) << 5;
3615 xgifb_reg_set(pVBInfo->Part2Port, 0x46, temp);
3616 temp = (tempbx - 3) & 0x00FF;
3617 xgifb_reg_set(pVBInfo->Part2Port, 0x47, temp);
3620 tempbx = tempbx & 0x00FF;
3622 if (!(modeflag & HalfDCLK)) {
3623 tempcx = pVBInfo->VGAHDE;
3624 if (tempcx >= pVBInfo->HDE) {
3632 if (pVBInfo->VBInfo & SetCRT2ToTV) { /*301b*/
3633 if (pVBInfo->VGAHDE >= 1024) {
3635 if (pVBInfo->VGAHDE >= 1280) {
3637 tempbx = tempbx & 0xDFFF;
3642 if (!(tempbx & 0x2000)) {
3643 if (modeflag & HalfDCLK)
3644 tempcx = (tempcx & 0xFF00) | ((tempcx & 0x00FF) << 1);
3647 tempeax = pVBInfo->VGAHDE;
3648 tempebx = (tempcx & 0xFF00) >> 8;
3649 longtemp = tempeax * tempebx;
3650 tempecx = tempcx & 0x00FF;
3651 longtemp = longtemp / tempecx;
3656 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
3657 | VB_SIS302LV | VB_XGI301C)) {
3658 tempecx = tempecx * 8;
3661 longtemp = longtemp * tempecx;
3662 tempecx = pVBInfo->HDE;
3663 temp2 = longtemp % tempecx;
3664 tempeax = longtemp / tempecx;
3668 tempax = (unsigned short) tempeax;
3671 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
3672 | VB_SIS302LV | VB_XGI301C)) {
3673 tempcx = ((tempax & 0xFF00) >> 5) >> 8;
3678 tempbx = (unsigned short) (((tempeax & 0x0000FF00) & 0x1F00)
3679 | (tempbx & 0x00FF));
3680 tempax = (unsigned short) (((tempeax & 0x000000FF) << 8)
3681 | (tempax & 0x00FF));
3682 temp = (tempax & 0xFF00) >> 8;
3684 temp = (tempax & 0x00FF) >> 8;
3687 xgifb_reg_set(pVBInfo->Part2Port, 0x44, temp);
3688 temp = (tempbx & 0xFF00) >> 8;
3689 xgifb_reg_and_or(pVBInfo->Part2Port, 0x45, ~0x03F, temp);
3690 temp = tempcx & 0x00FF;
3692 if (tempbx & 0x2000)
3695 if (!(pVBInfo->VBInfo & SetCRT2ToLCD))
3698 xgifb_reg_and_or(pVBInfo->Part2Port, 0x46, ~0x1F, temp);
3699 if (pVBInfo->TVInfo & TVSetPAL) {
3707 temp = tempbx & 0x00FF;
3708 xgifb_reg_set(pVBInfo->Part2Port, 0x4b, temp);
3709 temp = tempcx & 0x00FF;
3710 xgifb_reg_set(pVBInfo->Part2Port, 0x4c, temp);
3712 temp = ((tempcx & 0xFF00) >> 8) & 0x03;
3714 temp |= ((tempbx & 0xFF00) >> 8) & 0x03;
3716 if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) {
3719 if (pVBInfo->TVInfo & TVSetYPbPr525p)
3722 if (pVBInfo->TVInfo & TVSetYPbPr750p)
3726 xgifb_reg_set(pVBInfo->Part2Port, 0x4d, temp);
3727 temp = xgifb_reg_get(pVBInfo->Part2Port, 0x43); /* 301b change */
3728 xgifb_reg_set(pVBInfo->Part2Port, 0x43, (unsigned short) (temp - 3));
3730 if (!(pVBInfo->TVInfo & (TVSetYPbPr525p | TVSetYPbPr750p))) {
3731 if (pVBInfo->TVInfo & NTSC1024x768) {
3732 TimingPoint = XGI_NTSC1024AdjTime;
3733 for (i = 0x1c, j = 0; i <= 0x30; i++, j++) {
3734 xgifb_reg_set(pVBInfo->Part2Port, i,
3737 xgifb_reg_set(pVBInfo->Part2Port, 0x43, 0x72);
3741 /* Modify for 301C PALM Support */
3742 if (pVBInfo->VBType & VB_XGI301C) {
3743 if (pVBInfo->TVInfo & TVSetPALM)
3744 xgifb_reg_and_or(pVBInfo->Part2Port, 0x4E, ~0x08,
3745 0x08); /* PALM Mode */
3748 if (pVBInfo->TVInfo & TVSetPALM) {
3749 tempax = xgifb_reg_get(pVBInfo->Part2Port, 0x01);
3751 xgifb_reg_and(pVBInfo->Part2Port, 0x01, tempax);
3753 xgifb_reg_and(pVBInfo->Part2Port, 0x00, 0xEF);
3756 if (pVBInfo->VBInfo & SetCRT2ToHiVision) {
3757 if (!(pVBInfo->VBInfo & SetInSlaveMode))
3758 xgifb_reg_set(pVBInfo->Part2Port, 0x0B, 0x00);
3761 if (pVBInfo->VBInfo & SetCRT2ToTV)
3765 static void XGI_SetLCDRegs(unsigned short ModeNo, unsigned short ModeIdIndex,
3766 struct xgi_hw_device_info *HwDeviceExtension,
3767 unsigned short RefreshRateTableIndex,
3768 struct vb_device_info *pVBInfo)
3770 unsigned short pushbx, tempax, tempbx, tempcx, temp, tempah,
3773 struct XGI_LCDDesStruct const *LCDBDesPtr = NULL;
3775 /* si+Ext_ResInfo */
3776 if (!(pVBInfo->VBInfo & SetCRT2ToLCD))
3779 tempbx = pVBInfo->HDE; /* RHACTE=HDE-1 */
3781 if (XGI_IsLCDDualLink(pVBInfo))
3782 tempbx = tempbx >> 1;
3785 temp = tempbx & 0x00FF;
3786 xgifb_reg_set(pVBInfo->Part2Port, 0x2C, temp);
3787 temp = (tempbx & 0xFF00) >> 8;
3789 xgifb_reg_and_or(pVBInfo->Part2Port, 0x2B, 0x0F, temp);
3792 xgifb_reg_set(pVBInfo->Part2Port, 0x0B, temp);
3793 tempbx = pVBInfo->VDE; /* RTVACTEO=(VDE-1)&0xFF */
3795 temp = tempbx & 0x00FF;
3796 xgifb_reg_set(pVBInfo->Part2Port, 0x03, temp);
3797 temp = ((tempbx & 0xFF00) >> 8) & 0x07;
3798 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0C, ~0x07, temp);
3800 tempcx = pVBInfo->VT - 1;
3801 temp = tempcx & 0x00FF; /* RVTVT=VT-1 */
3802 xgifb_reg_set(pVBInfo->Part2Port, 0x19, temp);
3803 temp = (tempcx & 0xFF00) >> 8;
3805 xgifb_reg_set(pVBInfo->Part2Port, 0x1A, temp);
3806 xgifb_reg_and_or(pVBInfo->Part2Port, 0x09, 0xF0, 0x00);
3807 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0A, 0xF0, 0x00);
3808 xgifb_reg_and_or(pVBInfo->Part2Port, 0x17, 0xFB, 0x00);
3809 xgifb_reg_and_or(pVBInfo->Part2Port, 0x18, 0xDF, 0x00);
3811 /* Customized LCDB Does not add */
3812 if ((pVBInfo->VBType & VB_SIS301LV) || (pVBInfo->VBType & VB_SIS302LV))
3813 LCDBDesPtr = XGI_GetLcdPtr(xgifb_lcddldes, ModeNo, ModeIdIndex,
3814 RefreshRateTableIndex, pVBInfo);
3816 LCDBDesPtr = XGI_GetLcdPtr(XGI_LCDDesDataTable, ModeNo,
3817 ModeIdIndex, RefreshRateTableIndex,
3820 tempah = pVBInfo->LCDResInfo;
3821 tempah &= PanelResInfo;
3823 if ((tempah == Panel_1024x768) || (tempah == Panel_1024x768x75)) {
3826 } else if ((tempah == Panel_1280x1024) ||
3827 (tempah == Panel_1280x1024x75)) {
3830 } else if (tempah == Panel_1400x1050) {
3838 if (pVBInfo->LCDInfo & EnableScalingLCD) {
3839 tempbx = pVBInfo->HDE;
3840 tempcx = pVBInfo->VDE;
3844 tempax = pVBInfo->VT;
3845 pVBInfo->LCDHDES = LCDBDesPtr->LCDHDES;
3846 pVBInfo->LCDHRS = LCDBDesPtr->LCDHRS;
3847 pVBInfo->LCDVDES = LCDBDesPtr->LCDVDES;
3848 pVBInfo->LCDVRS = LCDBDesPtr->LCDVRS;
3849 tempbx = pVBInfo->LCDVDES;
3852 if (tempcx >= tempax)
3853 tempcx -= tempax; /* lcdvdes */
3855 temp = tempbx & 0x00FF; /* RVEQ1EQ=lcdvdes */
3856 xgifb_reg_set(pVBInfo->Part2Port, 0x05, temp);
3857 temp = tempcx & 0x00FF;
3858 xgifb_reg_set(pVBInfo->Part2Port, 0x06, temp);
3859 tempch = ((tempcx & 0xFF00) >> 8) & 0x07;
3860 tempbh = ((tempbx & 0xFF00) >> 8) & 0x07;
3862 tempah = tempah << 3;
3864 xgifb_reg_set(pVBInfo->Part2Port, 0x02, tempah);
3867 XGI_GetLCDSync(&tempax, &tempbx, pVBInfo);
3869 tempax = pVBInfo->VT;
3870 tempbx = pVBInfo->LCDVRS;
3873 if (tempcx >= tempax)
3876 temp = tempbx & 0x00FF; /* RTVACTEE=lcdvrs */
3877 xgifb_reg_set(pVBInfo->Part2Port, 0x04, temp);
3878 temp = (tempbx & 0xFF00) >> 8;
3880 temp |= (tempcx & 0x000F);
3881 xgifb_reg_set(pVBInfo->Part2Port, 0x01, temp);
3883 tempax = pVBInfo->HT;
3884 tempbx = pVBInfo->LCDHDES;
3887 if (XGI_IsLCDDualLink(pVBInfo)) {
3888 tempax = tempax >> 1;
3889 tempbx = tempbx >> 1;
3890 tempcx = tempcx >> 1;
3893 if (pVBInfo->VBType & VB_SIS302LV)
3896 if (pVBInfo->VBType & VB_XGI301C) /* tap4 */
3901 if (tempcx >= tempax)
3904 temp = tempbx & 0x00FF;
3905 xgifb_reg_set(pVBInfo->Part2Port, 0x1F, temp); /* RHBLKE=lcdhdes */
3906 temp = ((tempbx & 0xFF00) >> 8) << 4;
3907 xgifb_reg_set(pVBInfo->Part2Port, 0x20, temp);
3908 temp = tempcx & 0x00FF;
3909 xgifb_reg_set(pVBInfo->Part2Port, 0x23, temp); /* RHEQPLE=lcdhdee */
3910 temp = (tempcx & 0xFF00) >> 8;
3911 xgifb_reg_set(pVBInfo->Part2Port, 0x25, temp);
3913 XGI_GetLCDSync(&tempax, &tempbx, pVBInfo);
3915 tempax = pVBInfo->HT;
3916 tempbx = pVBInfo->LCDHRS;
3917 if (XGI_IsLCDDualLink(pVBInfo)) {
3918 tempax = tempax >> 1;
3919 tempbx = tempbx >> 1;
3920 tempcx = tempcx >> 1;
3923 if (pVBInfo->VBType & VB_SIS302LV)
3928 if (tempcx >= tempax)
3931 temp = tempbx & 0x00FF; /* RHBURSTS=lcdhrs */
3932 xgifb_reg_set(pVBInfo->Part2Port, 0x1C, temp);
3934 temp = (tempbx & 0xFF00) >> 8;
3936 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1D, ~0x0F0, temp);
3937 temp = tempcx & 0x00FF; /* RHSYEXP2S=lcdhre */
3938 xgifb_reg_set(pVBInfo->Part2Port, 0x21, temp);
3940 if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) {
3941 if (pVBInfo->VGAVDE == 525) {
3942 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B
3943 | VB_SIS301LV | VB_SIS302LV
3949 xgifb_reg_set(pVBInfo->Part2Port, 0x2f, temp);
3950 xgifb_reg_set(pVBInfo->Part2Port, 0x30, 0xB3);
3953 if (pVBInfo->VGAVDE == 420) {
3954 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B
3955 | VB_SIS301LV | VB_SIS302LV
3960 xgifb_reg_set(pVBInfo->Part2Port, 0x2f, temp);
3965 /* --------------------------------------------------------------------- */
3966 /* Function : XGI_GetTap4Ptr */
3968 /* Output : di -> Tap4 Reg. Setting Pointer */
3970 /* --------------------------------------------------------------------- */
3971 static struct XGI301C_Tap4TimingStruct const
3972 *XGI_GetTap4Ptr(unsigned short tempcx, struct vb_device_info *pVBInfo)
3974 unsigned short tempax, tempbx, i;
3975 struct XGI301C_Tap4TimingStruct const *Tap4TimingPtr;
3978 tempax = pVBInfo->VGAHDE;
3979 tempbx = pVBInfo->HDE;
3981 tempax = pVBInfo->VGAVDE;
3982 tempbx = pVBInfo->VDE;
3985 if (tempax <= tempbx)
3986 return &xgifb_tap4_timing[0];
3988 Tap4TimingPtr = xgifb_ntsc_525_tap4_timing; /* NTSC */
3990 if (pVBInfo->TVInfo & TVSetPAL)
3991 Tap4TimingPtr = PALTap4Timing;
3993 if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) {
3994 if ((pVBInfo->TVInfo & TVSetYPbPr525i) ||
3995 (pVBInfo->TVInfo & TVSetYPbPr525p))
3996 Tap4TimingPtr = xgifb_ntsc_525_tap4_timing;
3997 if (pVBInfo->TVInfo & TVSetYPbPr750p)
3998 Tap4TimingPtr = YPbPr750pTap4Timing;
4001 if (pVBInfo->VBInfo & SetCRT2ToHiVision)
4002 Tap4TimingPtr = xgifb_tap4_timing;
4005 while (Tap4TimingPtr[i].DE != 0xFFFF) {
4006 if (Tap4TimingPtr[i].DE == tempax)
4010 return &Tap4TimingPtr[i];
4013 static void XGI_SetTap4Regs(struct vb_device_info *pVBInfo)
4015 unsigned short i, j;
4016 struct XGI301C_Tap4TimingStruct const *Tap4TimingPtr;
4018 if (!(pVBInfo->VBType & VB_XGI301C))
4021 Tap4TimingPtr = XGI_GetTap4Ptr(0, pVBInfo); /* Set Horizontal Scaling */
4022 for (i = 0x80, j = 0; i <= 0xBF; i++, j++)
4023 xgifb_reg_set(pVBInfo->Part2Port, i, Tap4TimingPtr->Reg[j]);
4025 if ((pVBInfo->VBInfo & SetCRT2ToTV) &&
4026 (!(pVBInfo->VBInfo & SetCRT2ToHiVision))) {
4027 /* Set Vertical Scaling */
4028 Tap4TimingPtr = XGI_GetTap4Ptr(1, pVBInfo);
4029 for (i = 0xC0, j = 0; i < 0xFF; i++, j++)
4030 xgifb_reg_set(pVBInfo->Part2Port,
4032 Tap4TimingPtr->Reg[j]);
4035 if ((pVBInfo->VBInfo & SetCRT2ToTV) &&
4036 (!(pVBInfo->VBInfo & SetCRT2ToHiVision)))
4037 /* Enable V.Scaling */
4038 xgifb_reg_and_or(pVBInfo->Part2Port, 0x4E, ~0x14, 0x04);
4040 /* Enable H.Scaling */
4041 xgifb_reg_and_or(pVBInfo->Part2Port, 0x4E, ~0x14, 0x10);
4044 static void XGI_SetGroup3(unsigned short ModeNo, unsigned short ModeIdIndex,
4045 struct vb_device_info *pVBInfo)
4048 unsigned char const *tempdi;
4049 unsigned short modeflag;
4051 /* si+Ext_ResInfo */
4052 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4054 xgifb_reg_set(pVBInfo->Part3Port, 0x00, 0x00);
4055 if (pVBInfo->TVInfo & TVSetPAL) {
4056 xgifb_reg_set(pVBInfo->Part3Port, 0x13, 0xFA);
4057 xgifb_reg_set(pVBInfo->Part3Port, 0x14, 0xC8);
4059 xgifb_reg_set(pVBInfo->Part3Port, 0x13, 0xF5);
4060 xgifb_reg_set(pVBInfo->Part3Port, 0x14, 0xB7);
4063 if (!(pVBInfo->VBInfo & SetCRT2ToTV))
4066 if (pVBInfo->TVInfo & TVSetPALM) {
4067 xgifb_reg_set(pVBInfo->Part3Port, 0x13, 0xFA);
4068 xgifb_reg_set(pVBInfo->Part3Port, 0x14, 0xC8);
4069 xgifb_reg_set(pVBInfo->Part3Port, 0x3D, 0xA8);
4072 if ((pVBInfo->VBInfo & SetCRT2ToHiVision) || (pVBInfo->VBInfo
4073 & SetCRT2ToYPbPr525750)) {
4074 if (pVBInfo->TVInfo & TVSetYPbPr525i)
4077 tempdi = XGI330_HiTVGroup3Data;
4078 if (pVBInfo->SetFlag & TVSimuMode) {
4079 tempdi = XGI330_HiTVGroup3Simu;
4080 if (!(modeflag & Charx8Dot))
4081 tempdi = XGI330_HiTVGroup3Text;
4084 if (pVBInfo->TVInfo & TVSetYPbPr525p)
4085 tempdi = XGI330_Ren525pGroup3;
4087 if (pVBInfo->TVInfo & TVSetYPbPr750p)
4088 tempdi = XGI330_Ren750pGroup3;
4090 for (i = 0; i <= 0x3E; i++)
4091 xgifb_reg_set(pVBInfo->Part3Port, i, tempdi[i]);
4093 if (pVBInfo->VBType & VB_XGI301C) { /* Marcovision */
4094 if (pVBInfo->TVInfo & TVSetYPbPr525p)
4095 xgifb_reg_set(pVBInfo->Part3Port, 0x28, 0x3f);
4099 } /* {end of XGI_SetGroup3} */
4101 static void XGI_SetGroup4(unsigned short ModeNo, unsigned short ModeIdIndex,
4102 unsigned short RefreshRateTableIndex,
4103 struct xgi_hw_device_info *HwDeviceExtension,
4104 struct vb_device_info *pVBInfo)
4106 unsigned short tempax, tempcx, tempbx, modeflag, temp, temp2;
4108 unsigned long tempebx, tempeax, templong;
4110 /* si+Ext_ResInfo */
4111 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4112 temp = pVBInfo->RVBHCFACT;
4113 xgifb_reg_set(pVBInfo->Part4Port, 0x13, temp);
4115 tempbx = pVBInfo->RVBHCMAX;
4116 temp = tempbx & 0x00FF;
4117 xgifb_reg_set(pVBInfo->Part4Port, 0x14, temp);
4118 temp2 = ((tempbx & 0xFF00) >> 8) << 7;
4119 tempcx = pVBInfo->VGAHT - 1;
4120 temp = tempcx & 0x00FF;
4121 xgifb_reg_set(pVBInfo->Part4Port, 0x16, temp);
4123 temp = ((tempcx & 0xFF00) >> 8) << 3;
4126 tempcx = pVBInfo->VGAVT - 1;
4127 if (!(pVBInfo->VBInfo & SetCRT2ToTV))
4130 temp = tempcx & 0x00FF;
4131 xgifb_reg_set(pVBInfo->Part4Port, 0x17, temp);
4132 temp = temp2 | ((tempcx & 0xFF00) >> 8);
4133 xgifb_reg_set(pVBInfo->Part4Port, 0x15, temp);
4134 xgifb_reg_or(pVBInfo->Part4Port, 0x0D, 0x08);
4135 tempcx = pVBInfo->VBInfo;
4136 tempbx = pVBInfo->VGAHDE;
4138 if (modeflag & HalfDCLK)
4139 tempbx = tempbx >> 1;
4141 if (XGI_IsLCDDualLink(pVBInfo))
4142 tempbx = tempbx >> 1;
4144 if (tempcx & SetCRT2ToHiVision) {
4150 } else if (tempcx & SetCRT2ToTV) {
4156 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
4163 if (pVBInfo->TVInfo & (TVSetYPbPr525p | TVSetYPbPr750p)) {
4165 if (pVBInfo->VGAHDE == 1280)
4167 if (pVBInfo->VGAHDE == 1024)
4170 xgifb_reg_and_or(pVBInfo->Part4Port, 0x0E, ~0xEF, temp);
4172 tempebx = pVBInfo->VDE;
4174 tempcx = pVBInfo->RVBHRS;
4175 temp = tempcx & 0x00FF;
4176 xgifb_reg_set(pVBInfo->Part4Port, 0x18, temp);
4178 tempeax = pVBInfo->VGAVDE;
4181 if (tempeax <= tempebx) {
4182 tempcx = (tempcx & (~0x4000));
4183 tempeax = pVBInfo->VGAVDE;
4188 templong = (tempeax * 256 * 1024) % tempebx;
4189 tempeax = (tempeax * 256 * 1024) / tempebx;
4195 temp = (unsigned short) (tempebx & 0x000000FF);
4196 xgifb_reg_set(pVBInfo->Part4Port, 0x1B, temp);
4198 temp = (unsigned short) ((tempebx & 0x0000FF00) >> 8);
4199 xgifb_reg_set(pVBInfo->Part4Port, 0x1A, temp);
4200 tempbx = (unsigned short) (tempebx >> 16);
4201 temp = tempbx & 0x00FF;
4203 temp |= ((tempcx & 0xFF00) >> 8);
4204 xgifb_reg_set(pVBInfo->Part4Port, 0x19, temp);
4207 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
4208 | VB_SIS302LV | VB_XGI301C)) {
4210 xgifb_reg_set(pVBInfo->Part4Port, 0x1C, temp);
4211 tempax = pVBInfo->VGAHDE;
4212 if (modeflag & HalfDCLK)
4213 tempax = tempax >> 1;
4215 if (XGI_IsLCDDualLink(pVBInfo))
4216 tempax = tempax >> 1;
4218 if (pVBInfo->VBInfo & SetCRT2ToLCD) {
4221 } else if (pVBInfo->VGAHDE > 800) {
4222 if (pVBInfo->VGAHDE == 1024)
4223 tempax = (tempax * 25 / 32) - 1;
4225 tempax = (tempax * 20 / 32) - 1;
4229 temp = (tempax & 0xFF00) >> 8;
4230 temp = ((temp & 0x0003) << 4);
4231 xgifb_reg_set(pVBInfo->Part4Port, 0x1E, temp);
4232 temp = (tempax & 0x00FF);
4233 xgifb_reg_set(pVBInfo->Part4Port, 0x1D, temp);
4235 if (pVBInfo->VBInfo & (SetCRT2ToTV | SetCRT2ToHiVision)) {
4236 if (pVBInfo->VGAHDE > 800)
4237 xgifb_reg_or(pVBInfo->Part4Port, 0x1E, 0x08);
4242 if (pVBInfo->VBInfo & SetCRT2ToTV) {
4243 if (!(pVBInfo->TVInfo & (NTSC1024x768
4244 | TVSetYPbPr525p | TVSetYPbPr750p
4245 | TVSetHiVision))) {
4247 if ((pVBInfo->VBInfo & SetInSlaveMode)
4248 && (!(pVBInfo->TVInfo
4254 xgifb_reg_and_or(pVBInfo->Part4Port, 0x1F, 0x00C0, temp);
4255 tempbx = pVBInfo->HT;
4256 if (XGI_IsLCDDualLink(pVBInfo))
4257 tempbx = tempbx >> 1;
4258 tempbx = (tempbx >> 1) - 2;
4259 temp = ((tempbx & 0x0700) >> 8) << 3;
4260 xgifb_reg_and_or(pVBInfo->Part4Port, 0x21, 0x00C0, temp);
4261 temp = tempbx & 0x00FF;
4262 xgifb_reg_set(pVBInfo->Part4Port, 0x22, temp);
4266 XGI_SetCRT2VCLK(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
4269 static void XGINew_EnableCRT2(struct vb_device_info *pVBInfo)
4271 xgifb_reg_and_or(pVBInfo->P3c4, 0x1E, 0xFF, 0x20);
4274 static void XGI_SetGroup5(unsigned short ModeNo, unsigned short ModeIdIndex,
4275 struct vb_device_info *pVBInfo)
4277 if (pVBInfo->ModeType == ModeVGA) {
4278 if (!(pVBInfo->VBInfo & (SetInSlaveMode | LoadDACFlag
4279 | DisableCRT2Display))) {
4280 XGINew_EnableCRT2(pVBInfo);
4286 static void XGI_DisableGatingCRT(struct xgi_hw_device_info *HwDeviceExtension,
4287 struct vb_device_info *pVBInfo)
4290 xgifb_reg_and_or(pVBInfo->P3d4, 0x63, 0xBF, 0x00);
4293 static unsigned char XGI_XG21CheckLVDSMode(struct xgifb_video_info *xgifb_info,
4294 unsigned short ModeNo, unsigned short ModeIdIndex,
4295 struct vb_device_info *pVBInfo)
4297 unsigned short xres, yres, colordepth, modeflag, resindex;
4299 resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
4300 xres = XGI330_ModeResInfo[resindex].HTotal; /* xres->ax */
4301 yres = XGI330_ModeResInfo[resindex].VTotal; /* yres->bx */
4302 /* si+St_ModeFlag */
4303 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4305 if (!(modeflag & Charx8Dot)) {
4310 if ((ModeNo > 0x13) && (modeflag & HalfDCLK))
4313 if ((ModeNo > 0x13) && (modeflag & DoubleScanMode))
4316 if (xres > xgifb_info->lvds_data.LVDSHDE)
4319 if (yres > xgifb_info->lvds_data.LVDSVDE)
4322 if (xres != xgifb_info->lvds_data.LVDSHDE ||
4323 yres != xgifb_info->lvds_data.LVDSVDE) {
4324 colordepth = XGI_GetColorDepth(ModeNo, ModeIdIndex, pVBInfo);
4331 static void xgifb_set_lvds(struct xgifb_video_info *xgifb_info,
4333 unsigned short ModeNo,
4334 unsigned short ModeIdIndex,
4335 struct vb_device_info *pVBInfo)
4337 unsigned char temp, Miscdata;
4338 unsigned short xres, yres, modeflag, resindex;
4339 unsigned short LVDSHT, LVDSHBS, LVDSHRS, LVDSHRE, LVDSHBE;
4340 unsigned short LVDSVT, LVDSVBS, LVDSVRS, LVDSVRE, LVDSVBE;
4341 unsigned short value;
4343 temp = (unsigned char) ((xgifb_info->lvds_data.LVDS_Capability &
4344 (LCDPolarity << 8)) >> 8);
4345 temp &= LCDPolarity;
4346 Miscdata = inb(pVBInfo->P3cc);
4348 outb((Miscdata & 0x3F) | temp, pVBInfo->P3c2);
4350 temp = xgifb_info->lvds_data.LVDS_Capability & LCDPolarity;
4351 /* SR35[7] FP VSync polarity */
4352 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x80, temp & 0x80);
4353 /* SR30[5] FP HSync polarity */
4354 xgifb_reg_and_or(pVBInfo->P3c4, 0x30, ~0x20, (temp & 0x40) >> 1);
4356 if (chip_id == XG27)
4357 XGI_SetXG27FPBits(pVBInfo);
4359 XGI_SetXG21FPBits(pVBInfo);
4361 resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO;
4362 xres = XGI330_ModeResInfo[resindex].HTotal; /* xres->ax */
4363 yres = XGI330_ModeResInfo[resindex].VTotal; /* yres->bx */
4364 /* si+St_ModeFlag */
4365 modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4367 if (!(modeflag & Charx8Dot))
4368 xres = xres * 8 / 9;
4370 LVDSHT = xgifb_info->lvds_data.LVDSHT;
4372 LVDSHBS = xres + (xgifb_info->lvds_data.LVDSHDE - xres) / 2;
4374 if (LVDSHBS > LVDSHT)
4377 LVDSHRS = LVDSHBS + xgifb_info->lvds_data.LVDSHFP;
4378 if (LVDSHRS > LVDSHT)
4381 LVDSHRE = LVDSHRS + xgifb_info->lvds_data.LVDSHSYNC;
4382 if (LVDSHRE > LVDSHT)
4385 LVDSHBE = LVDSHBS + LVDSHT - xgifb_info->lvds_data.LVDSHDE;
4387 LVDSVT = xgifb_info->lvds_data.LVDSVT;
4389 LVDSVBS = yres + (xgifb_info->lvds_data.LVDSVDE - yres) / 2;
4390 if (modeflag & DoubleScanMode)
4391 LVDSVBS += yres / 2;
4393 if (LVDSVBS > LVDSVT)
4396 LVDSVRS = LVDSVBS + xgifb_info->lvds_data.LVDSVFP;
4397 if (LVDSVRS > LVDSVT)
4400 LVDSVRE = LVDSVRS + xgifb_info->lvds_data.LVDSVSYNC;
4401 if (LVDSVRE > LVDSVT)
4404 LVDSVBE = LVDSVBS + LVDSVT - xgifb_info->lvds_data.LVDSVDE;
4406 temp = xgifb_reg_get(pVBInfo->P3d4, 0x11);
4407 xgifb_reg_set(pVBInfo->P3d4, 0x11, temp & 0x7f); /* Unlock CRTC */
4409 if (!(modeflag & Charx8Dot))
4410 xgifb_reg_or(pVBInfo->P3c4, 0x1, 0x1);
4412 /* HT SR0B[1:0] CR00 */
4413 value = (LVDSHT >> 3) - 5;
4414 xgifb_reg_and_or(pVBInfo->P3c4, 0x0B, ~0x03, (value & 0x300) >> 8);
4415 xgifb_reg_set(pVBInfo->P3d4, 0x0, (value & 0xFF));
4417 /* HBS SR0B[5:4] CR02 */
4418 value = (LVDSHBS >> 3) - 1;
4419 xgifb_reg_and_or(pVBInfo->P3c4, 0x0B, ~0x30, (value & 0x300) >> 4);
4420 xgifb_reg_set(pVBInfo->P3d4, 0x2, (value & 0xFF));
4422 /* HBE SR0C[1:0] CR05[7] CR03[4:0] */
4423 value = (LVDSHBE >> 3) - 1;
4424 xgifb_reg_and_or(pVBInfo->P3c4, 0x0C, ~0x03, (value & 0xC0) >> 6);
4425 xgifb_reg_and_or(pVBInfo->P3d4, 0x05, ~0x80, (value & 0x20) << 2);
4426 xgifb_reg_and_or(pVBInfo->P3d4, 0x03, ~0x1F, value & 0x1F);
4428 /* HRS SR0B[7:6] CR04 */
4429 value = (LVDSHRS >> 3) + 2;
4430 xgifb_reg_and_or(pVBInfo->P3c4, 0x0B, ~0xC0, (value & 0x300) >> 2);
4431 xgifb_reg_set(pVBInfo->P3d4, 0x4, (value & 0xFF));
4433 /* Panel HRS SR2F[1:0] SR2E[7:0] */
4435 xgifb_reg_and_or(pVBInfo->P3c4, 0x2F, ~0x03, (value & 0x300) >> 8);
4436 xgifb_reg_set(pVBInfo->P3c4, 0x2E, (value & 0xFF));
4438 /* HRE SR0C[2] CR05[4:0] */
4439 value = (LVDSHRE >> 3) + 2;
4440 xgifb_reg_and_or(pVBInfo->P3c4, 0x0C, ~0x04, (value & 0x20) >> 3);
4441 xgifb_reg_and_or(pVBInfo->P3d4, 0x05, ~0x1F, value & 0x1F);
4443 /* Panel HRE SR2F[7:2] */
4445 xgifb_reg_and_or(pVBInfo->P3c4, 0x2F, ~0xFC, value << 2);
4447 /* VT SR0A[0] CR07[5][0] CR06 */
4449 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x01, (value & 0x400) >> 10);
4450 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x20, (value & 0x200) >> 4);
4451 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x01, (value & 0x100) >> 8);
4452 xgifb_reg_set(pVBInfo->P3d4, 0x06, (value & 0xFF));
4454 /* VBS SR0A[2] CR09[5] CR07[3] CR15 */
4455 value = LVDSVBS - 1;
4456 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x04, (value & 0x400) >> 8);
4457 xgifb_reg_and_or(pVBInfo->P3d4, 0x09, ~0x20, (value & 0x200) >> 4);
4458 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x08, (value & 0x100) >> 5);
4459 xgifb_reg_set(pVBInfo->P3d4, 0x15, (value & 0xFF));
4461 /* VBE SR0A[4] CR16 */
4462 value = LVDSVBE - 1;
4463 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x10, (value & 0x100) >> 4);
4464 xgifb_reg_set(pVBInfo->P3d4, 0x16, (value & 0xFF));
4466 /* VRS SR0A[3] CR7[7][2] CR10 */
4467 value = LVDSVRS - 1;
4468 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x08, (value & 0x400) >> 7);
4469 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x80, (value & 0x200) >> 2);
4470 xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x04, (value & 0x100) >> 6);
4471 xgifb_reg_set(pVBInfo->P3d4, 0x10, (value & 0xFF));
4473 if (chip_id == XG27) {
4474 /* Panel VRS SR35[2:0] SR34[7:0] */
4475 xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x07,
4476 (value & 0x700) >> 8);
4477 xgifb_reg_set(pVBInfo->P3c4, 0x34, value & 0xFF);
4479 /* Panel VRS SR3F[1:0] SR34[7:0] SR33[0] */
4480 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0x03,
4481 (value & 0x600) >> 9);
4482 xgifb_reg_set(pVBInfo->P3c4, 0x34, (value >> 1) & 0xFF);
4483 xgifb_reg_and_or(pVBInfo->P3d4, 0x33, ~0x01, value & 0x01);
4486 /* VRE SR0A[5] CR11[3:0] */
4487 value = LVDSVRE - 1;
4488 xgifb_reg_and_or(pVBInfo->P3c4, 0x0A, ~0x20, (value & 0x10) << 1);
4489 xgifb_reg_and_or(pVBInfo->P3d4, 0x11, ~0x0F, value & 0x0F);
4491 /* Panel VRE SR3F[7:2] */
4492 if (chip_id == XG27)
4493 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC,
4494 (value << 2) & 0xFC);
4496 /* SR3F[7] has to be 0, h/w bug */
4497 xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC,
4498 (value << 2) & 0x7C);
4500 for (temp = 0, value = 0; temp < 3; temp++) {
4502 xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, value);
4503 xgifb_reg_set(pVBInfo->P3c4,
4504 0x2B, xgifb_info->lvds_data.VCLKData1);
4505 xgifb_reg_set(pVBInfo->P3c4,
4506 0x2C, xgifb_info->lvds_data.VCLKData2);
4510 if (!(modeflag & Charx8Dot)) {
4511 inb(pVBInfo->P3da); /* reset 3da */
4512 outb(0x13, pVBInfo->P3c0); /* set index */
4513 /* set data, panning = 0, shift left 1 dot*/
4514 outb(0x00, pVBInfo->P3c0);
4516 inb(pVBInfo->P3da); /* Enable Attribute */
4517 outb(0x20, pVBInfo->P3c0);
4519 inb(pVBInfo->P3da); /* reset 3da */
4524 /* --------------------------------------------------------------------- */
4525 /* Function : XGI_IsLCDON */
4527 /* Output : 0 : Skip PSC Control */
4528 /* 1: Disable PSC */
4530 /* --------------------------------------------------------------------- */
4531 static unsigned char XGI_IsLCDON(struct vb_device_info *pVBInfo)
4533 unsigned short tempax;
4535 tempax = pVBInfo->VBInfo;
4536 if (tempax & SetCRT2ToDualEdge)
4538 else if (tempax & (DisableCRT2Display | SwitchCRT2 | SetSimuScanMode))
4544 /* --------------------------------------------------------------------- */
4545 /* Function : XGI_EnableChISLCD */
4547 /* Output : 0 -> Not LCD mode */
4548 /* Description : if bool enable = true -> enable, else disable */
4549 /* --------------------------------------------------------------------- */
4550 static unsigned char XGI_EnableChISLCD(struct vb_device_info *pVBInfo,
4553 unsigned short tempbx, tempah;
4556 tempbx = pVBInfo->SetFlag & EnableChA;
4558 tempbx = pVBInfo->SetFlag & DisableChA;
4560 tempah = ~((unsigned short) xgifb_reg_get(pVBInfo->Part1Port, 0x2E));
4562 if (tempbx & (EnableChA | DisableChA)) {
4563 if (!(tempah & 0x08)) /* Chk LCDA Mode */
4570 static void XGI_DisableBridge(struct xgifb_video_info *xgifb_info,
4571 struct xgi_hw_device_info *HwDeviceExtension,
4572 struct vb_device_info *pVBInfo)
4574 unsigned short tempah = 0;
4576 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
4577 | VB_SIS302LV | VB_XGI301C)) {
4579 if (!(pVBInfo->VBInfo &
4580 (DisableCRT2Display | SetSimuScanMode))) {
4581 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) {
4582 if (pVBInfo->VBInfo & SetCRT2ToDualEdge) {
4583 tempah = 0x7F; /* Disable Channel A */
4584 if (!(pVBInfo->VBInfo &
4586 /* Disable Channel B */
4589 if (pVBInfo->SetFlag & DisableChA)
4590 /* Force to disable Channel B */
4596 /* disable part4_1f */
4597 xgifb_reg_and(pVBInfo->Part4Port, 0x1F, tempah);
4599 if (pVBInfo->VBType & (VB_SIS302LV | VB_XGI301C)) {
4600 if (((pVBInfo->VBInfo &
4601 (SetCRT2ToLCD | XGI_SetCRT2ToLCDA))) ||
4602 (XGI_EnableChISLCD(pVBInfo, false)) ||
4603 (XGI_IsLCDON(pVBInfo)))
4604 /* LVDS Driver power down */
4605 xgifb_reg_or(pVBInfo->Part4Port, 0x30, 0x80);
4608 if ((pVBInfo->SetFlag & DisableChA) || (pVBInfo->VBInfo
4609 & (DisableCRT2Display | XGI_SetCRT2ToLCDA
4610 | SetSimuScanMode)))
4611 XGI_DisplayOff(xgifb_info, HwDeviceExtension, pVBInfo);
4613 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) {
4614 if ((pVBInfo->SetFlag & DisableChA) || (pVBInfo->VBInfo
4615 & XGI_SetCRT2ToLCDA))
4617 xgifb_reg_and(pVBInfo->Part1Port, 0x1e, 0xdf);
4620 /* disable TV as primary VGA swap */
4621 xgifb_reg_and(pVBInfo->P3c4, 0x32, 0xdf);
4623 if ((pVBInfo->VBInfo & (SetSimuScanMode | SetCRT2ToDualEdge)))
4624 xgifb_reg_and(pVBInfo->Part2Port, 0x00, 0xdf);
4626 if ((pVBInfo->VBInfo &
4627 (DisableCRT2Display | SetSimuScanMode)) ||
4628 ((!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) &&
4630 (SetCRT2ToRAMDAC | SetCRT2ToLCD | SetCRT2ToTV))))
4631 xgifb_reg_or(pVBInfo->Part1Port, 0x00, 0x80);
4633 if ((pVBInfo->VBInfo &
4634 (DisableCRT2Display | SetSimuScanMode)) ||
4635 (!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) ||
4637 (SetCRT2ToRAMDAC | SetCRT2ToLCD | SetCRT2ToTV))) {
4638 /* save Part1 index 0 */
4639 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x00);
4640 /* BTDAC = 1, avoid VB reset */
4641 xgifb_reg_or(pVBInfo->Part1Port, 0x00, 0x10);
4643 xgifb_reg_and(pVBInfo->Part1Port, 0x1E, 0xDF);
4644 /* restore Part1 index 0 */
4645 xgifb_reg_set(pVBInfo->Part1Port, 0x00, tempah);
4647 } else { /* {301} */
4648 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
4649 xgifb_reg_or(pVBInfo->Part1Port, 0x00, 0x80);
4651 xgifb_reg_and(pVBInfo->Part1Port, 0x1E, 0xDF);
4652 /* Disable TV asPrimary VGA swap */
4653 xgifb_reg_and(pVBInfo->P3c4, 0x32, 0xDF);
4656 if (pVBInfo->VBInfo & (DisableCRT2Display | XGI_SetCRT2ToLCDA
4658 XGI_DisplayOff(xgifb_info, HwDeviceExtension, pVBInfo);
4662 /* --------------------------------------------------------------------- */
4663 /* Function : XGI_GetTVPtrIndex */
4666 /* Description : bx 0 : ExtNTSC */
4678 /* --------------------------------------------------------------------- */
4679 static unsigned short XGI_GetTVPtrIndex(struct vb_device_info *pVBInfo)
4681 unsigned short tempbx = 0;
4683 if (pVBInfo->TVInfo & TVSetPAL)
4685 if (pVBInfo->TVInfo & TVSetHiVision)
4687 if (pVBInfo->TVInfo & TVSetYPbPr525i)
4689 if (pVBInfo->TVInfo & TVSetYPbPr525p)
4691 if (pVBInfo->TVInfo & TVSetYPbPr750p)
4693 if (pVBInfo->TVInfo & TVSimuMode)
4699 /* --------------------------------------------------------------------- */
4700 /* Function : XGI_GetTVPtrIndex2 */
4702 /* Output : bx 0 : NTSC */
4706 /* 4 : NTSC1024x768 */
4707 /* 5 : PAL-M 1024x768 */
4709 /* cl 0 : YFilter1 */
4712 /* 1 : 301B/302B/301LV/302LV */
4714 /* --------------------------------------------------------------------- */
4715 static void XGI_GetTVPtrIndex2(unsigned short *tempbx, unsigned char *tempcl,
4716 unsigned char *tempch, struct vb_device_info *pVBInfo)
4722 if (pVBInfo->TVInfo & TVSetPAL)
4725 if (pVBInfo->TVInfo & TVSetPALM)
4728 if (pVBInfo->TVInfo & TVSetPALN)
4731 if (pVBInfo->TVInfo & NTSC1024x768) {
4733 if (pVBInfo->TVInfo & TVSetPALM)
4737 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
4738 | VB_SIS302LV | VB_XGI301C)) {
4739 if ((!(pVBInfo->VBInfo & SetInSlaveMode)) || (pVBInfo->TVInfo
4746 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
4747 | VB_SIS302LV | VB_XGI301C))
4751 static void XGI_SetDelayComp(struct vb_device_info *pVBInfo)
4753 unsigned char tempah, tempbl, tempbh;
4755 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
4756 | VB_SIS302LV | VB_XGI301C)) {
4757 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA
4758 | SetCRT2ToTV | SetCRT2ToRAMDAC)) {
4760 tempbl = XGI301TVDelay;
4762 if (pVBInfo->VBInfo & SetCRT2ToDualEdge)
4763 tempbl = tempbl >> 4;
4764 if (pVBInfo->VBInfo &
4765 (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) {
4766 tempbh = XGI301LCDDelay;
4768 if (!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA))
4774 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x2D);
4776 if (pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToLCD
4777 | SetCRT2ToTV)) { /* Channel B */
4782 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) {
4787 xgifb_reg_set(pVBInfo->Part1Port, 0x2D, tempah);
4792 static void XGI_SetLCDCap_A(unsigned short tempcx,
4793 struct vb_device_info *pVBInfo)
4795 unsigned short temp;
4797 temp = xgifb_reg_get(pVBInfo->P3d4, 0x37);
4799 if (temp & LCDRGB18Bit) {
4800 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, 0x0F,
4802 (unsigned short) (0x20 | (tempcx & 0x00C0)));
4803 xgifb_reg_and_or(pVBInfo->Part1Port, 0x1A, 0x7F, 0x80);
4805 xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, 0x0F,
4806 (unsigned short) (0x30 | (tempcx & 0x00C0)));
4807 xgifb_reg_and_or(pVBInfo->Part1Port, 0x1A, 0x7F, 0x00);
4811 /* --------------------------------------------------------------------- */
4812 /* Function : XGI_SetLCDCap_B */
4813 /* Input : cx -> LCD Capability */
4816 /* --------------------------------------------------------------------- */
4817 static void XGI_SetLCDCap_B(unsigned short tempcx,
4818 struct vb_device_info *pVBInfo)
4820 if (tempcx & EnableLCD24bpp) /* 24bits */
4821 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1A, 0xE0,
4822 (unsigned short) (((tempcx & 0x00ff) >> 6)
4825 xgifb_reg_and_or(pVBInfo->Part2Port, 0x1A, 0xE0,
4826 (unsigned short) (((tempcx & 0x00ff) >> 6)
4827 | 0x18)); /* Enable Dither */
4830 static void XGI_LongWait(struct vb_device_info *pVBInfo)
4834 i = xgifb_reg_get(pVBInfo->P3c4, 0x1F);
4837 for (i = 0; i < 0xFFFF; i++) {
4838 if (!(inb(pVBInfo->P3da) & 0x08))
4842 for (i = 0; i < 0xFFFF; i++) {
4843 if ((inb(pVBInfo->P3da) & 0x08))
4849 static void SetSpectrum(struct vb_device_info *pVBInfo)
4851 unsigned short index;
4853 index = XGI_GetLCDCapPtr(pVBInfo);
4855 /* disable down spectrum D[4] */
4856 xgifb_reg_and(pVBInfo->Part4Port, 0x30, 0x8F);
4857 XGI_LongWait(pVBInfo);
4858 xgifb_reg_or(pVBInfo->Part4Port, 0x30, 0x20); /* reset spectrum */
4859 XGI_LongWait(pVBInfo);
4861 xgifb_reg_set(pVBInfo->Part4Port, 0x31,
4862 pVBInfo->LCDCapList[index].Spectrum_31);
4863 xgifb_reg_set(pVBInfo->Part4Port, 0x32,
4864 pVBInfo->LCDCapList[index].Spectrum_32);
4865 xgifb_reg_set(pVBInfo->Part4Port, 0x33,
4866 pVBInfo->LCDCapList[index].Spectrum_33);
4867 xgifb_reg_set(pVBInfo->Part4Port, 0x34,
4868 pVBInfo->LCDCapList[index].Spectrum_34);
4869 XGI_LongWait(pVBInfo);
4870 xgifb_reg_or(pVBInfo->Part4Port, 0x30, 0x40); /* enable spectrum */
4873 static void XGI_SetLCDCap(struct vb_device_info *pVBInfo)
4875 unsigned short tempcx;
4877 tempcx = pVBInfo->LCDCapList[XGI_GetLCDCapPtr(pVBInfo)].LCD_Capability;
4879 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV |
4880 VB_SIS302LV | VB_XGI301C)) {
4881 if (pVBInfo->VBType &
4882 (VB_SIS301LV | VB_SIS302LV | VB_XGI301C)) {
4883 /* Set 301LV Capability */
4884 xgifb_reg_set(pVBInfo->Part4Port, 0x24,
4885 (unsigned char) (tempcx & 0x1F));
4888 xgifb_reg_and_or(pVBInfo->Part4Port, 0x0D,
4889 ~((EnableVBCLKDRVLOW | EnablePLLSPLOW) >> 8),
4890 (unsigned short) ((tempcx & (EnableVBCLKDRVLOW
4891 | EnablePLLSPLOW)) >> 8));
4893 if (pVBInfo->VBInfo & SetCRT2ToLCD)
4894 XGI_SetLCDCap_B(tempcx, pVBInfo);
4895 else if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)
4896 XGI_SetLCDCap_A(tempcx, pVBInfo);
4898 if (pVBInfo->VBType & (VB_SIS302LV | VB_XGI301C)) {
4899 if (tempcx & EnableSpectrum)
4900 SetSpectrum(pVBInfo);
4904 XGI_SetLCDCap_A(tempcx, pVBInfo);
4908 /* --------------------------------------------------------------------- */
4909 /* Function : XGI_SetAntiFlicker */
4912 /* Description : Set TV Customized Param. */
4913 /* --------------------------------------------------------------------- */
4914 static void XGI_SetAntiFlicker(unsigned short ModeNo,
4915 unsigned short ModeIdIndex,
4916 struct vb_device_info *pVBInfo)
4918 unsigned short tempbx;
4920 unsigned char tempah;
4922 if (pVBInfo->TVInfo & (TVSetYPbPr525p | TVSetYPbPr750p))
4925 tempbx = XGI_GetTVPtrIndex(pVBInfo);
4927 tempah = TVAntiFlickList[tempbx];
4928 tempah = tempah << 4;
4930 xgifb_reg_and_or(pVBInfo->Part2Port, 0x0A, 0x8F, tempah);
4933 static void XGI_SetEdgeEnhance(unsigned short ModeNo,
4934 unsigned short ModeIdIndex,
4935 struct vb_device_info *pVBInfo)
4937 unsigned short tempbx;
4939 unsigned char tempah;
4941 tempbx = XGI_GetTVPtrIndex(pVBInfo);
4943 tempah = TVEdgeList[tempbx];
4944 tempah = tempah << 5;
4946 xgifb_reg_and_or(pVBInfo->Part2Port, 0x3A, 0x1F, tempah);
4949 static void XGI_SetPhaseIncr(struct vb_device_info *pVBInfo)
4951 unsigned short tempbx;
4953 unsigned char tempcl, tempch;
4955 unsigned long tempData;
4957 XGI_GetTVPtrIndex2(&tempbx, &tempcl, &tempch, pVBInfo); /* bx, cl, ch */
4958 tempData = TVPhaseList[tempbx];
4960 xgifb_reg_set(pVBInfo->Part2Port, 0x31, (unsigned short) (tempData
4962 xgifb_reg_set(pVBInfo->Part2Port, 0x32, (unsigned short) ((tempData
4963 & 0x0000FF00) >> 8));
4964 xgifb_reg_set(pVBInfo->Part2Port, 0x33, (unsigned short) ((tempData
4965 & 0x00FF0000) >> 16));
4966 xgifb_reg_set(pVBInfo->Part2Port, 0x34, (unsigned short) ((tempData
4967 & 0xFF000000) >> 24));
4970 static void XGI_SetYFilter(unsigned short ModeNo, unsigned short ModeIdIndex,
4971 struct vb_device_info *pVBInfo)
4973 unsigned short tempbx, index;
4974 unsigned char const *filterPtr;
4975 unsigned char tempcl, tempch, tempal;
4977 XGI_GetTVPtrIndex2(&tempbx, &tempcl, &tempch, pVBInfo); /* bx, cl, ch */
4982 filterPtr = NTSCYFilter1;
4986 filterPtr = PALYFilter1;
4993 filterPtr = xgifb_palmn_yfilter1;
5001 filterPtr = xgifb_yfilter2;
5008 tempal = XGI330_EModeIDTable[ModeIdIndex].VB_ExtTVYFilterIndex;
5014 if ((tempcl == 0) && (tempch == 1)) {
5015 xgifb_reg_set(pVBInfo->Part2Port, 0x35, 0);
5016 xgifb_reg_set(pVBInfo->Part2Port, 0x36, 0);
5017 xgifb_reg_set(pVBInfo->Part2Port, 0x37, 0);
5018 xgifb_reg_set(pVBInfo->Part2Port, 0x38, filterPtr[index++]);
5020 xgifb_reg_set(pVBInfo->Part2Port, 0x35, filterPtr[index++]);
5021 xgifb_reg_set(pVBInfo->Part2Port, 0x36, filterPtr[index++]);
5022 xgifb_reg_set(pVBInfo->Part2Port, 0x37, filterPtr[index++]);
5023 xgifb_reg_set(pVBInfo->Part2Port, 0x38, filterPtr[index++]);
5026 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
5027 | VB_SIS302LV | VB_XGI301C)) {
5028 xgifb_reg_set(pVBInfo->Part2Port, 0x48, filterPtr[index++]);
5029 xgifb_reg_set(pVBInfo->Part2Port, 0x49, filterPtr[index++]);
5030 xgifb_reg_set(pVBInfo->Part2Port, 0x4A, filterPtr[index++]);
5034 /* --------------------------------------------------------------------- */
5035 /* Function : XGI_OEM310Setting */
5038 /* Description : Customized Param. for 301 */
5039 /* --------------------------------------------------------------------- */
5040 static void XGI_OEM310Setting(unsigned short ModeNo,
5041 unsigned short ModeIdIndex,
5042 struct vb_device_info *pVBInfo)
5044 XGI_SetDelayComp(pVBInfo);
5046 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA))
5047 XGI_SetLCDCap(pVBInfo);
5049 if (pVBInfo->VBInfo & SetCRT2ToTV) {
5050 XGI_SetPhaseIncr(pVBInfo);
5051 XGI_SetYFilter(ModeNo, ModeIdIndex, pVBInfo);
5052 XGI_SetAntiFlicker(ModeNo, ModeIdIndex, pVBInfo);
5054 if (pVBInfo->VBType & VB_SIS301)
5055 XGI_SetEdgeEnhance(ModeNo, ModeIdIndex, pVBInfo);
5059 /* --------------------------------------------------------------------- */
5060 /* Function : XGI_SetCRT2ModeRegs */
5063 /* Description : Origin code for crt2group */
5064 /* --------------------------------------------------------------------- */
5065 static void XGI_SetCRT2ModeRegs(unsigned short ModeNo,
5066 struct xgi_hw_device_info *HwDeviceExtension,
5067 struct vb_device_info *pVBInfo)
5069 unsigned short tempbl;
5072 unsigned char tempah;
5075 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
5076 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x00);
5077 tempah &= ~0x10; /* BTRAMDAC */
5078 tempah |= 0x40; /* BTRAM */
5080 if (pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToTV
5082 tempah = 0x40; /* BTDRAM */
5083 tempcl = pVBInfo->ModeType;
5087 tempah = (0x008 >> tempcl);
5092 if (pVBInfo->VBInfo & SetInSlaveMode)
5093 tempah ^= 0x50; /* BTDAC */
5097 xgifb_reg_set(pVBInfo->Part1Port, 0x00, tempah);
5101 if (pVBInfo->VBInfo & DisableCRT2Display)
5107 if (!(pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToTV |
5108 SetCRT2ToLCD | XGI_SetCRT2ToLCDA)))
5111 if ((pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) &&
5112 (!(pVBInfo->VBInfo & SetSimuScanMode))) {
5118 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) {
5123 if (!(pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToTV | SetCRT2ToLCD)))
5129 if (!(pVBInfo->VBInfo & SetInSlaveMode))
5132 if (!(pVBInfo->VBInfo & SetCRT2ToRAMDAC)) {
5133 tempah = tempah ^ 0x05;
5134 if (!(pVBInfo->VBInfo & SetCRT2ToLCD))
5135 tempah = tempah ^ 0x01;
5138 if (!(pVBInfo->VBInfo & SetCRT2ToDualEdge))
5142 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2e, tempbl, tempah);
5144 if (pVBInfo->VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToTV | SetCRT2ToLCD
5145 | XGI_SetCRT2ToLCDA)) {
5147 if ((pVBInfo->ModeType == ModeVGA) && (!(pVBInfo->VBInfo
5148 & SetInSlaveMode))) {
5153 if (pVBInfo->VBInfo & SetCRT2ToTV) {
5155 if (pVBInfo->VBInfo & DriverMode)
5156 tempah = tempah ^ 0x20;
5159 xgifb_reg_and_or(pVBInfo->Part4Port, 0x0D, ~0x0BF, tempah);
5162 if (pVBInfo->LCDInfo & SetLCDDualLink)
5165 if (pVBInfo->VBInfo & SetCRT2ToTV) {
5166 if (pVBInfo->TVInfo & RPLLDIV2XO)
5170 if ((pVBInfo->LCDResInfo == Panel_1280x1024)
5171 || (pVBInfo->LCDResInfo == Panel_1280x1024x75))
5174 if (pVBInfo->LCDResInfo == Panel_1280x960)
5177 xgifb_reg_set(pVBInfo->Part4Port, 0x0C, tempah);
5180 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
5181 | VB_SIS302LV | VB_XGI301C)) {
5185 if (pVBInfo->VBInfo & SetCRT2ToDualEdge) {
5187 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)
5188 tempah |= 0x04; /* shampoo 0129 */
5191 xgifb_reg_and_or(pVBInfo->Part1Port, 0x13, tempbl, tempah);
5194 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
5195 if (pVBInfo->VBInfo & SetCRT2ToDualEdge)
5199 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2c, tempbl, tempah);
5203 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
5204 if (pVBInfo->VBInfo & SetCRT2ToDualEdge)
5207 xgifb_reg_and_or(pVBInfo->Part4Port, 0x21, tempbl, tempah);
5212 if (!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) {
5214 if (!(pVBInfo->VBInfo & SetCRT2ToDualEdge))
5218 xgifb_reg_and_or(pVBInfo->Part4Port, 0x23, tempbl, tempah);
5220 if (pVBInfo->VBType & (VB_SIS302LV | VB_XGI301C)) {
5221 if (pVBInfo->LCDInfo & SetLCDDualLink) {
5222 xgifb_reg_or(pVBInfo->Part4Port, 0x27, 0x20);
5223 xgifb_reg_or(pVBInfo->Part4Port, 0x34, 0x10);
5229 void XGI_UnLockCRT2(struct xgi_hw_device_info *HwDeviceExtension,
5230 struct vb_device_info *pVBInfo)
5233 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2f, 0xFF, 0x01);
5237 void XGI_LockCRT2(struct xgi_hw_device_info *HwDeviceExtension,
5238 struct vb_device_info *pVBInfo)
5241 xgifb_reg_and_or(pVBInfo->Part1Port, 0x2F, 0xFE, 0x00);
5245 unsigned short XGI_GetRatePtrCRT2(struct xgi_hw_device_info *pXGIHWDE,
5246 unsigned short ModeNo, unsigned short ModeIdIndex,
5247 struct vb_device_info *pVBInfo)
5249 const u8 LCDARefreshIndex[] = {
5250 0x00, 0x00, 0x03, 0x01, 0x01, 0x01, 0x01, 0x00 };
5252 unsigned short RefreshRateTableIndex, i, index, temp;
5254 index = xgifb_reg_get(pVBInfo->P3d4, 0x33);
5255 index = index >> pVBInfo->SelectCRT2Rate;
5258 if (pVBInfo->LCDInfo & LCDNonExpanding)
5264 if (pVBInfo->SetFlag & ProgrammingCRT2) {
5265 if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) {
5266 temp = LCDARefreshIndex[pVBInfo->LCDResInfo & 0x07];
5273 RefreshRateTableIndex = XGI330_EModeIDTable[ModeIdIndex].REFindex;
5274 ModeNo = XGI330_RefIndex[RefreshRateTableIndex].ModeID;
5275 if (pXGIHWDE->jChipType >= XG20) { /* for XG20, XG21, XG27 */
5276 if ((XGI330_RefIndex[RefreshRateTableIndex].XRes == 800) &&
5277 (XGI330_RefIndex[RefreshRateTableIndex].YRes == 600)) {
5280 /* do the similar adjustment like XGISearchCRT1Rate() */
5281 if ((XGI330_RefIndex[RefreshRateTableIndex].XRes == 1024) &&
5282 (XGI330_RefIndex[RefreshRateTableIndex].YRes == 768)) {
5285 if ((XGI330_RefIndex[RefreshRateTableIndex].XRes == 1280) &&
5286 (XGI330_RefIndex[RefreshRateTableIndex].YRes == 1024)) {
5293 if (XGI330_RefIndex[RefreshRateTableIndex + i].
5296 temp = XGI330_RefIndex[RefreshRateTableIndex + i].Ext_InfoFlag;
5297 temp &= ModeTypeMask;
5298 if (temp < pVBInfo->ModeType)
5303 } while (index != 0xFFFF);
5304 if (!(pVBInfo->VBInfo & SetCRT2ToRAMDAC)) {
5305 if (pVBInfo->VBInfo & SetInSlaveMode) {
5306 temp = XGI330_RefIndex[RefreshRateTableIndex + i - 1].
5308 if (temp & InterlaceMode)
5313 if ((pVBInfo->SetFlag & ProgrammingCRT2)) {
5314 temp = XGI_AjustCRT2Rate(ModeNo, ModeIdIndex,
5315 RefreshRateTableIndex, &i, pVBInfo);
5317 return RefreshRateTableIndex + i;
5320 static void XGI_SetLCDAGroup(unsigned short ModeNo, unsigned short ModeIdIndex,
5321 struct xgi_hw_device_info *HwDeviceExtension,
5322 struct vb_device_info *pVBInfo)
5324 unsigned short RefreshRateTableIndex;
5326 pVBInfo->SetFlag |= ProgrammingCRT2;
5327 RefreshRateTableIndex = XGI_GetRatePtrCRT2(HwDeviceExtension, ModeNo,
5328 ModeIdIndex, pVBInfo);
5329 XGI_GetLVDSResInfo(ModeNo, ModeIdIndex, pVBInfo);
5330 XGI_GetLVDSData(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
5331 XGI_ModCRT1Regs(ModeNo, ModeIdIndex, RefreshRateTableIndex,
5332 HwDeviceExtension, pVBInfo);
5333 XGI_SetLVDSRegs(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
5334 XGI_SetCRT2ECLK(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
5337 static unsigned char XGI_SetCRT2Group301(unsigned short ModeNo,
5338 struct xgi_hw_device_info *HwDeviceExtension,
5339 struct vb_device_info *pVBInfo)
5341 unsigned short ModeIdIndex, RefreshRateTableIndex;
5343 pVBInfo->SetFlag |= ProgrammingCRT2;
5344 XGI_SearchModeID(ModeNo, &ModeIdIndex, pVBInfo);
5345 pVBInfo->SelectCRT2Rate = 4;
5346 RefreshRateTableIndex = XGI_GetRatePtrCRT2(HwDeviceExtension, ModeNo,
5347 ModeIdIndex, pVBInfo);
5348 XGI_SaveCRT2Info(ModeNo, pVBInfo);
5349 XGI_GetCRT2ResInfo(ModeNo, ModeIdIndex, pVBInfo);
5350 XGI_GetCRT2Data(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
5351 XGI_PreSetGroup1(ModeNo, ModeIdIndex, HwDeviceExtension,
5352 RefreshRateTableIndex, pVBInfo);
5353 XGI_SetGroup1(ModeNo, ModeIdIndex, HwDeviceExtension,
5354 RefreshRateTableIndex, pVBInfo);
5355 XGI_SetLockRegs(ModeNo, ModeIdIndex, HwDeviceExtension,
5356 RefreshRateTableIndex, pVBInfo);
5357 XGI_SetGroup2(ModeNo, ModeIdIndex, RefreshRateTableIndex,
5358 HwDeviceExtension, pVBInfo);
5359 XGI_SetLCDRegs(ModeNo, ModeIdIndex, HwDeviceExtension,
5360 RefreshRateTableIndex, pVBInfo);
5361 XGI_SetTap4Regs(pVBInfo);
5362 XGI_SetGroup3(ModeNo, ModeIdIndex, pVBInfo);
5363 XGI_SetGroup4(ModeNo, ModeIdIndex, RefreshRateTableIndex,
5364 HwDeviceExtension, pVBInfo);
5365 XGI_SetCRT2VCLK(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo);
5366 XGI_SetGroup5(ModeNo, ModeIdIndex, pVBInfo);
5367 XGI_AutoThreshold(pVBInfo);
5371 void XGI_SenseCRT1(struct vb_device_info *pVBInfo)
5373 unsigned char CRTCData[17] = { 0x5F, 0x4F, 0x50, 0x82, 0x55, 0x81,
5374 0x0B, 0x3E, 0xE9, 0x0B, 0xDF, 0xE7, 0x04, 0x00, 0x00,
5377 unsigned char SR01 = 0, SR1F = 0, SR07 = 0, SR06 = 0;
5379 unsigned char CR17, CR63, SR31;
5380 unsigned short temp;
5383 xgifb_reg_set(pVBInfo->P3c4, 0x05, 0x86);
5385 /* to fix XG42 single LCD sense to CRT+LCD */
5386 xgifb_reg_set(pVBInfo->P3d4, 0x57, 0x4A);
5387 xgifb_reg_set(pVBInfo->P3d4, 0x53, (xgifb_reg_get(
5388 pVBInfo->P3d4, 0x53) | 0x02));
5390 SR31 = xgifb_reg_get(pVBInfo->P3c4, 0x31);
5391 CR63 = xgifb_reg_get(pVBInfo->P3d4, 0x63);
5392 SR01 = xgifb_reg_get(pVBInfo->P3c4, 0x01);
5394 xgifb_reg_set(pVBInfo->P3c4, 0x01, (unsigned char) (SR01 & 0xDF));
5395 xgifb_reg_set(pVBInfo->P3d4, 0x63, (unsigned char) (CR63 & 0xBF));
5397 CR17 = xgifb_reg_get(pVBInfo->P3d4, 0x17);
5398 xgifb_reg_set(pVBInfo->P3d4, 0x17, (unsigned char) (CR17 | 0x80));
5400 SR1F = xgifb_reg_get(pVBInfo->P3c4, 0x1F);
5401 xgifb_reg_set(pVBInfo->P3c4, 0x1F, (unsigned char) (SR1F | 0x04));
5403 SR07 = xgifb_reg_get(pVBInfo->P3c4, 0x07);
5404 xgifb_reg_set(pVBInfo->P3c4, 0x07, (unsigned char) (SR07 & 0xFB));
5405 SR06 = xgifb_reg_get(pVBInfo->P3c4, 0x06);
5406 xgifb_reg_set(pVBInfo->P3c4, 0x06, (unsigned char) (SR06 & 0xC3));
5408 xgifb_reg_set(pVBInfo->P3d4, 0x11, 0x00);
5410 for (i = 0; i < 8; i++)
5411 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) i, CRTCData[i]);
5413 for (i = 8; i < 11; i++)
5414 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 8),
5417 for (i = 11; i < 13; i++)
5418 xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 4),
5421 for (i = 13; i < 16; i++)
5422 xgifb_reg_set(pVBInfo->P3c4, (unsigned short) (i - 3),
5425 xgifb_reg_set(pVBInfo->P3c4, 0x0E, (unsigned char) (CRTCData[16]
5428 xgifb_reg_set(pVBInfo->P3c4, 0x31, 0x00);
5429 xgifb_reg_set(pVBInfo->P3c4, 0x2B, 0x1B);
5430 xgifb_reg_set(pVBInfo->P3c4, 0x2C, 0xE1);
5432 outb(0x00, pVBInfo->P3c8);
5434 for (i = 0; i < 256 * 3; i++) {
5435 outb(0x0F, (pVBInfo->P3c8 + 1)); /* DAC_TEST_PARMS */
5440 XGI_WaitDisply(pVBInfo);
5441 temp = inb(pVBInfo->P3c2);
5444 xgifb_reg_and_or(pVBInfo->P3d4, 0x32, 0xDF, 0x20);
5446 xgifb_reg_and_or(pVBInfo->P3d4, 0x32, 0xDF, 0x00);
5448 /* avoid display something, set BLACK DAC if not restore DAC */
5449 outb(0x00, pVBInfo->P3c8);
5451 for (i = 0; i < 256 * 3; i++) {
5452 outb(0, (pVBInfo->P3c8 + 1));
5455 xgifb_reg_set(pVBInfo->P3c4, 0x01, SR01);
5456 xgifb_reg_set(pVBInfo->P3d4, 0x63, CR63);
5457 xgifb_reg_set(pVBInfo->P3c4, 0x31, SR31);
5459 xgifb_reg_set(pVBInfo->P3d4, 0x53, (xgifb_reg_get(
5460 pVBInfo->P3d4, 0x53) & 0xFD));
5461 xgifb_reg_set(pVBInfo->P3c4, 0x1F, (unsigned char) SR1F);
5464 static void XGI_EnableBridge(struct xgifb_video_info *xgifb_info,
5465 struct xgi_hw_device_info *HwDeviceExtension,
5466 struct vb_device_info *pVBInfo)
5468 unsigned short tempah;
5470 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
5471 | VB_SIS302LV | VB_XGI301C)) {
5472 if (!(pVBInfo->SetFlag & DisableChA)) {
5473 if ((pVBInfo->SetFlag & EnableChA) ||
5474 (pVBInfo->VBInfo & SetCRT2ToDualEdge)) {
5476 xgifb_reg_set(pVBInfo->Part1Port, 0x1E, 0x20);
5480 if (pVBInfo->VBInfo & (SetCRT2ToLCD | SetCRT2ToTV |
5482 tempah = xgifb_reg_get(pVBInfo->P3c4, 0x32);
5484 if (pVBInfo->VBInfo & SetInSlaveMode) {
5485 if (!(pVBInfo->VBInfo & SetCRT2ToRAMDAC))
5488 xgifb_reg_set(pVBInfo->P3c4, 0x32, tempah);
5489 xgifb_reg_or(pVBInfo->P3c4, 0x1E, 0x20);
5491 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x2E);
5493 if (!(tempah & 0x80))
5494 xgifb_reg_or(pVBInfo->Part1Port, 0x2E, 0x80);
5495 xgifb_reg_and(pVBInfo->Part1Port, 0x00, 0x7F);
5498 if ((pVBInfo->SetFlag & EnableChA)
5499 || (!(pVBInfo->VBInfo & DisableCRT2Display))) {
5500 xgifb_reg_and_or(pVBInfo->Part2Port, 0x00, ~0xE0,
5501 0x20); /* shampoo 0129 */
5502 if (pVBInfo->VBType & (VB_SIS302LV | VB_XGI301C)) {
5503 if (!XGI_EnableChISLCD(pVBInfo, false)) {
5504 if (XGI_EnableChISLCD(pVBInfo, true) ||
5506 (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)))
5507 /* LVDS PLL power on */
5513 /* LVDS Driver power on */
5514 xgifb_reg_and(pVBInfo->Part4Port, 0x30, 0x7F);
5520 if (!(pVBInfo->VBInfo & DisableCRT2Display)) {
5523 if (!(pVBInfo->VBInfo & SetSimuScanMode) &&
5524 (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) &&
5525 (pVBInfo->VBInfo & SetCRT2ToDualEdge)) {
5526 tempah = tempah & 0x40;
5527 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)
5528 tempah = tempah ^ 0xC0;
5530 if (pVBInfo->SetFlag & DisableChA)
5533 if (pVBInfo->SetFlag & EnableChA)
5538 /* EnablePart4_1F */
5539 xgifb_reg_or(pVBInfo->Part4Port, 0x1F, tempah);
5541 if (!(pVBInfo->SetFlag & DisableChA)) {
5542 XGI_DisableGatingCRT(HwDeviceExtension, pVBInfo);
5543 XGI_DisplayOn(xgifb_info, HwDeviceExtension, pVBInfo);
5547 if (pVBInfo->VBInfo & (SetCRT2ToTV | SetCRT2ToLCD
5548 | XGI_SetCRT2ToLCDA))
5550 xgifb_reg_or(pVBInfo->Part1Port, 0x1E, 0x20);
5552 tempah = xgifb_reg_get(pVBInfo->Part1Port, 0x2E);
5553 if (!(tempah & 0x80))
5554 xgifb_reg_or(pVBInfo->Part1Port, 0x2E, 0x80);
5556 xgifb_reg_and(pVBInfo->Part1Port, 0x00, 0x7F);
5557 XGI_DisplayOn(xgifb_info, HwDeviceExtension, pVBInfo);
5561 static void XGI_SetCRT1Group(struct xgifb_video_info *xgifb_info,
5562 struct xgi_hw_device_info *HwDeviceExtension,
5563 unsigned short ModeNo, unsigned short ModeIdIndex,
5564 struct vb_device_info *pVBInfo)
5566 unsigned short RefreshRateTableIndex, temp;
5568 XGI_SetSeqRegs(ModeNo, ModeIdIndex, pVBInfo);
5569 outb(XGI330_StandTable.MISC, pVBInfo->P3c2);
5570 XGI_SetCRTCRegs(HwDeviceExtension, pVBInfo);
5571 XGI_SetATTRegs(ModeNo, ModeIdIndex, pVBInfo);
5572 XGI_SetGRCRegs(pVBInfo);
5573 XGI_ClearExt1Regs(pVBInfo);
5575 if (HwDeviceExtension->jChipType == XG27) {
5576 if (pVBInfo->IF_DEF_LVDS == 0)
5577 XGI_SetDefaultVCLK(pVBInfo);
5580 temp = ~ProgrammingCRT2;
5581 pVBInfo->SetFlag &= temp;
5582 pVBInfo->SelectCRT2Rate = 0;
5584 if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV
5585 | VB_SIS302LV | VB_XGI301C)) {
5586 if (pVBInfo->VBInfo & (SetSimuScanMode | XGI_SetCRT2ToLCDA
5587 | SetInSlaveMode)) {
5588 pVBInfo->SetFlag |= ProgrammingCRT2;
5592 RefreshRateTableIndex = XGI_GetRatePtrCRT2(HwDeviceExtension, ModeNo,
5593 ModeIdIndex, pVBInfo);
5594 if (RefreshRateTableIndex != 0xFFFF) {
5595 XGI_SetSync(RefreshRateTableIndex, pVBInfo);
5596 XGI_SetCRT1CRTC(ModeNo, ModeIdIndex, RefreshRateTableIndex,
5597 pVBInfo, HwDeviceExtension);
5598 XGI_SetCRT1DE(HwDeviceExtension, ModeNo, ModeIdIndex,
5599 RefreshRateTableIndex, pVBInfo);
5600 XGI_SetCRT1Offset(ModeNo, ModeIdIndex, RefreshRateTableIndex,
5601 HwDeviceExtension, pVBInfo);
5602 XGI_SetCRT1VCLK(ModeNo, ModeIdIndex, HwDeviceExtension,
5603 RefreshRateTableIndex, pVBInfo);
5606 if (HwDeviceExtension->jChipType >= XG21) {
5607 temp = xgifb_reg_get(pVBInfo->P3d4, 0x38);
5610 if (HwDeviceExtension->jChipType == XG27)
5611 XGI_SetXG27CRTC(ModeNo, ModeIdIndex,
5612 RefreshRateTableIndex, pVBInfo);
5614 XGI_SetXG21CRTC(ModeNo, ModeIdIndex,
5615 RefreshRateTableIndex, pVBInfo);
5617 XGI_UpdateXG21CRTC(ModeNo, pVBInfo,
5618 RefreshRateTableIndex);
5620 xgifb_set_lcd(HwDeviceExtension->jChipType,
5621 pVBInfo, RefreshRateTableIndex, ModeNo);
5623 if (pVBInfo->IF_DEF_LVDS == 1)
5624 xgifb_set_lvds(xgifb_info,
5625 HwDeviceExtension->jChipType,
5626 ModeNo, ModeIdIndex, pVBInfo);
5630 pVBInfo->SetFlag &= (~ProgrammingCRT2);
5631 XGI_SetCRT1FIFO(ModeNo, HwDeviceExtension, pVBInfo);
5632 XGI_SetCRT1ModeRegs(HwDeviceExtension, ModeNo, ModeIdIndex,
5633 RefreshRateTableIndex, pVBInfo);
5634 XGI_LoadDAC(ModeNo, ModeIdIndex, pVBInfo);
5637 unsigned char XGISetModeNew(struct xgifb_video_info *xgifb_info,
5638 struct xgi_hw_device_info *HwDeviceExtension,
5639 unsigned short ModeNo)
5641 unsigned short ModeIdIndex;
5642 struct vb_device_info VBINF;
5643 struct vb_device_info *pVBInfo = &VBINF;
5644 pVBInfo->IF_DEF_LVDS = 0;
5646 if (HwDeviceExtension->jChipType >= XG20) {
5647 pVBInfo->IF_DEF_YPbPr = 0;
5648 pVBInfo->IF_DEF_HiVision = 0;
5649 pVBInfo->IF_DEF_CRT2Monitor = 0;
5650 pVBInfo->VBType = 0; /*set VBType default 0*/
5652 pVBInfo->IF_DEF_YPbPr = 1;
5653 pVBInfo->IF_DEF_HiVision = 1;
5654 pVBInfo->IF_DEF_CRT2Monitor = 1;
5657 XGIRegInit(pVBInfo, xgifb_info->vga_base);
5659 /* for x86 Linux, XG21 LVDS */
5660 if (HwDeviceExtension->jChipType == XG21) {
5661 if ((xgifb_reg_get(pVBInfo->P3d4, 0x38) & 0xE0) == 0xC0)
5662 pVBInfo->IF_DEF_LVDS = 1;
5664 if (HwDeviceExtension->jChipType == XG27) {
5665 if ((xgifb_reg_get(pVBInfo->P3d4, 0x38) & 0xE0) == 0xC0) {
5666 if (xgifb_reg_get(pVBInfo->P3d4, 0x30) & 0x20)
5667 pVBInfo->IF_DEF_LVDS = 1;
5671 InitTo330Pointer(HwDeviceExtension->jChipType, pVBInfo);
5673 ModeNo = ModeNo & 0x7F;
5674 xgifb_reg_set(pVBInfo->P3c4, 0x05, 0x86);
5676 if (HwDeviceExtension->jChipType < XG20)
5677 XGI_UnLockCRT2(HwDeviceExtension, pVBInfo);
5679 XGI_SearchModeID(ModeNo, &ModeIdIndex, pVBInfo);
5681 if (HwDeviceExtension->jChipType < XG20) {
5682 XGI_GetVBInfo(ModeNo, ModeIdIndex, HwDeviceExtension, pVBInfo);
5683 XGI_GetTVInfo(ModeNo, ModeIdIndex, pVBInfo);
5684 XGI_GetLCDInfo(ModeNo, ModeIdIndex, pVBInfo);
5685 XGI_DisableBridge(xgifb_info, HwDeviceExtension, pVBInfo);
5687 if (pVBInfo->VBInfo & (SetSimuScanMode | XGI_SetCRT2ToLCDA) ||
5688 (!(pVBInfo->VBInfo & SwitchCRT2))) {
5689 XGI_SetCRT1Group(xgifb_info, HwDeviceExtension, ModeNo,
5690 ModeIdIndex, pVBInfo);
5692 if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) {
5693 XGI_SetLCDAGroup(ModeNo, ModeIdIndex,
5694 HwDeviceExtension, pVBInfo);
5698 if (pVBInfo->VBInfo & (SetSimuScanMode | SwitchCRT2)) {
5699 switch (HwDeviceExtension->ujVBChipID) {
5700 case VB_CHIP_301: /* fall through */
5702 XGI_SetCRT2Group301(ModeNo, HwDeviceExtension,
5703 pVBInfo); /*add for CRT2 */
5711 XGI_SetCRT2ModeRegs(ModeNo, HwDeviceExtension, pVBInfo);
5712 XGI_OEM310Setting(ModeNo, ModeIdIndex, pVBInfo); /*0212*/
5713 XGI_EnableBridge(xgifb_info, HwDeviceExtension, pVBInfo);
5716 if (pVBInfo->IF_DEF_LVDS == 1)
5717 if (!XGI_XG21CheckLVDSMode(xgifb_info, ModeNo,
5722 pVBInfo->ModeType = XGI330_EModeIDTable[ModeIdIndex].
5723 Ext_ModeFlag & ModeTypeMask;
5725 pVBInfo->SetFlag = 0;
5726 pVBInfo->VBInfo = DisableCRT2Display;
5728 XGI_DisplayOff(xgifb_info, HwDeviceExtension, pVBInfo);
5730 XGI_SetCRT1Group(xgifb_info, HwDeviceExtension, ModeNo,
5731 ModeIdIndex, pVBInfo);
5733 XGI_DisplayOn(xgifb_info, HwDeviceExtension, pVBInfo);
5736 XGI_UpdateModeInfo(HwDeviceExtension, pVBInfo);
5738 if (HwDeviceExtension->jChipType < XG20)
5739 XGI_LockCRT2(HwDeviceExtension, pVBInfo);