ecfd72178dbb3fce2cc0d8b9d9b8b338b9dbcc3e
[linux-2.6.git] / drivers / video / sis / init.c
1 /* $XFree86$ */
2 /* $XdotOrg$ */
3 /*
4  * Mode initializing code (CRT1 section) for
5  * for SiS 300/305/540/630/730 and
6  *     SiS 315/550/650/M650/651/661FX/M661FX/740/741(GX)/M741/330/660/M660/760/M760
7  * (Universal module for Linux kernel framebuffer and XFree86 4.x)
8  *
9  * Copyright (C) 2001-2004 by Thomas Winischhofer, Vienna, Austria
10  *
11  * If distributed as part of the Linux kernel, the following license terms
12  * apply:
13  *
14  * * This program is free software; you can redistribute it and/or modify
15  * * it under the terms of the GNU General Public License as published by
16  * * the Free Software Foundation; either version 2 of the named License,
17  * * or any later version.
18  * *
19  * * This program is distributed in the hope that it will be useful,
20  * * but WITHOUT ANY WARRANTY; without even the implied warranty of
21  * * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22  * * GNU General Public License for more details.
23  * *
24  * * You should have received a copy of the GNU General Public License
25  * * along with this program; if not, write to the Free Software
26  * * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
27  *
28  * Otherwise, the following license terms apply:
29  *
30  * * Redistribution and use in source and binary forms, with or without
31  * * modification, are permitted provided that the following conditions
32  * * are met:
33  * * 1) Redistributions of source code must retain the above copyright
34  * *    notice, this list of conditions and the following disclaimer.
35  * * 2) Redistributions in binary form must reproduce the above copyright
36  * *    notice, this list of conditions and the following disclaimer in the
37  * *    documentation and/or other materials provided with the distribution.
38  * * 3) The name of the author may not be used to endorse or promote products
39  * *    derived from this software without specific prior written permission.
40  * *
41  * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
42  * * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
43  * * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
44  * * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
45  * * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
46  * * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
47  * * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
48  * * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
49  * * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
50  * * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
51  *
52  * Author:      Thomas Winischhofer <thomas@winischhofer.net>
53  *
54  * Formerly based on non-functional code-fragements for 300 series by SiS, Inc.
55  * Used by permission.
56  *
57  * TW says: This code looks awful, I know. But please don't do anything about
58  * this otherwise debugging will be hell.
59  * The code is extremely fragile as regards the different chipsets, different
60  * video bridges and combinations thereof. If anything is changed, extreme
61  * care has to be taken that that change doesn't break it for other chipsets,
62  * bridges or combinations thereof.
63  * All comments in this file are by me, regardless if they are marked TW or not.
64  *
65  */
66  
67 #include "init.h"
68
69 #ifdef SIS300
70 #include "300vtbl.h"
71 #endif
72
73 #ifdef SIS315H
74 #include "310vtbl.h"
75 #endif
76
77 #if defined(ALLOC_PRAGMA)
78 #pragma alloc_text(PAGE,SiSSetMode)
79 #endif
80
81 /*********************************************/
82 /*         POINTER INITIALIZATION            */
83 /*********************************************/
84
85 #if defined(SIS300) || defined(SIS315H)
86 static void
87 InitCommonPointer(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
88 {
89    SiS_Pr->SiS_StResInfo     = SiS_StResInfo;
90    SiS_Pr->SiS_ModeResInfo   = SiS_ModeResInfo;
91    SiS_Pr->SiS_StandTable    = SiS_StandTable;
92
93    SiS_Pr->SiS_NTSCPhase     = SiS_NTSCPhase;
94    SiS_Pr->SiS_PALPhase      = SiS_PALPhase;
95    SiS_Pr->SiS_NTSCPhase2    = SiS_NTSCPhase2;
96    SiS_Pr->SiS_PALPhase2     = SiS_PALPhase2;
97    SiS_Pr->SiS_PALMPhase     = SiS_PALMPhase;
98    SiS_Pr->SiS_PALNPhase     = SiS_PALNPhase;
99    SiS_Pr->SiS_PALMPhase2    = SiS_PALMPhase2;
100    SiS_Pr->SiS_PALNPhase2    = SiS_PALNPhase2;
101    SiS_Pr->SiS_SpecialPhase  = SiS_SpecialPhase;
102    SiS_Pr->SiS_SpecialPhaseM = SiS_SpecialPhaseM;
103    SiS_Pr->SiS_SpecialPhaseJ = SiS_SpecialPhaseJ;
104
105    SiS_Pr->SiS_NTSCTiming     = SiS_NTSCTiming;
106    SiS_Pr->SiS_PALTiming      = SiS_PALTiming;
107    SiS_Pr->SiS_HiTVSt1Timing  = SiS_HiTVSt1Timing;
108    SiS_Pr->SiS_HiTVSt2Timing  = SiS_HiTVSt2Timing;
109
110    SiS_Pr->SiS_HiTVExtTiming  = SiS_HiTVExtTiming;
111    SiS_Pr->SiS_HiTVGroup3Data = SiS_HiTVGroup3Data;
112    SiS_Pr->SiS_HiTVGroup3Simu = SiS_HiTVGroup3Simu;
113 #if 0
114    SiS_Pr->SiS_HiTVTextTiming = SiS_HiTVTextTiming;
115    SiS_Pr->SiS_HiTVGroup3Text = SiS_HiTVGroup3Text;
116 #endif
117
118    SiS_Pr->SiS_StPALData   = SiS_StPALData;
119    SiS_Pr->SiS_ExtPALData  = SiS_ExtPALData;
120    SiS_Pr->SiS_StNTSCData  = SiS_StNTSCData;
121    SiS_Pr->SiS_ExtNTSCData = SiS_ExtNTSCData;
122    SiS_Pr->SiS_St1HiTVData = SiS_StHiTVData;
123    SiS_Pr->SiS_St2HiTVData = SiS_St2HiTVData;
124    SiS_Pr->SiS_ExtHiTVData = SiS_ExtHiTVData;
125    SiS_Pr->SiS_St525iData  = SiS_StNTSCData;
126    SiS_Pr->SiS_St525pData  = SiS_St525pData;
127    SiS_Pr->SiS_St750pData  = SiS_St750pData;
128    SiS_Pr->SiS_Ext525iData = SiS_ExtNTSCData;
129    SiS_Pr->SiS_Ext525pData = SiS_ExtNTSCData;
130    SiS_Pr->SiS_Ext750pData = SiS_Ext750pData;
131
132    SiS_Pr->pSiS_OutputSelect = &SiS_OutputSelect;
133    SiS_Pr->pSiS_SoftSetting  = &SiS_SoftSetting;
134
135    SiS_Pr->SiS_LCD1280x720Data      = SiS_LCD1280x720Data;
136    SiS_Pr->SiS_StLCD1280x768_2Data  = SiS_StLCD1280x768_2Data;
137    SiS_Pr->SiS_ExtLCD1280x768_2Data = SiS_ExtLCD1280x768_2Data;
138    SiS_Pr->SiS_LCD1280x800Data      = SiS_LCD1280x800Data;
139    SiS_Pr->SiS_LCD1280x800_2Data    = SiS_LCD1280x800_2Data;
140    SiS_Pr->SiS_LCD1280x960Data      = SiS_LCD1280x960Data;
141    SiS_Pr->SiS_StLCD1400x1050Data   = SiS_StLCD1400x1050Data;
142    SiS_Pr->SiS_ExtLCD1400x1050Data  = SiS_ExtLCD1400x1050Data;
143    SiS_Pr->SiS_LCD1680x1050Data     = SiS_LCD1680x1050Data;
144    SiS_Pr->SiS_StLCD1600x1200Data   = SiS_StLCD1600x1200Data;
145    SiS_Pr->SiS_ExtLCD1600x1200Data  = SiS_ExtLCD1600x1200Data;
146    SiS_Pr->SiS_NoScaleData          = SiS_NoScaleData;
147
148    SiS_Pr->SiS_LVDS320x480Data_1   = SiS_LVDS320x480Data_1;
149    SiS_Pr->SiS_LVDS800x600Data_1   = SiS_LVDS800x600Data_1;
150    SiS_Pr->SiS_LVDS800x600Data_2   = SiS_LVDS800x600Data_2;
151    SiS_Pr->SiS_LVDS1024x768Data_1  = SiS_LVDS1024x768Data_1;
152    SiS_Pr->SiS_LVDS1024x768Data_2  = SiS_LVDS1024x768Data_2;
153    SiS_Pr->SiS_LVDS1280x1024Data_1 = SiS_LVDS1280x1024Data_1;
154    SiS_Pr->SiS_LVDS1280x1024Data_2 = SiS_LVDS1280x1024Data_2;
155    SiS_Pr->SiS_LVDS1400x1050Data_1 = SiS_LVDS1400x1050Data_1;
156    SiS_Pr->SiS_LVDS1400x1050Data_2 = SiS_LVDS1400x1050Data_2;
157    SiS_Pr->SiS_LVDS1600x1200Data_1 = SiS_LVDS1600x1200Data_1;
158    SiS_Pr->SiS_LVDS1600x1200Data_2 = SiS_LVDS1600x1200Data_2;
159    SiS_Pr->SiS_LVDS1280x768Data_1  = SiS_LVDS1280x768Data_1;
160    SiS_Pr->SiS_LVDS1280x768Data_2  = SiS_LVDS1280x768Data_2;
161    SiS_Pr->SiS_LVDS1024x600Data_1  = SiS_LVDS1024x600Data_1;
162    SiS_Pr->SiS_LVDS1024x600Data_2  = SiS_LVDS1024x600Data_2;
163    SiS_Pr->SiS_LVDS1152x768Data_1  = SiS_LVDS1152x768Data_1;
164    SiS_Pr->SiS_LVDS1152x768Data_2  = SiS_LVDS1152x768Data_2;
165    SiS_Pr->SiS_LVDSXXXxXXXData_1   = SiS_LVDSXXXxXXXData_1;
166    SiS_Pr->SiS_LVDS1280x960Data_1  = SiS_LVDS1280x960Data_1;
167    SiS_Pr->SiS_LVDS1280x960Data_2  = SiS_LVDS1280x960Data_2;
168    SiS_Pr->SiS_LVDS640x480Data_1   = SiS_LVDS640x480Data_1;
169    SiS_Pr->SiS_LVDS1280x960Data_1  = SiS_LVDS1280x1024Data_1;
170    SiS_Pr->SiS_LVDS1280x960Data_2  = SiS_LVDS1280x1024Data_2;
171    SiS_Pr->SiS_LVDS640x480Data_1   = SiS_LVDS640x480Data_1;
172    SiS_Pr->SiS_LVDS640x480Data_2   = SiS_LVDS640x480Data_2;
173
174    SiS_Pr->SiS_LVDS848x480Data_1   = SiS_LVDS848x480Data_1;
175    SiS_Pr->SiS_LVDS848x480Data_2   = SiS_LVDS848x480Data_2;
176    SiS_Pr->SiS_LVDSBARCO1024Data_1 = SiS_LVDSBARCO1024Data_1;
177    SiS_Pr->SiS_LVDSBARCO1024Data_2 = SiS_LVDSBARCO1024Data_2;
178    SiS_Pr->SiS_LVDSBARCO1366Data_1 = SiS_LVDSBARCO1366Data_1;
179    SiS_Pr->SiS_LVDSBARCO1366Data_2 = SiS_LVDSBARCO1366Data_2;
180
181    SiS_Pr->SiS_LVDSCRT11280x768_1    = SiS_LVDSCRT11280x768_1;
182    SiS_Pr->SiS_LVDSCRT11024x600_1    = SiS_LVDSCRT11024x600_1;
183    SiS_Pr->SiS_LVDSCRT11152x768_1    = SiS_LVDSCRT11152x768_1;
184    SiS_Pr->SiS_LVDSCRT11280x768_1_H  = SiS_LVDSCRT11280x768_1_H;
185    SiS_Pr->SiS_LVDSCRT11024x600_1_H  = SiS_LVDSCRT11024x600_1_H;
186    SiS_Pr->SiS_LVDSCRT11152x768_1_H  = SiS_LVDSCRT11152x768_1_H;
187    SiS_Pr->SiS_LVDSCRT11280x768_2    = SiS_LVDSCRT11280x768_2;
188    SiS_Pr->SiS_LVDSCRT11024x600_2    = SiS_LVDSCRT11024x600_2;
189    SiS_Pr->SiS_LVDSCRT11152x768_2    = SiS_LVDSCRT11152x768_2;
190    SiS_Pr->SiS_LVDSCRT11280x768_2_H  = SiS_LVDSCRT11280x768_2_H;
191    SiS_Pr->SiS_LVDSCRT11024x600_2_H  = SiS_LVDSCRT11024x600_2_H;
192    SiS_Pr->SiS_LVDSCRT11152x768_2_H  = SiS_LVDSCRT11152x768_2_H;
193    SiS_Pr->SiS_LVDSCRT1320x480_1     = SiS_LVDSCRT1320x480_1;
194    SiS_Pr->SiS_LVDSCRT1640x480_1     = SiS_LVDSCRT1640x480_1;
195    SiS_Pr->SiS_LVDSCRT1640x480_1_H   = SiS_LVDSCRT1640x480_1_H;
196    SiS_Pr->SiS_LVDSCRT1640x480_2     = SiS_LVDSCRT1640x480_2;
197    SiS_Pr->SiS_LVDSCRT1640x480_2_H   = SiS_LVDSCRT1640x480_2_H;
198    SiS_Pr->SiS_LVDSCRT1640x480_3     = SiS_LVDSCRT1640x480_3;
199    SiS_Pr->SiS_LVDSCRT1640x480_3_H   = SiS_LVDSCRT1640x480_3_H;
200
201    SiS_Pr->SiS_CHTVUNTSCData = SiS_CHTVUNTSCData;
202    SiS_Pr->SiS_CHTVONTSCData = SiS_CHTVONTSCData;
203
204    SiS_Pr->SiS_CHTVUNTSCDesData = SiS_CHTVUNTSCDesData;
205    SiS_Pr->SiS_CHTVONTSCDesData = SiS_CHTVONTSCDesData;
206    SiS_Pr->SiS_CHTVUPALDesData  = SiS_CHTVUPALDesData;
207    SiS_Pr->SiS_CHTVOPALDesData  = SiS_CHTVOPALDesData;
208
209    SiS_Pr->SiS_PanelMinLVDS   = Panel_800x600;    /* lowest value LVDS/LCDA */
210    SiS_Pr->SiS_PanelMin301    = Panel_1024x768;   /* lowest value 301 */
211 }
212 #endif
213
214 #ifdef SIS300
215 static void
216 InitTo300Pointer(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
217 {
218    InitCommonPointer(SiS_Pr, HwInfo);
219
220    SiS_Pr->SiS_SModeIDTable  = SiS300_SModeIDTable;
221    SiS_Pr->SiS_VBModeIDTable = SiS300_VBModeIDTable;
222    SiS_Pr->SiS_EModeIDTable  = SiS300_EModeIDTable;
223    SiS_Pr->SiS_RefIndex      = SiS300_RefIndex;
224    SiS_Pr->SiS_CRT1Table     = SiS300_CRT1Table;
225    if(HwInfo->jChipType == SIS_300) {
226       SiS_Pr->SiS_MCLKData_0    = SiS300_MCLKData_300; /* 300 */
227    } else {
228       SiS_Pr->SiS_MCLKData_0    = SiS300_MCLKData_630; /* 630, 730 */
229    }
230    SiS_Pr->SiS_VCLKData      = SiS300_VCLKData;
231    SiS_Pr->SiS_VBVCLKData    = (SiS_VBVCLKDataStruct *)SiS300_VCLKData;
232
233    SiS_Pr->SiS_SR15  = SiS300_SR15;
234
235 #ifdef LINUX_KERNEL
236    SiS_Pr->pSiS_SR07 = &SiS300_SR07;
237    SiS_Pr->SiS_CR40  = SiS300_CR40;
238    SiS_Pr->SiS_CR49  = SiS300_CR49;
239    SiS_Pr->pSiS_SR1F = &SiS300_SR1F;
240    SiS_Pr->pSiS_SR21 = &SiS300_SR21;
241    SiS_Pr->pSiS_SR22 = &SiS300_SR22;
242    SiS_Pr->pSiS_SR23 = &SiS300_SR23;
243    SiS_Pr->pSiS_SR24 = &SiS300_SR24;
244    SiS_Pr->SiS_SR25  = SiS300_SR25;
245    SiS_Pr->pSiS_SR31 = &SiS300_SR31;
246    SiS_Pr->pSiS_SR32 = &SiS300_SR32;
247    SiS_Pr->pSiS_SR33 = &SiS300_SR33;
248    SiS_Pr->pSiS_CRT2Data_1_2  = &SiS300_CRT2Data_1_2;
249    SiS_Pr->pSiS_CRT2Data_4_D  = &SiS300_CRT2Data_4_D;
250    SiS_Pr->pSiS_CRT2Data_4_E  = &SiS300_CRT2Data_4_E;
251    SiS_Pr->pSiS_CRT2Data_4_10 = &SiS300_CRT2Data_4_10;
252    SiS_Pr->pSiS_RGBSenseData    = &SiS300_RGBSenseData;
253    SiS_Pr->pSiS_VideoSenseData  = &SiS300_VideoSenseData;
254    SiS_Pr->pSiS_YCSenseData     = &SiS300_YCSenseData;
255    SiS_Pr->pSiS_RGBSenseData2   = &SiS300_RGBSenseData2;
256    SiS_Pr->pSiS_VideoSenseData2 = &SiS300_VideoSenseData2;
257    SiS_Pr->pSiS_YCSenseData2    = &SiS300_YCSenseData2;
258 #endif
259
260    SiS_Pr->SiS_PanelDelayTbl     = SiS300_PanelDelayTbl;
261    SiS_Pr->SiS_PanelDelayTblLVDS = SiS300_PanelDelayTbl;
262
263    SiS_Pr->SiS_ExtLCD1024x768Data   = SiS300_ExtLCD1024x768Data;
264    SiS_Pr->SiS_St2LCD1024x768Data   = SiS300_St2LCD1024x768Data;
265    SiS_Pr->SiS_ExtLCD1280x1024Data  = SiS300_ExtLCD1280x1024Data;
266    SiS_Pr->SiS_St2LCD1280x1024Data  = SiS300_St2LCD1280x1024Data;
267
268    SiS_Pr->SiS_CRT2Part2_1024x768_1  = SiS300_CRT2Part2_1024x768_1;
269    SiS_Pr->SiS_CRT2Part2_1280x1024_1 = SiS300_CRT2Part2_1280x1024_1;
270    SiS_Pr->SiS_CRT2Part2_1024x768_2  = SiS300_CRT2Part2_1024x768_2;
271    SiS_Pr->SiS_CRT2Part2_1280x1024_2 = SiS300_CRT2Part2_1280x1024_2;
272    SiS_Pr->SiS_CRT2Part2_1024x768_3  = SiS300_CRT2Part2_1024x768_3;
273    SiS_Pr->SiS_CRT2Part2_1280x1024_3 = SiS300_CRT2Part2_1280x1024_3;
274
275    SiS_Pr->SiS_CHTVUPALData  = SiS300_CHTVUPALData;
276    SiS_Pr->SiS_CHTVOPALData  = SiS300_CHTVOPALData;
277    SiS_Pr->SiS_CHTVUPALMData = SiS_CHTVUNTSCData;    /* not supported on 300 series */
278    SiS_Pr->SiS_CHTVOPALMData = SiS_CHTVONTSCData;    /* not supported on 300 series */
279    SiS_Pr->SiS_CHTVUPALNData = SiS300_CHTVUPALData;  /* not supported on 300 series */
280    SiS_Pr->SiS_CHTVOPALNData = SiS300_CHTVOPALData;  /* not supported on 300 series */
281    SiS_Pr->SiS_CHTVSOPALData = SiS300_CHTVSOPALData;
282
283    SiS_Pr->SiS_PanelType00_1 = SiS300_PanelType00_1;
284    SiS_Pr->SiS_PanelType01_1 = SiS300_PanelType01_1;
285    SiS_Pr->SiS_PanelType02_1 = SiS300_PanelType02_1;
286    SiS_Pr->SiS_PanelType03_1 = SiS300_PanelType03_1;
287    SiS_Pr->SiS_PanelType04_1 = SiS300_PanelType04_1;
288    SiS_Pr->SiS_PanelType05_1 = SiS300_PanelType05_1;
289    SiS_Pr->SiS_PanelType06_1 = SiS300_PanelType06_1;
290    SiS_Pr->SiS_PanelType07_1 = SiS300_PanelType07_1;
291    SiS_Pr->SiS_PanelType08_1 = SiS300_PanelType08_1;
292    SiS_Pr->SiS_PanelType09_1 = SiS300_PanelType09_1;
293    SiS_Pr->SiS_PanelType0a_1 = SiS300_PanelType0a_1;
294    SiS_Pr->SiS_PanelType0b_1 = SiS300_PanelType0b_1;
295    SiS_Pr->SiS_PanelType0c_1 = SiS300_PanelType0c_1;
296    SiS_Pr->SiS_PanelType0d_1 = SiS300_PanelType0d_1;
297    SiS_Pr->SiS_PanelType0e_1 = SiS300_PanelType0e_1;
298    SiS_Pr->SiS_PanelType0f_1 = SiS300_PanelType0f_1;
299    SiS_Pr->SiS_PanelType00_2 = SiS300_PanelType00_2;
300    SiS_Pr->SiS_PanelType01_2 = SiS300_PanelType01_2;
301    SiS_Pr->SiS_PanelType02_2 = SiS300_PanelType02_2;
302    SiS_Pr->SiS_PanelType03_2 = SiS300_PanelType03_2;
303    SiS_Pr->SiS_PanelType04_2 = SiS300_PanelType04_2;
304    SiS_Pr->SiS_PanelType05_2 = SiS300_PanelType05_2;
305    SiS_Pr->SiS_PanelType06_2 = SiS300_PanelType06_2;
306    SiS_Pr->SiS_PanelType07_2 = SiS300_PanelType07_2;
307    SiS_Pr->SiS_PanelType08_2 = SiS300_PanelType08_2;
308    SiS_Pr->SiS_PanelType09_2 = SiS300_PanelType09_2;
309    SiS_Pr->SiS_PanelType0a_2 = SiS300_PanelType0a_2;
310    SiS_Pr->SiS_PanelType0b_2 = SiS300_PanelType0b_2;
311    SiS_Pr->SiS_PanelType0c_2 = SiS300_PanelType0c_2;
312    SiS_Pr->SiS_PanelType0d_2 = SiS300_PanelType0d_2;
313    SiS_Pr->SiS_PanelType0e_2 = SiS300_PanelType0e_2;
314    SiS_Pr->SiS_PanelType0f_2 = SiS300_PanelType0f_2;
315    SiS_Pr->SiS_PanelTypeNS_1 = SiS300_PanelTypeNS_1;
316    SiS_Pr->SiS_PanelTypeNS_2 = SiS300_PanelTypeNS_2;
317
318    if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) {
319       SiS_Pr->SiS_PanelType04_1 = SiS300_PanelType04_1a;
320       SiS_Pr->SiS_PanelType04_2 = SiS300_PanelType04_2a;
321    }
322    if(SiS_Pr->SiS_CustomT == CUT_BARCO1024) {
323       SiS_Pr->SiS_PanelType04_1 = SiS300_PanelType04_1b;
324       SiS_Pr->SiS_PanelType04_2 = SiS300_PanelType04_2b;
325    }
326
327    SiS_Pr->SiS_LVDSCRT1800x600_1     = SiS300_LVDSCRT1800x600_1;
328    SiS_Pr->SiS_LVDSCRT1800x600_1_H   = SiS300_LVDSCRT1800x600_1_H;
329    SiS_Pr->SiS_LVDSCRT1800x600_2     = SiS300_LVDSCRT1800x600_2;
330    SiS_Pr->SiS_LVDSCRT1800x600_2_H   = SiS300_LVDSCRT1800x600_2_H;
331    SiS_Pr->SiS_LVDSCRT11024x768_1    = SiS300_LVDSCRT11024x768_1;
332    SiS_Pr->SiS_LVDSCRT11024x768_1_H  = SiS300_LVDSCRT11024x768_1_H;
333    SiS_Pr->SiS_LVDSCRT11024x768_2    = SiS300_LVDSCRT11024x768_2;
334    SiS_Pr->SiS_LVDSCRT11024x768_2_H  = SiS300_LVDSCRT11024x768_2_H;
335    SiS_Pr->SiS_LVDSCRT11280x1024_1   = SiS300_LVDSCRT11280x1024_1;
336    SiS_Pr->SiS_LVDSCRT11280x1024_1_H = SiS300_LVDSCRT11280x1024_1_H;
337    SiS_Pr->SiS_LVDSCRT11280x1024_2   = SiS300_LVDSCRT11280x1024_2;
338    SiS_Pr->SiS_LVDSCRT11280x1024_2_H = SiS300_LVDSCRT11280x1024_2_H;
339    SiS_Pr->SiS_LVDSCRT1XXXxXXX_1     = SiS300_LVDSCRT1XXXxXXX_1;
340    SiS_Pr->SiS_LVDSCRT1XXXxXXX_1_H   = SiS300_LVDSCRT1XXXxXXX_1_H;
341
342    SiS_Pr->SiS_CHTVCRT1UNTSC = SiS300_CHTVCRT1UNTSC;
343    SiS_Pr->SiS_CHTVCRT1ONTSC = SiS300_CHTVCRT1ONTSC;
344    SiS_Pr->SiS_CHTVCRT1UPAL  = SiS300_CHTVCRT1UPAL;
345    SiS_Pr->SiS_CHTVCRT1OPAL  = SiS300_CHTVCRT1OPAL;
346    SiS_Pr->SiS_CHTVCRT1SOPAL = SiS300_CHTVCRT1SOPAL;
347    SiS_Pr->SiS_CHTVReg_UNTSC = SiS300_CHTVReg_UNTSC;
348    SiS_Pr->SiS_CHTVReg_ONTSC = SiS300_CHTVReg_ONTSC;
349    SiS_Pr->SiS_CHTVReg_UPAL  = SiS300_CHTVReg_UPAL;
350    SiS_Pr->SiS_CHTVReg_OPAL  = SiS300_CHTVReg_OPAL;
351    SiS_Pr->SiS_CHTVReg_UPALM = SiS300_CHTVReg_UNTSC;  /* not supported on 300 series */
352    SiS_Pr->SiS_CHTVReg_OPALM = SiS300_CHTVReg_ONTSC;  /* not supported on 300 series */
353    SiS_Pr->SiS_CHTVReg_UPALN = SiS300_CHTVReg_UPAL;   /* not supported on 300 series */
354    SiS_Pr->SiS_CHTVReg_OPALN = SiS300_CHTVReg_OPAL;   /* not supported on 300 series */
355    SiS_Pr->SiS_CHTVReg_SOPAL = SiS300_CHTVReg_SOPAL;
356    SiS_Pr->SiS_CHTVVCLKUNTSC = SiS300_CHTVVCLKUNTSC;
357    SiS_Pr->SiS_CHTVVCLKONTSC = SiS300_CHTVVCLKONTSC;
358    SiS_Pr->SiS_CHTVVCLKUPAL  = SiS300_CHTVVCLKUPAL;
359    SiS_Pr->SiS_CHTVVCLKOPAL  = SiS300_CHTVVCLKOPAL;
360    SiS_Pr->SiS_CHTVVCLKUPALM = SiS300_CHTVVCLKUNTSC;  /* not supported on 300 series */
361    SiS_Pr->SiS_CHTVVCLKOPALM = SiS300_CHTVVCLKONTSC;  /* not supported on 300 series */
362    SiS_Pr->SiS_CHTVVCLKUPALN = SiS300_CHTVVCLKUPAL;   /* not supported on 300 series */
363    SiS_Pr->SiS_CHTVVCLKOPALN = SiS300_CHTVVCLKOPAL;   /* not supported on 300 series */
364    SiS_Pr->SiS_CHTVVCLKSOPAL = SiS300_CHTVVCLKSOPAL;
365 }
366 #endif
367
368 #ifdef SIS315H
369 static void
370 InitTo310Pointer(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
371 {
372    InitCommonPointer(SiS_Pr, HwInfo);
373
374    SiS_Pr->SiS_SModeIDTable  = SiS310_SModeIDTable;
375    SiS_Pr->SiS_EModeIDTable  = SiS310_EModeIDTable;
376    SiS_Pr->SiS_RefIndex      = (SiS_Ext2Struct *)SiS310_RefIndex;
377    SiS_Pr->SiS_CRT1Table     = SiS310_CRT1Table;
378    if(HwInfo->jChipType >= SIS_340) {
379       SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_340;  /* 340 */
380    } else if(HwInfo->jChipType >= SIS_761) {
381       SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_761;  /* 761 - preliminary */
382    } else if(HwInfo->jChipType >= SIS_760) {
383       SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_760;  /* 760 */
384    } else if(HwInfo->jChipType >= SIS_661) {
385       SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_660;  /* 661/741 */
386    } else if(HwInfo->jChipType == SIS_330) {
387       SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_330;  /* 330 */
388    } else if(HwInfo->jChipType > SIS_315PRO) {
389       SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_650;  /* 550, 650, 740 */
390    } else {
391       SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_315;  /* 315 */
392    }
393    if(HwInfo->jChipType >= SIS_340) {
394       SiS_Pr->SiS_MCLKData_1    = SiS310_MCLKData_1_340;
395    } else {
396       SiS_Pr->SiS_MCLKData_1    = SiS310_MCLKData_1;
397    }
398    SiS_Pr->SiS_VCLKData      = SiS310_VCLKData;
399    SiS_Pr->SiS_VBVCLKData    = SiS310_VBVCLKData;
400
401    SiS_Pr->SiS_SR15  = SiS310_SR15;
402
403 #ifdef LINUX_KERNEL
404    SiS_Pr->pSiS_SR07 = &SiS310_SR07;
405    SiS_Pr->SiS_CR40  = SiS310_CR40;
406    SiS_Pr->SiS_CR49  = SiS310_CR49;
407    SiS_Pr->pSiS_SR1F = &SiS310_SR1F;
408    SiS_Pr->pSiS_SR21 = &SiS310_SR21;
409    SiS_Pr->pSiS_SR22 = &SiS310_SR22;
410    SiS_Pr->pSiS_SR23 = &SiS310_SR23;
411    SiS_Pr->pSiS_SR24 = &SiS310_SR24;
412    SiS_Pr->SiS_SR25  = SiS310_SR25;
413    SiS_Pr->pSiS_SR31 = &SiS310_SR31;
414    SiS_Pr->pSiS_SR32 = &SiS310_SR32;
415    SiS_Pr->pSiS_SR33 = &SiS310_SR33;
416    SiS_Pr->pSiS_CRT2Data_1_2  = &SiS310_CRT2Data_1_2;
417    SiS_Pr->pSiS_CRT2Data_4_D  = &SiS310_CRT2Data_4_D;
418    SiS_Pr->pSiS_CRT2Data_4_E  = &SiS310_CRT2Data_4_E;
419    SiS_Pr->pSiS_CRT2Data_4_10 = &SiS310_CRT2Data_4_10;
420    SiS_Pr->pSiS_RGBSenseData    = &SiS310_RGBSenseData;
421    SiS_Pr->pSiS_VideoSenseData  = &SiS310_VideoSenseData;
422    SiS_Pr->pSiS_YCSenseData     = &SiS310_YCSenseData;
423    SiS_Pr->pSiS_RGBSenseData2   = &SiS310_RGBSenseData2;
424    SiS_Pr->pSiS_VideoSenseData2 = &SiS310_VideoSenseData2;
425    SiS_Pr->pSiS_YCSenseData2    = &SiS310_YCSenseData2;
426 #endif
427
428    SiS_Pr->SiS_PanelDelayTbl     = SiS310_PanelDelayTbl;
429    SiS_Pr->SiS_PanelDelayTblLVDS = SiS310_PanelDelayTblLVDS;
430
431    SiS_Pr->SiS_St2LCD1024x768Data   = SiS310_St2LCD1024x768Data;
432    SiS_Pr->SiS_ExtLCD1024x768Data   = SiS310_ExtLCD1024x768Data;
433    SiS_Pr->SiS_St2LCD1280x1024Data  = SiS310_St2LCD1280x1024Data;
434    SiS_Pr->SiS_ExtLCD1280x1024Data  = SiS310_ExtLCD1280x1024Data;
435
436    SiS_Pr->SiS_CRT2Part2_1024x768_1  = SiS310_CRT2Part2_1024x768_1;
437
438    SiS_Pr->SiS_PanelType00_1 = SiS310_PanelType00_1;
439    SiS_Pr->SiS_PanelType01_1 = SiS310_PanelType01_1;
440    SiS_Pr->SiS_PanelType02_1 = SiS310_PanelType02_1;
441    SiS_Pr->SiS_PanelType03_1 = SiS310_PanelType03_1;
442    SiS_Pr->SiS_PanelType04_1 = SiS310_PanelType04_1;
443    SiS_Pr->SiS_PanelType05_1 = SiS310_PanelType05_1;
444    SiS_Pr->SiS_PanelType06_1 = SiS310_PanelType06_1;
445    SiS_Pr->SiS_PanelType07_1 = SiS310_PanelType07_1;
446    SiS_Pr->SiS_PanelType08_1 = SiS310_PanelType08_1;
447    SiS_Pr->SiS_PanelType09_1 = SiS310_PanelType09_1;
448    SiS_Pr->SiS_PanelType0a_1 = SiS310_PanelType0a_1;
449    SiS_Pr->SiS_PanelType0b_1 = SiS310_PanelType0b_1;
450    SiS_Pr->SiS_PanelType0c_1 = SiS310_PanelType0c_1;
451    SiS_Pr->SiS_PanelType0d_1 = SiS310_PanelType0d_1;
452    SiS_Pr->SiS_PanelType0e_1 = SiS310_PanelType0e_1;
453    SiS_Pr->SiS_PanelType0f_1 = SiS310_PanelType0f_1;
454    SiS_Pr->SiS_PanelType00_2 = SiS310_PanelType00_2;
455    SiS_Pr->SiS_PanelType01_2 = SiS310_PanelType01_2;
456    SiS_Pr->SiS_PanelType02_2 = SiS310_PanelType02_2;
457    SiS_Pr->SiS_PanelType03_2 = SiS310_PanelType03_2;
458    SiS_Pr->SiS_PanelType04_2 = SiS310_PanelType04_2;
459    SiS_Pr->SiS_PanelType05_2 = SiS310_PanelType05_2;
460    SiS_Pr->SiS_PanelType06_2 = SiS310_PanelType06_2;
461    SiS_Pr->SiS_PanelType07_2 = SiS310_PanelType07_2;
462    SiS_Pr->SiS_PanelType08_2 = SiS310_PanelType08_2;
463    SiS_Pr->SiS_PanelType09_2 = SiS310_PanelType09_2;
464    SiS_Pr->SiS_PanelType0a_2 = SiS310_PanelType0a_2;
465    SiS_Pr->SiS_PanelType0b_2 = SiS310_PanelType0b_2;
466    SiS_Pr->SiS_PanelType0c_2 = SiS310_PanelType0c_2;
467    SiS_Pr->SiS_PanelType0d_2 = SiS310_PanelType0d_2;
468    SiS_Pr->SiS_PanelType0e_2 = SiS310_PanelType0e_2;
469    SiS_Pr->SiS_PanelType0f_2 = SiS310_PanelType0f_2;
470    SiS_Pr->SiS_PanelTypeNS_1 = SiS310_PanelTypeNS_1;
471    SiS_Pr->SiS_PanelTypeNS_2 = SiS310_PanelTypeNS_2;
472
473    SiS_Pr->SiS_CHTVUPALData  = SiS310_CHTVUPALData;
474    SiS_Pr->SiS_CHTVOPALData  = SiS310_CHTVOPALData;
475    SiS_Pr->SiS_CHTVUPALMData = SiS310_CHTVUPALMData;
476    SiS_Pr->SiS_CHTVOPALMData = SiS310_CHTVOPALMData;
477    SiS_Pr->SiS_CHTVUPALNData = SiS310_CHTVUPALNData;
478    SiS_Pr->SiS_CHTVOPALNData = SiS310_CHTVOPALNData;
479    SiS_Pr->SiS_CHTVSOPALData = SiS310_CHTVSOPALData;
480
481    SiS_Pr->SiS_LVDSCRT1800x600_1     = SiS310_LVDSCRT1800x600_1;
482    SiS_Pr->SiS_LVDSCRT11024x768_1    = SiS310_LVDSCRT11024x768_1;
483    SiS_Pr->SiS_LVDSCRT11280x1024_1   = SiS310_LVDSCRT11280x1024_1;
484    SiS_Pr->SiS_LVDSCRT11400x1050_1   = SiS310_LVDSCRT11400x1050_1;
485    SiS_Pr->SiS_LVDSCRT11600x1200_1   = SiS310_LVDSCRT11600x1200_1;
486    SiS_Pr->SiS_LVDSCRT1800x600_1_H   = SiS310_LVDSCRT1800x600_1_H;
487    SiS_Pr->SiS_LVDSCRT11024x768_1_H  = SiS310_LVDSCRT11024x768_1_H;
488    SiS_Pr->SiS_LVDSCRT11280x1024_1_H = SiS310_LVDSCRT11280x1024_1_H;
489    SiS_Pr->SiS_LVDSCRT11400x1050_1_H = SiS310_LVDSCRT11400x1050_1_H;
490    SiS_Pr->SiS_LVDSCRT11600x1200_1_H = SiS310_LVDSCRT11600x1200_1_H;
491    SiS_Pr->SiS_LVDSCRT1800x600_2     = SiS310_LVDSCRT1800x600_2;
492    SiS_Pr->SiS_LVDSCRT11024x768_2    = SiS310_LVDSCRT11024x768_2;
493    SiS_Pr->SiS_LVDSCRT11280x1024_2   = SiS310_LVDSCRT11280x1024_2;
494    SiS_Pr->SiS_LVDSCRT11400x1050_2   = SiS310_LVDSCRT11400x1050_2;
495    SiS_Pr->SiS_LVDSCRT11600x1200_2   = SiS310_LVDSCRT11600x1200_2;
496    SiS_Pr->SiS_LVDSCRT1800x600_2_H   = SiS310_LVDSCRT1800x600_2_H;
497    SiS_Pr->SiS_LVDSCRT11024x768_2_H  = SiS310_LVDSCRT11024x768_2_H;
498    SiS_Pr->SiS_LVDSCRT11280x1024_2_H = SiS310_LVDSCRT11280x1024_2_H;
499    SiS_Pr->SiS_LVDSCRT11400x1050_2_H = SiS310_LVDSCRT11400x1050_2_H;
500    SiS_Pr->SiS_LVDSCRT11600x1200_2_H = SiS310_LVDSCRT11600x1200_2_H;
501    SiS_Pr->SiS_LVDSCRT1XXXxXXX_1     = SiS310_LVDSCRT1XXXxXXX_1;
502    SiS_Pr->SiS_LVDSCRT1XXXxXXX_1_H   = SiS310_LVDSCRT1XXXxXXX_1_H;
503    SiS_Pr->SiS_CHTVCRT1UNTSC         = SiS310_CHTVCRT1UNTSC;
504    SiS_Pr->SiS_CHTVCRT1ONTSC         = SiS310_CHTVCRT1ONTSC;
505    SiS_Pr->SiS_CHTVCRT1UPAL          = SiS310_CHTVCRT1UPAL;
506    SiS_Pr->SiS_CHTVCRT1OPAL          = SiS310_CHTVCRT1OPAL;
507    SiS_Pr->SiS_CHTVCRT1SOPAL         = SiS310_CHTVCRT1OPAL;
508
509    SiS_Pr->SiS_CHTVReg_UNTSC = SiS310_CHTVReg_UNTSC;
510    SiS_Pr->SiS_CHTVReg_ONTSC = SiS310_CHTVReg_ONTSC;
511    SiS_Pr->SiS_CHTVReg_UPAL  = SiS310_CHTVReg_UPAL;
512    SiS_Pr->SiS_CHTVReg_OPAL  = SiS310_CHTVReg_OPAL;
513    SiS_Pr->SiS_CHTVReg_UPALM = SiS310_CHTVReg_UPALM;
514    SiS_Pr->SiS_CHTVReg_OPALM = SiS310_CHTVReg_OPALM;
515    SiS_Pr->SiS_CHTVReg_UPALN = SiS310_CHTVReg_UPALN;
516    SiS_Pr->SiS_CHTVReg_OPALN = SiS310_CHTVReg_OPALN;
517    SiS_Pr->SiS_CHTVReg_SOPAL = SiS310_CHTVReg_OPAL;
518
519    SiS_Pr->SiS_CHTVVCLKUNTSC = SiS310_CHTVVCLKUNTSC;
520    SiS_Pr->SiS_CHTVVCLKONTSC = SiS310_CHTVVCLKONTSC;
521    SiS_Pr->SiS_CHTVVCLKUPAL  = SiS310_CHTVVCLKUPAL;
522    SiS_Pr->SiS_CHTVVCLKOPAL  = SiS310_CHTVVCLKOPAL;
523    SiS_Pr->SiS_CHTVVCLKUPALM = SiS310_CHTVVCLKUPALM;
524    SiS_Pr->SiS_CHTVVCLKOPALM = SiS310_CHTVVCLKOPALM;
525    SiS_Pr->SiS_CHTVVCLKUPALN = SiS310_CHTVVCLKUPALN;
526    SiS_Pr->SiS_CHTVVCLKOPALN = SiS310_CHTVVCLKOPALN;
527    SiS_Pr->SiS_CHTVVCLKSOPAL = SiS310_CHTVVCLKOPAL;
528 }
529 #endif
530
531 static void
532 SiSInitPtr(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
533 {
534    switch(HwInfo->jChipType) {
535 #ifdef SIS315H
536    case SIS_315H:
537    case SIS_315:
538    case SIS_315PRO:
539    case SIS_550:
540    case SIS_650:
541    case SIS_740:
542    case SIS_330:
543    case SIS_661:
544    case SIS_741:
545    case SIS_660:
546    case SIS_760:
547    case SIS_761:
548    case SIS_340:
549       InitTo310Pointer(SiS_Pr, HwInfo);
550       break;
551 #endif
552 #ifdef SIS300
553    case SIS_300:
554    case SIS_540:
555    case SIS_630:
556    case SIS_730:
557       InitTo300Pointer(SiS_Pr, HwInfo);
558       break;
559 #endif
560    default:
561       break;
562    }
563 }
564
565 /*********************************************/
566 /*            HELPER: Get ModeID             */
567 /*********************************************/
568
569 #ifdef LINUX_XF86
570 USHORT
571 SiS_GetModeID(int VGAEngine, ULONG VBFlags, int HDisplay, int VDisplay,
572               int Depth, BOOLEAN FSTN, int LCDwidth, int LCDheight)
573 {
574    USHORT ModeIndex = 0;
575
576    switch(HDisplay)
577    {
578      case 320:
579           if(VDisplay == 200)     ModeIndex = ModeIndex_320x200[Depth];
580           else if(VDisplay == 240) {
581              if(FSTN) ModeIndex = ModeIndex_320x240_FSTN[Depth];
582              else     ModeIndex = ModeIndex_320x240[Depth];
583           }
584           break;
585      case 400:
586           if((!(VBFlags & CRT1_LCDA)) || ((LCDwidth >= 800) && (LCDwidth >= 600))) {
587              if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
588           }
589           break;
590      case 512:
591           if((!(VBFlags & CRT1_LCDA)) || ((LCDwidth >= 1024) && (LCDwidth >= 768))) {
592              if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
593           }
594           break;
595      case 640:
596           if(VDisplay == 480)      ModeIndex = ModeIndex_640x480[Depth];
597           else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
598           break;
599      case 720:
600           if(VDisplay == 480)      ModeIndex = ModeIndex_720x480[Depth];
601           else if(VDisplay == 576) ModeIndex = ModeIndex_720x576[Depth];
602           break;
603      case 768:
604           if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth];
605           break;
606      case 800:
607           if(VDisplay == 600)      ModeIndex = ModeIndex_800x600[Depth];
608           else if(VDisplay == 480) ModeIndex = ModeIndex_800x480[Depth];
609           break;
610      case 848:
611           if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth];
612           break;
613      case 856:
614           if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth];
615           break;
616      case 960:
617           if(VGAEngine == SIS_315_VGA) {
618              if(VDisplay == 540)      ModeIndex = ModeIndex_960x540[Depth];
619              else if(VDisplay == 600) ModeIndex = ModeIndex_960x600[Depth];
620           }
621           break;
622      case 1024:
623           if(VDisplay == 576)      ModeIndex = ModeIndex_1024x576[Depth];
624           else if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
625           else if(VGAEngine == SIS_300_VGA) {
626              if(VDisplay == 600)   ModeIndex = ModeIndex_1024x600[Depth];
627           }
628           break;
629      case 1152:
630           if(VDisplay == 864) ModeIndex = ModeIndex_1152x864[Depth];
631           if(VGAEngine == SIS_300_VGA) {
632              if(VDisplay == 768) ModeIndex = ModeIndex_1152x768[Depth];
633           }
634           break;
635      case 1280:
636           switch(VDisplay) {
637           case 720:
638              ModeIndex = ModeIndex_1280x720[Depth];
639              break;
640           case 768:
641              if(VGAEngine == SIS_300_VGA) {
642                 ModeIndex = ModeIndex_300_1280x768[Depth];
643              } else {
644                 ModeIndex = ModeIndex_310_1280x768[Depth];
645              }
646              break;
647           case 800:
648              if(VGAEngine == SIS_315_VGA) {
649                 ModeIndex = ModeIndex_1280x800[Depth];
650              }
651              break;
652           case 960:
653              ModeIndex = ModeIndex_1280x960[Depth];
654              break;
655           case 1024:
656              ModeIndex = ModeIndex_1280x1024[Depth];
657              break;
658           }
659           break;
660      case 1360:
661           if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth];
662           if(VGAEngine == SIS_300_VGA) {
663              if(VDisplay == 1024) ModeIndex = ModeIndex_300_1360x1024[Depth];
664           }
665           break;
666      case 1400:
667           if(VGAEngine == SIS_315_VGA) {
668              if(VDisplay == 1050) {
669                 ModeIndex = ModeIndex_1400x1050[Depth];
670              }
671           }
672           break;
673      case 1600:
674           if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth];
675           break;
676      case 1680:
677           if(VGAEngine == SIS_315_VGA) {
678              if(VDisplay == 1050) ModeIndex = ModeIndex_1680x1050[Depth];
679           }
680           break;
681      case 1920:
682           if(VDisplay == 1440)    ModeIndex = ModeIndex_1920x1440[Depth];
683           else if(VGAEngine == SIS_315_VGA) {
684              if(VDisplay == 1080) ModeIndex = ModeIndex_1920x1080[Depth];
685           }
686           break;
687      case 2048:
688           if(VDisplay == 1536) {
689              if(VGAEngine == SIS_300_VGA) {
690                  ModeIndex = ModeIndex_300_2048x1536[Depth];
691              } else {
692                  ModeIndex = ModeIndex_310_2048x1536[Depth];
693              }
694           }
695           break;
696    }
697
698    return(ModeIndex);
699 }
700 #endif
701
702 USHORT
703 SiS_GetModeID_LCD(int VGAEngine, ULONG VBFlags, int HDisplay, int VDisplay,
704                   int Depth, BOOLEAN FSTN, USHORT CustomT, int LCDwidth, int LCDheight)
705 {
706    USHORT ModeIndex = 0;
707
708    if(VBFlags & (VB_LVDS | VB_30xBDH)) {
709
710       switch(HDisplay)
711       {
712         case 320:
713              if(CustomT != CUT_PANEL848) {
714                 if(VDisplay == 200) ModeIndex = ModeIndex_320x200[Depth];
715                 else if(VDisplay == 240) {
716                    if(!FSTN) ModeIndex = ModeIndex_320x240[Depth];
717                    else if(VGAEngine == SIS_315_VGA) {
718                       ModeIndex = ModeIndex_320x240_FSTN[Depth];
719                    }
720                 }
721              }
722              break;
723         case 400:
724              if(CustomT != CUT_PANEL848) {
725                 if(!((VGAEngine == SIS_300_VGA) && (VBFlags & VB_TRUMPION))) {
726                    if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
727                 }
728              }
729              break;
730         case 512:
731              if(CustomT != CUT_PANEL848) {
732                 if(!((VGAEngine == SIS_300_VGA) && (VBFlags & VB_TRUMPION))) {
733                    if(LCDwidth >= 1024 && LCDwidth != 1152 && LCDheight >= 768) {
734                       if(VDisplay == 384) {
735                          ModeIndex = ModeIndex_512x384[Depth];
736                       }
737                    }
738                 }
739              }
740              break;
741         case 640:
742              if(VDisplay == 480)            ModeIndex = ModeIndex_640x480[Depth];
743              else if(VDisplay == 400) {
744                 if(CustomT != CUT_PANEL848) ModeIndex = ModeIndex_640x400[Depth];
745              }
746              break;
747         case 800:
748              if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
749              break;
750         case 848:
751              if(CustomT == CUT_PANEL848) {
752                 if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth];
753              }
754              break;
755         case 1024:
756              if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
757              else if(VGAEngine == SIS_300_VGA) {
758                 if((VDisplay == 600) && (LCDheight == 600)) {
759                    ModeIndex = ModeIndex_1024x600[Depth];
760                 }
761              }
762              break;
763         case 1152:
764              if(VGAEngine == SIS_300_VGA) {
765                 if((VDisplay == 768) && (LCDheight == 768)) {
766                    ModeIndex = ModeIndex_1152x768[Depth];
767                 }
768              }
769              break;
770         case 1280:
771              if(VDisplay == 1024) ModeIndex = ModeIndex_1280x1024[Depth];
772              else if(VGAEngine == SIS_315_VGA) {
773                 if((VDisplay == 768) && (LCDheight == 768)) {
774                    ModeIndex = ModeIndex_310_1280x768[Depth];
775                 }
776              }
777              break;
778         case 1360:
779              if(VGAEngine == SIS_300_VGA) {
780                 if(CustomT == CUT_BARCO1366) {
781                    if(VDisplay == 1024) ModeIndex = ModeIndex_300_1360x1024[Depth];
782                 }
783              }
784              if(CustomT == CUT_PANEL848) {
785                 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth];
786              }
787              break;
788         case 1400:
789              if(VGAEngine == SIS_315_VGA) {
790                 if(VDisplay == 1050) ModeIndex = ModeIndex_1400x1050[Depth];
791              }
792              break;
793         case 1600:
794              if(VGAEngine == SIS_315_VGA) {
795                 if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth];
796              }
797              break;
798       }
799
800    } else if(VBFlags & VB_SISBRIDGE) {
801
802       switch(HDisplay)
803       {
804         case 320:
805              if(VDisplay == 200)      ModeIndex = ModeIndex_320x200[Depth];
806              else if(VDisplay == 240) ModeIndex = ModeIndex_320x240[Depth];
807              break;
808         case 400:
809              if(LCDwidth >= 800 && LCDheight >= 600) {
810                 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
811              }
812              break;
813         case 512:
814              if(LCDwidth >= 1024 && LCDheight >= 768 && LCDwidth != 1152) {
815                 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
816              }
817              break;
818         case 640:
819              if(VDisplay == 480)      ModeIndex = ModeIndex_640x480[Depth];
820              else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
821              break;
822         case 720:
823              if(VGAEngine == SIS_315_VGA) {
824                 if(VDisplay == 480)      ModeIndex = ModeIndex_720x480[Depth];
825                 else if(VDisplay == 576) ModeIndex = ModeIndex_720x576[Depth];
826              }
827              break;
828         case 768:
829              if(VGAEngine == SIS_315_VGA) {
830                 if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth];
831              }
832              break;
833         case 800:
834              if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
835              if(VGAEngine == SIS_315_VGA) {
836                 if(VDisplay == 480) ModeIndex = ModeIndex_800x480[Depth];
837              }
838              break;
839         case 848:
840              if(VGAEngine == SIS_315_VGA) {
841                 if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth];
842              }
843              break;
844         case 856:
845              if(VGAEngine == SIS_315_VGA) {
846                 if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth];
847              }
848              break;
849         case 960:
850              if(VGAEngine == SIS_315_VGA) {
851                 if(VDisplay == 540)      ModeIndex = ModeIndex_960x540[Depth];
852                 else if(VDisplay == 600) ModeIndex = ModeIndex_960x600[Depth];
853              }
854              break;
855         case 1024:
856              if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
857              if(VGAEngine == SIS_315_VGA) {
858                 if(VDisplay == 576) ModeIndex = ModeIndex_1024x576[Depth];
859              }
860              break;
861         case 1152:
862              if(VGAEngine == SIS_315_VGA) {
863                 if(VDisplay == 864) ModeIndex = ModeIndex_1152x864[Depth];
864              }
865              break;
866         case 1280:
867              switch(VDisplay) {
868              case 720:
869                 ModeIndex = ModeIndex_1280x720[Depth];
870              case 768:
871                 if(VGAEngine == SIS_300_VGA) {
872                    ModeIndex = ModeIndex_300_1280x768[Depth];
873                 } else {
874                    ModeIndex = ModeIndex_310_1280x768[Depth];
875                 }
876                 break;
877              case 800:
878                 if(VGAEngine == SIS_315_VGA) {
879                    ModeIndex = ModeIndex_1280x800[Depth];
880                 }
881                 break;
882              case 960:
883                 ModeIndex = ModeIndex_1280x960[Depth];
884                 break;
885              case 1024:
886                 ModeIndex = ModeIndex_1280x1024[Depth];
887                 break;
888              }
889              break;
890         case 1360:
891              if(VGAEngine == SIS_315_VGA) {
892                 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth];
893              }
894              break;
895         case 1400:
896              if(VGAEngine == SIS_315_VGA) {
897                 if(VBFlags & (VB_301C | VB_302LV | VB_302ELV)) {
898                    if(VDisplay == 1050) ModeIndex = ModeIndex_1400x1050[Depth];
899                 }
900              }
901              break;
902         case 1600:
903              if(VGAEngine == SIS_315_VGA) {
904                 if(VBFlags & (VB_301C | VB_302LV | VB_302ELV)) {
905                    if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth];
906                 }
907              }
908              break;
909 #ifndef VB_FORBID_CRT2LCD_OVER_1600
910         case 1680:
911              if(VGAEngine == SIS_315_VGA) {
912                 if(VBFlags & (VB_301C | VB_302LV | VB_302ELV)) {
913                    if(VDisplay == 1050) ModeIndex = ModeIndex_1680x1050[Depth];
914                 }
915              }
916              break;
917 #endif
918       }
919    }
920
921    return ModeIndex;
922 }
923
924 USHORT
925 SiS_GetModeID_TV(int VGAEngine, ULONG VBFlags, int HDisplay, int VDisplay, int Depth)
926 {
927    USHORT ModeIndex = 0;
928
929    if(VBFlags & VB_CHRONTEL) {
930
931       switch(HDisplay)
932       {
933         case 512:
934              if(VGAEngine == SIS_315_VGA) {
935                 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
936              }
937              break;
938         case 640:
939              if(VDisplay == 480)      ModeIndex = ModeIndex_640x480[Depth];
940              else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
941              break;
942         case 800:
943              if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
944              break;
945         case 1024:
946              if(VGAEngine == SIS_315_VGA) {
947                 if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
948              }
949              break;
950       }
951
952    } else if(VBFlags & VB_SISTVBRIDGE) {
953
954       switch(HDisplay)
955       {
956         case 320:
957              if(VDisplay == 200)      ModeIndex = ModeIndex_320x200[Depth];
958              else if(VDisplay == 240) ModeIndex = ModeIndex_320x240[Depth];
959              break;
960         case 400:
961              if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
962              break;
963         case 512:
964              if( ((VBFlags & TV_YPBPR) && (VBFlags & (TV_YPBPR750P | TV_YPBPR1080I))) ||
965                  (VBFlags & TV_HIVISION)                                              ||
966                  ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) ) {
967                 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
968              }
969              break;
970         case 640:
971              if(VDisplay == 480)      ModeIndex = ModeIndex_640x480[Depth];
972              else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
973              break;
974         case 720:
975              if((!(VBFlags & TV_HIVISION)) && (!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)))) {
976                 if(VDisplay == 480) {
977                    ModeIndex = ModeIndex_720x480[Depth];
978                 } else if(VDisplay == 576) {
979                    if( ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P)) ||
980                        ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) )
981                       ModeIndex = ModeIndex_720x576[Depth];
982                 }
983              }
984              break;
985         case 768:
986              if((!(VBFlags & TV_HIVISION)) && (!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)))) {
987                 if( ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P)) ||
988                     ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) ) {
989                    if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth];
990                 }
991              }
992              break;
993         case 800:
994              if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
995              else if(VDisplay == 480) {
996                 if((VBFlags & TV_HIVISION) || ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) {
997                    ModeIndex = ModeIndex_800x480[Depth];
998                 }
999              }
1000              break;
1001         case 960:
1002              if(VGAEngine == SIS_315_VGA) {
1003                 if(VDisplay == 600) {
1004                    if((VBFlags & TV_HIVISION) || ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) {
1005                       ModeIndex = ModeIndex_960x600[Depth];
1006                    }
1007                 }
1008              }
1009              break;
1010         case 1024:
1011              if(VDisplay == 768) {
1012                 if(VBFlags & (VB_301B|VB_301C|VB_302B|VB_301LV|VB_302LV|VB_302ELV)) {
1013                    ModeIndex = ModeIndex_1024x768[Depth];
1014                 }
1015              } else if(VDisplay == 576) {
1016                 if((VBFlags & TV_HIVISION) || ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) {
1017                    ModeIndex = ModeIndex_1024x576[Depth];
1018                 }
1019              }
1020              break;
1021         case 1280:
1022              if(VDisplay == 720) {
1023                 if((VBFlags & TV_HIVISION) ||
1024                    ((VBFlags & TV_YPBPR) && (VBFlags & (TV_YPBPR1080I | TV_YPBPR750P)))) {
1025                    ModeIndex = ModeIndex_1280x720[Depth];
1026                 }
1027              } else if(VDisplay == 1024) {
1028                 if((VBFlags & TV_HIVISION) ||
1029                    ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) {
1030                    ModeIndex = ModeIndex_1280x1024[Depth];
1031                 }
1032              }
1033              break;
1034       }
1035    }
1036    return ModeIndex;
1037 }
1038
1039 USHORT
1040 SiS_GetModeID_VGA2(int VGAEngine, ULONG VBFlags, int HDisplay, int VDisplay, int Depth)
1041 {
1042    USHORT ModeIndex = 0;
1043
1044    if(!(VBFlags & (VB_301|VB_301B|VB_301C|VB_302B))) return 0;
1045
1046    switch(HDisplay)
1047    {
1048         case 320:
1049                 if(VDisplay == 200)      ModeIndex = ModeIndex_320x200[Depth];
1050                 else if(VDisplay == 240) ModeIndex = ModeIndex_320x240[Depth];
1051                 break;
1052         case 400:
1053                 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
1054                 break;
1055         case 512:
1056                 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
1057                 break;
1058         case 640:
1059                 if(VDisplay == 480)      ModeIndex = ModeIndex_640x480[Depth];
1060                 else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
1061                 break;
1062         case 720:
1063                 if(VDisplay == 480)      ModeIndex = ModeIndex_720x480[Depth];
1064                 else if(VDisplay == 576) ModeIndex = ModeIndex_720x576[Depth];
1065                 break;
1066         case 768:
1067                 if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth];
1068                 break;
1069         case 800:
1070                 if(VDisplay == 600)      ModeIndex = ModeIndex_800x600[Depth];
1071                 else if(VDisplay == 480) ModeIndex = ModeIndex_800x480[Depth];
1072                 break;
1073         case 848:
1074                 if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth];
1075                 break;
1076         case 856:
1077                 if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth];
1078                 break;
1079         case 960:
1080                 if(VGAEngine == SIS_315_VGA) {
1081                    if(VDisplay == 540)      ModeIndex = ModeIndex_960x540[Depth];
1082                    else if(VDisplay == 600) ModeIndex = ModeIndex_960x600[Depth];
1083                 }
1084                 break;
1085         case 1024:
1086                 if(VDisplay == 768)      ModeIndex = ModeIndex_1024x768[Depth];
1087                 else if(VDisplay == 576) ModeIndex = ModeIndex_1024x576[Depth];
1088                 break;
1089         case 1152:
1090                 if(VDisplay == 864)    ModeIndex = ModeIndex_1152x864[Depth];
1091                 else if(VGAEngine == SIS_300_VGA) {
1092                    if(VDisplay == 768) ModeIndex = ModeIndex_1152x768[Depth];
1093                 }
1094                 break;
1095         case 1280:
1096                 if(VDisplay == 768) {
1097                    if(VGAEngine == SIS_300_VGA) {
1098                       ModeIndex = ModeIndex_300_1280x768[Depth];
1099                    } else {
1100                       ModeIndex = ModeIndex_310_1280x768[Depth];
1101                    }
1102                 } else if(VDisplay == 1024) ModeIndex = ModeIndex_1280x1024[Depth];
1103                 else if(VDisplay == 720)    ModeIndex = ModeIndex_1280x720[Depth];
1104                 else if(VDisplay == 800)    ModeIndex = ModeIndex_1280x800[Depth];
1105                 else if(VDisplay == 960)    ModeIndex = ModeIndex_1280x960[Depth];
1106                 break;
1107         case 1360:
1108                 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth];
1109                 break;
1110         case 1400:
1111                 if(VGAEngine == SIS_315_VGA) {
1112                    if(VDisplay == 1050) ModeIndex = ModeIndex_1400x1050[Depth];
1113                 }
1114                 break;
1115         case 1600:
1116                 if(VGAEngine == SIS_315_VGA) {
1117                    if(VBFlags & (VB_301B|VB_301C|VB_302B)) {
1118                       if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth];
1119                    }
1120                 }
1121                 break;
1122         case 1680:
1123                 if(VGAEngine == SIS_315_VGA) {
1124                    if(VBFlags & (VB_301B|VB_301C|VB_302B)) {
1125                       if(VDisplay == 1050) ModeIndex = ModeIndex_1680x1050[Depth];
1126                    }
1127                 }
1128                 break;
1129    }
1130
1131    return ModeIndex;
1132 }
1133
1134
1135 /*********************************************/
1136 /*          HELPER: SetReg, GetReg           */
1137 /*********************************************/
1138
1139 void
1140 SiS_SetReg(SISIOADDRESS port, USHORT index, USHORT data)
1141 {
1142    OutPortByte(port,index);
1143    OutPortByte(port + 1,data);
1144 }
1145
1146 void
1147 SiS_SetRegByte(SISIOADDRESS port, USHORT data)
1148 {
1149    OutPortByte(port,data);
1150 }
1151
1152 void
1153 SiS_SetRegShort(SISIOADDRESS port, USHORT data)
1154 {
1155    OutPortWord(port,data);
1156 }
1157
1158 void
1159 SiS_SetRegLong(SISIOADDRESS port, ULONG data)
1160 {
1161    OutPortLong(port,data);
1162 }
1163
1164 UCHAR
1165 SiS_GetReg(SISIOADDRESS port, USHORT index)
1166 {
1167    OutPortByte(port,index);
1168    return(InPortByte(port + 1));
1169 }
1170
1171 UCHAR
1172 SiS_GetRegByte(SISIOADDRESS port)
1173 {
1174    return(InPortByte(port));
1175 }
1176
1177 USHORT
1178 SiS_GetRegShort(SISIOADDRESS port)
1179 {
1180    return(InPortWord(port));
1181 }
1182
1183 ULONG
1184 SiS_GetRegLong(SISIOADDRESS port)
1185 {
1186    return(InPortLong(port));
1187 }
1188
1189 void
1190 SiS_SetRegANDOR(SISIOADDRESS Port,USHORT Index,USHORT DataAND,USHORT DataOR)
1191 {
1192   USHORT temp;
1193
1194   temp = SiS_GetReg(Port,Index);
1195   temp = (temp & (DataAND)) | DataOR;
1196   SiS_SetReg(Port,Index,temp);
1197 }
1198
1199 void
1200 SiS_SetRegAND(SISIOADDRESS Port,USHORT Index,USHORT DataAND)
1201 {
1202   USHORT temp;
1203
1204   temp = SiS_GetReg(Port,Index);
1205   temp &= DataAND;
1206   SiS_SetReg(Port,Index,temp);
1207 }
1208
1209 void
1210 SiS_SetRegOR(SISIOADDRESS Port,USHORT Index,USHORT DataOR)
1211 {
1212   USHORT temp;
1213
1214   temp = SiS_GetReg(Port,Index);
1215   temp |= DataOR;
1216   SiS_SetReg(Port,Index,temp);
1217 }
1218
1219 /*********************************************/
1220 /*      HELPER: DisplayOn, DisplayOff        */
1221 /*********************************************/
1222
1223 void
1224 SiS_DisplayOn(SiS_Private *SiS_Pr)
1225 {
1226    SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x01,0xDF);
1227 }
1228
1229 void
1230 SiS_DisplayOff(SiS_Private *SiS_Pr)
1231 {
1232    SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x01,0x20);
1233 }
1234
1235
1236 /*********************************************/
1237 /*        HELPER: Init Port Addresses        */
1238 /*********************************************/
1239
1240 void
1241 SiSRegInit(SiS_Private *SiS_Pr, SISIOADDRESS BaseAddr)
1242 {
1243    SiS_Pr->SiS_P3c4 = BaseAddr + 0x14;
1244    SiS_Pr->SiS_P3d4 = BaseAddr + 0x24;
1245    SiS_Pr->SiS_P3c0 = BaseAddr + 0x10;
1246    SiS_Pr->SiS_P3ce = BaseAddr + 0x1e;
1247    SiS_Pr->SiS_P3c2 = BaseAddr + 0x12;
1248    SiS_Pr->SiS_P3ca = BaseAddr + 0x1a;
1249    SiS_Pr->SiS_P3c6 = BaseAddr + 0x16;
1250    SiS_Pr->SiS_P3c7 = BaseAddr + 0x17;
1251    SiS_Pr->SiS_P3c8 = BaseAddr + 0x18;
1252    SiS_Pr->SiS_P3c9 = BaseAddr + 0x19;
1253    SiS_Pr->SiS_P3cb = BaseAddr + 0x1b;
1254    SiS_Pr->SiS_P3cd = BaseAddr + 0x1d;
1255    SiS_Pr->SiS_P3da = BaseAddr + 0x2a;
1256    SiS_Pr->SiS_Part1Port = BaseAddr + SIS_CRT2_PORT_04;     /* Digital video interface registers (LCD) */
1257    SiS_Pr->SiS_Part2Port = BaseAddr + SIS_CRT2_PORT_10;     /* 301 TV Encoder registers */
1258    SiS_Pr->SiS_Part3Port = BaseAddr + SIS_CRT2_PORT_12;     /* 301 Macrovision registers */
1259    SiS_Pr->SiS_Part4Port = BaseAddr + SIS_CRT2_PORT_14;     /* 301 VGA2 (and LCD) registers */
1260    SiS_Pr->SiS_Part5Port = BaseAddr + SIS_CRT2_PORT_14 + 2; /* 301 palette address port registers */
1261    SiS_Pr->SiS_DDC_Port = BaseAddr + 0x14;                  /* DDC Port ( = P3C4, SR11/0A) */
1262    SiS_Pr->SiS_VidCapt = BaseAddr + SIS_VIDEO_CAPTURE;
1263    SiS_Pr->SiS_VidPlay = BaseAddr + SIS_VIDEO_PLAYBACK;
1264 }
1265
1266 /*********************************************/
1267 /*             HELPER: GetSysFlags           */
1268 /*********************************************/
1269
1270 static void
1271 SiS_GetSysFlags(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1272 {
1273    unsigned char cr5f, temp1, temp2;
1274
1275    /* 661 and newer: NEVER write non-zero to SR11[7:4] */
1276    /* (SR11 is used for DDC and in enable/disablebridge) */
1277    SiS_Pr->SiS_SensibleSR11 = FALSE;
1278    SiS_Pr->SiS_MyCR63 = 0x63;
1279    if(HwInfo->jChipType >= SIS_330) {
1280       SiS_Pr->SiS_MyCR63 = 0x53;
1281       if(HwInfo->jChipType >= SIS_661) {
1282          SiS_Pr->SiS_SensibleSR11 = TRUE;
1283       }
1284    }
1285
1286    /* You should use the macros, not these flags directly */
1287
1288    SiS_Pr->SiS_SysFlags = 0;
1289    if(HwInfo->jChipType == SIS_650) {
1290       cr5f = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xf0;
1291       SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x5c,0x07);
1292       temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8;
1293       SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x5c,0xf8);
1294       temp2 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8;
1295       if((!temp1) || (temp2)) {
1296          switch(cr5f) {
1297             case 0x80:
1298             case 0x90:
1299             case 0xc0:
1300                SiS_Pr->SiS_SysFlags |= SF_IsM650;  break;
1301             case 0xa0:
1302             case 0xb0:
1303             case 0xe0:
1304                SiS_Pr->SiS_SysFlags |= SF_Is651;   break;
1305          }
1306       } else {
1307          switch(cr5f) {
1308             case 0x90:
1309                temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8;
1310                switch(temp1) {
1311                   case 0x00: SiS_Pr->SiS_SysFlags |= SF_IsM652; break;
1312                   case 0x40: SiS_Pr->SiS_SysFlags |= SF_IsM653; break;
1313                   default:   SiS_Pr->SiS_SysFlags |= SF_IsM650; break;
1314                }
1315                break;
1316             case 0xb0:
1317                SiS_Pr->SiS_SysFlags |= SF_Is652;  break;
1318             default:
1319                SiS_Pr->SiS_SysFlags |= SF_IsM650; break;
1320          }
1321       }
1322    }
1323    if(HwInfo->jChipType == SIS_760) {
1324       temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x78);
1325       if(temp1 & 0x30) SiS_Pr->SiS_SysFlags |= SF_760LFB;
1326    }
1327 }
1328
1329 /*********************************************/
1330 /*         HELPER: Init PCI & Engines        */
1331 /*********************************************/
1332
1333 static void
1334 SiSInitPCIetc(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1335 {
1336    switch(HwInfo->jChipType) {
1337    case SIS_300:
1338    case SIS_540:
1339    case SIS_630:
1340    case SIS_730:
1341       /* Set - PCI LINEAR ADDRESSING ENABLE (0x80)
1342        *     - RELOCATED VGA IO  (0x20)
1343        *     - MMIO ENABLE (0x1)
1344        */
1345       SiS_SetReg(SiS_Pr->SiS_P3c4,0x20,0xa1);
1346       /*  - Enable 2D (0x40)
1347        *  - Enable 3D (0x02)
1348        *  - Enable 3D Vertex command fetch (0x10) ?
1349        *  - Enable 3D command parser (0x08) ?
1350        */
1351       SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x5A);
1352       break;
1353    case SIS_315H:
1354    case SIS_315:
1355    case SIS_315PRO:
1356    case SIS_650:
1357    case SIS_740:
1358    case SIS_330:
1359    case SIS_661:
1360    case SIS_741:
1361    case SIS_660:
1362    case SIS_760:
1363    case SIS_761:
1364    case SIS_340:
1365       SiS_SetReg(SiS_Pr->SiS_P3c4,0x20,0xa1);
1366       /*  - Enable 2D (0x40)
1367        *  - Enable 3D (0x02)
1368        *  - Enable 3D vertex command fetch (0x10)
1369        *  - Enable 3D command parser (0x08)
1370        *  - Enable 3D G/L transformation engine (0x80)
1371        */
1372       SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0xDA);
1373       break;
1374    case SIS_550:
1375       SiS_SetReg(SiS_Pr->SiS_P3c4,0x20,0xa1);
1376       /* No 3D engine ! */
1377       /*  - Enable 2D (0x40)
1378        */
1379       SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x40);
1380    }
1381 }
1382
1383 /*********************************************/
1384 /*             HELPER: SetLVDSetc            */
1385 /*********************************************/
1386
1387 static void
1388 SiSSetLVDSetc(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1389 {
1390    USHORT temp;
1391
1392    SiS_Pr->SiS_IF_DEF_LVDS = 0;
1393    SiS_Pr->SiS_IF_DEF_TRUMPION = 0;
1394    SiS_Pr->SiS_IF_DEF_CH70xx = 0;
1395    SiS_Pr->SiS_IF_DEF_DSTN = 0;
1396    SiS_Pr->SiS_IF_DEF_FSTN = 0;
1397    SiS_Pr->SiS_IF_DEF_CONEX = 0;
1398
1399    SiS_Pr->SiS_ChrontelInit = 0;
1400
1401    /* Check for SiS30x first */
1402    temp = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00);
1403    if((temp == 1) || (temp == 2)) return;
1404
1405    switch(HwInfo->jChipType) {
1406 #ifdef SIS300
1407    case SIS_540:
1408    case SIS_630:
1409    case SIS_730:
1410         temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37);
1411         temp = (temp & 0x0E) >> 1;
1412         if((temp >= 2) && (temp <= 5))  SiS_Pr->SiS_IF_DEF_LVDS = 1;
1413         if(temp == 3)                   SiS_Pr->SiS_IF_DEF_TRUMPION = 1;
1414         if((temp == 4) || (temp == 5)) {
1415                 /* Save power status (and error check) - UNUSED */
1416                 SiS_Pr->SiS_Backup70xx = SiS_GetCH700x(SiS_Pr, 0x0e);
1417                 SiS_Pr->SiS_IF_DEF_CH70xx = 1;
1418         }
1419         break;
1420 #endif
1421 #ifdef SIS315H
1422    case SIS_550:
1423    case SIS_650:
1424    case SIS_740:
1425    case SIS_330:
1426         temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37);
1427         temp = (temp & 0x0E) >> 1;
1428         if((temp >= 2) && (temp <= 3))  SiS_Pr->SiS_IF_DEF_LVDS = 1;
1429         if(temp == 3)                   SiS_Pr->SiS_IF_DEF_CH70xx = 2;
1430         break;
1431    case SIS_661:
1432    case SIS_741:
1433    case SIS_660:
1434    case SIS_760:
1435    case SIS_761:
1436    case SIS_340:
1437         temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1438         temp = (temp & 0xe0) >> 5;
1439         if((temp >= 2) && (temp <= 3))  SiS_Pr->SiS_IF_DEF_LVDS = 1;
1440         if(temp == 3)                   SiS_Pr->SiS_IF_DEF_CH70xx = 2;
1441         if(temp == 4)                   SiS_Pr->SiS_IF_DEF_CONEX = 1;  /* Not yet supported */
1442         break;
1443 #endif
1444    default:
1445         break;
1446    }
1447 }
1448
1449 /*********************************************/
1450 /*          HELPER: Enable DSTN/FSTN         */
1451 /*********************************************/
1452
1453 void
1454 SiS_SetEnableDstn(SiS_Private *SiS_Pr, int enable)
1455 {
1456    SiS_Pr->SiS_IF_DEF_DSTN = enable ? 1 : 0;
1457 }
1458
1459 void
1460 SiS_SetEnableFstn(SiS_Private *SiS_Pr, int enable)
1461 {
1462    SiS_Pr->SiS_IF_DEF_FSTN = enable ? 1 : 0;
1463 }
1464
1465 /*********************************************/
1466 /*        HELPER: Determine ROM usage        */
1467 /*********************************************/
1468
1469 BOOLEAN
1470 SiSDetermineROMLayout661(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1471 {
1472    UCHAR  *ROMAddr  = HwInfo->pjVirtualRomBase;
1473    USHORT romversoffs, romvmaj = 1, romvmin = 0;
1474
1475    if(HwInfo->jChipType >= SIS_761) {
1476       /* I very much assume 761 and 340 will use new layout */
1477       return TRUE;
1478    } else if(HwInfo->jChipType >= SIS_661) {
1479       if((ROMAddr[0x1a] == 'N') &&
1480          (ROMAddr[0x1b] == 'e') &&
1481          (ROMAddr[0x1c] == 'w') &&
1482          (ROMAddr[0x1d] == 'V')) {
1483          return TRUE;
1484       }
1485       romversoffs = ROMAddr[0x16] | (ROMAddr[0x17] << 8);
1486       if(romversoffs) {
1487          if((ROMAddr[romversoffs+1] == '.') || (ROMAddr[romversoffs+4] == '.')) {
1488             romvmaj = ROMAddr[romversoffs] - '0';
1489             romvmin = ((ROMAddr[romversoffs+2] -'0') * 10) + (ROMAddr[romversoffs+3] - '0');
1490          }
1491       }
1492       if((romvmaj != 0) || (romvmin >= 92)) {
1493          return TRUE;
1494       }
1495    } else if(IS_SIS650740) {
1496       if((ROMAddr[0x1a] == 'N') &&
1497          (ROMAddr[0x1b] == 'e') &&
1498          (ROMAddr[0x1c] == 'w') &&
1499          (ROMAddr[0x1d] == 'V')) {
1500          return TRUE;
1501       }
1502    }
1503    return FALSE;
1504 }
1505
1506 static void
1507 SiSDetermineROMUsage(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1508 {
1509    UCHAR  *ROMAddr  = HwInfo->pjVirtualRomBase;
1510    USHORT romptr = 0;
1511
1512    SiS_Pr->SiS_UseROM = FALSE;
1513    SiS_Pr->SiS_ROMNew = FALSE;
1514
1515    if((ROMAddr) && (HwInfo->UseROM)) {
1516       if(HwInfo->jChipType == SIS_300) {
1517          /* 300: We check if the code starts below 0x220 by
1518           * checking the jmp instruction at the beginning
1519           * of the BIOS image.
1520           */
1521          if((ROMAddr[3] == 0xe9) && ((ROMAddr[5] << 8) | ROMAddr[4]) > 0x21a)
1522             SiS_Pr->SiS_UseROM = TRUE;
1523       } else if(HwInfo->jChipType < SIS_315H) {
1524          /* Sony's VAIO BIOS 1.09 follows the standard, so perhaps
1525           * the others do as well
1526           */
1527          SiS_Pr->SiS_UseROM = TRUE;
1528       } else {
1529          /* 315/330 series stick to the standard(s) */
1530          SiS_Pr->SiS_UseROM = TRUE;
1531          if((SiS_Pr->SiS_ROMNew = SiSDetermineROMLayout661(SiS_Pr, HwInfo))) {
1532             SiS_Pr->SiS_EMIOffset = 14;
1533             SiS_Pr->SiS661LCD2TableSize = 36;
1534             /* Find out about LCD data table entry size */
1535             if((romptr = SISGETROMW(0x0102))) {
1536                if(ROMAddr[romptr + (32 * 16)] == 0xff)
1537                   SiS_Pr->SiS661LCD2TableSize = 32;
1538                else if(ROMAddr[romptr + (34 * 16)] == 0xff)
1539                   SiS_Pr->SiS661LCD2TableSize = 34;
1540                else if(ROMAddr[romptr + (36 * 16)] == 0xff)        /* 0.94 */
1541                   SiS_Pr->SiS661LCD2TableSize = 36;
1542                else if( (ROMAddr[romptr + (38 * 16)] == 0xff) ||   /* 2.00.00 - 2.02.00 */
1543                         (ROMAddr[0x6F] & 0x01) ) {                 /* 2.03.00+ */
1544                   SiS_Pr->SiS661LCD2TableSize = 38;
1545                   SiS_Pr->SiS_EMIOffset = 16;
1546                }
1547             }
1548          }
1549       }
1550    }
1551 }
1552
1553 /*********************************************/
1554 /*        HELPER: SET SEGMENT REGISTERS      */
1555 /*********************************************/
1556
1557 static void
1558 SiS_SetSegRegLower(SiS_Private *SiS_Pr, USHORT value)
1559 {
1560    USHORT temp;
1561
1562    value &= 0x00ff;
1563    temp = SiS_GetRegByte(SiS_Pr->SiS_P3cb) & 0xf0;
1564    temp |= (value >> 4);
1565    SiS_SetRegByte(SiS_Pr->SiS_P3cb, temp);
1566    temp = SiS_GetRegByte(SiS_Pr->SiS_P3cd) & 0xf0;
1567    temp |= (value & 0x0f);
1568    SiS_SetRegByte(SiS_Pr->SiS_P3cd, temp);
1569 }
1570
1571 static void
1572 SiS_SetSegRegUpper(SiS_Private *SiS_Pr, USHORT value)
1573 {
1574    USHORT temp;
1575
1576    value &= 0x00ff;
1577    temp = SiS_GetRegByte(SiS_Pr->SiS_P3cb) & 0x0f;
1578    temp |= (value & 0xf0);
1579    SiS_SetRegByte(SiS_Pr->SiS_P3cb, temp);
1580    temp = SiS_GetRegByte(SiS_Pr->SiS_P3cd) & 0x0f;
1581    temp |= (value << 4);
1582    SiS_SetRegByte(SiS_Pr->SiS_P3cd, temp);
1583 }
1584
1585 static void
1586 SiS_SetSegmentReg(SiS_Private *SiS_Pr, USHORT value)
1587 {
1588    SiS_SetSegRegLower(SiS_Pr, value);
1589    SiS_SetSegRegUpper(SiS_Pr, value);
1590 }
1591
1592 static void
1593 SiS_ResetSegmentReg(SiS_Private *SiS_Pr)
1594 {
1595    SiS_SetSegmentReg(SiS_Pr, 0);
1596 }
1597
1598 static void
1599 SiS_SetSegmentRegOver(SiS_Private *SiS_Pr, USHORT value)
1600 {
1601    USHORT temp = value >> 8;
1602
1603    temp &= 0x07;
1604    temp |= (temp << 4);
1605    SiS_SetReg(SiS_Pr->SiS_P3c4,0x1d,temp);
1606    SiS_SetSegmentReg(SiS_Pr, value);
1607 }
1608
1609 static void
1610 SiS_ResetSegmentRegOver(SiS_Private *SiS_Pr)
1611 {
1612    SiS_SetSegmentRegOver(SiS_Pr, 0);
1613 }
1614
1615 static void
1616 SiS_ResetSegmentRegisters(SiS_Private *SiS_Pr,PSIS_HW_INFO HwInfo)
1617 {
1618    if((IS_SIS65x) || (HwInfo->jChipType >= SIS_661)) {
1619       SiS_ResetSegmentReg(SiS_Pr);
1620       SiS_ResetSegmentRegOver(SiS_Pr);
1621    }
1622 }
1623
1624 /*********************************************/
1625 /*             HELPER: GetVBType             */
1626 /*********************************************/
1627
1628 static void
1629 SiS_GetVBType(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1630 {
1631   USHORT flag=0, rev=0, nolcd=0, p4_0f, p4_25, p4_27;
1632
1633   SiS_Pr->SiS_VBType = 0;
1634
1635   if((SiS_Pr->SiS_IF_DEF_LVDS) || (SiS_Pr->SiS_IF_DEF_CONEX))
1636      return;
1637
1638   flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00);
1639
1640   if(flag > 3) return;
1641
1642   rev = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x01);
1643
1644   if(flag >= 2) {
1645      SiS_Pr->SiS_VBType = VB_SIS302B;
1646   } else if(flag == 1) {
1647      if(rev >= 0xC0) {
1648         SiS_Pr->SiS_VBType = VB_SIS301C;
1649      } else if(rev >= 0xB0) {
1650         SiS_Pr->SiS_VBType = VB_SIS301B;
1651         /* Check if 30xB DH version (no LCD support, use Panel Link instead) */
1652         nolcd = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x23);
1653         if(!(nolcd & 0x02)) SiS_Pr->SiS_VBType |= VB_NoLCD;
1654      } else {
1655         SiS_Pr->SiS_VBType = VB_SIS301;
1656      }
1657   }
1658   if(SiS_Pr->SiS_VBType & (VB_SIS301B | VB_SIS301C | VB_SIS302B)) {
1659      if(rev >= 0xE0) {
1660         flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x39);
1661         if(flag == 0xff) SiS_Pr->SiS_VBType = VB_SIS302LV;
1662         else             SiS_Pr->SiS_VBType = VB_SIS301C;  /* VB_SIS302ELV; */
1663      } else if(rev >= 0xD0) {
1664         SiS_Pr->SiS_VBType = VB_SIS301LV;
1665      }
1666   }
1667   if(SiS_Pr->SiS_VBType & (VB_301C | VB_301LV | VB_302LV | VB_302ELV)) {
1668      p4_0f = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x0f);
1669      p4_25 = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x25);
1670      p4_27 = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x27);
1671      SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x0f,0x7f);
1672      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x25,0x08);
1673      SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x27,0xfd);
1674      if(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x08) {
1675         SiS_Pr->SiS_VBType |= VB_UMC;
1676      }
1677      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x27,p4_27);
1678      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x25,p4_25);
1679      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0f,p4_0f);
1680   }
1681 }
1682
1683 /*********************************************/
1684 /*           HELPER: Check RAM size          */
1685 /*********************************************/
1686
1687 #ifdef LINUX_KERNEL
1688 static BOOLEAN
1689 SiS_CheckMemorySize(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,
1690                     USHORT ModeNo, USHORT ModeIdIndex)
1691 {
1692   USHORT AdapterMemSize = HwInfo->ulVideoMemorySize / (1024*1024);
1693   USHORT memorysize,modeflag;
1694
1695   if(SiS_Pr->UseCustomMode) {
1696      modeflag = SiS_Pr->CModeFlag;
1697   } else {
1698      if(ModeNo <= 0x13) {
1699         modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
1700      } else {
1701         modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1702      }
1703   }
1704
1705   memorysize = modeflag & MemoryInfoFlag;
1706   memorysize >>= MemorySizeShift;               /* Get required memory size */
1707   memorysize++;
1708
1709   if(AdapterMemSize < memorysize) return FALSE;
1710   return TRUE;
1711 }
1712 #endif
1713
1714 /*********************************************/
1715 /*           HELPER: Get DRAM type           */
1716 /*********************************************/
1717
1718 #ifdef SIS315H
1719 static UCHAR
1720 SiS_Get310DRAMType(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1721 {
1722    UCHAR data, temp;
1723
1724    if((*SiS_Pr->pSiS_SoftSetting) & SoftDRAMType) {
1725      data = (*SiS_Pr->pSiS_SoftSetting) & 0x03;
1726    } else {
1727      if(HwInfo->jChipType >= SIS_340) {
1728         /* TODO */
1729         data = 0;
1730      } if(HwInfo->jChipType >= SIS_661) {
1731         data = SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0x07;
1732         if(SiS_Pr->SiS_ROMNew) {
1733            data = ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0xc0) >> 6);
1734         }
1735      } else if(IS_SIS550650740) {
1736         data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x07;
1737      } else {   /* 315, 330 */
1738         data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3a) & 0x03;
1739         if(HwInfo->jChipType == SIS_330) {
1740            if(data > 1) {
1741               temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0x30;
1742               switch(temp) {
1743               case 0x00: data = 1; break;
1744               case 0x10: data = 3; break;
1745               case 0x20: data = 3; break;
1746               case 0x30: data = 2; break;
1747               }
1748            } else {
1749               data = 0;
1750            }
1751         }
1752      }
1753    }
1754
1755    return data;
1756 }
1757
1758 static USHORT
1759 SiS_GetMCLK(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1760 {
1761   UCHAR  *ROMAddr = HwInfo->pjVirtualRomBase;
1762   USHORT index;
1763
1764   index = SiS_Get310DRAMType(SiS_Pr, HwInfo);
1765   if(HwInfo->jChipType >= SIS_661) {
1766      if(SiS_Pr->SiS_ROMNew) {
1767         return((USHORT)(SISGETROMW((0x90 + (index * 5) + 3))));
1768      }
1769      return(SiS_Pr->SiS_MCLKData_0[index].CLOCK);
1770   } else if(index >= 4) {
1771      index -= 4;
1772      return(SiS_Pr->SiS_MCLKData_1[index].CLOCK);
1773   } else {
1774      return(SiS_Pr->SiS_MCLKData_0[index].CLOCK);
1775   }
1776 }
1777 #endif
1778
1779 /*********************************************/
1780 /*           HELPER: ClearBuffer             */
1781 /*********************************************/
1782
1783 #ifdef LINUX_KERNEL
1784 static void
1785 SiS_ClearBuffer(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo, USHORT ModeNo)
1786 {
1787   UCHAR SISIOMEMTYPE *VideoMemoryAddress = HwInfo->pjVideoMemoryAddress;
1788   ULONG  AdapterMemorySize = HwInfo->ulVideoMemorySize;
1789   USHORT SISIOMEMTYPE *pBuffer;
1790   int i;
1791
1792   if(SiS_Pr->SiS_ModeType >= ModeEGA) {
1793      if(ModeNo > 0x13) {
1794         SiS_SetMemory(VideoMemoryAddress, AdapterMemorySize, 0);
1795      } else {
1796         pBuffer = (USHORT SISIOMEMTYPE *)VideoMemoryAddress;
1797         for(i=0; i<0x4000; i++) writew(0x0000, &pBuffer[i]);
1798      }
1799   } else {
1800      if(SiS_Pr->SiS_ModeType < ModeCGA) {
1801         pBuffer = (USHORT SISIOMEMTYPE *)VideoMemoryAddress;
1802         for(i=0; i<0x4000; i++) writew(0x0720, &pBuffer[i]);
1803      } else {
1804         SiS_SetMemory(VideoMemoryAddress, 0x8000, 0);
1805      }
1806   }
1807 }
1808 #endif
1809
1810 /*********************************************/
1811 /*           HELPER: SearchModeID            */
1812 /*********************************************/
1813
1814 BOOLEAN
1815 SiS_SearchModeID(SiS_Private *SiS_Pr, USHORT *ModeNo, USHORT *ModeIdIndex)
1816 {
1817    UCHAR VGAINFO = SiS_Pr->SiS_VGAINFO;
1818
1819    if(*ModeNo <= 0x13) {
1820
1821       if((*ModeNo) <= 0x05) (*ModeNo) |= 0x01;
1822
1823       for(*ModeIdIndex = 0; ;(*ModeIdIndex)++) {
1824          if(SiS_Pr->SiS_SModeIDTable[*ModeIdIndex].St_ModeID == (*ModeNo)) break;
1825          if(SiS_Pr->SiS_SModeIDTable[*ModeIdIndex].St_ModeID == 0xFF)   return FALSE;
1826       }
1827
1828       if(*ModeNo == 0x07) {
1829           if(VGAINFO & 0x10) (*ModeIdIndex)++;   /* 400 lines */
1830           /* else 350 lines */
1831       }
1832       if(*ModeNo <= 0x03) {
1833          if(!(VGAINFO & 0x80)) (*ModeIdIndex)++;
1834          if(VGAINFO & 0x10)    (*ModeIdIndex)++; /* 400 lines  */
1835          /* else 350 lines  */
1836       }
1837       /* else 200 lines  */
1838
1839    } else {
1840
1841       for(*ModeIdIndex = 0; ;(*ModeIdIndex)++) {
1842          if(SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == (*ModeNo)) break;
1843          if(SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == 0xFF)      return FALSE;
1844       }
1845
1846    }
1847    return TRUE;
1848 }
1849
1850 /*********************************************/
1851 /*            HELPER: GetModePtr             */
1852 /*********************************************/
1853
1854 UCHAR
1855 SiS_GetModePtr(SiS_Private *SiS_Pr, USHORT ModeNo, USHORT ModeIdIndex)
1856 {
1857    UCHAR index;
1858
1859    if(ModeNo <= 0x13) {
1860       index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_StTableIndex;
1861    } else {
1862       if(SiS_Pr->SiS_ModeType <= ModeEGA) index = 0x1B;
1863       else index = 0x0F;
1864    }
1865    return index;
1866 }
1867
1868 /*********************************************/
1869 /*           HELPER: LowModeTests            */
1870 /*********************************************/
1871
1872 static BOOLEAN
1873 SiS_DoLowModeTest(SiS_Private *SiS_Pr, USHORT ModeNo, PSIS_HW_INFO HwInfo)
1874 {
1875     USHORT temp,temp1,temp2;
1876
1877     if((ModeNo != 0x03) && (ModeNo != 0x10) && (ModeNo != 0x12))
1878        return(TRUE);
1879     temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x11);
1880     SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x11,0x80);
1881     temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x00);
1882     SiS_SetReg(SiS_Pr->SiS_P3d4,0x00,0x55);
1883     temp2 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x00);
1884     SiS_SetReg(SiS_Pr->SiS_P3d4,0x00,temp1);
1885     SiS_SetReg(SiS_Pr->SiS_P3d4,0x11,temp);
1886     if((HwInfo->jChipType >= SIS_315H) ||
1887        (HwInfo->jChipType == SIS_300)) {
1888        if(temp2 == 0x55) return(FALSE);
1889        else return(TRUE);
1890     } else {
1891        if(temp2 != 0x55) return(TRUE);
1892        else {
1893           SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x35,0x01);
1894           return(FALSE);
1895        }
1896     }
1897 }
1898
1899 static void
1900 SiS_SetLowModeTest(SiS_Private *SiS_Pr, USHORT ModeNo, PSIS_HW_INFO HwInfo)
1901 {
1902     if(SiS_DoLowModeTest(SiS_Pr, ModeNo, HwInfo)) {
1903        SiS_Pr->SiS_SetFlag |= LowModeTests;
1904     }
1905 }
1906
1907 /*********************************************/
1908 /*            HELPER: ENABLE CRT1            */
1909 /*********************************************/
1910
1911 static void
1912 SiS_SetupCR5x(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
1913 {
1914     if(IS_SIS650) {
1915        if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
1916           SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x51,0x1f);
1917           if(IS_SIS651) SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x51,0x20);
1918           SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x56,0xe7);
1919        }
1920     } else if(IS_SIS661741660760) {
1921        SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x61,0xf7);
1922        SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x51,0x1f);
1923        SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x56,0xe7);
1924        if(!SiS_Pr->SiS_ROMNew) {
1925           SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x3a,0xef);
1926        }
1927     }
1928 }
1929
1930 static void
1931 SiS_HandleCRT1(SiS_Private *SiS_Pr)
1932 {
1933   /* Enable CRT1 gating */
1934   SiS_SetRegAND(SiS_Pr->SiS_P3d4,SiS_Pr->SiS_MyCR63,0xbf);
1935 #if 0
1936   if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x15) & 0x01)) {
1937      if((SiS_GetReg(SiS_Pr->SiS_P3c4,0x15) & 0x0a) ||
1938         (SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x01)) {
1939         SiS_SetRegOR(SiS_Pr->SiS_P3d4,SiS_Pr->SiS_MyCR63,0x40);
1940      }
1941   }
1942 #endif
1943 }
1944
1945 /*********************************************/
1946 /*           HELPER: GetColorDepth           */
1947 /*********************************************/
1948
1949 USHORT
1950 SiS_GetColorDepth(SiS_Private *SiS_Pr, USHORT ModeNo, USHORT ModeIdIndex)
1951 {
1952   USHORT ColorDepth[6] = { 1, 2, 4, 4, 6, 8};
1953   SHORT  index;
1954   USHORT modeflag;
1955
1956   /* Do NOT check UseCustomMode, will skrew up FIFO */
1957   if(ModeNo == 0xfe) {
1958      modeflag = SiS_Pr->CModeFlag;
1959   } else {
1960      if(ModeNo <= 0x13)
1961         modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
1962      else
1963         modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1964   }
1965
1966   index = (modeflag & ModeTypeMask) - ModeEGA;
1967   if(index < 0) index = 0;
1968   return(ColorDepth[index]);
1969 }
1970
1971 /*********************************************/
1972 /*             HELPER: GetOffset             */
1973 /*********************************************/
1974
1975 USHORT
1976 SiS_GetOffset(SiS_Private *SiS_Pr,USHORT ModeNo,USHORT ModeIdIndex,
1977               USHORT RefreshRateTableIndex,PSIS_HW_INFO HwInfo)
1978 {
1979   USHORT xres, temp, colordepth, infoflag;
1980
1981   if(SiS_Pr->UseCustomMode) {
1982      infoflag = SiS_Pr->CInfoFlag;
1983      xres = SiS_Pr->CHDisplay;
1984   } else {
1985      infoflag = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
1986      xres = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].XRes;
1987   }
1988
1989   colordepth = SiS_GetColorDepth(SiS_Pr,ModeNo,ModeIdIndex);
1990
1991   temp = xres / 16;
1992   if(infoflag & InterlaceMode) temp <<= 1;
1993   temp *= colordepth;
1994   if(xres % 16) {
1995      colordepth >>= 1;
1996      temp += colordepth;
1997   }
1998
1999   return(temp);
2000 }
2001
2002 /*********************************************/
2003 /*                   SEQ                     */
2004 /*********************************************/
2005
2006 static void
2007 SiS_SetSeqRegs(SiS_Private *SiS_Pr, USHORT StandTableIndex, PSIS_HW_INFO HwInfo)
2008 {
2009    UCHAR SRdata;
2010    USHORT i;
2011
2012    SiS_SetReg(SiS_Pr->SiS_P3c4,0x00,0x03);              /* Set SR0  */
2013
2014    SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[0];
2015
2016    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
2017       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
2018          SRdata |= 0x01;
2019       }
2020       if(HwInfo->jChipType >= SIS_661) {
2021          if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
2022             if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2023                SRdata |= 0x01;                          /* 8 dot clock  */
2024             }
2025          }
2026       } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
2027          if(SiS_Pr->SiS_VBType & VB_NoLCD) {
2028             if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2029                SRdata |= 0x01;                          /* 8 dot clock  */
2030             }
2031          }
2032       }
2033    }
2034
2035    if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
2036       if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
2037          if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
2038             if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2039                SRdata |= 0x01;                          /* 8 dot clock  */
2040             }
2041          }
2042       }
2043       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
2044          if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2045             SRdata |= 0x01;                             /* 8 dot clock  */
2046          }
2047       }
2048    }
2049
2050    SRdata |= 0x20;                                      /* screen off  */
2051
2052    SiS_SetReg(SiS_Pr->SiS_P3c4,0x01,SRdata);
2053
2054    for(i = 2; i <= 4; i++) {
2055       SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[i-1];
2056       SiS_SetReg(SiS_Pr->SiS_P3c4,i,SRdata);
2057    }
2058 }
2059
2060 /*********************************************/
2061 /*                  MISC                     */
2062 /*********************************************/
2063
2064 static void
2065 SiS_SetMiscRegs(SiS_Private *SiS_Pr, USHORT StandTableIndex, PSIS_HW_INFO HwInfo)
2066 {
2067    UCHAR Miscdata;
2068
2069    Miscdata = SiS_Pr->SiS_StandTable[StandTableIndex].MISC;
2070
2071    if(HwInfo->jChipType < SIS_661) {
2072       if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
2073          if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
2074             Miscdata |= 0x0C;
2075          }
2076       }
2077    }
2078
2079    SiS_SetRegByte(SiS_Pr->SiS_P3c2,Miscdata);
2080 }
2081
2082 /*********************************************/
2083 /*                  CRTC                     */
2084 /*********************************************/
2085
2086 static void
2087 SiS_SetCRTCRegs(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,
2088                 USHORT StandTableIndex)
2089 {
2090   UCHAR CRTCdata;
2091   USHORT i;
2092
2093   SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f);                       /* Unlock CRTC */
2094
2095   for(i = 0; i <= 0x18; i++) {
2096      CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i];
2097      SiS_SetReg(SiS_Pr->SiS_P3d4,i,CRTCdata);                     /* Set CRTC(3d4) */
2098   }
2099   if(HwInfo->jChipType >= SIS_661) {
2100      SiS_SetupCR5x(SiS_Pr, HwInfo);
2101      for(i = 0x13; i <= 0x14; i++) {
2102         CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i];
2103         SiS_SetReg(SiS_Pr->SiS_P3d4,i,CRTCdata);
2104      }
2105   } else if( ( (HwInfo->jChipType == SIS_630) ||
2106                (HwInfo->jChipType == SIS_730) )  &&
2107              (HwInfo->jChipRevision >= 0x30) ) {           /* for 630S0 */
2108      if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2109         if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
2110            SiS_SetReg(SiS_Pr->SiS_P3d4,0x18,0xFE);
2111         }
2112      }
2113   }
2114 }
2115
2116 /*********************************************/
2117 /*                   ATT                     */
2118 /*********************************************/
2119
2120 static void
2121 SiS_SetATTRegs(SiS_Private *SiS_Pr, USHORT StandTableIndex,
2122                PSIS_HW_INFO HwInfo)
2123 {
2124    UCHAR ARdata;
2125    USHORT i;
2126
2127    for(i = 0; i <= 0x13; i++) {
2128       ARdata = SiS_Pr->SiS_StandTable[StandTableIndex].ATTR[i];
2129 #if 0
2130       if((i <= 0x0f) || (i == 0x11)) {
2131          if(ds:489 & 0x08) {
2132             continue;
2133          }
2134       }
2135 #endif
2136       if(i == 0x13) {
2137          /* Pixel shift. If screen on LCD or TV is shifted left or right,
2138           * this might be the cause.
2139           */
2140          if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
2141             if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)  ARdata=0;
2142          }
2143          if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
2144             if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
2145                if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
2146                   if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata=0;
2147                }
2148             }
2149          }
2150          if(HwInfo->jChipType >= SIS_661) {
2151             if(SiS_Pr->SiS_VBInfo & (SetCRT2ToTV | SetCRT2ToLCD)) {
2152                if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata=0;
2153             }
2154          } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
2155             if(HwInfo->jChipType >= SIS_315H) {
2156                if(IS_SIS550650740660) {
2157                   /* 315, 330 don't do this */
2158                   if(SiS_Pr->SiS_VBType & VB_SIS301B302B) {
2159                      if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata=0;
2160                   } else {
2161                      ARdata = 0;
2162                   }
2163                }
2164             } else {
2165                if(SiS_Pr->SiS_VBInfo & SetInSlaveMode)  ARdata=0;
2166             }
2167          }
2168       }
2169       SiS_GetRegByte(SiS_Pr->SiS_P3da);                         /* reset 3da  */
2170       SiS_SetRegByte(SiS_Pr->SiS_P3c0,i);                       /* set index  */
2171       SiS_SetRegByte(SiS_Pr->SiS_P3c0,ARdata);                  /* set data   */
2172    }
2173    SiS_GetRegByte(SiS_Pr->SiS_P3da);                            /* reset 3da  */
2174    SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x14);                       /* set index  */
2175    SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x00);                       /* set data   */
2176
2177    SiS_GetRegByte(SiS_Pr->SiS_P3da);
2178    SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x20);                       /* Enable Attribute  */
2179    SiS_GetRegByte(SiS_Pr->SiS_P3da);
2180 }
2181
2182 /*********************************************/
2183 /*                   GRC                     */
2184 /*********************************************/
2185
2186 static void
2187 SiS_SetGRCRegs(SiS_Private *SiS_Pr, USHORT StandTableIndex)
2188 {
2189    UCHAR GRdata;
2190    USHORT i;
2191
2192    for(i = 0; i <= 0x08; i++) {
2193       GRdata = SiS_Pr->SiS_StandTable[StandTableIndex].GRC[i];
2194       SiS_SetReg(SiS_Pr->SiS_P3ce,i,GRdata);
2195    }
2196
2197    if(SiS_Pr->SiS_ModeType > ModeVGA) {
2198       /* 256 color disable */
2199       SiS_SetRegAND(SiS_Pr->SiS_P3ce,0x05,0xBF);
2200    }
2201 }
2202
2203 /*********************************************/
2204 /*          CLEAR EXTENDED REGISTERS         */
2205 /*********************************************/
2206
2207 static void
2208 SiS_ClearExt1Regs(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo, USHORT ModeNo)
2209 {
2210   USHORT i;
2211
2212   for(i = 0x0A; i <= 0x0E; i++) {
2213      SiS_SetReg(SiS_Pr->SiS_P3c4,i,0x00);
2214   }
2215
2216   if(HwInfo->jChipType >= SIS_315H) {
2217      SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x37,0xFE);
2218      if(ModeNo <= 0x13) {
2219         if(ModeNo == 0x06 || ModeNo >= 0x0e) {
2220            SiS_SetReg(SiS_Pr->SiS_P3c4,0x0e,0x20);
2221         }
2222      }
2223   }
2224 }
2225
2226 /*********************************************/
2227 /*                 RESET VCLK                */
2228 /*********************************************/
2229
2230 static void
2231 SiS_ResetCRT1VCLK(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
2232 {
2233    if(HwInfo->jChipType >= SIS_315H) {
2234       if(HwInfo->jChipType < SIS_661) {
2235          if(SiS_Pr->SiS_IF_DEF_LVDS == 0) return;
2236       }
2237    } else {
2238       if((SiS_Pr->SiS_IF_DEF_LVDS == 0) &&
2239          (!(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV)) ) {
2240          return;
2241       }
2242    }
2243
2244    if(HwInfo->jChipType >= SIS_315H) {
2245       SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xCF,0x20);
2246    } else {
2247       SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x20);
2248    }
2249    SiS_SetReg(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[1].SR2B);
2250    SiS_SetReg(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[1].SR2C);
2251    SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80);
2252    if(HwInfo->jChipType >= SIS_315H) {
2253       SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xcf,0x10);
2254    } else {
2255       SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x10);
2256    }
2257    SiS_SetReg(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[0].SR2B);
2258    SiS_SetReg(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[0].SR2C);
2259    SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80);
2260 }
2261
2262 /*********************************************/
2263 /*                  SYNC                     */
2264 /*********************************************/
2265
2266 static void
2267 SiS_SetCRT1Sync(SiS_Private *SiS_Pr, USHORT RefreshRateTableIndex)
2268 {
2269   USHORT sync;
2270
2271   if(SiS_Pr->UseCustomMode) {
2272      sync = SiS_Pr->CInfoFlag >> 8;
2273   } else {
2274      sync = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag >> 8;
2275   }
2276
2277   sync &= 0xC0;
2278   sync |= 0x2f;
2279   SiS_SetRegByte(SiS_Pr->SiS_P3c2,sync);
2280 }
2281
2282 /*********************************************/
2283 /*                  CRTC/2                   */
2284 /*********************************************/
2285
2286 static void
2287 SiS_SetCRT1CRTC(SiS_Private *SiS_Pr, USHORT ModeNo, USHORT ModeIdIndex,
2288                 USHORT RefreshRateTableIndex,
2289                 PSIS_HW_INFO HwInfo)
2290 {
2291   UCHAR  index;
2292   USHORT temp,i,j,modeflag;
2293
2294   SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f);            /* unlock cr0-7 */
2295
2296   if(SiS_Pr->UseCustomMode) {
2297
2298      modeflag = SiS_Pr->CModeFlag;
2299
2300      for(i=0,j=0;i<=7;i++,j++) {
2301         SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]);
2302      }
2303      for(j=0x10;i<=10;i++,j++) {
2304         SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]);
2305      }
2306      for(j=0x15;i<=12;i++,j++) {
2307         SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]);
2308      }
2309      for(j=0x0A;i<=15;i++,j++) {
2310         SiS_SetReg(SiS_Pr->SiS_P3c4,j,SiS_Pr->CCRT1CRTC[i]);
2311      }
2312
2313      temp = SiS_Pr->CCRT1CRTC[16] & 0xE0;
2314      SiS_SetReg(SiS_Pr->SiS_P3c4,0x0E,temp);
2315
2316      temp = (SiS_Pr->CCRT1CRTC[16] & 0x01) << 5;
2317      if(modeflag & DoubleScanMode) temp |= 0x80;
2318      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,0x5F,temp);
2319
2320   } else {
2321
2322      if(ModeNo <= 0x13) {
2323         modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
2324      } else {
2325         modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2326      }
2327
2328      index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;
2329
2330      for(i=0,j=0;i<=7;i++,j++) {
2331         SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->SiS_CRT1Table[index].CR[i]);
2332      }
2333      for(j=0x10;i<=10;i++,j++) {
2334         SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->SiS_CRT1Table[index].CR[i]);
2335      }
2336      for(j=0x15;i<=12;i++,j++) {
2337         SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->SiS_CRT1Table[index].CR[i]);
2338      }
2339      for(j=0x0A;i<=15;i++,j++) {
2340         SiS_SetReg(SiS_Pr->SiS_P3c4,j,SiS_Pr->SiS_CRT1Table[index].CR[i]);
2341      }
2342
2343      temp = SiS_Pr->SiS_CRT1Table[index].CR[16] & 0xE0;
2344      SiS_SetReg(SiS_Pr->SiS_P3c4,0x0E,temp);
2345
2346      temp = ((SiS_Pr->SiS_CRT1Table[index].CR[16]) & 0x01) << 5;
2347      if(modeflag & DoubleScanMode)  temp |= 0x80;
2348      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,0x5F,temp);
2349
2350   }
2351
2352   if(SiS_Pr->SiS_ModeType > ModeVGA) SiS_SetReg(SiS_Pr->SiS_P3d4,0x14,0x4F);
2353 }
2354
2355 /*********************************************/
2356 /*               OFFSET & PITCH              */
2357 /*********************************************/
2358 /*  (partly overruled by SetPitch() in XF86) */
2359 /*********************************************/
2360
2361 static void
2362 SiS_SetCRT1Offset(SiS_Private *SiS_Pr, USHORT ModeNo, USHORT ModeIdIndex,
2363                   USHORT RefreshRateTableIndex,
2364                   PSIS_HW_INFO HwInfo)
2365 {
2366    USHORT temp, DisplayUnit, infoflag;
2367
2368    if(SiS_Pr->UseCustomMode) {
2369       infoflag = SiS_Pr->CInfoFlag;
2370    } else {
2371       infoflag = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
2372    }
2373
2374    DisplayUnit = SiS_GetOffset(SiS_Pr,ModeNo,ModeIdIndex,
2375                                RefreshRateTableIndex,HwInfo);
2376
2377    temp = (DisplayUnit >> 8) & 0x0f;
2378    SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0xF0,temp);
2379
2380    temp = DisplayUnit & 0xFF;
2381    SiS_SetReg(SiS_Pr->SiS_P3d4,0x13,temp);
2382
2383    if(infoflag & InterlaceMode) DisplayUnit >>= 1;
2384
2385    DisplayUnit <<= 5;
2386    temp = (DisplayUnit & 0xff00) >> 8;
2387    if(DisplayUnit & 0xff) temp++;
2388    temp++;
2389    SiS_SetReg(SiS_Pr->SiS_P3c4,0x10,temp);
2390 }
2391
2392 /*********************************************/
2393 /*                  VCLK                     */
2394 /*********************************************/
2395
2396 static void
2397 SiS_SetCRT1VCLK(SiS_Private *SiS_Pr, USHORT ModeNo, USHORT ModeIdIndex,
2398                 PSIS_HW_INFO HwInfo, USHORT RefreshRateTableIndex)
2399 {
2400   USHORT  index=0, clka, clkb;
2401
2402   if(SiS_Pr->UseCustomMode) {
2403      clka = SiS_Pr->CSR2B;
2404      clkb = SiS_Pr->CSR2C;
2405   } else {
2406      index = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex, HwInfo);
2407      if((SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
2408         clka = SiS_Pr->SiS_VBVCLKData[index].Part4_A;
2409         clkb = SiS_Pr->SiS_VBVCLKData[index].Part4_B;
2410      } else {
2411         clka = SiS_Pr->SiS_VCLKData[index].SR2B;
2412         clkb = SiS_Pr->SiS_VCLKData[index].SR2C;
2413      }
2414   }
2415
2416   if(HwInfo->jChipType >= SIS_315H) {
2417      SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xCF);
2418   } else {
2419      SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x00);
2420   }
2421
2422   SiS_SetReg(SiS_Pr->SiS_P3c4,0x2B,clka);
2423   SiS_SetReg(SiS_Pr->SiS_P3c4,0x2C,clkb);
2424
2425   if(HwInfo->jChipType >= SIS_315H) {
2426      SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x01);
2427   } else {
2428      SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80);
2429   }
2430 }
2431
2432 /*********************************************/
2433 /*                  FIFO                     */
2434 /*********************************************/
2435
2436 #ifdef SIS300
2437 static USHORT
2438 SiS_DoCalcDelay(SiS_Private *SiS_Pr, USHORT MCLK, USHORT VCLK, USHORT colordepth, USHORT key)
2439 {
2440   const UCHAR ThLowA[]   = { 61, 3,52, 5,68, 7,100,11,
2441                              43, 3,42, 5,54, 7, 78,11,
2442                              34, 3,37, 5,47, 7, 67,11 };
2443
2444   const UCHAR ThLowB[]   = { 81, 4,72, 6,88, 8,120,12,
2445                              55, 4,54, 6,66, 8, 90,12,
2446                              42, 4,45, 6,55, 8, 75,12 };
2447
2448   const UCHAR ThTiming[] = {  1, 2, 2, 3, 0, 1,  1, 2 };
2449
2450   USHORT tempah, tempal, tempcl, tempbx, temp;
2451   ULONG  longtemp;
2452
2453   tempah = SiS_GetReg(SiS_Pr->SiS_P3c4,0x18);
2454   tempah &= 0x62;
2455   tempah >>= 1;
2456   tempal = tempah;
2457   tempah >>= 3;
2458   tempal |= tempah;
2459   tempal &= 0x07;
2460   tempcl = ThTiming[tempal];
2461   tempbx = SiS_GetReg(SiS_Pr->SiS_P3c4,0x16);
2462   tempbx >>= 6;
2463   tempah = SiS_GetReg(SiS_Pr->SiS_P3c4,0x14);
2464   tempah >>= 4;
2465   tempah &= 0x0c;
2466   tempbx |= tempah;
2467   tempbx <<= 1;
2468   if(key == 0) {
2469      tempal = ThLowA[tempbx + 1];
2470      tempal *= tempcl;
2471      tempal += ThLowA[tempbx];
2472   } else {
2473      tempal = ThLowB[tempbx + 1];
2474      tempal *= tempcl;
2475      tempal += ThLowB[tempbx];
2476   }
2477   longtemp = tempal * VCLK * colordepth;
2478   temp = longtemp % (MCLK * 16);
2479   longtemp /= (MCLK * 16);
2480   if(temp) longtemp++;
2481   return((USHORT)longtemp);
2482 }
2483
2484 static USHORT
2485 SiS_CalcDelay(SiS_Private *SiS_Pr, USHORT VCLK, USHORT colordepth, USHORT MCLK)
2486 {
2487   USHORT tempax, tempbx;
2488
2489   tempbx = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 0);
2490   tempax = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 1);
2491   if(tempax < 4) tempax = 4;
2492   tempax -= 4;
2493   if(tempbx < tempax) tempbx = tempax;
2494   return(tempbx);
2495 }
2496
2497 static void
2498 SiS_SetCRT1FIFO_300(SiS_Private *SiS_Pr, USHORT ModeNo, PSIS_HW_INFO HwInfo,
2499                     USHORT RefreshRateTableIndex)
2500 {
2501   USHORT  ThresholdLow = 0;
2502   USHORT  index, VCLK, MCLK, colorth=0;
2503   USHORT  tempah, temp;
2504
2505   if(ModeNo > 0x13) {
2506
2507      if(SiS_Pr->UseCustomMode) {
2508         VCLK = SiS_Pr->CSRClock;
2509      } else {
2510         index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
2511         index &= 0x3F;
2512         VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;             /* Get VCLK  */
2513      }
2514
2515      switch (SiS_Pr->SiS_ModeType - ModeEGA) {     /* Get half colordepth */
2516         case 0 : colorth = 1; break;
2517         case 1 : colorth = 1; break;
2518         case 2 : colorth = 2; break;
2519         case 3 : colorth = 2; break;
2520         case 4 : colorth = 3; break;
2521         case 5 : colorth = 4; break;
2522      }
2523
2524      index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3A);
2525      index &= 0x07;
2526      MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK;           /* Get MCLK  */
2527
2528      tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
2529      tempah &= 0xc3;
2530      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3c,tempah);
2531
2532      do {
2533         ThresholdLow = SiS_CalcDelay(SiS_Pr, VCLK, colorth, MCLK);
2534         ThresholdLow++;
2535         if(ThresholdLow < 0x13) break;
2536         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x16,0xfc);
2537         ThresholdLow = 0x13;
2538         tempah = SiS_GetReg(SiS_Pr->SiS_P3c4,0x16);
2539         tempah >>= 6;
2540         if(!(tempah)) break;
2541         tempah--;
2542         tempah <<= 6;
2543         SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3f,tempah);
2544      } while(0);
2545
2546   } else ThresholdLow = 2;
2547
2548   /* Write CRT/CPU threshold low, CRT/Engine threshold high */
2549   temp = (ThresholdLow << 4) | 0x0f;
2550   SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,temp);
2551
2552   temp = (ThresholdLow & 0x10) << 1;
2553   if(ModeNo > 0x13) temp |= 0x40;
2554   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0f,0x9f,temp);
2555
2556   /* What is this? */
2557   SiS_SetReg(SiS_Pr->SiS_P3c4,0x3B,0x09);
2558
2559   /* Write CRT/CPU threshold high */
2560   temp = ThresholdLow + 3;
2561   if(temp > 0x0f) temp = 0x0f;
2562   SiS_SetReg(SiS_Pr->SiS_P3c4,0x09,temp);
2563 }
2564
2565 static USHORT
2566 SiS_CalcDelay2(SiS_Private *SiS_Pr, UCHAR key, PSIS_HW_INFO HwInfo)
2567 {
2568   USHORT data,index;
2569   const UCHAR  LatencyFactor[] = {
2570         97, 88, 86, 79, 77, 00,       /*; 64  bit    BQ=2   */
2571         00, 87, 85, 78, 76, 54,       /*; 64  bit    BQ=1   */
2572         97, 88, 86, 79, 77, 00,       /*; 128 bit    BQ=2   */
2573         00, 79, 77, 70, 68, 48,       /*; 128 bit    BQ=1   */
2574         80, 72, 69, 63, 61, 00,       /*; 64  bit    BQ=2   */
2575         00, 70, 68, 61, 59, 37,       /*; 64  bit    BQ=1   */
2576         86, 77, 75, 68, 66, 00,       /*; 128 bit    BQ=2   */
2577         00, 68, 66, 59, 57, 37        /*; 128 bit    BQ=1   */
2578   };
2579   const UCHAR  LatencyFactor730[] = {
2580          69, 63, 61,
2581          86, 79, 77,
2582         103, 96, 94,
2583         120,113,111,
2584         137,130,128,    /* --- Table ends with this entry, data below */
2585         137,130,128,    /* to avoid using illegal values              */
2586         137,130,128,
2587         137,130,128,
2588         137,130,128,
2589         137,130,128,
2590         137,130,128,
2591         137,130,128,
2592         137,130,128,
2593         137,130,128,
2594         137,130,128,
2595         137,130,128,
2596   };
2597
2598   if(HwInfo->jChipType == SIS_730) {
2599      index = ((key & 0x0f) * 3) + ((key & 0xC0) >> 6);
2600      data = LatencyFactor730[index];
2601   } else {
2602      index = (key & 0xE0) >> 5;
2603      if(key & 0x10) index +=6;
2604      if(!(key & 0x01)) index += 24;
2605      data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x14);
2606      if(data & 0x0080) index += 12;
2607      data = LatencyFactor[index];
2608   }
2609   return(data);
2610 }
2611
2612 static void
2613 SiS_SetCRT1FIFO_630(SiS_Private *SiS_Pr, USHORT ModeNo,
2614                     PSIS_HW_INFO HwInfo,
2615                     USHORT RefreshRateTableIndex)
2616 {
2617   USHORT  i,index,data,VCLK,MCLK,colorth=0;
2618   ULONG   B,eax,bl,data2;
2619   USHORT  ThresholdLow=0;
2620   UCHAR   FQBQData[]= {
2621         0x01,0x21,0x41,0x61,0x81,
2622         0x31,0x51,0x71,0x91,0xb1,
2623         0x00,0x20,0x40,0x60,0x80,
2624         0x30,0x50,0x70,0x90,0xb0,
2625         0xFF
2626   };
2627   UCHAR   FQBQData730[]= {
2628         0x34,0x74,0xb4,
2629         0x23,0x63,0xa3,
2630         0x12,0x52,0x92,
2631         0x01,0x41,0x81,
2632         0x00,0x40,0x80,
2633         0xff
2634   };
2635
2636   i=0;
2637   if(ModeNo > 0x13) {
2638     if(SiS_Pr->UseCustomMode) {
2639        VCLK = SiS_Pr->CSRClock;
2640     } else {
2641        index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
2642        index &= 0x3F;
2643        VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;          /* Get VCLK  */
2644     }
2645
2646     index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1A);
2647     index &= 0x07;
2648     MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK;           /* Get MCLK  */
2649
2650     data2 = SiS_Pr->SiS_ModeType - ModeEGA;       /* Get half colordepth */
2651     switch (data2) {
2652         case 0 : colorth = 1; break;
2653         case 1 : colorth = 1; break;
2654         case 2 : colorth = 2; break;
2655         case 3 : colorth = 2; break;
2656         case 4 : colorth = 3; break;
2657         case 5 : colorth = 4; break;
2658     }
2659
2660     if(HwInfo->jChipType == SIS_730) {
2661
2662        do {
2663           B = SiS_CalcDelay2(SiS_Pr, FQBQData730[i], HwInfo) * VCLK * colorth;
2664           bl = B / (MCLK * 16);
2665
2666           if(B == bl * 16 * MCLK) {
2667              bl = bl + 1;
2668           } else {
2669              bl = bl + 2;
2670           }
2671
2672           if(bl > 0x13) {
2673              if(FQBQData730[i+1] == 0xFF) {
2674                 ThresholdLow = 0x13;
2675                 break;
2676              }
2677              i++;
2678           } else {
2679              ThresholdLow = bl;
2680              break;
2681           }
2682        } while(FQBQData730[i] != 0xFF);
2683
2684     } else {
2685
2686        do {
2687           B = SiS_CalcDelay2(SiS_Pr, FQBQData[i], HwInfo) * VCLK * colorth;
2688           bl = B / (MCLK * 16);
2689
2690           if(B == bl * 16 * MCLK) {
2691              bl = bl + 1;
2692           } else {
2693              bl = bl + 2;
2694           }
2695
2696           if(bl > 0x13) {
2697              if(FQBQData[i+1] == 0xFF) {
2698                 ThresholdLow = 0x13;
2699                 break;
2700              }
2701              i++;
2702           } else {
2703              ThresholdLow = bl;
2704              break;
2705           }
2706        } while(FQBQData[i] != 0xFF);
2707     }
2708   }
2709   else {
2710     if(HwInfo->jChipType == SIS_730) {
2711     } else {
2712       i = 9;
2713     }
2714     ThresholdLow = 0x02;
2715   }
2716
2717   /* Write foreground and background queue */
2718   if(HwInfo->jChipType == SIS_730) {
2719
2720      data2 = FQBQData730[i];
2721      data2 = (data2 & 0xC0) >> 5;
2722      data2 <<= 8;
2723
2724 #ifdef LINUX_KERNEL
2725      SiS_SetRegLong(0xcf8,0x80000050);
2726      eax = SiS_GetRegLong(0xcfc);
2727      eax &= 0xfffff9ff;
2728      eax |= data2;
2729      SiS_SetRegLong(0xcfc,eax);
2730 #else
2731      /* We use pci functions X offers. We use pcitag 0, because
2732       * we want to read/write to the host bridge (which is always
2733       * 00:00.0 on 630, 730 and 540), not the VGA device.
2734       */
2735      eax = pciReadLong(0x00000000, 0x50);
2736      eax &= 0xfffff9ff;
2737      eax |= data2;
2738      pciWriteLong(0x00000000, 0x50, eax);
2739 #endif
2740
2741      /* Write GUI grant timer (PCI config 0xA3) */
2742      data2 = FQBQData730[i] << 8;
2743      data2 = (data2 & 0x0f00) | ((data2 & 0x3000) >> 8);
2744      data2 <<= 20;
2745
2746 #ifdef LINUX_KERNEL
2747      SiS_SetRegLong(0xcf8,0x800000A0);
2748      eax = SiS_GetRegLong(0xcfc);
2749      eax &= 0x00ffffff;
2750      eax |= data2;
2751      SiS_SetRegLong(0xcfc,eax);
2752 #else
2753      eax = pciReadLong(0x00000000, 0xA0);
2754      eax &= 0x00ffffff;
2755      eax |= data2;
2756      pciWriteLong(0x00000000, 0xA0, eax);
2757 #endif
2758
2759   } else {
2760
2761      data2 = FQBQData[i];
2762      data2 = (data2 & 0xf0) >> 4;
2763      data2 <<= 24;
2764
2765 #ifdef LINUX_KERNEL
2766      SiS_SetRegLong(0xcf8,0x80000050);
2767      eax = SiS_GetRegLong(0xcfc);
2768      eax &= 0xf0ffffff;
2769      eax |= data2;
2770      SiS_SetRegLong(0xcfc,eax);
2771 #else
2772      eax = pciReadLong(0x00000000, 0x50);
2773      eax &= 0xf0ffffff;
2774      eax |= data2;
2775      pciWriteLong(0x00000000, 0x50, eax);
2776 #endif
2777
2778      /* Write GUI grant timer (PCI config 0xA3) */
2779      data2 = FQBQData[i];
2780      data2 &= 0x0f;
2781      data2 <<= 24;
2782
2783 #ifdef LINUX_KERNEL
2784      SiS_SetRegLong(0xcf8,0x800000A0);
2785      eax = SiS_GetRegLong(0xcfc);
2786      eax &= 0xf0ffffff;
2787      eax |= data2;
2788      SiS_SetRegLong(0xcfc,eax);
2789 #else
2790      eax = pciReadLong(0x00000000, 0xA0);
2791      eax &= 0xf0ffffff;
2792      eax |= data2;
2793      pciWriteLong(0x00000000, 0xA0, eax);
2794 #endif
2795
2796   }
2797
2798   /* Write CRT/CPU threshold low, CRT/Engine threshold high */
2799   data = ((ThresholdLow & 0x0f) << 4) | 0x0f;
2800   SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,data);
2801
2802   data = (ThresholdLow & 0x10) << 1;
2803   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xDF,data);
2804
2805   /* What is this? */
2806   SiS_SetReg(SiS_Pr->SiS_P3c4,0x3B,0x09);
2807
2808   /* Write CRT/CPU threshold high (gap = 3) */
2809   data = ThresholdLow + 3;
2810   if(data > 0x0f) data = 0x0f;
2811   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x09,0x80,data);
2812 }
2813 #endif
2814
2815 #ifdef SIS315H
2816 static void
2817 SiS_SetCRT1FIFO_310(SiS_Private *SiS_Pr, USHORT ModeNo, USHORT ModeIdIndex,
2818                     PSIS_HW_INFO HwInfo)
2819 {
2820   USHORT modeflag;
2821
2822   /* disable auto-threshold */
2823   SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x3D,0xFE);
2824
2825   if(SiS_Pr->UseCustomMode) {
2826      modeflag = SiS_Pr->CModeFlag;
2827   } else {
2828      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2829   }
2830
2831   SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,0xAE);
2832   SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x09,0xF0);
2833   if(ModeNo > 0x13) {
2834      if(HwInfo->jChipType >= SIS_661) {
2835         if(!(modeflag & HalfDCLK)) {
2836            SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,0x34);
2837            SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x3D,0x01);
2838         }
2839      } else {
2840         if((!(modeflag & DoubleScanMode)) || (!(modeflag & HalfDCLK))) {
2841            SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,0x34);
2842            SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x3D,0x01);
2843         }
2844      }
2845   }
2846 }
2847 #endif
2848
2849 /*********************************************/
2850 /*              MODE REGISTERS               */
2851 /*********************************************/
2852
2853 static void
2854 SiS_SetVCLKState(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,
2855                  USHORT ModeNo, USHORT RefreshRateTableIndex,
2856                  USHORT ModeIdIndex)
2857 {
2858   USHORT data=0, VCLK=0, index=0;
2859
2860   if(ModeNo > 0x13) {
2861      if(SiS_Pr->UseCustomMode) {
2862         VCLK = SiS_Pr->CSRClock;
2863      } else {
2864         index = SiS_GetVCLK2Ptr(SiS_Pr,ModeNo,ModeIdIndex,
2865                               RefreshRateTableIndex,HwInfo);
2866         VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
2867      }
2868   }
2869
2870   if(HwInfo->jChipType < SIS_315H) {
2871
2872      if(VCLK > 150) data |= 0x80;
2873      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0x7B,data);
2874
2875      data = 0x00;
2876      if(VCLK >= 150) data |= 0x08;
2877      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xF7,data);
2878
2879   } else {
2880
2881      if(VCLK >= 166) data |= 0x0c;
2882      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xf3,data);
2883
2884      if(VCLK >= 166) {
2885         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1f,0xe7);
2886      }
2887   }
2888
2889   /* DAC speed */
2890   if(HwInfo->jChipType >= SIS_661) {
2891
2892      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xE8,0x10);
2893
2894   } else {
2895
2896      data = 0x03;
2897      if((VCLK >= 135) && (VCLK < 160))      data = 0x02;
2898      else if((VCLK >= 160) && (VCLK < 260)) data = 0x01;
2899      else if(VCLK >= 260)                   data = 0x00;
2900
2901      if(HwInfo->jChipType == SIS_540) {
2902         if((VCLK == 203) || (VCLK < 234))   data = 0x02;
2903      }
2904
2905      if(HwInfo->jChipType < SIS_315H) {
2906         SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xFC,data);
2907      } else {
2908         if(HwInfo->jChipType > SIS_315PRO) {
2909            if(ModeNo > 0x13) data &= 0xfc;
2910         }
2911         SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xF8,data);
2912      }
2913
2914   }
2915 }
2916
2917 static void
2918 SiS_SetCRT1ModeRegs(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,
2919                     USHORT ModeNo,USHORT ModeIdIndex,USHORT RefreshRateTableIndex)
2920 {
2921   USHORT data,infoflag=0,modeflag;
2922   USHORT resindex,xres;
2923 #ifdef SIS315H
2924   USHORT data2,data3;
2925   ULONG  longdata;
2926   UCHAR  *ROMAddr  = HwInfo->pjVirtualRomBase;
2927 #endif
2928
2929   if(SiS_Pr->UseCustomMode) {
2930      modeflag = SiS_Pr->CModeFlag;
2931      infoflag = SiS_Pr->CInfoFlag;
2932      xres = SiS_Pr->CHDisplay;
2933   } else {
2934      resindex = SiS_GetResInfo(SiS_Pr,ModeNo,ModeIdIndex);
2935      if(ModeNo > 0x13) {
2936         modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
2937         infoflag = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
2938         xres = SiS_Pr->SiS_ModeResInfo[resindex].HTotal;
2939      } else {
2940         modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
2941         xres = SiS_Pr->SiS_StResInfo[resindex].HTotal;
2942      }
2943   }
2944
2945   /* Disable DPMS */
2946   SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1F,0x3F);
2947
2948   data = 0;
2949   if(ModeNo > 0x13) {
2950      if(SiS_Pr->SiS_ModeType > ModeEGA) {
2951         data |= 0x02;
2952         data |= ((SiS_Pr->SiS_ModeType - ModeVGA) << 2);
2953      }
2954      if(infoflag & InterlaceMode) data |= 0x20;
2955   }
2956   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x06,0xC0,data);
2957
2958   if(HwInfo->jChipType != SIS_300) {
2959      data = 0;
2960      if(infoflag & InterlaceMode) {
2961         if(xres <= 800)       data = 0x0020;
2962         else if(xres <= 1024) data = 0x0035;
2963         else                  data = 0x0048;
2964      }
2965      SiS_SetReg(SiS_Pr->SiS_P3d4,0x19,(data & 0xFF));
2966      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x1a,0xFC,(data >> 8));
2967   }
2968
2969   if(modeflag & HalfDCLK) {
2970      SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x01,0x08);
2971   }
2972
2973   data = 0;
2974   if(modeflag & LineCompareOff) data = 0x08;
2975   if(HwInfo->jChipType == SIS_300) {
2976      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xF7,data);
2977   } else {
2978      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xB7,data);
2979      if(SiS_Pr->SiS_ModeType == ModeEGA) {
2980         if(ModeNo > 0x13) {
2981            SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x0F,0x40);
2982         }
2983      }
2984   }
2985
2986   if(HwInfo->jChipType >= SIS_661) {
2987      SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xfb);
2988   }
2989
2990 #ifdef SIS315H
2991   if(HwInfo->jChipType == SIS_315PRO) {
2992
2993      data = SiS_Get310DRAMType(SiS_Pr, HwInfo);
2994      data = SiS_Pr->SiS_SR15[2][data];
2995      if(SiS_Pr->SiS_ModeType == ModeText) {
2996         data &= 0xc7;
2997      } else {
2998         data2 = SiS_GetOffset(SiS_Pr,ModeNo,ModeIdIndex,
2999                               RefreshRateTableIndex,HwInfo);
3000         data2 >>= 1;
3001         if(infoflag & InterlaceMode) data2 >>= 1;
3002         data3 = SiS_GetColorDepth(SiS_Pr,ModeNo,ModeIdIndex) >> 1;
3003         if(!data3) data3++;
3004         data2 /= data3;
3005         if(data2 >= 0x50) {
3006            data &= 0x0f;
3007            data |= 0x50;
3008         }
3009      }
3010      SiS_SetReg(SiS_Pr->SiS_P3c4,0x17,data);
3011
3012   } else if( (HwInfo->jChipType == SIS_330) ||
3013              ((HwInfo->jChipType == SIS_760) && (SiS_Pr->SiS_SysFlags & SF_760LFB))) {
3014
3015      data = SiS_Get310DRAMType(SiS_Pr, HwInfo);
3016      if(HwInfo->jChipType == SIS_330) {
3017         data = SiS_Pr->SiS_SR15[2][data];
3018      } else {
3019         if(SiS_Pr->SiS_ROMNew)      data = ROMAddr[0xf6];
3020         else if(SiS_Pr->SiS_UseROM) data = ROMAddr[0x100 + data];
3021         else                        data = 0xba;
3022      }
3023      if(SiS_Pr->SiS_ModeType <= ModeEGA) {
3024         data &= 0xc7;
3025      } else {
3026         if(SiS_Pr->UseCustomMode) {
3027            data2 = SiS_Pr->CSRClock;
3028         } else {
3029            data2 = SiS_GetVCLK2Ptr(SiS_Pr,ModeNo,ModeIdIndex,
3030                                    RefreshRateTableIndex,HwInfo);
3031            data2 = SiS_Pr->SiS_VCLKData[data2].CLOCK;
3032         }
3033
3034         data3 = SiS_GetColorDepth(SiS_Pr,ModeNo,ModeIdIndex) >> 1;
3035         if(data3) data2 *= data3;
3036
3037         longdata = SiS_GetMCLK(SiS_Pr, HwInfo) * 1024;
3038
3039         data2 = longdata / data2;
3040
3041         if(HwInfo->jChipType == SIS_330) {
3042            if(SiS_Pr->SiS_ModeType != Mode16Bpp) {
3043               if     (data2 >= 0x19c) data = 0xba;
3044               else if(data2 >= 0x140) data = 0x7a;
3045               else if(data2 >= 0x101) data = 0x3a;
3046               else if(data2 >= 0xf5)  data = 0x32;
3047               else if(data2 >= 0xe2)  data = 0x2a;
3048               else if(data2 >= 0xc4)  data = 0x22;
3049               else if(data2 >= 0xac)  data = 0x1a;
3050               else if(data2 >= 0x9e)  data = 0x12;
3051               else if(data2 >= 0x8e)  data = 0x0a;
3052               else                    data = 0x02;
3053            } else {
3054               if(data2 >= 0x127)      data = 0xba;
3055               else                    data = 0x7a;
3056            }
3057         } else {  /* 760+LFB */
3058            if     (data2 >= 0x190) data = 0xba;
3059            else if(data2 >= 0xff)  data = 0x7a;
3060            else if(data2 >= 0xd3)  data = 0x3a;
3061            else if(data2 >= 0xa9)  data = 0x1a;
3062            else if(data2 >= 0x93)  data = 0x0a;
3063            else                    data = 0x02;
3064         }
3065      }
3066      SiS_SetReg(SiS_Pr->SiS_P3c4,0x17,data);
3067   } else if(HwInfo->jChipType == SIS_340) {
3068      /* TODO */
3069   }
3070 #endif
3071
3072   data = 0x60;
3073   if(SiS_Pr->SiS_ModeType != ModeText) {
3074      data ^= 0x60;
3075      if(SiS_Pr->SiS_ModeType != ModeEGA) {
3076         data ^= 0xA0;
3077      }
3078   }
3079   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x21,0x1F,data);
3080
3081   SiS_SetVCLKState(SiS_Pr, HwInfo, ModeNo, RefreshRateTableIndex, ModeIdIndex);
3082
3083 #ifdef SIS315H
3084   if(HwInfo->jChipType >= SIS_315H) {
3085      if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40) {
3086         SiS_SetReg(SiS_Pr->SiS_P3d4,0x52,0x2c);
3087      } else {
3088         SiS_SetReg(SiS_Pr->SiS_P3d4,0x52,0x6c);
3089      }
3090   }
3091 #endif
3092 }
3093
3094 /*********************************************/
3095 /*                 LOAD DAC                  */
3096 /*********************************************/
3097
3098 #if 0
3099 static void
3100 SiS_ClearDAC(SiS_Private *SiS_Pr, ULONG port)
3101 {
3102    int i;
3103
3104    OutPortByte(port, 0);
3105    port++;
3106    for (i=0; i < (256 * 3); i++) {
3107       OutPortByte(port, 0);
3108    }
3109 }
3110 #endif
3111
3112 static void
3113 SiS_WriteDAC(SiS_Private *SiS_Pr, SISIOADDRESS DACData, USHORT shiftflag,
3114              USHORT dl, USHORT ah, USHORT al, USHORT dh)
3115 {
3116   USHORT temp,bh,bl;
3117
3118   bh = ah;
3119   bl = al;
3120   if(dl != 0) {
3121      temp = bh;
3122      bh = dh;
3123      dh = temp;
3124      if(dl == 1) {
3125         temp = bl;
3126         bl = dh;
3127         dh = temp;
3128      } else {
3129         temp = bl;
3130         bl = bh;
3131         bh = temp;
3132      }
3133   }
3134   if(shiftflag) {
3135      dh <<= 2;
3136      bh <<= 2;
3137      bl <<= 2;
3138   }
3139   SiS_SetRegByte(DACData,(USHORT)dh);
3140   SiS_SetRegByte(DACData,(USHORT)bh);
3141   SiS_SetRegByte(DACData,(USHORT)bl);
3142 }
3143
3144 void
3145 SiS_LoadDAC(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,
3146             USHORT ModeNo, USHORT ModeIdIndex)
3147 {
3148    USHORT data,data2;
3149    USHORT time,i,j,k,m,n,o;
3150    USHORT si,di,bx,dl,al,ah,dh;
3151    USHORT shiftflag;
3152    SISIOADDRESS DACAddr, DACData;
3153    const USHORT *table = NULL;
3154
3155    if(ModeNo <= 0x13) {
3156       data = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
3157    } else {
3158       if(SiS_Pr->UseCustomMode) {
3159          data = SiS_Pr->CModeFlag;
3160       } else {
3161          data = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3162       }
3163    }
3164
3165    data &= DACInfoFlag;
3166    time = 64;
3167    if(data == 0x00) table = SiS_MDA_DAC;
3168    if(data == 0x08) table = SiS_CGA_DAC;
3169    if(data == 0x10) table = SiS_EGA_DAC;
3170    if(data == 0x18) {
3171       time = 256;
3172       table = SiS_VGA_DAC;
3173    }
3174    if(time == 256) j = 16;
3175    else            j = time;
3176
3177    if( ( (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) &&        /* 301B-DH LCD */
3178          (SiS_Pr->SiS_VBType & VB_NoLCD) )        ||
3179        (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)       ||   /* LCDA */
3180        (!(SiS_Pr->SiS_SetFlag & ProgrammingCRT2)) ) {  /* Programming CRT1 */
3181       DACAddr = SiS_Pr->SiS_P3c8;
3182       DACData = SiS_Pr->SiS_P3c9;
3183       shiftflag = 0;
3184       SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF);
3185    } else {
3186       shiftflag = 1;
3187       DACAddr = SiS_Pr->SiS_Part5Port;
3188       DACData = SiS_Pr->SiS_Part5Port + 1;
3189    }
3190
3191    SiS_SetRegByte(DACAddr,0x00);
3192
3193    for(i=0; i<j; i++) {
3194       data = table[i];
3195       for(k=0; k<3; k++) {
3196         data2 = 0;
3197         if(data & 0x01) data2 = 0x2A;
3198         if(data & 0x02) data2 += 0x15;
3199         if(shiftflag) data2 <<= 2;
3200         SiS_SetRegByte(DACData, data2);
3201         data >>= 2;
3202       }
3203    }
3204
3205    if(time == 256) {
3206       for(i = 16; i < 32; i++) {
3207          data = table[i];
3208          if(shiftflag) data <<= 2;
3209          for(k = 0; k < 3; k++) SiS_SetRegByte(DACData, data);
3210       }
3211       si = 32;
3212       for(m = 0; m < 9; m++) {
3213          di = si;
3214          bx = si + 4;
3215          dl = 0;
3216          for(n = 0; n < 3; n++) {
3217             for(o = 0; o < 5; o++) {
3218                dh = table[si];
3219                ah = table[di];
3220                al = table[bx];
3221                si++;
3222                SiS_WriteDAC(SiS_Pr, DACData, shiftflag, dl, ah, al, dh);
3223             }
3224             si -= 2;
3225             for(o = 0; o < 3; o++) {
3226                dh = table[bx];
3227                ah = table[di];
3228                al = table[si];
3229                si--;
3230                SiS_WriteDAC(SiS_Pr, DACData, shiftflag, dl, ah, al, dh);
3231             }
3232             dl++;
3233          }            /* for n < 3 */
3234          si += 5;
3235       }               /* for m < 9 */
3236    }
3237 }
3238
3239 /*********************************************/
3240 /*         SET CRT1 REGISTER GROUP           */
3241 /*********************************************/
3242
3243 static void
3244 SiS_SetCRT1Group(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,
3245                  USHORT ModeNo, USHORT ModeIdIndex)
3246 {
3247   USHORT  StandTableIndex,RefreshRateTableIndex;
3248
3249   SiS_Pr->SiS_CRT1Mode = ModeNo;
3250   StandTableIndex = SiS_GetModePtr(SiS_Pr, ModeNo, ModeIdIndex);
3251   if(SiS_Pr->SiS_SetFlag & LowModeTests) {
3252      if(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2)) {
3253         SiS_DisableBridge(SiS_Pr, HwInfo);
3254      }
3255   }
3256
3257   SiS_ResetSegmentRegisters(SiS_Pr, HwInfo);
3258
3259   SiS_SetSeqRegs(SiS_Pr, StandTableIndex, HwInfo);
3260   SiS_SetMiscRegs(SiS_Pr, StandTableIndex, HwInfo);
3261   SiS_SetCRTCRegs(SiS_Pr, HwInfo, StandTableIndex);
3262   SiS_SetATTRegs(SiS_Pr, StandTableIndex, HwInfo);
3263   SiS_SetGRCRegs(SiS_Pr, StandTableIndex);
3264   SiS_ClearExt1Regs(SiS_Pr, HwInfo, ModeNo);
3265   SiS_ResetCRT1VCLK(SiS_Pr, HwInfo);
3266
3267   SiS_Pr->SiS_SelectCRT2Rate = 0;
3268   SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2);
3269
3270 #ifdef LINUX_XF86
3271   xf86DrvMsgVerb(0, X_PROBED, 4, "(init: VBType=0x%04x, VBInfo=0x%04x)\n",
3272                     SiS_Pr->SiS_VBType, SiS_Pr->SiS_VBInfo);
3273 #endif
3274
3275   if(SiS_Pr->SiS_VBInfo & SetSimuScanMode) {
3276      if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
3277         SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
3278      }
3279   }
3280
3281   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
3282      SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
3283   }
3284
3285   RefreshRateTableIndex = SiS_GetRatePtr(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3286
3287   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
3288      SiS_Pr->SiS_SetFlag &= ~ProgrammingCRT2;
3289   }
3290
3291   if(RefreshRateTableIndex != 0xFFFF) {
3292      SiS_SetCRT1Sync(SiS_Pr, RefreshRateTableIndex);
3293      SiS_SetCRT1CRTC(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex, HwInfo);
3294      SiS_SetCRT1Offset(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex, HwInfo);
3295      SiS_SetCRT1VCLK(SiS_Pr, ModeNo, ModeIdIndex, HwInfo, RefreshRateTableIndex);
3296   }
3297
3298 #ifdef SIS300
3299   if(HwInfo->jChipType == SIS_300) {
3300      SiS_SetCRT1FIFO_300(SiS_Pr, ModeNo,HwInfo,RefreshRateTableIndex);
3301   } else if((HwInfo->jChipType == SIS_630) ||
3302             (HwInfo->jChipType == SIS_730) ||
3303             (HwInfo->jChipType == SIS_540)) {
3304      SiS_SetCRT1FIFO_630(SiS_Pr, ModeNo, HwInfo, RefreshRateTableIndex);
3305   }
3306 #endif
3307 #ifdef SIS315H
3308   if(HwInfo->jChipType >= SIS_315H) {
3309      SiS_SetCRT1FIFO_310(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3310   }
3311 #endif
3312
3313   SiS_SetCRT1ModeRegs(SiS_Pr, HwInfo, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3314
3315   SiS_LoadDAC(SiS_Pr, HwInfo, ModeNo, ModeIdIndex);
3316
3317 #ifdef LINUX_KERNEL
3318   if(SiS_Pr->SiS_flag_clearbuffer) {
3319      SiS_ClearBuffer(SiS_Pr,HwInfo,ModeNo);
3320   }
3321 #endif
3322
3323   if(!(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2 | SetCRT2ToLCDA))) {
3324      SiS_WaitRetrace1(SiS_Pr);
3325      SiS_DisplayOn(SiS_Pr);
3326   }
3327 }
3328
3329 /*********************************************/
3330 /*       HELPER: VIDEO BRIDGE PROG CLK       */
3331 /*********************************************/
3332
3333 static void
3334 SiS_ResetVB(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
3335 {
3336    UCHAR  *ROMAddr  = HwInfo->pjVirtualRomBase;
3337    USHORT temp;
3338
3339    /* VB programming clock */
3340    if(SiS_Pr->SiS_UseROM) {
3341       if(HwInfo->jChipType < SIS_330) {
3342          temp = ROMAddr[VB310Data_1_2_Offset] | 0x40;
3343          if(SiS_Pr->SiS_ROMNew) temp = ROMAddr[0x80] | 0x40;
3344          SiS_SetReg(SiS_Pr->SiS_Part1Port,0x02,temp);
3345       } else if(HwInfo->jChipType >= SIS_661) {
3346          temp = ROMAddr[0x7e] | 0x40;
3347          if(SiS_Pr->SiS_ROMNew) temp = ROMAddr[0x80] | 0x40;
3348          SiS_SetReg(SiS_Pr->SiS_Part1Port,0x02,temp);
3349       }
3350    }
3351 }
3352
3353 /*********************************************/
3354 /*         HELPER: SET VIDEO REGISTERS       */
3355 /*********************************************/
3356
3357 static void
3358 SiS_StrangeStuff(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
3359 {
3360    if((IS_SIS651) || (IS_SISM650)) {
3361       SiS_SetReg(SiS_Pr->SiS_VidCapt, 0x3f, 0x00);   /* Fiddle with capture regs */
3362       SiS_SetReg(SiS_Pr->SiS_VidCapt, 0x00, 0x00);
3363       SiS_SetReg(SiS_Pr->SiS_VidPlay, 0x00, 0x86);   /* (BIOS does NOT unlock) */
3364       SiS_SetRegAND(SiS_Pr->SiS_VidPlay, 0x30, 0xfe); /* Fiddle with video regs */
3365       SiS_SetRegAND(SiS_Pr->SiS_VidPlay, 0x3f, 0xef);
3366    }
3367    /* !!! This does not support modes < 0x13 !!! */
3368 }
3369
3370 /*********************************************/
3371 /*         XFree86: SET SCREEN PITCH         */
3372 /*********************************************/
3373
3374 #ifdef LINUX_XF86
3375 static void
3376 SiS_SetPitchCRT1(SiS_Private *SiS_Pr, ScrnInfoPtr pScrn)
3377 {
3378    SISPtr pSiS = SISPTR(pScrn);
3379    UShort HDisplay = pSiS->scrnPitch >> 3;
3380
3381    SiS_SetReg(SiS_Pr->SiS_P3d4,0x13,(HDisplay & 0xFF));
3382    SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0xF0,(HDisplay>>8));
3383 }
3384
3385 static void
3386 SiS_SetPitchCRT2(SiS_Private *SiS_Pr, ScrnInfoPtr pScrn)
3387 {
3388    SISPtr pSiS = SISPTR(pScrn);
3389    UShort HDisplay = pSiS->scrnPitch2 >> 3;
3390
3391     /* Unlock CRT2 */
3392    if(pSiS->VGAEngine == SIS_315_VGA)
3393      SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2F, 0x01);
3394    else
3395      SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x24, 0x01);
3396
3397    SiS_SetReg(SiS_Pr->SiS_Part1Port,0x07,(HDisplay & 0xFF));
3398    SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x09,0xF0,(HDisplay >> 8));
3399 }
3400
3401 static void
3402 SiS_SetPitch(SiS_Private *SiS_Pr, ScrnInfoPtr pScrn)
3403 {
3404    SISPtr pSiS = SISPTR(pScrn);
3405    BOOLEAN isslavemode = FALSE;
3406
3407    if( (pSiS->VBFlags & VB_VIDEOBRIDGE) &&
3408        ( ((pSiS->VGAEngine == SIS_300_VGA) &&
3409           (SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0xa0) == 0x20) ||
3410          ((pSiS->VGAEngine == SIS_315_VGA) &&
3411           (SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x50) == 0x10) ) ) {
3412       isslavemode = TRUE;
3413    }
3414
3415    /* We need to set pitch for CRT1 if bridge is in slave mode, too */
3416    if((pSiS->VBFlags & DISPTYPE_DISP1) || (isslavemode)) {
3417       SiS_SetPitchCRT1(SiS_Pr, pScrn);
3418    }
3419    /* We must not set the pitch for CRT2 if bridge is in slave mode */
3420    if((pSiS->VBFlags & DISPTYPE_DISP2) && (!isslavemode)) {
3421       SiS_SetPitchCRT2(SiS_Pr, pScrn);
3422    }
3423 }
3424 #endif
3425
3426 /*********************************************/
3427 /*                 SiSSetMode()              */
3428 /*********************************************/
3429
3430 #ifdef LINUX_XF86
3431 /* We need pScrn for setting the pitch correctly */
3432 BOOLEAN
3433 SiSSetMode(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,ScrnInfoPtr pScrn,USHORT ModeNo, BOOLEAN dosetpitch)
3434 #else
3435 BOOLEAN
3436 SiSSetMode(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo,USHORT ModeNo)
3437 #endif
3438 {
3439    USHORT  ModeIdIndex;
3440    SISIOADDRESS BaseAddr = HwInfo->ulIOAddress;
3441    unsigned char backupreg=0;
3442 #ifdef LINUX_KERNEL
3443    USHORT  KeepLockReg;
3444    ULONG   temp;
3445
3446    SiS_Pr->UseCustomMode = FALSE;
3447    SiS_Pr->CRT1UsesCustomMode = FALSE;
3448 #endif
3449
3450    if(SiS_Pr->UseCustomMode) {
3451       ModeNo = 0xfe;
3452    }
3453
3454    SiSInitPtr(SiS_Pr, HwInfo);
3455    SiSRegInit(SiS_Pr, BaseAddr);
3456    SiS_GetSysFlags(SiS_Pr, HwInfo);
3457
3458 #if defined(LINUX_XF86) && (defined(i386) || defined(__i386) || defined(__i386__) || defined(__AMD64__))
3459    if(pScrn) SiS_Pr->SiS_VGAINFO = SiS_GetSetBIOSScratch(pScrn, 0x489, 0xff);
3460    else
3461 #endif
3462          SiS_Pr->SiS_VGAINFO = 0x11;
3463
3464    SiSInitPCIetc(SiS_Pr, HwInfo);
3465    SiSSetLVDSetc(SiS_Pr, HwInfo);
3466    SiSDetermineROMUsage(SiS_Pr, HwInfo);
3467
3468    SiS_Pr->SiS_flag_clearbuffer = 0;
3469
3470    if(!SiS_Pr->UseCustomMode) {
3471 #ifdef LINUX_KERNEL
3472       if(!(ModeNo & 0x80)) SiS_Pr->SiS_flag_clearbuffer = 1;
3473 #endif
3474       ModeNo &= 0x7f;
3475    }
3476
3477 #ifdef LINUX_KERNEL
3478    KeepLockReg = SiS_GetReg(SiS_Pr->SiS_P3c4,0x05);
3479 #endif
3480    SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x86);
3481
3482    SiS_UnLockCRT2(SiS_Pr, HwInfo);
3483
3484    if(!SiS_Pr->UseCustomMode) {
3485       if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) return FALSE;
3486    } else {
3487       ModeIdIndex = 0;
3488    }
3489
3490    SiS_GetVBType(SiS_Pr, HwInfo);
3491
3492    /* Init/restore some VB registers */
3493
3494    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
3495       if(HwInfo->jChipType >= SIS_315H) {
3496          SiS_ResetVB(SiS_Pr, HwInfo);
3497          SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x32,0x10);
3498          SiS_SetRegOR(SiS_Pr->SiS_Part2Port,0x00,0x0c);
3499          backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
3500       } else {
3501          backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
3502       }
3503    }
3504
3505    /* Get VB information (connectors, connected devices) */
3506    SiS_GetVBInfo(SiS_Pr, ModeNo, ModeIdIndex, HwInfo, (SiS_Pr->UseCustomMode) ? 0 : 1);
3507    SiS_SetYPbPr(SiS_Pr, HwInfo);
3508    SiS_SetTVMode(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3509    SiS_GetLCDResInfo(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3510    SiS_SetLowModeTest(SiS_Pr, ModeNo, HwInfo);
3511
3512 #ifdef LINUX_KERNEL
3513    /* 3. Check memory size (Kernel framebuffer driver only) */
3514    temp = SiS_CheckMemorySize(SiS_Pr, HwInfo, ModeNo, ModeIdIndex);
3515    if(!temp) return(0);
3516 #endif
3517
3518    if(HwInfo->jChipType >= SIS_315H) {
3519       SiS_SetupCR5x(SiS_Pr, HwInfo);
3520    }
3521
3522    if(SiS_Pr->UseCustomMode) {
3523       SiS_Pr->CRT1UsesCustomMode = TRUE;
3524       SiS_Pr->CSRClock_CRT1 = SiS_Pr->CSRClock;
3525       SiS_Pr->CModeFlag_CRT1 = SiS_Pr->CModeFlag;
3526    } else {
3527       SiS_Pr->CRT1UsesCustomMode = FALSE;
3528    }
3529
3530    /* Set mode on CRT1 */
3531    if( (SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SetCRT2ToLCDA)) ||
3532        (!(SiS_Pr->SiS_VBInfo & SwitchCRT2)) ) {
3533       SiS_SetCRT1Group(SiS_Pr, HwInfo, ModeNo, ModeIdIndex);
3534    }
3535
3536    /* Set mode on CRT2 */
3537    if(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2 | SetCRT2ToLCDA)) {
3538       if( (SiS_Pr->SiS_VBType & VB_SISVB)    ||
3539           (SiS_Pr->SiS_IF_DEF_LVDS     == 1) ||
3540           (SiS_Pr->SiS_IF_DEF_CH70xx   != 0) ||
3541           (SiS_Pr->SiS_IF_DEF_TRUMPION != 0) ) {
3542          SiS_SetCRT2Group(SiS_Pr, HwInfo, ModeNo);
3543       }
3544    }
3545
3546    SiS_HandleCRT1(SiS_Pr);
3547
3548    SiS_StrangeStuff(SiS_Pr, HwInfo);
3549
3550    SiS_DisplayOn(SiS_Pr);
3551    SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF);
3552
3553    if(HwInfo->jChipType >= SIS_315H) {
3554       if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
3555          if(!(SiS_IsDualEdge(SiS_Pr, HwInfo))) {
3556             SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb);
3557          }
3558       }
3559    }
3560
3561    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
3562       if(HwInfo->jChipType >= SIS_315H) {
3563          if(!SiS_Pr->SiS_ROMNew) {
3564             if(SiS_IsVAMode(SiS_Pr,HwInfo)) {
3565                SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x35,0x01);
3566             } else {
3567                SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x35,0xFE);
3568             }
3569          }
3570
3571          SiS_SetReg(SiS_Pr->SiS_P3d4,0x38,backupreg);
3572
3573          if((IS_SIS650) && (SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & 0xfc)) {
3574             if((ModeNo == 0x03) || (ModeNo == 0x10)) {
3575                SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x51,0x80);
3576                SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x56,0x08);
3577             }
3578          }
3579
3580          if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & SetCRT2ToLCD) {
3581             SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x38,0xfc);
3582          }
3583       } else if((HwInfo->jChipType == SIS_630) ||
3584                 (HwInfo->jChipType == SIS_730)) {
3585          SiS_SetReg(SiS_Pr->SiS_P3d4,0x35,backupreg);
3586       }
3587    }
3588
3589 #ifdef LINUX_XF86
3590    if(pScrn) {
3591       /* SetPitch: Adapt to virtual size & position */
3592       if((ModeNo > 0x13) && (dosetpitch)) {
3593          SiS_SetPitch(SiS_Pr, pScrn);
3594       }
3595
3596       /* Backup/Set ModeNo in BIOS scratch area */
3597       SiS_GetSetModeID(pScrn, ModeNo);
3598    }
3599 #endif
3600
3601 #ifdef LINUX_KERNEL  /* We never lock registers in XF86 */
3602    if(KeepLockReg == 0xA1) SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x86);
3603    else SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x00);
3604 #endif
3605
3606    return TRUE;
3607 }
3608
3609 /*********************************************/
3610 /*          XFree86: SiSBIOSSetMode()        */
3611 /*           for non-Dual-Head mode          */
3612 /*********************************************/
3613
3614 #ifdef LINUX_XF86
3615 BOOLEAN
3616 SiSBIOSSetMode(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo, ScrnInfoPtr pScrn,
3617                DisplayModePtr mode, BOOLEAN IsCustom)
3618 {
3619    SISPtr pSiS = SISPTR(pScrn);
3620    UShort ModeNo = 0;
3621
3622    SiS_Pr->UseCustomMode = FALSE;
3623
3624    if((IsCustom) && (SiS_CheckBuildCustomMode(pScrn, mode, pSiS->VBFlags))) {
3625
3626       xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3, "Setting custom mode %dx%d\n",
3627                 SiS_Pr->CHDisplay,
3628                 (mode->Flags & V_INTERLACE ? SiS_Pr->CVDisplay * 2 :
3629                    (mode->Flags & V_DBLSCAN ? SiS_Pr->CVDisplay / 2 :
3630                       SiS_Pr->CVDisplay)));
3631
3632    } else {
3633
3634       /* Don't need vbflags here; checks done earlier */
3635       ModeNo = SiS_GetModeNumber(pScrn, mode, 0);
3636       if(!ModeNo) return FALSE;
3637
3638       xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3, "Setting standard mode 0x%x\n", ModeNo);
3639
3640    }
3641
3642    return(SiSSetMode(SiS_Pr, HwInfo, pScrn, ModeNo, TRUE));
3643 }
3644
3645 /*********************************************/
3646 /*       XFree86: SiSBIOSSetModeCRT2()       */
3647 /*           for Dual-Head modes             */
3648 /*********************************************/
3649 BOOLEAN
3650 SiSBIOSSetModeCRT2(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo, ScrnInfoPtr pScrn,
3651                DisplayModePtr mode, BOOLEAN IsCustom)
3652 {
3653    USHORT  ModeIdIndex;
3654    SISIOADDRESS BaseAddr = HwInfo->ulIOAddress;
3655    UShort  ModeNo   = 0;
3656    unsigned char backupreg=0;
3657    SISPtr  pSiS     = SISPTR(pScrn);
3658 #ifdef SISDUALHEAD
3659    SISEntPtr pSiSEnt = pSiS->entityPrivate;
3660 #endif
3661
3662    SiS_Pr->UseCustomMode = FALSE;
3663
3664    /* Remember: Custom modes for CRT2 are ONLY supported
3665     *     -) on the 30x/B/C, and
3666     *     -) if CRT2 is LCD or VGA, or CRT1 is LCDA
3667     */
3668
3669    if((IsCustom) && (SiS_CheckBuildCustomMode(pScrn, mode, pSiS->VBFlags))) {
3670
3671          ModeNo = 0xfe;
3672
3673    } else {
3674
3675          ModeNo = SiS_GetModeNumber(pScrn, mode, 0);
3676          if(!ModeNo) return FALSE;
3677
3678    }
3679
3680    SiSRegInit(SiS_Pr, BaseAddr);
3681    SiSInitPtr(SiS_Pr, HwInfo);
3682    SiS_GetSysFlags(SiS_Pr, HwInfo);
3683 #if (defined(i386) || defined(__i386) || defined(__i386__) || defined(__AMD64__))
3684    SiS_Pr->SiS_VGAINFO = SiS_GetSetBIOSScratch(pScrn, 0x489, 0xff);
3685 #else
3686    SiS_Pr->SiS_VGAINFO = 0x11;
3687 #endif
3688    SiSInitPCIetc(SiS_Pr, HwInfo);
3689    SiSSetLVDSetc(SiS_Pr, HwInfo);
3690    SiSDetermineROMUsage(SiS_Pr, HwInfo);
3691
3692    /* Save mode info so we can set it from within SetMode for CRT1 */
3693 #ifdef SISDUALHEAD
3694    if(pSiS->DualHeadMode) {
3695       pSiSEnt->CRT2ModeNo = ModeNo;
3696       pSiSEnt->CRT2DMode = mode;
3697       pSiSEnt->CRT2IsCustom = IsCustom;
3698       pSiSEnt->CRT2CR30 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
3699       pSiSEnt->CRT2CR31 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31);
3700       pSiSEnt->CRT2CR35 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
3701       pSiSEnt->CRT2CR38 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
3702 #if 0
3703       /* We can't set CRT2 mode before CRT1 mode is set */
3704       if(pSiSEnt->CRT1ModeNo == -1) {
3705          xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3,
3706                 "Setting CRT2 mode delayed until after setting CRT1 mode\n");
3707          return TRUE;
3708       }
3709 #endif
3710       pSiSEnt->CRT2ModeSet = TRUE;
3711    }
3712 #endif
3713
3714    /* We don't clear the buffer in X */
3715    SiS_Pr->SiS_flag_clearbuffer=0;
3716
3717    if(SiS_Pr->UseCustomMode) {
3718
3719       USHORT temptemp = SiS_Pr->CVDisplay;
3720
3721       if(SiS_Pr->CModeFlag & DoubleScanMode)     temptemp >>= 1;
3722       else if(SiS_Pr->CInfoFlag & InterlaceMode) temptemp <<= 1;
3723
3724       xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3,
3725           "Setting custom mode %dx%d on CRT2\n",
3726           SiS_Pr->CHDisplay, temptemp);
3727
3728    } else {
3729
3730       xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3,
3731           "Setting standard mode 0x%x on CRT2\n", ModeNo);
3732
3733    }
3734
3735    SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x86);
3736
3737    SiS_UnLockCRT2(SiS_Pr, HwInfo);
3738
3739    if(!SiS_Pr->UseCustomMode) {
3740       if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) return FALSE;
3741    } else {
3742       ModeIdIndex = 0;
3743    }
3744
3745    SiS_GetVBType(SiS_Pr, HwInfo);
3746
3747    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
3748       if(HwInfo->jChipType >= SIS_315H) {
3749          SiS_ResetVB(SiS_Pr, HwInfo);
3750          SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x32,0x10);
3751          SiS_SetRegOR(SiS_Pr->SiS_Part2Port,0x00,0x0c);
3752          backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
3753       } else {
3754          backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
3755       }
3756    }
3757
3758    /* Get VB information (connectors, connected devices) */
3759    if(!SiS_Pr->UseCustomMode) {
3760       SiS_GetVBInfo(SiS_Pr, ModeNo, ModeIdIndex, HwInfo, 1);
3761    } else {
3762       /* If this is a custom mode, we don't check the modeflag for CRT2Mode */
3763       SiS_GetVBInfo(SiS_Pr, ModeNo, ModeIdIndex, HwInfo, 0);
3764    }
3765    SiS_SetYPbPr(SiS_Pr, HwInfo);
3766    SiS_SetTVMode(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3767    SiS_GetLCDResInfo(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3768    SiS_SetLowModeTest(SiS_Pr, ModeNo, HwInfo);
3769
3770    /* Set mode on CRT2 */
3771    if( (SiS_Pr->SiS_VBType & VB_SISVB)    ||
3772        (SiS_Pr->SiS_IF_DEF_LVDS     == 1) ||
3773        (SiS_Pr->SiS_IF_DEF_CH70xx   != 0) ||
3774        (SiS_Pr->SiS_IF_DEF_TRUMPION != 0) ) {
3775       SiS_SetCRT2Group(SiS_Pr, HwInfo, ModeNo);
3776    }
3777
3778    SiS_StrangeStuff(SiS_Pr, HwInfo);
3779
3780    SiS_DisplayOn(SiS_Pr);
3781    SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF);
3782
3783    if(HwInfo->jChipType >= SIS_315H) {
3784       if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
3785          if(!(SiS_IsDualEdge(SiS_Pr, HwInfo))) {
3786             SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb);
3787          }
3788       }
3789    }
3790
3791    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
3792       if(HwInfo->jChipType >= SIS_315H) {
3793          if(!SiS_Pr->SiS_ROMNew) {
3794             if(SiS_IsVAMode(SiS_Pr,HwInfo)) {
3795                SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x35,0x01);
3796             } else {
3797                SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x35,0xFE);
3798             }
3799          }
3800
3801          SiS_SetReg(SiS_Pr->SiS_P3d4,0x38,backupreg);
3802
3803          if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & SetCRT2ToLCD) {
3804             SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x38,0xfc);
3805          }
3806       } else if((HwInfo->jChipType == SIS_630) ||
3807                 (HwInfo->jChipType == SIS_730)) {
3808          SiS_SetReg(SiS_Pr->SiS_P3d4,0x35,backupreg);
3809       }
3810    }
3811
3812    /* SetPitch: Adapt to virtual size & position */
3813    SiS_SetPitchCRT2(SiS_Pr, pScrn);
3814
3815    return TRUE;
3816 }
3817
3818 /*********************************************/
3819 /*       XFree86: SiSBIOSSetModeCRT1()       */
3820 /*           for Dual-Head modes             */
3821 /*********************************************/
3822
3823 BOOLEAN
3824 SiSBIOSSetModeCRT1(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo, ScrnInfoPtr pScrn,
3825                    DisplayModePtr mode, BOOLEAN IsCustom)
3826 {
3827    SISPtr  pSiS = SISPTR(pScrn);
3828    SISIOADDRESS BaseAddr = HwInfo->ulIOAddress;
3829    USHORT  ModeIdIndex, ModeNo=0;
3830    UCHAR backupreg=0;
3831 #ifdef SISDUALHEAD
3832    SISEntPtr pSiSEnt = pSiS->entityPrivate;
3833    UCHAR backupcr30, backupcr31, backupcr38, backupcr35, backupp40d=0;
3834    BOOLEAN backupcustom;
3835 #endif
3836
3837    SiS_Pr->UseCustomMode = FALSE;
3838
3839    if((IsCustom) && (SiS_CheckBuildCustomMode(pScrn, mode, pSiS->VBFlags))) {
3840
3841          USHORT temptemp = SiS_Pr->CVDisplay;
3842
3843          if(SiS_Pr->CModeFlag & DoubleScanMode)     temptemp >>= 1;
3844          else if(SiS_Pr->CInfoFlag & InterlaceMode) temptemp <<= 1;
3845
3846          xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3,
3847                 "Setting custom mode %dx%d on CRT1\n",
3848                 SiS_Pr->CHDisplay, temptemp);
3849          ModeNo = 0xfe;
3850
3851    } else {
3852
3853          ModeNo = SiS_GetModeNumber(pScrn, mode, 0);
3854          if(!ModeNo) return FALSE;
3855
3856          xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3,
3857                 "Setting standard mode 0x%x on CRT1\n", ModeNo);
3858    }
3859
3860    SiSInitPtr(SiS_Pr, HwInfo);
3861    SiSRegInit(SiS_Pr, BaseAddr);
3862    SiS_GetSysFlags(SiS_Pr, HwInfo);
3863 #if (defined(i386) || defined(__i386) || defined(__i386__) || defined(__AMD64__))
3864    SiS_Pr->SiS_VGAINFO = SiS_GetSetBIOSScratch(pScrn, 0x489, 0xff);
3865 #else
3866    SiS_Pr->SiS_VGAINFO = 0x11;
3867 #endif
3868    SiSInitPCIetc(SiS_Pr, HwInfo);
3869    SiSSetLVDSetc(SiS_Pr, HwInfo);
3870    SiSDetermineROMUsage(SiS_Pr, HwInfo);
3871
3872    /* We don't clear the buffer in X */
3873    SiS_Pr->SiS_flag_clearbuffer = 0;
3874
3875    SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x86);
3876
3877    SiS_UnLockCRT2(SiS_Pr, HwInfo);
3878
3879    if(!SiS_Pr->UseCustomMode) {
3880       if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) return FALSE;
3881    } else {
3882       ModeIdIndex = 0;
3883    }
3884
3885    /* Determine VBType */
3886    SiS_GetVBType(SiS_Pr, HwInfo);
3887
3888    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
3889       if(HwInfo->jChipType >= SIS_315H) {
3890          backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
3891       } else {
3892          backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
3893       }
3894    }
3895
3896    /* Get VB information (connectors, connected devices) */
3897    /* (We don't care if the current mode is a CRT2 mode) */
3898    SiS_GetVBInfo(SiS_Pr, ModeNo, ModeIdIndex, HwInfo, 0);
3899    SiS_SetYPbPr(SiS_Pr, HwInfo);
3900    SiS_SetTVMode(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3901    SiS_GetLCDResInfo(SiS_Pr, ModeNo, ModeIdIndex, HwInfo);
3902    SiS_SetLowModeTest(SiS_Pr, ModeNo, HwInfo);
3903
3904    if(HwInfo->jChipType >= SIS_315H) {
3905       SiS_SetupCR5x(SiS_Pr, HwInfo);
3906    }
3907
3908    /* Set mode on CRT1 */
3909    SiS_SetCRT1Group(SiS_Pr, HwInfo, ModeNo, ModeIdIndex);
3910    if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
3911       SiS_SetCRT2Group(SiS_Pr, HwInfo, ModeNo);
3912    }
3913
3914    /* SetPitch: Adapt to virtual size & position */
3915    SiS_SetPitchCRT1(SiS_Pr, pScrn);
3916
3917 #ifdef SISDUALHEAD
3918    if(pSiS->DualHeadMode) {
3919       pSiSEnt->CRT1ModeNo = ModeNo;
3920       pSiSEnt->CRT1DMode = mode;
3921    }
3922 #endif
3923
3924    if(SiS_Pr->UseCustomMode) {
3925       SiS_Pr->CRT1UsesCustomMode = TRUE;
3926       SiS_Pr->CSRClock_CRT1 = SiS_Pr->CSRClock;
3927       SiS_Pr->CModeFlag_CRT1 = SiS_Pr->CModeFlag;
3928    } else {
3929       SiS_Pr->CRT1UsesCustomMode = FALSE;
3930    }
3931
3932    /* Reset CRT2 if changing mode on CRT1 */
3933 #ifdef SISDUALHEAD
3934    if(pSiS->DualHeadMode) {
3935       if(pSiSEnt->CRT2ModeNo != -1) {
3936          xf86DrvMsgVerb(pScrn->scrnIndex, X_INFO, 3,
3937                                 "(Re-)Setting mode for CRT2\n");
3938          backupcustom = SiS_Pr->UseCustomMode;
3939          backupcr30 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
3940          backupcr31 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31);
3941          backupcr35 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
3942          backupcr38 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
3943          if(SiS_Pr->SiS_VBType & VB_SISVB) {
3944             /* Backup LUT-enable */
3945             if(pSiSEnt->CRT2ModeSet) {
3946                backupp40d = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x0d) & 0x08;
3947             }
3948          }
3949          if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
3950             SiS_SetReg(SiS_Pr->SiS_P3d4,0x30,pSiSEnt->CRT2CR30);
3951             SiS_SetReg(SiS_Pr->SiS_P3d4,0x31,pSiSEnt->CRT2CR31);
3952             SiS_SetReg(SiS_Pr->SiS_P3d4,0x35,pSiSEnt->CRT2CR35);
3953             SiS_SetReg(SiS_Pr->SiS_P3d4,0x38,pSiSEnt->CRT2CR38);
3954          }
3955          SiSBIOSSetModeCRT2(SiS_Pr, HwInfo, pSiSEnt->pScrn_1,
3956                             pSiSEnt->CRT2DMode, pSiSEnt->CRT2IsCustom);
3957          SiS_SetReg(SiS_Pr->SiS_P3d4,0x30,backupcr30);
3958          SiS_SetReg(SiS_Pr->SiS_P3d4,0x31,backupcr31);
3959          SiS_SetReg(SiS_Pr->SiS_P3d4,0x35,backupcr35);
3960          SiS_SetReg(SiS_Pr->SiS_P3d4,0x38,backupcr38);
3961          if(SiS_Pr->SiS_VBType & VB_SISVB) {
3962             SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0d, ~0x08, backupp40d);
3963          }
3964          SiS_Pr->UseCustomMode = backupcustom;
3965       }
3966    }
3967 #endif
3968
3969    /* Warning: From here, the custom mode entries in SiS_Pr are
3970     * possibly overwritten
3971     */
3972
3973    SiS_HandleCRT1(SiS_Pr);
3974
3975    SiS_StrangeStuff(SiS_Pr, HwInfo);
3976
3977    SiS_DisplayOn(SiS_Pr);
3978    SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF);
3979
3980    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
3981       if(HwInfo->jChipType >= SIS_315H) {
3982          SiS_SetReg(SiS_Pr->SiS_P3d4,0x38,backupreg);
3983       } else if((HwInfo->jChipType == SIS_630) ||
3984                 (HwInfo->jChipType == SIS_730)) {
3985          SiS_SetReg(SiS_Pr->SiS_P3d4,0x35,backupreg);
3986       }
3987    }
3988
3989    /* Backup/Set ModeNo in BIOS scratch area */
3990    SiS_GetSetModeID(pScrn,ModeNo);
3991
3992    return TRUE;
3993 }
3994 #endif /* Linux_XF86 */
3995
3996
3997 #ifdef LINUX_XF86
3998 BOOLEAN
3999 SiS_GetPanelID(SiS_Private *SiS_Pr, PSIS_HW_INFO HwInfo)
4000 {
4001   const USHORT PanelTypeTable300[16] = {
4002       0xc101, 0xc117, 0x0121, 0xc135, 0xc142, 0xc152, 0xc162, 0xc072,
4003       0xc181, 0xc192, 0xc1a1, 0xc1b6, 0xc1c2, 0xc0d2, 0xc1e2, 0xc1f2
4004   };
4005   const USHORT PanelTypeTable31030x[16] = {
4006       0xc102, 0xc112, 0x0122, 0xc132, 0xc142, 0xc152, 0xc169, 0xc179,
4007       0x0189, 0xc192, 0xc1a2, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
4008   };
4009   const USHORT PanelTypeTable310LVDS[16] = {
4010       0xc111, 0xc122, 0xc133, 0xc144, 0xc155, 0xc166, 0xc177, 0xc188,
4011       0xc199, 0xc0aa, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
4012   };
4013   USHORT tempax,tempbx,temp;
4014
4015   if(HwInfo->jChipType < SIS_315H) {
4016
4017      tempax = SiS_GetReg(SiS_Pr->SiS_P3c4,0x18);
4018      tempbx = tempax & 0x0F;
4019      if(!(tempax & 0x10)){
4020         if(SiS_Pr->SiS_IF_DEF_LVDS == 1){
4021            tempbx = 0;
4022            temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x38);
4023            if(temp & 0x40) tempbx |= 0x08;
4024            if(temp & 0x20) tempbx |= 0x02;
4025            if(temp & 0x01) tempbx |= 0x01;
4026            temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x39);
4027            if(temp & 0x80) tempbx |= 0x04;
4028         } else {
4029            return 0;
4030         }
4031      }
4032      tempbx = PanelTypeTable300[tempbx];
4033      tempbx |= LCDSync;
4034      temp = tempbx & 0x00FF;
4035      SiS_SetReg(SiS_Pr->SiS_P3d4,0x36,temp);
4036      temp = (tempbx & 0xFF00) >> 8;
4037      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x37,~(LCDSyncBit|LCDRGB18Bit),temp);
4038
4039   } else {
4040
4041      if(HwInfo->jChipType >= SIS_661) return 0;
4042
4043      tempax = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1a);
4044      tempax &= 0x1e;
4045      tempax >>= 1;
4046      if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
4047         if(tempax == 0) {
4048            /* TODO: Include HUGE detection routine
4049                     (Probably not worth bothering)
4050             */
4051            return 0;
4052         }
4053         temp = tempax & 0xff;
4054         tempax--;
4055         tempbx = PanelTypeTable310LVDS[tempax];
4056      } else {
4057         tempbx = PanelTypeTable31030x[tempax];
4058         temp = tempbx & 0xff;
4059      }
4060      SiS_SetReg(SiS_Pr->SiS_P3d4,0x36,temp);
4061      tempbx = (tempbx & 0xff00) >> 8;
4062      temp = tempbx & 0xc1;
4063      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x37,~(LCDSyncBit|LCDRGB18Bit),temp);
4064      if(SiS_Pr->SiS_VBType & VB_SISVB) {
4065         temp = tempbx & 0x04;
4066         SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x39,0xfb,temp);
4067      }
4068
4069   }
4070   return 1;
4071 }
4072 #endif
4073
4074 #ifndef GETBITSTR
4075 #define BITMASK(h,l)            (((unsigned)(1U << ((h)-(l)+1))-1)<<(l))
4076 #define GENMASK(mask)           BITMASK(1?mask,0?mask)
4077 #define GETBITS(var,mask)       (((var) & GENMASK(mask)) >> (0?mask))
4078 #define GETBITSTR(val,from,to)  ((GETBITS(val,from)) << (0?to))
4079 #endif
4080
4081 static void
4082 SiS_CalcCRRegisters(SiS_Private *SiS_Pr, int depth)
4083 {
4084    SiS_Pr->CCRT1CRTC[0]  =  ((SiS_Pr->CHTotal >> 3) - 5) & 0xff;                /* CR0 */
4085    SiS_Pr->CCRT1CRTC[1]  =  (SiS_Pr->CHDisplay >> 3) - 1;                       /* CR1 */
4086    SiS_Pr->CCRT1CRTC[2]  =  (SiS_Pr->CHBlankStart >> 3) - 1;                    /* CR2 */
4087    SiS_Pr->CCRT1CRTC[3]  =  (((SiS_Pr->CHBlankEnd >> 3) - 1) & 0x1F) | 0x80;    /* CR3 */
4088    SiS_Pr->CCRT1CRTC[4]  =  (SiS_Pr->CHSyncStart >> 3) + 3;                     /* CR4 */
4089    SiS_Pr->CCRT1CRTC[5]  =  ((((SiS_Pr->CHBlankEnd >> 3) - 1) & 0x20) << 2) |   /* CR5 */
4090                             (((SiS_Pr->CHSyncEnd >> 3) + 3) & 0x1F);
4091
4092    SiS_Pr->CCRT1CRTC[6]  =  (SiS_Pr->CVTotal - 2) & 0xFF;                       /* CR6 */
4093    SiS_Pr->CCRT1CRTC[7]  =  (((SiS_Pr->CVTotal - 2) & 0x100) >> 8)              /* CR7 */
4094                           | (((SiS_Pr->CVDisplay - 1) & 0x100) >> 7)
4095                           | ((SiS_Pr->CVSyncStart & 0x100) >> 6)
4096                           | (((SiS_Pr->CVBlankStart - 1) & 0x100) >> 5)
4097                           | 0x10
4098                           | (((SiS_Pr->CVTotal - 2) & 0x200)   >> 4)
4099                           | (((SiS_Pr->CVDisplay - 1) & 0x200) >> 3)
4100                           | ((SiS_Pr->CVSyncStart & 0x200) >> 2);
4101
4102    SiS_Pr->CCRT1CRTC[16] = ((((SiS_Pr->CVBlankStart - 1) & 0x200) >> 4) >> 5);  /* CR9 */
4103
4104    if(depth != 8) {
4105       if(SiS_Pr->CHDisplay >= 1600)      SiS_Pr->CCRT1CRTC[16] |= 0x60;         /* SRE */
4106       else if(SiS_Pr->CHDisplay >= 640)  SiS_Pr->CCRT1CRTC[16] |= 0x40;
4107    }
4108
4109 #if 0
4110    if (mode->VScan >= 32)
4111         regp->CRTC[9] |= 0x1F;
4112    else if (mode->VScan > 1)
4113         regp->CRTC[9] |= mode->VScan - 1;
4114 #endif
4115
4116    SiS_Pr->CCRT1CRTC[8] =  (SiS_Pr->CVSyncStart     ) & 0xFF;                   /* CR10 */
4117    SiS_Pr->CCRT1CRTC[9] =  ((SiS_Pr->CVSyncEnd      ) & 0x0F) | 0x80;           /* CR11 */
4118    SiS_Pr->CCRT1CRTC[10] = (SiS_Pr->CVDisplay    - 1) & 0xFF;                   /* CR12 */
4119    SiS_Pr->CCRT1CRTC[11] = (SiS_Pr->CVBlankStart - 1) & 0xFF;                   /* CR15 */
4120    SiS_Pr->CCRT1CRTC[12] = (SiS_Pr->CVBlankEnd   - 1) & 0xFF;                   /* CR16 */
4121
4122    SiS_Pr->CCRT1CRTC[13] =                                                      /* SRA */
4123                         GETBITSTR((SiS_Pr->CVTotal     -2), 10:10, 0:0) |
4124                         GETBITSTR((SiS_Pr->CVDisplay   -1), 10:10, 1:1) |
4125                         GETBITSTR((SiS_Pr->CVBlankStart-1), 10:10, 2:2) |
4126                         GETBITSTR((SiS_Pr->CVSyncStart   ), 10:10, 3:3) |
4127                         GETBITSTR((SiS_Pr->CVBlankEnd  -1),   8:8, 4:4) |
4128                         GETBITSTR((SiS_Pr->CVSyncEnd     ),   4:4, 5:5) ;
4129
4130    SiS_Pr->CCRT1CRTC[14] =                                                      /* SRB */
4131                         GETBITSTR((SiS_Pr->CHTotal      >> 3) - 5, 9:8, 1:0) |
4132                         GETBITSTR((SiS_Pr->CHDisplay    >> 3) - 1, 9:8, 3:2) |
4133                         GETBITSTR((SiS_Pr->CHBlankStart >> 3) - 1, 9:8, 5:4) |
4134                         GETBITSTR((SiS_Pr->CHSyncStart  >> 3) + 3, 9:8, 7:6) ;
4135
4136
4137    SiS_Pr->CCRT1CRTC[15] =                                                      /* SRC */
4138                         GETBITSTR((SiS_Pr->CHBlankEnd >> 3) - 1, 7:6, 1:0) |
4139                         GETBITSTR((SiS_Pr->CHSyncEnd  >> 3) + 3, 5:5, 2:2) ;
4140 }
4141
4142 void
4143 SiS_CalcLCDACRT1Timing(SiS_Private *SiS_Pr,USHORT ModeNo,USHORT ModeIdIndex)
4144 {
4145    USHORT modeflag, tempax, tempbx, VGAHDE = SiS_Pr->SiS_VGAHDE;
4146    int i,j;
4147
4148    /* 1:1 data: use data set by setcrt1crtc() */
4149    if(SiS_Pr->SiS_LCDInfo & LCDPass11) return;
4150
4151    if(ModeNo <= 0x13) {
4152      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
4153    } else if(SiS_Pr->UseCustomMode) {
4154      modeflag = SiS_Pr->CModeFlag;
4155    } else {
4156      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
4157    }
4158
4159    if(modeflag & HalfDCLK) VGAHDE >>= 1;
4160
4161    SiS_Pr->CHDisplay = VGAHDE;
4162    SiS_Pr->CHBlankStart = VGAHDE;
4163
4164    SiS_Pr->CVDisplay = SiS_Pr->SiS_VGAVDE;
4165    SiS_Pr->CVBlankStart = SiS_Pr->SiS_VGAVDE;
4166
4167    tempbx = SiS_Pr->PanelHT - SiS_Pr->PanelXRes;
4168    tempax = SiS_Pr->SiS_VGAHDE;  /* not /2 ! */
4169    if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
4170       tempax = SiS_Pr->PanelXRes;
4171    }
4172    tempbx += tempax;
4173    if(modeflag & HalfDCLK) tempbx -= VGAHDE;
4174    SiS_Pr->CHTotal = SiS_Pr->CHBlankEnd = tempbx;
4175
4176    tempax = VGAHDE;
4177    tempbx = SiS_Pr->CHTotal;
4178    if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
4179       tempbx = SiS_Pr->PanelXRes;
4180       if(modeflag & HalfDCLK) tempbx >>= 1;
4181       tempax += ((tempbx - tempax) >> 1);
4182    }