1 /* $XFree86$ */ 2 /* $XdotOrg$ */ 3 /* 4 * Mode initializing code (CRT1 section) for 5 * 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) 9 * 10 * Copyright (C) 2001-2005 by Thomas Winischhofer, Vienna, Austria 11 * 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. 57 */ 58 59 #include "init.h" 60 61 #ifdef CONFIG_FB_SIS_300 62 #include "300vtbl.h" 63 #endif 64 65 #ifdef CONFIG_FB_SIS_315 66 #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 77 #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) 78 static void 79 InitCommonPointer(struct SiS_Private *SiS_Pr) 80 { 81 SiS_Pr->SiS_SModeIDTable = SiS_SModeIDTable; 82 SiS_Pr->SiS_StResInfo = SiS_StResInfo; 83 SiS_Pr->SiS_ModeResInfo = SiS_ModeResInfo; 84 SiS_Pr->SiS_StandTable = SiS_StandTable; 85 86 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; 121 SiS_Pr->SiS_LCD1280x854Data = SiS_LCD1280x854Data; 122 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 130 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; 133 SiS_Pr->SiS_LVDS800x600Data_1 = SiS_LVDS800x600Data_1; 134 SiS_Pr->SiS_LVDS1024x600Data_1 = SiS_LVDS1024x600Data_1; 135 SiS_Pr->SiS_LVDS1024x768Data_1 = SiS_LVDS1024x768Data_1; 136 137 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; 142 SiS_Pr->SiS_LVDSCRT1640x480_1 = SiS_LVDSCRT1640x480_1; 143 SiS_Pr->SiS_LVDSCRT1640x480_1_H = SiS_LVDSCRT1640x480_1_H; 144 #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 150 151 SiS_Pr->SiS_CHTVUNTSCData = SiS_CHTVUNTSCData; 152 SiS_Pr->SiS_CHTVONTSCData = SiS_CHTVONTSCData; 153 154 SiS_Pr->SiS_PanelMinLVDS = Panel_800x600; /* lowest value LVDS/LCDA */ 155 SiS_Pr->SiS_PanelMin301 = Panel_1024x768; /* lowest value 301 */ 156 } 157 #endif 158 159 #ifdef CONFIG_FB_SIS_300 160 static void 161 InitTo300Pointer(struct SiS_Private *SiS_Pr) 162 { 163 InitCommonPointer(SiS_Pr); 164 165 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; 169 if(SiS_Pr->ChipType == SIS_300) { 170 SiS_Pr->SiS_MCLKData_0 = SiS300_MCLKData_300; /* 300 */ 171 } else { 172 SiS_Pr->SiS_MCLKData_0 = SiS300_MCLKData_630; /* 630, 730 */ 173 } 174 SiS_Pr->SiS_VCLKData = SiS300_VCLKData; 175 SiS_Pr->SiS_VBVCLKData = (struct SiS_VBVCLKData *)SiS300_VCLKData; 176 177 SiS_Pr->SiS_SR15 = SiS300_SR15; 178 179 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; 188 SiS_Pr->SiS_CRT2Part2_1024x768_2 = SiS300_CRT2Part2_1024x768_2; 189 SiS_Pr->SiS_CRT2Part2_1024x768_3 = SiS300_CRT2Part2_1024x768_3; 190 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 199 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; 204 205 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; 209 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 236 #ifdef CONFIG_FB_SIS_315 237 static void 238 InitTo310Pointer(struct SiS_Private *SiS_Pr) 239 { 240 InitCommonPointer(SiS_Pr); 241 242 SiS_Pr->SiS_EModeIDTable = SiS310_EModeIDTable; 243 SiS_Pr->SiS_RefIndex = SiS310_RefIndex; 244 SiS_Pr->SiS_CRT1Table = SiS310_CRT1Table; 245 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) { 248 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_761; /* 761 - preliminary */ 249 } else if(SiS_Pr->ChipType >= SIS_760) { 250 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_760; /* 760 */ 251 } else if(SiS_Pr->ChipType >= SIS_661) { 252 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_660; /* 661/741 */ 253 } else if(SiS_Pr->ChipType == SIS_330) { 254 SiS_Pr->SiS_MCLKData_0 = SiS310_MCLKData_0_330; /* 330 */ 255 } else if(SiS_Pr->ChipType > SIS_315PRO) { 256 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 } 260 if(SiS_Pr->ChipType >= SIS_340) { 261 SiS_Pr->SiS_MCLKData_1 = SiS310_MCLKData_1_340; 262 } else { 263 SiS_Pr->SiS_MCLKData_1 = SiS310_MCLKData_1; 264 } 265 SiS_Pr->SiS_VCLKData = SiS310_VCLKData; 266 SiS_Pr->SiS_VBVCLKData = SiS310_VBVCLKData; 267 268 SiS_Pr->SiS_SR15 = SiS310_SR15; 269 270 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 280 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 288 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; 293 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 316 bool 317 SiSInitPtr(struct SiS_Private *SiS_Pr) 318 { 319 if(SiS_Pr->ChipType < SIS_315H) { 320 #ifdef CONFIG_FB_SIS_300 321 InitTo300Pointer(SiS_Pr); 322 #else 323 return false; 324 #endif 325 } else { 326 #ifdef CONFIG_FB_SIS_315 327 InitTo310Pointer(SiS_Pr); 328 #else 329 return false; 330 #endif 331 } 332 return true; 333 } 334 335 /*********************************************/ 336 /* HELPER: Get ModeID */ 337 /*********************************************/ 338 339 static 340 unsigned short 341 SiS_GetModeID(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay, 342 int Depth, bool FSTN, int LCDwidth, int LCDheight) 343 { 344 unsigned short ModeIndex = 0; 345 346 switch(HDisplay) 347 { 348 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; 473 } 474 475 return ModeIndex; 476 } 477 478 unsigned short 479 SiS_GetModeID_LCD(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay, 480 int Depth, bool FSTN, unsigned short CustomT, int LCDwidth, int LCDheight, 481 unsigned int VBFlags2) 482 { 483 unsigned short ModeIndex = 0; 484 485 if(VBFlags2 & (VB2_LVDS | VB2_30xBDH)) { 486 487 switch(HDisplay) 488 { 489 case 320: 490 if((CustomT != CUT_PANEL848) && (CustomT != CUT_PANEL856)) { 491 if(VDisplay == 200) { 492 if(!FSTN) ModeIndex = ModeIndex_320x200[Depth]; 493 } else if(VDisplay == 240) { 494 if(!FSTN) ModeIndex = ModeIndex_320x240[Depth]; 495 else if(VGAEngine == SIS_315_VGA) { 496 ModeIndex = ModeIndex_320x240_FSTN[Depth]; 497 } 498 } 499 } 500 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]; 505 } 506 } 507 break; 508 case 512: 509 if((CustomT != CUT_PANEL848) && (CustomT != CUT_PANEL856)) { 510 if(!((VGAEngine == SIS_300_VGA) && (VBFlags2 & VB2_TRUMPION))) { 511 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: 520 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth]; 521 else if(VDisplay == 400) { 522 if((CustomT != CUT_PANEL848) && (CustomT != CUT_PANEL856)) 523 ModeIndex = ModeIndex_640x400[Depth]; 524 } 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; 534 case 856: 535 if(CustomT == CUT_PANEL856) { 536 if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth]; 537 } 538 break; 539 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) { 549 if((VDisplay == 768) && (LCDheight == 768)) { 550 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) { 557 if((VDisplay == 768) && (LCDheight == 768)) { 558 ModeIndex = ModeIndex_310_1280x768[Depth]; 559 } 560 } 561 break; 562 case 1360: 563 if(VGAEngine == SIS_300_VGA) { 564 if(CustomT == CUT_BARCO1366) { 565 if(VDisplay == 1024) ModeIndex = ModeIndex_300_1360x1024[Depth]; 566 } 567 } 568 if(CustomT == CUT_PANEL848) { 569 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth]; 570 } 571 break; 572 case 1400: 573 if(VGAEngine == SIS_315_VGA) { 574 if(VDisplay == 1050) ModeIndex = ModeIndex_1400x1050[Depth]; 575 } 576 break; 577 case 1600: 578 if(VGAEngine == SIS_315_VGA) { 579 if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth]; 580 } 581 break; 582 } 583 584 } else if(VBFlags2 & VB2_SISBRIDGE) { 585 586 switch(HDisplay) 587 { 588 case 320: 589 if(VDisplay == 200) ModeIndex = ModeIndex_320x200[Depth]; 590 else if(VDisplay == 240) ModeIndex = ModeIndex_320x240[Depth]; 591 break; 592 case 400: 593 if(LCDwidth >= 800 && LCDheight >= 600) { 594 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth]; 595 } 596 break; 597 case 512: 598 if(LCDwidth >= 1024 && LCDheight >= 768 && LCDwidth != 1152) { 599 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth]; 600 } 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) { 608 if(VDisplay == 480) ModeIndex = ModeIndex_720x480[Depth]; 609 else if(VDisplay == 576) ModeIndex = ModeIndex_720x576[Depth]; 610 } 611 break; 612 case 768: 613 if(VGAEngine == SIS_315_VGA) { 614 if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth]; 615 } 616 break; 617 case 800: 618 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth]; 619 if(VGAEngine == SIS_315_VGA) { 620 if(VDisplay == 480) ModeIndex = ModeIndex_800x480[Depth]; 621 } 622 break; 623 case 848: 624 if(VGAEngine == SIS_315_VGA) { 625 if(VDisplay == 480) ModeIndex = ModeIndex_848x480[Depth]; 626 } 627 break; 628 case 856: 629 if(VGAEngine == SIS_315_VGA) { 630 if(VDisplay == 480) ModeIndex = ModeIndex_856x480[Depth]; 631 } 632 break; 633 case 960: 634 if(VGAEngine == SIS_315_VGA) { 635 if(VDisplay == 540) ModeIndex = ModeIndex_960x540[Depth]; 636 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) { 642 if(VDisplay == 576) ModeIndex = ModeIndex_1024x576[Depth]; 643 } 644 break; 645 case 1152: 646 if(VGAEngine == SIS_315_VGA) { 647 if(VDisplay == 864) ModeIndex = ModeIndex_1152x864[Depth]; 648 } 649 break; 650 case 1280: 651 switch(VDisplay) { 652 case 720: 653 ModeIndex = ModeIndex_1280x720[Depth]; 654 break; 655 case 768: 656 if(VGAEngine == SIS_300_VGA) { 657 ModeIndex = ModeIndex_300_1280x768[Depth]; 658 } else { 659 ModeIndex = ModeIndex_310_1280x768[Depth]; 660 } 661 break; 662 case 800: 663 if(VGAEngine == SIS_315_VGA) { 664 ModeIndex = ModeIndex_1280x800[Depth]; 665 } 666 break; 667 case 854: 668 if(VGAEngine == SIS_315_VGA) { 669 ModeIndex = ModeIndex_1280x854[Depth]; 670 } 671 break; 672 case 960: 673 ModeIndex = ModeIndex_1280x960[Depth]; 674 break; 675 case 1024: 676 ModeIndex = ModeIndex_1280x1024[Depth]; 677 break; 678 } 679 break; 680 case 1360: 681 if(VGAEngine == SIS_315_VGA) { /* OVER1280 only? */ 682 if(VDisplay == 768) ModeIndex = ModeIndex_1360x768[Depth]; 683 } 684 break; 685 case 1400: 686 if(VGAEngine == SIS_315_VGA) { 687 if(VBFlags2 & VB2_LCDOVER1280BRIDGE) { 688 if(VDisplay == 1050) ModeIndex = ModeIndex_1400x1050[Depth]; 689 } 690 } 691 break; 692 case 1600: 693 if(VGAEngine == SIS_315_VGA) { 694 if(VBFlags2 & VB2_LCDOVER1280BRIDGE) { 695 if(VDisplay == 1200) ModeIndex = ModeIndex_1600x1200[Depth]; 696 } 697 } 698 break; 699 #ifndef VB_FORBID_CRT2LCD_OVER_1600 700 case 1680: 701 if(VGAEngine == SIS_315_VGA) { 702 if(VBFlags2 & VB2_LCDOVER1280BRIDGE) { 703 if(VDisplay == 1050) ModeIndex = ModeIndex_1680x1050[Depth]; 704 } 705 } 706 break; 707 case 1920: 708 if(VGAEngine == SIS_315_VGA) { 709 if(VBFlags2 & VB2_LCDOVER1600BRIDGE) { 710 if(VDisplay == 1440) ModeIndex = ModeIndex_1920x1440[Depth]; 711 } 712 } 713 break; 714 case 2048: 715 if(VGAEngine == SIS_315_VGA) { 716 if(VBFlags2 & VB2_LCDOVER1600BRIDGE) { 717 if(VDisplay == 1536) ModeIndex = ModeIndex_310_2048x1536[Depth]; 718 } 719 } 720 break; 721 #endif 722 } 723 } 724 725 return ModeIndex; 726 } 727 728 unsigned short 729 SiS_GetModeID_TV(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay, int Depth, 730 unsigned int VBFlags2) 731 { 732 unsigned short ModeIndex = 0; 733 734 if(VBFlags2 & VB2_CHRONTEL) { 735 736 switch(HDisplay) 737 { 738 case 512: 739 if(VGAEngine == SIS_315_VGA) { 740 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth]; 741 } 742 break; 743 case 640: 744 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth]; 745 else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth]; 746 break; 747 case 800: 748 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth]; 749 break; 750 case 1024: 751 if(VGAEngine == SIS_315_VGA) { 752 if(VDisplay == 768) ModeIndex = ModeIndex_1024x768[Depth]; 753 } 754 break; 755 } 756 757 } else if(VBFlags2 & VB2_SISTVBRIDGE) { 758 759 switch(HDisplay) 760 { 761 case 320: 762 if(VDisplay == 200) ModeIndex = ModeIndex_320x200[Depth]; 763 else if(VDisplay == 240) ModeIndex = ModeIndex_320x240[Depth]; 764 break; 765 case 400: 766 if(VDisplay == 300) ModeIndex = ModeIndex_400x300[Depth]; 767 break; 768 case 512: 769 if( ((VBFlags & TV_YPBPR) && (VBFlags & (TV_YPBPR750P | TV_YPBPR1080I))) || 770 (VBFlags & TV_HIVISION) || 771 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) ) { 772 if(VDisplay == 384) ModeIndex = ModeIndex_512x384[Depth]; 773 } 774 break; 775 case 640: 776 if(VDisplay == 480) ModeIndex = ModeIndex_640x480[Depth]; 777 else if(VDisplay == 400) ModeIndex = ModeIndex_640x400[Depth]; 778 break; 779 case 720: 780 if((!(VBFlags & TV_HIVISION)) && (!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)))) { 781 if(VDisplay == 480) { 782 ModeIndex = ModeIndex_720x480[Depth]; 783 } else if(VDisplay == 576) { 784 if( ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P)) || 785 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) ) 786 ModeIndex = ModeIndex_720x576[Depth]; 787 } 788 } 789 break; 790 case 768: 791 if((!(VBFlags & TV_HIVISION)) && (!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)))) { 792 if( ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P)) || 793 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL)) ) { 794 if(VDisplay == 576) ModeIndex = ModeIndex_768x576[Depth]; 795 } 796 } 797 break; 798 case 800: 799 if(VDisplay == 600) ModeIndex = ModeIndex_800x600[Depth]; 800 else if(VDisplay == 480) { 801 if(!((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR750P))) { 802 ModeIndex = ModeIndex_800x480[Depth]; 803 } 804 } 805 break; 806 case 960: 807 if(VGAEngine == SIS_315_VGA) { 808 if(VDisplay == 600) { 809 if((VBFlags & TV_HIVISION) || ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) { 810 ModeIndex = ModeIndex_960x600[Depth]; 811 } 812 } 813 } 814 break; 815 case 1024: 816 if(VDisplay == 768) { 817 if(VBFlags2 & VB2_30xBLV) { 818 ModeIndex = ModeIndex_1024x768[Depth]; 819 } 820 } else if(VDisplay == 576) { 821 if( (VBFlags & TV_HIVISION) || 822 ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I)) || 823 ((VBFlags2 & VB2_30xBLV) && 824 ((!(VBFlags & (TV_YPBPR | TV_PALM))) && (VBFlags & TV_PAL))) ) { 825 ModeIndex = ModeIndex_1024x576[Depth]; 826 } 827 } 828 break; 829 case 1280: 830 if(VDisplay == 720) { 831 if((VBFlags & TV_HIVISION) || 832 ((VBFlags & TV_YPBPR) && (VBFlags & (TV_YPBPR1080I | TV_YPBPR750P)))) { 833 ModeIndex = ModeIndex_1280x720[Depth]; 834 } 835 } else if(VDisplay == 1024) { 836 if((VBFlags & TV_HIVISION) || 837 ((VBFlags & TV_YPBPR) && (VBFlags & TV_YPBPR1080I))) { 838 ModeIndex = ModeIndex_1280x1024[Depth]; 839 } 840 } 841 break; 842 } 843 } 844 return ModeIndex; 845 } 846 847 unsigned short 848 SiS_GetModeID_VGA2(int VGAEngine, unsigned int VBFlags, int HDisplay, int VDisplay, int Depth, 849 unsigned int VBFlags2) 850 { 851 if(!(VBFlags2 & VB2_SISVGA2BRIDGE)) return 0; 852 853 if(HDisplay >= 1920) return 0; 854 855 switch(HDisplay) 856 { 857 case 1600: 858 if(VDisplay == 1200) { 859 if(VGAEngine != SIS_315_VGA) return 0; 860 if(!(VBFlags2 & VB2_30xB)) return 0; 861 } 862 break; 863 case 1680: 864 if(VDisplay == 1050) { 865 if(VGAEngine != SIS_315_VGA) return 0; 866 if(!(VBFlags2 & VB2_30xB)) return 0; 867 } 868 break; 869 } 870 871 return SiS_GetModeID(VGAEngine, 0, HDisplay, VDisplay, Depth, false, 0, 0); 872 } 873 874 875 /*********************************************/ 876 /* HELPER: SetReg, GetReg */ 877 /*********************************************/ 878 879 void 880 SiS_SetReg(SISIOADDRESS port, u8 index, u8 data) 881 { 882 outb(index, port); 883 outb(data, port + 1); 884 } 885 886 void 887 SiS_SetRegByte(SISIOADDRESS port, u8 data) 888 { 889 outb(data, port); 890 } 891 892 void 893 SiS_SetRegShort(SISIOADDRESS port, u16 data) 894 { 895 outw(data, port); 896 } 897 898 void 899 SiS_SetRegLong(SISIOADDRESS port, u32 data) 900 { 901 outl(data, port); 902 } 903 904 u8 905 SiS_GetReg(SISIOADDRESS port, u8 index) 906 { 907 outb(index, port); 908 return inb(port + 1); 909 } 910 911 u8 912 SiS_GetRegByte(SISIOADDRESS port) 913 { 914 return inb(port); 915 } 916 917 u16 918 SiS_GetRegShort(SISIOADDRESS port) 919 { 920 return inw(port); 921 } 922 923 u32 924 SiS_GetRegLong(SISIOADDRESS port) 925 { 926 return inl(port); 927 } 928 929 void 930 SiS_SetRegANDOR(SISIOADDRESS Port, u8 Index, u8 DataAND, u8 DataOR) 931 { 932 u8 temp; 933 934 temp = SiS_GetReg(Port, Index); 935 temp = (temp & (DataAND)) | DataOR; 936 SiS_SetReg(Port, Index, temp); 937 } 938 939 void 940 SiS_SetRegAND(SISIOADDRESS Port, u8 Index, u8 DataAND) 941 { 942 u8 temp; 943 944 temp = SiS_GetReg(Port, Index); 945 temp &= DataAND; 946 SiS_SetReg(Port, Index, temp); 947 } 948 949 void 950 SiS_SetRegOR(SISIOADDRESS Port, u8 Index, u8 DataOR) 951 { 952 u8 temp; 953 954 temp = SiS_GetReg(Port, Index); 955 temp |= DataOR; 956 SiS_SetReg(Port, Index, temp); 957 } 958 959 /*********************************************/ 960 /* HELPER: DisplayOn, DisplayOff */ 961 /*********************************************/ 962 963 void 964 SiS_DisplayOn(struct SiS_Private *SiS_Pr) 965 { 966 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x01,0xDF); 967 } 968 969 void 970 SiS_DisplayOff(struct SiS_Private *SiS_Pr) 971 { 972 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x01,0x20); 973 } 974 975 976 /*********************************************/ 977 /* HELPER: Init Port Addresses */ 978 /*********************************************/ 979 980 void 981 SiSRegInit(struct SiS_Private *SiS_Pr, SISIOADDRESS BaseAddr) 982 { 983 SiS_Pr->SiS_P3c4 = BaseAddr + 0x14; 984 SiS_Pr->SiS_P3d4 = BaseAddr + 0x24; 985 SiS_Pr->SiS_P3c0 = BaseAddr + 0x10; 986 SiS_Pr->SiS_P3ce = BaseAddr + 0x1e; 987 SiS_Pr->SiS_P3c2 = BaseAddr + 0x12; 988 SiS_Pr->SiS_P3ca = BaseAddr + 0x1a; 989 SiS_Pr->SiS_P3c6 = BaseAddr + 0x16; 990 SiS_Pr->SiS_P3c7 = BaseAddr + 0x17; 991 SiS_Pr->SiS_P3c8 = BaseAddr + 0x18; 992 SiS_Pr->SiS_P3c9 = BaseAddr + 0x19; 993 SiS_Pr->SiS_P3cb = BaseAddr + 0x1b; 994 SiS_Pr->SiS_P3cc = BaseAddr + 0x1c; 995 SiS_Pr->SiS_P3cd = BaseAddr + 0x1d; 996 SiS_Pr->SiS_P3da = BaseAddr + 0x2a; 997 SiS_Pr->SiS_Part1Port = BaseAddr + SIS_CRT2_PORT_04; 998 SiS_Pr->SiS_Part2Port = BaseAddr + SIS_CRT2_PORT_10; 999 SiS_Pr->SiS_Part3Port = BaseAddr + SIS_CRT2_PORT_12; 1000 SiS_Pr->SiS_Part4Port = BaseAddr + SIS_CRT2_PORT_14; 1001 SiS_Pr->SiS_Part5Port = BaseAddr + SIS_CRT2_PORT_14 + 2; 1002 SiS_Pr->SiS_DDC_Port = BaseAddr + 0x14; 1003 SiS_Pr->SiS_VidCapt = BaseAddr + SIS_VIDEO_CAPTURE; 1004 SiS_Pr->SiS_VidPlay = BaseAddr + SIS_VIDEO_PLAYBACK; 1005 } 1006 1007 /*********************************************/ 1008 /* HELPER: GetSysFlags */ 1009 /*********************************************/ 1010 1011 static void 1012 SiS_GetSysFlags(struct SiS_Private *SiS_Pr) 1013 { 1014 unsigned char cr5f, temp1, temp2; 1015 1016 /* 661 and newer: NEVER write non-zero to SR11[7:4] */ 1017 /* (SR11 is used for DDC and in enable/disablebridge) */ 1018 SiS_Pr->SiS_SensibleSR11 = false; 1019 SiS_Pr->SiS_MyCR63 = 0x63; 1020 if(SiS_Pr->ChipType >= SIS_330) { 1021 SiS_Pr->SiS_MyCR63 = 0x53; 1022 if(SiS_Pr->ChipType >= SIS_661) { 1023 SiS_Pr->SiS_SensibleSR11 = true; 1024 } 1025 } 1026 1027 /* You should use the macros, not these flags directly */ 1028 1029 SiS_Pr->SiS_SysFlags = 0; 1030 if(SiS_Pr->ChipType == SIS_650) { 1031 cr5f = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xf0; 1032 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x5c,0x07); 1033 temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8; 1034 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x5c,0xf8); 1035 temp2 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8; 1036 if((!temp1) || (temp2)) { 1037 switch(cr5f) { 1038 case 0x80: 1039 case 0x90: 1040 case 0xc0: 1041 SiS_Pr->SiS_SysFlags |= SF_IsM650; 1042 break; 1043 case 0xa0: 1044 case 0xb0: 1045 case 0xe0: 1046 SiS_Pr->SiS_SysFlags |= SF_Is651; 1047 break; 1048 } 1049 } else { 1050 switch(cr5f) { 1051 case 0x90: 1052 temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5c) & 0xf8; 1053 switch(temp1) { 1054 case 0x00: SiS_Pr->SiS_SysFlags |= SF_IsM652; break; 1055 case 0x40: SiS_Pr->SiS_SysFlags |= SF_IsM653; break; 1056 default: SiS_Pr->SiS_SysFlags |= SF_IsM650; break; 1057 } 1058 break; 1059 case 0xb0: 1060 SiS_Pr->SiS_SysFlags |= SF_Is652; 1061 break; 1062 default: 1063 SiS_Pr->SiS_SysFlags |= SF_IsM650; 1064 break; 1065 } 1066 } 1067 } 1068 1069 if(SiS_Pr->ChipType >= SIS_760 && SiS_Pr->ChipType <= SIS_761) { 1070 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0x30) { 1071 SiS_Pr->SiS_SysFlags |= SF_760LFB; 1072 } 1073 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x79) & 0xf0) { 1074 SiS_Pr->SiS_SysFlags |= SF_760UMA; 1075 } 1076 } 1077 } 1078 1079 /*********************************************/ 1080 /* HELPER: Init PCI & Engines */ 1081 /*********************************************/ 1082 1083 static void 1084 SiSInitPCIetc(struct SiS_Private *SiS_Pr) 1085 { 1086 switch(SiS_Pr->ChipType) { 1087 #ifdef CONFIG_FB_SIS_300 1088 case SIS_300: 1089 case SIS_540: 1090 case SIS_630: 1091 case SIS_730: 1092 /* Set - PCI LINEAR ADDRESSING ENABLE (0x80) 1093 * - RELOCATED VGA IO ENABLED (0x20) 1094 * - MMIO ENABLED (0x01) 1095 * Leave other bits untouched. 1096 */ 1097 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x20,0xa1); 1098 /* - Enable 2D (0x40) 1099 * - Enable 3D (0x02) 1100 * - Enable 3D Vertex command fetch (0x10) ? 1101 * - Enable 3D command parser (0x08) ? 1102 */ 1103 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x5A); 1104 break; 1105 #endif 1106 #ifdef CONFIG_FB_SIS_315 1107 case SIS_315H: 1108 case SIS_315: 1109 case SIS_315PRO: 1110 case SIS_650: 1111 case SIS_740: 1112 case SIS_330: 1113 case SIS_661: 1114 case SIS_741: 1115 case SIS_660: 1116 case SIS_760: 1117 case SIS_761: 1118 case SIS_340: 1119 case XGI_40: 1120 /* See above */ 1121 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x20,0xa1); 1122 /* - Enable 3D G/L transformation engine (0x80) 1123 * - Enable 2D (0x40) 1124 * - Enable 3D vertex command fetch (0x10) 1125 * - Enable 3D command parser (0x08) 1126 * - Enable 3D (0x02) 1127 */ 1128 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0xDA); 1129 break; 1130 case XGI_20: 1131 case SIS_550: 1132 /* See above */ 1133 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x20,0xa1); 1134 /* No 3D engine ! */ 1135 /* - Enable 2D (0x40) 1136 * - disable 3D 1137 */ 1138 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x1E,0x60,0x40); 1139 break; 1140 #endif 1141 default: 1142 break; 1143 } 1144 } 1145 1146 /*********************************************/ 1147 /* HELPER: SetLVDSetc */ 1148 /*********************************************/ 1149 1150 static 1151 void 1152 SiSSetLVDSetc(struct SiS_Private *SiS_Pr) 1153 { 1154 unsigned short temp; 1155 1156 SiS_Pr->SiS_IF_DEF_LVDS = 0; 1157 SiS_Pr->SiS_IF_DEF_TRUMPION = 0; 1158 SiS_Pr->SiS_IF_DEF_CH70xx = 0; 1159 SiS_Pr->SiS_IF_DEF_CONEX = 0; 1160 1161 SiS_Pr->SiS_ChrontelInit = 0; 1162 1163 if(SiS_Pr->ChipType == XGI_20) return; 1164 1165 /* Check for SiS30x first */ 1166 temp = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00); 1167 if((temp == 1) || (temp == 2)) return; 1168 1169 switch(SiS_Pr->ChipType) { 1170 #ifdef CONFIG_FB_SIS_300 1171 case SIS_540: 1172 case SIS_630: 1173 case SIS_730: 1174 temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x37) & 0x0e) >> 1; 1175 if((temp >= 2) && (temp <= 5)) SiS_Pr->SiS_IF_DEF_LVDS = 1; 1176 if(temp == 3) SiS_Pr->SiS_IF_DEF_TRUMPION = 1; 1177 if((temp == 4) || (temp == 5)) { 1178 /* Save power status (and error check) - UNUSED */ 1179 SiS_Pr->SiS_Backup70xx = SiS_GetCH700x(SiS_Pr, 0x0e); 1180 SiS_Pr->SiS_IF_DEF_CH70xx = 1; 1181 } 1182 break; 1183 #endif 1184 #ifdef CONFIG_FB_SIS_315 1185 case SIS_550: 1186 case SIS_650: 1187 case SIS_740: 1188 case SIS_330: 1189 temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x37) & 0x0e) >> 1; 1190 if((temp >= 2) && (temp <= 3)) SiS_Pr->SiS_IF_DEF_LVDS = 1; 1191 if(temp == 3) SiS_Pr->SiS_IF_DEF_CH70xx = 2; 1192 break; 1193 case SIS_661: 1194 case SIS_741: 1195 case SIS_660: 1196 case SIS_760: 1197 case SIS_761: 1198 case SIS_340: 1199 case XGI_20: 1200 case XGI_40: 1201 temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & 0xe0) >> 5; 1202 if((temp >= 2) && (temp <= 3)) SiS_Pr->SiS_IF_DEF_LVDS = 1; 1203 if(temp == 3) SiS_Pr->SiS_IF_DEF_CH70xx = 2; 1204 if(temp == 4) SiS_Pr->SiS_IF_DEF_CONEX = 1; /* Not yet supported */ 1205 break; 1206 #endif 1207 default: 1208 break; 1209 } 1210 } 1211 1212 /*********************************************/ 1213 /* HELPER: Enable DSTN/FSTN */ 1214 /*********************************************/ 1215 1216 void 1217 SiS_SetEnableDstn(struct SiS_Private *SiS_Pr, int enable) 1218 { 1219 SiS_Pr->SiS_IF_DEF_DSTN = enable ? 1 : 0; 1220 } 1221 1222 void 1223 SiS_SetEnableFstn(struct SiS_Private *SiS_Pr, int enable) 1224 { 1225 SiS_Pr->SiS_IF_DEF_FSTN = enable ? 1 : 0; 1226 } 1227 1228 /*********************************************/ 1229 /* HELPER: Get modeflag */ 1230 /*********************************************/ 1231 1232 unsigned short 1233 SiS_GetModeFlag(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 1234 unsigned short ModeIdIndex) 1235 { 1236 if(SiS_Pr->UseCustomMode) { 1237 return SiS_Pr->CModeFlag; 1238 } else if(ModeNo <= 0x13) { 1239 return SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; 1240 } else { 1241 return SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; 1242 } 1243 } 1244 1245 /*********************************************/ 1246 /* HELPER: Determine ROM usage */ 1247 /*********************************************/ 1248 1249 bool 1250 SiSDetermineROMLayout661(struct SiS_Private *SiS_Pr) 1251 { 1252 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; 1253 unsigned short romversoffs, romvmaj = 1, romvmin = 0; 1254 1255 if(SiS_Pr->ChipType >= XGI_20) { 1256 /* XGI ROMs don't qualify */ 1257 return false; 1258 } else if(SiS_Pr->ChipType >= SIS_761) { 1259 /* I very much assume 761, 340 and newer will use new layout */ 1260 return true; 1261 } else if(SiS_Pr->ChipType >= SIS_661) { 1262 if((ROMAddr[0x1a] == 'N') && 1263 (ROMAddr[0x1b] == 'e') && 1264 (ROMAddr[0x1c] == 'w') && 1265 (ROMAddr[0x1d] == 'V')) { 1266 return true; 1267 } 1268 romversoffs = ROMAddr[0x16] | (ROMAddr[0x17] << 8); 1269 if(romversoffs) { 1270 if((ROMAddr[romversoffs+1] == '.') || (ROMAddr[romversoffs+4] == '.')) { 1271 romvmaj = ROMAddr[romversoffs] - '0'; 1272 romvmin = ((ROMAddr[romversoffs+2] -'0') * 10) + (ROMAddr[romversoffs+3] - '0'); 1273 } 1274 } 1275 if((romvmaj != 0) || (romvmin >= 92)) { 1276 return true; 1277 } 1278 } else if(IS_SIS650740) { 1279 if((ROMAddr[0x1a] == 'N') && 1280 (ROMAddr[0x1b] == 'e') && 1281 (ROMAddr[0x1c] == 'w') && 1282 (ROMAddr[0x1d] == 'V')) { 1283 return true; 1284 } 1285 } 1286 return false; 1287 } 1288 1289 static void 1290 SiSDetermineROMUsage(struct SiS_Private *SiS_Pr) 1291 { 1292 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; 1293 unsigned short romptr = 0; 1294 1295 SiS_Pr->SiS_UseROM = false; 1296 SiS_Pr->SiS_ROMNew = false; 1297 SiS_Pr->SiS_PWDOffset = 0; 1298 1299 if(SiS_Pr->ChipType >= XGI_20) return; 1300 1301 if((ROMAddr) && (SiS_Pr->UseROM)) { 1302 if(SiS_Pr->ChipType == SIS_300) { 1303 /* 300: We check if the code starts below 0x220 by 1304 * checking the jmp instruction at the beginning 1305 * of the BIOS image. 1306 */ 1307 if((ROMAddr[3] == 0xe9) && ((ROMAddr[5] << 8) | ROMAddr[4]) > 0x21a) 1308 SiS_Pr->SiS_UseROM = true; 1309 } else if(SiS_Pr->ChipType < SIS_315H) { 1310 /* Sony's VAIO BIOS 1.09 follows the standard, so perhaps 1311 * the others do as well 1312 */ 1313 SiS_Pr->SiS_UseROM = true; 1314 } else { 1315 /* 315/330 series stick to the standard(s) */ 1316 SiS_Pr->SiS_UseROM = true; 1317 if((SiS_Pr->SiS_ROMNew = SiSDetermineROMLayout661(SiS_Pr))) { 1318 SiS_Pr->SiS_EMIOffset = 14; 1319 SiS_Pr->SiS_PWDOffset = 17; 1320 SiS_Pr->SiS661LCD2TableSize = 36; 1321 /* Find out about LCD data table entry size */ 1322 if((romptr = SISGETROMW(0x0102))) { 1323 if(ROMAddr[romptr + (32 * 16)] == 0xff) 1324 SiS_Pr->SiS661LCD2TableSize = 32; 1325 else if(ROMAddr[romptr + (34 * 16)] == 0xff) 1326 SiS_Pr->SiS661LCD2TableSize = 34; 1327 else if(ROMAddr[romptr + (36 * 16)] == 0xff) /* 0.94, 2.05.00+ */ 1328 SiS_Pr->SiS661LCD2TableSize = 36; 1329 else if( (ROMAddr[romptr + (38 * 16)] == 0xff) || /* 2.00.00 - 2.02.00 */ 1330 (ROMAddr[0x6F] & 0x01) ) { /* 2.03.00 - <2.05.00 */ 1331 SiS_Pr->SiS661LCD2TableSize = 38; /* UMC data layout abandoned at 2.05.00 */ 1332 SiS_Pr->SiS_EMIOffset = 16; 1333 SiS_Pr->SiS_PWDOffset = 19; 1334 } 1335 } 1336 } 1337 } 1338 } 1339 } 1340 1341 /*********************************************/ 1342 /* HELPER: SET SEGMENT REGISTERS */ 1343 /*********************************************/ 1344 1345 static void 1346 SiS_SetSegRegLower(struct SiS_Private *SiS_Pr, unsigned short value) 1347 { 1348 unsigned short temp; 1349 1350 value &= 0x00ff; 1351 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cb) & 0xf0; 1352 temp |= (value >> 4); 1353 SiS_SetRegByte(SiS_Pr->SiS_P3cb, temp); 1354 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cd) & 0xf0; 1355 temp |= (value & 0x0f); 1356 SiS_SetRegByte(SiS_Pr->SiS_P3cd, temp); 1357 } 1358 1359 static void 1360 SiS_SetSegRegUpper(struct SiS_Private *SiS_Pr, unsigned short value) 1361 { 1362 unsigned short temp; 1363 1364 value &= 0x00ff; 1365 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cb) & 0x0f; 1366 temp |= (value & 0xf0); 1367 SiS_SetRegByte(SiS_Pr->SiS_P3cb, temp); 1368 temp = SiS_GetRegByte(SiS_Pr->SiS_P3cd) & 0x0f; 1369 temp |= (value << 4); 1370 SiS_SetRegByte(SiS_Pr->SiS_P3cd, temp); 1371 } 1372 1373 static void 1374 SiS_SetSegmentReg(struct SiS_Private *SiS_Pr, unsigned short value) 1375 { 1376 SiS_SetSegRegLower(SiS_Pr, value); 1377 SiS_SetSegRegUpper(SiS_Pr, value); 1378 } 1379 1380 static void 1381 SiS_ResetSegmentReg(struct SiS_Private *SiS_Pr) 1382 { 1383 SiS_SetSegmentReg(SiS_Pr, 0); 1384 } 1385 1386 static void 1387 SiS_SetSegmentRegOver(struct SiS_Private *SiS_Pr, unsigned short value) 1388 { 1389 unsigned short temp = value >> 8; 1390 1391 temp &= 0x07; 1392 temp |= (temp << 4); 1393 SiS_SetReg(SiS_Pr->SiS_P3c4,0x1d,temp); 1394 SiS_SetSegmentReg(SiS_Pr, value); 1395 } 1396 1397 static void 1398 SiS_ResetSegmentRegOver(struct SiS_Private *SiS_Pr) 1399 { 1400 SiS_SetSegmentRegOver(SiS_Pr, 0); 1401 } 1402 1403 static void 1404 SiS_ResetSegmentRegisters(struct SiS_Private *SiS_Pr) 1405 { 1406 if((IS_SIS65x) || (SiS_Pr->ChipType >= SIS_661)) { 1407 SiS_ResetSegmentReg(SiS_Pr); 1408 SiS_ResetSegmentRegOver(SiS_Pr); 1409 } 1410 } 1411 1412 /*********************************************/ 1413 /* HELPER: GetVBType */ 1414 /*********************************************/ 1415 1416 static 1417 void 1418 SiS_GetVBType(struct SiS_Private *SiS_Pr) 1419 { 1420 unsigned short flag = 0, rev = 0, nolcd = 0; 1421 unsigned short p4_0f, p4_25, p4_27; 1422 1423 SiS_Pr->SiS_VBType = 0; 1424 1425 if((SiS_Pr->SiS_IF_DEF_LVDS) || (SiS_Pr->SiS_IF_DEF_CONEX)) 1426 return; 1427 1428 if(SiS_Pr->ChipType == XGI_20) 1429 return; 1430 1431 flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00); 1432 1433 if(flag > 3) 1434 return; 1435 1436 rev = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x01); 1437 1438 if(flag >= 2) { 1439 SiS_Pr->SiS_VBType = VB_SIS302B; 1440 } else if(flag == 1) { 1441 if(rev >= 0xC0) { 1442 SiS_Pr->SiS_VBType = VB_SIS301C; 1443 } else if(rev >= 0xB0) { 1444 SiS_Pr->SiS_VBType = VB_SIS301B; 1445 /* Check if 30xB DH version (no LCD support, use Panel Link instead) */ 1446 nolcd = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x23); 1447 if(!(nolcd & 0x02)) SiS_Pr->SiS_VBType |= VB_NoLCD; 1448 } else { 1449 SiS_Pr->SiS_VBType = VB_SIS301; 1450 } 1451 } 1452 if(SiS_Pr->SiS_VBType & (VB_SIS301B | VB_SIS301C | VB_SIS302B)) { 1453 if(rev >= 0xE0) { 1454 flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x39); 1455 if(flag == 0xff) SiS_Pr->SiS_VBType = VB_SIS302LV; 1456 else SiS_Pr->SiS_VBType = VB_SIS301C; /* VB_SIS302ELV; */ 1457 } else if(rev >= 0xD0) { 1458 SiS_Pr->SiS_VBType = VB_SIS301LV; 1459 } 1460 } 1461 if(SiS_Pr->SiS_VBType & (VB_SIS301C | VB_SIS301LV | VB_SIS302LV | VB_SIS302ELV)) { 1462 p4_0f = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x0f); 1463 p4_25 = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x25); 1464 p4_27 = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x27); 1465 SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x0f,0x7f); 1466 SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x25,0x08); 1467 SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x27,0xfd); 1468 if(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x08) { 1469 SiS_Pr->SiS_VBType |= VB_UMC; 1470 } 1471 SiS_SetReg(SiS_Pr->SiS_Part4Port,0x27,p4_27); 1472 SiS_SetReg(SiS_Pr->SiS_Part4Port,0x25,p4_25); 1473 SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0f,p4_0f); 1474 } 1475 } 1476 1477 /*********************************************/ 1478 /* HELPER: Check RAM size */ 1479 /*********************************************/ 1480 1481 static bool 1482 SiS_CheckMemorySize(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 1483 unsigned short ModeIdIndex) 1484 { 1485 unsigned short AdapterMemSize = SiS_Pr->VideoMemorySize / (1024*1024); 1486 unsigned short modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); 1487 unsigned short memorysize = ((modeflag & MemoryInfoFlag) >> MemorySizeShift) + 1; 1488 1489 if(!AdapterMemSize) return true; 1490 1491 if(AdapterMemSize < memorysize) return false; 1492 return true; 1493 } 1494 1495 /*********************************************/ 1496 /* HELPER: Get DRAM type */ 1497 /*********************************************/ 1498 1499 #ifdef CONFIG_FB_SIS_315 1500 static unsigned char 1501 SiS_Get310DRAMType(struct SiS_Private *SiS_Pr) 1502 { 1503 unsigned char data; 1504 1505 if((*SiS_Pr->pSiS_SoftSetting) & SoftDRAMType) { 1506 data = (*SiS_Pr->pSiS_SoftSetting) & 0x03; 1507 } else { 1508 if(SiS_Pr->ChipType >= XGI_20) { 1509 /* Do I need this? SR17 seems to be zero anyway... */ 1510 data = 0; 1511 } else if(SiS_Pr->ChipType >= SIS_340) { 1512 /* TODO */ 1513 data = 0; 1514 } else if(SiS_Pr->ChipType >= SIS_661) { 1515 if(SiS_Pr->SiS_ROMNew) { 1516 data = ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0xc0) >> 6); 1517 } else { 1518 data = SiS_GetReg(SiS_Pr->SiS_P3d4,0x78) & 0x07; 1519 } 1520 } else if(IS_SIS550650740) { 1521 data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x07; 1522 } else { /* 315, 330 */ 1523 data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3a) & 0x03; 1524 if(SiS_Pr->ChipType == SIS_330) { 1525 if(data > 1) { 1526 switch(SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0x30) { 1527 case 0x00: data = 1; break; 1528 case 0x10: data = 3; break; 1529 case 0x20: data = 3; break; 1530 case 0x30: data = 2; break; 1531 } 1532 } else { 1533 data = 0; 1534 } 1535 } 1536 } 1537 } 1538 1539 return data; 1540 } 1541 1542 static unsigned short 1543 SiS_GetMCLK(struct SiS_Private *SiS_Pr) 1544 { 1545 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; 1546 unsigned short index; 1547 1548 index = SiS_Get310DRAMType(SiS_Pr); 1549 if(SiS_Pr->ChipType >= SIS_661) { 1550 if(SiS_Pr->SiS_ROMNew) { 1551 return((unsigned short)(SISGETROMW((0x90 + (index * 5) + 3)))); 1552 } 1553 return(SiS_Pr->SiS_MCLKData_0[index].CLOCK); 1554 } else if(index >= 4) { 1555 return(SiS_Pr->SiS_MCLKData_1[index - 4].CLOCK); 1556 } else { 1557 return(SiS_Pr->SiS_MCLKData_0[index].CLOCK); 1558 } 1559 } 1560 #endif 1561 1562 /*********************************************/ 1563 /* HELPER: ClearBuffer */ 1564 /*********************************************/ 1565 1566 static void 1567 SiS_ClearBuffer(struct SiS_Private *SiS_Pr, unsigned short ModeNo) 1568 { 1569 unsigned char SISIOMEMTYPE *memaddr = SiS_Pr->VideoMemoryAddress; 1570 unsigned int memsize = SiS_Pr->VideoMemorySize; 1571 unsigned short SISIOMEMTYPE *pBuffer; 1572 int i; 1573 1574 if(!memaddr || !memsize) return; 1575 1576 if(SiS_Pr->SiS_ModeType >= ModeEGA) { 1577 if(ModeNo > 0x13) { 1578 memset_io(memaddr, 0, memsize); 1579 } else { 1580 pBuffer = (unsigned short SISIOMEMTYPE *)memaddr; 1581 for(i = 0; i < 0x4000; i++) writew(0x0000, &pBuffer[i]); 1582 } 1583 } else if(SiS_Pr->SiS_ModeType < ModeCGA) { 1584 pBuffer = (unsigned short SISIOMEMTYPE *)memaddr; 1585 for(i = 0; i < 0x4000; i++) writew(0x0720, &pBuffer[i]); 1586 } else { 1587 memset_io(memaddr, 0, 0x8000); 1588 } 1589 } 1590 1591 /*********************************************/ 1592 /* HELPER: SearchModeID */ 1593 /*********************************************/ 1594 1595 bool 1596 SiS_SearchModeID(struct SiS_Private *SiS_Pr, unsigned short *ModeNo, 1597 unsigned short *ModeIdIndex) 1598 { 1599 unsigned char VGAINFO = SiS_Pr->SiS_VGAINFO; 1600 1601 if((*ModeNo) <= 0x13) { 1602 1603 if((*ModeNo) <= 0x05) (*ModeNo) |= 0x01; 1604 1605 for((*ModeIdIndex) = 0; ;(*ModeIdIndex)++) { 1606 if(SiS_Pr->SiS_SModeIDTable[(*ModeIdIndex)].St_ModeID == (*ModeNo)) break; 1607 if(SiS_Pr->SiS_SModeIDTable[(*ModeIdIndex)].St_ModeID == 0xFF) return false; 1608 } 1609 1610 if((*ModeNo) == 0x07) { 1611 if(VGAINFO & 0x10) (*ModeIdIndex)++; /* 400 lines */ 1612 /* else 350 lines */ 1613 } 1614 if((*ModeNo) <= 0x03) { 1615 if(!(VGAINFO & 0x80)) (*ModeIdIndex)++; 1616 if(VGAINFO & 0x10) (*ModeIdIndex)++; /* 400 lines */ 1617 /* else 350 lines */ 1618 } 1619 /* else 200 lines */ 1620 1621 } else { 1622 1623 for((*ModeIdIndex) = 0; ;(*ModeIdIndex)++) { 1624 if(SiS_Pr->SiS_EModeIDTable[(*ModeIdIndex)].Ext_ModeID == (*ModeNo)) break; 1625 if(SiS_Pr->SiS_EModeIDTable[(*ModeIdIndex)].Ext_ModeID == 0xFF) return false; 1626 } 1627 1628 } 1629 return true; 1630 } 1631 1632 /*********************************************/ 1633 /* HELPER: GetModePtr */ 1634 /*********************************************/ 1635 1636 unsigned short 1637 SiS_GetModePtr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) 1638 { 1639 unsigned short index; 1640 1641 if(ModeNo <= 0x13) { 1642 index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_StTableIndex; 1643 } else { 1644 if(SiS_Pr->SiS_ModeType <= ModeEGA) index = 0x1B; 1645 else index = 0x0F; 1646 } 1647 return index; 1648 } 1649 1650 /*********************************************/ 1651 /* HELPERS: Get some indices */ 1652 /*********************************************/ 1653 1654 unsigned short 1655 SiS_GetRefCRTVCLK(struct SiS_Private *SiS_Pr, unsigned short Index, int UseWide) 1656 { 1657 if(SiS_Pr->SiS_RefIndex[Index].Ext_InfoFlag & HaveWideTiming) { 1658 if(UseWide == 1) { 1659 return SiS_Pr->SiS_RefIndex[Index].Ext_CRTVCLK_WIDE; 1660 } else { 1661 return SiS_Pr->SiS_RefIndex[Index].Ext_CRTVCLK_NORM; 1662 } 1663 } else { 1664 return SiS_Pr->SiS_RefIndex[Index].Ext_CRTVCLK; 1665 } 1666 } 1667 1668 unsigned short 1669 SiS_GetRefCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short Index, int UseWide) 1670 { 1671 if(SiS_Pr->SiS_RefIndex[Index].Ext_InfoFlag & HaveWideTiming) { 1672 if(UseWide == 1) { 1673 return SiS_Pr->SiS_RefIndex[Index].Ext_CRT1CRTC_WIDE; 1674 } else { 1675 return SiS_Pr->SiS_RefIndex[Index].Ext_CRT1CRTC_NORM; 1676 } 1677 } else { 1678 return SiS_Pr->SiS_RefIndex[Index].Ext_CRT1CRTC; 1679 } 1680 } 1681 1682 /*********************************************/ 1683 /* HELPER: LowModeTests */ 1684 /*********************************************/ 1685 1686 static bool 1687 SiS_DoLowModeTest(struct SiS_Private *SiS_Pr, unsigned short ModeNo) 1688 { 1689 unsigned short temp, temp1, temp2; 1690 1691 if((ModeNo != 0x03) && (ModeNo != 0x10) && (ModeNo != 0x12)) 1692 return true; 1693 temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x11); 1694 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x11,0x80); 1695 temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x00); 1696 SiS_SetReg(SiS_Pr->SiS_P3d4,0x00,0x55); 1697 temp2 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x00); 1698 SiS_SetReg(SiS_Pr->SiS_P3d4,0x00,temp1); 1699 SiS_SetReg(SiS_Pr->SiS_P3d4,0x11,temp); 1700 if((SiS_Pr->ChipType >= SIS_315H) || 1701 (SiS_Pr->ChipType == SIS_300)) { 1702 if(temp2 == 0x55) return false; 1703 else return true; 1704 } else { 1705 if(temp2 != 0x55) return true; 1706 else { 1707 SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x35,0x01); 1708 return false; 1709 } 1710 } 1711 } 1712 1713 static void 1714 SiS_SetLowModeTest(struct SiS_Private *SiS_Pr, unsigned short ModeNo) 1715 { 1716 if(SiS_DoLowModeTest(SiS_Pr, ModeNo)) { 1717 SiS_Pr->SiS_SetFlag |= LowModeTests; 1718 } 1719 } 1720 1721 /*********************************************/ 1722 /* HELPER: OPEN/CLOSE CRT1 CRTC */ 1723 /*********************************************/ 1724 1725 static void 1726 SiS_OpenCRTC(struct SiS_Private *SiS_Pr) 1727 { 1728 if(IS_SIS650) { 1729 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x51,0x1f); 1730 if(IS_SIS651) SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x51,0x20); 1731 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x56,0xe7); 1732 } else if(IS_SIS661741660760) { 1733 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x61,0xf7); 1734 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x51,0x1f); 1735 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x56,0xe7); 1736 if(!SiS_Pr->SiS_ROMNew) { 1737 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x3a,0xef); 1738 } 1739 } 1740 } 1741 1742 static void 1743 SiS_CloseCRTC(struct SiS_Private *SiS_Pr) 1744 { 1745 #if 0 /* This locks some CRTC registers. We don't want that. */ 1746 unsigned short temp1 = 0, temp2 = 0; 1747 1748 if(IS_SIS661741660760) { 1749 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { 1750 temp1 = 0xa0; temp2 = 0x08; 1751 } 1752 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x51,0x1f,temp1); 1753 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x56,0xe7,temp2); 1754 } 1755 #endif 1756 } 1757 1758 static void 1759 SiS_HandleCRT1(struct SiS_Private *SiS_Pr) 1760 { 1761 /* Enable CRT1 gating */ 1762 SiS_SetRegAND(SiS_Pr->SiS_P3d4,SiS_Pr->SiS_MyCR63,0xbf); 1763 #if 0 1764 if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x15) & 0x01)) { 1765 if((SiS_GetReg(SiS_Pr->SiS_P3c4,0x15) & 0x0a) || 1766 (SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x01)) { 1767 SiS_SetRegOR(SiS_Pr->SiS_P3d4,SiS_Pr->SiS_MyCR63,0x40); 1768 } 1769 } 1770 #endif 1771 } 1772 1773 /*********************************************/ 1774 /* HELPER: GetColorDepth */ 1775 /*********************************************/ 1776 1777 unsigned short 1778 SiS_GetColorDepth(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 1779 unsigned short ModeIdIndex) 1780 { 1781 static const unsigned short ColorDepth[6] = { 1, 2, 4, 4, 6, 8 }; 1782 unsigned short modeflag; 1783 short index; 1784 1785 /* Do NOT check UseCustomMode, will skrew up FIFO */ 1786 if(ModeNo == 0xfe) { 1787 modeflag = SiS_Pr->CModeFlag; 1788 } else if(ModeNo <= 0x13) { 1789 modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; 1790 } else { 1791 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; 1792 } 1793 1794 index = (modeflag & ModeTypeMask) - ModeEGA; 1795 if(index < 0) index = 0; 1796 return ColorDepth[index]; 1797 } 1798 1799 /*********************************************/ 1800 /* HELPER: GetOffset */ 1801 /*********************************************/ 1802 1803 unsigned short 1804 SiS_GetOffset(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 1805 unsigned short ModeIdIndex, unsigned short RRTI) 1806 { 1807 unsigned short xres, temp, colordepth, infoflag; 1808 1809 if(SiS_Pr->UseCustomMode) { 1810 infoflag = SiS_Pr->CInfoFlag; 1811 xres = SiS_Pr->CHDisplay; 1812 } else { 1813 infoflag = SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag; 1814 xres = SiS_Pr->SiS_RefIndex[RRTI].XRes; 1815 } 1816 1817 colordepth = SiS_GetColorDepth(SiS_Pr, ModeNo, ModeIdIndex); 1818 1819 temp = xres / 16; 1820 if(infoflag & InterlaceMode) temp <<= 1; 1821 temp *= colordepth; 1822 if(xres % 16) temp += (colordepth >> 1); 1823 1824 return temp; 1825 } 1826 1827 /*********************************************/ 1828 /* SEQ */ 1829 /*********************************************/ 1830 1831 static void 1832 SiS_SetSeqRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex) 1833 { 1834 unsigned char SRdata; 1835 int i; 1836 1837 SiS_SetReg(SiS_Pr->SiS_P3c4,0x00,0x03); 1838 1839 /* or "display off" */ 1840 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[0] | 0x20; 1841 1842 /* determine whether to force x8 dotclock */ 1843 if((SiS_Pr->SiS_VBType & VB_SISVB) || (SiS_Pr->SiS_IF_DEF_LVDS)) { 1844 1845 if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) { 1846 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) SRdata |= 0x01; 1847 } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) SRdata |= 0x01; 1848 1849 } 1850 1851 SiS_SetReg(SiS_Pr->SiS_P3c4,0x01,SRdata); 1852 1853 for(i = 2; i <= 4; i++) { 1854 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[i - 1]; 1855 SiS_SetReg(SiS_Pr->SiS_P3c4,i,SRdata); 1856 } 1857 } 1858 1859 /*********************************************/ 1860 /* MISC */ 1861 /*********************************************/ 1862 1863 static void 1864 SiS_SetMiscRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex) 1865 { 1866 unsigned char Miscdata; 1867 1868 Miscdata = SiS_Pr->SiS_StandTable[StandTableIndex].MISC; 1869 1870 if(SiS_Pr->ChipType < SIS_661) { 1871 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { 1872 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { 1873 Miscdata |= 0x0C; 1874 } 1875 } 1876 } 1877 1878 SiS_SetRegByte(SiS_Pr->SiS_P3c2,Miscdata); 1879 } 1880 1881 /*********************************************/ 1882 /* CRTC */ 1883 /*********************************************/ 1884 1885 static void 1886 SiS_SetCRTCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex) 1887 { 1888 unsigned char CRTCdata; 1889 unsigned short i; 1890 1891 /* Unlock CRTC */ 1892 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f); 1893 1894 for(i = 0; i <= 0x18; i++) { 1895 CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i]; 1896 SiS_SetReg(SiS_Pr->SiS_P3d4,i,CRTCdata); 1897 } 1898 1899 if(SiS_Pr->ChipType >= SIS_661) { 1900 SiS_OpenCRTC(SiS_Pr); 1901 for(i = 0x13; i <= 0x14; i++) { 1902 CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i]; 1903 SiS_SetReg(SiS_Pr->SiS_P3d4,i,CRTCdata); 1904 } 1905 } else if( ( (SiS_Pr->ChipType == SIS_630) || 1906 (SiS_Pr->ChipType == SIS_730) ) && 1907 (SiS_Pr->ChipRevision >= 0x30) ) { 1908 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { 1909 if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) { 1910 SiS_SetReg(SiS_Pr->SiS_P3d4,0x18,0xFE); 1911 } 1912 } 1913 } 1914 } 1915 1916 /*********************************************/ 1917 /* ATT */ 1918 /*********************************************/ 1919 1920 static void 1921 SiS_SetATTRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex) 1922 { 1923 unsigned char ARdata; 1924 unsigned short i; 1925 1926 for(i = 0; i <= 0x13; i++) { 1927 ARdata = SiS_Pr->SiS_StandTable[StandTableIndex].ATTR[i]; 1928 1929 if(i == 0x13) { 1930 /* Pixel shift. If screen on LCD or TV is shifted left or right, 1931 * this might be the cause. 1932 */ 1933 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { 1934 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) ARdata = 0; 1935 } 1936 if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { 1937 if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { 1938 if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { 1939 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0; 1940 } 1941 } 1942 } 1943 if(SiS_Pr->ChipType >= SIS_661) { 1944 if(SiS_Pr->SiS_VBInfo & (SetCRT2ToTV | SetCRT2ToLCD)) { 1945 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0; 1946 } 1947 } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { 1948 if(SiS_Pr->ChipType >= SIS_315H) { 1949 if(IS_SIS550650740660) { 1950 /* 315, 330 don't do this */ 1951 if(SiS_Pr->SiS_VBType & VB_SIS30xB) { 1952 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0; 1953 } else { 1954 ARdata = 0; 1955 } 1956 } 1957 } else { 1958 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata = 0; 1959 } 1960 } 1961 } 1962 SiS_GetRegByte(SiS_Pr->SiS_P3da); /* reset 3da */ 1963 SiS_SetRegByte(SiS_Pr->SiS_P3c0,i); /* set index */ 1964 SiS_SetRegByte(SiS_Pr->SiS_P3c0,ARdata); /* set data */ 1965 } 1966 1967 SiS_GetRegByte(SiS_Pr->SiS_P3da); /* reset 3da */ 1968 SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x14); /* set index */ 1969 SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x00); /* set data */ 1970 1971 SiS_GetRegByte(SiS_Pr->SiS_P3da); 1972 SiS_SetRegByte(SiS_Pr->SiS_P3c0,0x20); /* Enable Attribute */ 1973 SiS_GetRegByte(SiS_Pr->SiS_P3da); 1974 } 1975 1976 /*********************************************/ 1977 /* GRC */ 1978 /*********************************************/ 1979 1980 static void 1981 SiS_SetGRCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex) 1982 { 1983 unsigned char GRdata; 1984 unsigned short i; 1985 1986 for(i = 0; i <= 0x08; i++) { 1987 GRdata = SiS_Pr->SiS_StandTable[StandTableIndex].GRC[i]; 1988 SiS_SetReg(SiS_Pr->SiS_P3ce,i,GRdata); 1989 } 1990 1991 if(SiS_Pr->SiS_ModeType > ModeVGA) { 1992 /* 256 color disable */ 1993 SiS_SetRegAND(SiS_Pr->SiS_P3ce,0x05,0xBF); 1994 } 1995 } 1996 1997 /*********************************************/ 1998 /* CLEAR EXTENDED REGISTERS */ 1999 /*********************************************/ 2000 2001 static void 2002 SiS_ClearExt1Regs(struct SiS_Private *SiS_Pr, unsigned short ModeNo) 2003 { 2004 unsigned short i; 2005 2006 for(i = 0x0A; i <= 0x0E; i++) { 2007 SiS_SetReg(SiS_Pr->SiS_P3c4,i,0x00); 2008 } 2009 2010 if(SiS_Pr->ChipType >= SIS_315H) { 2011 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x37,0xFE); 2012 if(ModeNo <= 0x13) { 2013 if(ModeNo == 0x06 || ModeNo >= 0x0e) { 2014 SiS_SetReg(SiS_Pr->SiS_P3c4,0x0e,0x20); 2015 } 2016 } 2017 } 2018 } 2019 2020 /*********************************************/ 2021 /* RESET VCLK */ 2022 /*********************************************/ 2023 2024 static void 2025 SiS_ResetCRT1VCLK(struct SiS_Private *SiS_Pr) 2026 { 2027 if(SiS_Pr->ChipType >= SIS_315H) { 2028 if(SiS_Pr->ChipType < SIS_661) { 2029 if(SiS_Pr->SiS_IF_DEF_LVDS == 0) return; 2030 } 2031 } else { 2032 if((SiS_Pr->SiS_IF_DEF_LVDS == 0) && 2033 (!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) ) { 2034 return; 2035 } 2036 } 2037 2038 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xcf,0x20); 2039 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[1].SR2B); 2040 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[1].SR2C); 2041 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80); 2042 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xcf,0x10); 2043 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[0].SR2B); 2044 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[0].SR2C); 2045 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80); 2046 } 2047 2048 /*********************************************/ 2049 /* SYNC */ 2050 /*********************************************/ 2051 2052 static void 2053 SiS_SetCRT1Sync(struct SiS_Private *SiS_Pr, unsigned short RRTI) 2054 { 2055 unsigned short sync; 2056 2057 if(SiS_Pr->UseCustomMode) { 2058 sync = SiS_Pr->CInfoFlag >> 8; 2059 } else { 2060 sync = SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag >> 8; 2061 } 2062 2063 sync &= 0xC0; 2064 sync |= 0x2f; 2065 SiS_SetRegByte(SiS_Pr->SiS_P3c2,sync); 2066 } 2067 2068 /*********************************************/ 2069 /* CRTC/2 */ 2070 /*********************************************/ 2071 2072 static void 2073 SiS_SetCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 2074 unsigned short ModeIdIndex, unsigned short RRTI) 2075 { 2076 unsigned short temp, i, j, modeflag; 2077 unsigned char *crt1data = NULL; 2078 2079 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); 2080 2081 if(SiS_Pr->UseCustomMode) { 2082 2083 crt1data = &SiS_Pr->CCRT1CRTC[0]; 2084 2085 } else { 2086 2087 temp = SiS_GetRefCRT1CRTC(SiS_Pr, RRTI, SiS_Pr->SiS_UseWide); 2088 2089 /* Alternate for 1600x1200 LCDA */ 2090 if((temp == 0x20) && (SiS_Pr->Alternate1600x1200)) temp = 0x57; 2091 2092 crt1data = (unsigned char *)&SiS_Pr->SiS_CRT1Table[temp].CR[0]; 2093 2094 } 2095 2096 /* unlock cr0-7 */ 2097 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f); 2098 2099 for(i = 0, j = 0; i <= 7; i++, j++) { 2100 SiS_SetReg(SiS_Pr->SiS_P3d4,j,crt1data[i]); 2101 } 2102 for(j = 0x10; i <= 10; i++, j++) { 2103 SiS_SetReg(SiS_Pr->SiS_P3d4,j,crt1data[i]); 2104 } 2105 for(j = 0x15; i <= 12; i++, j++) { 2106 SiS_SetReg(SiS_Pr->SiS_P3d4,j,crt1data[i]); 2107 } 2108 for(j = 0x0A; i <= 15; i++, j++) { 2109 SiS_SetReg(SiS_Pr->SiS_P3c4,j,crt1data[i]); 2110 } 2111 2112 SiS_SetReg(SiS_Pr->SiS_P3c4,0x0E,crt1data[16] & 0xE0); 2113 2114 temp = (crt1data[16] & 0x01) << 5; 2115 if(modeflag & DoubleScanMode) temp |= 0x80; 2116 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,0x5F,temp); 2117 2118 if(SiS_Pr->SiS_ModeType > ModeVGA) { 2119 SiS_SetReg(SiS_Pr->SiS_P3d4,0x14,0x4F); 2120 } 2121 2122 #ifdef CONFIG_FB_SIS_315 2123 if(SiS_Pr->ChipType == XGI_20) { 2124 SiS_SetReg(SiS_Pr->SiS_P3d4,0x04,crt1data[4] - 1); 2125 if(!(temp = crt1data[5] & 0x1f)) { 2126 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x0c,0xfb); 2127 } 2128 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x05,0xe0,((temp - 1) & 0x1f)); 2129 temp = (crt1data[16] >> 5) + 3; 2130 if(temp > 7) temp -= 7; 2131 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0e,0x1f,(temp << 5)); 2132 } 2133 #endif 2134 } 2135 2136 /*********************************************/ 2137 /* OFFSET & PITCH */ 2138 /*********************************************/ 2139 /* (partly overruled by SetPitch() in XF86) */ 2140 /*********************************************/ 2141 2142 static void 2143 SiS_SetCRT1Offset(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 2144 unsigned short ModeIdIndex, unsigned short RRTI) 2145 { 2146 unsigned short temp, DisplayUnit, infoflag; 2147 2148 if(SiS_Pr->UseCustomMode) { 2149 infoflag = SiS_Pr->CInfoFlag; 2150 } else { 2151 infoflag = SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag; 2152 } 2153 2154 DisplayUnit = SiS_GetOffset(SiS_Pr, ModeNo, ModeIdIndex, RRTI); 2155 2156 temp = (DisplayUnit >> 8) & 0x0f; 2157 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0xF0,temp); 2158 2159 SiS_SetReg(SiS_Pr->SiS_P3d4,0x13,DisplayUnit & 0xFF); 2160 2161 if(infoflag & InterlaceMode) DisplayUnit >>= 1; 2162 2163 DisplayUnit <<= 5; 2164 temp = (DisplayUnit >> 8) + 1; 2165 if(DisplayUnit & 0xff) temp++; 2166 if(SiS_Pr->ChipType == XGI_20) { 2167 if(ModeNo == 0x4a || ModeNo == 0x49) temp--; 2168 } 2169 SiS_SetReg(SiS_Pr->SiS_P3c4,0x10,temp); 2170 } 2171 2172 /*********************************************/ 2173 /* VCLK */ 2174 /*********************************************/ 2175 2176 static void 2177 SiS_SetCRT1VCLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 2178 unsigned short ModeIdIndex, unsigned short RRTI) 2179 { 2180 unsigned short index = 0, clka, clkb; 2181 2182 if(SiS_Pr->UseCustomMode) { 2183 clka = SiS_Pr->CSR2B; 2184 clkb = SiS_Pr->CSR2C; 2185 } else { 2186 index = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RRTI); 2187 if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) && 2188 (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { 2189 /* Alternate for 1600x1200 LCDA */ 2190 if((index == 0x21) && (SiS_Pr->Alternate1600x1200)) index = 0x72; 2191 clka = SiS_Pr->SiS_VBVCLKData[index].Part4_A; 2192 clkb = SiS_Pr->SiS_VBVCLKData[index].Part4_B; 2193 } else { 2194 clka = SiS_Pr->SiS_VCLKData[index].SR2B; 2195 clkb = SiS_Pr->SiS_VCLKData[index].SR2C; 2196 } 2197 } 2198 2199 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xCF); 2200 2201 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2b,clka); 2202 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2c,clkb); 2203 2204 if(SiS_Pr->ChipType >= SIS_315H) { 2205 #ifdef CONFIG_FB_SIS_315 2206 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x01); 2207 if(SiS_Pr->ChipType == XGI_20) { 2208 unsigned short mf = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); 2209 if(mf & HalfDCLK) { 2210 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2b,SiS_GetReg(SiS_Pr->SiS_P3c4,0x2b)); 2211 clkb = SiS_GetReg(SiS_Pr->SiS_P3c4,0x2c); 2212 clkb = (((clkb & 0x1f) << 1) + 1) | (clkb & 0xe0); 2213 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2c,clkb); 2214 } 2215 } 2216 #endif 2217 } else { 2218 SiS_SetReg(SiS_Pr->SiS_P3c4,0x2D,0x80); 2219 } 2220 } 2221 2222 /*********************************************/ 2223 /* FIFO */ 2224 /*********************************************/ 2225 2226 #ifdef CONFIG_FB_SIS_300 2227 void 2228 SiS_GetFIFOThresholdIndex300(struct SiS_Private *SiS_Pr, unsigned short *idx1, 2229 unsigned short *idx2) 2230 { 2231 unsigned short temp1, temp2; 2232 static const unsigned char ThTiming[8] = { 2233 1, 2, 2, 3, 0, 1, 1, 2 2234 }; 2235 2236 temp1 = temp2 = (SiS_GetReg(SiS_Pr->SiS_P3c4,0x18) & 0x62) >> 1; 2237 (*idx2) = (unsigned short)(ThTiming[((temp2 >> 3) | temp1) & 0x07]); 2238 (*idx1) = (unsigned short)(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) >> 6) & 0x03; 2239 (*idx1) |= (unsigned short)(((SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) >> 4) & 0x0c)); 2240 (*idx1) <<= 1; 2241 } 2242 2243 static unsigned short 2244 SiS_GetFIFOThresholdA300(unsigned short idx1, unsigned short idx2) 2245 { 2246 static const unsigned char ThLowA[8 * 3] = { 2247 61, 3,52, 5,68, 7,100,11, 2248 43, 3,42, 5,54, 7, 78,11, 2249 34, 3,37, 5,47, 7, 67,11 2250 }; 2251 2252 return (unsigned short)((ThLowA[idx1 + 1] * idx2) + ThLowA[idx1]); 2253 } 2254 2255 unsigned short 2256 SiS_GetFIFOThresholdB300(unsigned short idx1, unsigned short idx2) 2257 { 2258 static const unsigned char ThLowB[8 * 3] = { 2259 81, 4,72, 6,88, 8,120,12, 2260 55, 4,54, 6,66, 8, 90,12, 2261 42, 4,45, 6,55, 8, 75,12 2262 }; 2263 2264 return (unsigned short)((ThLowB[idx1 + 1] * idx2) + ThLowB[idx1]); 2265 } 2266 2267 static unsigned short 2268 SiS_DoCalcDelay(struct SiS_Private *SiS_Pr, unsigned short MCLK, unsigned short VCLK, 2269 unsigned short colordepth, unsigned short key) 2270 { 2271 unsigned short idx1, idx2; 2272 unsigned int longtemp = VCLK * colordepth; 2273 2274 SiS_GetFIFOThresholdIndex300(SiS_Pr, &idx1, &idx2); 2275 2276 if(key == 0) { 2277 longtemp *= SiS_GetFIFOThresholdA300(idx1, idx2); 2278 } else { 2279 longtemp *= SiS_GetFIFOThresholdB300(idx1, idx2); 2280 } 2281 idx1 = longtemp % (MCLK * 16); 2282 longtemp /= (MCLK * 16); 2283 if(idx1) longtemp++; 2284 return (unsigned short)longtemp; 2285 } 2286 2287 static unsigned short 2288 SiS_CalcDelay(struct SiS_Private *SiS_Pr, unsigned short VCLK, 2289 unsigned short colordepth, unsigned short MCLK) 2290 { 2291 unsigned short temp1, temp2; 2292 2293 temp2 = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 0); 2294 temp1 = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 1); 2295 if(temp1 < 4) temp1 = 4; 2296 temp1 -= 4; 2297 if(temp2 < temp1) temp2 = temp1; 2298 return temp2; 2299 } 2300 2301 static void 2302 SiS_SetCRT1FIFO_300(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 2303 unsigned short RefreshRateTableIndex) 2304 { 2305 unsigned short ThresholdLow = 0; 2306 unsigned short temp, index, VCLK, MCLK, colorth; 2307 static const unsigned short colortharray[6] = { 1, 1, 2, 2, 3, 4 }; 2308 2309 if(ModeNo > 0x13) { 2310 2311 /* Get VCLK */ 2312 if(SiS_Pr->UseCustomMode) { 2313 VCLK = SiS_Pr->CSRClock; 2314 } else { 2315 index = SiS_GetRefCRTVCLK(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWide); 2316 VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK; 2317 } 2318 2319 /* Get half colordepth */ 2320 colorth = colortharray[(SiS_Pr->SiS_ModeType - ModeEGA)]; 2321 2322 /* Get MCLK */ 2323 index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3A) & 0x07; 2324 MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK; 2325 2326 temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35) & 0xc3; 2327 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3c,temp); 2328 2329 do { 2330 ThresholdLow = SiS_CalcDelay(SiS_Pr, VCLK, colorth, MCLK) + 1; 2331 if(ThresholdLow < 0x13) break; 2332 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x16,0xfc); 2333 ThresholdLow = 0x13; 2334 temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) >> 6; 2335 if(!temp) break; 2336 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3f,((temp - 1) << 6)); 2337 } while(0); 2338 2339 } else ThresholdLow = 2; 2340 2341 /* Write CRT/CPU threshold low, CRT/Engine threshold high */ 2342 temp = (ThresholdLow << 4) | 0x0f; 2343 SiS_SetReg(SiS_Pr->SiS_P3c4,0x08,temp); 2344 2345 temp = (ThresholdLow & 0x10) << 1; 2346 if(ModeNo > 0x13) temp |= 0x40; 2347 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0f,0x9f,temp); 2348 2349 /* What is this? */ 2350 SiS_SetReg(SiS_Pr->SiS_P3c4,0x3B,0x09); 2351 2352 /* Write CRT/CPU threshold high */ 2353 temp = ThresholdLow + 3; 2354 if(temp > 0x0f) temp = 0x0f; 2355 SiS_SetReg(SiS_Pr->SiS_P3c4,0x09,temp); 2356 } 2357 2358 unsigned short 2359 SiS_GetLatencyFactor630(struct SiS_Private *SiS_Pr, unsigned short index) 2360 { 2361 static const unsigned char LatencyFactor[] = { 2362 97, 88, 86, 79, 77, 0, /* 64 bit BQ=2 */ 2363 0, 87, 85, 78, 76, 54, /* 64 bit BQ=1 */ 2364 97, 88, 86, 79, 77, 0, /* 128 bit BQ=2 */ 2365 0, 79, 77, 70, 68, 48, /* 128 bit BQ=1 */ 2366 80, 72, 69, 63, 61, 0, /* 64 bit BQ=2 */ 2367 0, 70, 68, 61, 59, 37, /* 64 bit BQ=1 */ 2368 86, 77, 75, 68, 66, 0, /* 128 bit BQ=2 */ 2369 0, 68, 66, 59, 57, 37 /* 128 bit BQ=1 */ 2370 }; 2371 static const unsigned char LatencyFactor730[] = { 2372 69, 63, 61, 2373 86, 79, 77, 2374 103, 96, 94, 2375 120,113,111, 2376 137,130,128 2377 }; 2378 2379 if(SiS_Pr->ChipType == SIS_730) { 2380 return (unsigned short)LatencyFactor730[index]; 2381 } else { 2382 return (unsigned short)LatencyFactor[index]; 2383 } 2384 } 2385 2386 static unsigned short 2387 SiS_CalcDelay2(struct SiS_Private *SiS_Pr, unsigned char key) 2388 { 2389 unsigned short index; 2390 2391 if(SiS_Pr->ChipType == SIS_730) { 2392 index = ((key & 0x0f) * 3) + ((key & 0xc0) >> 6); 2393 } else { 2394 index = (key & 0xe0) >> 5; 2395 if(key & 0x10) index += 6; 2396 if(!(key & 0x01)) index += 24; 2397 if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) & 0x80) index += 12; 2398 } 2399 return SiS_GetLatencyFactor630(SiS_Pr, index); 2400 } 2401 2402 static void 2403 SiS_SetCRT1FIFO_630(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 2404 unsigned short RefreshRateTableIndex) 2405 { 2406 unsigned short ThresholdLow = 0; 2407 unsigned short i, data, VCLK, MCLK16, colorth = 0; 2408 unsigned int templ, datal; 2409 const unsigned char *queuedata = NULL; 2410 static const unsigned char FQBQData[21] = { 2411 0x01,0x21,0x41,0x61,0x81, 2412 0x31,0x51,0x71,0x91,0xb1, 2413 0x00,0x20,0x40,0x60,0x80, 2414 0x30,0x50,0x70,0x90,0xb0, 2415 0xff 2416 }; 2417 static const unsigned char FQBQData730[16] = { 2418 0x34,0x74,0xb4, 2419 0x23,0x63,0xa3, 2420 0x12,0x52,0x92, 2421 0x01,0x41,0x81, 2422 0x00,0x40,0x80, 2423 0xff 2424 }; 2425 static const unsigned short colortharray[6] = { 2426 1, 1, 2, 2, 3, 4 2427 }; 2428 2429 i = 0; 2430 2431 if (SiS_Pr->ChipType == SIS_730) 2432 queuedata = &FQBQData730[0]; 2433 else 2434 queuedata = &FQBQData[0]; 2435 2436 if(ModeNo > 0x13) { 2437 2438 /* Get VCLK */ 2439 if(SiS_Pr->UseCustomMode) { 2440 VCLK = SiS_Pr->CSRClock; 2441 } else { 2442 data = SiS_GetRefCRTVCLK(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWide); 2443 VCLK = SiS_Pr->SiS_VCLKData[data].CLOCK; 2444 } 2445 2446 /* Get MCLK * 16 */ 2447 data = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1A) & 0x07; 2448 MCLK16 = SiS_Pr->SiS_MCLKData_0[data].CLOCK * 16; 2449 2450 /* Get half colordepth */ 2451 colorth = colortharray[(SiS_Pr->SiS_ModeType - ModeEGA)]; 2452 2453 do { 2454 templ = SiS_CalcDelay2(SiS_Pr, queuedata[i]) * VCLK * colorth; 2455 2456 datal = templ % MCLK16; 2457 templ = (templ / MCLK16) + 1; 2458 if(datal) templ++; 2459 2460 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); 2471 2472 } else { 2473 2474 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); 2493 2494 /* Write foreground and background queue */ 2495 templ = sisfb_read_nbridge_pci_dword(SiS_Pr, 0x50); 2496 2497 if(SiS_Pr->ChipType == SIS_730) { 2498 2499 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 2515 sisfb_write_nbridge_pci_dword(SiS_Pr, 0x50, templ); 2516 templ = sisfb_read_nbridge_pci_dword(SiS_Pr, 0xA0); 2517 2518 /* GUI grant timer (PCI config 0xA3) */ 2519 if(SiS_Pr->ChipType == SIS_730) { 2520 2521 templ &= 0x00ffffff; 2522 datal = queuedata[i] << 8; 2523 templ |= (((datal & 0x0f00) | ((datal & 0x3000) >> 8)) << 20); 2524 2525 } else { 2526 2527 templ &= 0xf0ffffff; 2528 templ |= ((queuedata[i] & 0x0f) << 24); 2529 2530 } 2531 2532 sisfb_write_nbridge_pci_dword(SiS_Pr, 0xA0, templ); 2533 } 2534 #endif /* CONFIG_FB_SIS_300 */ 2535 2536 #ifdef CONFIG_FB_SIS_315 2537 static void 2538 SiS_SetCRT1FIFO_310(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) 2539 { 2540 unsigned short modeflag; 2541 2542 /* disable auto-threshold */ 2543 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x3D,0xFE); 2544 2545 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); 2546 2547 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 } 2565 } 2566 #endif 2567 2568 /*********************************************/ 2569 /* MODE REGISTERS */ 2570 /*********************************************/ 2571 2572 static void 2573 SiS_SetVCLKState(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 2574 unsigned short RefreshRateTableIndex, unsigned short ModeIdIndex) 2575 { 2576 unsigned short data = 0, VCLK = 0, index = 0; 2577 2578 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 } 2586 2587 if(SiS_Pr->ChipType < SIS_315H) { 2588 #ifdef CONFIG_FB_SIS_300 2589 if(VCLK > 150) data |= 0x80; 2590 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0x7B,data); 2591 2592 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) { 2597 #ifdef CONFIG_FB_SIS_315 2598 if(VCLK >= 166) data |= 0x0c; 2599 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xf3,data); 2600 2601 if(VCLK >= 166) { 2602 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1f,0xe7); 2603 } 2604 #endif 2605 } else { 2606 #ifdef CONFIG_FB_SIS_315 2607 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 } 2617 2618 /* DAC speed */ 2619 if(SiS_Pr->ChipType >= SIS_661) { 2620 2621 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xE8,0x10); 2622 2623 } else { 2624 2625 data = 0x03; 2626 if(VCLK >= 260) data = 0x00; 2627 else if(VCLK >= 160) data = 0x01; 2628 else if(VCLK >= 135) data = 0x02; 2629 2630 if(SiS_Pr->ChipType == SIS_540) { 2631 /* Was == 203 or < 234 which made no sense */ 2632 if (VCLK < 234) data = 0x02; 2633 } 2634 2635 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 } 2643 2644 } 2645 } 2646 2647 static void 2648 SiS_SetCRT1ModeRegs(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 2649 unsigned short ModeIdIndex, unsigned short RRTI) 2650 { 2651 unsigned short data, infoflag = 0, modeflag, resindex; 2652 #ifdef CONFIG_FB_SIS_315 2653 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; 2654 unsigned short data2, data3; 2655 #endif 2656 2657 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); 2658 2659 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 } 2667 2668 /* Disable DPMS */ 2669 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1F,0x3F); 2670 2671 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); 2680 2681 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 } 2694 2695 if(modeflag & HalfDCLK) { 2696 SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x01,0x08); 2697 } 2698 2699 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 } 2712 2713 #ifdef CONFIG_FB_SIS_315 2714 if(SiS_Pr->ChipType >= SIS_315H) { 2715 SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xfb); 2716 } 2717 2718 if(SiS_Pr->ChipType == SIS_315PRO) { 2719 2720 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); 2734 2735 } else if((SiS_Pr->ChipType == SIS_330) || (SiS_Pr->SiS_SysFlags & SF_760LFB)) { 2736 2737 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 } 2754 2755 data3 = SiS_GetColorDepth(SiS_Pr, ModeNo, ModeIdIndex) >> 1; 2756 if(data3) data2 *= data3; 2757 2758 data2 = ((unsigned int)(SiS_GetMCLK(SiS_Pr) * 1024)) / data2; 2759 2760 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 */ 2790 #endif 2791 2792 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); 2800 2801 SiS_SetVCLKState(SiS_Pr, ModeNo, RRTI, ModeIdIndex); 2802 2803 #ifdef CONFIG_FB_SIS_315 2804 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 } 2819 #endif 2820 } 2821 2822 #ifdef CONFIG_FB_SIS_315 2823 static void 2824 SiS_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 2852 /*********************************************/ 2853 /* LOAD DAC */ 2854 /*********************************************/ 2855 2856 static void 2857 SiS_WriteDAC(struct SiS_Private *SiS_Pr, SISIOADDRESS DACData, unsigned short shiftflag, 2858 unsigned short dl, unsigned short ah, unsigned short al, unsigned short dh) 2859 { 2860 unsigned short d1, d2, d3; 2861 2862 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; 2866 } 2867 SiS_SetRegByte(DACData, (d1 << shiftflag)); 2868 SiS_SetRegByte(DACData, (d2 << shiftflag)); 2869 SiS_SetRegByte(DACData, (d3 << shiftflag)); 2870 } 2871 2872 void 2873 SiS_LoadDAC(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) 2874 { 2875 unsigned short data, data2, time, i, j, k, m, n, o; 2876 unsigned short si, di, bx, sf; 2877 SISIOADDRESS DACAddr, DACData; 2878 const unsigned char *table = NULL; 2879 2880 data = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex) & DACInfoFlag; 2881 2882 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; 2888 time = 256; 2889 table = SiS_VGA_DAC; 2890 } 2891 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 */ 2896 SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF); 2897 DACAddr = SiS_Pr->SiS_P3c8; 2898 DACData = SiS_Pr->SiS_P3c9; 2899 sf = 0; 2900 } else { 2901 DACAddr = SiS_Pr->SiS_Part5Port; 2902 DACData = SiS_Pr->SiS_Part5Port + 1; 2903 sf = 2; 2904 } 2905 2906 SiS_SetRegByte(DACAddr,0x00); 2907 2908 for(i = 0; i < j; i++) { 2909 data = table[i]; 2910 for(k = 0; k < 3; k++) { 2911 data2 = 0; 2912 if(data & 0x01) data2 += 0x2A; 2913 if(data & 0x02) data2 += 0x15; 2914 SiS_SetRegByte(DACData, (data2 << sf)); 2915 data >>= 2; 2916 } 2917 } 2918 2919 if(time == 256) { 2920 for(i = 16; i < 32; i++) { 2921 data = table[i] << sf; 2922 for(k = 0; k < 3; k++) SiS_SetRegByte(DACData, data); 2923 } 2924 si = 32; 2925 for(m = 0; m < 9; m++) { 2926 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]); 2931 si++; 2932 } 2933 si -= 2; 2934 for(o = 0; o < 3; o++) { 2935 SiS_WriteDAC(SiS_Pr, DACData, sf, n, table[di], table[si], table[bx]); 2936 si--; 2937 } 2938 } /* for n < 3 */ 2939 si += 5; 2940 } /* for m < 9 */ 2941 } 2942 } 2943 2944 /*********************************************/ 2945 /* SET CRT1 REGISTER GROUP */ 2946 /*********************************************/ 2947 2948 static void 2949 SiS_SetCRT1Group(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) 2950 { 2951 unsigned short StandTableIndex, RefreshRateTableIndex; 2952 2953 SiS_Pr->SiS_CRT1Mode = ModeNo; 2954 2955 StandTableIndex = SiS_GetModePtr(SiS_Pr, ModeNo, ModeIdIndex); 2956 2957 if(SiS_Pr->SiS_SetFlag & LowModeTests) { 2958 if(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2)) { 2959 SiS_DisableBridge(SiS_Pr); 2960 } 2961 } 2962 2963 SiS_ResetSegmentRegisters(SiS_Pr); 2964 2965 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 2976 if(SiS_Pr->SiS_VBInfo & SetSimuScanMode) { 2977 if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { 2978 SiS_Pr->SiS_SetFlag |= ProgrammingCRT2; 2979 } 2980 } 2981 2982 if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { 2983 SiS_Pr->SiS_SetFlag |= ProgrammingCRT2; 2984 } 2985 2986 RefreshRateTableIndex = SiS_GetRatePtr(SiS_Pr, ModeNo, ModeIdIndex); 2987 2988 if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { 2989 SiS_Pr->SiS_SetFlag &= ~ProgrammingCRT2; 2990 } 2991 2992 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 } 2998 2999 switch(SiS_Pr->ChipType) { 3000 #ifdef CONFIG_FB_SIS_300 3001 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; 3009 #endif 3010 default: 3011 #ifdef CONFIG_FB_SIS_315 3012 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 3034 #ifdef CONFIG_FB_SIS_315 3035 if(SiS_Pr->ChipType == XGI_40) { 3036 SiS_SetupDualChip(SiS_Pr); 3037 } 3038 #endif 3039 3040 SiS_LoadDAC(SiS_Pr, ModeNo, ModeIdIndex); 3041 3042 if(SiS_Pr->SiS_flag_clearbuffer) { 3043 SiS_ClearBuffer(SiS_Pr, ModeNo); 3044 } 3045 3046 if(!(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2 | SetCRT2ToLCDA))) { 3047 SiS_WaitRetrace1(SiS_Pr); 3048 SiS_DisplayOn(SiS_Pr); 3049 } 3050 } 3051 3052 /*********************************************/ 3053 /* HELPER: VIDEO BRIDGE PROG CLK */ 3054 /*********************************************/ 3055 3056 static void 3057 SiS_InitVB(struct SiS_Private *SiS_Pr) 3058 { 3059 unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; 3060 3061 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]; 3067 } 3068 } 3069 } 3070 3071 static void 3072 SiS_ResetVB(struct SiS_Private *SiS_Pr) 3073 { 3074 #ifdef CONFIG_FB_SIS_315 3075 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 3098 /*********************************************/ 3099 /* HELPER: SET VIDEO/CAPTURE REGISTERS */ 3100 /*********************************************/ 3101 3102 static void 3103 SiS_StrangeStuff(struct SiS_Private *SiS_Pr) 3104 { 3105 /* 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 */ 3109 #ifdef CONFIG_FB_SIS_315 3110 if((IS_SIS651) || (IS_SISM650) || 3111 SiS_Pr->ChipType == SIS_340 || 3112 SiS_Pr->ChipType == XGI_40) { 3113 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 !!! */ 3120 #endif 3121 } 3122 3123 /*********************************************/ 3124 /* HELPER: SET AGP TIMING FOR SiS760 */ 3125 /*********************************************/ 3126 3127 static void 3128 SiS_Handle760(struct SiS_Private *SiS_Pr) 3129 { 3130 #ifdef CONFIG_FB_SIS_315 3131 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 3140 somebase = sisfb_read_mio_pci_word(SiS_Pr, 0x74); 3141 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 3156 sisfb_write_nbridge_pci_byte(SiS_Pr, 0x7e, temp1); 3157 sisfb_write_nbridge_pci_byte(SiS_Pr, 0x8d, temp2); 3158 3159 SiS_SetRegByte((somebase + 0x85), temp3); 3160 #endif 3161 } 3162 3163 /*********************************************/ 3164 /* SiSSetMode() */ 3165 /*********************************************/ 3166 3167 bool 3168 SiSSetMode(struct SiS_Private *SiS_Pr, unsigned short ModeNo) 3169 { 3170 SISIOADDRESS BaseAddr = SiS_Pr->IOAddress; 3171 unsigned short RealModeNo, ModeIdIndex; 3172 unsigned char backupreg = 0; 3173 unsigned short KeepLockReg; 3174 3175 SiS_Pr->UseCustomMode = false; 3176 SiS_Pr->CRT1UsesCustomMode = false; 3177 3178 SiS_Pr->SiS_flag_clearbuffer = 0; 3179 3180 if(SiS_Pr->UseCustomMode) { 3181 ModeNo = 0xfe; 3182 } else { 3183 if(!(ModeNo & 0x80)) SiS_Pr->SiS_flag_clearbuffer = 1; 3184 ModeNo &= 0x7f; 3185 } 3186 3187 /* 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; 3196 3197 KeepLockReg = SiS_GetReg(SiS_Pr->SiS_P3c4,0x05); 3198 SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x86); 3199 3200 SiSInitPCIetc(SiS_Pr); 3201 SiSSetLVDSetc(SiS_Pr); 3202 SiSDetermineROMUsage(SiS_Pr); 3203 3204 SiS_UnLockCRT2(SiS_Pr); 3205 3206 if(!SiS_Pr->UseCustomMode) { 3207 if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) return false; 3208 } else { 3209 ModeIdIndex = 0; 3210 } 3211 3212 SiS_GetVBType(SiS_Pr); 3213 3214 /* Init/restore some VB registers */ 3215 SiS_InitVB(SiS_Pr); 3216 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { 3217 if(SiS_Pr->ChipType >= SIS_315H) { 3218 SiS_ResetVB(SiS_Pr); 3219 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) */ 3228 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); 3233 3234 /* Check memory size (kernel framebuffer driver only) */ 3235 if(!SiS_CheckMemorySize(SiS_Pr, ModeNo, ModeIdIndex)) { 3236 return false; 3237 } 3238 3239 SiS_OpenCRTC(SiS_Pr); 3240 3241 if(SiS_Pr->UseCustomMode) { 3242 SiS_Pr->CRT1UsesCustomMode = true; 3243 SiS_Pr->CSRClock_CRT1 = SiS_Pr->CSRClock; 3244 SiS_Pr->CModeFlag_CRT1 = SiS_Pr->CModeFlag; 3245 } else { 3246 SiS_Pr->CRT1UsesCustomMode = false; 3247 } 3248 3249 /* Set mode on CRT1 */ 3250 if( (SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SetCRT2ToLCDA)) || 3251 (!(SiS_Pr->SiS_VBInfo & SwitchCRT2)) ) { 3252 SiS_SetCRT1Group(SiS_Pr, ModeNo, ModeIdIndex); 3253 } 3254 3255 /* Set mode on CRT2 */ 3256 if(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchCRT2 | SetCRT2ToLCDA)) { 3257 if( (SiS_Pr->SiS_VBType & VB_SISVB) || 3258 (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); 3262 } 3263 } 3264 3265 SiS_HandleCRT1(SiS_Pr); 3266 3267 SiS_StrangeStuff(SiS_Pr); 3268 3269 SiS_DisplayOn(SiS_Pr); 3270 SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xFF); 3271 3272 #ifdef CONFIG_FB_SIS_315 3273 if(SiS_Pr->ChipType >= SIS_315H) { 3274 if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { 3275 if(!(SiS_IsDualEdge(SiS_Pr))) { 3276 SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb); 3277 } 3278 } 3279 } 3280 #endif 3281 3282 if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { 3283 if(SiS_Pr->ChipType >= SIS_315H) { 3284 #ifdef CONFIG_FB_SIS_315 3285 if(!SiS_Pr->SiS_ROMNew) { 3286 if(SiS_IsVAMode(SiS_Pr)) { 3287 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); 3299 } 3300 } 3301 3302 if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & SetCRT2ToLCD) { 3303 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x38,0xfc); 3304 } 3305 #endif 3306 } else if((SiS_Pr->ChipType == SIS_630) || 3307 (SiS_Pr->ChipType == SIS_730)) { 3308 SiS_SetReg(SiS_Pr->SiS_P3d4,0x35,backupreg); 3309 } 3310 } 3311 3312 SiS_CloseCRTC(SiS_Pr); 3313 3314 SiS_Handle760(SiS_Pr); 3315 3316 /* We never lock registers in XF86 */ 3317 if(KeepLockReg != 0xA1) SiS_SetReg(SiS_Pr->SiS_P3c4,0x05,0x00); 3318 3319 return true; 3320 } 3321 3322 #ifndef GETBITSTR 3323 #define GENBITSMASK(mask) GENMASK(1?mask,0?mask) 3324 #define GETBITS(var,mask) (((var) & GENBITSMASK(mask)) >> (0?mask)) 3325 #define GETBITSTR(val,from,to) ((GETBITS(val,from)) << (0?to)) 3326 #endif 3327 3328 void 3329 SiS_CalcCRRegisters(struct SiS_Private *SiS_Pr, int depth) 3330 { 3331 int x = 1; /* Fix sync */ 3332 3333 SiS_Pr->CCRT1CRTC[0] = ((SiS_Pr->CHTotal >> 3) - 5) & 0xff; /* CR0 */ 3334 SiS_Pr->CCRT1CRTC[1] = (SiS_Pr->CHDisplay >> 3) - 1; /* CR1 */ 3335 SiS_Pr->CCRT1CRTC[2] = (SiS_Pr->CHBlankStart >> 3) - 1; /* CR2 */ 3336 SiS_Pr->CCRT1CRTC[3] = (((SiS_Pr->CHBlankEnd >> 3) - 1) & 0x1F) | 0x80; /* CR3 */ 3337 SiS_Pr->CCRT1CRTC[4] = (SiS_Pr->CHSyncStart >> 3) + 3; /* CR4 */ 3338 SiS_Pr->CCRT1CRTC[5] = ((((SiS_Pr->CHBlankEnd >> 3) - 1) & 0x20) << 2) | /* CR5 */ 3339 (((SiS_Pr->CHSyncEnd >> 3) + 3) & 0x1F); 3340 3341 SiS_Pr->CCRT1CRTC[6] = (SiS_Pr->CVTotal - 2) & 0xFF; /* CR6 */ 3342 SiS_Pr->CCRT1CRTC[7] = (((SiS_Pr->CVTotal - 2) & 0x100) >> 8) /* CR7 */ 3343 | (((SiS_Pr->CVDisplay - 1) & 0x100) >> 7) 3344 | (((SiS_Pr->CVSyncStart - x) & 0x100) >> 6) 3345 | (((SiS_Pr->CVBlankStart- 1) & 0x100) >> 5) 3346 | 0x10 3347 | (((SiS_Pr->CVTotal - 2) & 0x200) >> 4) 3348 | (((SiS_Pr->CVDisplay - 1) & 0x200) >> 3) 3349 | (((SiS_Pr->CVSyncStart - x) & 0x200) >> 2); 3350 3351 SiS_Pr->CCRT1CRTC[16] = ((((SiS_Pr->CVBlankStart - 1) & 0x200) >> 4) >> 5); /* CR9 */ 3352 3353 if(depth != 8) { 3354 if(SiS_Pr->CHDisplay >= 1600) SiS_Pr->CCRT1CRTC[16] |= 0x60; /* SRE */ 3355 else if(SiS_Pr->CHDisplay >= 640) SiS_Pr->CCRT1CRTC[16] |= 0x40; 3356 } 3357 3358 SiS_Pr->CCRT1CRTC[8] = (SiS_Pr->CVSyncStart - x) & 0xFF; /* CR10 */ 3359 SiS_Pr->CCRT1CRTC[9] = ((SiS_Pr->CVSyncEnd - x) & 0x0F) | 0x80; /* CR11 */ 3360 SiS_Pr->CCRT1CRTC[10] = (SiS_Pr->CVDisplay - 1) & 0xFF; /* CR12 */ 3361 SiS_Pr->CCRT1CRTC[11] = (SiS_Pr->CVBlankStart - 1) & 0xFF; /* CR15 */ 3362 SiS_Pr->CCRT1CRTC[12] = (SiS_Pr->CVBlankEnd - 1) & 0xFF; /* CR16 */ 3363 3364 SiS_Pr->CCRT1CRTC[13] = /* SRA */ 3365 GETBITSTR((SiS_Pr->CVTotal -2), 10:10, 0:0) | 3366 GETBITSTR((SiS_Pr->CVDisplay -1), 10:10, 1:1) | 3367 GETBITSTR((SiS_Pr->CVBlankStart-1), 10:10, 2:2) | 3368 GETBITSTR((SiS_Pr->CVSyncStart -x), 10:10, 3:3) | 3369 GETBITSTR((SiS_Pr->CVBlankEnd -1), 8:8, 4:4) | 3370 GETBITSTR((SiS_Pr->CVSyncEnd ), 4:4, 5:5) ; 3371 3372 SiS_Pr->CCRT1CRTC[14] = /* SRB */ 3373 GETBITSTR((SiS_Pr->CHTotal >> 3) - 5, 9:8, 1:0) | 3374 GETBITSTR((SiS_Pr->CHDisplay >> 3) - 1, 9:8, 3:2) | 3375 GETBITSTR((SiS_Pr->CHBlankStart >> 3) - 1, 9:8, 5:4) | 3376 GETBITSTR((SiS_Pr->CHSyncStart >> 3) + 3, 9:8, 7:6) ; 3377 3378 3379 SiS_Pr->CCRT1CRTC[15] = /* SRC */ 3380 GETBITSTR((SiS_Pr->CHBlankEnd >> 3) - 1, 7:6, 1:0) | 3381 GETBITSTR((SiS_Pr->CHSyncEnd >> 3) + 3, 5:5, 2:2) ; 3382 } 3383 3384 void 3385 SiS_CalcLCDACRT1Timing(struct SiS_Private *SiS_Pr, unsigned short ModeNo, 3386 unsigned short ModeIdIndex) 3387 { 3388 unsigned short modeflag, tempax, tempbx = 0, remaining = 0; 3389 unsigned short VGAHDE = SiS_Pr->SiS_VGAHDE; 3390 int i, j; 3391 3392 /* 1:1 data: use data set by setcrt1crtc() */ 3393 if(SiS_Pr->SiS_LCDInfo & LCDPass11) return; 3394 3395 modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); 3396 3397 if(modeflag & HalfDCLK) VGAHDE >>= 1; 3398 3399 SiS_Pr->CHDisplay = VGAHDE; 3400 SiS_Pr->CHBlankStart = VGAHDE; 3401 3402 SiS_Pr->CVDisplay = SiS_Pr->SiS_VGAVDE; 3403 SiS_Pr->CVBlankStart = SiS_Pr->SiS_VGAVDE; 3404 3405 if(SiS_Pr->ChipType < SIS_315H) { 3406 #ifdef CONFIG_FB_SIS_300 3407 tempbx = SiS_Pr->SiS_VGAHT; 3408 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { 3409 tempbx = SiS_Pr->PanelHT; 3410 } 3411 if(modeflag & HalfDCLK) tempbx >>= 1; 3412 remaining = tempbx % 8; 3413 #endif 3414 } else { 3415 #ifdef CONFIG_FB_SIS_315 3416 /* OK for LCDA, LVDS */ 3417 tempbx = SiS_Pr->PanelHT - SiS_Pr->PanelXRes; 3418 tempax = SiS_Pr->SiS_VGAHDE; /* not /2 ! */ 3419 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { 3420 tempax = SiS_Pr->PanelXRes; 3421 } 3422 tempbx += tempax; 3423 if(modeflag & HalfDCLK) tempbx -= VGAHDE; 3424 #endif 3425 } 3426 SiS_Pr->CHTotal = SiS_Pr->CHBlankEnd = tempbx; 3427 3428 if(SiS_Pr->ChipType < SIS_315H) { 3429 #ifdef CONFIG_FB_SIS_300 3430 if(SiS_Pr->SiS_VGAHDE == SiS_Pr->PanelXRes) { 3431 SiS_Pr->CHSyncStart = SiS_Pr->SiS_VGAHDE + ((SiS_Pr->PanelHRS + 1) & ~1); 3432 SiS_Pr->CHSyncEnd = SiS_Pr->CHSyncStart + SiS_Pr->PanelHRE; 3433 if(modeflag & HalfDCLK) { 3434 SiS_Pr->CHSyncStart >>= 1; 3435 SiS_Pr->CHSyncEnd >>= 1; 3436 } 3437 } else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { 3438 tempax = (SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE) >> 1; 3439 tempbx = (SiS_Pr->PanelHRS + 1) & ~1; 3440 if(modeflag & HalfDCLK) { 3441 tempax >>= 1; 3442 tempbx >>= 1; 3443 } 3444 SiS_Pr->CHSyncStart = (VGAHDE + tempax + tempbx + 7) & ~7; 3445 tempax = SiS_Pr->PanelHRE + 7; 3446 if(modeflag & HalfDCLK) tempax >>= 1; 3447 SiS_Pr->CHSyncEnd = (SiS_Pr->CHSyncStart + tempax) & ~7; 3448 } else { 3449 SiS_Pr->CHSyncStart = SiS_Pr->SiS_VGAHDE; 3450 if(modeflag & HalfDCLK) { 3451 SiS_Pr->CHSyncStart >>= 1; 3452 tempax = ((SiS_Pr->CHTotal - SiS_Pr->CHSyncStart) / 3) << 1; 3453 SiS_Pr->CHSyncEnd = SiS_Pr->CHSyncStart + tempax; 3454 } else { 3455 SiS_Pr->CHSyncEnd = (SiS_Pr->CHSyncStart + (SiS_Pr->CHTotal / 10) + 7) & ~7; 3456 SiS_Pr->CHSyncStart += 8; 3457 } 3458 } 3459 #endif 3460 } else { 3461 #ifdef CONFIG_FB_SIS_315 3462 tempax = VGAHDE; 3463 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { 3464 tempbx = SiS_Pr->PanelXRes; 3465 if(modeflag & HalfDCLK) tempbx >>= 1; 3466 tempax += ((tempbx - tempax) >> 1); 3467 } 3468 tempax += SiS_Pr->PanelHRS; 3469 SiS_Pr->CHSyncStart = tempax; 3470 tempax += SiS_Pr->PanelHRE; 3471 SiS_Pr->CHSyncEnd = tempax; 3472 #endif 3473 } 3474 3475 tempbx = SiS_Pr->PanelVT - SiS_Pr->PanelYRes; 3476 tempax = SiS_Pr->SiS_VGAVDE; 3477 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { 3478 tempax = SiS_Pr->PanelYRes; 3479 } else if(SiS_Pr->ChipType < SIS_315H) { 3480 #ifdef CONFIG_FB_SIS_300 3481 /* Stupid hack for 640x400/320x200 */ 3482 if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { 3483 if((tempax + tempbx) == 438) tempbx += 16; 3484 } else if((SiS_Pr->SiS_LCDResInfo == Panel_800x600) || 3485 (SiS_Pr->SiS_LCDResInfo == Panel_1024x600)) { 3486 tempax = 0; 3487 tempbx = SiS_Pr->SiS_VGAVT; 3488 } 3489 #endif 3490 } 3491 SiS_Pr->CVTotal = SiS_Pr->CVBlankEnd = tempbx + tempax; 3492 3493 tempax = SiS_Pr->SiS_VGAVDE; 3494 if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { 3495 tempax += (SiS_Pr->PanelYRes - tempax) >> 1; 3496 } 3497 tempax += SiS_Pr->PanelVRS; 3498 SiS_Pr->CVSyncStart = tempax; 3499 tempax += SiS_Pr->PanelVRE; 3500 SiS_Pr->CVSyncEnd = tempax; 3501 if(SiS_Pr->ChipType < SIS_315H) { 3502 SiS_Pr->CVSyncStart--; 3503 SiS_Pr->CVSyncEnd--; 3504 } 3505 3506 SiS_CalcCRRegisters(SiS_Pr, 8); 3507 SiS_Pr->CCRT1CRTC[15] &= ~0xF8; 3508 SiS_Pr->CCRT1CRTC[15] |= (remaining << 4); 3509 SiS_Pr->CCRT1CRTC[16] &= ~0xE0; 3510 3511 SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f); 3512 3513 for(i = 0, j = 0; i <= 7; i++, j++) { 3514 SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]); 3515 } 3516 for(j = 0x10; i <= 10; i++, j++) { 3517 SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]); 3518 } 3519 for(j = 0x15; i <= 12; i++, j++) { 3520 SiS_SetReg(SiS_Pr->SiS_P3d4,j,SiS_Pr->CCRT1CRTC[i]); 3521 } 3522 for(j = 0x0A; i <= 15; i++, j++) { 3523 SiS_SetReg(SiS_Pr->SiS_P3c4,j,SiS_Pr->CCRT1CRTC[i]); 3524 } 3525 3526 tempax = SiS_Pr->CCRT1CRTC[16] & 0xE0; 3527 SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0x1F,tempax); 3528 3529 tempax = (SiS_Pr->CCRT1CRTC[16] & 0x01) << 5; 3530 if(modeflag & DoubleScanMode) tempax |= 0x80; 3531 SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,0x5F,tempax); 3532 3533 } 3534 3535 void 3536 SiS_Generic_ConvertCRData(struct SiS_Private *SiS_Pr, unsigned char *crdata, 3537 int xres, int yres, 3538 struct fb_var_screeninfo *var, bool writeres 3539 ) 3540 { 3541 unsigned short HRE, HBE, HRS, HBS, HDE, HT; 3542 unsigned short VRE, VBE, VRS, VBS, VDE, VT; 3543 unsigned char sr_data, cr_data, cr_data2; 3544 int A, B, C, D, E, F, temp; 3545 3546 sr_data = crdata[14]; 3547 3548 /* Horizontal total */ 3549 HT = crdata[0] | ((unsigned short)(sr_data & 0x03) << 8); 3550 A = HT + 5; 3551 3552 /* Horizontal display enable end */ 3553 HDE = crdata[1] | ((unsigned short)(sr_data & 0x0C) << 6); 3554 E = HDE + 1; 3555 3556 /* Horizontal retrace (=sync) start */ 3557 HRS = crdata[4] | ((unsigned short)(sr_data & 0xC0) << 2); 3558 F = HRS - E - 3; 3559 3560 /* Horizontal blank start */ 3561 HBS = crdata[2] | ((unsigned short)(sr_data & 0x30) << 4); 3562 3563 sr_data = crdata[15]; 3564 cr_data = crdata[5]; 3565 3566 /* Horizontal blank end */ 3567 HBE = (crdata[3] & 0x1f) | 3568 ((unsigned short)(cr_data & 0x80) >> 2) | 3569 ((unsigned short)(sr_data & 0x03) << 6); 3570 3571 /* Horizontal retrace (=sync) end */ 3572 HRE = (cr_data & 0x1f) | ((sr_data & 0x04) << 3); 3573 3574 temp = HBE - ((E - 1) & 255); 3575 B = (temp > 0) ? temp : (temp + 256); 3576 3577 temp = HRE - ((E + F + 3) & 63); 3578 C = (temp > 0) ? temp : (temp + 64); 3579 3580 D = B - F - C; 3581 3582 if(writeres) var->xres = xres = E * 8; 3583 var->left_margin = D * 8; 3584 var->right_margin = F * 8; 3585 var->hsync_len = C * 8; 3586 3587 /* Vertical */ 3588 sr_data = crdata[13]; 3589 cr_data = crdata[7]; 3590 3591 /* Vertical total */ 3592 VT = crdata[6] | 3593 ((unsigned short)(cr_data & 0x01) << 8) | 3594 ((unsigned short)(cr_data & 0x20) << 4) | 3595 ((unsigned short)(sr_data & 0x01) << 10); 3596 A = VT + 2; 3597 3598 /* Vertical display enable end */ 3599 VDE = crdata[10] | 3600 ((unsigned short)(cr_data & 0x02) << 7) | 3601 ((unsigned short)(cr_data & 0x40) << 3) | 3602 ((unsigned short)(sr_data & 0x02) << 9); 3603 E = VDE + 1; 3604 3605 /* Vertical retrace (=sync) start */ 3606 VRS = crdata[8] | 3607 ((unsigned short)(cr_data & 0x04) << 6) | 3608 ((unsigned short)(cr_data & 0x80) << 2) | 3609 ((unsigned short)(sr_data & 0x08) << 7); 3610 F = VRS + 1 - E; 3611 3612 cr_data2 = (crdata[16] & 0x01) << 5; 3613 3614 /* Vertical blank start */ 3615 VBS = crdata[11] | 3616 ((unsigned short)(cr_data & 0x08) << 5) | 3617 ((unsigned short)(cr_data2 & 0x20) << 4) | 3618 ((unsigned short)(sr_data & 0x04) << 8); 3619 3620 /* Vertical blank end */ 3621 VBE = crdata[12] | ((unsigned short)(sr_data & 0x10) << 4); 3622 temp = VBE - ((E - 1) & 511); 3623 B = (temp > 0) ? temp : (temp + 512); 3624 3625 /* Vertical retrace (=sync) end */ 3626 VRE = (crdata[9] & 0x0f) | ((sr_data & 0x20) >> 1); 3627 temp = VRE - ((E + F - 1) & 31); 3628 C = (temp > 0) ? temp : (temp + 32); 3629 3630 D = B - F - C; 3631 3632 if(writeres) var->yres = yres = E; 3633 var->upper_margin = D; 3634 var->lower_margin = F; 3635 var->vsync_len = C; 3636 3637 if((xres == 320) && ((yres == 200) || (yres == 240))) { 3638 /* Terrible hack, but correct CRTC data for 3639 * these modes only produces a black screen... 3640 * (HRE is 0, leading into a too large C and 3641 * a negative D. The CRT controller does not 3642 * seem to like correcting HRE to 50) 3643 */ 3644 var->left_margin = (400 - 376); 3645 var->right_margin = (328 - 320); 3646 var->hsync_len = (376 - 328); 3647 3648 } 3649 3650 } 3651 3652 3653 3654 3655