| #include <linux/delay.h> |
| #include "XGIfb.h" |
| |
| #include "vb_def.h" |
| #include "vb_init.h" |
| #include "vb_util.h" |
| #include "vb_table.h" |
| #include "vb_setmode.h" |
| |
| #define IndexMask 0xff |
| #define TVCLKBASE_315_25 (TVCLKBASE_315 + 25) |
| |
| static const unsigned short XGINew_VGA_DAC[] = { |
| 0x00, 0x10, 0x04, 0x14, 0x01, 0x11, 0x09, 0x15, |
| 0x2A, 0x3A, 0x2E, 0x3E, 0x2B, 0x3B, 0x2F, 0x3F, |
| 0x00, 0x05, 0x08, 0x0B, 0x0E, 0x11, 0x14, 0x18, |
| 0x1C, 0x20, 0x24, 0x28, 0x2D, 0x32, 0x38, 0x3F, |
| 0x00, 0x10, 0x1F, 0x2F, 0x3F, 0x1F, 0x27, 0x2F, |
| 0x37, 0x3F, 0x2D, 0x31, 0x36, 0x3A, 0x3F, 0x00, |
| 0x07, 0x0E, 0x15, 0x1C, 0x0E, 0x11, 0x15, 0x18, |
| 0x1C, 0x14, 0x16, 0x18, 0x1A, 0x1C, 0x00, 0x04, |
| 0x08, 0x0C, 0x10, 0x08, 0x0A, 0x0C, 0x0E, 0x10, |
| 0x0B, 0x0C, 0x0D, 0x0F, 0x10}; |
| |
| void InitTo330Pointer(unsigned char ChipType, struct vb_device_info *pVBInfo) |
| { |
| pVBInfo->MCLKData = XGI340New_MCLKData; |
| |
| pVBInfo->LCDResInfo = 0; |
| pVBInfo->LCDTypeInfo = 0; |
| pVBInfo->LCDInfo = 0; |
| pVBInfo->VBInfo = 0; |
| pVBInfo->TVInfo = 0; |
| |
| pVBInfo->SR18 = XGI340_SR18; |
| pVBInfo->CR40 = XGI340_cr41; |
| |
| if (ChipType < XG20) |
| XGI_GetVBType(pVBInfo); |
| |
| /* 310 customization related */ |
| if ((pVBInfo->VBType & VB_SIS301LV) || (pVBInfo->VBType & VB_SIS302LV)) |
| pVBInfo->LCDCapList = XGI_LCDDLCapList; |
| else |
| pVBInfo->LCDCapList = XGI_LCDCapList; |
| |
| if (ChipType >= XG20) |
| pVBInfo->XGINew_CR97 = 0x10; |
| |
| if (ChipType == XG27) { |
| unsigned char temp; |
| |
| pVBInfo->MCLKData = XGI27New_MCLKData; |
| pVBInfo->CR40 = XGI27_cr41; |
| pVBInfo->XGINew_CR97 = 0xc1; |
| pVBInfo->SR18 = XG27_SR18; |
| |
| /*Z11m DDR*/ |
| temp = xgifb_reg_get(pVBInfo->P3c4, 0x3B); |
| /* SR3B[7][3]MAA15 MAA11 (Power on Trapping) */ |
| if (((temp & 0x88) == 0x80) || ((temp & 0x88) == 0x08)) |
| pVBInfo->XGINew_CR97 = 0x80; |
| } |
| |
| } |
| |
| static void XGI_SetSeqRegs(struct vb_device_info *pVBInfo) |
| { |
| unsigned char SRdata, i; |
| |
| xgifb_reg_set(pVBInfo->P3c4, 0x00, 0x03); /* Set SR0 */ |
| |
| for (i = 0; i < 4; i++) { |
| /* Get SR1,2,3,4 from file */ |
| /* SR1 is with screen off 0x20 */ |
| SRdata = XGI330_StandTable.SR[i]; |
| xgifb_reg_set(pVBInfo->P3c4, i+1, SRdata); /* Set SR 1 2 3 4 */ |
| } |
| } |
| |
| static void XGI_SetCRTCRegs(struct vb_device_info *pVBInfo) |
| { |
| unsigned char CRTCdata; |
| unsigned short i; |
| |
| CRTCdata = xgifb_reg_get(pVBInfo->P3d4, 0x11); |
| CRTCdata &= 0x7f; |
| xgifb_reg_set(pVBInfo->P3d4, 0x11, CRTCdata); /* Unlock CRTC */ |
| |
| for (i = 0; i <= 0x18; i++) { |
| /* Get CRTC from file */ |
| CRTCdata = XGI330_StandTable.CRTC[i]; |
| xgifb_reg_set(pVBInfo->P3d4, i, CRTCdata); /* Set CRTC(3d4) */ |
| } |
| } |
| |
| static void XGI_SetATTRegs(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char ARdata; |
| unsigned short i, modeflag; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| |
| for (i = 0; i <= 0x13; i++) { |
| ARdata = XGI330_StandTable.ATTR[i]; |
| |
| if ((modeflag & Charx8Dot) && i == 0x13) { /* ifndef Dot9 */ |
| if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) { |
| ARdata = 0; |
| } else if ((pVBInfo->VBInfo & |
| (SetCRT2ToTV | SetCRT2ToLCD)) && |
| (pVBInfo->VBInfo & SetInSlaveMode)) { |
| ARdata = 0; |
| } |
| } |
| |
| inb(pVBInfo->P3da); /* reset 3da */ |
| outb(i, pVBInfo->P3c0); /* set index */ |
| outb(ARdata, pVBInfo->P3c0); /* set data */ |
| } |
| |
| inb(pVBInfo->P3da); /* reset 3da */ |
| outb(0x14, pVBInfo->P3c0); /* set index */ |
| outb(0x00, pVBInfo->P3c0); /* set data */ |
| inb(pVBInfo->P3da); /* Enable Attribute */ |
| outb(0x20, pVBInfo->P3c0); |
| } |
| |
| static void XGI_SetGRCRegs(struct vb_device_info *pVBInfo) |
| { |
| unsigned char GRdata; |
| unsigned short i; |
| |
| for (i = 0; i <= 0x08; i++) { |
| /* Get GR from file */ |
| GRdata = XGI330_StandTable.GRC[i]; |
| xgifb_reg_set(pVBInfo->P3ce, i, GRdata); /* Set GR(3ce) */ |
| } |
| |
| if (pVBInfo->ModeType > ModeVGA) { |
| GRdata = xgifb_reg_get(pVBInfo->P3ce, 0x05); |
| GRdata &= 0xBF; /* 256 color disable */ |
| xgifb_reg_set(pVBInfo->P3ce, 0x05, GRdata); |
| } |
| } |
| |
| static void XGI_ClearExt1Regs(struct vb_device_info *pVBInfo) |
| { |
| unsigned short i; |
| |
| for (i = 0x0A; i <= 0x0E; i++) |
| xgifb_reg_set(pVBInfo->P3c4, i, 0x00); /* Clear SR0A-SR0E */ |
| } |
| |
| static unsigned char XGI_SetDefaultVCLK(struct vb_device_info *pVBInfo) |
| { |
| |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, 0x20); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2B, XGI_VCLKData[0].SR2B); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2C, XGI_VCLKData[0].SR2C); |
| |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x31, ~0x30, 0x10); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2B, XGI_VCLKData[1].SR2B); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2C, XGI_VCLKData[1].SR2C); |
| |
| xgifb_reg_and(pVBInfo->P3c4, 0x31, ~0x30); |
| return 0; |
| } |
| |
| static unsigned char XGI_AjustCRT2Rate(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, unsigned short *i, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempax, tempbx, resinfo, modeflag, infoflag; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| tempbx = XGI330_RefIndex[RefreshRateTableIndex + (*i)].ModeID; |
| tempax = 0; |
| |
| if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) { |
| tempax |= SupportRAMDAC2; |
| |
| if (pVBInfo->VBType & VB_XGI301C) |
| tempax |= SupportCRT2in301C; |
| } |
| |
| /* 301b */ |
| if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) { |
| tempax |= SupportLCD; |
| |
| if (pVBInfo->LCDResInfo != Panel_1280x1024 && |
| pVBInfo->LCDResInfo != Panel_1280x960 && |
| (pVBInfo->LCDInfo & LCDNonExpanding) && |
| resinfo >= 9) |
| return 0; |
| } |
| |
| if (pVBInfo->VBInfo & SetCRT2ToHiVision) { /* for HiTV */ |
| tempax |= SupportHiVision; |
| if ((pVBInfo->VBInfo & SetInSlaveMode) && |
| ((resinfo == 4) || |
| (resinfo == 3 && (pVBInfo->SetFlag & TVSimuMode)) || |
| (resinfo > 7))) |
| return 0; |
| } else if (pVBInfo->VBInfo & (SetCRT2ToAVIDEO | SetCRT2ToSVIDEO | |
| SetCRT2ToSCART | SetCRT2ToYPbPr525750 | |
| SetCRT2ToHiVision)) { |
| tempax |= SupportTV; |
| |
| if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV | |
| VB_SIS302LV | VB_XGI301C)) |
| tempax |= SupportTV1024; |
| |
| if (!(pVBInfo->VBInfo & TVSetPAL) && |
| (modeflag & NoSupportSimuTV) && |
| (pVBInfo->VBInfo & SetInSlaveMode) && |
| (!(pVBInfo->VBInfo & SetNotSimuMode))) |
| return 0; |
| } |
| |
| for (; XGI330_RefIndex[RefreshRateTableIndex + (*i)].ModeID == |
| tempbx; (*i)--) { |
| infoflag = XGI330_RefIndex[RefreshRateTableIndex + (*i)]. |
| Ext_InfoFlag; |
| if (infoflag & tempax) |
| return 1; |
| |
| if ((*i) == 0) |
| break; |
| } |
| |
| for ((*i) = 0;; (*i)++) { |
| infoflag = XGI330_RefIndex[RefreshRateTableIndex + (*i)]. |
| Ext_InfoFlag; |
| if (XGI330_RefIndex[RefreshRateTableIndex + (*i)].ModeID |
| != tempbx) { |
| return 0; |
| } |
| |
| if (infoflag & tempax) |
| return 1; |
| } |
| return 1; |
| } |
| |
| static void XGI_SetSync(unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short sync, temp; |
| |
| /* di+0x00 */ |
| sync = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag >> 8; |
| sync &= 0xC0; |
| temp = 0x2F; |
| temp |= sync; |
| outb(temp, pVBInfo->P3c2); /* Set Misc(3c2) */ |
| } |
| |
| static void XGI_SetCRT1Timing_H(struct vb_device_info *pVBInfo, |
| struct xgi_hw_device_info *HwDeviceExtension) |
| { |
| unsigned char data, data1, pushax; |
| unsigned short i, j; |
| |
| /* unlock cr0-7 */ |
| data = xgifb_reg_get(pVBInfo->P3d4, 0x11); |
| data &= 0x7F; |
| xgifb_reg_set(pVBInfo->P3d4, 0x11, data); |
| |
| data = pVBInfo->TimingH.data[0]; |
| xgifb_reg_set(pVBInfo->P3d4, 0, data); |
| |
| for (i = 0x01; i <= 0x04; i++) { |
| data = pVBInfo->TimingH.data[i]; |
| xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 1), data); |
| } |
| |
| for (i = 0x05; i <= 0x06; i++) { |
| data = pVBInfo->TimingH.data[i]; |
| xgifb_reg_set(pVBInfo->P3c4, (unsigned short) (i + 6), data); |
| } |
| |
| j = xgifb_reg_get(pVBInfo->P3c4, 0x0e); |
| j &= 0x1F; |
| data = pVBInfo->TimingH.data[7]; |
| data &= 0xE0; |
| data |= j; |
| xgifb_reg_set(pVBInfo->P3c4, 0x0e, data); |
| |
| if (HwDeviceExtension->jChipType >= XG20) { |
| data = xgifb_reg_get(pVBInfo->P3d4, 0x04); |
| data = data - 1; |
| xgifb_reg_set(pVBInfo->P3d4, 0x04, data); |
| data = xgifb_reg_get(pVBInfo->P3d4, 0x05); |
| data1 = data; |
| data1 &= 0xE0; |
| data &= 0x1F; |
| if (data == 0) { |
| pushax = data; |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x0c); |
| data &= 0xFB; |
| xgifb_reg_set(pVBInfo->P3c4, 0x0c, data); |
| data = pushax; |
| } |
| data = data - 1; |
| data |= data1; |
| xgifb_reg_set(pVBInfo->P3d4, 0x05, data); |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x0e); |
| data >>= 5; |
| data = data + 3; |
| if (data > 7) |
| data = data - 7; |
| data <<= 5; |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x0e, ~0xE0, data); |
| } |
| } |
| |
| static void XGI_SetCRT1Timing_V(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char data; |
| unsigned short i, j; |
| |
| for (i = 0x00; i <= 0x01; i++) { |
| data = pVBInfo->TimingV.data[i]; |
| xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 6), data); |
| } |
| |
| for (i = 0x02; i <= 0x03; i++) { |
| data = pVBInfo->TimingV.data[i]; |
| xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 0x0e), data); |
| } |
| |
| for (i = 0x04; i <= 0x05; i++) { |
| data = pVBInfo->TimingV.data[i]; |
| xgifb_reg_set(pVBInfo->P3d4, (unsigned short) (i + 0x11), data); |
| } |
| |
| j = xgifb_reg_get(pVBInfo->P3c4, 0x0a); |
| j &= 0xC0; |
| data = pVBInfo->TimingV.data[6]; |
| data &= 0x3F; |
| data |= j; |
| xgifb_reg_set(pVBInfo->P3c4, 0x0a, data); |
| |
| data = pVBInfo->TimingV.data[6]; |
| data &= 0x80; |
| data >>= 2; |
| |
| i = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| i &= DoubleScanMode; |
| if (i) |
| data |= 0x80; |
| |
| j = xgifb_reg_get(pVBInfo->P3d4, 0x09); |
| j &= 0x5F; |
| data |= j; |
| xgifb_reg_set(pVBInfo->P3d4, 0x09, data); |
| } |
| |
| static void XGI_SetCRT1CRTC(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo, |
| struct xgi_hw_device_info *HwDeviceExtension) |
| { |
| unsigned char index, data; |
| unsigned short i; |
| |
| /* Get index */ |
| index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC; |
| index = index & IndexMask; |
| |
| data = xgifb_reg_get(pVBInfo->P3d4, 0x11); |
| data &= 0x7F; |
| xgifb_reg_set(pVBInfo->P3d4, 0x11, data); /* Unlock CRTC */ |
| |
| for (i = 0; i < 8; i++) |
| pVBInfo->TimingH.data[i] |
| = XGI_CRT1Table[index].CR[i]; |
| |
| for (i = 0; i < 7; i++) |
| pVBInfo->TimingV.data[i] |
| = XGI_CRT1Table[index].CR[i + 8]; |
| |
| XGI_SetCRT1Timing_H(pVBInfo, HwDeviceExtension); |
| |
| XGI_SetCRT1Timing_V(ModeIdIndex, pVBInfo); |
| |
| if (pVBInfo->ModeType > 0x03) |
| xgifb_reg_set(pVBInfo->P3d4, 0x14, 0x4F); |
| } |
| |
| /* --------------------------------------------------------------------- */ |
| /* Function : XGI_SetXG21CRTC */ |
| /* Input : Stand or enhance CRTC table */ |
| /* Output : Fill CRT Hsync/Vsync to SR2E/SR2F/SR30/SR33/SR34/SR3F */ |
| /* Description : Set LCD timing */ |
| /* --------------------------------------------------------------------- */ |
| static void XGI_SetXG21CRTC(unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char index, Tempax, Tempbx, Tempcx, Tempdx; |
| unsigned short Temp1, Temp2, Temp3; |
| |
| index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC; |
| /* Tempax: CR4 HRS */ |
| Tempax = XGI_CRT1Table[index].CR[3]; |
| Tempcx = Tempax; /* Tempcx: HRS */ |
| /* SR2E[7:0]->HRS */ |
| xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax); |
| |
| Tempdx = XGI_CRT1Table[index].CR[5]; /* SRB */ |
| Tempdx &= 0xC0; /* Tempdx[7:6]: SRB[7:6] */ |
| Temp1 = Tempdx; /* Temp1[7:6]: HRS[9:8] */ |
| Temp1 <<= 2; /* Temp1[9:8]: HRS[9:8] */ |
| Temp1 |= Tempax; /* Temp1[9:0]: HRS[9:0] */ |
| |
| Tempax = XGI_CRT1Table[index].CR[4]; /* CR5 HRE */ |
| Tempax &= 0x1F; /* Tempax[4:0]: HRE[4:0] */ |
| |
| Tempbx = XGI_CRT1Table[index].CR[6]; /* SRC */ |
| Tempbx &= 0x04; /* Tempbx[2]: HRE[5] */ |
| Tempbx <<= 3; /* Tempbx[5]: HRE[5] */ |
| Tempax |= Tempbx; /* Tempax[5:0]: HRE[5:0] */ |
| |
| Temp2 = Temp1 & 0x3C0; /* Temp2[9:6]: HRS[9:6] */ |
| Temp2 |= Tempax; /* Temp2[9:0]: HRE[9:0] */ |
| |
| Tempcx &= 0x3F; /* Tempcx[5:0]: HRS[5:0] */ |
| if (Tempax < Tempcx) /* HRE < HRS */ |
| Temp2 |= 0x40; /* Temp2 + 0x40 */ |
| |
| Temp2 &= 0xFF; |
| Tempax = (unsigned char) Temp2; /* Tempax: HRE[7:0] */ |
| Tempax <<= 2; /* Tempax[7:2]: HRE[5:0] */ |
| Tempdx >>= 6; /* Tempdx[7:6]->[1:0] HRS[9:8] */ |
| Tempax |= Tempdx; /* HRE[5:0]HRS[9:8] */ |
| /* SR2F D[7:2]->HRE, D[1:0]->HRS */ |
| xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempax); |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00); |
| |
| /* CR10 VRS */ |
| Tempax = XGI_CRT1Table[index].CR[10]; |
| Tempbx = Tempax; /* Tempbx: VRS */ |
| Tempax &= 0x01; /* Tempax[0]: VRS[0] */ |
| xgifb_reg_or(pVBInfo->P3c4, 0x33, Tempax); /* SR33[0]->VRS[0] */ |
| /* CR7[2][7] VRE */ |
| Tempax = XGI_CRT1Table[index].CR[9]; |
| Tempcx = Tempbx >> 1; /* Tempcx[6:0]: VRS[7:1] */ |
| Tempdx = Tempax & 0x04; /* Tempdx[2]: CR7[2] */ |
| Tempdx <<= 5; /* Tempdx[7]: VRS[8] */ |
| Tempcx |= Tempdx; /* Tempcx[7:0]: VRS[8:1] */ |
| xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempcx); /* SR34[8:1]->VRS */ |
| |
| Temp1 = Tempdx; /* Temp1[7]: Tempdx[7] */ |
| Temp1 <<= 1; /* Temp1[8]: VRS[8] */ |
| Temp1 |= Tempbx; /* Temp1[8:0]: VRS[8:0] */ |
| Tempax &= 0x80; |
| Temp2 = Tempax << 2; /* Temp2[9]: VRS[9] */ |
| Temp1 |= Temp2; /* Temp1[9:0]: VRS[9:0] */ |
| /* Tempax: SRA */ |
| Tempax = XGI_CRT1Table[index].CR[14]; |
| Tempax &= 0x08; /* Tempax[3]: VRS[3] */ |
| Temp2 = Tempax; |
| Temp2 <<= 7; /* Temp2[10]: VRS[10] */ |
| Temp1 |= Temp2; /* Temp1[10:0]: VRS[10:0] */ |
| |
| /* Tempax: CR11 VRE */ |
| Tempax = XGI_CRT1Table[index].CR[11]; |
| Tempax &= 0x0F; /* Tempax[3:0]: VRE[3:0] */ |
| /* Tempbx: SRA */ |
| Tempbx = XGI_CRT1Table[index].CR[14]; |
| Tempbx &= 0x20; /* Tempbx[5]: VRE[5] */ |
| Tempbx >>= 1; /* Tempbx[4]: VRE[4] */ |
| Tempax |= Tempbx; /* Tempax[4:0]: VRE[4:0] */ |
| Temp2 = Temp1 & 0x7E0; /* Temp2[10:5]: VRS[10:5] */ |
| Temp2 |= Tempax; /* Temp2[10:5]: VRE[10:5] */ |
| |
| Temp3 = Temp1 & 0x1F; /* Temp3[4:0]: VRS[4:0] */ |
| if (Tempax < Temp3) /* VRE < VRS */ |
| Temp2 |= 0x20; /* VRE + 0x20 */ |
| |
| Temp2 &= 0xFF; |
| Tempax = (unsigned char) Temp2; /* Tempax: VRE[7:0] */ |
| Tempax <<= 2; /* Tempax[7:0]; VRE[5:0]00 */ |
| Temp1 &= 0x600; /* Temp1[10:9]: VRS[10:9] */ |
| Temp1 >>= 9; /* Temp1[1:0]: VRS[10:9] */ |
| Tempbx = (unsigned char) Temp1; |
| Tempax |= Tempbx; /* Tempax[7:0]: VRE[5:0]VRS[10:9] */ |
| Tempax &= 0x7F; |
| /* SR3F D[7:2]->VRE D[1:0]->VRS */ |
| xgifb_reg_set(pVBInfo->P3c4, 0x3F, Tempax); |
| } |
| |
| static void XGI_SetXG27CRTC(unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short index, Tempax, Tempbx, Tempcx; |
| |
| index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC; |
| /* Tempax: CR4 HRS */ |
| Tempax = XGI_CRT1Table[index].CR[3]; |
| Tempbx = Tempax; /* Tempbx: HRS[7:0] */ |
| /* SR2E[7:0]->HRS */ |
| xgifb_reg_set(pVBInfo->P3c4, 0x2E, Tempax); |
| |
| /* SR0B */ |
| Tempax = XGI_CRT1Table[index].CR[5]; |
| Tempax &= 0xC0; /* Tempax[7:6]: SR0B[7:6]: HRS[9:8]*/ |
| Tempbx |= (Tempax << 2); /* Tempbx: HRS[9:0] */ |
| |
| Tempax = XGI_CRT1Table[index].CR[4]; /* CR5 HRE */ |
| Tempax &= 0x1F; /* Tempax[4:0]: HRE[4:0] */ |
| Tempcx = Tempax; /* Tempcx: HRE[4:0] */ |
| |
| Tempax = XGI_CRT1Table[index].CR[6]; /* SRC */ |
| Tempax &= 0x04; /* Tempax[2]: HRE[5] */ |
| Tempax <<= 3; /* Tempax[5]: HRE[5] */ |
| Tempcx |= Tempax; /* Tempcx[5:0]: HRE[5:0] */ |
| |
| Tempbx = Tempbx & 0x3C0; /* Tempbx[9:6]: HRS[9:6] */ |
| Tempbx |= Tempcx; /* Tempbx: HRS[9:6]HRE[5:0] */ |
| |
| /* Tempax: CR4 HRS */ |
| Tempax = XGI_CRT1Table[index].CR[3]; |
| Tempax &= 0x3F; /* Tempax: HRS[5:0] */ |
| if (Tempcx <= Tempax) /* HRE[5:0] < HRS[5:0] */ |
| Tempbx += 0x40; /* Tempbx= Tempbx + 0x40 : HRE[9:0]*/ |
| |
| Tempax = XGI_CRT1Table[index].CR[5]; /* SR0B */ |
| Tempax &= 0xC0; /* Tempax[7:6]: SR0B[7:6]: HRS[9:8]*/ |
| Tempax >>= 6; /* Tempax[1:0]: HRS[9:8]*/ |
| Tempax |= ((Tempbx << 2) & 0xFF); /* Tempax[7:2]: HRE[5:0] */ |
| /* SR2F [7:2][1:0]: HRE[5:0]HRS[9:8] */ |
| xgifb_reg_set(pVBInfo->P3c4, 0x2F, Tempax); |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x30, 0xE3, 00); |
| |
| /* CR10 VRS */ |
| Tempax = XGI_CRT1Table[index].CR[10]; |
| /* SR34[7:0]->VRS[7:0] */ |
| xgifb_reg_set(pVBInfo->P3c4, 0x34, Tempax); |
| |
| Tempcx = Tempax; /* Tempcx <= VRS[7:0] */ |
| /* CR7[7][2] VRS[9][8] */ |
| Tempax = XGI_CRT1Table[index].CR[9]; |
| Tempbx = Tempax; /* Tempbx <= CR07[7:0] */ |
| Tempax = Tempax & 0x04; /* Tempax[2]: CR7[2]: VRS[8] */ |
| Tempax >>= 2; /* Tempax[0]: VRS[8] */ |
| /* SR35[0]: VRS[8] */ |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x01, Tempax); |
| Tempcx |= (Tempax << 8); /* Tempcx <= VRS[8:0] */ |
| Tempcx |= ((Tempbx & 0x80) << 2); /* Tempcx <= VRS[9:0] */ |
| /* Tempax: SR0A */ |
| Tempax = XGI_CRT1Table[index].CR[14]; |
| Tempax &= 0x08; /* SR0A[3] VRS[10] */ |
| Tempcx |= (Tempax << 7); /* Tempcx <= VRS[10:0] */ |
| |
| /* Tempax: CR11 VRE */ |
| Tempax = XGI_CRT1Table[index].CR[11]; |
| Tempax &= 0x0F; /* Tempax[3:0]: VRE[3:0] */ |
| /* Tempbx: SR0A */ |
| Tempbx = XGI_CRT1Table[index].CR[14]; |
| Tempbx &= 0x20; /* Tempbx[5]: SR0A[5]: VRE[4] */ |
| Tempbx >>= 1; /* Tempbx[4]: VRE[4] */ |
| Tempax |= Tempbx; /* Tempax[4:0]: VRE[4:0] */ |
| Tempbx = Tempcx; /* Tempbx: VRS[10:0] */ |
| Tempbx &= 0x7E0; /* Tempbx[10:5]: VRS[10:5] */ |
| Tempbx |= Tempax; /* Tempbx: VRS[10:5]VRE[4:0] */ |
| |
| if (Tempbx <= Tempcx) /* VRE <= VRS */ |
| Tempbx |= 0x20; /* VRE + 0x20 */ |
| |
| /* Tempax: Tempax[7:0]; VRE[5:0]00 */ |
| Tempax = (Tempbx << 2) & 0xFF; |
| /* SR3F[7:2]:VRE[5:0] */ |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x3F, ~0xFC, Tempax); |
| Tempax = Tempcx >> 8; |
| /* SR35[2:0]:VRS[10:8] */ |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x35, ~0x07, Tempax); |
| } |
| |
| static void XGI_SetXG27FPBits(struct vb_device_info *pVBInfo) |
| { |
| unsigned char temp; |
| |
| /* D[1:0] 01: 18bit, 00: dual 12, 10: single 24 */ |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x37); |
| temp = (temp & 3) << 6; |
| /* SR06[7]0: dual 12/1: single 24 [6] 18bit Dither <= 0 h/w recommend */ |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0xc0, temp & 0x80); |
| /* SR09[7] enable FP output, SR09[6] 1: sigle 18bits, 0: 24bits */ |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x09, ~0xc0, temp | 0x80); |
| |
| } |
| |
| static void xgifb_set_lcd(int chip_id, |
| struct vb_device_info *pVBInfo, |
| unsigned short RefreshRateTableIndex) |
| { |
| unsigned short temp; |
| |
| xgifb_reg_set(pVBInfo->P3d4, 0x2E, 0x00); |
| xgifb_reg_set(pVBInfo->P3d4, 0x2F, 0x00); |
| xgifb_reg_set(pVBInfo->P3d4, 0x46, 0x00); |
| xgifb_reg_set(pVBInfo->P3d4, 0x47, 0x00); |
| |
| if (chip_id == XG27) { |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x37); |
| if ((temp & 0x03) == 0) { /* dual 12 */ |
| xgifb_reg_set(pVBInfo->P3d4, 0x46, 0x13); |
| xgifb_reg_set(pVBInfo->P3d4, 0x47, 0x13); |
| } |
| } |
| |
| if (chip_id == XG27) { |
| XGI_SetXG27FPBits(pVBInfo); |
| } else { |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x37); |
| if (temp & 0x01) { |
| /* 18 bits FP */ |
| xgifb_reg_or(pVBInfo->P3c4, 0x06, 0x40); |
| xgifb_reg_or(pVBInfo->P3c4, 0x09, 0x40); |
| } |
| } |
| |
| xgifb_reg_or(pVBInfo->P3c4, 0x1E, 0x01); /* Negative blank polarity */ |
| |
| xgifb_reg_and(pVBInfo->P3c4, 0x30, ~0x20); /* Hsync polarity */ |
| xgifb_reg_and(pVBInfo->P3c4, 0x35, ~0x80); /* Vsync polarity */ |
| |
| temp = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag; |
| if (temp & 0x4000) |
| /* Hsync polarity */ |
| xgifb_reg_or(pVBInfo->P3c4, 0x30, 0x20); |
| if (temp & 0x8000) |
| /* Vsync polarity */ |
| xgifb_reg_or(pVBInfo->P3c4, 0x35, 0x80); |
| } |
| |
| /* --------------------------------------------------------------------- */ |
| /* Function : XGI_UpdateXG21CRTC */ |
| /* Input : */ |
| /* Output : CRT1 CRTC */ |
| /* Description : Modify CRT1 Hsync/Vsync to fix LCD mode timing */ |
| /* --------------------------------------------------------------------- */ |
| static void XGI_UpdateXG21CRTC(unsigned short ModeNo, |
| struct vb_device_info *pVBInfo, |
| unsigned short RefreshRateTableIndex) |
| { |
| int index = -1; |
| |
| xgifb_reg_and(pVBInfo->P3d4, 0x11, 0x7F); /* Unlock CR0~7 */ |
| if (ModeNo == 0x2E && |
| (XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC == |
| RES640x480x60)) |
| index = 12; |
| else if (ModeNo == 0x2E && (XGI330_RefIndex[RefreshRateTableIndex]. |
| Ext_CRT1CRTC == RES640x480x72)) |
| index = 13; |
| else if (ModeNo == 0x2F) |
| index = 14; |
| else if (ModeNo == 0x50) |
| index = 15; |
| else if (ModeNo == 0x59) |
| index = 16; |
| |
| if (index != -1) { |
| xgifb_reg_set(pVBInfo->P3d4, 0x02, |
| XGI_UpdateCRT1Table[index].CR02); |
| xgifb_reg_set(pVBInfo->P3d4, 0x03, |
| XGI_UpdateCRT1Table[index].CR03); |
| xgifb_reg_set(pVBInfo->P3d4, 0x15, |
| XGI_UpdateCRT1Table[index].CR15); |
| xgifb_reg_set(pVBInfo->P3d4, 0x16, |
| XGI_UpdateCRT1Table[index].CR16); |
| } |
| } |
| |
| static void XGI_SetCRT1DE(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short resindex, tempax, tempbx, tempcx, temp, modeflag; |
| |
| unsigned char data; |
| |
| resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| tempax = XGI330_ModeResInfo[resindex].HTotal; |
| tempbx = XGI330_ModeResInfo[resindex].VTotal; |
| |
| if (modeflag & HalfDCLK) |
| tempax >>= 1; |
| |
| if (modeflag & HalfDCLK) |
| tempax <<= 1; |
| |
| temp = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag; |
| |
| if (temp & InterlaceMode) |
| tempbx >>= 1; |
| |
| if (modeflag & DoubleScanMode) |
| tempbx <<= 1; |
| |
| tempcx = 8; |
| |
| tempax /= tempcx; |
| tempax -= 1; |
| tempbx -= 1; |
| tempcx = tempax; |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x11); |
| data = xgifb_reg_get(pVBInfo->P3d4, 0x11); |
| data &= 0x7F; |
| xgifb_reg_set(pVBInfo->P3d4, 0x11, data); /* Unlock CRTC */ |
| xgifb_reg_set(pVBInfo->P3d4, 0x01, (unsigned short) (tempcx & 0xff)); |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x0b, ~0x0c, |
| (unsigned short) ((tempcx & 0x0ff00) >> 10)); |
| xgifb_reg_set(pVBInfo->P3d4, 0x12, (unsigned short) (tempbx & 0xff)); |
| tempax = 0; |
| tempbx >>= 8; |
| |
| if (tempbx & 0x01) |
| tempax |= 0x02; |
| |
| if (tempbx & 0x02) |
| tempax |= 0x40; |
| |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x07, ~0x42, tempax); |
| data = xgifb_reg_get(pVBInfo->P3d4, 0x07); |
| tempax = 0; |
| |
| if (tempbx & 0x04) |
| tempax |= 0x02; |
| |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x0a, ~0x02, tempax); |
| xgifb_reg_set(pVBInfo->P3d4, 0x11, temp); |
| } |
| |
| static void XGI_SetCRT1Offset(unsigned short ModeNo, |
| unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct xgi_hw_device_info *HwDeviceExtension, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short temp, ah, al, temp2, i, DisplayUnit; |
| |
| /* GetOffset */ |
| temp = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeInfo; |
| temp >>= 8; |
| temp = XGI330_ScreenOffset[temp]; |
| |
| temp2 = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag; |
| temp2 &= InterlaceMode; |
| |
| if (temp2) |
| temp <<= 1; |
| |
| temp2 = pVBInfo->ModeType - ModeEGA; |
| |
| switch (temp2) { |
| case 0: |
| temp2 = 1; |
| break; |
| case 1: |
| temp2 = 2; |
| break; |
| case 2: |
| temp2 = 4; |
| break; |
| case 3: |
| temp2 = 4; |
| break; |
| case 4: |
| temp2 = 6; |
| break; |
| case 5: |
| temp2 = 8; |
| break; |
| default: |
| break; |
| } |
| |
| if ((ModeNo >= 0x26) && (ModeNo <= 0x28)) |
| temp = temp * temp2 + temp2 / 2; |
| else |
| temp *= temp2; |
| |
| /* SetOffset */ |
| DisplayUnit = temp; |
| temp2 = temp; |
| temp >>= 8; /* ah */ |
| temp &= 0x0F; |
| i = xgifb_reg_get(pVBInfo->P3c4, 0x0E); |
| i &= 0xF0; |
| i |= temp; |
| xgifb_reg_set(pVBInfo->P3c4, 0x0E, i); |
| |
| temp = (unsigned char) temp2; |
| temp &= 0xFF; /* al */ |
| xgifb_reg_set(pVBInfo->P3d4, 0x13, temp); |
| |
| /* SetDisplayUnit */ |
| temp2 = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag; |
| temp2 &= InterlaceMode; |
| if (temp2) |
| DisplayUnit >>= 1; |
| |
| DisplayUnit <<= 5; |
| ah = (DisplayUnit & 0xff00) >> 8; |
| al = DisplayUnit & 0x00ff; |
| if (al == 0) |
| ah += 1; |
| else |
| ah += 2; |
| |
| if (HwDeviceExtension->jChipType >= XG20) |
| if ((ModeNo == 0x4A) | (ModeNo == 0x49)) |
| ah -= 1; |
| |
| xgifb_reg_set(pVBInfo->P3c4, 0x10, ah); |
| } |
| |
| static unsigned short XGI_GetVCLK2Ptr(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short VCLKIndex, modeflag; |
| |
| /* si+Ext_ResInfo */ |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| |
| if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) { /*301b*/ |
| if (pVBInfo->LCDResInfo != Panel_1024x768) |
| /* LCDXlat2VCLK */ |
| VCLKIndex = VCLK108_2_315 + 5; |
| else |
| VCLKIndex = VCLK65_315 + 2; /* LCDXlat1VCLK */ |
| } else if (pVBInfo->VBInfo & SetCRT2ToHiVision) { |
| if (pVBInfo->SetFlag & RPLLDIV2XO) |
| VCLKIndex = TVCLKBASE_315_25 + HiTVVCLKDIV2; |
| else |
| VCLKIndex = TVCLKBASE_315_25 + HiTVVCLK; |
| |
| if (pVBInfo->SetFlag & TVSimuMode) { |
| if (modeflag & Charx8Dot) |
| VCLKIndex = TVCLKBASE_315_25 + HiTVSimuVCLK; |
| else |
| VCLKIndex = TVCLKBASE_315_25 + HiTVTextVCLK; |
| } |
| |
| /* 301lv */ |
| if (pVBInfo->VBType & VB_SIS301LV) { |
| if (pVBInfo->SetFlag & RPLLDIV2XO) |
| VCLKIndex = YPbPr525iVCLK_2; |
| else |
| VCLKIndex = YPbPr525iVCLK; |
| } |
| } else if (pVBInfo->VBInfo & SetCRT2ToTV) { |
| if (pVBInfo->SetFlag & RPLLDIV2XO) |
| VCLKIndex = TVCLKBASE_315_25 + TVVCLKDIV2; |
| else |
| VCLKIndex = TVCLKBASE_315_25 + TVVCLK; |
| } else { /* for CRT2 */ |
| /* di+Ext_CRTVCLK */ |
| VCLKIndex = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK; |
| VCLKIndex &= IndexMask; |
| } |
| |
| return VCLKIndex; |
| } |
| |
| static void XGI_SetCRT1VCLK(unsigned short ModeIdIndex, |
| struct xgi_hw_device_info *HwDeviceExtension, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char index, data; |
| unsigned short vclkindex; |
| |
| if ((pVBInfo->IF_DEF_LVDS == 0) && |
| (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV | |
| VB_SIS302LV | VB_XGI301C)) && |
| (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) { |
| vclkindex = XGI_GetVCLK2Ptr(ModeIdIndex, RefreshRateTableIndex, |
| pVBInfo); |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x31) & 0xCF; |
| xgifb_reg_set(pVBInfo->P3c4, 0x31, data); |
| data = XGI_VBVCLKData[vclkindex].Part4_A; |
| xgifb_reg_set(pVBInfo->P3c4, 0x2B, data); |
| data = XGI_VBVCLKData[vclkindex].Part4_B; |
| xgifb_reg_set(pVBInfo->P3c4, 0x2C, data); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2D, 0x01); |
| } else { |
| index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK; |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x31) & 0xCF; |
| xgifb_reg_set(pVBInfo->P3c4, 0x31, data); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2B, XGI_VCLKData[index].SR2B); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2C, XGI_VCLKData[index].SR2C); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2D, 0x01); |
| } |
| |
| if (HwDeviceExtension->jChipType >= XG20) { |
| if (XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag & |
| HalfDCLK) { |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x2B); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2B, data); |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x2C); |
| index = data; |
| index &= 0xE0; |
| data &= 0x1F; |
| data <<= 1; |
| data += 1; |
| data |= index; |
| xgifb_reg_set(pVBInfo->P3c4, 0x2C, data); |
| } |
| } |
| } |
| |
| static void XGI_SetXG21FPBits(struct vb_device_info *pVBInfo) |
| { |
| unsigned char temp; |
| |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x37); /* D[0] 1: 18bit */ |
| temp = (temp & 1) << 6; |
| /* SR06[6] 18bit Dither */ |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0x40, temp); |
| /* SR09[7] enable FP output, SR09[6] 1: sigle 18bits, 0: dual 12bits */ |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x09, ~0xc0, temp | 0x80); |
| |
| } |
| |
| static void XGI_SetCRT1FIFO(struct xgi_hw_device_info *HwDeviceExtension, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short data; |
| |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x3D); |
| data &= 0xfe; |
| xgifb_reg_set(pVBInfo->P3c4, 0x3D, data); /* disable auto-threshold */ |
| |
| xgifb_reg_set(pVBInfo->P3c4, 0x08, 0x34); |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x09); |
| data &= 0xC0; |
| xgifb_reg_set(pVBInfo->P3c4, 0x09, data | 0x30); |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x3D); |
| data |= 0x01; |
| xgifb_reg_set(pVBInfo->P3c4, 0x3D, data); |
| |
| if (HwDeviceExtension->jChipType == XG21) |
| XGI_SetXG21FPBits(pVBInfo); /* Fix SR9[7:6] can't read back */ |
| } |
| |
| static void XGI_SetVCLKState(struct xgi_hw_device_info *HwDeviceExtension, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short data, data2 = 0; |
| short VCLK; |
| |
| unsigned char index; |
| |
| index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK; |
| index &= IndexMask; |
| VCLK = XGI_VCLKData[index].CLOCK; |
| |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x32); |
| data &= 0xf3; |
| if (VCLK >= 200) |
| data |= 0x0c; /* VCLK > 200 */ |
| |
| if (HwDeviceExtension->jChipType >= XG20) |
| data &= ~0x04; /* 2 pixel mode */ |
| |
| xgifb_reg_set(pVBInfo->P3c4, 0x32, data); |
| |
| if (HwDeviceExtension->jChipType < XG20) { |
| data = xgifb_reg_get(pVBInfo->P3c4, 0x1F); |
| data &= 0xE7; |
| if (VCLK < 200) |
| data |= 0x10; |
| xgifb_reg_set(pVBInfo->P3c4, 0x1F, data); |
| } |
| |
| data2 = 0x00; |
| |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x07, 0xFC, data2); |
| if (HwDeviceExtension->jChipType >= XG27) |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x40, 0xFC, data2 & 0x03); |
| |
| } |
| |
| static void XGI_SetCRT1ModeRegs(struct xgi_hw_device_info *HwDeviceExtension, |
| unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short data, data2, data3, infoflag = 0, modeflag, resindex, |
| xres; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| infoflag = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag; |
| |
| if (xgifb_reg_get(pVBInfo->P3d4, 0x31) & 0x01) |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x1F, 0x3F, 0x00); |
| |
| data = infoflag; |
| data2 = 0; |
| data2 |= 0x02; |
| data3 = pVBInfo->ModeType - ModeVGA; |
| data3 <<= 2; |
| data2 |= data3; |
| data &= InterlaceMode; |
| |
| if (data) |
| data2 |= 0x20; |
| |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x06, ~0x3F, data2); |
| resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| xres = XGI330_ModeResInfo[resindex].HTotal; /* xres->ax */ |
| |
| data = 0x0000; |
| if (infoflag & InterlaceMode) { |
| if (xres == 1024) |
| data = 0x0035; |
| else if (xres == 1280) |
| data = 0x0048; |
| } |
| |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x19, 0xFF, data); |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x19, 0xFC, 0); |
| |
| if (modeflag & HalfDCLK) |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xF7, 0x08); |
| |
| data2 = 0; |
| |
| if (modeflag & LineCompareOff) |
| data2 |= 0x08; |
| |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x0F, ~0x48, data2); |
| data = 0x60; |
| data = data ^ 0x60; |
| data = data ^ 0xA0; |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x21, 0x1F, data); |
| |
| XGI_SetVCLKState(HwDeviceExtension, RefreshRateTableIndex, pVBInfo); |
| |
| data = xgifb_reg_get(pVBInfo->P3d4, 0x31); |
| |
| if (HwDeviceExtension->jChipType == XG27) { |
| if (data & 0x40) |
| data = 0x2c; |
| else |
| data = 0x6c; |
| xgifb_reg_set(pVBInfo->P3d4, 0x52, data); |
| xgifb_reg_or(pVBInfo->P3d4, 0x51, 0x10); |
| } else if (HwDeviceExtension->jChipType >= XG20) { |
| if (data & 0x40) |
| data = 0x33; |
| else |
| data = 0x73; |
| xgifb_reg_set(pVBInfo->P3d4, 0x52, data); |
| xgifb_reg_set(pVBInfo->P3d4, 0x51, 0x02); |
| } else { |
| if (data & 0x40) |
| data = 0x2c; |
| else |
| data = 0x6c; |
| xgifb_reg_set(pVBInfo->P3d4, 0x52, data); |
| } |
| |
| } |
| |
| static void XGI_WriteDAC(unsigned short dl, |
| unsigned short ah, |
| unsigned short al, |
| unsigned short dh, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short bh, bl; |
| |
| bh = ah; |
| bl = al; |
| |
| if (dl != 0) { |
| swap(bh, dh); |
| if (dl == 1) |
| swap(bl, dh); |
| else |
| swap(bl, bh); |
| } |
| outb((unsigned short) dh, pVBInfo->P3c9); |
| outb((unsigned short) bh, pVBInfo->P3c9); |
| outb((unsigned short) bl, pVBInfo->P3c9); |
| } |
| |
| static void XGI_LoadDAC(struct vb_device_info *pVBInfo) |
| { |
| unsigned short data, data2, i, k, m, n, o, si, di, bx, dl, al, ah, dh; |
| const unsigned short *table = XGINew_VGA_DAC; |
| |
| outb(0xFF, pVBInfo->P3c6); |
| outb(0x00, pVBInfo->P3c8); |
| |
| for (i = 0; i < 16; i++) { |
| data = table[i]; |
| |
| for (k = 0; k < 3; k++) { |
| data2 = 0; |
| |
| if (data & 0x01) |
| data2 = 0x2A; |
| |
| if (data & 0x02) |
| data2 += 0x15; |
| |
| outb(data2, pVBInfo->P3c9); |
| data >>= 2; |
| } |
| } |
| |
| for (i = 16; i < 32; i++) { |
| data = table[i]; |
| |
| for (k = 0; k < 3; k++) |
| outb(data, pVBInfo->P3c9); |
| } |
| |
| si = 32; |
| |
| for (m = 0; m < 9; m++) { |
| di = si; |
| bx = si + 0x04; |
| dl = 0; |
| |
| for (n = 0; n < 3; n++) { |
| for (o = 0; o < 5; o++) { |
| dh = table[si]; |
| ah = table[di]; |
| al = table[bx]; |
| si++; |
| XGI_WriteDAC(dl, ah, al, dh, pVBInfo); |
| } |
| |
| si -= 2; |
| |
| for (o = 0; o < 3; o++) { |
| dh = table[bx]; |
| ah = table[di]; |
| al = table[si]; |
| si--; |
| XGI_WriteDAC(dl, ah, al, dh, pVBInfo); |
| } |
| |
| dl++; |
| } |
| |
| si += 5; |
| } |
| } |
| |
| static void XGI_GetLVDSResInfo(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short resindex, xres, yres, modeflag; |
| |
| /* si+Ext_ResInfo */ |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| |
| /* si+Ext_ResInfo */ |
| resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| |
| xres = XGI330_ModeResInfo[resindex].HTotal; |
| yres = XGI330_ModeResInfo[resindex].VTotal; |
| |
| if (modeflag & HalfDCLK) |
| xres <<= 1; |
| |
| if (modeflag & DoubleScanMode) |
| yres <<= 1; |
| |
| if (xres == 720) |
| xres = 640; |
| |
| pVBInfo->VGAHDE = xres; |
| pVBInfo->HDE = xres; |
| pVBInfo->VGAVDE = yres; |
| pVBInfo->VDE = yres; |
| } |
| |
| static void const *XGI_GetLcdPtr(struct XGI330_LCDDataTablStruct const *table, |
| unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short i, tempdx, tempbx, modeflag; |
| |
| tempbx = 0; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| |
| i = 0; |
| |
| while (table[i].PANELID != 0xff) { |
| tempdx = pVBInfo->LCDResInfo; |
| if (tempbx & 0x0080) { /* OEMUtil */ |
| tempbx &= (~0x0080); |
| tempdx = pVBInfo->LCDTypeInfo; |
| } |
| |
| if (pVBInfo->LCDInfo & EnableScalingLCD) |
| tempdx &= (~PanelResInfo); |
| |
| if (table[i].PANELID == tempdx) { |
| tempbx = table[i].MASK; |
| tempdx = pVBInfo->LCDInfo; |
| |
| if (modeflag & HalfDCLK) |
| tempdx |= SetLCDLowResolution; |
| |
| tempbx &= tempdx; |
| if (tempbx == table[i].CAP) |
| break; |
| } |
| i++; |
| } |
| |
| return table[i].DATAPTR; |
| } |
| |
| static struct SiS_TVData const *XGI_GetTVPtr(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short i, tempdx, tempal, modeflag; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| tempal = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; |
| tempal = tempal & 0x3f; |
| tempdx = pVBInfo->TVInfo; |
| |
| if (pVBInfo->VBInfo & SetInSlaveMode) |
| tempdx = tempdx | SetTVLockMode; |
| |
| if (modeflag & HalfDCLK) |
| tempdx = tempdx | SetTVLowResolution; |
| |
| i = 0; |
| |
| while (XGI_TVDataTable[i].MASK != 0xffff) { |
| if ((tempdx & XGI_TVDataTable[i].MASK) == |
| XGI_TVDataTable[i].CAP) |
| break; |
| i++; |
| } |
| |
| return &XGI_TVDataTable[i].DATAPTR[tempal]; |
| } |
| |
| static void XGI_GetLVDSData(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| struct SiS_LVDSData const *LCDPtr; |
| |
| if (!(pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA))) |
| return; |
| |
| LCDPtr = XGI_GetLcdPtr(XGI_EPLLCDDataPtr, ModeIdIndex, pVBInfo); |
| pVBInfo->VGAHT = LCDPtr->VGAHT; |
| pVBInfo->VGAVT = LCDPtr->VGAVT; |
| pVBInfo->HT = LCDPtr->LCDHT; |
| pVBInfo->VT = LCDPtr->LCDVT; |
| |
| if (pVBInfo->LCDInfo & (SetLCDtoNonExpanding | EnableScalingLCD)) |
| return; |
| |
| if ((pVBInfo->LCDResInfo == Panel_1024x768) || |
| (pVBInfo->LCDResInfo == Panel_1024x768x75)) { |
| pVBInfo->HDE = 1024; |
| pVBInfo->VDE = 768; |
| } else if ((pVBInfo->LCDResInfo == Panel_1280x1024) || |
| (pVBInfo->LCDResInfo == Panel_1280x1024x75)) { |
| pVBInfo->HDE = 1280; |
| pVBInfo->VDE = 1024; |
| } else if (pVBInfo->LCDResInfo == Panel_1400x1050) { |
| pVBInfo->HDE = 1400; |
| pVBInfo->VDE = 1050; |
| } else { |
| pVBInfo->HDE = 1600; |
| pVBInfo->VDE = 1200; |
| } |
| } |
| |
| static void XGI_ModCRT1Regs(unsigned short ModeIdIndex, |
| struct xgi_hw_device_info *HwDeviceExtension, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short i; |
| struct XGI_LVDSCRT1HDataStruct const *LCDPtr = NULL; |
| struct XGI_LVDSCRT1VDataStruct const *LCDPtr1 = NULL; |
| |
| if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) { |
| LCDPtr = XGI_GetLcdPtr(xgifb_epllcd_crt1_h, ModeIdIndex, |
| pVBInfo); |
| |
| for (i = 0; i < 8; i++) |
| pVBInfo->TimingH.data[i] = LCDPtr[0].Reg[i]; |
| } |
| |
| XGI_SetCRT1Timing_H(pVBInfo, HwDeviceExtension); |
| |
| if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) { |
| LCDPtr1 = XGI_GetLcdPtr(xgifb_epllcd_crt1_v, ModeIdIndex, |
| pVBInfo); |
| for (i = 0; i < 7; i++) |
| pVBInfo->TimingV.data[i] = LCDPtr1[0].Reg[i]; |
| } |
| |
| XGI_SetCRT1Timing_V(ModeIdIndex, pVBInfo); |
| } |
| |
| static unsigned short XGI_GetLCDCapPtr(struct vb_device_info *pVBInfo) |
| { |
| unsigned char tempal, tempah, tempbl, i; |
| |
| tempah = xgifb_reg_get(pVBInfo->P3d4, 0x36); |
| tempal = tempah & 0x0F; |
| tempah = tempah & 0xF0; |
| i = 0; |
| tempbl = pVBInfo->LCDCapList[i].LCD_ID; |
| |
| while (tempbl != 0xFF) { |
| if (tempbl & 0x80) { /* OEMUtil */ |
| tempal = tempah; |
| tempbl = tempbl & ~(0x80); |
| } |
| |
| if (tempal == tempbl) |
| break; |
| |
| i++; |
| |
| tempbl = pVBInfo->LCDCapList[i].LCD_ID; |
| } |
| |
| return i; |
| } |
| |
| static unsigned short XGI_GetLCDCapPtr1(struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempah, tempal, tempbl, i; |
| |
| tempal = pVBInfo->LCDResInfo; |
| tempah = pVBInfo->LCDTypeInfo; |
| |
| i = 0; |
| tempbl = pVBInfo->LCDCapList[i].LCD_ID; |
| |
| while (tempbl != 0xFF) { |
| if ((tempbl & 0x80) && (tempbl != 0x80)) { |
| tempal = tempah; |
| tempbl &= ~0x80; |
| } |
| |
| if (tempal == tempbl) |
| break; |
| |
| i++; |
| tempbl = pVBInfo->LCDCapList[i].LCD_ID; |
| } |
| |
| if (tempbl == 0xFF) { |
| pVBInfo->LCDResInfo = Panel_1024x768; |
| pVBInfo->LCDTypeInfo = 0; |
| i = 0; |
| } |
| |
| return i; |
| } |
| |
| static void XGI_GetLCDSync(unsigned short *HSyncWidth, |
| unsigned short *VSyncWidth, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short Index; |
| |
| Index = XGI_GetLCDCapPtr(pVBInfo); |
| *HSyncWidth = pVBInfo->LCDCapList[Index].LCD_HSyncWidth; |
| *VSyncWidth = pVBInfo->LCDCapList[Index].LCD_VSyncWidth; |
| } |
| |
| static void XGI_SetLVDSRegs(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempbx, tempax, tempcx, tempdx, push1, push2, modeflag; |
| unsigned long temp, temp1, temp2, temp3, push3; |
| struct XGI330_LCDDataDesStruct2 const *LCDPtr1 = NULL; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| LCDPtr1 = XGI_GetLcdPtr(XGI_EPLLCDDesDataPtr, ModeIdIndex, pVBInfo); |
| |
| XGI_GetLCDSync(&tempax, &tempbx, pVBInfo); |
| push1 = tempbx; |
| push2 = tempax; |
| |
| /* GetLCDResInfo */ |
| if ((pVBInfo->LCDResInfo == Panel_1024x768) || |
| (pVBInfo->LCDResInfo == Panel_1024x768x75)) { |
| tempax = 1024; |
| tempbx = 768; |
| } else if ((pVBInfo->LCDResInfo == Panel_1280x1024) || |
| (pVBInfo->LCDResInfo == Panel_1280x1024x75)) { |
| tempax = 1280; |
| tempbx = 1024; |
| } else if (pVBInfo->LCDResInfo == Panel_1400x1050) { |
| tempax = 1400; |
| tempbx = 1050; |
| } else { |
| tempax = 1600; |
| tempbx = 1200; |
| } |
| |
| if (pVBInfo->LCDInfo & SetLCDtoNonExpanding) { |
| pVBInfo->HDE = tempax; |
| pVBInfo->VDE = tempbx; |
| pVBInfo->VGAHDE = tempax; |
| pVBInfo->VGAVDE = tempbx; |
| } |
| |
| tempax = pVBInfo->HT; |
| |
| tempbx = LCDPtr1->LCDHDES; |
| |
| tempcx = pVBInfo->HDE; |
| tempbx = tempbx & 0x0fff; |
| tempcx += tempbx; |
| |
| if (tempcx >= tempax) |
| tempcx -= tempax; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x1A, tempbx & 0x07); |
| |
| tempcx >>= 3; |
| tempbx >>= 3; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x16, |
| (unsigned short) (tempbx & 0xff)); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x17, |
| (unsigned short) (tempcx & 0xff)); |
| |
| tempax = pVBInfo->HT; |
| |
| tempbx = LCDPtr1->LCDHRS; |
| |
| tempcx = push2; |
| |
| if (pVBInfo->LCDInfo & EnableScalingLCD) |
| tempcx = LCDPtr1->LCDHSync; |
| |
| tempcx += tempbx; |
| |
| if (tempcx >= tempax) |
| tempcx -= tempax; |
| |
| tempax = tempbx & 0x07; |
| tempax >>= 5; |
| tempcx >>= 3; |
| tempbx >>= 3; |
| |
| tempcx &= 0x1f; |
| tempax |= tempcx; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x15, tempax); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x14, |
| (unsigned short) (tempbx & 0xff)); |
| |
| tempax = pVBInfo->VT; |
| tempbx = LCDPtr1->LCDVDES; |
| tempcx = pVBInfo->VDE; |
| |
| tempbx = tempbx & 0x0fff; |
| tempcx += tempbx; |
| if (tempcx >= tempax) |
| tempcx -= tempax; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x1b, |
| (unsigned short) (tempbx & 0xff)); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x1c, |
| (unsigned short) (tempcx & 0xff)); |
| |
| tempbx = (tempbx >> 8) & 0x07; |
| tempcx = (tempcx >> 8) & 0x07; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x1d, |
| (unsigned short) ((tempcx << 3) |
| | tempbx)); |
| |
| tempax = pVBInfo->VT; |
| tempbx = LCDPtr1->LCDVRS; |
| |
| tempcx = push1; |
| |
| if (pVBInfo->LCDInfo & EnableScalingLCD) |
| tempcx = LCDPtr1->LCDVSync; |
| |
| tempcx += tempbx; |
| if (tempcx >= tempax) |
| tempcx -= tempax; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x18, |
| (unsigned short) (tempbx & 0xff)); |
| xgifb_reg_and_or(pVBInfo->Part1Port, 0x19, ~0x0f, |
| (unsigned short) (tempcx & 0x0f)); |
| |
| tempax = ((tempbx >> 8) & 0x07) << 3; |
| |
| tempbx = pVBInfo->VGAVDE; |
| if (tempbx != pVBInfo->VDE) |
| tempax |= 0x40; |
| |
| if (pVBInfo->LCDInfo & XGI_EnableLVDSDDA) |
| tempax |= 0x40; |
| |
| xgifb_reg_and_or(pVBInfo->Part1Port, 0x1a, 0x07, |
| tempax); |
| |
| tempbx = pVBInfo->VDE; |
| tempax = pVBInfo->VGAVDE; |
| |
| temp = tempax; /* 0430 ylshieh */ |
| temp1 = (temp << 18) / tempbx; |
| |
| tempdx = (unsigned short) ((temp << 18) % tempbx); |
| |
| if (tempdx != 0) |
| temp1 += 1; |
| |
| temp2 = temp1; |
| push3 = temp2; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x37, |
| (unsigned short) (temp2 & 0xff)); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x36, |
| (unsigned short) ((temp2 >> 8) & 0xff)); |
| |
| tempbx = (unsigned short) (temp2 >> 16); |
| tempax = tempbx & 0x03; |
| |
| tempbx = pVBInfo->VGAVDE; |
| if (tempbx == pVBInfo->VDE) |
| tempax |= 0x04; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x35, tempax); |
| |
| if (pVBInfo->VBType & VB_XGI301C) { |
| temp2 = push3; |
| xgifb_reg_set(pVBInfo->Part4Port, |
| 0x3c, |
| (unsigned short) (temp2 & 0xff)); |
| xgifb_reg_set(pVBInfo->Part4Port, |
| 0x3b, |
| (unsigned short) ((temp2 >> 8) & |
| 0xff)); |
| tempbx = (unsigned short) (temp2 >> 16); |
| xgifb_reg_and_or(pVBInfo->Part4Port, 0x3a, |
| ~0xc0, |
| (unsigned short) ((tempbx & |
| 0xff) << 6)); |
| |
| tempcx = pVBInfo->VGAVDE; |
| if (tempcx == pVBInfo->VDE) |
| xgifb_reg_and_or(pVBInfo->Part4Port, |
| 0x30, ~0x0c, 0x00); |
| else |
| xgifb_reg_and_or(pVBInfo->Part4Port, |
| 0x30, ~0x0c, 0x08); |
| } |
| |
| tempcx = pVBInfo->VGAHDE; |
| tempbx = pVBInfo->HDE; |
| |
| temp1 = tempcx << 16; |
| |
| tempax = (unsigned short) (temp1 / tempbx); |
| |
| if ((tempbx & 0xffff) == (tempcx & 0xffff)) |
| tempax = 65535; |
| |
| temp3 = tempax; |
| temp1 = pVBInfo->VGAHDE << 16; |
| |
| temp1 /= temp3; |
| temp3 <<= 16; |
| temp1 -= 1; |
| |
| temp3 = (temp3 & 0xffff0000) + (temp1 & 0xffff); |
| |
| tempax = (unsigned short) (temp3 & 0xff); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x1f, tempax); |
| |
| temp1 = pVBInfo->VGAVDE << 18; |
| temp1 = temp1 / push3; |
| tempbx = (unsigned short) (temp1 & 0xffff); |
| |
| if (pVBInfo->LCDResInfo == Panel_1024x768) |
| tempbx -= 1; |
| |
| tempax = ((tempbx >> 8) & 0xff) << 3; |
| tempax |= (unsigned short) ((temp3 >> 8) & 0x07); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x20, |
| (unsigned short) (tempax & 0xff)); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x21, |
| (unsigned short) (tempbx & 0xff)); |
| |
| temp3 >>= 16; |
| |
| if (modeflag & HalfDCLK) |
| temp3 >>= 1; |
| |
| xgifb_reg_set(pVBInfo->Part1Port, 0x22, |
| (unsigned short) ((temp3 >> 8) & 0xff)); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x23, |
| (unsigned short) (temp3 & 0xff)); |
| } |
| |
| /* --------------------------------------------------------------------- */ |
| /* Function : XGI_GETLCDVCLKPtr */ |
| /* Input : */ |
| /* Output : al -> VCLK Index */ |
| /* Description : */ |
| /* --------------------------------------------------------------------- */ |
| static void XGI_GetLCDVCLKPtr(unsigned char *di_0, unsigned char *di_1, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short index; |
| |
| if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) { |
| index = XGI_GetLCDCapPtr1(pVBInfo); |
| |
| if (pVBInfo->VBInfo & SetCRT2ToLCD) { /* LCDB */ |
| *di_0 = pVBInfo->LCDCapList[index].LCUCHAR_VCLKData1; |
| *di_1 = pVBInfo->LCDCapList[index].LCUCHAR_VCLKData2; |
| } else { /* LCDA */ |
| *di_0 = pVBInfo->LCDCapList[index].LCDA_VCLKData1; |
| *di_1 = pVBInfo->LCDCapList[index].LCDA_VCLKData2; |
| } |
| } |
| } |
| |
| static unsigned char XGI_GetVCLKPtr(unsigned short RefreshRateTableIndex, |
| unsigned short ModeIdIndex, struct vb_device_info *pVBInfo) |
| { |
| |
| unsigned short index, modeflag; |
| unsigned char tempal; |
| |
| /* si+Ext_ResInfo */ |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| |
| if ((pVBInfo->SetFlag & ProgrammingCRT2) && |
| (!(pVBInfo->LCDInfo & EnableScalingLCD))) { /* {LCDA/LCDB} */ |
| index = XGI_GetLCDCapPtr(pVBInfo); |
| tempal = pVBInfo->LCDCapList[index].LCD_VCLK; |
| |
| if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) |
| return tempal; |
| |
| /* {TV} */ |
| if (pVBInfo->VBType & |
| (VB_SIS301B | |
| VB_SIS302B | |
| VB_SIS301LV | |
| VB_SIS302LV | |
| VB_XGI301C)) { |
| if (pVBInfo->VBInfo & SetCRT2ToHiVision) { |
| tempal = TVCLKBASE_315 + HiTVVCLKDIV2; |
| if (!(pVBInfo->TVInfo & RPLLDIV2XO)) |
| tempal = TVCLKBASE_315 + HiTVVCLK; |
| if (pVBInfo->TVInfo & TVSimuMode) { |
| tempal = TVCLKBASE_315 + HiTVSimuVCLK; |
| if (!(modeflag & Charx8Dot)) |
| tempal = TVCLKBASE_315 + |
| HiTVTextVCLK; |
| |
| } |
| return tempal; |
| } |
| |
| if (pVBInfo->TVInfo & TVSetYPbPr750p) { |
| tempal = XGI_YPbPr750pVCLK; |
| return tempal; |
| } |
| |
| if (pVBInfo->TVInfo & TVSetYPbPr525p) { |
| tempal = YPbPr525pVCLK; |
| return tempal; |
| } |
| |
| tempal = NTSC1024VCLK; |
| |
| if (!(pVBInfo->TVInfo & NTSC1024x768)) { |
| tempal = TVCLKBASE_315 + TVVCLKDIV2; |
| if (!(pVBInfo->TVInfo & RPLLDIV2XO)) |
| tempal = TVCLKBASE_315 + TVVCLK; |
| } |
| |
| if (pVBInfo->VBInfo & SetCRT2ToTV) |
| return tempal; |
| } |
| } /* {End of VB} */ |
| |
| inb((pVBInfo->P3ca + 0x02)); |
| tempal = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK; |
| return tempal; |
| } |
| |
| static void XGI_GetVCLKLen(unsigned char tempal, unsigned char *di_0, |
| unsigned char *di_1, struct vb_device_info *pVBInfo) |
| { |
| if (pVBInfo->VBType & (VB_SIS301 | VB_SIS301B | VB_SIS302B |
| | VB_SIS301LV | VB_SIS302LV | VB_XGI301C)) { |
| if ((!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) && |
| (pVBInfo->SetFlag & ProgrammingCRT2)) { |
| *di_0 = XGI_VBVCLKData[tempal].Part4_A; |
| *di_1 = XGI_VBVCLKData[tempal].Part4_B; |
| } |
| } else { |
| *di_0 = XGI_VCLKData[tempal].SR2B; |
| *di_1 = XGI_VCLKData[tempal].SR2C; |
| } |
| } |
| |
| static void XGI_SetCRT2ECLK(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char di_0, di_1, tempal; |
| int i; |
| |
| tempal = XGI_GetVCLKPtr(RefreshRateTableIndex, ModeIdIndex, pVBInfo); |
| XGI_GetVCLKLen(tempal, &di_0, &di_1, pVBInfo); |
| XGI_GetLCDVCLKPtr(&di_0, &di_1, pVBInfo); |
| |
| for (i = 0; i < 4; i++) { |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x31, ~0x30, |
| (unsigned short) (0x10 * i)); |
| if ((!(pVBInfo->VBInfo & XGI_SetCRT2ToLCDA)) |
| && (!(pVBInfo->VBInfo & SetInSlaveMode))) { |
| xgifb_reg_set(pVBInfo->P3c4, 0x2e, di_0); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2f, di_1); |
| } else { |
| xgifb_reg_set(pVBInfo->P3c4, 0x2b, di_0); |
| xgifb_reg_set(pVBInfo->P3c4, 0x2c, di_1); |
| } |
| } |
| } |
| |
| static void XGI_UpdateModeInfo(struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempcl, tempch, temp, tempbl, tempax; |
| |
| if (pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | VB_SIS301LV |
| | VB_SIS302LV | VB_XGI301C)) { |
| tempcl = 0; |
| tempch = 0; |
| temp = xgifb_reg_get(pVBInfo->P3c4, 0x01); |
| |
| if (!(temp & 0x20)) { |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x17); |
| if (temp & 0x80) { |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x53); |
| if (!(temp & 0x40)) |
| tempcl |= ActiveCRT1; |
| } |
| } |
| |
| temp = xgifb_reg_get(pVBInfo->Part1Port, 0x2e); |
| temp &= 0x0f; |
| |
| if (!(temp == 0x08)) { |
| /* Check ChannelA */ |
| tempax = xgifb_reg_get(pVBInfo->Part1Port, 0x13); |
| if (tempax & 0x04) |
| tempcl = tempcl | ActiveLCD; |
| |
| temp &= 0x05; |
| |
| if (!(tempcl & ActiveLCD)) |
| if (temp == 0x01) |
| tempcl |= ActiveCRT2; |
| |
| if (temp == 0x04) |
| tempcl |= ActiveLCD; |
| |
| if (temp == 0x05) { |
| temp = xgifb_reg_get(pVBInfo->Part2Port, 0x00); |
| |
| if (!(temp & 0x08)) |
| tempch |= ActiveAVideo; |
| |
| if (!(temp & 0x04)) |
| tempch |= ActiveSVideo; |
| |
| if (temp & 0x02) |
| tempch |= ActiveSCART; |
| |
| if (pVBInfo->VBInfo & SetCRT2ToHiVision) { |
| if (temp & 0x01) |
| tempch |= ActiveHiTV; |
| } |
| |
| if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) { |
| temp = xgifb_reg_get( |
| pVBInfo->Part2Port, |
| 0x4d); |
| |
| if (temp & 0x10) |
| tempch |= ActiveYPbPr; |
| } |
| |
| if (tempch != 0) |
| tempcl |= ActiveTV; |
| } |
| } |
| |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x3d); |
| if (tempcl & ActiveLCD) { |
| if ((pVBInfo->SetFlag & ReserveTVOption)) { |
| if (temp & ActiveTV) |
| tempcl |= ActiveTV; |
| } |
| } |
| temp = tempcl; |
| tempbl = ~XGI_ModeSwitchStatus; |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x3d, tempbl, temp); |
| |
| if (!(pVBInfo->SetFlag & ReserveTVOption)) |
| xgifb_reg_set(pVBInfo->P3d4, 0x3e, tempch); |
| } |
| } |
| |
| void XGI_GetVBType(struct vb_device_info *pVBInfo) |
| { |
| unsigned short flag, tempbx, tempah; |
| |
| tempbx = VB_SIS302B; |
| flag = xgifb_reg_get(pVBInfo->Part4Port, 0x00); |
| if (flag == 0x02) |
| goto finish; |
| |
| tempbx = VB_SIS301; |
| flag = xgifb_reg_get(pVBInfo->Part4Port, 0x01); |
| if (flag < 0xB0) |
| goto finish; |
| |
| tempbx = VB_SIS301B; |
| if (flag < 0xC0) |
| goto bigger_than_0xB0; |
| |
| tempbx = VB_XGI301C; |
| if (flag < 0xD0) |
| goto bigger_than_0xB0; |
| |
| tempbx = VB_SIS301LV; |
| if (flag < 0xE0) |
| goto bigger_than_0xB0; |
| |
| tempbx = VB_SIS302LV; |
| tempah = xgifb_reg_get(pVBInfo->Part4Port, 0x39); |
| if (tempah != 0xFF) |
| tempbx = VB_XGI301C; |
| |
| bigger_than_0xB0: |
| if (tempbx & (VB_SIS301B | VB_SIS302B)) { |
| flag = xgifb_reg_get(pVBInfo->Part4Port, 0x23); |
| if (!(flag & 0x02)) |
| tempbx = tempbx | VB_NoLCD; |
| } |
| |
| finish: |
| pVBInfo->VBType = tempbx; |
| } |
| |
| static void XGI_GetVBInfo(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempax, push, tempbx, temp, modeflag; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| pVBInfo->SetFlag = 0; |
| pVBInfo->ModeType = modeflag & ModeTypeMask; |
| tempbx = 0; |
| |
| if (!(pVBInfo->VBType & 0xFFFF)) |
| return; |
| |
| /* Check Display Device */ |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x30); |
| tempbx = tempbx | temp; |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x31); |
| push = temp; |
| push <<= 8; |
| tempax = temp << 8; |
| tempbx = tempbx | tempax; |
| temp = (SetCRT2ToDualEdge | SetCRT2ToYPbPr525750 | XGI_SetCRT2ToLCDA |
| | SetInSlaveMode | DisableCRT2Display); |
| temp = 0xFFFF ^ temp; |
| tempbx &= temp; |
| |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x38); |
| |
| if (pVBInfo->VBType & (VB_SIS302B | VB_SIS301LV | VB_SIS302LV | |
| VB_XGI301C)) { |
| if (temp & EnableDualEdge) { |
| tempbx |= SetCRT2ToDualEdge; |
| if (temp & SetToLCDA) |
| tempbx |= XGI_SetCRT2ToLCDA; |
| } |
| } |
| |
| if (pVBInfo->VBType & (VB_SIS301LV|VB_SIS302LV|VB_XGI301C)) { |
| if (temp & SetYPbPr) { |
| /* shampoo add for new scratch */ |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x35); |
| temp &= YPbPrMode; |
| tempbx |= SetCRT2ToHiVision; |
| |
| if (temp != YPbPrMode1080i) { |
| tempbx &= (~SetCRT2ToHiVision); |
| tempbx |= SetCRT2ToYPbPr525750; |
| } |
| } |
| } |
| |
| tempax = push; /* restore CR31 */ |
| |
| temp = 0x09FC; |
| |
| if (!(tempbx & temp)) { |
| tempax |= DisableCRT2Display; |
| tempbx = 0; |
| } |
| |
| if (!(pVBInfo->VBType & VB_NoLCD)) { |
| if (tempbx & XGI_SetCRT2ToLCDA) { |
| if (tempbx & SetSimuScanMode) |
| tempbx &= (~(SetCRT2ToLCD | SetCRT2ToRAMDAC | |
| SwitchCRT2)); |
| else |
| tempbx &= (~(SetCRT2ToLCD | SetCRT2ToRAMDAC | |
| SetCRT2ToTV | SwitchCRT2)); |
| } |
| } |
| |
| /* shampoo add */ |
| /* for driver abnormal */ |
| if (!(tempbx & (SwitchCRT2 | SetSimuScanMode))) { |
| if (tempbx & SetCRT2ToRAMDAC) { |
| tempbx &= (0xFF00 | SetCRT2ToRAMDAC | |
| SwitchCRT2 | SetSimuScanMode); |
| tempbx &= (0x00FF | (~SetCRT2ToYPbPr525750)); |
| } |
| } |
| |
| if (!(pVBInfo->VBType & VB_NoLCD)) { |
| if (tempbx & SetCRT2ToLCD) { |
| tempbx &= (0xFF00 | SetCRT2ToLCD | SwitchCRT2 | |
| SetSimuScanMode); |
| tempbx &= (0x00FF | (~SetCRT2ToYPbPr525750)); |
| } |
| } |
| |
| if (tempbx & SetCRT2ToSCART) { |
| tempbx &= (0xFF00 | SetCRT2ToSCART | SwitchCRT2 | |
| SetSimuScanMode); |
| tempbx &= (0x00FF | (~SetCRT2ToYPbPr525750)); |
| } |
| |
| if (tempbx & SetCRT2ToYPbPr525750) |
| tempbx &= (0xFF00 | SwitchCRT2 | SetSimuScanMode); |
| |
| if (tempbx & SetCRT2ToHiVision) |
| tempbx &= (0xFF00 | SetCRT2ToHiVision | SwitchCRT2 | |
| SetSimuScanMode); |
| |
| if (tempax & DisableCRT2Display) { /* Set Display Device Info */ |
| if (!(tempbx & (SwitchCRT2 | SetSimuScanMode))) |
| tempbx = DisableCRT2Display; |
| } |
| |
| if (!(tempbx & DisableCRT2Display)) { |
| if ((!(tempbx & DriverMode)) || (!(modeflag & CRT2Mode))) { |
| if (!(tempbx & XGI_SetCRT2ToLCDA)) |
| tempbx |= (SetInSlaveMode | SetSimuScanMode); |
| } |
| |
| /* LCD+TV can't support in slave mode |
| * (Force LCDA+TV->LCDB) */ |
| if ((tempbx & SetInSlaveMode) && (tempbx & XGI_SetCRT2ToLCDA)) { |
| tempbx ^= (SetCRT2ToLCD | XGI_SetCRT2ToLCDA | |
| SetCRT2ToDualEdge); |
| pVBInfo->SetFlag |= ReserveTVOption; |
| } |
| } |
| |
| pVBInfo->VBInfo = tempbx; |
| } |
| |
| static void XGI_GetTVInfo(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempbx = 0, resinfo = 0, modeflag, index1; |
| |
| if (pVBInfo->VBInfo & SetCRT2ToTV) { |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| |
| tempbx = xgifb_reg_get(pVBInfo->P3d4, 0x35); |
| if (tempbx & TVSetPAL) { |
| tempbx &= (SetCHTVOverScan | |
| TVSetPALM | |
| TVSetPALN | |
| TVSetPAL); |
| if (tempbx & TVSetPALM) |
| /* set to NTSC if PAL-M */ |
| tempbx &= ~TVSetPAL; |
| } else |
| tempbx &= (SetCHTVOverScan | |
| TVSetNTSCJ | |
| TVSetPAL); |
| |
| if (pVBInfo->VBInfo & SetCRT2ToSCART) |
| tempbx |= TVSetPAL; |
| |
| if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) { |
| index1 = xgifb_reg_get(pVBInfo->P3d4, 0x35); |
| index1 &= YPbPrMode; |
| |
| if (index1 == YPbPrMode525i) |
| tempbx |= TVSetYPbPr525i; |
| |
| if (index1 == YPbPrMode525p) |
| tempbx = tempbx | TVSetYPbPr525p; |
| if (index1 == YPbPrMode750p) |
| tempbx = tempbx | TVSetYPbPr750p; |
| } |
| |
| if (pVBInfo->VBInfo & SetCRT2ToHiVision) |
| tempbx = tempbx | TVSetHiVision | TVSetPAL; |
| |
| if ((pVBInfo->VBInfo & SetInSlaveMode) && |
| (!(pVBInfo->VBInfo & SetNotSimuMode))) |
| tempbx |= TVSimuMode; |
| |
| if (!(tempbx & TVSetPAL) && (modeflag > 13) && (resinfo == 8)) |
| /* NTSC 1024x768, */ |
| tempbx |= NTSC1024x768; |
| |
| tempbx |= RPLLDIV2XO; |
| |
| if (pVBInfo->VBInfo & SetCRT2ToHiVision) { |
| if (pVBInfo->VBInfo & SetInSlaveMode) |
| tempbx &= (~RPLLDIV2XO); |
| } else if (tempbx & (TVSetYPbPr525p | TVSetYPbPr750p)) { |
| tempbx &= (~RPLLDIV2XO); |
| } else if (!(pVBInfo->VBType & (VB_SIS301B | VB_SIS302B | |
| VB_SIS301LV | VB_SIS302LV | |
| VB_XGI301C))) { |
| if (tempbx & TVSimuMode) |
| tempbx &= (~RPLLDIV2XO); |
| } |
| } |
| pVBInfo->TVInfo = tempbx; |
| } |
| |
| static unsigned char XGI_GetLCDInfo(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short temp, tempax, tempbx, resinfo = 0, LCDIdIndex; |
| |
| pVBInfo->LCDResInfo = 0; |
| pVBInfo->LCDTypeInfo = 0; |
| pVBInfo->LCDInfo = 0; |
| |
| /* si+Ext_ResInfo // */ |
| resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x36); /* Get LCD Res.Info */ |
| tempbx = temp & 0x0F; |
| |
| if (tempbx == 0) |
| tempbx = Panel_1024x768; /* default */ |
| |
| /* LCD75 */ |
| if ((tempbx == Panel_1024x768) || (tempbx == Panel_1280x1024)) { |
| if (pVBInfo->VBInfo & DriverMode) { |
| tempax = xgifb_reg_get(pVBInfo->P3d4, 0x33); |
| if (pVBInfo->VBInfo & XGI_SetCRT2ToLCDA) |
| tempax &= 0x0F; |
| else |
| tempax >>= 4; |
| |
| if ((resinfo == 6) || (resinfo == 9)) { |
| if (tempax >= 3) |
| tempbx |= PanelRef75Hz; |
| } else if ((resinfo == 7) || (resinfo == 8)) { |
| if (tempax >= 4) |
| tempbx |= PanelRef75Hz; |
| } |
| } |
| } |
| |
| pVBInfo->LCDResInfo = tempbx; |
| |
| /* End of LCD75 */ |
| |
| if (!(pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA))) |
| return 0; |
| |
| tempbx = 0; |
| |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x37); |
| |
| temp &= (ScalingLCD | LCDNonExpanding | LCDSyncBit | SetPWDEnable); |
| |
| tempbx |= temp; |
| |
| LCDIdIndex = XGI_GetLCDCapPtr1(pVBInfo); |
| |
| tempax = pVBInfo->LCDCapList[LCDIdIndex].LCD_Capability; |
| |
| if (((pVBInfo->VBType & VB_SIS302LV) || |
| (pVBInfo->VBType & VB_XGI301C)) && (tempax & XGI_LCDDualLink)) |
| tempbx |= SetLCDDualLink; |
| |
| if ((pVBInfo->LCDResInfo == Panel_1400x1050) && |
| (pVBInfo->VBInfo & SetCRT2ToLCD) && (resinfo == 9) && |
| (!(tempbx & EnableScalingLCD))) |
| /* |
| * set to center in 1280x1024 LCDB |
| * for Panel_1400x1050 |
| */ |
| tempbx |= SetLCDtoNonExpanding; |
| |
| if (pVBInfo->VBInfo & SetInSlaveMode) { |
| if (pVBInfo->VBInfo & SetNotSimuMode) |
| tempbx |= XGI_LCDVESATiming; |
| } else { |
| tempbx |= XGI_LCDVESATiming; |
| } |
| |
| pVBInfo->LCDInfo = tempbx; |
| |
| return 1; |
| } |
| |
| unsigned char XGI_SearchModeID(unsigned short ModeNo, |
| unsigned short *ModeIdIndex) |
| { |
| for (*ModeIdIndex = 0;; (*ModeIdIndex)++) { |
| if (XGI330_EModeIDTable[*ModeIdIndex].Ext_ModeID == ModeNo) |
| break; |
| if (XGI330_EModeIDTable[*ModeIdIndex].Ext_ModeID == 0xFF) |
| return 0; |
| } |
| |
| return 1; |
| } |
| |
| static unsigned char XG21GPIODataTransfer(unsigned char ujDate) |
| { |
| unsigned char ujRet = 0; |
| unsigned char i = 0; |
| |
| for (i = 0; i < 8; i++) { |
| ujRet <<= 1; |
| ujRet |= (ujDate >> i) & 1; |
| } |
| |
| return ujRet; |
| } |
| |
| /*----------------------------------------------------------------------------*/ |
| /* output */ |
| /* bl[5] : LVDS signal */ |
| /* bl[1] : LVDS backlight */ |
| /* bl[0] : LVDS VDD */ |
| /*----------------------------------------------------------------------------*/ |
| static unsigned char XGI_XG21GetPSCValue(struct vb_device_info *pVBInfo) |
| { |
| unsigned char CR4A, temp; |
| |
| CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A); |
| xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~0x23); /* enable GPIO write */ |
| |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x48); |
| |
| temp = XG21GPIODataTransfer(temp); |
| temp &= 0x23; |
| xgifb_reg_set(pVBInfo->P3d4, 0x4A, CR4A); |
| return temp; |
| } |
| |
| /*----------------------------------------------------------------------------*/ |
| /* output */ |
| /* bl[5] : LVDS signal */ |
| /* bl[1] : LVDS backlight */ |
| /* bl[0] : LVDS VDD */ |
| /*----------------------------------------------------------------------------*/ |
| static unsigned char XGI_XG27GetPSCValue(struct vb_device_info *pVBInfo) |
| { |
| unsigned char CR4A, CRB4, temp; |
| |
| CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A); |
| xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~0x0C); /* enable GPIO write */ |
| |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x48); |
| |
| temp &= 0x0C; |
| temp >>= 2; |
| xgifb_reg_set(pVBInfo->P3d4, 0x4A, CR4A); |
| CRB4 = xgifb_reg_get(pVBInfo->P3d4, 0xB4); |
| temp |= ((CRB4 & 0x04) << 3); |
| return temp; |
| } |
| |
| /*----------------------------------------------------------------------------*/ |
| /* input */ |
| /* bl[5] : 1;LVDS signal on */ |
| /* bl[1] : 1;LVDS backlight on */ |
| /* bl[0] : 1:LVDS VDD on */ |
| /* bh: 100000b : clear bit 5, to set bit5 */ |
| /* 000010b : clear bit 1, to set bit1 */ |
| /* 000001b : clear bit 0, to set bit0 */ |
| /*----------------------------------------------------------------------------*/ |
| static void XGI_XG21BLSignalVDD(unsigned short tempbh, unsigned short tempbl, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char CR4A, temp; |
| |
| CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A); |
| tempbh &= 0x23; |
| tempbl &= 0x23; |
| xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~tempbh); /* enable GPIO write */ |
| |
| if (tempbh & 0x20) { |
| temp = (tempbl >> 4) & 0x02; |
| |
| /* CR B4[1] */ |
| xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~0x02, temp); |
| |
| } |
| |
| temp = xgifb_reg_get(pVBInfo->P3d4, 0x48); |
| |
| temp = XG21GPIODataTransfer(temp); |
| temp &= ~tempbh; |
| temp |= tempbl; |
| xgifb_reg_set(pVBInfo->P3d4, 0x48, temp); |
| } |
| |
| static void XGI_XG27BLSignalVDD(unsigned short tempbh, unsigned short tempbl, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char CR4A, temp; |
| unsigned short tempbh0, tempbl0; |
| |
| tempbh0 = tempbh; |
| tempbl0 = tempbl; |
| tempbh0 &= 0x20; |
| tempbl0 &= 0x20; |
| tempbh0 >>= 3; |
| tempbl0 >>= 3; |
| |
| if (tempbh & 0x20) { |
| temp = (tempbl >> 4) & 0x02; |
| |
| /* CR B4[1] */ |
| xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~0x02, temp); |
| |
| } |
| xgifb_reg_and_or(pVBInfo->P3d4, 0xB4, ~tempbh0, tempbl0); |
| |
| CR4A = xgifb_reg_get(pVBInfo->P3d4, 0x4A); |
| tempbh &= 0x03; |
| tempbl &= 0x03; |
| tempbh <<= 2; |
| tempbl <<= 2; /* GPIOC,GPIOD */ |
| xgifb_reg_and(pVBInfo->P3d4, 0x4A, ~tempbh); /* enable GPIO write */ |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x48, ~tempbh, tempbl); |
| } |
| |
| static void XGI_DisplayOn(struct xgifb_video_info *xgifb_info, |
| struct xgi_hw_device_info *pXGIHWDE, |
| struct vb_device_info *pVBInfo) |
| { |
| |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xDF, 0x00); |
| if (pXGIHWDE->jChipType == XG21) { |
| if (pVBInfo->IF_DEF_LVDS == 1) { |
| if (!(XGI_XG21GetPSCValue(pVBInfo) & 0x1)) { |
| /* LVDS VDD on */ |
| XGI_XG21BLSignalVDD(0x01, 0x01, pVBInfo); |
| mdelay(xgifb_info->lvds_data.PSC_S2); |
| } |
| if (!(XGI_XG21GetPSCValue(pVBInfo) & 0x20)) |
| /* LVDS signal on */ |
| XGI_XG21BLSignalVDD(0x20, 0x20, pVBInfo); |
| mdelay(xgifb_info->lvds_data.PSC_S3); |
| /* LVDS backlight on */ |
| XGI_XG21BLSignalVDD(0x02, 0x02, pVBInfo); |
| } else { |
| /* DVO/DVI signal on */ |
| XGI_XG21BLSignalVDD(0x20, 0x20, pVBInfo); |
| } |
| |
| } |
| |
| if (pXGIHWDE->jChipType == XG27) { |
| if (pVBInfo->IF_DEF_LVDS == 1) { |
| if (!(XGI_XG27GetPSCValue(pVBInfo) & 0x1)) { |
| /* LVDS VDD on */ |
| XGI_XG27BLSignalVDD(0x01, 0x01, pVBInfo); |
| mdelay(xgifb_info->lvds_data.PSC_S2); |
| } |
| if (!(XGI_XG27GetPSCValue(pVBInfo) & 0x20)) |
| /* LVDS signal on */ |
| XGI_XG27BLSignalVDD(0x20, 0x20, pVBInfo); |
| mdelay(xgifb_info->lvds_data.PSC_S3); |
| /* LVDS backlight on */ |
| XGI_XG27BLSignalVDD(0x02, 0x02, pVBInfo); |
| } else { |
| /* DVO/DVI signal on */ |
| XGI_XG27BLSignalVDD(0x20, 0x20, pVBInfo); |
| } |
| |
| } |
| } |
| |
| void XGI_DisplayOff(struct xgifb_video_info *xgifb_info, |
| struct xgi_hw_device_info *pXGIHWDE, |
| struct vb_device_info *pVBInfo) |
| { |
| |
| if (pXGIHWDE->jChipType == XG21) { |
| if (pVBInfo->IF_DEF_LVDS == 1) { |
| /* LVDS backlight off */ |
| XGI_XG21BLSignalVDD(0x02, 0x00, pVBInfo); |
| mdelay(xgifb_info->lvds_data.PSC_S3); |
| } else { |
| /* DVO/DVI signal off */ |
| XGI_XG21BLSignalVDD(0x20, 0x00, pVBInfo); |
| } |
| } |
| |
| if (pXGIHWDE->jChipType == XG27) { |
| if ((XGI_XG27GetPSCValue(pVBInfo) & 0x2)) { |
| /* LVDS backlight off */ |
| XGI_XG27BLSignalVDD(0x02, 0x00, pVBInfo); |
| mdelay(xgifb_info->lvds_data.PSC_S3); |
| } |
| |
| if (pVBInfo->IF_DEF_LVDS == 0) |
| /* DVO/DVI signal off */ |
| XGI_XG27BLSignalVDD(0x20, 0x00, pVBInfo); |
| } |
| |
| xgifb_reg_and_or(pVBInfo->P3c4, 0x01, 0xDF, 0x20); |
| } |
| |
| static void XGI_WaitDisply(struct vb_device_info *pVBInfo) |
| { |
| while ((inb(pVBInfo->P3da) & 0x01)) |
| break; |
| |
| while (!(inb(pVBInfo->P3da) & 0x01)) |
| break; |
| } |
| |
| static void XGI_AutoThreshold(struct vb_device_info *pVBInfo) |
| { |
| xgifb_reg_or(pVBInfo->Part1Port, 0x01, 0x40); |
| } |
| |
| static void XGI_SaveCRT2Info(unsigned short ModeNo, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short temp1, temp2; |
| |
| /* reserve CR34 for CRT1 Mode No */ |
| xgifb_reg_set(pVBInfo->P3d4, 0x34, ModeNo); |
| temp1 = (pVBInfo->VBInfo & SetInSlaveMode) >> 8; |
| temp2 = ~(SetInSlaveMode >> 8); |
| xgifb_reg_and_or(pVBInfo->P3d4, 0x31, temp2, temp1); |
| } |
| |
| static void XGI_GetCRT2ResInfo(unsigned short ModeIdIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short xres, yres, modeflag, resindex; |
| |
| resindex = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| xres = XGI330_ModeResInfo[resindex].HTotal; /* xres->ax */ |
| yres = XGI330_ModeResInfo[resindex].VTotal; /* yres->bx */ |
| /* si+St_ModeFlag */ |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| |
| if (modeflag & HalfDCLK) |
| xres *= 2; |
| |
| if (modeflag & DoubleScanMode) |
| yres *= 2; |
| |
| if (!(pVBInfo->VBInfo & SetCRT2ToLCD)) |
| goto exit; |
| |
| if (pVBInfo->LCDResInfo == Panel_1600x1200) { |
| if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) { |
| if (yres == 1024) |
| yres = 1056; |
| } |
| } |
| |
| if (pVBInfo->LCDResInfo == Panel_1280x1024) { |
| if (yres == 400) |
| yres = 405; |
| else if (yres == 350) |
| yres = 360; |
| |
| if (pVBInfo->LCDInfo & XGI_LCDVESATiming) { |
| if (yres == 360) |
| yres = 375; |
| } |
| } |
| |
| if (pVBInfo->LCDResInfo == Panel_1024x768) { |
| if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) { |
| if (!(pVBInfo->LCDInfo & LCDNonExpanding)) { |
| if (yres == 350) |
| yres = 357; |
| else if (yres == 400) |
| yres = 420; |
| else if (yres == 480) |
| yres = 525; |
| } |
| } |
| } |
| |
| if (xres == 720) |
| xres = 640; |
| |
| exit: |
| pVBInfo->VGAHDE = xres; |
| pVBInfo->HDE = xres; |
| pVBInfo->VGAVDE = yres; |
| pVBInfo->VDE = yres; |
| } |
| |
| static unsigned char XGI_IsLCDDualLink(struct vb_device_info *pVBInfo) |
| { |
| |
| if ((pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) && |
| (pVBInfo->LCDInfo & SetLCDDualLink)) /* shampoo0129 */ |
| return 1; |
| |
| return 0; |
| } |
| |
| static void XGI_GetRAMDAC2DATA(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempax, tempbx, temp1, temp2, modeflag = 0, tempcx, |
| CRT1Index; |
| |
| pVBInfo->RVBHCMAX = 1; |
| pVBInfo->RVBHCFACT = 1; |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| CRT1Index = XGI330_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC; |
| CRT1Index &= IndexMask; |
| temp1 = (unsigned short) XGI_CRT1Table[CRT1Index].CR[0]; |
| temp2 = (unsigned short) XGI_CRT1Table[CRT1Index].CR[5]; |
| tempax = (temp1 & 0xFF) | ((temp2 & 0x03) << 8); |
| tempbx = (unsigned short) XGI_CRT1Table[CRT1Index].CR[8]; |
| tempcx = (unsigned short) |
| XGI_CRT1Table[CRT1Index].CR[14] << 8; |
| tempcx &= 0x0100; |
| tempcx <<= 2; |
| tempbx |= tempcx; |
| temp1 = (unsigned short) XGI_CRT1Table[CRT1Index].CR[9]; |
| |
| if (temp1 & 0x01) |
| tempbx |= 0x0100; |
| |
| if (temp1 & 0x20) |
| tempbx |= 0x0200; |
| tempax += 5; |
| |
| if (modeflag & Charx8Dot) |
| tempax *= 8; |
| else |
| tempax *= 9; |
| |
| pVBInfo->VGAHT = tempax; |
| pVBInfo->HT = tempax; |
| tempbx++; |
| pVBInfo->VGAVT = tempbx; |
| pVBInfo->VT = tempbx; |
| } |
| |
| static void XGI_GetCRT2Data(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short tempax = 0, tempbx = 0, modeflag, resinfo; |
| |
| struct SiS_LCDData const *LCDPtr = NULL; |
| |
| /* si+Ext_ResInfo */ |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| resinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_RESINFO; |
| pVBInfo->NewFlickerMode = 0; |
| pVBInfo->RVBHRS = 50; |
| |
| if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) { |
| XGI_GetRAMDAC2DATA(ModeIdIndex, RefreshRateTableIndex, pVBInfo); |
| return; |
| } |
| |
| if (pVBInfo->VBInfo & (SetCRT2ToLCD | XGI_SetCRT2ToLCDA)) { |
| LCDPtr = XGI_GetLcdPtr(XGI_LCDDataTable, ModeIdIndex, |
| pVBInfo); |
| |
| pVBInfo->RVBHCMAX = LCDPtr->RVBHCMAX; |
| pVBInfo->RVBHCFACT = LCDPtr->RVBHCFACT; |
| pVBInfo->VGAHT = LCDPtr->VGAHT; |
| pVBInfo->VGAVT = LCDPtr->VGAVT; |
| pVBInfo->HT = LCDPtr->LCDHT; |
| pVBInfo->VT = LCDPtr->LCDVT; |
| |
| if (pVBInfo->LCDResInfo == Panel_1024x768) { |
| tempax = 1024; |
| tempbx = 768; |
| |
| if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) { |
| if (pVBInfo->VGAVDE == 357) |
| tempbx = 527; |
| else if (pVBInfo->VGAVDE == 420) |
| tempbx = 620; |
| else if (pVBInfo->VGAVDE == 525) |
| tempbx = 775; |
| else if (pVBInfo->VGAVDE == 600) |
| tempbx = 775; |
| } |
| } else if (pVBInfo->LCDResInfo == Panel_1024x768x75) { |
| tempax = 1024; |
| tempbx = 768; |
| } else if (pVBInfo->LCDResInfo == Panel_1280x1024) { |
| tempax = 1280; |
| if (pVBInfo->VGAVDE == 360) |
| tempbx = 768; |
| else if (pVBInfo->VGAVDE == 375) |
| tempbx = 800; |
| else if (pVBInfo->VGAVDE == 405) |
| tempbx = 864; |
| else |
| tempbx = 1024; |
| } else if (pVBInfo->LCDResInfo == Panel_1280x1024x75) { |
| tempax = 1280; |
| tempbx = 1024; |
| } else if (pVBInfo->LCDResInfo == Panel_1280x960) { |
| tempax = 1280; |
| if (pVBInfo->VGAVDE == 350) |
| tempbx = 700; |
| else if (pVBInfo->VGAVDE == 400) |
| tempbx = 800; |
| else if (pVBInfo->VGAVDE == 1024) |
| tempbx = 960; |
| else |
| tempbx = 960; |
| } else if (pVBInfo->LCDResInfo == Panel_1400x1050) { |
| tempax = 1400; |
| tempbx = 1050; |
| |
| if (pVBInfo->VGAVDE == 1024) { |
| tempax = 1280; |
| tempbx = 1024; |
| } |
| } else if (pVBInfo->LCDResInfo == Panel_1600x1200) { |
| tempax = 1600; |
| tempbx = 1200; /* alan 10/14/2003 */ |
| if (!(pVBInfo->LCDInfo & XGI_LCDVESATiming)) { |
| if (pVBInfo->VGAVDE == 350) |
| tempbx = 875; |
| else if (pVBInfo->VGAVDE == 400) |
| tempbx = 1000; |
| } |
| } |
| |
| if (pVBInfo->LCDInfo & LCDNonExpanding) { |
| tempax = pVBInfo->VGAHDE; |
| tempbx = pVBInfo->VGAVDE; |
| } |
| |
| pVBInfo->HDE = tempax; |
| pVBInfo->VDE = tempbx; |
| return; |
| } |
| |
| if (pVBInfo->VBInfo & (SetCRT2ToTV)) { |
| struct SiS_TVData const *TVPtr; |
| |
| TVPtr = XGI_GetTVPtr(ModeIdIndex, RefreshRateTableIndex, |
| pVBInfo); |
| |
| pVBInfo->RVBHCMAX = TVPtr->RVBHCMAX; |
| pVBInfo->RVBHCFACT = TVPtr->RVBHCFACT; |
| pVBInfo->VGAHT = TVPtr->VGAHT; |
| pVBInfo->VGAVT = TVPtr->VGAVT; |
| pVBInfo->HDE = TVPtr->TVHDE; |
| pVBInfo->VDE = TVPtr->TVVDE; |
| pVBInfo->RVBHRS = TVPtr->RVBHRS; |
| pVBInfo->NewFlickerMode = TVPtr->FlickerMode; |
| |
| if (pVBInfo->VBInfo & SetCRT2ToHiVision) { |
| if (resinfo == 0x08) |
| pVBInfo->NewFlickerMode = 0x40; |
| else if (resinfo == 0x09) |
| pVBInfo->NewFlickerMode = 0x40; |
| else if (resinfo == 0x12) |
| pVBInfo->NewFlickerMode = 0x40; |
| |
| if (pVBInfo->VGAVDE == 350) |
| pVBInfo->TVInfo |= TVSimuMode; |
| |
| tempax = ExtHiTVHT; |
| tempbx = ExtHiTVVT; |
| |
| if (pVBInfo->VBInfo & SetInSlaveMode) { |
| if (pVBInfo->TVInfo & TVSimuMode) { |
| tempax = StHiTVHT; |
| tempbx = StHiTVVT; |
| |
| if (!(modeflag & Charx8Dot)) { |
| tempax = StHiTextTVHT; |
| tempbx = StHiTextTVVT; |
| } |
| } |
| } |
| } else if (pVBInfo->VBInfo & SetCRT2ToYPbPr525750) { |
| if (pVBInfo->TVInfo & TVSetYPbPr750p) { |
| tempax = YPbPrTV750pHT; /* Ext750pTVHT */ |
| tempbx = YPbPrTV750pVT; /* Ext750pTVVT */ |
| } |
| |
| if (pVBInfo->TVInfo & TVSetYPbPr525p) { |
| tempax = YPbPrTV525pHT; /* Ext525pTVHT */ |
| tempbx = YPbPrTV525pVT; /* Ext525pTVVT */ |
| } else if (pVBInfo->TVInfo & TVSetYPbPr525i) { |
| tempax = YPbPrTV525iHT; /* Ext525iTVHT */ |
| tempbx = YPbPrTV525iVT; /* Ext525iTVVT */ |
| if (pVBInfo->TVInfo & NTSC1024x768) |
| tempax = NTSC1024x768HT; |
| } |
| } else { |
| tempax = PALHT; |
| tempbx = PALVT; |
| if (!(pVBInfo->TVInfo & TVSetPAL)) { |
| tempax = NTSCHT; |
| tempbx = NTSCVT; |
| if (pVBInfo->TVInfo & NTSC1024x768) |
| tempax = NTSC1024x768HT; |
| } |
| } |
| |
| pVBInfo->HT = tempax; |
| pVBInfo->VT = tempbx; |
| } |
| } |
| |
| static void XGI_SetCRT2VCLK(unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned char di_0, di_1, tempal; |
| |
| tempal = XGI_GetVCLKPtr(RefreshRateTableIndex, ModeIdIndex, pVBInfo); |
| XGI_GetVCLKLen(tempal, &di_0, &di_1, pVBInfo); |
| XGI_GetLCDVCLKPtr(&di_0, &di_1, pVBInfo); |
| |
| if (pVBInfo->VBType & VB_SIS301) { /* shampoo 0129 */ |
| /* 301 */ |
| xgifb_reg_set(pVBInfo->Part4Port, 0x0A, 0x10); |
| xgifb_reg_set(pVBInfo->Part4Port, 0x0B, di_1); |
| xgifb_reg_set(pVBInfo->Part4Port, 0x0A, di_0); |
| } else { /* 301b/302b/301lv/302lv */ |
| xgifb_reg_set(pVBInfo->Part4Port, 0x0A, di_0); |
| xgifb_reg_set(pVBInfo->Part4Port, 0x0B, di_1); |
| } |
| |
| xgifb_reg_set(pVBInfo->Part4Port, 0x00, 0x12); |
| |
| if (pVBInfo->VBInfo & SetCRT2ToRAMDAC) |
| xgifb_reg_or(pVBInfo->Part4Port, 0x12, 0x28); |
| else |
| xgifb_reg_or(pVBInfo->Part4Port, 0x12, 0x08); |
| } |
| |
| static unsigned short XGI_GetColorDepth(unsigned short ModeIdIndex) |
| { |
| unsigned short ColorDepth[6] = { 1, 2, 4, 4, 6, 8 }; |
| short index; |
| unsigned short modeflag; |
| |
| modeflag = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeFlag; |
| index = (modeflag & ModeTypeMask) - ModeEGA; |
| |
| if (index < 0) |
| index = 0; |
| |
| return ColorDepth[index]; |
| } |
| |
| static unsigned short XGI_GetOffset(unsigned short ModeNo, |
| unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex) |
| { |
| unsigned short temp, colordepth, modeinfo, index, infoflag, |
| ColorDepth[] = { 0x01, 0x02, 0x04 }; |
| |
| modeinfo = XGI330_EModeIDTable[ModeIdIndex].Ext_ModeInfo; |
| infoflag = XGI330_RefIndex[RefreshRateTableIndex].Ext_InfoFlag; |
| |
| index = (modeinfo >> 8) & 0xFF; |
| |
| temp = XGI330_ScreenOffset[index]; |
| |
| if (infoflag & InterlaceMode) |
| temp <<= 1; |
| |
| colordepth = XGI_GetColorDepth(ModeIdIndex); |
| |
| if ((ModeNo >= 0x7C) && (ModeNo <= 0x7E)) { |
| temp = ModeNo - 0x7C; |
| colordepth = ColorDepth[temp]; |
| temp = 0x6B; |
| if (infoflag & InterlaceMode) |
| temp <<= 1; |
| } |
| return temp * colordepth; |
| } |
| |
| static void XGI_SetCRT2Offset(unsigned short ModeNo, |
| unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| unsigned short offset; |
| unsigned char temp; |
| |
| if (pVBInfo->VBInfo & SetInSlaveMode) |
| return; |
| |
| offset = XGI_GetOffset(ModeNo, ModeIdIndex, RefreshRateTableIndex); |
| temp = (unsigned char) (offset & 0xFF); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x07, temp); |
| temp = (unsigned char) ((offset & 0xFF00) >> 8); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x09, temp); |
| temp = (unsigned char) (((offset >> 3) & 0xFF) + 1); |
| xgifb_reg_set(pVBInfo->Part1Port, 0x03, temp); |
| } |
| |
| static void XGI_SetCRT2FIFO(struct vb_device_info *pVBInfo) |
| { |
| /* threshold high ,disable auto threshold */ |
| xgifb_reg_set(pVBInfo->Part1Port, 0x01, 0x3B); |
| /* threshold low default 04h */ |
| xgifb_reg_and_or(pVBInfo->Part1Port, 0x02, ~(0x3F), 0x04); |
| } |
| |
| static void XGI_PreSetGroup1(unsigned short ModeNo, unsigned short ModeIdIndex, |
| unsigned short RefreshRateTableIndex, |
| struct vb_device_info *pVBInfo) |
| { |
| u8 tempcx; |
| |
| XGI_SetCRT2Offset(ModeNo, ModeIdIndex, RefreshRateTableIndex, pVBInfo); |
| XGI_SetCRT2FIFO(pVBInfo); |
| |
| for (tempcx = 4; tempcx < 7; tempcx++) |
| xgifb_reg_set(pVBInfo->Part1Port, tempcx, 0x0); |
|