blob: f082ae55c0c943e6068bd8f84b5a0f8fbfedf642 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* $XFree86$ */
2/* $XdotOrg$ */
3/*
4 * Mode initializing code (CRT1 section) for
Thomas Winischhofer544393f2005-09-09 13:04:45 -07005 * for SiS 300/305/540/630/730,
6 * SiS 315/550/[M]650/651/[M]661[FGM]X/[M]74x[GX]/330/[M]76x[GX],
7 * XGI Volari V3XT/V5/V8, Z7
8 * (Universal module for Linux kernel framebuffer and X.org/XFree86 4.x)
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 *
Thomas Winischhofer544393f2005-09-09 13:04:45 -070010 * Copyright (C) 2001-2005 by Thomas Winischhofer, Vienna, Austria
Linus Torvalds1da177e2005-04-16 15:20:36 -070011 *
12 * If distributed as part of the Linux kernel, the following license terms
13 * apply:
14 *
15 * * This program is free software; you can redistribute it and/or modify
16 * * it under the terms of the GNU General Public License as published by
17 * * the Free Software Foundation; either version 2 of the named License,
18 * * or any later version.
19 * *
20 * * This program is distributed in the hope that it will be useful,
21 * * but WITHOUT ANY WARRANTY; without even the implied warranty of
22 * * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
23 * * GNU General Public License for more details.
24 * *
25 * * You should have received a copy of the GNU General Public License
26 * * along with this program; if not, write to the Free Software
27 * * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
28 *
29 * Otherwise, the following license terms apply:
30 *
31 * * Redistribution and use in source and binary forms, with or without
32 * * modification, are permitted provided that the following conditions
33 * * are met:
34 * * 1) Redistributions of source code must retain the above copyright
35 * * notice, this list of conditions and the following disclaimer.
36 * * 2) Redistributions in binary form must reproduce the above copyright
37 * * notice, this list of conditions and the following disclaimer in the
38 * * documentation and/or other materials provided with the distribution.
39 * * 3) The name of the author may not be used to endorse or promote products
40 * * derived from this software without specific prior written permission.
41 * *
42 * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
43 * * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
44 * * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
45 * * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
46 * * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
47 * * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
48 * * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
49 * * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
50 * * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
51 * * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
52 *
53 * Author: Thomas Winischhofer <thomas@winischhofer.net>
54 *
55 * Formerly based on non-functional code-fragements for 300 series by SiS, Inc.
56 * Used by permission.
Linus Torvalds1da177e2005-04-16 15:20:36 -070057 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -070058
Linus Torvalds1da177e2005-04-16 15:20:36 -070059#include "init.h"
60
Aaro Koskinenf7854e52010-11-19 21:58:47 +000061#ifdef CONFIG_FB_SIS_300
Linus Torvalds1da177e2005-04-16 15:20:36 -070062#include "300vtbl.h"
63#endif
64
Aaro Koskinenf7854e52010-11-19 21:58:47 +000065#ifdef CONFIG_FB_SIS_315
Linus Torvalds1da177e2005-04-16 15:20:36 -070066#include "310vtbl.h"
67#endif
68
69#if defined(ALLOC_PRAGMA)
70#pragma alloc_text(PAGE,SiSSetMode)
71#endif
72
73/*********************************************/
74/* POINTER INITIALIZATION */
75/*********************************************/
76
Aaro Koskinenf7854e52010-11-19 21:58:47 +000077#if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315)
Linus Torvalds1da177e2005-04-16 15:20:36 -070078static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -070079InitCommonPointer(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070080{
Thomas Winischhofer544393f2005-09-09 13:04:45 -070081 SiS_Pr->SiS_SModeIDTable = SiS_SModeIDTable;
Linus Torvalds1da177e2005-04-16 15:20:36 -070082 SiS_Pr->SiS_StResInfo = SiS_StResInfo;
83 SiS_Pr->SiS_ModeResInfo = SiS_ModeResInfo;
84 SiS_Pr->SiS_StandTable = SiS_StandTable;
85
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 SiS_Pr->SiS_NTSCTiming = SiS_NTSCTiming;
87 SiS_Pr->SiS_PALTiming = SiS_PALTiming;
88 SiS_Pr->SiS_HiTVSt1Timing = SiS_HiTVSt1Timing;
89 SiS_Pr->SiS_HiTVSt2Timing = SiS_HiTVSt2Timing;
90
91 SiS_Pr->SiS_HiTVExtTiming = SiS_HiTVExtTiming;
92 SiS_Pr->SiS_HiTVGroup3Data = SiS_HiTVGroup3Data;
93 SiS_Pr->SiS_HiTVGroup3Simu = SiS_HiTVGroup3Simu;
94#if 0
95 SiS_Pr->SiS_HiTVTextTiming = SiS_HiTVTextTiming;
96 SiS_Pr->SiS_HiTVGroup3Text = SiS_HiTVGroup3Text;
97#endif
98
99 SiS_Pr->SiS_StPALData = SiS_StPALData;
100 SiS_Pr->SiS_ExtPALData = SiS_ExtPALData;
101 SiS_Pr->SiS_StNTSCData = SiS_StNTSCData;
102 SiS_Pr->SiS_ExtNTSCData = SiS_ExtNTSCData;
103 SiS_Pr->SiS_St1HiTVData = SiS_StHiTVData;
104 SiS_Pr->SiS_St2HiTVData = SiS_St2HiTVData;
105 SiS_Pr->SiS_ExtHiTVData = SiS_ExtHiTVData;
106 SiS_Pr->SiS_St525iData = SiS_StNTSCData;
107 SiS_Pr->SiS_St525pData = SiS_St525pData;
108 SiS_Pr->SiS_St750pData = SiS_St750pData;
109 SiS_Pr->SiS_Ext525iData = SiS_ExtNTSCData;
110 SiS_Pr->SiS_Ext525pData = SiS_ExtNTSCData;
111 SiS_Pr->SiS_Ext750pData = SiS_Ext750pData;
112
113 SiS_Pr->pSiS_OutputSelect = &SiS_OutputSelect;
114 SiS_Pr->pSiS_SoftSetting = &SiS_SoftSetting;
115
116 SiS_Pr->SiS_LCD1280x720Data = SiS_LCD1280x720Data;
117 SiS_Pr->SiS_StLCD1280x768_2Data = SiS_StLCD1280x768_2Data;
118 SiS_Pr->SiS_ExtLCD1280x768_2Data = SiS_ExtLCD1280x768_2Data;
119 SiS_Pr->SiS_LCD1280x800Data = SiS_LCD1280x800Data;
120 SiS_Pr->SiS_LCD1280x800_2Data = SiS_LCD1280x800_2Data;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700121 SiS_Pr->SiS_LCD1280x854Data = SiS_LCD1280x854Data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 SiS_Pr->SiS_LCD1280x960Data = SiS_LCD1280x960Data;
123 SiS_Pr->SiS_StLCD1400x1050Data = SiS_StLCD1400x1050Data;
124 SiS_Pr->SiS_ExtLCD1400x1050Data = SiS_ExtLCD1400x1050Data;
125 SiS_Pr->SiS_LCD1680x1050Data = SiS_LCD1680x1050Data;
126 SiS_Pr->SiS_StLCD1600x1200Data = SiS_StLCD1600x1200Data;
127 SiS_Pr->SiS_ExtLCD1600x1200Data = SiS_ExtLCD1600x1200Data;
128 SiS_Pr->SiS_NoScaleData = SiS_NoScaleData;
129
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700130 SiS_Pr->SiS_LVDS320x240Data_1 = SiS_LVDS320x240Data_1;
131 SiS_Pr->SiS_LVDS320x240Data_2 = SiS_LVDS320x240Data_2;
132 SiS_Pr->SiS_LVDS640x480Data_1 = SiS_LVDS640x480Data_1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133 SiS_Pr->SiS_LVDS800x600Data_1 = SiS_LVDS800x600Data_1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134 SiS_Pr->SiS_LVDS1024x600Data_1 = SiS_LVDS1024x600Data_1;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700135 SiS_Pr->SiS_LVDS1024x768Data_1 = SiS_LVDS1024x768Data_1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700137 SiS_Pr->SiS_LVDSCRT1320x240_1 = SiS_LVDSCRT1320x240_1;
138 SiS_Pr->SiS_LVDSCRT1320x240_2 = SiS_LVDSCRT1320x240_2;
139 SiS_Pr->SiS_LVDSCRT1320x240_2_H = SiS_LVDSCRT1320x240_2_H;
140 SiS_Pr->SiS_LVDSCRT1320x240_3 = SiS_LVDSCRT1320x240_3;
141 SiS_Pr->SiS_LVDSCRT1320x240_3_H = SiS_LVDSCRT1320x240_3_H;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 SiS_Pr->SiS_LVDSCRT1640x480_1 = SiS_LVDSCRT1640x480_1;
143 SiS_Pr->SiS_LVDSCRT1640x480_1_H = SiS_LVDSCRT1640x480_1_H;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700144#if 0
145 SiS_Pr->SiS_LVDSCRT11024x600_1 = SiS_LVDSCRT11024x600_1;
146 SiS_Pr->SiS_LVDSCRT11024x600_1_H = SiS_LVDSCRT11024x600_1_H;
147 SiS_Pr->SiS_LVDSCRT11024x600_2 = SiS_LVDSCRT11024x600_2;
148 SiS_Pr->SiS_LVDSCRT11024x600_2_H = SiS_LVDSCRT11024x600_2_H;
149#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150
151 SiS_Pr->SiS_CHTVUNTSCData = SiS_CHTVUNTSCData;
152 SiS_Pr->SiS_CHTVONTSCData = SiS_CHTVONTSCData;
153
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154 SiS_Pr->SiS_PanelMinLVDS = Panel_800x600; /* lowest value LVDS/LCDA */
155 SiS_Pr->SiS_PanelMin301 = Panel_1024x768; /* lowest value 301 */
156}
157#endif
158
Aaro Koskinenf7854e52010-11-19 21:58:47 +0000159#ifdef CONFIG_FB_SIS_300
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700161InitTo300Pointer(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162{
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700163 InitCommonPointer(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165 SiS_Pr->SiS_VBModeIDTable = SiS300_VBModeIDTable;
166 SiS_Pr->SiS_EModeIDTable = SiS300_EModeIDTable;
167 SiS_Pr->SiS_RefIndex = SiS300_RefIndex;
168 SiS_Pr->SiS_CRT1Table = SiS300_CRT1Table;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700169 if(SiS_Pr->ChipType == SIS_300) {
170 SiS_Pr->SiS_MCLKData_0 = SiS300_MCLKData_300; /* 300 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 } else {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700172 SiS_Pr->SiS_MCLKData_0 = SiS300_MCLKData_630; /* 630, 730 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173 }
174 SiS_Pr->SiS_VCLKData = SiS300_VCLKData;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700175 SiS_Pr->SiS_VBVCLKData = (struct SiS_VBVCLKData *)SiS300_VCLKData;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176
177 SiS_Pr->SiS_SR15 = SiS300_SR15;
178
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179 SiS_Pr->SiS_PanelDelayTbl = SiS300_PanelDelayTbl;
180 SiS_Pr->SiS_PanelDelayTblLVDS = SiS300_PanelDelayTbl;
181
182 SiS_Pr->SiS_ExtLCD1024x768Data = SiS300_ExtLCD1024x768Data;
183 SiS_Pr->SiS_St2LCD1024x768Data = SiS300_St2LCD1024x768Data;
184 SiS_Pr->SiS_ExtLCD1280x1024Data = SiS300_ExtLCD1280x1024Data;
185 SiS_Pr->SiS_St2LCD1280x1024Data = SiS300_St2LCD1280x1024Data;
186
187 SiS_Pr->SiS_CRT2Part2_1024x768_1 = SiS300_CRT2Part2_1024x768_1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188 SiS_Pr->SiS_CRT2Part2_1024x768_2 = SiS300_CRT2Part2_1024x768_2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 SiS_Pr->SiS_CRT2Part2_1024x768_3 = SiS300_CRT2Part2_1024x768_3;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190
191 SiS_Pr->SiS_CHTVUPALData = SiS300_CHTVUPALData;
192 SiS_Pr->SiS_CHTVOPALData = SiS300_CHTVOPALData;
193 SiS_Pr->SiS_CHTVUPALMData = SiS_CHTVUNTSCData; /* not supported on 300 series */
194 SiS_Pr->SiS_CHTVOPALMData = SiS_CHTVONTSCData; /* not supported on 300 series */
195 SiS_Pr->SiS_CHTVUPALNData = SiS300_CHTVUPALData; /* not supported on 300 series */
196 SiS_Pr->SiS_CHTVOPALNData = SiS300_CHTVOPALData; /* not supported on 300 series */
197 SiS_Pr->SiS_CHTVSOPALData = SiS300_CHTVSOPALData;
198
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700199 SiS_Pr->SiS_LVDS848x480Data_1 = SiS300_LVDS848x480Data_1;
200 SiS_Pr->SiS_LVDS848x480Data_2 = SiS300_LVDS848x480Data_2;
201 SiS_Pr->SiS_LVDSBARCO1024Data_1 = SiS300_LVDSBARCO1024Data_1;
202 SiS_Pr->SiS_LVDSBARCO1366Data_1 = SiS300_LVDSBARCO1366Data_1;
203 SiS_Pr->SiS_LVDSBARCO1366Data_2 = SiS300_LVDSBARCO1366Data_2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700205 SiS_Pr->SiS_PanelType04_1a = SiS300_PanelType04_1a;
206 SiS_Pr->SiS_PanelType04_2a = SiS300_PanelType04_2a;
207 SiS_Pr->SiS_PanelType04_1b = SiS300_PanelType04_1b;
208 SiS_Pr->SiS_PanelType04_2b = SiS300_PanelType04_2b;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209
210 SiS_Pr->SiS_CHTVCRT1UNTSC = SiS300_CHTVCRT1UNTSC;
211 SiS_Pr->SiS_CHTVCRT1ONTSC = SiS300_CHTVCRT1ONTSC;
212 SiS_Pr->SiS_CHTVCRT1UPAL = SiS300_CHTVCRT1UPAL;
213 SiS_Pr->SiS_CHTVCRT1OPAL = SiS300_CHTVCRT1OPAL;
214 SiS_Pr->SiS_CHTVCRT1SOPAL = SiS300_CHTVCRT1SOPAL;
215 SiS_Pr->SiS_CHTVReg_UNTSC = SiS300_CHTVReg_UNTSC;
216 SiS_Pr->SiS_CHTVReg_ONTSC = SiS300_CHTVReg_ONTSC;
217 SiS_Pr->SiS_CHTVReg_UPAL = SiS300_CHTVReg_UPAL;
218 SiS_Pr->SiS_CHTVReg_OPAL = SiS300_CHTVReg_OPAL;
219 SiS_Pr->SiS_CHTVReg_UPALM = SiS300_CHTVReg_UNTSC; /* not supported on 300 series */
220 SiS_Pr->SiS_CHTVReg_OPALM = SiS300_CHTVReg_ONTSC; /* not supported on 300 series */
221 SiS_Pr->SiS_CHTVReg_UPALN = SiS300_CHTVReg_UPAL; /* not supported on 300 series */
222 SiS_Pr->SiS_CHTVReg_OPALN = SiS300_CHTVReg_OPAL; /* not supported on 300 series */
223 SiS_Pr->SiS_CHTVReg_SOPAL = SiS300_CHTVReg_SOPAL;
224 SiS_Pr->SiS_CHTVVCLKUNTSC = SiS300_CHTVVCLKUNTSC;
225 SiS_Pr->SiS_CHTVVCLKONTSC = SiS300_CHTVVCLKONTSC;
226 SiS_Pr->SiS_CHTVVCLKUPAL = SiS300_CHTVVCLKUPAL;
227 SiS_Pr->SiS_CHTVVCLKOPAL = SiS300_CHTVVCLKOPAL;
228 SiS_Pr->SiS_CHTVVCLKUPALM = SiS300_CHTVVCLKUNTSC; /* not supported on 300 series */
229 SiS_Pr->SiS_CHTVVCLKOPALM = SiS300_CHTVVCLKONTSC; /* not supported on 300 series */
230 SiS_Pr->SiS_CHTVVCLKUPALN = SiS300_CHTVVCLKUPAL; /* not supported on 300 series */
231 SiS_Pr->SiS_CHTVVCLKOPALN = SiS300_CHTVVCLKOPAL; /* not supported on 300 series */
232 SiS_Pr->SiS_CHTVVCLKSOPAL = SiS300_CHTVVCLKSOPAL;
233}
234#endif
235
Aaro Koskinenf7854e52010-11-19 21:58:47 +0000236#ifdef CONFIG_FB_SIS_315
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700238InitTo310Pointer(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239{
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700240 InitCommonPointer(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242 SiS_Pr->SiS_EModeIDTable = SiS310_EModeIDTable;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700243 SiS_Pr->SiS_RefIndex = SiS310_RefIndex;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700244 SiS_Pr->SiS_CRT1Table = SiS310_CRT1Table;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700245 if(SiS_Pr->ChipType >= SIS_340) {
246 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_340; /* 340 + XGI */
247 } else if(SiS_Pr->ChipType >= SIS_761) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_761; /* 761 - preliminary */
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700249 } else if(SiS_Pr->ChipType >= SIS_760) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_760; /* 760 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700251 } else if(SiS_Pr->ChipType >= SIS_661) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_660; /* 661/741 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700253 } else if(SiS_Pr->ChipType == SIS_330) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_330; /* 330 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700255 } else if(SiS_Pr->ChipType > SIS_315PRO) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_650; /* 550, 650, 740 */
257 } else {
258 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_315; /* 315 */
259 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700260 if(SiS_Pr->ChipType >= SIS_340) {
261 SiS_Pr->SiS_MCLKData_1 = SiS310_MCLKData_1_340;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262 } else {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700263 SiS_Pr->SiS_MCLKData_1 = SiS310_MCLKData_1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264 }
265 SiS_Pr->SiS_VCLKData = SiS310_VCLKData;
266 SiS_Pr->SiS_VBVCLKData = SiS310_VBVCLKData;
267
268 SiS_Pr->SiS_SR15 = SiS310_SR15;
269
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270 SiS_Pr->SiS_PanelDelayTbl = SiS310_PanelDelayTbl;
271 SiS_Pr->SiS_PanelDelayTblLVDS = SiS310_PanelDelayTblLVDS;
272
273 SiS_Pr->SiS_St2LCD1024x768Data = SiS310_St2LCD1024x768Data;
274 SiS_Pr->SiS_ExtLCD1024x768Data = SiS310_ExtLCD1024x768Data;
275 SiS_Pr->SiS_St2LCD1280x1024Data = SiS310_St2LCD1280x1024Data;
276 SiS_Pr->SiS_ExtLCD1280x1024Data = SiS310_ExtLCD1280x1024Data;
277
278 SiS_Pr->SiS_CRT2Part2_1024x768_1 = SiS310_CRT2Part2_1024x768_1;
279
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280 SiS_Pr->SiS_CHTVUPALData = SiS310_CHTVUPALData;
281 SiS_Pr->SiS_CHTVOPALData = SiS310_CHTVOPALData;
282 SiS_Pr->SiS_CHTVUPALMData = SiS310_CHTVUPALMData;
283 SiS_Pr->SiS_CHTVOPALMData = SiS310_CHTVOPALMData;
284 SiS_Pr->SiS_CHTVUPALNData = SiS310_CHTVUPALNData;
285 SiS_Pr->SiS_CHTVOPALNData = SiS310_CHTVOPALNData;
286 SiS_Pr->SiS_CHTVSOPALData = SiS310_CHTVSOPALData;
287
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700288 SiS_Pr->SiS_CHTVCRT1UNTSC = SiS310_CHTVCRT1UNTSC;
289 SiS_Pr->SiS_CHTVCRT1ONTSC = SiS310_CHTVCRT1ONTSC;
290 SiS_Pr->SiS_CHTVCRT1UPAL = SiS310_CHTVCRT1UPAL;
291 SiS_Pr->SiS_CHTVCRT1OPAL = SiS310_CHTVCRT1OPAL;
292 SiS_Pr->SiS_CHTVCRT1SOPAL = SiS310_CHTVCRT1OPAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293
294 SiS_Pr->SiS_CHTVReg_UNTSC = SiS310_CHTVReg_UNTSC;
295 SiS_Pr->SiS_CHTVReg_ONTSC = SiS310_CHTVReg_ONTSC;
296 SiS_Pr->SiS_CHTVReg_UPAL = SiS310_CHTVReg_UPAL;
297 SiS_Pr->SiS_CHTVReg_OPAL = SiS310_CHTVReg_OPAL;
298 SiS_Pr->SiS_CHTVReg_UPALM = SiS310_CHTVReg_UPALM;
299 SiS_Pr->SiS_CHTVReg_OPALM = SiS310_CHTVReg_OPALM;
300 SiS_Pr->SiS_CHTVReg_UPALN = SiS310_CHTVReg_UPALN;
301 SiS_Pr->SiS_CHTVReg_OPALN = SiS310_CHTVReg_OPALN;
302 SiS_Pr->SiS_CHTVReg_SOPAL = SiS310_CHTVReg_OPAL;
303
304 SiS_Pr->SiS_CHTVVCLKUNTSC = SiS310_CHTVVCLKUNTSC;
305 SiS_Pr->SiS_CHTVVCLKONTSC = SiS310_CHTVVCLKONTSC;
306 SiS_Pr->SiS_CHTVVCLKUPAL = SiS310_CHTVVCLKUPAL;
307 SiS_Pr->SiS_CHTVVCLKOPAL = SiS310_CHTVVCLKOPAL;
308 SiS_Pr->SiS_CHTVVCLKUPALM = SiS310_CHTVVCLKUPALM;
309 SiS_Pr->SiS_CHTVVCLKOPALM = SiS310_CHTVVCLKOPALM;
310 SiS_Pr->SiS_CHTVVCLKUPALN = SiS310_CHTVVCLKUPALN;
311 SiS_Pr->SiS_CHTVVCLKOPALN = SiS310_CHTVVCLKOPALN;
312 SiS_Pr->SiS_CHTVVCLKSOPAL = SiS310_CHTVVCLKOPAL;
313}
314#endif
315
Richard Knutssonc30660ea2007-02-12 00:55:06 -0800316bool
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700317SiSInitPtr(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318{
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700319 if(SiS_Pr->ChipType < SIS_315H) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +0000320#ifdef CONFIG_FB_SIS_300
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700321 InitTo300Pointer(SiS_Pr);
322#else
Richard Knutssonc30660ea2007-02-12 00:55:06 -0800323 return false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324#endif
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700325 } else {
Aaro Koskinenf7854e52010-11-19 21:58:47 +0000326#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700327 InitTo310Pointer(SiS_Pr);
328#else
Richard Knutssonc30660ea2007-02-12 00:55:06 -0800329 return false;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700330#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 }
Richard Knutssonc30660ea2007-02-12 00:55:06 -0800332 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700333}
334
335/*********************************************/
336/* HELPER: Get ModeID */
337/*********************************************/
338
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700339static
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700340unsigned short
341SiS_GetModeID(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay,
Richard Knutssonc30660ea2007-02-12 00:55:06 -0800342 int Depth, bool FSTN, int LCDwidth, int LCDheight)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343{
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700344 unsigned short ModeIndex = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345
346 switch(HDisplay)
347 {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700348 case 320:
349 if(VDisplay == 200) ModeIndex = ModeIndex_320x200[Depth];
350 else if(VDisplay == 240) {
351 if((VBFlags & CRT2_LCD) && (FSTN))
352 ModeIndex = ModeIndex_320x240_FSTN[Depth];
353 else
354 ModeIndex = ModeIndex_320x240[Depth];
355 }
356 break;
357 case 400:
358 if((!(VBFlags & CRT1_LCDA)) || ((LCDwidth >= 800) && (LCDwidth >= 600))) {
359 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
360 }
361 break;
362 case 512:
363 if((!(VBFlags & CRT1_LCDA)) || ((LCDwidth >= 1024) && (LCDwidth >= 768))) {
364 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
365 }
366 break;
367 case 640:
368 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth];
369 else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
370 break;
371 case 720:
372 if(VDisplay == 480) ModeIndex = ModeIndex_720x480[Depth];
373 else if(VDisplay == 576) ModeIndex = ModeIndex_720x576[Depth];
374 break;
375 case 768:
376 if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth];
377 break;
378 case 800:
379 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
380 else if(VDisplay == 480) ModeIndex = ModeIndex_800x480[Depth];
381 break;
382 case 848:
383 if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth];
384 break;
385 case 856:
386 if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth];
387 break;
388 case 960:
389 if(VGAEngine == SIS_315_VGA) {
390 if(VDisplay == 540) ModeIndex = ModeIndex_960x540[Depth];
391 else if(VDisplay == 600) ModeIndex = ModeIndex_960x600[Depth];
392 }
393 break;
394 case 1024:
395 if(VDisplay == 576) ModeIndex = ModeIndex_1024x576[Depth];
396 else if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
397 else if(VGAEngine == SIS_300_VGA) {
398 if(VDisplay == 600) ModeIndex = ModeIndex_1024x600[Depth];
399 }
400 break;
401 case 1152:
402 if(VDisplay == 864) ModeIndex = ModeIndex_1152x864[Depth];
403 if(VGAEngine == SIS_300_VGA) {
404 if(VDisplay == 768) ModeIndex = ModeIndex_1152x768[Depth];
405 }
406 break;
407 case 1280:
408 switch(VDisplay) {
409 case 720:
410 ModeIndex = ModeIndex_1280x720[Depth];
411 break;
412 case 768:
413 if(VGAEngine == SIS_300_VGA) {
414 ModeIndex = ModeIndex_300_1280x768[Depth];
415 } else {
416 ModeIndex = ModeIndex_310_1280x768[Depth];
417 }
418 break;
419 case 800:
420 if(VGAEngine == SIS_315_VGA) {
421 ModeIndex = ModeIndex_1280x800[Depth];
422 }
423 break;
424 case 854:
425 if(VGAEngine == SIS_315_VGA) {
426 ModeIndex = ModeIndex_1280x854[Depth];
427 }
428 break;
429 case 960:
430 ModeIndex = ModeIndex_1280x960[Depth];
431 break;
432 case 1024:
433 ModeIndex = ModeIndex_1280x1024[Depth];
434 break;
435 }
436 break;
437 case 1360:
438 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth];
439 if(VGAEngine == SIS_300_VGA) {
440 if(VDisplay == 1024) ModeIndex = ModeIndex_300_1360x1024[Depth];
441 }
442 break;
443 case 1400:
444 if(VGAEngine == SIS_315_VGA) {
445 if(VDisplay == 1050) {
446 ModeIndex = ModeIndex_1400x1050[Depth];
447 }
448 }
449 break;
450 case 1600:
451 if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth];
452 break;
453 case 1680:
454 if(VGAEngine == SIS_315_VGA) {
455 if(VDisplay == 1050) ModeIndex = ModeIndex_1680x1050[Depth];
456 }
457 break;
458 case 1920:
459 if(VDisplay == 1440) ModeIndex = ModeIndex_1920x1440[Depth];
460 else if(VGAEngine == SIS_315_VGA) {
461 if(VDisplay == 1080) ModeIndex = ModeIndex_1920x1080[Depth];
462 }
463 break;
464 case 2048:
465 if(VDisplay == 1536) {
466 if(VGAEngine == SIS_300_VGA) {
467 ModeIndex = ModeIndex_300_2048x1536[Depth];
468 } else {
469 ModeIndex = ModeIndex_310_2048x1536[Depth];
470 }
471 }
472 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473 }
474
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700475 return ModeIndex;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700478unsigned short
479SiS_GetModeID_LCD(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay,
Richard Knutssonc30660ea2007-02-12 00:55:06 -0800480 int Depth, bool FSTN, unsigned short CustomT, int LCDwidth, int LCDheight,
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700481 unsigned int VBFlags2)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482{
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700483 unsigned short ModeIndex = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700485 if(VBFlags2 & (VB2_LVDS | VB2_30xBDH)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486
487 switch(HDisplay)
488 {
489 case 320:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700490 if((CustomT != CUT_PANEL848) && (CustomT != CUT_PANEL856)) {
491 if(VDisplay == 200) {
492 if(!FSTN) ModeIndex = ModeIndex_320x200[Depth];
493 } else if(VDisplay == 240) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700494 if(!FSTN) ModeIndex = ModeIndex_320x240[Depth];
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700495 else if(VGAEngine == SIS_315_VGA) {
496 ModeIndex = ModeIndex_320x240_FSTN[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497 }
498 }
499 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700500 break;
501 case 400:
502 if((CustomT != CUT_PANEL848) && (CustomT != CUT_PANEL856)) {
503 if(!((VGAEngine == SIS_300_VGA) && (VBFlags2 & VB2_TRUMPION))) {
504 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 }
506 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700507 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 case 512:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700509 if((CustomT != CUT_PANEL848) && (CustomT != CUT_PANEL856)) {
510 if(!((VGAEngine == SIS_300_VGA) && (VBFlags2 & VB2_TRUMPION))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511 if(LCDwidth >= 1024 && LCDwidth != 1152 && LCDheight >= 768) {
512 if(VDisplay == 384) {
513 ModeIndex = ModeIndex_512x384[Depth];
514 }
515 }
516 }
517 }
518 break;
519 case 640:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700520 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 else if(VDisplay == 400) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700522 if((CustomT != CUT_PANEL848) && (CustomT != CUT_PANEL856))
523 ModeIndex = ModeIndex_640x400[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 }
525 break;
526 case 800:
527 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
528 break;
529 case 848:
530 if(CustomT == CUT_PANEL848) {
531 if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth];
532 }
533 break;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700534 case 856:
535 if(CustomT == CUT_PANEL856) {
536 if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth];
537 }
538 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539 case 1024:
540 if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
541 else if(VGAEngine == SIS_300_VGA) {
542 if((VDisplay == 600) && (LCDheight == 600)) {
543 ModeIndex = ModeIndex_1024x600[Depth];
544 }
545 }
546 break;
547 case 1152:
548 if(VGAEngine == SIS_300_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700549 if((VDisplay == 768) && (LCDheight == 768)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 ModeIndex = ModeIndex_1152x768[Depth];
551 }
552 }
553 break;
554 case 1280:
555 if(VDisplay == 1024) ModeIndex = ModeIndex_1280x1024[Depth];
556 else if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700557 if((VDisplay == 768) && (LCDheight == 768)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558 ModeIndex = ModeIndex_310_1280x768[Depth];
559 }
560 }
561 break;
562 case 1360:
563 if(VGAEngine == SIS_300_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700564 if(CustomT == CUT_BARCO1366) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 if(VDisplay == 1024) ModeIndex = ModeIndex_300_1360x1024[Depth];
566 }
567 }
568 if(CustomT == CUT_PANEL848) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700569 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570 }
571 break;
572 case 1400:
573 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700574 if(VDisplay == 1050) ModeIndex = ModeIndex_1400x1050[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 }
576 break;
577 case 1600:
578 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700579 if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580 }
581 break;
582 }
583
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700584 } else if(VBFlags2 & VB2_SISBRIDGE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585
586 switch(HDisplay)
587 {
588 case 320:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700589 if(VDisplay == 200) ModeIndex = ModeIndex_320x200[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 else if(VDisplay == 240) ModeIndex = ModeIndex_320x240[Depth];
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700591 break;
592 case 400:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593 if(LCDwidth >= 800 && LCDheight >= 600) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700594 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700596 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597 case 512:
598 if(LCDwidth >= 1024 && LCDheight >= 768 && LCDwidth != 1152) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700599 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600 }
601 break;
602 case 640:
603 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth];
604 else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
605 break;
606 case 720:
607 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700608 if(VDisplay == 480) ModeIndex = ModeIndex_720x480[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609 else if(VDisplay == 576) ModeIndex = ModeIndex_720x576[Depth];
610 }
611 break;
612 case 768:
613 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700614 if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615 }
616 break;
617 case 800:
618 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
619 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700620 if(VDisplay == 480) ModeIndex = ModeIndex_800x480[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621 }
622 break;
623 case 848:
624 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700625 if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626 }
627 break;
628 case 856:
629 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700630 if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631 }
632 break;
633 case 960:
634 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700635 if(VDisplay == 540) ModeIndex = ModeIndex_960x540[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636 else if(VDisplay == 600) ModeIndex = ModeIndex_960x600[Depth];
637 }
638 break;
639 case 1024:
640 if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
641 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700642 if(VDisplay == 576) ModeIndex = ModeIndex_1024x576[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643 }
644 break;
645 case 1152:
646 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700647 if(VDisplay == 864) ModeIndex = ModeIndex_1152x864[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 }
649 break;
650 case 1280:
651 switch(VDisplay) {
652 case 720:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700653 ModeIndex = ModeIndex_1280x720[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 case 768:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700655 if(VGAEngine == SIS_300_VGA) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656 ModeIndex = ModeIndex_300_1280x768[Depth];
657 } else {
658 ModeIndex = ModeIndex_310_1280x768[Depth];
659 }
660 break;
661 case 800:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700662 if(VGAEngine == SIS_315_VGA) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700663 ModeIndex = ModeIndex_1280x800[Depth];
664 }
665 break;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700666 case 854:
667 if(VGAEngine == SIS_315_VGA) {
668 ModeIndex = ModeIndex_1280x854[Depth];
669 }
670 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700671 case 960:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700672 ModeIndex = ModeIndex_1280x960[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673 break;
674 case 1024:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700675 ModeIndex = ModeIndex_1280x1024[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700676 break;
677 }
678 break;
679 case 1360:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700680 if(VGAEngine == SIS_315_VGA) { /* OVER1280 only? */
681 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682 }
683 break;
684 case 1400:
685 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700686 if(VBFlags2 & VB2_LCDOVER1280BRIDGE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700687 if(VDisplay == 1050) ModeIndex = ModeIndex_1400x1050[Depth];
688 }
689 }
690 break;
691 case 1600:
692 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700693 if(VBFlags2 & VB2_LCDOVER1280BRIDGE) {
694 if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 }
696 }
697 break;
698#ifndef VB_FORBID_CRT2LCD_OVER_1600
699 case 1680:
700 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700701 if(VBFlags2 & VB2_LCDOVER1280BRIDGE) {
702 if(VDisplay == 1050) ModeIndex = ModeIndex_1680x1050[Depth];
703 }
704 }
705 break;
706 case 1920:
707 if(VGAEngine == SIS_315_VGA) {
708 if(VBFlags2 & VB2_LCDOVER1600BRIDGE) {
709 if(VDisplay == 1440) ModeIndex = ModeIndex_1920x1440[Depth];
710 }
711 }
712 break;
713 case 2048:
714 if(VGAEngine == SIS_315_VGA) {
715 if(VBFlags2 & VB2_LCDOVER1600BRIDGE) {
716 if(VDisplay == 1536) ModeIndex = ModeIndex_310_2048x1536[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717 }
718 }
719 break;
720#endif
721 }
722 }
723
724 return ModeIndex;
725}
726
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700727unsigned short
728SiS_GetModeID_TV(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay, int Depth,
729 unsigned int VBFlags2)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730{
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700731 unsigned short ModeIndex = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700733 if(VBFlags2 & VB2_CHRONTEL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734
735 switch(HDisplay)
736 {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700737 case 512:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700738 if(VGAEngine == SIS_315_VGA) {
739 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
740 }
741 break;
742 case 640:
743 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth];
744 else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
745 break;
746 case 800:
747 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
748 break;
749 case 1024:
750 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700751 if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700752 }
753 break;
754 }
755
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700756 } else if(VBFlags2 & VB2_SISTVBRIDGE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700757
758 switch(HDisplay)
759 {
760 case 320:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700761 if(VDisplay == 200) ModeIndex = ModeIndex_320x200[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 else if(VDisplay == 240) ModeIndex = ModeIndex_320x240[Depth];
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700763 break;
764 case 400:
765 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth];
766 break;
767 case 512:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768 if( ((VBFlags & TV_YPBPR) && (VBFlags & (TV_YPBPR750P | TV_YPBPR1080I))) ||
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700769 (VBFlags & TV_HIVISION) ||
770 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) ) {
771 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772 }
773 break;
774 case 640:
775 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth];
776 else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth];
777 break;
778 case 720:
779 if((!(VBFlags & TV_HIVISION)) && (!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)))) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700780 if(VDisplay == 480) {
781 ModeIndex = ModeIndex_720x480[Depth];
782 } else if(VDisplay == 576) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 if( ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P)) ||
784 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) )
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700785 ModeIndex = ModeIndex_720x576[Depth];
786 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 }
788 break;
789 case 768:
790 if((!(VBFlags & TV_HIVISION)) && (!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)))) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700791 if( ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P)) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700792 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) ) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700793 if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700794 }
795 }
796 break;
797 case 800:
798 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth];
799 else if(VDisplay == 480) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700800 if(!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700801 ModeIndex = ModeIndex_800x480[Depth];
802 }
803 }
804 break;
805 case 960:
806 if(VGAEngine == SIS_315_VGA) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700807 if(VDisplay == 600) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808 if((VBFlags & TV_HIVISION) || ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) {
809 ModeIndex = ModeIndex_960x600[Depth];
810 }
811 }
812 }
813 break;
814 case 1024:
815 if(VDisplay == 768) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700816 if(VBFlags2 & VB2_30xBLV) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700817 ModeIndex = ModeIndex_1024x768[Depth];
818 }
819 } else if(VDisplay == 576) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700820 if( (VBFlags & TV_HIVISION) ||
821 ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)) ||
822 ((VBFlags2 & VB2_30xBLV) &&
823 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL))) ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824 ModeIndex = ModeIndex_1024x576[Depth];
825 }
826 }
827 break;
828 case 1280:
829 if(VDisplay == 720) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700830 if((VBFlags & TV_HIVISION) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831 ((VBFlags & TV_YPBPR) && (VBFlags & (TV_YPBPR1080I | TV_YPBPR750P)))) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700832 ModeIndex = ModeIndex_1280x720[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833 }
834 } else if(VDisplay == 1024) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700835 if((VBFlags & TV_HIVISION) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700836 ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700837 ModeIndex = ModeIndex_1280x1024[Depth];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 }
839 }
840 break;
841 }
842 }
843 return ModeIndex;
844}
845
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700846unsigned short
847SiS_GetModeID_VGA2(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay, int Depth,
848 unsigned int VBFlags2)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849{
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700850 if(!(VBFlags2 & VB2_SISVGA2BRIDGE)) return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700851
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700852 if(HDisplay >= 1920) return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700853
854 switch(HDisplay)
855 {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700856 case 1600:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700857 if(VDisplay == 1200) {
858 if(VGAEngine != SIS_315_VGA) return 0;
859 if(!(VBFlags2 & VB2_30xB)) return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860 }
861 break;
862 case 1680:
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700863 if(VDisplay == 1050) {
864 if(VGAEngine != SIS_315_VGA) return 0;
865 if(!(VBFlags2 & VB2_30xB)) return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700866 }
867 break;
868 }
869
Richard Knutssonc30660ea2007-02-12 00:55:06 -0800870 return SiS_GetModeID(VGAEngine, 0, HDisplay, VDisplay, Depth, false, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871}
872
873
874/*********************************************/
875/* HELPER: SetReg, GetReg */
876/*********************************************/
877
878void
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200879SiS_SetReg(SISIOADDRESS port, u8 index, u8 data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700880{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200881 outb(index, port);
882 outb(data, port + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700883}
884
885void
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200886SiS_SetRegByte(SISIOADDRESS port, u8 data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700887{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200888 outb(data, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700889}
890
891void
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200892SiS_SetRegShort(SISIOADDRESS port, u16 data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200894 outw(data, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700895}
896
897void
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200898SiS_SetRegLong(SISIOADDRESS port, u32 data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200900 outl(data, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901}
902
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200903u8
904SiS_GetReg(SISIOADDRESS port, u8 index)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700905{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200906 outb(index, port);
Aaro Koskinen2ad28472010-11-19 21:58:48 +0000907 return inb(port + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908}
909
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200910u8
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911SiS_GetRegByte(SISIOADDRESS port)
912{
Aaro Koskinen2ad28472010-11-19 21:58:48 +0000913 return inb(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914}
915
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200916u16
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917SiS_GetRegShort(SISIOADDRESS port)
918{
Aaro Koskinen2ad28472010-11-19 21:58:48 +0000919 return inw(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700920}
921
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200922u32
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923SiS_GetRegLong(SISIOADDRESS port)
924{
Aaro Koskinen2ad28472010-11-19 21:58:48 +0000925 return inl(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926}
927
928void
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200929SiS_SetRegANDOR(SISIOADDRESS Port, u8 Index, u8 DataAND, u8 DataOR)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700930{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200931 u8 temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700933 temp = SiS_GetReg(Port, Index);
934 temp = (temp & (DataAND)) | DataOR;
935 SiS_SetReg(Port, Index, temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700936}
937
938void
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200939SiS_SetRegAND(SISIOADDRESS Port, u8 Index, u8 DataAND)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200941 u8 temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700942
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700943 temp = SiS_GetReg(Port, Index);
944 temp &= DataAND;
945 SiS_SetReg(Port, Index, temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946}
947
948void
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200949SiS_SetRegOR(SISIOADDRESS Port, u8 Index, u8 DataOR)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700950{
Aaro Koskinenf48b9642010-12-20 23:50:13 +0200951 u8 temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700953 temp = SiS_GetReg(Port, Index);
954 temp |= DataOR;
955 SiS_SetReg(Port, Index, temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956}
957
958/*********************************************/
959/* HELPER: DisplayOn, DisplayOff */
960/*********************************************/
961
962void
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700963SiS_DisplayOn(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700964{
965 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x01,0xDF);
966}
967
968void
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700969SiS_DisplayOff(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700970{
971 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x01,0x20);
972}
973
974
975/*********************************************/
976/* HELPER: Init Port Addresses */
977/*********************************************/
978
979void
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700980SiSRegInit(struct SiS_Private *SiS_Pr, SISIOADDRESS BaseAddr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981{
982 SiS_Pr->SiS_P3c4 = BaseAddr + 0x14;
983 SiS_Pr->SiS_P3d4 = BaseAddr + 0x24;
984 SiS_Pr->SiS_P3c0 = BaseAddr + 0x10;
985 SiS_Pr->SiS_P3ce = BaseAddr + 0x1e;
986 SiS_Pr->SiS_P3c2 = BaseAddr + 0x12;
987 SiS_Pr->SiS_P3ca = BaseAddr + 0x1a;
988 SiS_Pr->SiS_P3c6 = BaseAddr + 0x16;
989 SiS_Pr->SiS_P3c7 = BaseAddr + 0x17;
990 SiS_Pr->SiS_P3c8 = BaseAddr + 0x18;
991 SiS_Pr->SiS_P3c9 = BaseAddr + 0x19;
992 SiS_Pr->SiS_P3cb = BaseAddr + 0x1b;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700993 SiS_Pr->SiS_P3cc = BaseAddr + 0x1c;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994 SiS_Pr->SiS_P3cd = BaseAddr + 0x1d;
995 SiS_Pr->SiS_P3da = BaseAddr + 0x2a;
Thomas Winischhofer544393f2005-09-09 13:04:45 -0700996 SiS_Pr->SiS_Part1Port = BaseAddr + SIS_CRT2_PORT_04;
997 SiS_Pr->SiS_Part2Port = BaseAddr + SIS_CRT2_PORT_10;
998 SiS_Pr->SiS_Part3Port = BaseAddr + SIS_CRT2_PORT_12;
999 SiS_Pr->SiS_Part4Port = BaseAddr + SIS_CRT2_PORT_14;
1000 SiS_Pr->SiS_Part5Port = BaseAddr + SIS_CRT2_PORT_14 + 2;
1001 SiS_Pr->SiS_DDC_Port = BaseAddr + 0x14;
1002 SiS_Pr->SiS_VidCapt = BaseAddr + SIS_VIDEO_CAPTURE;
1003 SiS_Pr->SiS_VidPlay = BaseAddr + SIS_VIDEO_PLAYBACK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001004}
1005
1006/*********************************************/
1007/* HELPER: GetSysFlags */
1008/*********************************************/
1009
1010static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001011SiS_GetSysFlags(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012{
1013 unsigned char cr5f, temp1, temp2;
1014
1015 /* 661 and newer: NEVER write non-zero to SR11[7:4] */
1016 /* (SR11 is used for DDC and in enable/disablebridge) */
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001017 SiS_Pr->SiS_SensibleSR11 = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018 SiS_Pr->SiS_MyCR63 = 0x63;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001019 if(SiS_Pr->ChipType >= SIS_330) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020 SiS_Pr->SiS_MyCR63 = 0x53;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001021 if(SiS_Pr->ChipType >= SIS_661) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001022 SiS_Pr->SiS_SensibleSR11 = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023 }
1024 }
1025
1026 /* You should use the macros, not these flags directly */
1027
1028 SiS_Pr->SiS_SysFlags = 0;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001029 if(SiS_Pr->ChipType == SIS_650) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001030 cr5f = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xf0;
1031 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x5c,0x07);
1032 temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8;
1033 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x5c,0xf8);
1034 temp2 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8;
1035 if((!temp1) || (temp2)) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001036 switch(cr5f) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001037 case 0x80:
1038 case 0x90:
1039 case 0xc0:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001040 SiS_Pr->SiS_SysFlags |= SF_IsM650;
1041 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001042 case 0xa0:
1043 case 0xb0:
1044 case 0xe0:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001045 SiS_Pr->SiS_SysFlags |= SF_Is651;
1046 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047 }
1048 } else {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001049 switch(cr5f) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050 case 0x90:
1051 temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8;
1052 switch(temp1) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001053 case 0x00: SiS_Pr->SiS_SysFlags |= SF_IsM652; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001054 case 0x40: SiS_Pr->SiS_SysFlags |= SF_IsM653; break;
1055 default: SiS_Pr->SiS_SysFlags |= SF_IsM650; break;
1056 }
1057 break;
1058 case 0xb0:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001059 SiS_Pr->SiS_SysFlags |= SF_Is652;
1060 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061 default:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001062 SiS_Pr->SiS_SysFlags |= SF_IsM650;
1063 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064 }
1065 }
1066 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001067
1068 if(SiS_Pr->ChipType >= SIS_760 && SiS_Pr->ChipType <= SIS_761) {
1069 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0x30) {
1070 SiS_Pr->SiS_SysFlags |= SF_760LFB;
1071 }
1072 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x79) & 0xf0) {
1073 SiS_Pr->SiS_SysFlags |= SF_760UMA;
1074 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075 }
1076}
1077
1078/*********************************************/
1079/* HELPER: Init PCI & Engines */
1080/*********************************************/
1081
1082static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001083SiSInitPCIetc(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001085 switch(SiS_Pr->ChipType) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00001086#ifdef CONFIG_FB_SIS_300
Linus Torvalds1da177e2005-04-16 15:20:36 -07001087 case SIS_300:
1088 case SIS_540:
1089 case SIS_630:
1090 case SIS_730:
1091 /* Set - PCI LINEAR ADDRESSING ENABLE (0x80)
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001092 * - RELOCATED VGA IO ENABLED (0x20)
1093 * - MMIO ENABLED (0x01)
1094 * Leave other bits untouched.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001095 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001096 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x20,0xa1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097 /* - Enable 2D (0x40)
1098 * - Enable 3D (0x02)
1099 * - Enable 3D Vertex command fetch (0x10) ?
1100 * - Enable 3D command parser (0x08) ?
1101 */
1102 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x5A);
1103 break;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001104#endif
Aaro Koskinenf7854e52010-11-19 21:58:47 +00001105#ifdef CONFIG_FB_SIS_315
Linus Torvalds1da177e2005-04-16 15:20:36 -07001106 case SIS_315H:
1107 case SIS_315:
1108 case SIS_315PRO:
1109 case SIS_650:
1110 case SIS_740:
1111 case SIS_330:
1112 case SIS_661:
1113 case SIS_741:
1114 case SIS_660:
1115 case SIS_760:
1116 case SIS_761:
1117 case SIS_340:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001118 case XGI_40:
1119 /* See above */
1120 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x20,0xa1);
1121 /* - Enable 3D G/L transformation engine (0x80)
1122 * - Enable 2D (0x40)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001123 * - Enable 3D vertex command fetch (0x10)
1124 * - Enable 3D command parser (0x08)
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001125 * - Enable 3D (0x02)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001126 */
1127 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0xDA);
1128 break;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001129 case XGI_20:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001130 case SIS_550:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001131 /* See above */
1132 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x20,0xa1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 /* No 3D engine ! */
1134 /* - Enable 2D (0x40)
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001135 * - disable 3D
Linus Torvalds1da177e2005-04-16 15:20:36 -07001136 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001137 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x1E,0x60,0x40);
1138 break;
1139#endif
1140 default:
1141 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001142 }
1143}
1144
1145/*********************************************/
1146/* HELPER: SetLVDSetc */
1147/*********************************************/
1148
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001149static
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001150void
1151SiSSetLVDSetc(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001152{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001153 unsigned short temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001154
1155 SiS_Pr->SiS_IF_DEF_LVDS = 0;
1156 SiS_Pr->SiS_IF_DEF_TRUMPION = 0;
1157 SiS_Pr->SiS_IF_DEF_CH70xx = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001158 SiS_Pr->SiS_IF_DEF_CONEX = 0;
1159
1160 SiS_Pr->SiS_ChrontelInit = 0;
1161
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001162 if(SiS_Pr->ChipType == XGI_20) return;
1163
Linus Torvalds1da177e2005-04-16 15:20:36 -07001164 /* Check for SiS30x first */
1165 temp = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00);
1166 if((temp == 1) || (temp == 2)) return;
1167
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001168 switch(SiS_Pr->ChipType) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00001169#ifdef CONFIG_FB_SIS_300
Linus Torvalds1da177e2005-04-16 15:20:36 -07001170 case SIS_540:
1171 case SIS_630:
1172 case SIS_730:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001173 temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x37) & 0x0e) >> 1;
1174 if((temp >= 2) && (temp <= 5)) SiS_Pr->SiS_IF_DEF_LVDS = 1;
1175 if(temp == 3) SiS_Pr->SiS_IF_DEF_TRUMPION = 1;
1176 if((temp == 4) || (temp == 5)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001177 /* Save power status (and error check) - UNUSED */
1178 SiS_Pr->SiS_Backup70xx = SiS_GetCH700x(SiS_Pr, 0x0e);
1179 SiS_Pr->SiS_IF_DEF_CH70xx = 1;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001180 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001181 break;
1182#endif
Aaro Koskinenf7854e52010-11-19 21:58:47 +00001183#ifdef CONFIG_FB_SIS_315
Linus Torvalds1da177e2005-04-16 15:20:36 -07001184 case SIS_550:
1185 case SIS_650:
1186 case SIS_740:
1187 case SIS_330:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001188 temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x37) & 0x0e) >> 1;
1189 if((temp >= 2) && (temp <= 3)) SiS_Pr->SiS_IF_DEF_LVDS = 1;
1190 if(temp == 3) SiS_Pr->SiS_IF_DEF_CH70xx = 2;
1191 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001192 case SIS_661:
1193 case SIS_741:
1194 case SIS_660:
1195 case SIS_760:
1196 case SIS_761:
1197 case SIS_340:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001198 case XGI_20:
1199 case XGI_40:
1200 temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & 0xe0) >> 5;
1201 if((temp >= 2) && (temp <= 3)) SiS_Pr->SiS_IF_DEF_LVDS = 1;
1202 if(temp == 3) SiS_Pr->SiS_IF_DEF_CH70xx = 2;
1203 if(temp == 4) SiS_Pr->SiS_IF_DEF_CONEX = 1; /* Not yet supported */
1204 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001205#endif
1206 default:
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001207 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208 }
1209}
1210
1211/*********************************************/
1212/* HELPER: Enable DSTN/FSTN */
1213/*********************************************/
1214
1215void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001216SiS_SetEnableDstn(struct SiS_Private *SiS_Pr, int enable)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001217{
1218 SiS_Pr->SiS_IF_DEF_DSTN = enable ? 1 : 0;
1219}
1220
1221void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001222SiS_SetEnableFstn(struct SiS_Private *SiS_Pr, int enable)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001223{
1224 SiS_Pr->SiS_IF_DEF_FSTN = enable ? 1 : 0;
1225}
1226
1227/*********************************************/
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001228/* HELPER: Get modeflag */
1229/*********************************************/
1230
1231unsigned short
1232SiS_GetModeFlag(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
1233 unsigned short ModeIdIndex)
1234{
1235 if(SiS_Pr->UseCustomMode) {
1236 return SiS_Pr->CModeFlag;
1237 } else if(ModeNo <= 0x13) {
1238 return SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
1239 } else {
1240 return SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1241 }
1242}
1243
1244/*********************************************/
Linus Torvalds1da177e2005-04-16 15:20:36 -07001245/* HELPER: Determine ROM usage */
1246/*********************************************/
1247
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001248bool
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001249SiSDetermineROMLayout661(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001251 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
1252 unsigned short romversoffs, romvmaj = 1, romvmin = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001253
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001254 if(SiS_Pr->ChipType >= XGI_20) {
1255 /* XGI ROMs don't qualify */
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001256 return false;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001257 } else if(SiS_Pr->ChipType >= SIS_761) {
1258 /* I very much assume 761, 340 and newer will use new layout */
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001259 return true;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001260 } else if(SiS_Pr->ChipType >= SIS_661) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001261 if((ROMAddr[0x1a] == 'N') &&
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001262 (ROMAddr[0x1b] == 'e') &&
1263 (ROMAddr[0x1c] == 'w') &&
1264 (ROMAddr[0x1d] == 'V')) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001265 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001266 }
1267 romversoffs = ROMAddr[0x16] | (ROMAddr[0x17] << 8);
1268 if(romversoffs) {
1269 if((ROMAddr[romversoffs+1] == '.') || (ROMAddr[romversoffs+4] == '.')) {
1270 romvmaj = ROMAddr[romversoffs] - '0';
1271 romvmin = ((ROMAddr[romversoffs+2] -'0') * 10) + (ROMAddr[romversoffs+3] - '0');
1272 }
1273 }
1274 if((romvmaj != 0) || (romvmin >= 92)) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001275 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001276 }
1277 } else if(IS_SIS650740) {
1278 if((ROMAddr[0x1a] == 'N') &&
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001279 (ROMAddr[0x1b] == 'e') &&
1280 (ROMAddr[0x1c] == 'w') &&
1281 (ROMAddr[0x1d] == 'V')) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001282 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001283 }
1284 }
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001285 return false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001286}
1287
1288static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001289SiSDetermineROMUsage(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001291 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
1292 unsigned short romptr = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001293
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001294 SiS_Pr->SiS_UseROM = false;
1295 SiS_Pr->SiS_ROMNew = false;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001296 SiS_Pr->SiS_PWDOffset = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001297
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001298 if(SiS_Pr->ChipType >= XGI_20) return;
1299
1300 if((ROMAddr) && (SiS_Pr->UseROM)) {
1301 if(SiS_Pr->ChipType == SIS_300) {
1302 /* 300: We check if the code starts below 0x220 by
Linus Torvalds1da177e2005-04-16 15:20:36 -07001303 * checking the jmp instruction at the beginning
1304 * of the BIOS image.
1305 */
1306 if((ROMAddr[3] == 0xe9) && ((ROMAddr[5] << 8) | ROMAddr[4]) > 0x21a)
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001307 SiS_Pr->SiS_UseROM = true;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001308 } else if(SiS_Pr->ChipType < SIS_315H) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001309 /* Sony's VAIO BIOS 1.09 follows the standard, so perhaps
1310 * the others do as well
1311 */
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001312 SiS_Pr->SiS_UseROM = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001313 } else {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001314 /* 315/330 series stick to the standard(s) */
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001315 SiS_Pr->SiS_UseROM = true;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001316 if((SiS_Pr->SiS_ROMNew = SiSDetermineROMLayout661(SiS_Pr))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317 SiS_Pr->SiS_EMIOffset = 14;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001318 SiS_Pr->SiS_PWDOffset = 17;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319 SiS_Pr->SiS661LCD2TableSize = 36;
1320 /* Find out about LCD data table entry size */
1321 if((romptr = SISGETROMW(0x0102))) {
1322 if(ROMAddr[romptr + (32 * 16)] == 0xff)
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001323 SiS_Pr->SiS661LCD2TableSize = 32;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001324 else if(ROMAddr[romptr + (34 * 16)] == 0xff)
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001325 SiS_Pr->SiS661LCD2TableSize = 34;
1326 else if(ROMAddr[romptr + (36 * 16)] == 0xff) /* 0.94, 2.05.00+ */
1327 SiS_Pr->SiS661LCD2TableSize = 36;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328 else if( (ROMAddr[romptr + (38 * 16)] == 0xff) || /* 2.00.00 - 2.02.00 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001329 (ROMAddr[0x6F] & 0x01) ) { /* 2.03.00 - <2.05.00 */
1330 SiS_Pr->SiS661LCD2TableSize = 38; /* UMC data layout abandoned at 2.05.00 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331 SiS_Pr->SiS_EMIOffset = 16;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001332 SiS_Pr->SiS_PWDOffset = 19;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001333 }
1334 }
1335 }
1336 }
1337 }
1338}
1339
1340/*********************************************/
1341/* HELPER: SET SEGMENT REGISTERS */
1342/*********************************************/
1343
1344static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001345SiS_SetSegRegLower(struct SiS_Private *SiS_Pr, unsigned short value)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001347 unsigned short temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001348
1349 value &= 0x00ff;
1350 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cb) & 0xf0;
1351 temp |= (value >> 4);
1352 SiS_SetRegByte(SiS_Pr->SiS_P3cb, temp);
1353 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cd) & 0xf0;
1354 temp |= (value & 0x0f);
1355 SiS_SetRegByte(SiS_Pr->SiS_P3cd, temp);
1356}
1357
1358static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001359SiS_SetSegRegUpper(struct SiS_Private *SiS_Pr, unsigned short value)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001361 unsigned short temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001362
1363 value &= 0x00ff;
1364 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cb) & 0x0f;
1365 temp |= (value & 0xf0);
1366 SiS_SetRegByte(SiS_Pr->SiS_P3cb, temp);
1367 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cd) & 0x0f;
1368 temp |= (value << 4);
1369 SiS_SetRegByte(SiS_Pr->SiS_P3cd, temp);
1370}
1371
1372static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001373SiS_SetSegmentReg(struct SiS_Private *SiS_Pr, unsigned short value)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001374{
1375 SiS_SetSegRegLower(SiS_Pr, value);
1376 SiS_SetSegRegUpper(SiS_Pr, value);
1377}
1378
1379static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001380SiS_ResetSegmentReg(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001381{
1382 SiS_SetSegmentReg(SiS_Pr, 0);
1383}
1384
1385static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001386SiS_SetSegmentRegOver(struct SiS_Private *SiS_Pr, unsigned short value)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001387{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001388 unsigned short temp = value >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001389
1390 temp &= 0x07;
1391 temp |= (temp << 4);
1392 SiS_SetReg(SiS_Pr->SiS_P3c4,0x1d,temp);
1393 SiS_SetSegmentReg(SiS_Pr, value);
1394}
1395
1396static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001397SiS_ResetSegmentRegOver(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001398{
1399 SiS_SetSegmentRegOver(SiS_Pr, 0);
1400}
1401
1402static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001403SiS_ResetSegmentRegisters(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001404{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001405 if((IS_SIS65x) || (SiS_Pr->ChipType >= SIS_661)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406 SiS_ResetSegmentReg(SiS_Pr);
1407 SiS_ResetSegmentRegOver(SiS_Pr);
1408 }
1409}
1410
1411/*********************************************/
1412/* HELPER: GetVBType */
1413/*********************************************/
1414
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001415static
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001416void
1417SiS_GetVBType(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001418{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001419 unsigned short flag = 0, rev = 0, nolcd = 0;
1420 unsigned short p4_0f, p4_25, p4_27;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001422 SiS_Pr->SiS_VBType = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001423
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001424 if((SiS_Pr->SiS_IF_DEF_LVDS) || (SiS_Pr->SiS_IF_DEF_CONEX))
1425 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001426
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001427 if(SiS_Pr->ChipType == XGI_20)
1428 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001429
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001430 flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001432 if(flag > 3)
1433 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001434
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001435 rev = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x01);
1436
1437 if(flag >= 2) {
1438 SiS_Pr->SiS_VBType = VB_SIS302B;
1439 } else if(flag == 1) {
1440 if(rev >= 0xC0) {
1441 SiS_Pr->SiS_VBType = VB_SIS301C;
1442 } else if(rev >= 0xB0) {
1443 SiS_Pr->SiS_VBType = VB_SIS301B;
1444 /* Check if 30xB DH version (no LCD support, use Panel Link instead) */
1445 nolcd = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x23);
1446 if(!(nolcd & 0x02)) SiS_Pr->SiS_VBType |= VB_NoLCD;
1447 } else {
1448 SiS_Pr->SiS_VBType = VB_SIS301;
1449 }
1450 }
1451 if(SiS_Pr->SiS_VBType & (VB_SIS301B | VB_SIS301C | VB_SIS302B)) {
1452 if(rev >= 0xE0) {
1453 flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x39);
1454 if(flag == 0xff) SiS_Pr->SiS_VBType = VB_SIS302LV;
1455 else SiS_Pr->SiS_VBType = VB_SIS301C; /* VB_SIS302ELV; */
1456 } else if(rev >= 0xD0) {
1457 SiS_Pr->SiS_VBType = VB_SIS301LV;
1458 }
1459 }
1460 if(SiS_Pr->SiS_VBType & (VB_SIS301C | VB_SIS301LV | VB_SIS302LV | VB_SIS302ELV)) {
1461 p4_0f = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x0f);
1462 p4_25 = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x25);
1463 p4_27 = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x27);
1464 SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x0f,0x7f);
1465 SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x25,0x08);
1466 SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x27,0xfd);
1467 if(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x08) {
1468 SiS_Pr->SiS_VBType |= VB_UMC;
1469 }
1470 SiS_SetReg(SiS_Pr->SiS_Part4Port,0x27,p4_27);
1471 SiS_SetReg(SiS_Pr->SiS_Part4Port,0x25,p4_25);
1472 SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0f,p4_0f);
1473 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001474}
1475
1476/*********************************************/
1477/* HELPER: Check RAM size */
1478/*********************************************/
1479
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001480static bool
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001481SiS_CheckMemorySize(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
1482 unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001483{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001484 unsigned short AdapterMemSize = SiS_Pr->VideoMemorySize / (1024*1024);
1485 unsigned short modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
1486 unsigned short memorysize = ((modeflag & MemoryInfoFlag) >> MemorySizeShift) + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001487
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001488 if(!AdapterMemSize) return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001490 if(AdapterMemSize < memorysize) return false;
1491 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001493
1494/*********************************************/
1495/* HELPER: Get DRAM type */
1496/*********************************************/
1497
Aaro Koskinenf7854e52010-11-19 21:58:47 +00001498#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001499static unsigned char
1500SiS_Get310DRAMType(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001501{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001502 unsigned char data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001503
1504 if((*SiS_Pr->pSiS_SoftSetting) & SoftDRAMType) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001505 data = (*SiS_Pr->pSiS_SoftSetting) & 0x03;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506 } else {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001507 if(SiS_Pr->ChipType >= XGI_20) {
1508 /* Do I need this? SR17 seems to be zero anyway... */
1509 data = 0;
1510 } else if(SiS_Pr->ChipType >= SIS_340) {
1511 /* TODO */
1512 data = 0;
1513 } if(SiS_Pr->ChipType >= SIS_661) {
1514 if(SiS_Pr->SiS_ROMNew) {
1515 data = ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0xc0) >> 6);
1516 } else {
1517 data = SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0x07;
1518 }
1519 } else if(IS_SIS550650740) {
1520 data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x07;
1521 } else { /* 315, 330 */
1522 data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3a) & 0x03;
1523 if(SiS_Pr->ChipType == SIS_330) {
1524 if(data > 1) {
1525 switch(SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0x30) {
1526 case 0x00: data = 1; break;
1527 case 0x10: data = 3; break;
1528 case 0x20: data = 3; break;
1529 case 0x30: data = 2; break;
1530 }
1531 } else {
1532 data = 0;
1533 }
1534 }
1535 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001536 }
1537
1538 return data;
1539}
1540
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001541static unsigned short
1542SiS_GetMCLK(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001543{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001544 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
1545 unsigned short index;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001546
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001547 index = SiS_Get310DRAMType(SiS_Pr);
1548 if(SiS_Pr->ChipType >= SIS_661) {
1549 if(SiS_Pr->SiS_ROMNew) {
1550 return((unsigned short)(SISGETROMW((0x90 + (index * 5) + 3))));
1551 }
1552 return(SiS_Pr->SiS_MCLKData_0[index].CLOCK);
1553 } else if(index >= 4) {
1554 return(SiS_Pr->SiS_MCLKData_1[index - 4].CLOCK);
1555 } else {
1556 return(SiS_Pr->SiS_MCLKData_0[index].CLOCK);
1557 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001558}
1559#endif
1560
1561/*********************************************/
1562/* HELPER: ClearBuffer */
1563/*********************************************/
1564
Linus Torvalds1da177e2005-04-16 15:20:36 -07001565static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001566SiS_ClearBuffer(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001567{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001568 unsigned char SISIOMEMTYPE *memaddr = SiS_Pr->VideoMemoryAddress;
1569 unsigned int memsize = SiS_Pr->VideoMemorySize;
1570 unsigned short SISIOMEMTYPE *pBuffer;
1571 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001572
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001573 if(!memaddr || !memsize) return;
1574
1575 if(SiS_Pr->SiS_ModeType >= ModeEGA) {
1576 if(ModeNo > 0x13) {
Aaro Koskinenec49ec32010-11-19 21:58:49 +00001577 memset_io(memaddr, 0, memsize);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001578 } else {
1579 pBuffer = (unsigned short SISIOMEMTYPE *)memaddr;
1580 for(i = 0; i < 0x4000; i++) writew(0x0000, &pBuffer[i]);
1581 }
1582 } else if(SiS_Pr->SiS_ModeType < ModeCGA) {
1583 pBuffer = (unsigned short SISIOMEMTYPE *)memaddr;
1584 for(i = 0; i < 0x4000; i++) writew(0x0720, &pBuffer[i]);
1585 } else {
Aaro Koskinenec49ec32010-11-19 21:58:49 +00001586 memset_io(memaddr, 0, 0x8000);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001587 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001588}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001589
1590/*********************************************/
1591/* HELPER: SearchModeID */
1592/*********************************************/
1593
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001594bool
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001595SiS_SearchModeID(struct SiS_Private *SiS_Pr, unsigned short *ModeNo,
1596 unsigned short *ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001597{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001598 unsigned char VGAINFO = SiS_Pr->SiS_VGAINFO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001599
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001600 if((*ModeNo) <= 0x13) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001601
1602 if((*ModeNo) <= 0x05) (*ModeNo) |= 0x01;
1603
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001604 for((*ModeIdIndex) = 0; ;(*ModeIdIndex)++) {
1605 if(SiS_Pr->SiS_SModeIDTable[(*ModeIdIndex)].St_ModeID == (*ModeNo)) break;
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001606 if(SiS_Pr->SiS_SModeIDTable[(*ModeIdIndex)].St_ModeID == 0xFF) return false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001607 }
1608
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001609 if((*ModeNo) == 0x07) {
1610 if(VGAINFO & 0x10) (*ModeIdIndex)++; /* 400 lines */
1611 /* else 350 lines */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001612 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001613 if((*ModeNo) <= 0x03) {
1614 if(!(VGAINFO & 0x80)) (*ModeIdIndex)++;
1615 if(VGAINFO & 0x10) (*ModeIdIndex)++; /* 400 lines */
1616 /* else 350 lines */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617 }
1618 /* else 200 lines */
1619
1620 } else {
1621
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001622 for((*ModeIdIndex) = 0; ;(*ModeIdIndex)++) {
1623 if(SiS_Pr->SiS_EModeIDTable[(*ModeIdIndex)].Ext_ModeID == (*ModeNo)) break;
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001624 if(SiS_Pr->SiS_EModeIDTable[(*ModeIdIndex)].Ext_ModeID == 0xFF) return false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001625 }
1626
1627 }
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001628 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001629}
1630
1631/*********************************************/
1632/* HELPER: GetModePtr */
1633/*********************************************/
1634
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001635unsigned short
1636SiS_GetModePtr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001638 unsigned short index;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001639
1640 if(ModeNo <= 0x13) {
1641 index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_StTableIndex;
1642 } else {
1643 if(SiS_Pr->SiS_ModeType <= ModeEGA) index = 0x1B;
1644 else index = 0x0F;
1645 }
1646 return index;
1647}
1648
1649/*********************************************/
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001650/* HELPERS: Get some indices */
1651/*********************************************/
1652
1653unsigned short
1654SiS_GetRefCRTVCLK(struct SiS_Private *SiS_Pr, unsigned short Index, int UseWide)
1655{
1656 if(SiS_Pr->SiS_RefIndex[Index].Ext_InfoFlag & HaveWideTiming) {
1657 if(UseWide == 1) {
1658 return SiS_Pr->SiS_RefIndex[Index].Ext_CRTVCLK_WIDE;
1659 } else {
1660 return SiS_Pr->SiS_RefIndex[Index].Ext_CRTVCLK_NORM;
1661 }
1662 } else {
1663 return SiS_Pr->SiS_RefIndex[Index].Ext_CRTVCLK;
1664 }
1665}
1666
1667unsigned short
1668SiS_GetRefCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short Index, int UseWide)
1669{
1670 if(SiS_Pr->SiS_RefIndex[Index].Ext_InfoFlag & HaveWideTiming) {
1671 if(UseWide == 1) {
1672 return SiS_Pr->SiS_RefIndex[Index].Ext_CRT1CRTC_WIDE;
1673 } else {
1674 return SiS_Pr->SiS_RefIndex[Index].Ext_CRT1CRTC_NORM;
1675 }
1676 } else {
1677 return SiS_Pr->SiS_RefIndex[Index].Ext_CRT1CRTC;
1678 }
1679}
1680
1681/*********************************************/
Linus Torvalds1da177e2005-04-16 15:20:36 -07001682/* HELPER: LowModeTests */
1683/*********************************************/
1684
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001685static bool
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001686SiS_DoLowModeTest(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001688 unsigned short temp, temp1, temp2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001689
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001690 if((ModeNo != 0x03) && (ModeNo != 0x10) && (ModeNo != 0x12))
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001691 return true;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001692 temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x11);
1693 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x11,0x80);
1694 temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x00);
1695 SiS_SetReg(SiS_Pr->SiS_P3d4,0x00,0x55);
1696 temp2 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x00);
1697 SiS_SetReg(SiS_Pr->SiS_P3d4,0x00,temp1);
1698 SiS_SetReg(SiS_Pr->SiS_P3d4,0x11,temp);
1699 if((SiS_Pr->ChipType >= SIS_315H) ||
1700 (SiS_Pr->ChipType == SIS_300)) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001701 if(temp2 == 0x55) return false;
1702 else return true;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001703 } else {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001704 if(temp2 != 0x55) return true;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001705 else {
1706 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x35,0x01);
Richard Knutssonc30660ea2007-02-12 00:55:06 -08001707 return false;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001708 }
1709 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001710}
1711
1712static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001713SiS_SetLowModeTest(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001714{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001715 if(SiS_DoLowModeTest(SiS_Pr, ModeNo)) {
1716 SiS_Pr->SiS_SetFlag |= LowModeTests;
1717 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001718}
1719
1720/*********************************************/
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001721/* HELPER: OPEN/CLOSE CRT1 CRTC */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001722/*********************************************/
1723
1724static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001725SiS_OpenCRTC(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001726{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001727 if(IS_SIS650) {
1728 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x51,0x1f);
1729 if(IS_SIS651) SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x51,0x20);
1730 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x56,0xe7);
1731 } else if(IS_SIS661741660760) {
1732 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x61,0xf7);
1733 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x51,0x1f);
1734 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x56,0xe7);
1735 if(!SiS_Pr->SiS_ROMNew) {
1736 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x3a,0xef);
1737 }
1738 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001739}
1740
1741static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001742SiS_CloseCRTC(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001743{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001744#if 0 /* This locks some CRTC registers. We don't want that. */
1745 unsigned short temp1 = 0, temp2 = 0;
1746
1747 if(IS_SIS661741660760) {
1748 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
1749 temp1 = 0xa0; temp2 = 0x08;
1750 }
1751 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x51,0x1f,temp1);
1752 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x56,0xe7,temp2);
1753 }
1754#endif
1755}
1756
1757static void
1758SiS_HandleCRT1(struct SiS_Private *SiS_Pr)
1759{
1760 /* Enable CRT1 gating */
1761 SiS_SetRegAND(SiS_Pr->SiS_P3d4,SiS_Pr->SiS_MyCR63,0xbf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001762#if 0
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001763 if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x15) & 0x01)) {
1764 if((SiS_GetReg(SiS_Pr->SiS_P3c4,0x15) & 0x0a) ||
1765 (SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x01)) {
1766 SiS_SetRegOR(SiS_Pr->SiS_P3d4,SiS_Pr->SiS_MyCR63,0x40);
1767 }
1768 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001769#endif
1770}
1771
1772/*********************************************/
1773/* HELPER: GetColorDepth */
1774/*********************************************/
1775
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001776unsigned short
1777SiS_GetColorDepth(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
1778 unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001779{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001780 static const unsigned short ColorDepth[6] = { 1, 2, 4, 4, 6, 8 };
1781 unsigned short modeflag;
1782 short index;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001783
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001784 /* Do NOT check UseCustomMode, will skrew up FIFO */
1785 if(ModeNo == 0xfe) {
1786 modeflag = SiS_Pr->CModeFlag;
1787 } else if(ModeNo <= 0x13) {
1788 modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
1789 } else {
1790 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
1791 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001792
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001793 index = (modeflag & ModeTypeMask) - ModeEGA;
1794 if(index < 0) index = 0;
1795 return ColorDepth[index];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001796}
1797
1798/*********************************************/
1799/* HELPER: GetOffset */
1800/*********************************************/
1801
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001802unsigned short
1803SiS_GetOffset(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
1804 unsigned short ModeIdIndex, unsigned short RRTI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001805{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001806 unsigned short xres, temp, colordepth, infoflag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001807
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001808 if(SiS_Pr->UseCustomMode) {
1809 infoflag = SiS_Pr->CInfoFlag;
1810 xres = SiS_Pr->CHDisplay;
1811 } else {
1812 infoflag = SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag;
1813 xres = SiS_Pr->SiS_RefIndex[RRTI].XRes;
1814 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001815
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001816 colordepth = SiS_GetColorDepth(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001817
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001818 temp = xres / 16;
1819 if(infoflag & InterlaceMode) temp <<= 1;
1820 temp *= colordepth;
1821 if(xres % 16) temp += (colordepth >> 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001822
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001823 return temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001824}
1825
1826/*********************************************/
1827/* SEQ */
1828/*********************************************/
1829
1830static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001831SiS_SetSeqRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001832{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001833 unsigned char SRdata;
1834 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001835
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001836 SiS_SetReg(SiS_Pr->SiS_P3c4,0x00,0x03);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001837
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001838 /* or "display off" */
1839 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[0] | 0x20;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001840
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001841 /* determine whether to force x8 dotclock */
1842 if((SiS_Pr->SiS_VBType & VB_SISVB) || (SiS_Pr->SiS_IF_DEF_LVDS)) {
1843
1844 if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
1845 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) SRdata |= 0x01;
1846 } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) SRdata |= 0x01;
1847
Linus Torvalds1da177e2005-04-16 15:20:36 -07001848 }
1849
Linus Torvalds1da177e2005-04-16 15:20:36 -07001850 SiS_SetReg(SiS_Pr->SiS_P3c4,0x01,SRdata);
1851
1852 for(i = 2; i <= 4; i++) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001853 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[i - 1];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001854 SiS_SetReg(SiS_Pr->SiS_P3c4,i,SRdata);
1855 }
1856}
1857
1858/*********************************************/
1859/* MISC */
1860/*********************************************/
1861
1862static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001863SiS_SetMiscRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001864{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001865 unsigned char Miscdata;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001866
1867 Miscdata = SiS_Pr->SiS_StandTable[StandTableIndex].MISC;
1868
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001869 if(SiS_Pr->ChipType < SIS_661) {
1870 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
1871 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
1872 Miscdata |= 0x0C;
1873 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001874 }
1875 }
1876
1877 SiS_SetRegByte(SiS_Pr->SiS_P3c2,Miscdata);
1878}
1879
1880/*********************************************/
1881/* CRTC */
1882/*********************************************/
1883
1884static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001885SiS_SetCRTCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001886{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001887 unsigned char CRTCdata;
1888 unsigned short i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001889
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001890 /* Unlock CRTC */
1891 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001892
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001893 for(i = 0; i <= 0x18; i++) {
1894 CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i];
1895 SiS_SetReg(SiS_Pr->SiS_P3d4,i,CRTCdata);
1896 }
1897
1898 if(SiS_Pr->ChipType >= SIS_661) {
1899 SiS_OpenCRTC(SiS_Pr);
1900 for(i = 0x13; i <= 0x14; i++) {
1901 CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i];
1902 SiS_SetReg(SiS_Pr->SiS_P3d4,i,CRTCdata);
1903 }
1904 } else if( ( (SiS_Pr->ChipType == SIS_630) ||
1905 (SiS_Pr->ChipType == SIS_730) ) &&
1906 (SiS_Pr->ChipRevision >= 0x30) ) {
1907 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
1908 if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
1909 SiS_SetReg(SiS_Pr->SiS_P3d4,0x18,0xFE);
1910 }
1911 }
1912 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001913}
1914
1915/*********************************************/
1916/* ATT */
1917/*********************************************/
1918
1919static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001920SiS_SetATTRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001921{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001922 unsigned char ARdata;
1923 unsigned short i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924
1925 for(i = 0; i <= 0x13; i++) {
1926 ARdata = SiS_Pr->SiS_StandTable[StandTableIndex].ATTR[i];
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001927
Linus Torvalds1da177e2005-04-16 15:20:36 -07001928 if(i == 0x13) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001929 /* Pixel shift. If screen on LCD or TV is shifted left or right,
1930 * this might be the cause.
1931 */
1932 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
1933 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) ARdata = 0;
1934 }
1935 if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
1936 if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
1937 if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
1938 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0;
1939 }
1940 }
1941 }
1942 if(SiS_Pr->ChipType >= SIS_661) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001943 if(SiS_Pr->SiS_VBInfo & (SetCRT2ToTV | SetCRT2ToLCD)) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001944 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001945 }
1946 } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001947 if(SiS_Pr->ChipType >= SIS_315H) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001948 if(IS_SIS550650740660) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001949 /* 315, 330 don't do this */
1950 if(SiS_Pr->SiS_VBType & VB_SIS30xB) {
1951 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0;
1952 } else {
1953 ARdata = 0;
1954 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001955 }
1956 } else {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001957 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001958 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001959 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001960 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001961 SiS_GetRegByte(SiS_Pr->SiS_P3da); /* reset 3da */
1962 SiS_SetRegByte(SiS_Pr->SiS_P3c0,i); /* set index */
1963 SiS_SetRegByte(SiS_Pr->SiS_P3c0,ARdata); /* set data */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001964 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001965
1966 SiS_GetRegByte(SiS_Pr->SiS_P3da); /* reset 3da */
1967 SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x14); /* set index */
1968 SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x00); /* set data */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001969
1970 SiS_GetRegByte(SiS_Pr->SiS_P3da);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001971 SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x20); /* Enable Attribute */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972 SiS_GetRegByte(SiS_Pr->SiS_P3da);
1973}
1974
1975/*********************************************/
1976/* GRC */
1977/*********************************************/
1978
1979static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001980SiS_SetGRCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001981{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07001982 unsigned char GRdata;
1983 unsigned short i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001984
1985 for(i = 0; i <= 0x08; i++) {
1986 GRdata = SiS_Pr->SiS_StandTable[StandTableIndex].GRC[i];
1987 SiS_SetReg(SiS_Pr->SiS_P3ce,i,GRdata);
1988 }
1989
1990 if(SiS_Pr->SiS_ModeType > ModeVGA) {
1991 /* 256 color disable */
1992 SiS_SetRegAND(SiS_Pr->SiS_P3ce,0x05,0xBF);
1993 }
1994}
1995
1996/*********************************************/
1997/* CLEAR EXTENDED REGISTERS */
1998/*********************************************/
1999
2000static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002001SiS_ClearExt1Regs(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002002{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002003 unsigned short i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002004
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002005 for(i = 0x0A; i <= 0x0E; i++) {
2006 SiS_SetReg(SiS_Pr->SiS_P3c4,i,0x00);
2007 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002008
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002009 if(SiS_Pr->ChipType >= SIS_315H) {
2010 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x37,0xFE);
2011 if(ModeNo <= 0x13) {
2012 if(ModeNo == 0x06 || ModeNo >= 0x0e) {
2013 SiS_SetReg(SiS_Pr->SiS_P3c4,0x0e,0x20);
2014 }
2015 }
2016 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002017}
2018
2019/*********************************************/
2020/* RESET VCLK */
2021/*********************************************/
2022
2023static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002024SiS_ResetCRT1VCLK(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002025{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002026 if(SiS_Pr->ChipType >= SIS_315H) {
2027 if(SiS_Pr->ChipType < SIS_661) {
2028 if(SiS_Pr->SiS_IF_DEF_LVDS == 0) return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002029 }
2030 } else {
2031 if((SiS_Pr->SiS_IF_DEF_LVDS == 0) &&
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002032 (!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002033 return;
2034 }
2035 }
2036
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002037 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xcf,0x20);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[1].SR2B);
2039 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[1].SR2C);
2040 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002041 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xcf,0x10);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002042 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[0].SR2B);
2043 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[0].SR2C);
2044 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80);
2045}
2046
2047/*********************************************/
2048/* SYNC */
2049/*********************************************/
2050
2051static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002052SiS_SetCRT1Sync(struct SiS_Private *SiS_Pr, unsigned short RRTI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002053{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002054 unsigned short sync;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002056 if(SiS_Pr->UseCustomMode) {
2057 sync = SiS_Pr->CInfoFlag >> 8;
2058 } else {
2059 sync = SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag >> 8;
2060 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002062 sync &= 0xC0;
2063 sync |= 0x2f;
2064 SiS_SetRegByte(SiS_Pr->SiS_P3c2,sync);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002065}
2066
2067/*********************************************/
2068/* CRTC/2 */
2069/*********************************************/
2070
2071static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002072SiS_SetCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
2073 unsigned short ModeIdIndex, unsigned short RRTI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002074{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002075 unsigned short temp, i, j, modeflag;
2076 unsigned char *crt1data = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002077
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002078 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002079
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002080 if(SiS_Pr->UseCustomMode) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002081
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002082 crt1data = &SiS_Pr->CCRT1CRTC[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002083
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002084 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002085
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002086 temp = SiS_GetRefCRT1CRTC(SiS_Pr, RRTI, SiS_Pr->SiS_UseWide);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002087
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002088 /* Alternate for 1600x1200 LCDA */
2089 if((temp == 0x20) && (SiS_Pr->Alternate1600x1200)) temp = 0x57;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002090
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002091 crt1data = (unsigned char *)&SiS_Pr->SiS_CRT1Table[temp].CR[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002092
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002093 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002094
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002095 /* unlock cr0-7 */
2096 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002097
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002098 for(i = 0, j = 0; i <= 7; i++, j++) {
2099 SiS_SetReg(SiS_Pr->SiS_P3d4,j,crt1data[i]);
2100 }
2101 for(j = 0x10; i <= 10; i++, j++) {
2102 SiS_SetReg(SiS_Pr->SiS_P3d4,j,crt1data[i]);
2103 }
2104 for(j = 0x15; i <= 12; i++, j++) {
2105 SiS_SetReg(SiS_Pr->SiS_P3d4,j,crt1data[i]);
2106 }
2107 for(j = 0x0A; i <= 15; i++, j++) {
2108 SiS_SetReg(SiS_Pr->SiS_P3c4,j,crt1data[i]);
2109 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002110
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002111 SiS_SetReg(SiS_Pr->SiS_P3c4,0x0E,crt1data[16] & 0xE0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002112
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002113 temp = (crt1data[16] & 0x01) << 5;
2114 if(modeflag & DoubleScanMode) temp |= 0x80;
2115 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,0x5F,temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002117 if(SiS_Pr->SiS_ModeType > ModeVGA) {
2118 SiS_SetReg(SiS_Pr->SiS_P3d4,0x14,0x4F);
2119 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002120
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002121#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002122 if(SiS_Pr->ChipType == XGI_20) {
2123 SiS_SetReg(SiS_Pr->SiS_P3d4,0x04,crt1data[4] - 1);
2124 if(!(temp = crt1data[5] & 0x1f)) {
2125 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x0c,0xfb);
2126 }
2127 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x05,0xe0,((temp - 1) & 0x1f));
2128 temp = (crt1data[16] >> 5) + 3;
2129 if(temp > 7) temp -= 7;
2130 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0e,0x1f,(temp << 5));
2131 }
2132#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002133}
2134
2135/*********************************************/
2136/* OFFSET & PITCH */
2137/*********************************************/
2138/* (partly overruled by SetPitch() in XF86) */
2139/*********************************************/
2140
2141static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002142SiS_SetCRT1Offset(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
2143 unsigned short ModeIdIndex, unsigned short RRTI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002144{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002145 unsigned short temp, DisplayUnit, infoflag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002146
2147 if(SiS_Pr->UseCustomMode) {
2148 infoflag = SiS_Pr->CInfoFlag;
2149 } else {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002150 infoflag = SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002151 }
2152
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002153 DisplayUnit = SiS_GetOffset(SiS_Pr, ModeNo, ModeIdIndex, RRTI);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002154
2155 temp = (DisplayUnit >> 8) & 0x0f;
2156 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0xF0,temp);
2157
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002158 SiS_SetReg(SiS_Pr->SiS_P3d4,0x13,DisplayUnit & 0xFF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002159
2160 if(infoflag & InterlaceMode) DisplayUnit >>= 1;
2161
2162 DisplayUnit <<= 5;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002163 temp = (DisplayUnit >> 8) + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002164 if(DisplayUnit & 0xff) temp++;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002165 if(SiS_Pr->ChipType == XGI_20) {
2166 if(ModeNo == 0x4a || ModeNo == 0x49) temp--;
2167 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002168 SiS_SetReg(SiS_Pr->SiS_P3c4,0x10,temp);
2169}
2170
2171/*********************************************/
2172/* VCLK */
2173/*********************************************/
2174
2175static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002176SiS_SetCRT1VCLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
2177 unsigned short ModeIdIndex, unsigned short RRTI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002178{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002179 unsigned short index = 0, clka, clkb;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002180
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002181 if(SiS_Pr->UseCustomMode) {
2182 clka = SiS_Pr->CSR2B;
2183 clkb = SiS_Pr->CSR2C;
2184 } else {
2185 index = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RRTI);
2186 if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) &&
2187 (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
2188 /* Alternate for 1600x1200 LCDA */
2189 if((index == 0x21) && (SiS_Pr->Alternate1600x1200)) index = 0x72;
2190 clka = SiS_Pr->SiS_VBVCLKData[index].Part4_A;
2191 clkb = SiS_Pr->SiS_VBVCLKData[index].Part4_B;
2192 } else {
2193 clka = SiS_Pr->SiS_VCLKData[index].SR2B;
2194 clkb = SiS_Pr->SiS_VCLKData[index].SR2C;
2195 }
2196 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002197
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002198 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xCF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002199
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002200 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2b,clka);
2201 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2c,clkb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002202
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002203 if(SiS_Pr->ChipType >= SIS_315H) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002204#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002205 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x01);
2206 if(SiS_Pr->ChipType == XGI_20) {
2207 unsigned short mf = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
2208 if(mf & HalfDCLK) {
2209 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2b,SiS_GetReg(SiS_Pr->SiS_P3c4,0x2b));
2210 clkb = SiS_GetReg(SiS_Pr->SiS_P3c4,0x2c);
2211 clkb = (((clkb & 0x1f) << 1) + 1) | (clkb & 0xe0);
2212 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2c,clkb);
2213 }
2214 }
2215#endif
2216 } else {
2217 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80);
2218 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002219}
2220
2221/*********************************************/
2222/* FIFO */
2223/*********************************************/
2224
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002225#ifdef CONFIG_FB_SIS_300
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002226void
2227SiS_GetFIFOThresholdIndex300(struct SiS_Private *SiS_Pr, unsigned short *idx1,
2228 unsigned short *idx2)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002229{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002230 unsigned short temp1, temp2;
2231 static const unsigned char ThTiming[8] = {
2232 1, 2, 2, 3, 0, 1, 1, 2
2233 };
Linus Torvalds1da177e2005-04-16 15:20:36 -07002234
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002235 temp1 = temp2 = (SiS_GetReg(SiS_Pr->SiS_P3c4,0x18) & 0x62) >> 1;
2236 (*idx2) = (unsigned short)(ThTiming[((temp2 >> 3) | temp1) & 0x07]);
2237 (*idx1) = (unsigned short)(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) >> 6) & 0x03;
2238 (*idx1) |= (unsigned short)(((SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) >> 4) & 0x0c));
2239 (*idx1) <<= 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002240}
2241
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002242static unsigned short
2243SiS_GetFIFOThresholdA300(unsigned short idx1, unsigned short idx2)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002244{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002245 static const unsigned char ThLowA[8 * 3] = {
2246 61, 3,52, 5,68, 7,100,11,
2247 43, 3,42, 5,54, 7, 78,11,
2248 34, 3,37, 5,47, 7, 67,11
2249 };
Linus Torvalds1da177e2005-04-16 15:20:36 -07002250
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002251 return (unsigned short)((ThLowA[idx1 + 1] * idx2) + ThLowA[idx1]);
2252}
2253
2254unsigned short
2255SiS_GetFIFOThresholdB300(unsigned short idx1, unsigned short idx2)
2256{
2257 static const unsigned char ThLowB[8 * 3] = {
2258 81, 4,72, 6,88, 8,120,12,
2259 55, 4,54, 6,66, 8, 90,12,
2260 42, 4,45, 6,55, 8, 75,12
2261 };
2262
2263 return (unsigned short)((ThLowB[idx1 + 1] * idx2) + ThLowB[idx1]);
2264}
2265
2266static unsigned short
2267SiS_DoCalcDelay(struct SiS_Private *SiS_Pr, unsigned short MCLK, unsigned short VCLK,
2268 unsigned short colordepth, unsigned short key)
2269{
2270 unsigned short idx1, idx2;
2271 unsigned int longtemp = VCLK * colordepth;
2272
2273 SiS_GetFIFOThresholdIndex300(SiS_Pr, &idx1, &idx2);
2274
2275 if(key == 0) {
2276 longtemp *= SiS_GetFIFOThresholdA300(idx1, idx2);
2277 } else {
2278 longtemp *= SiS_GetFIFOThresholdB300(idx1, idx2);
2279 }
2280 idx1 = longtemp % (MCLK * 16);
2281 longtemp /= (MCLK * 16);
2282 if(idx1) longtemp++;
2283 return (unsigned short)longtemp;
2284}
2285
2286static unsigned short
2287SiS_CalcDelay(struct SiS_Private *SiS_Pr, unsigned short VCLK,
2288 unsigned short colordepth, unsigned short MCLK)
2289{
2290 unsigned short temp1, temp2;
2291
2292 temp2 = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 0);
2293 temp1 = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 1);
2294 if(temp1 < 4) temp1 = 4;
2295 temp1 -= 4;
2296 if(temp2 < temp1) temp2 = temp1;
2297 return temp2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002298}
2299
2300static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002301SiS_SetCRT1FIFO_300(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
2302 unsigned short RefreshRateTableIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002303{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002304 unsigned short ThresholdLow = 0;
2305 unsigned short temp, index, VCLK, MCLK, colorth;
2306 static const unsigned short colortharray[6] = { 1, 1, 2, 2, 3, 4 };
Linus Torvalds1da177e2005-04-16 15:20:36 -07002307
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002308 if(ModeNo > 0x13) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002309
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002310 /* Get VCLK */
2311 if(SiS_Pr->UseCustomMode) {
2312 VCLK = SiS_Pr->CSRClock;
2313 } else {
2314 index = SiS_GetRefCRTVCLK(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWide);
2315 VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
2316 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002317
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002318 /* Get half colordepth */
2319 colorth = colortharray[(SiS_Pr->SiS_ModeType - ModeEGA)];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002320
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002321 /* Get MCLK */
2322 index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3A) & 0x07;
2323 MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002324
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002325 temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35) & 0xc3;
2326 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3c,temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002327
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002328 do {
2329 ThresholdLow = SiS_CalcDelay(SiS_Pr, VCLK, colorth, MCLK) + 1;
2330 if(ThresholdLow < 0x13) break;
2331 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x16,0xfc);
2332 ThresholdLow = 0x13;
2333 temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) >> 6;
2334 if(!temp) break;
2335 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3f,((temp - 1) << 6));
2336 } while(0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002337
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002338 } else ThresholdLow = 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002339
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002340 /* Write CRT/CPU threshold low, CRT/Engine threshold high */
2341 temp = (ThresholdLow << 4) | 0x0f;
2342 SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002343
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002344 temp = (ThresholdLow & 0x10) << 1;
2345 if(ModeNo > 0x13) temp |= 0x40;
2346 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0f,0x9f,temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002347
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002348 /* What is this? */
2349 SiS_SetReg(SiS_Pr->SiS_P3c4,0x3B,0x09);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002350
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002351 /* Write CRT/CPU threshold high */
2352 temp = ThresholdLow + 3;
2353 if(temp > 0x0f) temp = 0x0f;
2354 SiS_SetReg(SiS_Pr->SiS_P3c4,0x09,temp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002355}
2356
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002357unsigned short
2358SiS_GetLatencyFactor630(struct SiS_Private *SiS_Pr, unsigned short index)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002359{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002360 static const unsigned char LatencyFactor[] = {
2361 97, 88, 86, 79, 77, 0, /* 64 bit BQ=2 */
2362 0, 87, 85, 78, 76, 54, /* 64 bit BQ=1 */
2363 97, 88, 86, 79, 77, 0, /* 128 bit BQ=2 */
2364 0, 79, 77, 70, 68, 48, /* 128 bit BQ=1 */
2365 80, 72, 69, 63, 61, 0, /* 64 bit BQ=2 */
2366 0, 70, 68, 61, 59, 37, /* 64 bit BQ=1 */
2367 86, 77, 75, 68, 66, 0, /* 128 bit BQ=2 */
2368 0, 68, 66, 59, 57, 37 /* 128 bit BQ=1 */
2369 };
2370 static const unsigned char LatencyFactor730[] = {
2371 69, 63, 61,
2372 86, 79, 77,
2373 103, 96, 94,
2374 120,113,111,
2375 137,130,128
2376 };
Linus Torvalds1da177e2005-04-16 15:20:36 -07002377
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002378 if(SiS_Pr->ChipType == SIS_730) {
2379 return (unsigned short)LatencyFactor730[index];
2380 } else {
2381 return (unsigned short)LatencyFactor[index];
2382 }
2383}
2384
2385static unsigned short
2386SiS_CalcDelay2(struct SiS_Private *SiS_Pr, unsigned char key)
2387{
2388 unsigned short index;
2389
2390 if(SiS_Pr->ChipType == SIS_730) {
2391 index = ((key & 0x0f) * 3) + ((key & 0xc0) >> 6);
2392 } else {
2393 index = (key & 0xe0) >> 5;
2394 if(key & 0x10) index += 6;
2395 if(!(key & 0x01)) index += 24;
2396 if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) & 0x80) index += 12;
2397 }
2398 return SiS_GetLatencyFactor630(SiS_Pr, index);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002399}
2400
2401static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002402SiS_SetCRT1FIFO_630(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
2403 unsigned short RefreshRateTableIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002404{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002405 unsigned short ThresholdLow = 0;
2406 unsigned short i, data, VCLK, MCLK16, colorth = 0;
2407 unsigned int templ, datal;
2408 const unsigned char *queuedata = NULL;
2409 static const unsigned char FQBQData[21] = {
2410 0x01,0x21,0x41,0x61,0x81,
2411 0x31,0x51,0x71,0x91,0xb1,
2412 0x00,0x20,0x40,0x60,0x80,
2413 0x30,0x50,0x70,0x90,0xb0,
2414 0xff
2415 };
2416 static const unsigned char FQBQData730[16] = {
2417 0x34,0x74,0xb4,
2418 0x23,0x63,0xa3,
2419 0x12,0x52,0x92,
2420 0x01,0x41,0x81,
2421 0x00,0x40,0x80,
2422 0xff
2423 };
2424 static const unsigned short colortharray[6] = {
2425 1, 1, 2, 2, 3, 4
2426 };
Linus Torvalds1da177e2005-04-16 15:20:36 -07002427
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002428 i = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002429
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002430 if(ModeNo > 0x13) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002431
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002432 /* Get VCLK */
2433 if(SiS_Pr->UseCustomMode) {
2434 VCLK = SiS_Pr->CSRClock;
2435 } else {
2436 data = SiS_GetRefCRTVCLK(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWide);
2437 VCLK = SiS_Pr->SiS_VCLKData[data].CLOCK;
2438 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002439
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002440 /* Get MCLK * 16 */
2441 data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1A) & 0x07;
2442 MCLK16 = SiS_Pr->SiS_MCLKData_0[data].CLOCK * 16;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002443
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002444 /* Get half colordepth */
2445 colorth = colortharray[(SiS_Pr->SiS_ModeType - ModeEGA)];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002446
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002447 if(SiS_Pr->ChipType == SIS_730) {
2448 queuedata = &FQBQData730[0];
2449 } else {
2450 queuedata = &FQBQData[0];
2451 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002452
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002453 do {
2454 templ = SiS_CalcDelay2(SiS_Pr, queuedata[i]) * VCLK * colorth;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002455
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002456 datal = templ % MCLK16;
2457 templ = (templ / MCLK16) + 1;
2458 if(datal) templ++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002459
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002460 if(templ > 0x13) {
2461 if(queuedata[i + 1] == 0xFF) {
2462 ThresholdLow = 0x13;
2463 break;
2464 }
2465 i++;
2466 } else {
2467 ThresholdLow = templ;
2468 break;
2469 }
2470 } while(queuedata[i] != 0xFF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002471
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002472 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002473
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002474 if(SiS_Pr->ChipType != SIS_730) i = 9;
2475 ThresholdLow = 0x02;
2476
2477 }
2478
2479 /* Write CRT/CPU threshold low, CRT/Engine threshold high */
2480 data = ((ThresholdLow & 0x0f) << 4) | 0x0f;
2481 SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,data);
2482
2483 data = (ThresholdLow & 0x10) << 1;
2484 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xDF,data);
2485
2486 /* What is this? */
2487 SiS_SetReg(SiS_Pr->SiS_P3c4,0x3B,0x09);
2488
2489 /* Write CRT/CPU threshold high (gap = 3) */
2490 data = ThresholdLow + 3;
2491 if(data > 0x0f) data = 0x0f;
2492 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x09,0x80,data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002493
2494 /* Write foreground and background queue */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002495 templ = sisfb_read_nbridge_pci_dword(SiS_Pr, 0x50);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002496
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002497 if(SiS_Pr->ChipType == SIS_730) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002498
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002499 templ &= 0xfffff9ff;
2500 templ |= ((queuedata[i] & 0xc0) << 3);
2501
2502 } else {
2503
2504 templ &= 0xf0ffffff;
2505 if( (ModeNo <= 0x13) &&
2506 (SiS_Pr->ChipType == SIS_630) &&
2507 (SiS_Pr->ChipRevision >= 0x30) ) {
2508 templ |= 0x0b000000;
2509 } else {
2510 templ |= ((queuedata[i] & 0xf0) << 20);
2511 }
2512
2513 }
2514
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002515 sisfb_write_nbridge_pci_dword(SiS_Pr, 0x50, templ);
2516 templ = sisfb_read_nbridge_pci_dword(SiS_Pr, 0xA0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002517
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002518 /* GUI grant timer (PCI config 0xA3) */
2519 if(SiS_Pr->ChipType == SIS_730) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002520
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002521 templ &= 0x00ffffff;
2522 datal = queuedata[i] << 8;
2523 templ |= (((datal & 0x0f00) | ((datal & 0x3000) >> 8)) << 20);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002524
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002525 } else {
2526
2527 templ &= 0xf0ffffff;
2528 templ |= ((queuedata[i] & 0x0f) << 24);
2529
2530 }
2531
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002532 sisfb_write_nbridge_pci_dword(SiS_Pr, 0xA0, templ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002533}
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002534#endif /* CONFIG_FB_SIS_300 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002535
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002536#ifdef CONFIG_FB_SIS_315
Linus Torvalds1da177e2005-04-16 15:20:36 -07002537static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002538SiS_SetCRT1FIFO_310(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002539{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002540 unsigned short modeflag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002541
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002542 /* disable auto-threshold */
2543 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x3D,0xFE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002544
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002545 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002546
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002547 SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,0xAE);
2548 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x09,0xF0);
2549 if(ModeNo > 0x13) {
2550 if(SiS_Pr->ChipType >= XGI_20) {
2551 SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,0x34);
2552 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x3D,0x01);
2553 } else if(SiS_Pr->ChipType >= SIS_661) {
2554 if(!(modeflag & HalfDCLK)) {
2555 SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,0x34);
2556 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x3D,0x01);
2557 }
2558 } else {
2559 if((!(modeflag & DoubleScanMode)) || (!(modeflag & HalfDCLK))) {
2560 SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,0x34);
2561 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x3D,0x01);
2562 }
2563 }
2564 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002565}
2566#endif
2567
2568/*********************************************/
2569/* MODE REGISTERS */
2570/*********************************************/
2571
2572static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002573SiS_SetVCLKState(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
2574 unsigned short RefreshRateTableIndex, unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002575{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002576 unsigned short data = 0, VCLK = 0, index = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002577
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002578 if(ModeNo > 0x13) {
2579 if(SiS_Pr->UseCustomMode) {
2580 VCLK = SiS_Pr->CSRClock;
2581 } else {
2582 index = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
2583 VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
2584 }
2585 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002586
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002587 if(SiS_Pr->ChipType < SIS_315H) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002588#ifdef CONFIG_FB_SIS_300
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002589 if(VCLK > 150) data |= 0x80;
2590 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0x7B,data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002591
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002592 data = 0x00;
2593 if(VCLK >= 150) data |= 0x08;
2594 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xF7,data);
2595#endif
2596 } else if(SiS_Pr->ChipType < XGI_20) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002597#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002598 if(VCLK >= 166) data |= 0x0c;
2599 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xf3,data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002600
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002601 if(VCLK >= 166) {
2602 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1f,0xe7);
2603 }
2604#endif
2605 } else {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002606#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002607 if(VCLK >= 200) data |= 0x0c;
2608 if(SiS_Pr->ChipType == XGI_20) data &= ~0x04;
2609 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xf3,data);
2610 if(SiS_Pr->ChipType != XGI_20) {
2611 data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1f) & 0xe7;
2612 if(VCLK < 200) data |= 0x10;
2613 SiS_SetReg(SiS_Pr->SiS_P3c4,0x1f,data);
2614 }
2615#endif
2616 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002617
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002618 /* DAC speed */
2619 if(SiS_Pr->ChipType >= SIS_661) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002620
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002621 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xE8,0x10);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002622
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002623 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002624
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002625 data = 0x03;
2626 if(VCLK >= 260) data = 0x00;
2627 else if(VCLK >= 160) data = 0x01;
2628 else if(VCLK >= 135) data = 0x02;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002629
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002630 if(SiS_Pr->ChipType == SIS_540) {
Alan Cox39012f62012-07-11 14:22:56 +01002631 /* Was == 203 or < 234 which made no sense */
2632 if (VCLK < 234) data = 0x02;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002633 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002634
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002635 if(SiS_Pr->ChipType < SIS_315H) {
2636 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xFC,data);
2637 } else {
2638 if(SiS_Pr->ChipType > SIS_315PRO) {
2639 if(ModeNo > 0x13) data &= 0xfc;
2640 }
2641 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xF8,data);
2642 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002643
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002644 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002645}
2646
2647static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002648SiS_SetCRT1ModeRegs(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
2649 unsigned short ModeIdIndex, unsigned short RRTI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002650{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002651 unsigned short data, infoflag = 0, modeflag, resindex;
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002652#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002653 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
2654 unsigned short data2, data3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002655#endif
2656
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002657 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002658
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002659 if(SiS_Pr->UseCustomMode) {
2660 infoflag = SiS_Pr->CInfoFlag;
2661 } else {
2662 resindex = SiS_GetResInfo(SiS_Pr, ModeNo, ModeIdIndex);
2663 if(ModeNo > 0x13) {
2664 infoflag = SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag;
2665 }
2666 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002667
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002668 /* Disable DPMS */
2669 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1F,0x3F);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002670
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002671 data = 0;
2672 if(ModeNo > 0x13) {
2673 if(SiS_Pr->SiS_ModeType > ModeEGA) {
2674 data |= 0x02;
2675 data |= ((SiS_Pr->SiS_ModeType - ModeVGA) << 2);
2676 }
2677 if(infoflag & InterlaceMode) data |= 0x20;
2678 }
2679 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x06,0xC0,data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002680
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002681 if(SiS_Pr->ChipType != SIS_300) {
2682 data = 0;
2683 if(infoflag & InterlaceMode) {
2684 /* data = (Hsync / 8) - ((Htotal / 8) / 2) + 3 */
2685 int hrs = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x04) |
2686 ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x0b) & 0xc0) << 2)) - 3;
2687 int hto = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x00) |
2688 ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x0b) & 0x03) << 8)) + 5;
2689 data = hrs - (hto >> 1) + 3;
2690 }
2691 SiS_SetReg(SiS_Pr->SiS_P3d4,0x19,data);
2692 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x1a,0xFC,((data >> 8) & 0x03));
2693 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002694
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002695 if(modeflag & HalfDCLK) {
2696 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x01,0x08);
2697 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002698
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002699 data = 0;
2700 if(modeflag & LineCompareOff) data = 0x08;
2701 if(SiS_Pr->ChipType == SIS_300) {
2702 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xF7,data);
2703 } else {
2704 if(SiS_Pr->ChipType >= XGI_20) data |= 0x20;
2705 if(SiS_Pr->SiS_ModeType == ModeEGA) {
2706 if(ModeNo > 0x13) {
2707 data |= 0x40;
2708 }
2709 }
2710 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xB7,data);
2711 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002712
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002713#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002714 if(SiS_Pr->ChipType >= SIS_315H) {
2715 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xfb);
2716 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002717
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002718 if(SiS_Pr->ChipType == SIS_315PRO) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002719
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002720 data = SiS_Pr->SiS_SR15[(2 * 4) + SiS_Get310DRAMType(SiS_Pr)];
2721 if(SiS_Pr->SiS_ModeType == ModeText) {
2722 data &= 0xc7;
2723 } else {
2724 data2 = SiS_GetOffset(SiS_Pr, ModeNo, ModeIdIndex, RRTI) >> 1;
2725 if(infoflag & InterlaceMode) data2 >>= 1;
2726 data3 = SiS_GetColorDepth(SiS_Pr, ModeNo, ModeIdIndex) >> 1;
2727 if(data3) data2 /= data3;
2728 if(data2 >= 0x50) {
2729 data &= 0x0f;
2730 data |= 0x50;
2731 }
2732 }
2733 SiS_SetReg(SiS_Pr->SiS_P3c4,0x17,data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002734
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002735 } else if((SiS_Pr->ChipType == SIS_330) || (SiS_Pr->SiS_SysFlags & SF_760LFB)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002736
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002737 data = SiS_Get310DRAMType(SiS_Pr);
2738 if(SiS_Pr->ChipType == SIS_330) {
2739 data = SiS_Pr->SiS_SR15[(2 * 4) + data];
2740 } else {
2741 if(SiS_Pr->SiS_ROMNew) data = ROMAddr[0xf6];
2742 else if(SiS_Pr->SiS_UseROM) data = ROMAddr[0x100 + data];
2743 else data = 0xba;
2744 }
2745 if(SiS_Pr->SiS_ModeType <= ModeEGA) {
2746 data &= 0xc7;
2747 } else {
2748 if(SiS_Pr->UseCustomMode) {
2749 data2 = SiS_Pr->CSRClock;
2750 } else {
2751 data2 = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RRTI);
2752 data2 = SiS_Pr->SiS_VCLKData[data2].CLOCK;
2753 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002754
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002755 data3 = SiS_GetColorDepth(SiS_Pr, ModeNo, ModeIdIndex) >> 1;
2756 if(data3) data2 *= data3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002757
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002758 data2 = ((unsigned int)(SiS_GetMCLK(SiS_Pr) * 1024)) / data2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002759
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002760 if(SiS_Pr->ChipType == SIS_330) {
2761 if(SiS_Pr->SiS_ModeType != Mode16Bpp) {
2762 if (data2 >= 0x19c) data = 0xba;
2763 else if(data2 >= 0x140) data = 0x7a;
2764 else if(data2 >= 0x101) data = 0x3a;
2765 else if(data2 >= 0xf5) data = 0x32;
2766 else if(data2 >= 0xe2) data = 0x2a;
2767 else if(data2 >= 0xc4) data = 0x22;
2768 else if(data2 >= 0xac) data = 0x1a;
2769 else if(data2 >= 0x9e) data = 0x12;
2770 else if(data2 >= 0x8e) data = 0x0a;
2771 else data = 0x02;
2772 } else {
2773 if(data2 >= 0x127) data = 0xba;
2774 else data = 0x7a;
2775 }
2776 } else { /* 76x+LFB */
2777 if (data2 >= 0x190) data = 0xba;
2778 else if(data2 >= 0xff) data = 0x7a;
2779 else if(data2 >= 0xd3) data = 0x3a;
2780 else if(data2 >= 0xa9) data = 0x1a;
2781 else if(data2 >= 0x93) data = 0x0a;
2782 else data = 0x02;
2783 }
2784 }
2785 SiS_SetReg(SiS_Pr->SiS_P3c4,0x17,data);
2786
2787 }
2788 /* XGI: Nothing. */
2789 /* TODO: Check SiS340 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002790#endif
2791
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002792 data = 0x60;
2793 if(SiS_Pr->SiS_ModeType != ModeText) {
2794 data ^= 0x60;
2795 if(SiS_Pr->SiS_ModeType != ModeEGA) {
2796 data ^= 0xA0;
2797 }
2798 }
2799 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x21,0x1F,data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002800
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002801 SiS_SetVCLKState(SiS_Pr, ModeNo, RRTI, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002802
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002803#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002804 if(((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->ChipType < SIS_661)) ||
2805 (SiS_Pr->ChipType == XGI_40)) {
2806 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40) {
2807 SiS_SetReg(SiS_Pr->SiS_P3d4,0x52,0x2c);
2808 } else {
2809 SiS_SetReg(SiS_Pr->SiS_P3d4,0x52,0x6c);
2810 }
2811 } else if(SiS_Pr->ChipType == XGI_20) {
2812 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40) {
2813 SiS_SetReg(SiS_Pr->SiS_P3d4,0x52,0x33);
2814 } else {
2815 SiS_SetReg(SiS_Pr->SiS_P3d4,0x52,0x73);
2816 }
2817 SiS_SetReg(SiS_Pr->SiS_P3d4,0x51,0x02);
2818 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002819#endif
2820}
2821
Aaro Koskinenf7854e52010-11-19 21:58:47 +00002822#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002823static void
2824SiS_SetupDualChip(struct SiS_Private *SiS_Pr)
2825{
2826#if 0
2827 /* TODO: Find out about IOAddress2 */
2828 SISIOADDRESS P2_3c2 = SiS_Pr->IOAddress2 + 0x12;
2829 SISIOADDRESS P2_3c4 = SiS_Pr->IOAddress2 + 0x14;
2830 SISIOADDRESS P2_3ce = SiS_Pr->IOAddress2 + 0x1e;
2831 int i;
2832
2833 if((SiS_Pr->ChipRevision != 0) ||
2834 (!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x3a) & 0x04)))
2835 return;
2836
2837 for(i = 0; i <= 4; i++) { /* SR00 - SR04 */
2838 SiS_SetReg(P2_3c4,i,SiS_GetReg(SiS_Pr->SiS_P3c4,i));
2839 }
2840 for(i = 0; i <= 8; i++) { /* GR00 - GR08 */
2841 SiS_SetReg(P2_3ce,i,SiS_GetReg(SiS_Pr->SiS_P3ce,i));
2842 }
2843 SiS_SetReg(P2_3c4,0x05,0x86);
2844 SiS_SetReg(P2_3c4,0x06,SiS_GetReg(SiS_Pr->SiS_P3c4,0x06)); /* SR06 */
2845 SiS_SetReg(P2_3c4,0x21,SiS_GetReg(SiS_Pr->SiS_P3c4,0x21)); /* SR21 */
2846 SiS_SetRegByte(P2_3c2,SiS_GetRegByte(SiS_Pr->SiS_P3cc)); /* MISC */
2847 SiS_SetReg(P2_3c4,0x05,0x00);
2848#endif
2849}
2850#endif
2851
Linus Torvalds1da177e2005-04-16 15:20:36 -07002852/*********************************************/
2853/* LOAD DAC */
2854/*********************************************/
2855
Linus Torvalds1da177e2005-04-16 15:20:36 -07002856static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002857SiS_WriteDAC(struct SiS_Private *SiS_Pr, SISIOADDRESS DACData, unsigned short shiftflag,
2858 unsigned short dl, unsigned short ah, unsigned short al, unsigned short dh)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002859{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002860 unsigned short d1, d2, d3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002861
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002862 switch(dl) {
2863 case 0: d1 = dh; d2 = ah; d3 = al; break;
2864 case 1: d1 = ah; d2 = al; d3 = dh; break;
2865 default: d1 = al; d2 = dh; d3 = ah;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002866 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002867 SiS_SetRegByte(DACData, (d1 << shiftflag));
2868 SiS_SetRegByte(DACData, (d2 << shiftflag));
2869 SiS_SetRegByte(DACData, (d3 << shiftflag));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002870}
2871
2872void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002873SiS_LoadDAC(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002874{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002875 unsigned short data, data2, time, i, j, k, m, n, o;
2876 unsigned short si, di, bx, sf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002877 SISIOADDRESS DACAddr, DACData;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002878 const unsigned char *table = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002879
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002880 data = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex) & DACInfoFlag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002881
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002882 j = time = 64;
2883 if(data == 0x00) table = SiS_MDA_DAC;
2884 else if(data == 0x08) table = SiS_CGA_DAC;
2885 else if(data == 0x10) table = SiS_EGA_DAC;
2886 else if(data == 0x18) {
2887 j = 16;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002888 time = 256;
2889 table = SiS_VGA_DAC;
2890 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002891
2892 if( ( (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && /* 301B-DH LCD */
2893 (SiS_Pr->SiS_VBType & VB_NoLCD) ) ||
2894 (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) || /* LCDA */
2895 (!(SiS_Pr->SiS_SetFlag & ProgrammingCRT2)) ) { /* Programming CRT1 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002896 SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002897 DACAddr = SiS_Pr->SiS_P3c8;
2898 DACData = SiS_Pr->SiS_P3c9;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002899 sf = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002900 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002901 DACAddr = SiS_Pr->SiS_Part5Port;
2902 DACData = SiS_Pr->SiS_Part5Port + 1;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002903 sf = 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002904 }
2905
2906 SiS_SetRegByte(DACAddr,0x00);
2907
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002908 for(i = 0; i < j; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002909 data = table[i];
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002910 for(k = 0; k < 3; k++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002911 data2 = 0;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002912 if(data & 0x01) data2 += 0x2A;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002913 if(data & 0x02) data2 += 0x15;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002914 SiS_SetRegByte(DACData, (data2 << sf));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002915 data >>= 2;
2916 }
2917 }
2918
2919 if(time == 256) {
2920 for(i = 16; i < 32; i++) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002921 data = table[i] << sf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002922 for(k = 0; k < 3; k++) SiS_SetRegByte(DACData, data);
2923 }
2924 si = 32;
2925 for(m = 0; m < 9; m++) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002926 di = si;
2927 bx = si + 4;
2928 for(n = 0; n < 3; n++) {
2929 for(o = 0; o < 5; o++) {
2930 SiS_WriteDAC(SiS_Pr, DACData, sf, n, table[di], table[bx], table[si]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002931 si++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002932 }
2933 si -= 2;
2934 for(o = 0; o < 3; o++) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002935 SiS_WriteDAC(SiS_Pr, DACData, sf, n, table[di], table[si], table[bx]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002936 si--;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002937 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002938 } /* for n < 3 */
2939 si += 5;
2940 } /* for m < 9 */
2941 }
2942}
2943
2944/*********************************************/
2945/* SET CRT1 REGISTER GROUP */
2946/*********************************************/
2947
2948static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002949SiS_SetCRT1Group(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002950{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002951 unsigned short StandTableIndex, RefreshRateTableIndex;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002952
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002953 SiS_Pr->SiS_CRT1Mode = ModeNo;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002954
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002955 StandTableIndex = SiS_GetModePtr(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002956
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002957 if(SiS_Pr->SiS_SetFlag & LowModeTests) {
2958 if(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2)) {
2959 SiS_DisableBridge(SiS_Pr);
2960 }
2961 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002962
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002963 SiS_ResetSegmentRegisters(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002964
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002965 SiS_SetSeqRegs(SiS_Pr, StandTableIndex);
2966 SiS_SetMiscRegs(SiS_Pr, StandTableIndex);
2967 SiS_SetCRTCRegs(SiS_Pr, StandTableIndex);
2968 SiS_SetATTRegs(SiS_Pr, StandTableIndex);
2969 SiS_SetGRCRegs(SiS_Pr, StandTableIndex);
2970 SiS_ClearExt1Regs(SiS_Pr, ModeNo);
2971 SiS_ResetCRT1VCLK(SiS_Pr);
2972
2973 SiS_Pr->SiS_SelectCRT2Rate = 0;
2974 SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2);
2975
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002976 if(SiS_Pr->SiS_VBInfo & SetSimuScanMode) {
2977 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2978 SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
2979 }
2980 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002981
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002982 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
2983 SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
2984 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002985
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002986 RefreshRateTableIndex = SiS_GetRatePtr(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002987
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002988 if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
2989 SiS_Pr->SiS_SetFlag &= ~ProgrammingCRT2;
2990 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002991
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002992 if(RefreshRateTableIndex != 0xFFFF) {
2993 SiS_SetCRT1Sync(SiS_Pr, RefreshRateTableIndex);
2994 SiS_SetCRT1CRTC(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
2995 SiS_SetCRT1Offset(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
2996 SiS_SetCRT1VCLK(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
2997 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002998
Thomas Winischhofer544393f2005-09-09 13:04:45 -07002999 switch(SiS_Pr->ChipType) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003000#ifdef CONFIG_FB_SIS_300
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003001 case SIS_300:
3002 SiS_SetCRT1FIFO_300(SiS_Pr, ModeNo, RefreshRateTableIndex);
3003 break;
3004 case SIS_540:
3005 case SIS_630:
3006 case SIS_730:
3007 SiS_SetCRT1FIFO_630(SiS_Pr, ModeNo, RefreshRateTableIndex);
3008 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003009#endif
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003010 default:
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003011#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003012 if(SiS_Pr->ChipType == XGI_20) {
3013 unsigned char sr2b = 0, sr2c = 0;
3014 switch(ModeNo) {
3015 case 0x00:
3016 case 0x01: sr2b = 0x4e; sr2c = 0xe9; break;
3017 case 0x04:
3018 case 0x05:
3019 case 0x0d: sr2b = 0x1b; sr2c = 0xe3; break;
3020 }
3021 if(sr2b) {
3022 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2b,sr2b);
3023 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2c,sr2c);
3024 SiS_SetRegByte(SiS_Pr->SiS_P3c2,(SiS_GetRegByte(SiS_Pr->SiS_P3cc) | 0x0c));
3025 }
3026 }
3027 SiS_SetCRT1FIFO_310(SiS_Pr, ModeNo, ModeIdIndex);
3028#endif
3029 break;
3030 }
3031
3032 SiS_SetCRT1ModeRegs(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3033
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003034#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003035 if(SiS_Pr->ChipType == XGI_40) {
3036 SiS_SetupDualChip(SiS_Pr);
3037 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003038#endif
3039
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003040 SiS_LoadDAC(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003041
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003042 if(SiS_Pr->SiS_flag_clearbuffer) {
3043 SiS_ClearBuffer(SiS_Pr, ModeNo);
3044 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003045
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003046 if(!(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2 | SetCRT2ToLCDA))) {
3047 SiS_WaitRetrace1(SiS_Pr);
3048 SiS_DisplayOn(SiS_Pr);
3049 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003050}
3051
3052/*********************************************/
3053/* HELPER: VIDEO BRIDGE PROG CLK */
3054/*********************************************/
3055
3056static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003057SiS_InitVB(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003058{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003059 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003060
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003061 SiS_Pr->Init_P4_0E = 0;
3062 if(SiS_Pr->SiS_ROMNew) {
3063 SiS_Pr->Init_P4_0E = ROMAddr[0x82];
3064 } else if(SiS_Pr->ChipType >= XGI_40) {
3065 if(SiS_Pr->SiS_XGIROM) {
3066 SiS_Pr->Init_P4_0E = ROMAddr[0x80];
Linus Torvalds1da177e2005-04-16 15:20:36 -07003067 }
3068 }
3069}
3070
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003071static void
3072SiS_ResetVB(struct SiS_Private *SiS_Pr)
3073{
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003074#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003075 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
3076 unsigned short temp;
3077
3078 /* VB programming clock */
3079 if(SiS_Pr->SiS_UseROM) {
3080 if(SiS_Pr->ChipType < SIS_330) {
3081 temp = ROMAddr[VB310Data_1_2_Offset] | 0x40;
3082 if(SiS_Pr->SiS_ROMNew) temp = ROMAddr[0x80] | 0x40;
3083 SiS_SetReg(SiS_Pr->SiS_Part1Port,0x02,temp);
3084 } else if(SiS_Pr->ChipType >= SIS_661 && SiS_Pr->ChipType < XGI_20) {
3085 temp = ROMAddr[0x7e] | 0x40;
3086 if(SiS_Pr->SiS_ROMNew) temp = ROMAddr[0x80] | 0x40;
3087 SiS_SetReg(SiS_Pr->SiS_Part1Port,0x02,temp);
3088 }
3089 } else if(SiS_Pr->ChipType >= XGI_40) {
3090 temp = 0x40;
3091 if(SiS_Pr->SiS_XGIROM) temp |= ROMAddr[0x7e];
3092 /* Can we do this on any chipset? */
3093 SiS_SetReg(SiS_Pr->SiS_Part1Port,0x02,temp);
3094 }
3095#endif
3096}
3097
Linus Torvalds1da177e2005-04-16 15:20:36 -07003098/*********************************************/
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003099/* HELPER: SET VIDEO/CAPTURE REGISTERS */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003100/*********************************************/
3101
3102static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003103SiS_StrangeStuff(struct SiS_Private *SiS_Pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003104{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003105 /* SiS65x and XGI set up some sort of "lock mode" for text
3106 * which locks CRT2 in some way to CRT1 timing. Disable
3107 * this here.
3108 */
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003109#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003110 if((IS_SIS651) || (IS_SISM650) ||
3111 SiS_Pr->ChipType == SIS_340 ||
3112 SiS_Pr->ChipType == XGI_40) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003113 SiS_SetReg(SiS_Pr->SiS_VidCapt, 0x3f, 0x00); /* Fiddle with capture regs */
3114 SiS_SetReg(SiS_Pr->SiS_VidCapt, 0x00, 0x00);
3115 SiS_SetReg(SiS_Pr->SiS_VidPlay, 0x00, 0x86); /* (BIOS does NOT unlock) */
3116 SiS_SetRegAND(SiS_Pr->SiS_VidPlay, 0x30, 0xfe); /* Fiddle with video regs */
3117 SiS_SetRegAND(SiS_Pr->SiS_VidPlay, 0x3f, 0xef);
3118 }
3119 /* !!! This does not support modes < 0x13 !!! */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003120#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003121}
3122
3123/*********************************************/
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003124/* HELPER: SET AGP TIMING FOR SiS760 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003125/*********************************************/
3126
Linus Torvalds1da177e2005-04-16 15:20:36 -07003127static void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003128SiS_Handle760(struct SiS_Private *SiS_Pr)
3129{
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003130#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003131 unsigned int somebase;
3132 unsigned char temp1, temp2, temp3;
3133
3134 if( (SiS_Pr->ChipType != SIS_760) ||
3135 ((SiS_GetReg(SiS_Pr->SiS_P3d4, 0x5c) & 0xf8) != 0x80) ||
3136 (!(SiS_Pr->SiS_SysFlags & SF_760LFB)) ||
3137 (!(SiS_Pr->SiS_SysFlags & SF_760UMA)) )
3138 return;
3139
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003140 somebase = sisfb_read_mio_pci_word(SiS_Pr, 0x74);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003141 somebase &= 0xffff;
3142
3143 if(somebase == 0) return;
3144
3145 temp3 = SiS_GetRegByte((somebase + 0x85)) & 0xb7;
3146
3147 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40) {
3148 temp1 = 0x21;
3149 temp2 = 0x03;
3150 temp3 |= 0x08;
3151 } else {
3152 temp1 = 0x25;
3153 temp2 = 0x0b;
3154 }
3155
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003156 sisfb_write_nbridge_pci_byte(SiS_Pr, 0x7e, temp1);
3157 sisfb_write_nbridge_pci_byte(SiS_Pr, 0x8d, temp2);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003158
3159 SiS_SetRegByte((somebase + 0x85), temp3);
3160#endif
3161}
3162
3163/*********************************************/
Linus Torvalds1da177e2005-04-16 15:20:36 -07003164/* SiSSetMode() */
3165/*********************************************/
3166
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003167bool
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003168SiSSetMode(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003169{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003170 SISIOADDRESS BaseAddr = SiS_Pr->IOAddress;
3171 unsigned short RealModeNo, ModeIdIndex;
3172 unsigned char backupreg = 0;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003173 unsigned short KeepLockReg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003174
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003175 SiS_Pr->UseCustomMode = false;
3176 SiS_Pr->CRT1UsesCustomMode = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003177
Linus Torvalds1da177e2005-04-16 15:20:36 -07003178 SiS_Pr->SiS_flag_clearbuffer = 0;
3179
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003180 if(SiS_Pr->UseCustomMode) {
3181 ModeNo = 0xfe;
3182 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003183 if(!(ModeNo & 0x80)) SiS_Pr->SiS_flag_clearbuffer = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003184 ModeNo &= 0x7f;
3185 }
3186
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003187 /* Don't use FSTN mode for CRT1 */
3188 RealModeNo = ModeNo;
3189 if(ModeNo == 0x5b) ModeNo = 0x56;
3190
3191 SiSInitPtr(SiS_Pr);
3192 SiSRegInit(SiS_Pr, BaseAddr);
3193 SiS_GetSysFlags(SiS_Pr);
3194
3195 SiS_Pr->SiS_VGAINFO = 0x11;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003196
Linus Torvalds1da177e2005-04-16 15:20:36 -07003197 KeepLockReg = SiS_GetReg(SiS_Pr->SiS_P3c4,0x05);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003198 SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x86);
3199
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003200 SiSInitPCIetc(SiS_Pr);
3201 SiSSetLVDSetc(SiS_Pr);
3202 SiSDetermineROMUsage(SiS_Pr);
3203
3204 SiS_UnLockCRT2(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003205
3206 if(!SiS_Pr->UseCustomMode) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003207 if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) return false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003208 } else {
3209 ModeIdIndex = 0;
3210 }
3211
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003212 SiS_GetVBType(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003213
3214 /* Init/restore some VB registers */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003215 SiS_InitVB(SiS_Pr);
3216 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
3217 if(SiS_Pr->ChipType >= SIS_315H) {
3218 SiS_ResetVB(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003219 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x32,0x10);
3220 SiS_SetRegOR(SiS_Pr->SiS_Part2Port,0x00,0x0c);
3221 backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
3222 } else {
3223 backupreg = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
3224 }
3225 }
3226
3227 /* Get VB information (connectors, connected devices) */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003228 SiS_GetVBInfo(SiS_Pr, ModeNo, ModeIdIndex, (SiS_Pr->UseCustomMode) ? 0 : 1);
3229 SiS_SetYPbPr(SiS_Pr);
3230 SiS_SetTVMode(SiS_Pr, ModeNo, ModeIdIndex);
3231 SiS_GetLCDResInfo(SiS_Pr, ModeNo, ModeIdIndex);
3232 SiS_SetLowModeTest(SiS_Pr, ModeNo);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003233
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003234 /* Check memory size (kernel framebuffer driver only) */
3235 if(!SiS_CheckMemorySize(SiS_Pr, ModeNo, ModeIdIndex)) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003236 return false;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003237 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003238
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003239 SiS_OpenCRTC(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003240
3241 if(SiS_Pr->UseCustomMode) {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003242 SiS_Pr->CRT1UsesCustomMode = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003243 SiS_Pr->CSRClock_CRT1 = SiS_Pr->CSRClock;
3244 SiS_Pr->CModeFlag_CRT1 = SiS_Pr->CModeFlag;
3245 } else {
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003246 SiS_Pr->CRT1UsesCustomMode = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003247 }
3248
3249 /* Set mode on CRT1 */
3250 if( (SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SetCRT2ToLCDA)) ||
3251 (!(SiS_Pr->SiS_VBInfo & SwitchCRT2)) ) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003252 SiS_SetCRT1Group(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003253 }
3254
3255 /* Set mode on CRT2 */
3256 if(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2 | SetCRT2ToLCDA)) {
3257 if( (SiS_Pr->SiS_VBType & VB_SISVB) ||
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003258 (SiS_Pr->SiS_IF_DEF_LVDS == 1) ||
3259 (SiS_Pr->SiS_IF_DEF_CH70xx != 0) ||
3260 (SiS_Pr->SiS_IF_DEF_TRUMPION != 0) ) {
3261 SiS_SetCRT2Group(SiS_Pr, RealModeNo);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003262 }
3263 }
3264
3265 SiS_HandleCRT1(SiS_Pr);
3266
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003267 SiS_StrangeStuff(SiS_Pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003268
3269 SiS_DisplayOn(SiS_Pr);
3270 SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF);
3271
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003272#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003273 if(SiS_Pr->ChipType >= SIS_315H) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003274 if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003275 if(!(SiS_IsDualEdge(SiS_Pr))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003276 SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb);
3277 }
3278 }
3279 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003280#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003281
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003282 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
3283 if(SiS_Pr->ChipType >= SIS_315H) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003284#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003285 if(!SiS_Pr->SiS_ROMNew) {
3286 if(SiS_IsVAMode(SiS_Pr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003287 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x35,0x01);
3288 } else {
3289 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x35,0xFE);
3290 }
3291 }
3292
3293 SiS_SetReg(SiS_Pr->SiS_P3d4,0x38,backupreg);
3294
3295 if((IS_SIS650) && (SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & 0xfc)) {
3296 if((ModeNo == 0x03) || (ModeNo == 0x10)) {
3297 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x51,0x80);
3298 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x56,0x08);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003299 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003300 }
3301
3302 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & SetCRT2ToLCD) {
3303 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x38,0xfc);
3304 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003305#endif
3306 } else if((SiS_Pr->ChipType == SIS_630) ||
3307 (SiS_Pr->ChipType == SIS_730)) {
3308 SiS_SetReg(SiS_Pr->SiS_P3d4,0x35,backupreg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003309 }
3310 }
3311
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003312 SiS_CloseCRTC(SiS_Pr);
3313
3314 SiS_Handle760(SiS_Pr);
3315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003316 /* We never lock registers in XF86 */
3317 if(KeepLockReg != 0xA1) SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x00);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003318
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003319 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003320}
3321
Linus Torvalds1da177e2005-04-16 15:20:36 -07003322#ifndef GETBITSTR
3323#define BITMASK(h,l) (((unsigned)(1U << ((h)-(l)+1))-1)<<(l))
3324#define GENMASK(mask) BITMASK(1?mask,0?mask)
3325#define GETBITS(var,mask) (((var) & GENMASK(mask)) >> (0?mask))
3326#define GETBITSTR(val,from,to) ((GETBITS(val,from)) << (0?to))
3327#endif
3328
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003329void
3330SiS_CalcCRRegisters(struct SiS_Private *SiS_Pr, int depth)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003331{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003332 int x = 1; /* Fix sync */
3333
Linus Torvalds1da177e2005-04-16 15:20:36 -07003334 SiS_Pr->CCRT1CRTC[0] = ((SiS_Pr->CHTotal >> 3) - 5) & 0xff; /* CR0 */
3335 SiS_Pr->CCRT1CRTC[1] = (SiS_Pr->CHDisplay >> 3) - 1; /* CR1 */
3336 SiS_Pr->CCRT1CRTC[2] = (SiS_Pr->CHBlankStart >> 3) - 1; /* CR2 */
3337 SiS_Pr->CCRT1CRTC[3] = (((SiS_Pr->CHBlankEnd >> 3) - 1) & 0x1F) | 0x80; /* CR3 */
3338 SiS_Pr->CCRT1CRTC[4] = (SiS_Pr->CHSyncStart >> 3) + 3; /* CR4 */
3339 SiS_Pr->CCRT1CRTC[5] = ((((SiS_Pr->CHBlankEnd >> 3) - 1) & 0x20) << 2) | /* CR5 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003340 (((SiS_Pr->CHSyncEnd >> 3) + 3) & 0x1F);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003341
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003342 SiS_Pr->CCRT1CRTC[6] = (SiS_Pr->CVTotal - 2) & 0xFF; /* CR6 */
3343 SiS_Pr->CCRT1CRTC[7] = (((SiS_Pr->CVTotal - 2) & 0x100) >> 8) /* CR7 */
3344 | (((SiS_Pr->CVDisplay - 1) & 0x100) >> 7)
3345 | (((SiS_Pr->CVSyncStart - x) & 0x100) >> 6)
3346 | (((SiS_Pr->CVBlankStart- 1) & 0x100) >> 5)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003347 | 0x10
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003348 | (((SiS_Pr->CVTotal - 2) & 0x200) >> 4)
3349 | (((SiS_Pr->CVDisplay - 1) & 0x200) >> 3)
3350 | (((SiS_Pr->CVSyncStart - x) & 0x200) >> 2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003351
3352 SiS_Pr->CCRT1CRTC[16] = ((((SiS_Pr->CVBlankStart - 1) & 0x200) >> 4) >> 5); /* CR9 */
3353
3354 if(depth != 8) {
3355 if(SiS_Pr->CHDisplay >= 1600) SiS_Pr->CCRT1CRTC[16] |= 0x60; /* SRE */
3356 else if(SiS_Pr->CHDisplay >= 640) SiS_Pr->CCRT1CRTC[16] |= 0x40;
3357 }
3358
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003359 SiS_Pr->CCRT1CRTC[8] = (SiS_Pr->CVSyncStart - x) & 0xFF; /* CR10 */
3360 SiS_Pr->CCRT1CRTC[9] = ((SiS_Pr->CVSyncEnd - x) & 0x0F) | 0x80; /* CR11 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003361 SiS_Pr->CCRT1CRTC[10] = (SiS_Pr->CVDisplay - 1) & 0xFF; /* CR12 */
3362 SiS_Pr->CCRT1CRTC[11] = (SiS_Pr->CVBlankStart - 1) & 0xFF; /* CR15 */
3363 SiS_Pr->CCRT1CRTC[12] = (SiS_Pr->CVBlankEnd - 1) & 0xFF; /* CR16 */
3364
3365 SiS_Pr->CCRT1CRTC[13] = /* SRA */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003366 GETBITSTR((SiS_Pr->CVTotal -2), 10:10, 0:0) |
3367 GETBITSTR((SiS_Pr->CVDisplay -1), 10:10, 1:1) |
3368 GETBITSTR((SiS_Pr->CVBlankStart-1), 10:10, 2:2) |
3369 GETBITSTR((SiS_Pr->CVSyncStart -x), 10:10, 3:3) |
3370 GETBITSTR((SiS_Pr->CVBlankEnd -1), 8:8, 4:4) |
3371 GETBITSTR((SiS_Pr->CVSyncEnd ), 4:4, 5:5) ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003372
3373 SiS_Pr->CCRT1CRTC[14] = /* SRB */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003374 GETBITSTR((SiS_Pr->CHTotal >> 3) - 5, 9:8, 1:0) |
3375 GETBITSTR((SiS_Pr->CHDisplay >> 3) - 1, 9:8, 3:2) |
3376 GETBITSTR((SiS_Pr->CHBlankStart >> 3) - 1, 9:8, 5:4) |
3377 GETBITSTR((SiS_Pr->CHSyncStart >> 3) + 3, 9:8, 7:6) ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003378
3379
3380 SiS_Pr->CCRT1CRTC[15] = /* SRC */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003381 GETBITSTR((SiS_Pr->CHBlankEnd >> 3) - 1, 7:6, 1:0) |
3382 GETBITSTR((SiS_Pr->CHSyncEnd >> 3) + 3, 5:5, 2:2) ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003383}
3384
3385void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003386SiS_CalcLCDACRT1Timing(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
3387 unsigned short ModeIdIndex)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003388{
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003389 unsigned short modeflag, tempax, tempbx = 0, remaining = 0;
3390 unsigned short VGAHDE = SiS_Pr->SiS_VGAHDE;
3391 int i, j;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003392
3393 /* 1:1 data: use data set by setcrt1crtc() */
3394 if(SiS_Pr->SiS_LCDInfo & LCDPass11) return;
3395
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003396 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003397
3398 if(modeflag & HalfDCLK) VGAHDE >>= 1;
3399
3400 SiS_Pr->CHDisplay = VGAHDE;
3401 SiS_Pr->CHBlankStart = VGAHDE;
3402
3403 SiS_Pr->CVDisplay = SiS_Pr->SiS_VGAVDE;
3404 SiS_Pr->CVBlankStart = SiS_Pr->SiS_VGAVDE;
3405
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003406 if(SiS_Pr->ChipType < SIS_315H) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003407#ifdef CONFIG_FB_SIS_300
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003408 tempbx = SiS_Pr->SiS_VGAHT;
3409 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3410 tempbx = SiS_Pr->PanelHT;
3411 }
3412 if(modeflag & HalfDCLK) tempbx >>= 1;
3413 remaining = tempbx % 8;
3414#endif
3415 } else {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003416#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003417 /* OK for LCDA, LVDS */
3418 tempbx = SiS_Pr->PanelHT - SiS_Pr->PanelXRes;
3419 tempax = SiS_Pr->SiS_VGAHDE; /* not /2 ! */
3420 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3421 tempax = SiS_Pr->PanelXRes;
3422 }
3423 tempbx += tempax;
3424 if(modeflag & HalfDCLK) tempbx -= VGAHDE;
3425#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003426 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003427 SiS_Pr->CHTotal = SiS_Pr->CHBlankEnd = tempbx;
3428
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003429 if(SiS_Pr->ChipType < SIS_315H) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003430#ifdef CONFIG_FB_SIS_300
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003431 if(SiS_Pr->SiS_VGAHDE == SiS_Pr->PanelXRes) {
3432 SiS_Pr->CHSyncStart = SiS_Pr->SiS_VGAHDE + ((SiS_Pr->PanelHRS + 1) & ~1);
3433 SiS_Pr->CHSyncEnd = SiS_Pr->CHSyncStart + SiS_Pr->PanelHRE;
3434 if(modeflag & HalfDCLK) {
3435 SiS_Pr->CHSyncStart >>= 1;
3436 SiS_Pr->CHSyncEnd >>= 1;
3437 }
3438 } else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3439 tempax = (SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE) >> 1;
3440 tempbx = (SiS_Pr->PanelHRS + 1) & ~1;
3441 if(modeflag & HalfDCLK) {
3442 tempax >>= 1;
3443 tempbx >>= 1;
3444 }
3445 SiS_Pr->CHSyncStart = (VGAHDE + tempax + tempbx + 7) & ~7;
3446 tempax = SiS_Pr->PanelHRE + 7;
3447 if(modeflag & HalfDCLK) tempax >>= 1;
3448 SiS_Pr->CHSyncEnd = (SiS_Pr->CHSyncStart + tempax) & ~7;
3449 } else {
3450 SiS_Pr->CHSyncStart = SiS_Pr->SiS_VGAHDE;
3451 if(modeflag & HalfDCLK) {
3452 SiS_Pr->CHSyncStart >>= 1;
3453 tempax = ((SiS_Pr->CHTotal - SiS_Pr->CHSyncStart) / 3) << 1;
3454 SiS_Pr->CHSyncEnd = SiS_Pr->CHSyncStart + tempax;
3455 } else {
3456 SiS_Pr->CHSyncEnd = (SiS_Pr->CHSyncStart + (SiS_Pr->CHTotal / 10) + 7) & ~7;
3457 SiS_Pr->CHSyncStart += 8;
3458 }
3459 }
3460#endif
3461 } else {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003462#ifdef CONFIG_FB_SIS_315
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003463 tempax = VGAHDE;
3464 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3465 tempbx = SiS_Pr->PanelXRes;
3466 if(modeflag & HalfDCLK) tempbx >>= 1;
3467 tempax += ((tempbx - tempax) >> 1);
3468 }
3469 tempax += SiS_Pr->PanelHRS;
3470 SiS_Pr->CHSyncStart = tempax;
3471 tempax += SiS_Pr->PanelHRE;
3472 SiS_Pr->CHSyncEnd = tempax;
3473#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003474 }
3475
Linus Torvalds1da177e2005-04-16 15:20:36 -07003476 tempbx = SiS_Pr->PanelVT - SiS_Pr->PanelYRes;
3477 tempax = SiS_Pr->SiS_VGAVDE;
3478 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3479 tempax = SiS_Pr->PanelYRes;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003480 } else if(SiS_Pr->ChipType < SIS_315H) {
Aaro Koskinenf7854e52010-11-19 21:58:47 +00003481#ifdef CONFIG_FB_SIS_300
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003482 /* Stupid hack for 640x400/320x200 */
3483 if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
3484 if((tempax + tempbx) == 438) tempbx += 16;
3485 } else if((SiS_Pr->SiS_LCDResInfo == Panel_800x600) ||
3486 (SiS_Pr->SiS_LCDResInfo == Panel_1024x600)) {
3487 tempax = 0;
3488 tempbx = SiS_Pr->SiS_VGAVT;
3489 }
3490#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003491 }
3492 SiS_Pr->CVTotal = SiS_Pr->CVBlankEnd = tempbx + tempax;
3493
3494 tempax = SiS_Pr->SiS_VGAVDE;
3495 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3496 tempax += (SiS_Pr->PanelYRes - tempax) >> 1;
3497 }
3498 tempax += SiS_Pr->PanelVRS;
3499 SiS_Pr->CVSyncStart = tempax;
3500 tempax += SiS_Pr->PanelVRE;
3501 SiS_Pr->CVSyncEnd = tempax;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003502 if(SiS_Pr->ChipType < SIS_315H) {
3503 SiS_Pr->CVSyncStart--;
3504 SiS_Pr->CVSyncEnd--;
3505 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003506
3507 SiS_CalcCRRegisters(SiS_Pr, 8);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003508 SiS_Pr->CCRT1CRTC[15] &= ~0xF8;
3509 SiS_Pr->CCRT1CRTC[15] |= (remaining << 4);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003510 SiS_Pr->CCRT1CRTC[16] &= ~0xE0;
3511
3512 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f);
3513
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003514 for(i = 0, j = 0; i <= 7; i++, j++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003515 SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]);
3516 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003517 for(j = 0x10; i <= 10; i++, j++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003518 SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]);
3519 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003520 for(j = 0x15; i <= 12; i++, j++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003521 SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]);
3522 }
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003523 for(j = 0x0A; i <= 15; i++, j++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003524 SiS_SetReg(SiS_Pr->SiS_P3c4,j,SiS_Pr->CCRT1CRTC[i]);
3525 }
3526
3527 tempax = SiS_Pr->CCRT1CRTC[16] & 0xE0;
3528 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0x1F,tempax);
3529
3530 tempax = (SiS_Pr->CCRT1CRTC[16] & 0x01) << 5;
3531 if(modeflag & DoubleScanMode) tempax |= 0x80;
3532 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,0x5F,tempax);
3533
Linus Torvalds1da177e2005-04-16 15:20:36 -07003534}
3535
Linus Torvalds1da177e2005-04-16 15:20:36 -07003536void
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003537SiS_Generic_ConvertCRData(struct SiS_Private *SiS_Pr, unsigned char *crdata,
3538 int xres, int yres,
Richard Knutssonc30660ea2007-02-12 00:55:06 -08003539 struct fb_var_screeninfo *var, bool writeres
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003540)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003541{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003542 unsigned short HRE, HBE, HRS, HBS, HDE, HT;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003543 unsigned short VRE, VBE, VRS, VBS, VDE, VT;
3544 unsigned char sr_data, cr_data, cr_data2;
3545 int A, B, C, D, E, F, temp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003546
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003547 sr_data = crdata[14];
Linus Torvalds1da177e2005-04-16 15:20:36 -07003548
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003549 /* Horizontal total */
3550 HT = crdata[0] | ((unsigned short)(sr_data & 0x03) << 8);
3551 A = HT + 5;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003552
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003553 /* Horizontal display enable end */
3554 HDE = crdata[1] | ((unsigned short)(sr_data & 0x0C) << 6);
3555 E = HDE + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003556
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003557 /* Horizontal retrace (=sync) start */
3558 HRS = crdata[4] | ((unsigned short)(sr_data & 0xC0) << 2);
3559 F = HRS - E - 3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003560
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003561 /* Horizontal blank start */
3562 HBS = crdata[2] | ((unsigned short)(sr_data & 0x30) << 4);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003563
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003564 sr_data = crdata[15];
3565 cr_data = crdata[5];
Linus Torvalds1da177e2005-04-16 15:20:36 -07003566
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003567 /* Horizontal blank end */
3568 HBE = (crdata[3] & 0x1f) |
3569 ((unsigned short)(cr_data & 0x80) >> 2) |
3570 ((unsigned short)(sr_data & 0x03) << 6);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003571
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003572 /* Horizontal retrace (=sync) end */
3573 HRE = (cr_data & 0x1f) | ((sr_data & 0x04) << 3);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003574
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003575 temp = HBE - ((E - 1) & 255);
3576 B = (temp > 0) ? temp : (temp + 256);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003577
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003578 temp = HRE - ((E + F + 3) & 63);
3579 C = (temp > 0) ? temp : (temp + 64);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003580
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003581 D = B - F - C;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003582
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003583 if(writeres) var->xres = xres = E * 8;
3584 var->left_margin = D * 8;
3585 var->right_margin = F * 8;
3586 var->hsync_len = C * 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003587
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003588 /* Vertical */
3589 sr_data = crdata[13];
3590 cr_data = crdata[7];
Linus Torvalds1da177e2005-04-16 15:20:36 -07003591
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003592 /* Vertical total */
3593 VT = crdata[6] |
3594 ((unsigned short)(cr_data & 0x01) << 8) |
3595 ((unsigned short)(cr_data & 0x20) << 4) |
3596 ((unsigned short)(sr_data & 0x01) << 10);
3597 A = VT + 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003598
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003599 /* Vertical display enable end */
3600 VDE = crdata[10] |
3601 ((unsigned short)(cr_data & 0x02) << 7) |
3602 ((unsigned short)(cr_data & 0x40) << 3) |
3603 ((unsigned short)(sr_data & 0x02) << 9);
3604 E = VDE + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003605
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003606 /* Vertical retrace (=sync) start */
3607 VRS = crdata[8] |
3608 ((unsigned short)(cr_data & 0x04) << 6) |
3609 ((unsigned short)(cr_data & 0x80) << 2) |
3610 ((unsigned short)(sr_data & 0x08) << 7);
3611 F = VRS + 1 - E;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003612
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003613 cr_data2 = (crdata[16] & 0x01) << 5;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003614
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003615 /* Vertical blank start */
3616 VBS = crdata[11] |
3617 ((unsigned short)(cr_data & 0x08) << 5) |
Linus Torvalds1da177e2005-04-16 15:20:36 -07003618 ((unsigned short)(cr_data2 & 0x20) << 4) |
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003619 ((unsigned short)(sr_data & 0x04) << 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003620
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003621 /* Vertical blank end */
3622 VBE = crdata[12] | ((unsigned short)(sr_data & 0x10) << 4);
3623 temp = VBE - ((E - 1) & 511);
3624 B = (temp > 0) ? temp : (temp + 512);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003625
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003626 /* Vertical retrace (=sync) end */
3627 VRE = (crdata[9] & 0x0f) | ((sr_data & 0x20) >> 1);
3628 temp = VRE - ((E + F - 1) & 31);
3629 C = (temp > 0) ? temp : (temp + 32);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003630
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003631 D = B - F - C;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003632
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003633 if(writeres) var->yres = yres = E;
3634 var->upper_margin = D;
3635 var->lower_margin = F;
3636 var->vsync_len = C;
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003637
3638 if((xres == 320) && ((yres == 200) || (yres == 240))) {
3639 /* Terrible hack, but correct CRTC data for
3640 * these modes only produces a black screen...
3641 * (HRE is 0, leading into a too large C and
3642 * a negative D. The CRT controller does not
3643 * seem to like correcting HRE to 50)
3644 */
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003645 var->left_margin = (400 - 376);
3646 var->right_margin = (328 - 320);
3647 var->hsync_len = (376 - 328);
Thomas Winischhofer544393f2005-09-09 13:04:45 -07003648
3649 }
3650
3651}
3652
3653
3654
Linus Torvalds1da177e2005-04-16 15:20:36 -07003655