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