drivers/video/fbdev/sis/init301.c

/* [<][>][^][v][top][bottom][index][help] */
This source file includes following definitions.
SiS_UnLockCRT2
SiS_LockCRT2
SiS_SetRegSR11ANDOR
GetLCDStructPtr661
GetLCDStructPtr661_2
SiS_AdjustCRT2Rate
SiS_GetRatePtr
SiS_SaveCRT2Info
SiS_CR36BIOSWord23b
SiS_CR36BIOSWord23d
SiS_DDC2Delay
SiS_GenericDelay
SiS_LongDelay
SiS_ShortDelay
SiS_PanelDelay
SiS_PanelDelayLoop
SiS_WaitRetrace1
SiS_WaitRetrace2
SiS_WaitVBRetrace
SiS_VBWait
SiS_VBLongWait
SiS_Is301B
SiS_CRT2IsLCD
SiS_IsDualEdge
SiS_IsVAMode
SiS_IsVAorLCD
SiS_IsDualLink
SiS_TVEnabled
SiS_LCDAEnabled
SiS_WeHaveBacklightCtrl
SiS_IsNotM650orLater
SiS_IsYPbPr
SiS_IsChScart
SiS_IsTVOrYPbPrOrScart
SiS_IsLCDOrLCDA
SiS_HaveBridge
SiS_BridgeIsEnabled
SiS_BridgeInSlavemode
SiS_SetChrontelGPIO
SiS_GetVBInfo
SiS_SetYPbPr
SiS_SetTVMode
SiS_GetBIOSLCDResInfo
SiS_GetLCDInfoBIOS
SiS_CheckScaling
SiS_GetLCDResInfo
SiS_GetVCLK2Ptr
SiS_SetCRT2ModeRegs
SiS_GetResInfo
SiS_GetCRT2ResInfo
SiS_GetCRT2Ptr
SiS_GetRAMDAC2DATA
SiS_CalcPanelLinkTiming
SiS_GetCRT2DataLVDS
SiS_GetCRT2Data301
SiS_GetCRT2Data
SiS_GetLVDSDesPtr
SiS_GetLVDSDesData
SiS_HandlePWD
SiS_DisableBridge
SiS_EnableBridge
SiS_SetCRT2Offset
SiS_SetCRT2Sync
SiS_SetCRT2FIFO_300
SiS_SetCRT2FIFO_310
SiS_GetVGAHT2
SiS_SetGroup1_301
SiS_SetGroup1_LVDS
SiS_SetGroup1
SiS_GetGroup2CLVXPtr
SiS_SetGroup2_C_ELV
SiS_GetCRT2Part2Ptr
SiS_Group2LCDSpecial
SiS_Set300Part2Regs
SiS_SetTVSpecial
SiS_SetGroup2_Tail
SiS_SetGroup2
SiS_SetGroup3
SiS_ShiftXPos
SiS_SetGroup4_C_ELV
SiS_SetCRT2VCLK
SiS_SetDualLinkEtc
SiS_SetGroup4
SiS_SetGroup5
SiS_GetLVDSCRT1Ptr
SiS_ModCRT1CRTC
SiS_SetCRT2ECLK
SiS_SetCHTVReg
SiS_Chrontel701xBLOn
SiS_Chrontel701xBLOff
SiS_ChrontelPowerSequencing
SiS_SetCH701xForLCD
SiS_ChrontelResetVSync
SiS_Chrontel701xOn
SiS_Chrontel701xOff
SiS_ChrontelResetDB
SiS_ChrontelInitTVVSync
SiS_ChrontelDoSomething3
SiS_ChrontelDoSomething2
SiS_ChrontelDoSomething1
SiS_SetCRT2Group
SiS_SiS30xBLOn
SiS_SiS30xBLOff
SiS_SetupDDCN
SiS_SetTrumpBlockLoop
SiS_SetTrumpionBlock
SiS_SetChReg
SiS_SetCH700x
SiS_SetCH701x
SiS_SetCH70xx
SiS_GetChReg
SiS_GetCH700x
SiS_GetCH701x
SiS_GetCH70xx
SiS_SetCH70xxANDOR
SiS_InitDDCRegs
SiS_WriteDABDDC
SiS_PrepareReadDDC
SiS_PrepareDDC
SiS_SendACK
SiS_DoProbeDDC
SiS_ProbeDDC
SiS_ReadDDC
SiS_HandleDDC
SiS_SetSwitchDDC2
SiS_ReadDDC1Bit
SiS_SetStart
SiS_SetStop
SiS_WriteDDC2Data
SiS_ReadDDC2Data
SiS_SetSCLKLow
SiS_SetSCLKHigh
SiS_CheckACK
GetRAMDACromptr
GetLCDromptr
GetTVromptr
GetLCDPtrIndexBIOS
GetLCDPtrIndex
GetTVPtrIndex
GetOEMTVPtr661_2_GEN
GetOEMTVPtr661_2_OLD
GetOEMTVPtr661_2_NEW
GetOEMTVPtr661
SetDelayComp
SetAntiFlicker
SetEdgeEnhance
SetYFilter
SetPhaseIncr
SetDelayComp661
SetCRT2SyncDither661
SetPanelParms661
SiS_OEM310Setting
SiS_OEM661Setting
SiS_FinalizeLCD
SetOEMLCDData2
GetOEMLCDPtr
SetOEMLCDDelay
SetOEMLCDData
GetOEMTVPtr
SetOEMTVDelay
SetOEMAntiFlicker
SetOEMPhaseIncr
SetOEMYFilter
SiS_SearchVBModeID
SiS_OEM300Setting
   1 /* $XFree86$ */
   2 /* $XdotOrg$ */
   3 /*
   4  * Mode initializing code (CRT2 section)
   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 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 
  60 #if 1
  61 #define SET_EMI         /* 302LV/ELV: Set EMI values */
  62 #endif
  63 
  64 #if 1
  65 #define SET_PWD         /* 301/302LV: Set PWD */
  66 #endif
  67 
  68 #define COMPAL_HACK     /* Needed for Compal 1400x1050 (EMI) */
  69 #define COMPAQ_HACK     /* Needed for Inventec/Compaq 1280x1024 (EMI) */
  70 #define ASUS_HACK       /* Needed for Asus A2H 1024x768 (EMI) */
  71 
  72 #include "init301.h"
  73 
  74 #ifdef CONFIG_FB_SIS_300
  75 #include "oem300.h"
  76 #endif
  77 
  78 #ifdef CONFIG_FB_SIS_315
  79 #include "oem310.h"
  80 #endif
  81 
  82 #define SiS_I2CDELAY      1000
  83 #define SiS_I2CDELAYSHORT  150
  84 
  85 static const unsigned char SiS_YPbPrTable[3][64] = {
  86   {
  87     0x17,0x1d,0x03,0x09,0x05,0x06,0x0c,0x0c,
  88     0x94,0x49,0x01,0x0a,0x06,0x0d,0x04,0x0a,
  89     0x06,0x14,0x0d,0x04,0x0a,0x00,0x85,0x1b,
  90     0x0c,0x50,0x00,0x97,0x00,0xda,0x4a,0x17,
  91     0x7d,0x05,0x4b,0x00,0x00,0xe2,0x00,0x02,
  92     0x03,0x0a,0x65,0x9d /*0x8d*/,0x08,0x92,0x8f,0x40,
  93     0x60,0x80,0x14,0x90,0x8c,0x60,0x14,0x53 /*0x50*/,
  94     0x00,0x40,0x44,0x00,0xdb,0x02,0x3b,0x00
  95   },
  96   {
  97     0x33,0x06,0x06,0x09,0x0b,0x0c,0x0c,0x0c,
  98     0x98,0x0a,0x01,0x0d,0x06,0x0d,0x04,0x0a,
  99     0x06,0x14,0x0d,0x04,0x0a,0x00,0x85,0x3f,
 100     0x0c,0x50,0xb2,0x9f,0x16,0x59,0x4f,0x13,
 101     0xad,0x11,0xad,0x1d,0x40,0x8a,0x3d,0xb8,
 102     0x51,0x5e,0x60,0x49,0x7d,0x92,0x0f,0x40,
 103     0x60,0x80,0x14,0x90,0x8c,0x60,0x14,0x4e,
 104     0x43,0x41,0x11,0x00,0xfc,0xff,0x32,0x00
 105   },
 106   {
 107 #if 0 /* OK, but sticks to left edge */
 108     0x13,0x1d,0xe8,0x09,0x09,0xed,0x0c,0x0c,
 109     0x98,0x0a,0x01,0x0c,0x06,0x0d,0x04,0x0a,
 110     0x06,0x14,0x0d,0x04,0x0a,0x00,0x85,0x3f,
 111     0xed,0x50,0x70,0x9f,0x16,0x59,0x21 /*0x2b*/,0x13,
 112     0x27,0x0b,0x27,0xfc,0x30,0x27,0x1c,0xb0,
 113     0x4b,0x4b,0x65 /*0x6f*/,0x2f,0x63,0x92,0x0f,0x40,
 114     0x60,0x80,0x14,0x90,0x8c,0x60,0x14,0x27,
 115     0x00,0x40,0x11,0x00,0xfc,0xff,0x32,0x00
 116 #endif
 117 #if 1 /* Perfect */
 118     0x23,0x2d,0xe8,0x09,0x09,0xed,0x0c,0x0c,
 119     0x98,0x0a,0x01,0x0c,0x06,0x0d,0x04,0x0a,
 120     0x06,0x14,0x0d,0x04,0x0a,0x00,0x85,0x3f,
 121     0xed,0x50,0x70,0x9f,0x16,0x59,0x60,0x13,
 122     0x27,0x0b,0x27,0xfc,0x30,0x27,0x1c,0xb0,
 123     0x4b,0x4b,0x6f,0x2f,0x63,0x92,0x0f,0x40,
 124     0x60,0x80,0x14,0x90,0x8c,0x60,0x14,0x73,
 125     0x00,0x40,0x11,0x00,0xfc,0xff,0x32,0x00
 126 #endif
 127   }
 128 };
 129 
 130 static const unsigned char SiS_TVPhase[] =
 131 {
 132         0x21,0xED,0xBA,0x08,    /* 0x00 SiS_NTSCPhase */
 133         0x2A,0x05,0xE3,0x00,    /* 0x01 SiS_PALPhase */
 134         0x21,0xE4,0x2E,0x9B,    /* 0x02 SiS_PALMPhase */
 135         0x21,0xF4,0x3E,0xBA,    /* 0x03 SiS_PALNPhase */
 136         0x1E,0x8B,0xA2,0xA7,
 137         0x1E,0x83,0x0A,0xE0,    /* 0x05 SiS_SpecialPhaseM */
 138         0x00,0x00,0x00,0x00,
 139         0x00,0x00,0x00,0x00,
 140         0x21,0xF0,0x7B,0xD6,    /* 0x08 SiS_NTSCPhase2 */
 141         0x2A,0x09,0x86,0xE9,    /* 0x09 SiS_PALPhase2 */
 142         0x21,0xE6,0xEF,0xA4,    /* 0x0a SiS_PALMPhase2 */
 143         0x21,0xF6,0x94,0x46,    /* 0x0b SiS_PALNPhase2 */
 144         0x1E,0x8B,0xA2,0xA7,
 145         0x1E,0x83,0x0A,0xE0,    /* 0x0d SiS_SpecialPhaseM */
 146         0x00,0x00,0x00,0x00,
 147         0x00,0x00,0x00,0x00,
 148         0x1e,0x8c,0x5c,0x7a,    /* 0x10 SiS_SpecialPhase */
 149         0x25,0xd4,0xfd,0x5e     /* 0x11 SiS_SpecialPhaseJ */
 150 };
 151 
 152 static const unsigned char SiS_HiTVGroup3_1[] = {
 153     0x00, 0x14, 0x15, 0x25, 0x55, 0x15, 0x0b, 0x13,
 154     0xb1, 0x41, 0x62, 0x62, 0xff, 0xf4, 0x45, 0xa6,
 155     0x25, 0x2f, 0x67, 0xf6, 0xbf, 0xff, 0x8e, 0x20,
 156     0xac, 0xda, 0x60, 0xfe, 0x6a, 0x9a, 0x06, 0x10,
 157     0xd1, 0x04, 0x18, 0x0a, 0xff, 0x80, 0x00, 0x80,
 158     0x3b, 0x77, 0x00, 0xef, 0xe0, 0x10, 0xb0, 0xe0,
 159     0x10, 0x4f, 0x0f, 0x0f, 0x05, 0x0f, 0x08, 0x6e,
 160     0x1a, 0x1f, 0x25, 0x2a, 0x4c, 0xaa, 0x01
 161 };
 162 
 163 static const unsigned char SiS_HiTVGroup3_2[] = {
 164     0x00, 0x14, 0x15, 0x25, 0x55, 0x15, 0x0b, 0x7a,
 165     0x54, 0x41, 0xe7, 0xe7, 0xff, 0xf4, 0x45, 0xa6,
 166     0x25, 0x2f, 0x67, 0xf6, 0xbf, 0xff, 0x8e, 0x20,
 167     0xac, 0x6a, 0x60, 0x2b, 0x52, 0xcd, 0x61, 0x10,
 168     0x51, 0x04, 0x18, 0x0a, 0x1f, 0x80, 0x00, 0x80,
 169     0xff, 0xa4, 0x04, 0x2b, 0x94, 0x21, 0x72, 0x94,
 170     0x26, 0x05, 0x01, 0x0f, 0xed, 0x0f, 0x0a, 0x64,
 171     0x18, 0x1d, 0x23, 0x28, 0x4c, 0xaa, 0x01
 172 };
 173 
 174 /* 301C / 302ELV extended Part2 TV registers (4 tap scaler) */
 175 
 176 static const unsigned char SiS_Part2CLVX_1[] = {
 177     0x00,0x00,
 178     0x00,0x20,0x00,0x00,0x7F,0x20,0x02,0x7F,0x7D,0x20,0x04,0x7F,0x7D,0x1F,0x06,0x7E,
 179     0x7C,0x1D,0x09,0x7E,0x7C,0x1B,0x0B,0x7E,0x7C,0x19,0x0E,0x7D,0x7C,0x17,0x11,0x7C,
 180     0x7C,0x14,0x14,0x7C,0x7C,0x11,0x17,0x7C,0x7D,0x0E,0x19,0x7C,0x7E,0x0B,0x1B,0x7C,
 181     0x7E,0x09,0x1D,0x7C,0x7F,0x06,0x1F,0x7C,0x7F,0x04,0x20,0x7D,0x00,0x02,0x20,0x7E
 182 };
 183 
 184 static const unsigned char SiS_Part2CLVX_2[] = {
 185     0x00,0x00,
 186     0x00,0x20,0x00,0x00,0x7F,0x20,0x02,0x7F,0x7D,0x20,0x04,0x7F,0x7D,0x1F,0x06,0x7E,
 187     0x7C,0x1D,0x09,0x7E,0x7C,0x1B,0x0B,0x7E,0x7C,0x19,0x0E,0x7D,0x7C,0x17,0x11,0x7C,
 188     0x7C,0x14,0x14,0x7C,0x7C,0x11,0x17,0x7C,0x7D,0x0E,0x19,0x7C,0x7E,0x0B,0x1B,0x7C,
 189     0x7E,0x09,0x1D,0x7C,0x7F,0x06,0x1F,0x7C,0x7F,0x04,0x20,0x7D,0x00,0x02,0x20,0x7E
 190 };
 191 
 192 static const unsigned char SiS_Part2CLVX_3[] = {  /* NTSC, 525i, 525p */
 193     0xE0,0x01,
 194     0x04,0x1A,0x04,0x7E,0x03,0x1A,0x06,0x7D,0x01,0x1A,0x08,0x7D,0x00,0x19,0x0A,0x7D,
 195     0x7F,0x19,0x0C,0x7C,0x7E,0x18,0x0E,0x7C,0x7E,0x17,0x10,0x7B,0x7D,0x15,0x12,0x7C,
 196     0x7D,0x13,0x13,0x7D,0x7C,0x12,0x15,0x7D,0x7C,0x10,0x17,0x7D,0x7C,0x0E,0x18,0x7E,
 197     0x7D,0x0C,0x19,0x7E,0x7D,0x0A,0x19,0x00,0x7D,0x08,0x1A,0x01,0x7E,0x06,0x1A,0x02,
 198     0x58,0x02,
 199     0x07,0x14,0x07,0x7E,0x06,0x14,0x09,0x7D,0x05,0x14,0x0A,0x7D,0x04,0x13,0x0B,0x7E,
 200     0x03,0x13,0x0C,0x7E,0x02,0x12,0x0D,0x7F,0x01,0x12,0x0E,0x7F,0x01,0x11,0x0F,0x7F,
 201     0x00,0x10,0x10,0x00,0x7F,0x0F,0x11,0x01,0x7F,0x0E,0x12,0x01,0x7E,0x0D,0x12,0x03,
 202     0x7E,0x0C,0x13,0x03,0x7E,0x0B,0x13,0x04,0x7E,0x0A,0x14,0x04,0x7D,0x09,0x14,0x06,
 203     0x00,0x03,
 204     0x09,0x0F,0x09,0x7F,0x08,0x0F,0x09,0x00,0x07,0x0F,0x0A,0x00,0x06,0x0F,0x0A,0x01,
 205     0x06,0x0E,0x0B,0x01,0x05,0x0E,0x0B,0x02,0x04,0x0E,0x0C,0x02,0x04,0x0D,0x0C,0x03,
 206     0x03,0x0D,0x0D,0x03,0x02,0x0C,0x0D,0x05,0x02,0x0C,0x0E,0x04,0x01,0x0B,0x0E,0x06,
 207     0x01,0x0B,0x0E,0x06,0x00,0x0A,0x0F,0x07,0x00,0x0A,0x0F,0x07,0x00,0x09,0x0F,0x08,
 208     0xFF,0xFF
 209 };
 210 
 211 static const unsigned char SiS_Part2CLVX_4[] = {   /* PAL */
 212     0x58,0x02,
 213     0x05,0x19,0x05,0x7D,0x03,0x19,0x06,0x7E,0x02,0x19,0x08,0x7D,0x01,0x18,0x0A,0x7D,
 214     0x00,0x18,0x0C,0x7C,0x7F,0x17,0x0E,0x7C,0x7E,0x16,0x0F,0x7D,0x7E,0x14,0x11,0x7D,
 215     0x7D,0x13,0x13,0x7D,0x7D,0x11,0x14,0x7E,0x7D,0x0F,0x16,0x7E,0x7D,0x0E,0x17,0x7E,
 216     0x7D,0x0C,0x18,0x7F,0x7D,0x0A,0x18,0x01,0x7D,0x08,0x19,0x02,0x7D,0x06,0x19,0x04,
 217     0x00,0x03,
 218     0x08,0x12,0x08,0x7E,0x07,0x12,0x09,0x7E,0x06,0x12,0x0A,0x7E,0x05,0x11,0x0B,0x7F,
 219     0x04,0x11,0x0C,0x7F,0x03,0x11,0x0C,0x00,0x03,0x10,0x0D,0x00,0x02,0x0F,0x0E,0x01,
 220     0x01,0x0F,0x0F,0x01,0x01,0x0E,0x0F,0x02,0x00,0x0D,0x10,0x03,0x7F,0x0C,0x11,0x04,
 221     0x7F,0x0C,0x11,0x04,0x7F,0x0B,0x11,0x05,0x7E,0x0A,0x12,0x06,0x7E,0x09,0x12,0x07,
 222     0x40,0x02,
 223     0x04,0x1A,0x04,0x7E,0x02,0x1B,0x05,0x7E,0x01,0x1A,0x07,0x7E,0x00,0x1A,0x09,0x7D,
 224     0x7F,0x19,0x0B,0x7D,0x7E,0x18,0x0D,0x7D,0x7D,0x17,0x10,0x7C,0x7D,0x15,0x12,0x7C,
 225     0x7C,0x14,0x14,0x7C,0x7C,0x12,0x15,0x7D,0x7C,0x10,0x17,0x7D,0x7C,0x0D,0x18,0x7F,
 226     0x7D,0x0B,0x19,0x7F,0x7D,0x09,0x1A,0x00,0x7D,0x07,0x1A,0x02,0x7E,0x05,0x1B,0x02,
 227     0xFF,0xFF
 228 };
 229 
 230 static const unsigned char SiS_Part2CLVX_5[] = {   /* 750p */
 231     0x00,0x03,
 232     0x05,0x19,0x05,0x7D,0x03,0x19,0x06,0x7E,0x02,0x19,0x08,0x7D,0x01,0x18,0x0A,0x7D,
 233     0x00,0x18,0x0C,0x7C,0x7F,0x17,0x0E,0x7C,0x7E,0x16,0x0F,0x7D,0x7E,0x14,0x11,0x7D,
 234     0x7D,0x13,0x13,0x7D,0x7D,0x11,0x14,0x7E,0x7D,0x0F,0x16,0x7E,0x7D,0x0E,0x17,0x7E,
 235     0x7D,0x0C,0x18,0x7F,0x7D,0x0A,0x18,0x01,0x7D,0x08,0x19,0x02,0x7D,0x06,0x19,0x04,
 236     0xFF,0xFF
 237 };
 238 
 239 static const unsigned char SiS_Part2CLVX_6[] = {   /* 1080i */
 240     0x00,0x04,
 241     0x04,0x1A,0x04,0x7E,0x02,0x1B,0x05,0x7E,0x01,0x1A,0x07,0x7E,0x00,0x1A,0x09,0x7D,
 242     0x7F,0x19,0x0B,0x7D,0x7E,0x18,0x0D,0x7D,0x7D,0x17,0x10,0x7C,0x7D,0x15,0x12,0x7C,
 243     0x7C,0x14,0x14,0x7C,0x7C,0x12,0x15,0x7D,0x7C,0x10,0x17,0x7D,0x7C,0x0D,0x18,0x7F,
 244     0x7D,0x0B,0x19,0x7F,0x7D,0x09,0x1A,0x00,0x7D,0x07,0x1A,0x02,0x7E,0x05,0x1B,0x02,
 245     0xFF,0xFF,
 246 };
 247 
 248 #ifdef CONFIG_FB_SIS_315
 249 /* 661 et al LCD data structure (2.03.00) */
 250 static const unsigned char SiS_LCDStruct661[] = {
 251     /* 1024x768 */
 252 /*  type|CR37|   HDE   |   VDE   |    HT   |    VT   |   hss    | hse   */
 253     0x02,0xC0,0x00,0x04,0x00,0x03,0x40,0x05,0x26,0x03,0x10,0x00,0x88,
 254     0x00,0x02,0x00,0x06,0x00,0x41,0x5A,0x64,0x00,0x00,0x00,0x00,0x04,
 255     /*  | vss     |    vse  |clck|  clock  |CRT2DataP|CRT2DataP|idx     */
 256     /*                                        VESA    non-VESA  noscale */
 257     /* 1280x1024 */
 258     0x03,0xC0,0x00,0x05,0x00,0x04,0x98,0x06,0x2A,0x04,0x30,0x00,0x70,
 259     0x00,0x01,0x00,0x03,0x00,0x6C,0xF8,0x2F,0x00,0x00,0x00,0x00,0x08,
 260     /* 1400x1050 */
 261     0x09,0x20,0x78,0x05,0x1A,0x04,0x98,0x06,0x2A,0x04,0x18,0x00,0x38,
 262     0x00,0x01,0x00,0x03,0x00,0x6C,0xF8,0x2F,0x00,0x00,0x00,0x00,0x09,
 263     /* 1600x1200 */
 264     0x0B,0xE0,0x40,0x06,0xB0,0x04,0x70,0x08,0xE2,0x04,0x40,0x00,0xC0,
 265     0x00,0x01,0x00,0x03,0x00,0xA2,0x70,0x24,0x00,0x00,0x00,0x00,0x0A,
 266     /* 1280x768 (_2) */
 267     0x0A,0xE0,0x00,0x05,0x00,0x03,0x7C,0x06,0x26,0x03,0x30,0x00,0x70,
 268     0x00,0x03,0x00,0x06,0x00,0x4D,0xC8,0x48,0x00,0x00,0x00,0x00,0x06,
 269     /* 1280x720 */
 270     0x0E,0xE0,0x00,0x05,0xD0,0x02,0x80,0x05,0x26,0x03,0x10,0x00,0x20,
 271     0x00,0x01,0x00,0x06,0x00,0x45,0x9C,0x62,0x00,0x00,0x00,0x00,0x05,
 272     /* 1280x800 (_2) */
 273     0x0C,0xE0,0x00,0x05,0x20,0x03,0x10,0x06,0x2C,0x03,0x30,0x00,0x70,
 274     0x00,0x04,0x00,0x03,0x00,0x49,0xCE,0x1E,0x00,0x00,0x00,0x00,0x09,
 275     /* 1680x1050 */
 276     0x0D,0xE0,0x90,0x06,0x1A,0x04,0x6C,0x07,0x2A,0x04,0x1A,0x00,0x4C,
 277     0x00,0x03,0x00,0x06,0x00,0x79,0xBE,0x44,0x00,0x00,0x00,0x00,0x06,
 278     /* 1280x800_3 */
 279     0x0C,0xE0,0x00,0x05,0x20,0x03,0xAA,0x05,0x2E,0x03,0x30,0x00,0x50,
 280     0x00,0x04,0x00,0x03,0x00,0x47,0xA9,0x10,0x00,0x00,0x00,0x00,0x07,
 281     /* 800x600 */
 282     0x01,0xC0,0x20,0x03,0x58,0x02,0x20,0x04,0x74,0x02,0x2A,0x00,0x80,
 283     0x00,0x06,0x00,0x04,0x00,0x28,0x63,0x4B,0x00,0x00,0x00,0x00,0x00,
 284     /* 1280x854 */
 285     0x08,0xE0,0x00,0x05,0x56,0x03,0x80,0x06,0x5d,0x03,0x10,0x00,0x70,
 286     0x00,0x01,0x00,0x03,0x00,0x54,0x75,0x13,0x00,0x00,0x00,0x00,0x08
 287 };
 288 #endif
 289 
 290 #ifdef CONFIG_FB_SIS_300
 291 static unsigned char SiS300_TrumpionData[14][80] = {
 292   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x0D,0x00,0x0D,0x10,0x7F,0x00,0x80,0x02,
 293     0x20,0x03,0x0B,0x00,0x90,0x01,0xC1,0x01,0x60,0x0C,0x30,0x10,0x00,0x00,0x04,0x23,
 294     0x00,0x00,0x03,0x28,0x03,0x10,0x05,0x08,0x40,0x10,0x00,0x10,0x04,0x23,0x00,0x23,
 295     0x03,0x11,0x60,0xBC,0x01,0xFF,0x03,0xFF,0x19,0x01,0x00,0x05,0x09,0x04,0x04,0x05,
 296     0x04,0x0C,0x09,0x05,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x5A,0x01,0xBE,0x01,0x00 },
 297   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x0D,0x00,0x0D,0x10,0x27,0x00,0x80,0x02,
 298     0x20,0x03,0x07,0x00,0x5E,0x01,0x0D,0x02,0x60,0x0C,0x30,0x11,0x00,0x00,0x04,0x23,
 299     0x00,0x00,0x03,0x80,0x03,0x28,0x06,0x08,0x40,0x11,0x00,0x11,0x04,0x23,0x00,0x23,
 300     0x03,0x11,0x60,0x90,0x01,0xFF,0x0F,0xF4,0x19,0x01,0x00,0x05,0x01,0x00,0x04,0x05,
 301     0x04,0x0C,0x02,0x01,0x02,0xB0,0x00,0x00,0x02,0xBA,0xEC,0x57,0x01,0xBE,0x01,0x00 },
 302   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x0D,0x00,0x0D,0x10,0x8A,0x00,0xD8,0x02,
 303     0x84,0x03,0x16,0x00,0x90,0x01,0xC1,0x01,0x60,0x0C,0x30,0x1C,0x00,0x20,0x04,0x23,
 304     0x00,0x01,0x03,0x53,0x03,0x28,0x06,0x08,0x40,0x1C,0x00,0x16,0x04,0x23,0x00,0x23,
 305     0x03,0x11,0x60,0xD9,0x01,0xFF,0x0F,0xF4,0x18,0x07,0x05,0x05,0x13,0x04,0x04,0x05,
 306     0x01,0x0B,0x13,0x0A,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x59,0x01,0xBE,0x01,0x00 },
 307   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x0D,0x00,0x0D,0x10,0x72,0x00,0xD8,0x02,
 308     0x84,0x03,0x16,0x00,0x90,0x01,0xC1,0x01,0x60,0x0C,0x30,0x1C,0x00,0x20,0x04,0x23,
 309     0x00,0x01,0x03,0x53,0x03,0x28,0x06,0x08,0x40,0x1C,0x00,0x16,0x04,0x23,0x00,0x23,
 310     0x03,0x11,0x60,0xDA,0x01,0xFF,0x0F,0xF4,0x18,0x07,0x05,0x05,0x13,0x04,0x04,0x05,
 311     0x01,0x0B,0x13,0x0A,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x55,0x01,0xBE,0x01,0x00 },
 312   { 0x02,0x0A,0x02,0x00,0x04,0x01,0x00,0x03,0x0D,0x00,0x0D,0x10,0x7F,0x00,0x80,0x02,
 313     0x20,0x03,0x16,0x00,0xE0,0x01,0x0D,0x02,0x60,0x0C,0x30,0x98,0x00,0x00,0x04,0x23,
 314     0x00,0x01,0x03,0x45,0x03,0x48,0x06,0x08,0x40,0x98,0x00,0x98,0x04,0x23,0x00,0x23,
 315     0x03,0x11,0x60,0xF4,0x01,0xFF,0x0F,0xF4,0x18,0x01,0x00,0x05,0x01,0x00,0x05,0x05,
 316     0x04,0x0C,0x08,0x05,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x5B,0x01,0xBE,0x01,0x00 },
 317   { 0x02,0x0A,0x02,0x01,0x04,0x01,0x00,0x03,0x0D,0x00,0x0D,0x10,0xBF,0x00,0x20,0x03,
 318     0x20,0x04,0x0D,0x00,0x58,0x02,0x71,0x02,0x80,0x0C,0x30,0x9A,0x00,0xFA,0x03,0x1D,
 319     0x00,0x01,0x03,0x22,0x03,0x28,0x06,0x08,0x40,0x98,0x00,0x98,0x04,0x1D,0x00,0x1D,
 320     0x03,0x11,0x60,0x39,0x03,0x40,0x05,0xF4,0x18,0x07,0x02,0x06,0x04,0x01,0x06,0x0B,
 321     0x02,0x0A,0x20,0x19,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x5B,0x01,0xBE,0x01,0x00 },
 322   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x0D,0x00,0x0D,0x10,0xEF,0x00,0x00,0x04,
 323     0x40,0x05,0x13,0x00,0x00,0x03,0x26,0x03,0x88,0x0C,0x30,0x90,0x00,0x00,0x04,0x23,
 324     0x00,0x01,0x03,0x24,0x03,0x28,0x06,0x08,0x40,0x90,0x00,0x90,0x04,0x23,0x00,0x23,
 325     0x03,0x11,0x60,0x40,0x05,0xFF,0x0F,0xF4,0x18,0x01,0x00,0x08,0x01,0x00,0x08,0x01,
 326     0x00,0x08,0x01,0x01,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x5B,0x01,0xBE,0x01,0x00 },
 327   /* variant 2 */
 328   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x11,0x00,0x0D,0x10,0x7F,0x00,0x80,0x02,
 329     0x20,0x03,0x15,0x00,0x90,0x01,0xC1,0x01,0x60,0x0C,0x30,0x18,0x00,0x00,0x04,0x23,
 330     0x00,0x01,0x03,0x44,0x03,0x28,0x06,0x08,0x40,0x18,0x00,0x18,0x04,0x23,0x00,0x23,
 331     0x03,0x11,0x60,0xA6,0x01,0xFF,0x03,0xFF,0x19,0x01,0x00,0x05,0x13,0x04,0x04,0x05,
 332     0x04,0x0C,0x13,0x0A,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x55,0x01,0xBE,0x01,0x00 },
 333   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x11,0x00,0x0D,0x10,0x7F,0x00,0x80,0x02,
 334     0x20,0x03,0x15,0x00,0x90,0x01,0xC1,0x01,0x60,0x0C,0x30,0x18,0x00,0x00,0x04,0x23,
 335     0x00,0x01,0x03,0x44,0x03,0x28,0x06,0x08,0x40,0x18,0x00,0x18,0x04,0x23,0x00,0x23,
 336     0x03,0x11,0x60,0xA6,0x01,0xFF,0x03,0xFF,0x19,0x01,0x00,0x05,0x13,0x04,0x04,0x05,
 337     0x04,0x0C,0x13,0x0A,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x55,0x01,0xBE,0x01,0x00 },
 338   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x11,0x00,0x0D,0x10,0x8A,0x00,0xD8,0x02,
 339     0x84,0x03,0x16,0x00,0x90,0x01,0xC1,0x01,0x60,0x0C,0x30,0x1C,0x00,0x20,0x04,0x23,
 340     0x00,0x01,0x03,0x53,0x03,0x28,0x06,0x08,0x40,0x1C,0x00,0x16,0x04,0x23,0x00,0x23,
 341     0x03,0x11,0x60,0xDA,0x01,0xFF,0x0F,0xF4,0x18,0x07,0x05,0x05,0x13,0x04,0x04,0x05,
 342     0x01,0x0B,0x13,0x0A,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x55,0x01,0xBE,0x01,0x00 },
 343   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x11,0x00,0x0D,0x10,0x72,0x00,0xD8,0x02,
 344     0x84,0x03,0x16,0x00,0x90,0x01,0xC1,0x01,0x60,0x0C,0x30,0x1C,0x00,0x20,0x04,0x23,
 345     0x00,0x01,0x03,0x53,0x03,0x28,0x06,0x08,0x40,0x1C,0x00,0x16,0x04,0x23,0x00,0x23,
 346     0x03,0x11,0x60,0xDA,0x01,0xFF,0x0F,0xF4,0x18,0x07,0x05,0x05,0x13,0x04,0x04,0x05,
 347     0x01,0x0B,0x13,0x0A,0x02,0xB0,0x00,0x00,0x02,0xBA,0xF0,0x55,0x01,0xBE,0x01,0x00 },
 348   { 0x02,0x0A,0x02,0x00,0x04,0x01,0x00,0x03,0x11,0x00,0x0D,0x10,0x7F,0x00,0x80,0x02,
 349     0x20,0x03,0x16,0x00,0xE0,0x01,0x0D,0x02,0x60,0x0C,0x30,0x98,0x00,0x00,0x04,0x23,
 350     0x00,0x01,0x03,0x45,0x03,0x48,0x06,0x08,0x40,0x98,0x00,0x98,0x04,0x23,0x00,0x23,
 351     0x03,0x11,0x60,0xF4,0x01,0xFF,0x0F,0xF4,0x18,0x01,0x00,0x05,0x01,0x00,0x05,0x05,
 352     0x04,0x0C,0x08,0x05,0x02,0xB0,0x00,0x00,0x02,0xBA,0xEA,0x58,0x01,0xBE,0x01,0x00 },
 353   { 0x02,0x0A,0x02,0x01,0x04,0x01,0x00,0x03,0x11,0x00,0x0D,0x10,0xBF,0x00,0x20,0x03,
 354     0x20,0x04,0x0D,0x00,0x58,0x02,0x71,0x02,0x80,0x0C,0x30,0x9A,0x00,0xFA,0x03,0x1D,
 355     0x00,0x01,0x03,0x22,0x03,0x28,0x06,0x08,0x40,0x98,0x00,0x98,0x04,0x1D,0x00,0x1D,
 356     0x03,0x11,0x60,0x39,0x03,0x40,0x05,0xF4,0x18,0x07,0x02,0x06,0x04,0x01,0x06,0x0B,
 357     0x02,0x0A,0x20,0x19,0x02,0xB0,0x00,0x00,0x02,0xBA,0xEA,0x58,0x01,0xBE,0x01,0x00 },
 358   { 0x02,0x0A,0x0A,0x01,0x04,0x01,0x00,0x03,0x11,0x00,0x0D,0x10,0xEF,0x00,0x00,0x04,
 359     0x40,0x05,0x13,0x00,0x00,0x03,0x26,0x03,0x88,0x0C,0x30,0x90,0x00,0x00,0x04,0x23,
 360     0x00,0x01,0x03,0x24,0x03,0x28,0x06,0x08,0x40,0x90,0x00,0x90,0x04,0x23,0x00,0x23,
 361     0x03,0x11,0x60,0x40,0x05,0xFF,0x0F,0xF4,0x18,0x01,0x00,0x08,0x01,0x00,0x08,0x01,
 362     0x00,0x08,0x01,0x01,0x02,0xB0,0x00,0x00,0x02,0xBA,0xEA,0x58,0x01,0xBE,0x01,0x00 }
 363 };
 364 #endif
 365 
 366 #ifdef CONFIG_FB_SIS_315
 367 static void     SiS_Chrontel701xOn(struct SiS_Private *SiS_Pr);
 368 static void     SiS_Chrontel701xOff(struct SiS_Private *SiS_Pr);
 369 static void     SiS_ChrontelInitTVVSync(struct SiS_Private *SiS_Pr);
 370 static void     SiS_ChrontelDoSomething1(struct SiS_Private *SiS_Pr);
 371 #endif /* 315 */
 372 
 373 #ifdef CONFIG_FB_SIS_300
 374 static  bool    SiS_SetTrumpionBlock(struct SiS_Private *SiS_Pr, unsigned char *dataptr);
 375 #endif
 376 
 377 static unsigned short   SiS_InitDDCRegs(struct SiS_Private *SiS_Pr, unsigned int VBFlags,
 378                                 int VGAEngine, unsigned short adaptnum, unsigned short DDCdatatype,
 379                                 bool checkcr32, unsigned int VBFlags2);
 380 static unsigned short   SiS_ProbeDDC(struct SiS_Private *SiS_Pr);
 381 static unsigned short   SiS_ReadDDC(struct SiS_Private *SiS_Pr, unsigned short DDCdatatype,
 382                                 unsigned char *buffer);
 383 static void             SiS_SetSwitchDDC2(struct SiS_Private *SiS_Pr);
 384 static unsigned short   SiS_SetStart(struct SiS_Private *SiS_Pr);
 385 static unsigned short   SiS_SetStop(struct SiS_Private *SiS_Pr);
 386 static unsigned short   SiS_SetSCLKLow(struct SiS_Private *SiS_Pr);
 387 static unsigned short   SiS_SetSCLKHigh(struct SiS_Private *SiS_Pr);
 388 static unsigned short   SiS_ReadDDC2Data(struct SiS_Private *SiS_Pr);
 389 static unsigned short   SiS_WriteDDC2Data(struct SiS_Private *SiS_Pr, unsigned short tempax);
 390 static unsigned short   SiS_CheckACK(struct SiS_Private *SiS_Pr);
 391 static unsigned short   SiS_WriteDABDDC(struct SiS_Private *SiS_Pr);
 392 static unsigned short   SiS_PrepareReadDDC(struct SiS_Private *SiS_Pr);
 393 static unsigned short   SiS_PrepareDDC(struct SiS_Private *SiS_Pr);
 394 static void             SiS_SendACK(struct SiS_Private *SiS_Pr, unsigned short yesno);
 395 static unsigned short   SiS_DoProbeDDC(struct SiS_Private *SiS_Pr);
 396 
 397 #ifdef CONFIG_FB_SIS_300
 398 static void             SiS_OEM300Setting(struct SiS_Private *SiS_Pr,
 399                                 unsigned short ModeNo, unsigned short ModeIdIndex, unsigned short RefTabindex);
 400 static void             SetOEMLCDData2(struct SiS_Private *SiS_Pr,
 401                                 unsigned short ModeNo, unsigned short ModeIdIndex,unsigned short RefTableIndex);
 402 #endif
 403 #ifdef CONFIG_FB_SIS_315
 404 static void             SiS_OEM310Setting(struct SiS_Private *SiS_Pr,
 405                                 unsigned short ModeNo,unsigned short ModeIdIndex, unsigned short RRTI);
 406 static void             SiS_OEM661Setting(struct SiS_Private *SiS_Pr,
 407                                 unsigned short ModeNo,unsigned short ModeIdIndex, unsigned short RRTI);
 408 static void             SiS_FinalizeLCD(struct SiS_Private *, unsigned short, unsigned short);
 409 #endif
 410 
 411 static unsigned short   SiS_GetBIOSLCDResInfo(struct SiS_Private *SiS_Pr);
 412 static void             SiS_SetCH70xx(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val);
 413 
 414 /*********************************************/
 415 /*         HELPER: Lock/Unlock CRT2          */
 416 /*********************************************/
 417 
 418 void
 419 SiS_UnLockCRT2(struct SiS_Private *SiS_Pr)
 420 {
 421    if(SiS_Pr->ChipType == XGI_20)
 422       return;
 423    else if(SiS_Pr->ChipType >= SIS_315H)
 424       SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2f,0x01);
 425    else
 426       SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x24,0x01);
 427 }
 428 
 429 static
 430 void
 431 SiS_LockCRT2(struct SiS_Private *SiS_Pr)
 432 {
 433    if(SiS_Pr->ChipType == XGI_20)
 434       return;
 435    else if(SiS_Pr->ChipType >= SIS_315H)
 436       SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2F,0xFE);
 437    else
 438       SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x24,0xFE);
 439 }
 440 
 441 /*********************************************/
 442 /*            HELPER: Write SR11             */
 443 /*********************************************/
 444 
 445 static void
 446 SiS_SetRegSR11ANDOR(struct SiS_Private *SiS_Pr, unsigned short DataAND, unsigned short DataOR)
 447 {
 448    if(SiS_Pr->ChipType >= SIS_661) {
 449       DataAND &= 0x0f;
 450       DataOR  &= 0x0f;
 451    }
 452    SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x11,DataAND,DataOR);
 453 }
 454 
 455 /*********************************************/
 456 /*    HELPER: Get Pointer to LCD structure   */
 457 /*********************************************/
 458 
 459 #ifdef CONFIG_FB_SIS_315
 460 static unsigned char *
 461 GetLCDStructPtr661(struct SiS_Private *SiS_Pr)
 462 {
 463    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
 464    unsigned char  *myptr = NULL;
 465    unsigned short romindex = 0, reg = 0, idx = 0;
 466 
 467    /* Use the BIOS tables only for LVDS panels; TMDS is unreliable
 468     * due to the variaty of panels the BIOS doesn't know about.
 469     * Exception: If the BIOS has better knowledge (such as in case
 470     * of machines with a 301C and a panel that does not support DDC)
 471     * use the BIOS data as well.
 472     */
 473 
 474    if((SiS_Pr->SiS_ROMNew) &&
 475       ((SiS_Pr->SiS_VBType & VB_SISLVDS) || (!SiS_Pr->PanelSelfDetected))) {
 476 
 477       if(SiS_Pr->ChipType < SIS_661) reg = 0x3c;
 478       else                           reg = 0x7d;
 479 
 480       idx = (SiS_GetReg(SiS_Pr->SiS_P3d4,reg) & 0x1f) * 26;
 481 
 482       if(idx < (8*26)) {
 483          myptr = (unsigned char *)&SiS_LCDStruct661[idx];
 484       }
 485       romindex = SISGETROMW(0x100);
 486       if(romindex) {
 487          romindex += idx;
 488          myptr = &ROMAddr[romindex];
 489       }
 490    }
 491    return myptr;
 492 }
 493 
 494 static unsigned short
 495 GetLCDStructPtr661_2(struct SiS_Private *SiS_Pr)
 496 {
 497    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
 498    unsigned short romptr = 0;
 499 
 500    /* Use the BIOS tables only for LVDS panels; TMDS is unreliable
 501     * due to the variaty of panels the BIOS doesn't know about.
 502     * Exception: If the BIOS has better knowledge (such as in case
 503     * of machines with a 301C and a panel that does not support DDC)
 504     * use the BIOS data as well.
 505     */
 506 
 507    if((SiS_Pr->SiS_ROMNew) &&
 508       ((SiS_Pr->SiS_VBType & VB_SISLVDS) || (!SiS_Pr->PanelSelfDetected))) {
 509       romptr = SISGETROMW(0x102);
 510       romptr += ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4) * SiS_Pr->SiS661LCD2TableSize);
 511    }
 512 
 513    return romptr;
 514 }
 515 #endif
 516 
 517 /*********************************************/
 518 /*           Adjust Rate for CRT2            */
 519 /*********************************************/
 520 
 521 static bool
 522 SiS_AdjustCRT2Rate(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
 523                 unsigned short RRTI, unsigned short *i)
 524 {
 525    unsigned short checkmask=0, modeid, infoflag;
 526 
 527    modeid = SiS_Pr->SiS_RefIndex[RRTI + (*i)].ModeID;
 528 
 529    if(SiS_Pr->SiS_VBType & VB_SISVB) {
 530 
 531       if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) {
 532 
 533          checkmask |= SupportRAMDAC2;
 534          if(SiS_Pr->ChipType >= SIS_315H) {
 535             checkmask |= SupportRAMDAC2_135;
 536             if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
 537                checkmask |= SupportRAMDAC2_162;
 538                if(SiS_Pr->SiS_VBType & VB_SISRAMDAC202) {
 539                   checkmask |= SupportRAMDAC2_202;
 540                }
 541             }
 542          }
 543 
 544       } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
 545 
 546          checkmask |= SupportLCD;
 547          if(SiS_Pr->ChipType >= SIS_315H) {
 548             if(SiS_Pr->SiS_VBType & VB_SISVB) {
 549                if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (SiS_Pr->SiS_LCDInfo & LCDPass11)) {
 550                   if(modeid == 0x2e) checkmask |= Support64048060Hz;
 551                }
 552             }
 553          }
 554 
 555       } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
 556 
 557          checkmask |= SupportHiVision;
 558 
 559       } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToYPbPr525750|SetCRT2ToAVIDEO|SetCRT2ToSVIDEO|SetCRT2ToSCART)) {
 560 
 561          checkmask |= SupportTV;
 562          if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
 563             checkmask |= SupportTV1024;
 564             if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
 565                if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) {
 566                   checkmask |= SupportYPbPr750p;
 567                }
 568             }
 569          }
 570 
 571       }
 572 
 573    } else {     /* LVDS */
 574 
 575       if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
 576          if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
 577             checkmask |= SupportCHTV;
 578          }
 579       }
 580 
 581       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
 582          checkmask |= SupportLCD;
 583       }
 584 
 585    }
 586 
 587    /* Look backwards in table for matching CRT2 mode */
 588    for(; SiS_Pr->SiS_RefIndex[RRTI + (*i)].ModeID == modeid; (*i)--) {
 589       infoflag = SiS_Pr->SiS_RefIndex[RRTI + (*i)].Ext_InfoFlag;
 590       if(infoflag & checkmask) return true;
 591       if((*i) == 0) break;
 592    }
 593 
 594    /* Look through the whole mode-section of the table from the beginning
 595     * for a matching CRT2 mode if no mode was found yet.
 596     */
 597    for((*i) = 0; ; (*i)++) {
 598       if(SiS_Pr->SiS_RefIndex[RRTI + (*i)].ModeID != modeid) break;
 599       infoflag = SiS_Pr->SiS_RefIndex[RRTI + (*i)].Ext_InfoFlag;
 600       if(infoflag & checkmask) return true;
 601    }
 602    return false;
 603 }
 604 
 605 /*********************************************/
 606 /*              Get rate index               */
 607 /*********************************************/
 608 
 609 unsigned short
 610 SiS_GetRatePtr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
 611 {
 612    unsigned short RRTI,i,backup_i;
 613    unsigned short modeflag,index,temp,backupindex;
 614    static const unsigned short LCDRefreshIndex[] = {
 615                 0x00, 0x00, 0x01, 0x01,
 616                 0x01, 0x01, 0x01, 0x01,
 617                 0x01, 0x01, 0x01, 0x01,
 618                 0x01, 0x01, 0x01, 0x01,
 619                 0x00, 0x00, 0x00, 0x00
 620    };
 621 
 622    /* Do NOT check for UseCustomMode here, will skrew up FIFO */
 623    if(ModeNo == 0xfe) return 0;
 624 
 625    if(ModeNo <= 0x13) {
 626       modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
 627    } else {
 628       modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
 629    }
 630 
 631    if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
 632       if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
 633          if(modeflag & HalfDCLK) return 0;
 634       }
 635    }
 636 
 637    if(ModeNo < 0x14) return 0xFFFF;
 638 
 639    index = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x33) >> SiS_Pr->SiS_SelectCRT2Rate) & 0x0F;
 640    backupindex = index;
 641 
 642    if(index > 0) index--;
 643 
 644    if(SiS_Pr->SiS_SetFlag & ProgrammingCRT2) {
 645       if(SiS_Pr->SiS_VBType & VB_SISVB) {
 646          if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
 647             if(SiS_Pr->SiS_VBType & VB_NoLCD)            index = 0;
 648             else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) index = backupindex = 0;
 649          }
 650          if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
 651             if(!(SiS_Pr->SiS_VBType & VB_NoLCD)) {
 652                temp = LCDRefreshIndex[SiS_GetBIOSLCDResInfo(SiS_Pr)];
 653                if(index > temp) index = temp;
 654             }
 655          }
 656       } else {
 657          if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) index = 0;
 658          if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
 659             if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) index = 0;
 660          }
 661       }
 662    }
 663 
 664    RRTI = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].REFindex;
 665    ModeNo = SiS_Pr->SiS_RefIndex[RRTI].ModeID;
 666 
 667    if(SiS_Pr->ChipType >= SIS_315H) {
 668       if(!(SiS_Pr->SiS_VBInfo & DriverMode)) {
 669          if( (SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_VESAID == 0x105) ||
 670              (SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_VESAID == 0x107) ) {
 671             if(backupindex <= 1) RRTI++;
 672          }
 673       }
 674    }
 675 
 676    i = 0;
 677    do {
 678       if(SiS_Pr->SiS_RefIndex[RRTI + i].ModeID != ModeNo) break;
 679       temp = SiS_Pr->SiS_RefIndex[RRTI + i].Ext_InfoFlag;
 680       temp &= ModeTypeMask;
 681       if(temp < SiS_Pr->SiS_ModeType) break;
 682       i++;
 683       index--;
 684    } while(index != 0xFFFF);
 685 
 686    if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) {
 687       if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
 688          temp = SiS_Pr->SiS_RefIndex[RRTI + i - 1].Ext_InfoFlag;
 689          if(temp & InterlaceMode) i++;
 690       }
 691    }
 692 
 693    i--;
 694 
 695    if((SiS_Pr->SiS_SetFlag & ProgrammingCRT2) && (!(SiS_Pr->SiS_VBInfo & DisableCRT2Display))) {
 696       backup_i = i;
 697       if(!(SiS_AdjustCRT2Rate(SiS_Pr, ModeNo, ModeIdIndex, RRTI, &i))) {
 698          i = backup_i;
 699       }
 700    }
 701 
 702    return (RRTI + i);
 703 }
 704 
 705 /*********************************************/
 706 /*            STORE CRT2 INFO in CR34        */
 707 /*********************************************/
 708 
 709 static void
 710 SiS_SaveCRT2Info(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
 711 {
 712    unsigned short temp1, temp2;
 713 
 714    /* Store CRT1 ModeNo in CR34 */
 715    SiS_SetReg(SiS_Pr->SiS_P3d4,0x34,ModeNo);
 716    temp1 = (SiS_Pr->SiS_VBInfo & SetInSlaveMode) >> 8;
 717    temp2 = ~(SetInSlaveMode >> 8);
 718    SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x31,temp2,temp1);
 719 }
 720 
 721 /*********************************************/
 722 /*    HELPER: GET SOME DATA FROM BIOS ROM    */
 723 /*********************************************/
 724 
 725 #ifdef CONFIG_FB_SIS_300
 726 static bool
 727 SiS_CR36BIOSWord23b(struct SiS_Private *SiS_Pr)
 728 {
 729    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
 730    unsigned short temp,temp1;
 731 
 732    if(SiS_Pr->SiS_UseROM) {
 733       if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) {
 734          temp = 1 << ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4) & 0x0f);
 735          temp1 = SISGETROMW(0x23b);
 736          if(temp1 & temp) return true;
 737       }
 738    }
 739    return false;
 740 }
 741 
 742 static bool
 743 SiS_CR36BIOSWord23d(struct SiS_Private *SiS_Pr)
 744 {
 745    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
 746    unsigned short temp,temp1;
 747 
 748    if(SiS_Pr->SiS_UseROM) {
 749       if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) {
 750          temp = 1 << ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4) & 0x0f);
 751          temp1 = SISGETROMW(0x23d);
 752          if(temp1 & temp) return true;
 753       }
 754    }
 755    return false;
 756 }
 757 #endif
 758 
 759 /*********************************************/
 760 /*          HELPER: DELAY FUNCTIONS          */
 761 /*********************************************/
 762 
 763 void
 764 SiS_DDC2Delay(struct SiS_Private *SiS_Pr, unsigned int delaytime)
 765 {
 766    while (delaytime-- > 0)
 767       SiS_GetReg(SiS_Pr->SiS_P3c4, 0x05);
 768 }
 769 
 770 #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315)
 771 static void
 772 SiS_GenericDelay(struct SiS_Private *SiS_Pr, unsigned short delay)
 773 {
 774    SiS_DDC2Delay(SiS_Pr, delay * 36);
 775 }
 776 #endif
 777 
 778 #ifdef CONFIG_FB_SIS_315
 779 static void
 780 SiS_LongDelay(struct SiS_Private *SiS_Pr, unsigned short delay)
 781 {
 782    while(delay--) {
 783       SiS_GenericDelay(SiS_Pr, 6623);
 784    }
 785 }
 786 #endif
 787 
 788 #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315)
 789 static void
 790 SiS_ShortDelay(struct SiS_Private *SiS_Pr, unsigned short delay)
 791 {
 792    while(delay--) {
 793       SiS_GenericDelay(SiS_Pr, 66);
 794    }
 795 }
 796 #endif
 797 
 798 static void
 799 SiS_PanelDelay(struct SiS_Private *SiS_Pr, unsigned short DelayTime)
 800 {
 801 #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315)
 802    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
 803    unsigned short PanelID, DelayIndex, Delay=0;
 804 #endif
 805 
 806    if(SiS_Pr->ChipType < SIS_315H) {
 807 
 808 #ifdef CONFIG_FB_SIS_300
 809 
 810       PanelID = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36);
 811       if(SiS_Pr->SiS_VBType & VB_SISVB) {
 812          if(SiS_Pr->SiS_VBType & VB_SIS301) PanelID &= 0xf7;
 813          if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x18) & 0x10)) PanelID = 0x12;
 814       }
 815       DelayIndex = PanelID >> 4;
 816       if((DelayTime >= 2) && ((PanelID & 0x0f) == 1))  {
 817          Delay = 3;
 818       } else {
 819          if(DelayTime >= 2) DelayTime -= 2;
 820          if(!(DelayTime & 0x01)) {
 821             Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[0];
 822          } else {
 823             Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[1];
 824          }
 825          if(SiS_Pr->SiS_UseROM) {
 826             if(ROMAddr[0x220] & 0x40) {
 827                if(!(DelayTime & 0x01)) Delay = (unsigned short)ROMAddr[0x225];
 828                else                    Delay = (unsigned short)ROMAddr[0x226];
 829             }
 830          }
 831       }
 832       SiS_ShortDelay(SiS_Pr, Delay);
 833 
 834 #endif  /* CONFIG_FB_SIS_300 */
 835 
 836    } else {
 837 
 838 #ifdef CONFIG_FB_SIS_315
 839 
 840       if((SiS_Pr->ChipType >= SIS_661)    ||
 841          (SiS_Pr->ChipType <= SIS_315PRO) ||
 842          (SiS_Pr->ChipType == SIS_330)    ||
 843          (SiS_Pr->SiS_ROMNew)) {
 844 
 845          if(!(DelayTime & 0x01)) {
 846             SiS_DDC2Delay(SiS_Pr, 0x1000);
 847          } else {
 848             SiS_DDC2Delay(SiS_Pr, 0x4000);
 849          }
 850 
 851       } else if (SiS_Pr->SiS_IF_DEF_LVDS == 1) {                        /* 315 series, LVDS; Special */
 852 
 853          if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) {
 854             PanelID = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36);
 855             if(SiS_Pr->SiS_CustomT == CUT_CLEVO1400) {
 856                if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x1b) & 0x10)) PanelID = 0x12;
 857             }
 858             if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) {
 859                DelayIndex = PanelID & 0x0f;
 860             } else {
 861                DelayIndex = PanelID >> 4;
 862             }
 863             if((DelayTime >= 2) && ((PanelID & 0x0f) == 1))  {
 864                Delay = 3;
 865             } else {
 866                if(DelayTime >= 2) DelayTime -= 2;
 867                if(!(DelayTime & 0x01)) {
 868                   Delay = SiS_Pr->SiS_PanelDelayTblLVDS[DelayIndex].timer[0];
 869                 } else {
 870                   Delay = SiS_Pr->SiS_PanelDelayTblLVDS[DelayIndex].timer[1];
 871                }
 872                if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) {
 873                   if(ROMAddr[0x13c] & 0x40) {
 874                      if(!(DelayTime & 0x01)) {
 875                         Delay = (unsigned short)ROMAddr[0x17e];
 876                      } else {
 877                         Delay = (unsigned short)ROMAddr[0x17f];
 878                      }
 879                   }
 880                }
 881             }
 882             SiS_ShortDelay(SiS_Pr, Delay);
 883          }
 884 
 885       } else if(SiS_Pr->SiS_VBType & VB_SISVB) {                        /* 315 series, all bridges */
 886 
 887          DelayIndex = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4;
 888          if(!(DelayTime & 0x01)) {
 889             Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[0];
 890          } else {
 891             Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[1];
 892          }
 893          Delay <<= 8;
 894          SiS_DDC2Delay(SiS_Pr, Delay);
 895 
 896       }
 897 
 898 #endif /* CONFIG_FB_SIS_315 */
 899 
 900    }
 901 }
 902 
 903 #ifdef CONFIG_FB_SIS_315
 904 static void
 905 SiS_PanelDelayLoop(struct SiS_Private *SiS_Pr, unsigned short DelayTime, unsigned short DelayLoop)
 906 {
 907    int i;
 908    for(i = 0; i < DelayLoop; i++) {
 909       SiS_PanelDelay(SiS_Pr, DelayTime);
 910    }
 911 }
 912 #endif
 913 
 914 /*********************************************/
 915 /*    HELPER: WAIT-FOR-RETRACE FUNCTIONS     */
 916 /*********************************************/
 917 
 918 void
 919 SiS_WaitRetrace1(struct SiS_Private *SiS_Pr)
 920 {
 921    unsigned short watchdog;
 922 
 923    if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x1f) & 0xc0) return;
 924    if(!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x17) & 0x80)) return;
 925 
 926    watchdog = 65535;
 927    while((SiS_GetRegByte(SiS_Pr->SiS_P3da) & 0x08) && --watchdog);
 928    watchdog = 65535;
 929    while((!(SiS_GetRegByte(SiS_Pr->SiS_P3da) & 0x08)) && --watchdog);
 930 }
 931 
 932 #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315)
 933 static void
 934 SiS_WaitRetrace2(struct SiS_Private *SiS_Pr, unsigned short reg)
 935 {
 936    unsigned short watchdog;
 937 
 938    watchdog = 65535;
 939    while((SiS_GetReg(SiS_Pr->SiS_Part1Port,reg) & 0x02) && --watchdog);
 940    watchdog = 65535;
 941    while((!(SiS_GetReg(SiS_Pr->SiS_Part1Port,reg) & 0x02)) && --watchdog);
 942 }
 943 #endif
 944 
 945 static void
 946 SiS_WaitVBRetrace(struct SiS_Private *SiS_Pr)
 947 {
 948    if(SiS_Pr->ChipType < SIS_315H) {
 949 #ifdef CONFIG_FB_SIS_300
 950       if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
 951          if(!(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x20)) return;
 952       }
 953       if(!(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x80)) {
 954          SiS_WaitRetrace1(SiS_Pr);
 955       } else {
 956          SiS_WaitRetrace2(SiS_Pr, 0x25);
 957       }
 958 #endif
 959    } else {
 960 #ifdef CONFIG_FB_SIS_315
 961       if(!(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x40)) {
 962          SiS_WaitRetrace1(SiS_Pr);
 963       } else {
 964          SiS_WaitRetrace2(SiS_Pr, 0x30);
 965       }
 966 #endif
 967    }
 968 }
 969 
 970 static void
 971 SiS_VBWait(struct SiS_Private *SiS_Pr)
 972 {
 973    unsigned short tempal,temp,i,j;
 974 
 975    temp = 0;
 976    for(i = 0; i < 3; i++) {
 977      for(j = 0; j < 100; j++) {
 978         tempal = SiS_GetRegByte(SiS_Pr->SiS_P3da);
 979         if(temp & 0x01) {
 980            if((tempal & 0x08))  continue;
 981            else break;
 982         } else {
 983            if(!(tempal & 0x08)) continue;
 984            else break;
 985         }
 986      }
 987      temp ^= 0x01;
 988    }
 989 }
 990 
 991 static void
 992 SiS_VBLongWait(struct SiS_Private *SiS_Pr)
 993 {
 994    if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
 995       SiS_VBWait(SiS_Pr);
 996    } else {
 997       SiS_WaitRetrace1(SiS_Pr);
 998    }
 999 }
1000 
1001 /*********************************************/
1002 /*               HELPER: MISC                */
1003 /*********************************************/
1004 
1005 #ifdef CONFIG_FB_SIS_300
1006 static bool
1007 SiS_Is301B(struct SiS_Private *SiS_Pr)
1008 {
1009    if(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x01) >= 0xb0) return true;
1010    return false;
1011 }
1012 #endif
1013 
1014 static bool
1015 SiS_CRT2IsLCD(struct SiS_Private *SiS_Pr)
1016 {
1017    if(SiS_Pr->ChipType == SIS_730) {
1018       if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x20) return true;
1019    }
1020    if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & 0x20) return true;
1021    return false;
1022 }
1023 
1024 bool
1025 SiS_IsDualEdge(struct SiS_Private *SiS_Pr)
1026 {
1027 #ifdef CONFIG_FB_SIS_315
1028    if(SiS_Pr->ChipType >= SIS_315H) {
1029       if((SiS_Pr->ChipType != SIS_650) || (SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xf0)) {
1030          if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & EnableDualEdge) return true;
1031       }
1032    }
1033 #endif
1034    return false;
1035 }
1036 
1037 bool
1038 SiS_IsVAMode(struct SiS_Private *SiS_Pr)
1039 {
1040 #ifdef CONFIG_FB_SIS_315
1041    unsigned short flag;
1042 
1043    if(SiS_Pr->ChipType >= SIS_315H) {
1044       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1045       if((flag & EnableDualEdge) && (flag & SetToLCDA)) return true;
1046    }
1047 #endif
1048    return false;
1049 }
1050 
1051 #ifdef CONFIG_FB_SIS_315
1052 static bool
1053 SiS_IsVAorLCD(struct SiS_Private *SiS_Pr)
1054 {
1055    if(SiS_IsVAMode(SiS_Pr))  return true;
1056    if(SiS_CRT2IsLCD(SiS_Pr)) return true;
1057    return false;
1058 }
1059 #endif
1060 
1061 static bool
1062 SiS_IsDualLink(struct SiS_Private *SiS_Pr)
1063 {
1064 #ifdef CONFIG_FB_SIS_315
1065    if(SiS_Pr->ChipType >= SIS_315H) {
1066       if((SiS_CRT2IsLCD(SiS_Pr)) ||
1067          (SiS_IsVAMode(SiS_Pr))) {
1068          if(SiS_Pr->SiS_LCDInfo & LCDDualLink) return true;
1069       }
1070    }
1071 #endif
1072    return false;
1073 }
1074 
1075 #ifdef CONFIG_FB_SIS_315
1076 static bool
1077 SiS_TVEnabled(struct SiS_Private *SiS_Pr)
1078 {
1079    if((SiS_GetReg(SiS_Pr->SiS_Part2Port,0x00) & 0x0f) != 0x0c) return true;
1080    if(SiS_Pr->SiS_VBType & VB_SISYPBPR) {
1081       if(SiS_GetReg(SiS_Pr->SiS_Part2Port,0x4d) & 0x10) return true;
1082    }
1083    return false;
1084 }
1085 #endif
1086 
1087 #ifdef CONFIG_FB_SIS_315
1088 static bool
1089 SiS_LCDAEnabled(struct SiS_Private *SiS_Pr)
1090 {
1091    if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x13) & 0x04) return true;
1092    return false;
1093 }
1094 #endif
1095 
1096 #ifdef CONFIG_FB_SIS_315
1097 static bool
1098 SiS_WeHaveBacklightCtrl(struct SiS_Private *SiS_Pr)
1099 {
1100    if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->ChipType < SIS_661)) {
1101       if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x79) & 0x10) return true;
1102    }
1103    return false;
1104 }
1105 #endif
1106 
1107 #ifdef CONFIG_FB_SIS_315
1108 static bool
1109 SiS_IsNotM650orLater(struct SiS_Private *SiS_Pr)
1110 {
1111    unsigned short flag;
1112 
1113    if(SiS_Pr->ChipType == SIS_650) {
1114       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xf0;
1115       /* Check for revision != A0 only */
1116       if((flag == 0xe0) || (flag == 0xc0) ||
1117          (flag == 0xb0) || (flag == 0x90)) return false;
1118    } else if(SiS_Pr->ChipType >= SIS_661) return false;
1119    return true;
1120 }
1121 #endif
1122 
1123 #ifdef CONFIG_FB_SIS_315
1124 static bool
1125 SiS_IsYPbPr(struct SiS_Private *SiS_Pr)
1126 {
1127    if(SiS_Pr->ChipType >= SIS_315H) {
1128       /* YPrPb = 0x08 */
1129       if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & EnableCHYPbPr) return true;
1130    }
1131    return false;
1132 }
1133 #endif
1134 
1135 #ifdef CONFIG_FB_SIS_315
1136 static bool
1137 SiS_IsChScart(struct SiS_Private *SiS_Pr)
1138 {
1139    if(SiS_Pr->ChipType >= SIS_315H) {
1140       /* Scart = 0x04 */
1141       if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & EnableCHScart) return true;
1142    }
1143    return false;
1144 }
1145 #endif
1146 
1147 #ifdef CONFIG_FB_SIS_315
1148 static bool
1149 SiS_IsTVOrYPbPrOrScart(struct SiS_Private *SiS_Pr)
1150 {
1151    unsigned short flag;
1152 
1153    if(SiS_Pr->ChipType >= SIS_315H) {
1154       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
1155       if(flag & SetCRT2ToTV)        return true;
1156       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1157       if(flag & EnableCHYPbPr)      return true;  /* = YPrPb = 0x08 */
1158       if(flag & EnableCHScart)      return true;  /* = Scart = 0x04 - TW */
1159    } else {
1160       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
1161       if(flag & SetCRT2ToTV)        return true;
1162    }
1163    return false;
1164 }
1165 #endif
1166 
1167 #ifdef CONFIG_FB_SIS_315
1168 static bool
1169 SiS_IsLCDOrLCDA(struct SiS_Private *SiS_Pr)
1170 {
1171    unsigned short flag;
1172 
1173    if(SiS_Pr->ChipType >= SIS_315H) {
1174       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
1175       if(flag & SetCRT2ToLCD) return true;
1176       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1177       if(flag & SetToLCDA)    return true;
1178    } else {
1179       flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
1180       if(flag & SetCRT2ToLCD) return true;
1181    }
1182    return false;
1183 }
1184 #endif
1185 
1186 static bool
1187 SiS_HaveBridge(struct SiS_Private *SiS_Pr)
1188 {
1189    unsigned short flag;
1190 
1191    if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
1192       return true;
1193    } else if(SiS_Pr->SiS_VBType & VB_SISVB) {
1194       flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00);
1195       if((flag == 1) || (flag == 2)) return true;
1196    }
1197    return false;
1198 }
1199 
1200 static bool
1201 SiS_BridgeIsEnabled(struct SiS_Private *SiS_Pr)
1202 {
1203    unsigned short flag;
1204 
1205    if(SiS_HaveBridge(SiS_Pr)) {
1206       flag = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00);
1207       if(SiS_Pr->ChipType < SIS_315H) {
1208         flag &= 0xa0;
1209         if((flag == 0x80) || (flag == 0x20)) return true;
1210       } else {
1211         flag &= 0x50;
1212         if((flag == 0x40) || (flag == 0x10)) return true;
1213       }
1214    }
1215    return false;
1216 }
1217 
1218 static bool
1219 SiS_BridgeInSlavemode(struct SiS_Private *SiS_Pr)
1220 {
1221    unsigned short flag1;
1222 
1223    flag1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31);
1224    if(flag1 & (SetInSlaveMode >> 8)) return true;
1225    return false;
1226 }
1227 
1228 /*********************************************/
1229 /*       GET VIDEO BRIDGE CONFIG INFO        */
1230 /*********************************************/
1231 
1232 /* Setup general purpose IO for Chrontel communication */
1233 #ifdef CONFIG_FB_SIS_300
1234 void
1235 SiS_SetChrontelGPIO(struct SiS_Private *SiS_Pr, unsigned short myvbinfo)
1236 {
1237    unsigned int   acpibase;
1238    unsigned short temp;
1239 
1240    if(!(SiS_Pr->SiS_ChSW)) return;
1241 
1242    acpibase = sisfb_read_lpc_pci_dword(SiS_Pr, 0x74);
1243    acpibase &= 0xFFFF;
1244    if(!acpibase) return;
1245    temp = SiS_GetRegShort((acpibase + 0x3c));   /* ACPI register 0x3c: GP Event 1 I/O mode select */
1246    temp &= 0xFEFF;
1247    SiS_SetRegShort((acpibase + 0x3c), temp);
1248    temp = SiS_GetRegShort((acpibase + 0x3c));
1249    temp = SiS_GetRegShort((acpibase + 0x3a));   /* ACPI register 0x3a: GP Pin Level (low/high) */
1250    temp &= 0xFEFF;
1251    if(!(myvbinfo & SetCRT2ToTV)) temp |= 0x0100;
1252    SiS_SetRegShort((acpibase + 0x3a), temp);
1253    temp = SiS_GetRegShort((acpibase + 0x3a));
1254 }
1255 #endif
1256 
1257 void
1258 SiS_GetVBInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
1259                 unsigned short ModeIdIndex, int checkcrt2mode)
1260 {
1261    unsigned short tempax, tempbx, temp;
1262    unsigned short modeflag, resinfo = 0;
1263 
1264    SiS_Pr->SiS_SetFlag = 0;
1265 
1266    modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
1267 
1268    SiS_Pr->SiS_ModeType = modeflag & ModeTypeMask;
1269 
1270    if((ModeNo > 0x13) && (!SiS_Pr->UseCustomMode)) {
1271       resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
1272    }
1273 
1274    tempbx = 0;
1275 
1276    if(SiS_HaveBridge(SiS_Pr)) {
1277 
1278         temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
1279         tempbx |= temp;
1280         tempax = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) << 8;
1281         tempax &= (DriverMode | LoadDACFlag | SetNotSimuMode | SetPALTV);
1282         tempbx |= tempax;
1283 
1284 #ifdef CONFIG_FB_SIS_315
1285         if(SiS_Pr->ChipType >= SIS_315H) {
1286            if(SiS_Pr->SiS_VBType & VB_SISLCDA) {
1287               if(ModeNo == 0x03) {
1288                  /* Mode 0x03 is never in driver mode */
1289                  SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x31,0xbf);
1290               }
1291               if(!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & (DriverMode >> 8))) {
1292                  /* Reset LCDA setting if not driver mode */
1293                  SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x38,0xfc);
1294               }
1295               if(IS_SIS650) {
1296                  if(SiS_Pr->SiS_UseLCDA) {
1297                     if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xF0) {
1298                        if((ModeNo <= 0x13) || (!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & (DriverMode >> 8)))) {
1299                           SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x38,(EnableDualEdge | SetToLCDA));
1300                        }
1301                     }
1302                  }
1303               }
1304               temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1305               if((temp & (EnableDualEdge | SetToLCDA)) == (EnableDualEdge | SetToLCDA)) {
1306                  tempbx |= SetCRT2ToLCDA;
1307               }
1308            }
1309 
1310            if(SiS_Pr->ChipType >= SIS_661) { /* New CR layout */
1311               tempbx &= ~(SetCRT2ToYPbPr525750 | SetCRT2ToHiVision);
1312               if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & 0x04) {
1313                  temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35) & 0xe0;
1314                  if(temp == 0x60) tempbx |= SetCRT2ToHiVision;
1315                  else if(SiS_Pr->SiS_VBType & VB_SISYPBPR) {
1316                     tempbx |= SetCRT2ToYPbPr525750;
1317                  }
1318               }
1319            }
1320 
1321            if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
1322               temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1323               if(temp & SetToLCDA) {
1324                  tempbx |= SetCRT2ToLCDA;
1325               }
1326               if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
1327                  if(temp & EnableCHYPbPr) {
1328                     tempbx |= SetCRT2ToCHYPbPr;
1329                  }
1330               }
1331            }
1332         }
1333 
1334 #endif  /* CONFIG_FB_SIS_315 */
1335 
1336         if(!(SiS_Pr->SiS_VBType & VB_SISVGA2)) {
1337            tempbx &= ~(SetCRT2ToRAMDAC);
1338         }
1339 
1340         if(SiS_Pr->SiS_VBType & VB_SISVB) {
1341            temp = SetCRT2ToSVIDEO   |
1342                   SetCRT2ToAVIDEO   |
1343                   SetCRT2ToSCART    |
1344                   SetCRT2ToLCDA     |
1345                   SetCRT2ToLCD      |
1346                   SetCRT2ToRAMDAC   |
1347                   SetCRT2ToHiVision |
1348                   SetCRT2ToYPbPr525750;
1349         } else {
1350            if(SiS_Pr->ChipType >= SIS_315H) {
1351               if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
1352                  temp = SetCRT2ToAVIDEO |
1353                         SetCRT2ToSVIDEO |
1354                         SetCRT2ToSCART  |
1355                         SetCRT2ToLCDA   |
1356                         SetCRT2ToLCD    |
1357                         SetCRT2ToCHYPbPr;
1358               } else {
1359                  temp = SetCRT2ToLCDA   |
1360                         SetCRT2ToLCD;
1361               }
1362            } else {
1363               if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
1364                  temp = SetCRT2ToTV | SetCRT2ToLCD;
1365               } else {
1366                  temp = SetCRT2ToLCD;
1367               }
1368            }
1369         }
1370 
1371         if(!(tempbx & temp)) {
1372            tempax = DisableCRT2Display;
1373            tempbx = 0;
1374         }
1375 
1376         if(SiS_Pr->SiS_VBType & VB_SISVB) {
1377 
1378            unsigned short clearmask = ( DriverMode |
1379                                 DisableCRT2Display |
1380                                 LoadDACFlag        |
1381                                 SetNotSimuMode     |
1382                                 SetInSlaveMode     |
1383                                 SetPALTV           |
1384                                 SwitchCRT2         |
1385                                 SetSimuScanMode );
1386 
1387            if(tempbx & SetCRT2ToLCDA)        tempbx &= (clearmask | SetCRT2ToLCDA);
1388            if(tempbx & SetCRT2ToRAMDAC)      tempbx &= (clearmask | SetCRT2ToRAMDAC);
1389            if(tempbx & SetCRT2ToLCD)         tempbx &= (clearmask | SetCRT2ToLCD);
1390            if(tempbx & SetCRT2ToSCART)       tempbx &= (clearmask | SetCRT2ToSCART);
1391            if(tempbx & SetCRT2ToHiVision)    tempbx &= (clearmask | SetCRT2ToHiVision);
1392            if(tempbx & SetCRT2ToYPbPr525750) tempbx &= (clearmask | SetCRT2ToYPbPr525750);
1393 
1394         } else {
1395 
1396            if(SiS_Pr->ChipType >= SIS_315H) {
1397               if(tempbx & SetCRT2ToLCDA) {
1398                  tempbx &= (0xFF00|SwitchCRT2|SetSimuScanMode);
1399               }
1400            }
1401            if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
1402               if(tempbx & SetCRT2ToTV) {
1403                  tempbx &= (0xFF00|SetCRT2ToTV|SwitchCRT2|SetSimuScanMode);
1404               }
1405            }
1406            if(tempbx & SetCRT2ToLCD) {
1407               tempbx &= (0xFF00|SetCRT2ToLCD|SwitchCRT2|SetSimuScanMode);
1408            }
1409            if(SiS_Pr->ChipType >= SIS_315H) {
1410               if(tempbx & SetCRT2ToLCDA) {
1411                  tempbx |= SetCRT2ToLCD;
1412               }
1413            }
1414 
1415         }
1416 
1417         if(tempax & DisableCRT2Display) {
1418            if(!(tempbx & (SwitchCRT2 | SetSimuScanMode))) {
1419               tempbx = SetSimuScanMode | DisableCRT2Display;
1420            }
1421         }
1422 
1423         if(!(tempbx & DriverMode)) tempbx |= SetSimuScanMode;
1424 
1425         /* LVDS/CHRONTEL (LCD/TV) and 301BDH (LCD) can only be slave in 8bpp modes */
1426         if(SiS_Pr->SiS_ModeType <= ModeVGA) {
1427            if( (SiS_Pr->SiS_IF_DEF_LVDS == 1) ||
1428                ((SiS_Pr->SiS_VBType & VB_NoLCD) && (tempbx & SetCRT2ToLCD)) ) {
1429               modeflag &= (~CRT2Mode);
1430            }
1431         }
1432 
1433         if(!(tempbx & SetSimuScanMode)) {
1434            if(tempbx & SwitchCRT2) {
1435               if((!(modeflag & CRT2Mode)) && (checkcrt2mode)) {
1436                  if(resinfo != SIS_RI_1600x1200) {
1437                     tempbx |= SetSimuScanMode;
1438                  }
1439               }
1440            } else {
1441               if(SiS_BridgeIsEnabled(SiS_Pr)) {
1442                  if(!(tempbx & DriverMode)) {
1443                     if(SiS_BridgeInSlavemode(SiS_Pr)) {
1444                        tempbx |= SetSimuScanMode;
1445                     }
1446                  }
1447               }
1448            }
1449         }
1450 
1451         if(!(tempbx & DisableCRT2Display)) {
1452            if(tempbx & DriverMode) {
1453               if(tempbx & SetSimuScanMode) {
1454                  if((!(modeflag & CRT2Mode)) && (checkcrt2mode)) {
1455                     if(resinfo != SIS_RI_1600x1200) {
1456                        tempbx |= SetInSlaveMode;
1457                     }
1458                  }
1459               }
1460            } else {
1461               tempbx |= SetInSlaveMode;
1462            }
1463         }
1464 
1465    }
1466 
1467    SiS_Pr->SiS_VBInfo = tempbx;
1468 
1469 #ifdef CONFIG_FB_SIS_300
1470    if(SiS_Pr->ChipType == SIS_630) {
1471       SiS_SetChrontelGPIO(SiS_Pr, SiS_Pr->SiS_VBInfo);
1472    }
1473 #endif
1474 
1475 #if 0
1476    printk(KERN_DEBUG "sisfb: (init301: VBInfo= 0x%04x, SetFlag=0x%04x)\n",
1477       SiS_Pr->SiS_VBInfo, SiS_Pr->SiS_SetFlag);
1478 #endif
1479 }
1480 
1481 /*********************************************/
1482 /*           DETERMINE YPbPr MODE            */
1483 /*********************************************/
1484 
1485 void
1486 SiS_SetYPbPr(struct SiS_Private *SiS_Pr)
1487 {
1488 
1489    unsigned char temp;
1490 
1491    /* Note: This variable is only used on 30xLV systems.
1492     * CR38 has a different meaning on LVDS/CH7019 systems.
1493     * On 661 and later, these bits moved to CR35.
1494     *
1495     * On 301, 301B, only HiVision 1080i is supported.
1496     * On 30xLV, 301C, only YPbPr 1080i is supported.
1497     */
1498 
1499    SiS_Pr->SiS_YPbPr = 0;
1500    if(SiS_Pr->ChipType >= SIS_661) return;
1501 
1502    if(SiS_Pr->SiS_VBType) {
1503       if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
1504          SiS_Pr->SiS_YPbPr = YPbPrHiVision;
1505       }
1506    }
1507 
1508    if(SiS_Pr->ChipType >= SIS_315H) {
1509       if(SiS_Pr->SiS_VBType & VB_SISYPBPR) {
1510          temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1511          if(temp & 0x08) {
1512             switch((temp >> 4)) {
1513             case 0x00: SiS_Pr->SiS_YPbPr = YPbPr525i;     break;
1514             case 0x01: SiS_Pr->SiS_YPbPr = YPbPr525p;     break;
1515             case 0x02: SiS_Pr->SiS_YPbPr = YPbPr750p;     break;
1516             case 0x03: SiS_Pr->SiS_YPbPr = YPbPrHiVision; break;
1517             }
1518          }
1519       }
1520    }
1521 
1522 }
1523 
1524 /*********************************************/
1525 /*           DETERMINE TVMode flag           */
1526 /*********************************************/
1527 
1528 void
1529 SiS_SetTVMode(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
1530 {
1531    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
1532    unsigned short temp, temp1, resinfo = 0, romindex = 0;
1533    unsigned char  OutputSelect = *SiS_Pr->pSiS_OutputSelect;
1534 
1535    SiS_Pr->SiS_TVMode = 0;
1536 
1537    if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) return;
1538    if(SiS_Pr->UseCustomMode) return;
1539 
1540    if(ModeNo > 0x13) {
1541       resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
1542    }
1543 
1544    if(SiS_Pr->ChipType < SIS_661) {
1545 
1546       if(SiS_Pr->SiS_VBInfo & SetPALTV) SiS_Pr->SiS_TVMode |= TVSetPAL;
1547 
1548       if(SiS_Pr->SiS_VBType & VB_SISVB) {
1549          temp = 0;
1550          if((SiS_Pr->ChipType == SIS_630) ||
1551             (SiS_Pr->ChipType == SIS_730)) {
1552             temp = 0x35;
1553             romindex = 0xfe;
1554          } else if(SiS_Pr->ChipType >= SIS_315H) {
1555             temp = 0x38;
1556             if(SiS_Pr->ChipType < XGI_20) {
1557                romindex = 0xf3;
1558                if(SiS_Pr->ChipType >= SIS_330) romindex = 0x11b;
1559             }
1560          }
1561          if(temp) {
1562             if(romindex && SiS_Pr->SiS_UseROM && (!(SiS_Pr->SiS_ROMNew))) {
1563                OutputSelect = ROMAddr[romindex];
1564                if(!(OutputSelect & EnablePALMN)) {
1565                   SiS_SetRegAND(SiS_Pr->SiS_P3d4,temp,0x3F);
1566                }
1567             }
1568             temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,temp);
1569             if(SiS_Pr->SiS_TVMode & TVSetPAL) {
1570                if(temp1 & EnablePALM) {         /* 0x40 */
1571                   SiS_Pr->SiS_TVMode |= TVSetPALM;
1572                   SiS_Pr->SiS_TVMode &= ~TVSetPAL;
1573                } else if(temp1 & EnablePALN) {  /* 0x80 */
1574                   SiS_Pr->SiS_TVMode |= TVSetPALN;
1575                }
1576             } else {
1577                if(temp1 & EnableNTSCJ) {        /* 0x40 */
1578                   SiS_Pr->SiS_TVMode |= TVSetNTSCJ;
1579                }
1580             }
1581          }
1582          /* Translate HiVision/YPbPr to our new flags */
1583          if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
1584             if(SiS_Pr->SiS_YPbPr == YPbPr750p)          SiS_Pr->SiS_TVMode |= TVSetYPbPr750p;
1585             else if(SiS_Pr->SiS_YPbPr == YPbPr525p)     SiS_Pr->SiS_TVMode |= TVSetYPbPr525p;
1586             else if(SiS_Pr->SiS_YPbPr == YPbPrHiVision) SiS_Pr->SiS_TVMode |= TVSetHiVision;
1587             else                                        SiS_Pr->SiS_TVMode |= TVSetYPbPr525i;
1588             if(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p | TVSetYPbPr525p | TVSetYPbPr525i)) {
1589                SiS_Pr->SiS_VBInfo &= ~SetCRT2ToHiVision;
1590                SiS_Pr->SiS_VBInfo |= SetCRT2ToYPbPr525750;
1591             } else if(SiS_Pr->SiS_TVMode & TVSetHiVision) {
1592                SiS_Pr->SiS_TVMode |= TVSetPAL;
1593             }
1594          }
1595       } else if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
1596          if(SiS_Pr->SiS_CHOverScan) {
1597             if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) {
1598                temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
1599                if((temp & TVOverScan) || (SiS_Pr->SiS_CHOverScan == 1)) {
1600                   SiS_Pr->SiS_TVMode |= TVSetCHOverScan;
1601                }
1602             } else if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
1603                temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x79);
1604                if((temp & 0x80) || (SiS_Pr->SiS_CHOverScan == 1)) {
1605                   SiS_Pr->SiS_TVMode |= TVSetCHOverScan;
1606                }
1607             }
1608             if(SiS_Pr->SiS_CHSOverScan) {
1609                SiS_Pr->SiS_TVMode |= TVSetCHOverScan;
1610             }
1611          }
1612          if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
1613             temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38);
1614             if(SiS_Pr->SiS_TVMode & TVSetPAL) {
1615                if(temp & EnablePALM)      SiS_Pr->SiS_TVMode |= TVSetPALM;
1616                else if(temp & EnablePALN) SiS_Pr->SiS_TVMode |= TVSetPALN;
1617             } else {
1618                if(temp & EnableNTSCJ) {
1619                   SiS_Pr->SiS_TVMode |= TVSetNTSCJ;
1620                }
1621             }
1622          }
1623       }
1624 
1625    } else {  /* 661 and later */
1626 
1627       temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
1628       if(temp1 & 0x01) {
1629          SiS_Pr->SiS_TVMode |= TVSetPAL;
1630          if(temp1 & 0x08) {
1631             SiS_Pr->SiS_TVMode |= TVSetPALN;
1632          } else if(temp1 & 0x04) {
1633             if(SiS_Pr->SiS_VBType & VB_SISVB) {
1634                SiS_Pr->SiS_TVMode &= ~TVSetPAL;
1635             }
1636             SiS_Pr->SiS_TVMode |= TVSetPALM;
1637          }
1638       } else {
1639          if(temp1 & 0x02) {
1640             SiS_Pr->SiS_TVMode |= TVSetNTSCJ;
1641          }
1642       }
1643       if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
1644          if(SiS_Pr->SiS_CHOverScan) {
1645             if((temp1 & 0x10) || (SiS_Pr->SiS_CHOverScan == 1)) {
1646                SiS_Pr->SiS_TVMode |= TVSetCHOverScan;
1647             }
1648          }
1649       }
1650       if(SiS_Pr->SiS_VBType & VB_SISVB) {
1651          if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
1652             temp1 &= 0xe0;
1653             if(temp1 == 0x00)      SiS_Pr->SiS_TVMode |= TVSetYPbPr525i;
1654             else if(temp1 == 0x20) SiS_Pr->SiS_TVMode |= TVSetYPbPr525p;
1655             else if(temp1 == 0x40) SiS_Pr->SiS_TVMode |= TVSetYPbPr750p;
1656          } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
1657             SiS_Pr->SiS_TVMode |= (TVSetHiVision | TVSetPAL);
1658          }
1659          if(SiS_Pr->SiS_VBInfo & (SetCRT2ToYPbPr525750 | SetCRT2ToHiVision)) {
1660             if(resinfo == SIS_RI_800x480 || resinfo == SIS_RI_1024x576 || resinfo == SIS_RI_1280x720) {
1661                SiS_Pr->SiS_TVMode |= TVAspect169;
1662             } else {
1663                temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x39);
1664                if(temp1 & 0x02) {
1665                   if(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p | TVSetHiVision)) {
1666                      SiS_Pr->SiS_TVMode |= TVAspect169;
1667                   } else {
1668                      SiS_Pr->SiS_TVMode |= TVAspect43LB;
1669                   }
1670                } else {
1671                   SiS_Pr->SiS_TVMode |= TVAspect43;
1672                }
1673             }
1674          }
1675       }
1676    }
1677 
1678    if(SiS_Pr->SiS_VBInfo & SetCRT2ToSCART) SiS_Pr->SiS_TVMode |= TVSetPAL;
1679 
1680    if(SiS_Pr->SiS_VBType & VB_SISVB) {
1681 
1682       if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
1683          SiS_Pr->SiS_TVMode |= TVSetPAL;
1684          SiS_Pr->SiS_TVMode &= ~(TVSetPALM | TVSetPALN | TVSetNTSCJ);
1685       } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
1686          if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525i | TVSetYPbPr525p | TVSetYPbPr750p)) {
1687             SiS_Pr->SiS_TVMode &= ~(TVSetPAL | TVSetNTSCJ | TVSetPALM | TVSetPALN);
1688          }
1689       }
1690 
1691       if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
1692          if(!(SiS_Pr->SiS_VBInfo & SetNotSimuMode)) {
1693             SiS_Pr->SiS_TVMode |= TVSetTVSimuMode;
1694          }
1695       }
1696 
1697       if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) {
1698          if(resinfo == SIS_RI_1024x768) {
1699             if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) {
1700                SiS_Pr->SiS_TVMode |= TVSet525p1024;
1701             } else if(!(SiS_Pr->SiS_TVMode & (TVSetHiVision | TVSetYPbPr750p))) {
1702                SiS_Pr->SiS_TVMode |= TVSetNTSC1024;
1703             }
1704          }
1705       }
1706 
1707       SiS_Pr->SiS_TVMode |= TVRPLLDIV2XO;
1708       if((SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) &&
1709          (SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
1710          SiS_Pr->SiS_TVMode &= ~TVRPLLDIV2XO;
1711       } else if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p)) {
1712          SiS_Pr->SiS_TVMode &= ~TVRPLLDIV2XO;
1713       } else if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) {
1714          if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) {
1715             SiS_Pr->SiS_TVMode &= ~TVRPLLDIV2XO;
1716          }
1717       }
1718 
1719    }
1720 
1721    SiS_Pr->SiS_VBInfo &= ~SetPALTV;
1722 }
1723 
1724 /*********************************************/
1725 /*               GET LCD INFO                */
1726 /*********************************************/
1727 
1728 static unsigned short
1729 SiS_GetBIOSLCDResInfo(struct SiS_Private *SiS_Pr)
1730 {
1731    unsigned short temp = SiS_Pr->SiS_LCDResInfo;
1732    /* Translate my LCDResInfo to BIOS value */
1733    switch(temp) {
1734    case Panel_1280x768_2: temp = Panel_1280x768;    break;
1735    case Panel_1280x800_2: temp = Panel_1280x800;    break;
1736    case Panel_1280x854:   temp = Panel661_1280x854; break;
1737    }
1738    return temp;
1739 }
1740 
1741 static void
1742 SiS_GetLCDInfoBIOS(struct SiS_Private *SiS_Pr)
1743 {
1744 #ifdef CONFIG_FB_SIS_315
1745    unsigned char  *ROMAddr;
1746    unsigned short temp;
1747 
1748    if((ROMAddr = GetLCDStructPtr661(SiS_Pr))) {
1749       if((temp = SISGETROMW(6)) != SiS_Pr->PanelHT) {
1750          SiS_Pr->SiS_NeedRomModeData = true;
1751          SiS_Pr->PanelHT  = temp;
1752       }
1753       if((temp = SISGETROMW(8)) != SiS_Pr->PanelVT) {
1754          SiS_Pr->SiS_NeedRomModeData = true;
1755          SiS_Pr->PanelVT  = temp;
1756       }
1757       SiS_Pr->PanelHRS = SISGETROMW(10);
1758       SiS_Pr->PanelHRE = SISGETROMW(12);
1759       SiS_Pr->PanelVRS = SISGETROMW(14);
1760       SiS_Pr->PanelVRE = SISGETROMW(16);
1761       SiS_Pr->PanelVCLKIdx315 = VCLK_CUSTOM_315;
1762       SiS_Pr->SiS_VCLKData[VCLK_CUSTOM_315].CLOCK =
1763          SiS_Pr->SiS_VBVCLKData[VCLK_CUSTOM_315].CLOCK = (unsigned short)((unsigned char)ROMAddr[18]);
1764       SiS_Pr->SiS_VCLKData[VCLK_CUSTOM_315].SR2B =
1765          SiS_Pr->SiS_VBVCLKData[VCLK_CUSTOM_315].Part4_A = ROMAddr[19];
1766       SiS_Pr->SiS_VCLKData[VCLK_CUSTOM_315].SR2C =
1767          SiS_Pr->SiS_VBVCLKData[VCLK_CUSTOM_315].Part4_B = ROMAddr[20];
1768 
1769    }
1770 #endif
1771 }
1772 
1773 static void
1774 SiS_CheckScaling(struct SiS_Private *SiS_Pr, unsigned short resinfo,
1775                         const unsigned char *nonscalingmodes)
1776 {
1777    int i = 0;
1778    while(nonscalingmodes[i] != 0xff) {
1779       if(nonscalingmodes[i++] == resinfo) {
1780          if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) ||
1781             (SiS_Pr->UsePanelScaler == -1)) {
1782             SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
1783          }
1784          break;
1785       }
1786    }
1787 }
1788 
1789 void
1790 SiS_GetLCDResInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
1791 {
1792   unsigned short temp,modeflag,resinfo=0,modexres=0,modeyres=0;
1793   bool panelcanscale = false;
1794 #ifdef CONFIG_FB_SIS_300
1795   unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
1796   static const unsigned char SiS300SeriesLCDRes[] =
1797           { 0,  1,  2,  3,  7,  4,  5,  8,
1798             0,  0, 10,  0,  0,  0,  0, 15 };
1799 #endif
1800 #ifdef CONFIG_FB_SIS_315
1801   unsigned char   *myptr = NULL;
1802 #endif
1803 
1804   SiS_Pr->SiS_LCDResInfo  = 0;
1805   SiS_Pr->SiS_LCDTypeInfo = 0;
1806   SiS_Pr->SiS_LCDInfo     = 0;
1807   SiS_Pr->PanelHRS        = 999; /* HSync start */
1808   SiS_Pr->PanelHRE        = 999; /* HSync end */
1809   SiS_Pr->PanelVRS        = 999; /* VSync start */
1810   SiS_Pr->PanelVRE        = 999; /* VSync end */
1811   SiS_Pr->SiS_NeedRomModeData = false;
1812 
1813   /* Alternative 1600x1200@60 timing for 1600x1200 LCDA */
1814   SiS_Pr->Alternate1600x1200 = false;
1815 
1816   if(!(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA))) return;
1817 
1818   modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
1819 
1820   if((ModeNo > 0x13) && (!SiS_Pr->UseCustomMode)) {
1821      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
1822      modexres = SiS_Pr->SiS_ModeResInfo[resinfo].HTotal;
1823      modeyres = SiS_Pr->SiS_ModeResInfo[resinfo].VTotal;
1824   }
1825 
1826   temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36);
1827 
1828   /* For broken BIOSes: Assume 1024x768 */
1829   if(temp == 0) temp = 0x02;
1830 
1831   if((SiS_Pr->ChipType >= SIS_661) || (SiS_Pr->SiS_ROMNew)) {
1832      SiS_Pr->SiS_LCDTypeInfo = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x39) & 0x7c) >> 2;
1833   } else if((SiS_Pr->ChipType < SIS_315H) || (SiS_Pr->ChipType >= SIS_661)) {
1834      SiS_Pr->SiS_LCDTypeInfo = temp >> 4;
1835   } else {
1836      SiS_Pr->SiS_LCDTypeInfo = (temp & 0x0F) - 1;
1837   }
1838   temp &= 0x0f;
1839 #ifdef CONFIG_FB_SIS_300
1840   if(SiS_Pr->ChipType < SIS_315H) {
1841      /* Very old BIOSes only know 7 sizes (NetVista 2179, 1.01g) */
1842      if(SiS_Pr->SiS_VBType & VB_SIS301) {
1843         if(temp < 0x0f) temp &= 0x07;
1844      }
1845      /* Translate 300 series LCDRes to 315 series for unified usage */
1846      temp = SiS300SeriesLCDRes[temp];
1847   }
1848 #endif
1849 
1850   /* Translate to our internal types */
1851 #ifdef CONFIG_FB_SIS_315
1852   if(SiS_Pr->ChipType == SIS_550) {
1853      if     (temp == Panel310_1152x768)  temp = Panel_320x240_2; /* Verified working */
1854      else if(temp == Panel310_320x240_2) temp = Panel_320x240_2;
1855      else if(temp == Panel310_320x240_3) temp = Panel_320x240_3;
1856   } else if(SiS_Pr->ChipType >= SIS_661) {
1857      if(temp == Panel661_1280x854)       temp = Panel_1280x854;
1858   }
1859 #endif
1860 
1861   if(SiS_Pr->SiS_VBType & VB_SISLVDS) {         /* SiS LVDS */
1862      if(temp == Panel310_1280x768) {
1863         temp = Panel_1280x768_2;
1864      }
1865      if(SiS_Pr->SiS_ROMNew) {
1866         if(temp == Panel661_1280x800) {
1867            temp = Panel_1280x800_2;
1868         }
1869      }
1870   }
1871 
1872   SiS_Pr->SiS_LCDResInfo = temp;
1873 
1874 #ifdef CONFIG_FB_SIS_300
1875   if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
1876      if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) {
1877         SiS_Pr->SiS_LCDResInfo = Panel_Barco1366;
1878      } else if(SiS_Pr->SiS_CustomT == CUT_PANEL848) {
1879         SiS_Pr->SiS_LCDResInfo = Panel_848x480;
1880      } else if(SiS_Pr->SiS_CustomT == CUT_PANEL856) {
1881         SiS_Pr->SiS_LCDResInfo = Panel_856x480;
1882      }
1883   }
1884 #endif
1885 
1886   if(SiS_Pr->SiS_VBType & VB_SISVB) {
1887      if(SiS_Pr->SiS_LCDResInfo < SiS_Pr->SiS_PanelMin301)
1888         SiS_Pr->SiS_LCDResInfo = SiS_Pr->SiS_PanelMin301;
1889   } else {
1890      if(SiS_Pr->SiS_LCDResInfo < SiS_Pr->SiS_PanelMinLVDS)
1891         SiS_Pr->SiS_LCDResInfo = SiS_Pr->SiS_PanelMinLVDS;
1892   }
1893 
1894   temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37);
1895   SiS_Pr->SiS_LCDInfo = temp & ~0x000e;
1896   /* Need temp below! */
1897 
1898   /* These must/can't scale no matter what */
1899   switch(SiS_Pr->SiS_LCDResInfo) {
1900   case Panel_320x240_1:
1901   case Panel_320x240_2:
1902   case Panel_320x240_3:
1903   case Panel_1280x960:
1904       SiS_Pr->SiS_LCDInfo &= ~DontExpandLCD;
1905       break;
1906   case Panel_640x480:
1907       SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
1908   }
1909 
1910   panelcanscale = (bool)(SiS_Pr->SiS_LCDInfo & DontExpandLCD);
1911 
1912   if(!SiS_Pr->UsePanelScaler)          SiS_Pr->SiS_LCDInfo &= ~DontExpandLCD;
1913   else if(SiS_Pr->UsePanelScaler == 1) SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
1914 
1915   /* Dual link, Pass 1:1 BIOS default, etc. */
1916 #ifdef CONFIG_FB_SIS_315
1917   if(SiS_Pr->ChipType >= SIS_661) {
1918      if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
1919         if(temp & 0x08) SiS_Pr->SiS_LCDInfo |= LCDPass11;
1920      }
1921      if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) {
1922         if(SiS_Pr->SiS_ROMNew) {
1923            if(temp & 0x02) SiS_Pr->SiS_LCDInfo |= LCDDualLink;
1924         } else if((myptr = GetLCDStructPtr661(SiS_Pr))) {
1925            if(myptr[2] & 0x01) SiS_Pr->SiS_LCDInfo |= LCDDualLink;
1926         }
1927      }
1928   } else if(SiS_Pr->ChipType >= SIS_315H) {
1929      if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
1930         if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x39) & 0x01) SiS_Pr->SiS_LCDInfo |= LCDPass11;
1931      }
1932      if((SiS_Pr->SiS_ROMNew) && (!(SiS_Pr->PanelSelfDetected))) {
1933         SiS_Pr->SiS_LCDInfo &= ~(LCDRGB18Bit);
1934         temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35);
1935         if(temp & 0x01) SiS_Pr->SiS_LCDInfo |= LCDRGB18Bit;
1936         if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) {
1937            if(temp & 0x02) SiS_Pr->SiS_LCDInfo |= LCDDualLink;
1938         }
1939      } else if(!(SiS_Pr->SiS_ROMNew)) {
1940         if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) {
1941            if((SiS_Pr->SiS_CustomT == CUT_CLEVO1024) &&
1942               (SiS_Pr->SiS_LCDResInfo == Panel_1024x768)) {
1943               SiS_Pr->SiS_LCDInfo |= LCDDualLink;
1944            }
1945            if((SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) ||
1946               (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) ||
1947               (SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) ||
1948               (SiS_Pr->SiS_LCDResInfo == Panel_1680x1050)) {
1949               SiS_Pr->SiS_LCDInfo |= LCDDualLink;
1950            }
1951         }
1952      }
1953   }
1954 #endif
1955 
1956   /* Pass 1:1 */
1957   if((SiS_Pr->SiS_IF_DEF_LVDS == 1) || (SiS_Pr->SiS_VBType & VB_NoLCD)) {
1958      /* Always center screen on LVDS (if scaling is disabled) */
1959      SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
1960   } else if(SiS_Pr->SiS_VBType & VB_SISVB) {
1961      if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
1962         /* Always center screen on SiS LVDS (if scaling is disabled) */
1963         SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
1964      } else {
1965         /* By default, pass 1:1 on SiS TMDS (if scaling is supported) */
1966         if(panelcanscale)             SiS_Pr->SiS_LCDInfo |= LCDPass11;
1967         if(SiS_Pr->CenterScreen == 1) SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
1968      }
1969   }
1970 
1971   SiS_Pr->PanelVCLKIdx300 = VCLK65_300;
1972   SiS_Pr->PanelVCLKIdx315 = VCLK108_2_315;
1973 
1974   switch(SiS_Pr->SiS_LCDResInfo) {
1975      case Panel_320x240_1:
1976      case Panel_320x240_2:
1977      case Panel_320x240_3:  SiS_Pr->PanelXRes =  640; SiS_Pr->PanelYRes =  480;
1978                             SiS_Pr->PanelVRS  =   24; SiS_Pr->PanelVRE  =    3;
1979                             SiS_Pr->PanelVCLKIdx300 = VCLK28;
1980                             SiS_Pr->PanelVCLKIdx315 = VCLK28;
1981                             break;
1982      case Panel_640x480:    SiS_Pr->PanelXRes =  640; SiS_Pr->PanelYRes =  480;
1983                                                       SiS_Pr->PanelVRE  =    3;
1984                             SiS_Pr->PanelVCLKIdx300 = VCLK28;
1985                             SiS_Pr->PanelVCLKIdx315 = VCLK28;
1986                             break;
1987      case Panel_800x600:    SiS_Pr->PanelXRes =  800; SiS_Pr->PanelYRes =  600;
1988                             SiS_Pr->PanelHT   = 1056; SiS_Pr->PanelVT   =  628;
1989                             SiS_Pr->PanelHRS  =   40; SiS_Pr->PanelHRE  =  128;
1990                             SiS_Pr->PanelVRS  =    1; SiS_Pr->PanelVRE  =    4;
1991                             SiS_Pr->PanelVCLKIdx300 = VCLK40;
1992                             SiS_Pr->PanelVCLKIdx315 = VCLK40;
1993                             break;
1994      case Panel_1024x600:   SiS_Pr->PanelXRes = 1024; SiS_Pr->PanelYRes =  600;
1995                             SiS_Pr->PanelHT   = 1344; SiS_Pr->PanelVT   =  800;
1996                             SiS_Pr->PanelHRS  =   24; SiS_Pr->PanelHRE  =  136;
1997                             SiS_Pr->PanelVRS  =    2 /* 88 */ ; SiS_Pr->PanelVRE  =    6;
1998                             SiS_Pr->PanelVCLKIdx300 = VCLK65_300;
1999                             SiS_Pr->PanelVCLKIdx315 = VCLK65_315;
2000                             break;
2001      case Panel_1024x768:   SiS_Pr->PanelXRes = 1024; SiS_Pr->PanelYRes =  768;
2002                             SiS_Pr->PanelHT   = 1344; SiS_Pr->PanelVT   =  806;
2003                             SiS_Pr->PanelHRS  =   24; SiS_Pr->PanelHRE  =  136;
2004                             SiS_Pr->PanelVRS  =    3; SiS_Pr->PanelVRE  =    6;
2005                             if(SiS_Pr->ChipType < SIS_315H) {
2006                                SiS_Pr->PanelHRS = 23;
2007                                                       SiS_Pr->PanelVRE  =    5;
2008                             }
2009                             SiS_Pr->PanelVCLKIdx300 = VCLK65_300;
2010                             SiS_Pr->PanelVCLKIdx315 = VCLK65_315;
2011                             SiS_GetLCDInfoBIOS(SiS_Pr);
2012                             break;
2013      case Panel_1152x768:   SiS_Pr->PanelXRes = 1152; SiS_Pr->PanelYRes =  768;
2014                             SiS_Pr->PanelHT   = 1344; SiS_Pr->PanelVT   =  806;
2015                             SiS_Pr->PanelHRS  =   24; SiS_Pr->PanelHRE  =  136;
2016                             SiS_Pr->PanelVRS  =    3; SiS_Pr->PanelVRE  =    6;
2017                             if(SiS_Pr->ChipType < SIS_315H) {
2018                                SiS_Pr->PanelHRS = 23;
2019                                                       SiS_Pr->PanelVRE  =    5;
2020                             }
2021                             SiS_Pr->PanelVCLKIdx300 = VCLK65_300;
2022                             SiS_Pr->PanelVCLKIdx315 = VCLK65_315;
2023                             break;
2024      case Panel_1152x864:   SiS_Pr->PanelXRes = 1152; SiS_Pr->PanelYRes =  864;
2025                             break;
2026      case Panel_1280x720:   SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes =  720;
2027                             SiS_Pr->PanelHT   = 1650; SiS_Pr->PanelVT   =  750;
2028                             SiS_Pr->PanelHRS  =  110; SiS_Pr->PanelHRE  =   40;
2029                             SiS_Pr->PanelVRS  =    5; SiS_Pr->PanelVRE  =    5;
2030                             SiS_Pr->PanelVCLKIdx315 = VCLK_1280x720;
2031                             /* Data above for TMDS (projector); get from BIOS for LVDS */
2032                             SiS_GetLCDInfoBIOS(SiS_Pr);
2033                             break;
2034      case Panel_1280x768:   SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes =  768;
2035                             if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
2036                                SiS_Pr->PanelHT   = 1408; SiS_Pr->PanelVT   =  806;
2037                                SiS_Pr->PanelVCLKIdx300 = VCLK81_300; /* ? */
2038                                SiS_Pr->PanelVCLKIdx315 = VCLK81_315; /* ? */
2039                             } else {
2040                                SiS_Pr->PanelHT   = 1688; SiS_Pr->PanelVT   =  802;
2041                                SiS_Pr->PanelHRS  =   48; SiS_Pr->PanelHRE  =  112;
2042                                SiS_Pr->PanelVRS  =    3; SiS_Pr->PanelVRE  =    6;
2043                                SiS_Pr->PanelVCLKIdx300 = VCLK81_300;
2044                                SiS_Pr->PanelVCLKIdx315 = VCLK81_315;
2045                             }
2046                             break;
2047      case Panel_1280x768_2: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes =  768;
2048                             SiS_Pr->PanelHT   = 1660; SiS_Pr->PanelVT   =  806;
2049                             SiS_Pr->PanelHRS  =   48; SiS_Pr->PanelHRE  =  112;
2050                             SiS_Pr->PanelVRS  =    3; SiS_Pr->PanelVRE  =    6;
2051                             SiS_Pr->PanelVCLKIdx315 = VCLK_1280x768_2;
2052                             SiS_GetLCDInfoBIOS(SiS_Pr);
2053                             break;
2054      case Panel_1280x800:   SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes =  800;
2055                             SiS_Pr->PanelHT   = 1408; SiS_Pr->PanelVT   =  816;
2056                             SiS_Pr->PanelHRS   =  21; SiS_Pr->PanelHRE  =   24;
2057                             SiS_Pr->PanelVRS   =   4; SiS_Pr->PanelVRE  =    3;
2058                             SiS_Pr->PanelVCLKIdx315 = VCLK_1280x800_315;
2059                             SiS_GetLCDInfoBIOS(SiS_Pr);
2060                             break;
2061      case Panel_1280x800_2: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes =  800;
2062                             SiS_Pr->PanelHT   = 1552; SiS_Pr->PanelVT   =  812;
2063                             SiS_Pr->PanelHRS   =  48; SiS_Pr->PanelHRE  =  112;
2064                             SiS_Pr->PanelVRS   =   4; SiS_Pr->PanelVRE  =    3;
2065                             SiS_Pr->PanelVCLKIdx315 = VCLK_1280x800_315_2;
2066                             SiS_GetLCDInfoBIOS(SiS_Pr);
2067                             break;
2068      case Panel_1280x854:   SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes =  854;
2069                             SiS_Pr->PanelHT   = 1664; SiS_Pr->PanelVT   =  861;
2070                             SiS_Pr->PanelHRS   =  16; SiS_Pr->PanelHRE  =  112;
2071                             SiS_Pr->PanelVRS   =   1; SiS_Pr->PanelVRE  =    3;
2072                             SiS_Pr->PanelVCLKIdx315 = VCLK_1280x854;
2073                             SiS_GetLCDInfoBIOS(SiS_Pr);
2074                             break;
2075      case Panel_1280x960:   SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes =  960;
2076                             SiS_Pr->PanelHT   = 1800; SiS_Pr->PanelVT   = 1000;
2077                             SiS_Pr->PanelVCLKIdx300 = VCLK108_3_300;
2078                             SiS_Pr->PanelVCLKIdx315 = VCLK108_3_315;
2079                             if(resinfo == SIS_RI_1280x1024) {
2080                                SiS_Pr->PanelVCLKIdx300 = VCLK100_300;
2081                                SiS_Pr->PanelVCLKIdx315 = VCLK100_315;
2082                             }
2083                             break;
2084      case Panel_1280x1024:  SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 1024;
2085                             SiS_Pr->PanelHT   = 1688; SiS_Pr->PanelVT   = 1066;
2086                             SiS_Pr->PanelHRS  =   48; SiS_Pr->PanelHRE  =  112;
2087                             SiS_Pr->PanelVRS  =    1; SiS_Pr->PanelVRE  =    3;
2088                             SiS_Pr->PanelVCLKIdx300 = VCLK108_3_300;
2089                             SiS_Pr->PanelVCLKIdx315 = VCLK108_2_315;
2090                             SiS_GetLCDInfoBIOS(SiS_Pr);
2091                             break;
2092      case Panel_1400x1050:  SiS_Pr->PanelXRes = 1400; SiS_Pr->PanelYRes = 1050;
2093                             SiS_Pr->PanelHT   = 1688; SiS_Pr->PanelVT   = 1066;
2094                             SiS_Pr->PanelHRS  =   48; SiS_Pr->PanelHRE  =  112;
2095                             SiS_Pr->PanelVRS  =    1; SiS_Pr->PanelVRE  =    3;
2096                             SiS_Pr->PanelVCLKIdx315 = VCLK108_2_315;
2097                             SiS_GetLCDInfoBIOS(SiS_Pr);
2098                             break;
2099      case Panel_1600x1200:  SiS_Pr->PanelXRes = 1600; SiS_Pr->PanelYRes = 1200;
2100                             SiS_Pr->PanelHT   = 2160; SiS_Pr->PanelVT   = 1250;
2101                             SiS_Pr->PanelHRS  =   64; SiS_Pr->PanelHRE  =  192;
2102                             SiS_Pr->PanelVRS  =    1; SiS_Pr->PanelVRE  =    3;
2103                             SiS_Pr->PanelVCLKIdx315 = VCLK162_315;
2104                             if(SiS_Pr->SiS_VBType & VB_SISTMDSLCDA) {
2105                                if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
2106                                   SiS_Pr->PanelHT  = 1760; SiS_Pr->PanelVT  = 1235;
2107                                   SiS_Pr->PanelHRS =   48; SiS_Pr->PanelHRE =   32;
2108                                   SiS_Pr->PanelVRS =    2; SiS_Pr->PanelVRE =    4;
2109                                   SiS_Pr->PanelVCLKIdx315 = VCLK130_315;
2110                                   SiS_Pr->Alternate1600x1200 = true;
2111                                }
2112                             } else if(SiS_Pr->SiS_IF_DEF_LVDS) {
2113                                SiS_Pr->PanelHT  = 2048; SiS_Pr->PanelVT  = 1320;
2114                                SiS_Pr->PanelHRS = SiS_Pr->PanelHRE = 999;
2115                                SiS_Pr->PanelVRS = SiS_Pr->PanelVRE = 999;
2116                             }
2117                             SiS_GetLCDInfoBIOS(SiS_Pr);
2118                             break;
2119      case Panel_1680x1050:  SiS_Pr->PanelXRes = 1680; SiS_Pr->PanelYRes = 1050;
2120                             SiS_Pr->PanelHT   = 1900; SiS_Pr->PanelVT   = 1066;
2121                             SiS_Pr->PanelHRS  =   26; SiS_Pr->PanelHRE  =   76;
2122                             SiS_Pr->PanelVRS  =    3; SiS_Pr->PanelVRE  =    6;
2123                             SiS_Pr->PanelVCLKIdx315 = VCLK121_315;
2124                             SiS_GetLCDInfoBIOS(SiS_Pr);
2125                             break;
2126      case Panel_Barco1366:  SiS_Pr->PanelXRes = 1360; SiS_Pr->PanelYRes = 1024;
2127                             SiS_Pr->PanelHT   = 1688; SiS_Pr->PanelVT   = 1066;
2128                             break;
2129      case Panel_848x480:    SiS_Pr->PanelXRes =  848; SiS_Pr->PanelYRes =  480;
2130                             SiS_Pr->PanelHT   = 1088; SiS_Pr->PanelVT   =  525;
2131                             break;
2132      case Panel_856x480:    SiS_Pr->PanelXRes =  856; SiS_Pr->PanelYRes =  480;
2133                             SiS_Pr->PanelHT   = 1088; SiS_Pr->PanelVT   =  525;
2134                             break;
2135      case Panel_Custom:     SiS_Pr->PanelXRes = SiS_Pr->CP_MaxX;
2136                             SiS_Pr->PanelYRes = SiS_Pr->CP_MaxY;
2137                             SiS_Pr->PanelHT   = SiS_Pr->CHTotal;
2138                             SiS_Pr->PanelVT   = SiS_Pr->CVTotal;
2139                             if(SiS_Pr->CP_PreferredIndex != -1) {
2140                                SiS_Pr->PanelXRes = SiS_Pr->CP_HDisplay[SiS_Pr->CP_PreferredIndex];
2141                                SiS_Pr->PanelYRes = SiS_Pr->CP_VDisplay[SiS_Pr->CP_PreferredIndex];
2142                                SiS_Pr->PanelHT   = SiS_Pr->CP_HTotal[SiS_Pr->CP_PreferredIndex];
2143                                SiS_Pr->PanelVT   = SiS_Pr->CP_VTotal[SiS_Pr->CP_PreferredIndex];
2144                                SiS_Pr->PanelHRS  = SiS_Pr->CP_HSyncStart[SiS_Pr->CP_PreferredIndex];
2145                                SiS_Pr->PanelHRE  = SiS_Pr->CP_HSyncEnd[SiS_Pr->CP_PreferredIndex];
2146                                SiS_Pr->PanelVRS  = SiS_Pr->CP_VSyncStart[SiS_Pr->CP_PreferredIndex];
2147                                SiS_Pr->PanelVRE  = SiS_Pr->CP_VSyncEnd[SiS_Pr->CP_PreferredIndex];
2148                                SiS_Pr->PanelHRS -= SiS_Pr->PanelXRes;
2149                                SiS_Pr->PanelHRE -= SiS_Pr->PanelHRS;
2150                                SiS_Pr->PanelVRS -= SiS_Pr->PanelYRes;
2151                                SiS_Pr->PanelVRE -= SiS_Pr->PanelVRS;
2152                                if(SiS_Pr->CP_PrefClock) {
2153                                   int idx;
2154                                   SiS_Pr->PanelVCLKIdx315 = VCLK_CUSTOM_315;
2155                                   SiS_Pr->PanelVCLKIdx300 = VCLK_CUSTOM_300;
2156                                   if(SiS_Pr->ChipType < SIS_315H) idx = VCLK_CUSTOM_300;
2157                                   else                             idx = VCLK_CUSTOM_315;
2158                                   SiS_Pr->SiS_VCLKData[idx].CLOCK =
2159                                      SiS_Pr->SiS_VBVCLKData[idx].CLOCK = SiS_Pr->CP_PrefClock;
2160                                   SiS_Pr->SiS_VCLKData[idx].SR2B =
2161                                      SiS_Pr->SiS_VBVCLKData[idx].Part4_A = SiS_Pr->CP_PrefSR2B;
2162                                   SiS_Pr->SiS_VCLKData[idx].SR2C =
2163                                      SiS_Pr->SiS_VBVCLKData[idx].Part4_B = SiS_Pr->CP_PrefSR2C;
2164                                }
2165                             }
2166                             break;
2167      default:               SiS_Pr->PanelXRes = 1024; SiS_Pr->PanelYRes =  768;
2168                             SiS_Pr->PanelHT   = 1344; SiS_Pr->PanelVT   =  806;
2169                             break;
2170   }
2171 
2172   /* Special cases */
2173   if( (SiS_Pr->SiS_IF_DEF_FSTN)              ||
2174       (SiS_Pr->SiS_IF_DEF_DSTN)              ||
2175       (SiS_Pr->SiS_CustomT == CUT_BARCO1366) ||
2176       (SiS_Pr->SiS_CustomT == CUT_BARCO1024) ||
2177       (SiS_Pr->SiS_CustomT == CUT_PANEL848)  ||
2178       (SiS_Pr->SiS_CustomT == CUT_PANEL856) ) {
2179      SiS_Pr->PanelHRS = 999;
2180      SiS_Pr->PanelHRE = 999;
2181   }
2182 
2183   if( (SiS_Pr->SiS_CustomT == CUT_BARCO1366) ||
2184       (SiS_Pr->SiS_CustomT == CUT_BARCO1024) ||
2185       (SiS_Pr->SiS_CustomT == CUT_PANEL848)  ||
2186       (SiS_Pr->SiS_CustomT == CUT_PANEL856) ) {
2187      SiS_Pr->PanelVRS = 999;
2188      SiS_Pr->PanelVRE = 999;
2189   }
2190 
2191   /* DontExpand overrule */
2192   if((SiS_Pr->SiS_VBType & VB_SISVB) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) {
2193 
2194      if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (modeflag & NoSupportLCDScale)) {
2195         /* No scaling for this mode on any panel (LCD=CRT2)*/
2196         SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2197      }
2198 
2199      switch(SiS_Pr->SiS_LCDResInfo) {
2200 
2201      case Panel_Custom:
2202      case Panel_1152x864:
2203      case Panel_1280x768:       /* TMDS only */
2204         SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2205         break;
2206 
2207      case Panel_800x600: {
2208         static const unsigned char nonscalingmodes[] = {
2209            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, 0xff
2210         };
2211         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2212         break;
2213      }
2214      case Panel_1024x768: {
2215         static const unsigned char nonscalingmodes[] = {
2216            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2217            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2218            0xff
2219         };
2220         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2221         break;
2222      }
2223      case Panel_1280x720: {
2224         static const unsigned char nonscalingmodes[] = {
2225            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2226            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2227            0xff
2228         };
2229         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2230         if(SiS_Pr->PanelHT == 1650) {
2231            SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2232         }
2233         break;
2234      }
2235      case Panel_1280x768_2: {  /* LVDS only */
2236         static const unsigned char nonscalingmodes[] = {
2237            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2238            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2239            SIS_RI_1152x768,0xff
2240         };
2241         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2242         switch(resinfo) {
2243         case SIS_RI_1280x720:  if(SiS_Pr->UsePanelScaler == -1) {
2244                                   SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2245                                }
2246                                break;
2247         }
2248         break;
2249      }
2250      case Panel_1280x800: {     /* SiS TMDS special (Averatec 6200 series) */
2251         static const unsigned char nonscalingmodes[] = {
2252            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2253            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2254            SIS_RI_1152x768,SIS_RI_1280x720,SIS_RI_1280x768,0xff
2255         };
2256         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2257         break;
2258      }
2259      case Panel_1280x800_2:  {  /* SiS LVDS */
2260         static const unsigned char nonscalingmodes[] = {
2261            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2262            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2263            SIS_RI_1152x768,0xff
2264         };
2265         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2266         switch(resinfo) {
2267         case SIS_RI_1280x720:
2268         case SIS_RI_1280x768:  if(SiS_Pr->UsePanelScaler == -1) {
2269                                   SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2270                                }
2271                                break;
2272         }
2273         break;
2274      }
2275      case Panel_1280x854: {     /* SiS LVDS */
2276         static const unsigned char nonscalingmodes[] = {
2277            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2278            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2279            SIS_RI_1152x768,0xff
2280         };
2281         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2282         switch(resinfo) {
2283         case SIS_RI_1280x720:
2284         case SIS_RI_1280x768:
2285         case SIS_RI_1280x800:  if(SiS_Pr->UsePanelScaler == -1) {
2286                                   SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2287                                }
2288                                break;
2289         }
2290         break;
2291      }
2292      case Panel_1280x960: {
2293         static const unsigned char nonscalingmodes[] = {
2294            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2295            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2296            SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x720,SIS_RI_1280x768,SIS_RI_1280x800,
2297            SIS_RI_1280x854,0xff
2298         };
2299         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2300         break;
2301      }
2302      case Panel_1280x1024: {
2303         static const unsigned char nonscalingmodes[] = {
2304            SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2305            SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2306            SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x720,SIS_RI_1280x768,SIS_RI_1280x800,
2307            SIS_RI_1280x854,SIS_RI_1280x960,0xff
2308         };
2309         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2310         break;
2311      }
2312      case Panel_1400x1050: {
2313         static const unsigned char nonscalingmodes[] = {
2314              SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2315              SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2316              SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x768,SIS_RI_1280x800,SIS_RI_1280x854,
2317              SIS_RI_1280x960,0xff
2318         };
2319         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2320         switch(resinfo) {
2321         case SIS_RI_1280x720:  if(SiS_Pr->UsePanelScaler == -1) {
2322                                   SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2323                                }
2324                                break;
2325         case SIS_RI_1280x1024: SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
2326                                break;
2327         }
2328         break;
2329      }
2330      case Panel_1600x1200: {
2331         static const unsigned char nonscalingmodes[] = {
2332              SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2333              SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2334              SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x720,SIS_RI_1280x768,SIS_RI_1280x800,
2335              SIS_RI_1280x854,SIS_RI_1280x960,SIS_RI_1360x768,SIS_RI_1360x1024,0xff
2336         };
2337         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2338         break;
2339      }
2340      case Panel_1680x1050: {
2341         static const unsigned char nonscalingmodes[] = {
2342              SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480,
2343              SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600,
2344              SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x854,SIS_RI_1280x960,SIS_RI_1360x768,
2345              SIS_RI_1360x1024,0xff
2346         };
2347         SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes);
2348         break;
2349      }
2350      }
2351   }
2352 
2353 #ifdef CONFIG_FB_SIS_300
2354   if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
2355      if(SiS_Pr->SiS_CustomT == CUT_PANEL848 || SiS_Pr->SiS_CustomT == CUT_PANEL856) {
2356         SiS_Pr->SiS_LCDInfo = 0x80 | 0x40 | 0x20;   /* neg h/v sync, RGB24(D0 = 0) */
2357      }
2358   }
2359 
2360   if(SiS_Pr->ChipType < SIS_315H) {
2361      if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
2362         if(SiS_Pr->SiS_UseROM) {
2363            if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) {
2364               if(!(ROMAddr[0x235] & 0x02)) {
2365                  SiS_Pr->SiS_LCDInfo &= (~DontExpandLCD);
2366               }
2367            }
2368         }
2369      } else if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
2370         if((SiS_Pr->SiS_SetFlag & SetDOSMode) && ((ModeNo == 0x03) || (ModeNo == 0x10))) {
2371            SiS_Pr->SiS_LCDInfo &= (~DontExpandLCD);
2372         }
2373      }
2374   }
2375 #endif
2376 
2377   /* Special cases */
2378 
2379   if(modexres == SiS_Pr->PanelXRes && modeyres == SiS_Pr->PanelYRes) {
2380      SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
2381   }
2382 
2383   if(SiS_Pr->SiS_IF_DEF_TRUMPION) {
2384      SiS_Pr->SiS_LCDInfo |= (DontExpandLCD | LCDPass11);
2385   }
2386 
2387   switch(SiS_Pr->SiS_LCDResInfo) {
2388   case Panel_640x480:
2389      SiS_Pr->SiS_LCDInfo |= (DontExpandLCD | LCDPass11);
2390      break;
2391   case Panel_1280x800:
2392      /* Don't pass 1:1 by default (TMDS special) */
2393      if(SiS_Pr->CenterScreen == -1) SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
2394      break;
2395   case Panel_1280x960:
2396      SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
2397      break;
2398   case Panel_Custom:
2399      if((!SiS_Pr->CP_PrefClock) ||
2400         (modexres > SiS_Pr->PanelXRes) || (modeyres > SiS_Pr->PanelYRes)) {
2401         SiS_Pr->SiS_LCDInfo |= LCDPass11;
2402      }
2403      break;
2404   }
2405 
2406   if((SiS_Pr->UseCustomMode) || (SiS_Pr->SiS_CustomT == CUT_UNKNOWNLCD)) {
2407      SiS_Pr->SiS_LCDInfo |= (DontExpandLCD | LCDPass11);
2408   }
2409 
2410   /* (In)validate LCDPass11 flag */
2411   if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) {
2412      SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
2413   }
2414 
2415   /* LVDS DDA */
2416   if(!((SiS_Pr->ChipType < SIS_315H) && (SiS_Pr->SiS_SetFlag & SetDOSMode))) {
2417 
2418      if((SiS_Pr->SiS_IF_DEF_LVDS == 1) || (SiS_Pr->SiS_VBType & VB_NoLCD)) {
2419         if(SiS_Pr->SiS_IF_DEF_TRUMPION == 0) {
2420            if(ModeNo == 0x12) {
2421               if(SiS_Pr->SiS_LCDInfo & LCDPass11) {
2422                  SiS_Pr->SiS_SetFlag |= EnableLVDSDDA;
2423               }
2424            } else if(ModeNo > 0x13) {
2425               if(SiS_Pr->SiS_LCDResInfo == Panel_1024x600) {
2426                  if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) {
2427                     if((resinfo == SIS_RI_800x600) || (resinfo == SIS_RI_400x300)) {
2428                        SiS_Pr->SiS_SetFlag |= EnableLVDSDDA;
2429                     }
2430                  }
2431               }
2432            }
2433         }
2434      }
2435 
2436      if(modeflag & HalfDCLK) {
2437         if(SiS_Pr->SiS_IF_DEF_TRUMPION == 1) {
2438            SiS_Pr->SiS_SetFlag |= EnableLVDSDDA;
2439         } else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
2440            SiS_Pr->SiS_SetFlag |= EnableLVDSDDA;
2441         } else if(SiS_Pr->SiS_LCDResInfo == Panel_640x480) {
2442            SiS_Pr->SiS_SetFlag |= EnableLVDSDDA;
2443         } else if(ModeNo > 0x13) {
2444            if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
2445               if(resinfo == SIS_RI_512x384) SiS_Pr->SiS_SetFlag |= EnableLVDSDDA;
2446            } else if(SiS_Pr->SiS_LCDResInfo == Panel_800x600) {
2447               if(resinfo == SIS_RI_400x300) SiS_Pr->SiS_SetFlag |= EnableLVDSDDA;
2448            }
2449         }
2450      }
2451 
2452   }
2453 
2454   /* VESA timing */
2455   if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2456      if(SiS_Pr->SiS_VBInfo & SetNotSimuMode) {
2457         SiS_Pr->SiS_SetFlag |= LCDVESATiming;
2458      }
2459   } else {
2460      SiS_Pr->SiS_SetFlag |= LCDVESATiming;
2461   }
2462 
2463 #if 0
2464   printk(KERN_DEBUG "sisfb: (LCDInfo=0x%04x LCDResInfo=0x%02x LCDTypeInfo=0x%02x)\n",
2465         SiS_Pr->SiS_LCDInfo, SiS_Pr->SiS_LCDResInfo, SiS_Pr->SiS_LCDTypeInfo);
2466 #endif
2467 }
2468 
2469 /*********************************************/
2470 /*                 GET VCLK                  */
2471 /*********************************************/
2472 
2473 unsigned short
2474 SiS_GetVCLK2Ptr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
2475                 unsigned short RefreshRateTableIndex)
2476 {
2477   unsigned short CRT2Index, VCLKIndex = 0, VCLKIndexGEN = 0, VCLKIndexGENCRT = 0;
2478   unsigned short resinfo, tempbx;
2479   const unsigned char *CHTVVCLKPtr = NULL;
2480 
2481   if(ModeNo <= 0x13) {
2482      resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo;
2483      CRT2Index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
2484      VCLKIndexGEN = (SiS_GetRegByte((SiS_Pr->SiS_P3ca+0x02)) >> 2) & 0x03;
2485      VCLKIndexGENCRT = VCLKIndexGEN;
2486   } else {
2487      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
2488      CRT2Index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
2489      VCLKIndexGEN = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
2490      VCLKIndexGENCRT = SiS_GetRefCRTVCLK(SiS_Pr, RefreshRateTableIndex,
2491                 (SiS_Pr->SiS_SetFlag & ProgrammingCRT2) ? SiS_Pr->SiS_UseWideCRT2 : SiS_Pr->SiS_UseWide);
2492   }
2493 
2494   if(SiS_Pr->SiS_VBType & VB_SISVB) {    /* 30x/B/LV */
2495 
2496      if(SiS_Pr->SiS_SetFlag & ProgrammingCRT2) {
2497 
2498         CRT2Index >>= 6;
2499         if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {       /*  LCD */
2500 
2501            if(SiS_Pr->ChipType < SIS_315H) {
2502               VCLKIndex = SiS_Pr->PanelVCLKIdx300;
2503               if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (SiS_Pr->SiS_LCDInfo & LCDPass11)) {
2504                  VCLKIndex = VCLKIndexGEN;
2505               }
2506            } else {
2507               VCLKIndex = SiS_Pr->PanelVCLKIdx315;
2508               if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (SiS_Pr->SiS_LCDInfo & LCDPass11)) {
2509                  switch(resinfo) {
2510                  /* Correct those whose IndexGEN doesn't match VBVCLK array */
2511                  case SIS_RI_720x480:  VCLKIndex = VCLK_720x480;  break;
2512                  case SIS_RI_720x576:  VCLKIndex = VCLK_720x576;  break;
2513                  case SIS_RI_768x576:  VCLKIndex = VCLK_768x576;  break;
2514                  case SIS_RI_848x480:  VCLKIndex = VCLK_848x480;  break;
2515                  case SIS_RI_856x480:  VCLKIndex = VCLK_856x480;  break;
2516                  case SIS_RI_800x480:  VCLKIndex = VCLK_800x480;  break;
2517                  case SIS_RI_1024x576: VCLKIndex = VCLK_1024x576; break;
2518                  case SIS_RI_1152x864: VCLKIndex = VCLK_1152x864; break;
2519                  case SIS_RI_1280x720: VCLKIndex = VCLK_1280x720; break;
2520                  case SIS_RI_1360x768: VCLKIndex = VCLK_1360x768; break;
2521                  default:              VCLKIndex = VCLKIndexGEN;
2522                  }
2523 
2524                  if(ModeNo <= 0x13) {
2525                     if(SiS_Pr->ChipType <= SIS_315PRO) {
2526                        if(SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC == 1) VCLKIndex = 0x42;
2527                     } else {
2528                        if(SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC == 1) VCLKIndex = 0x00;
2529                     }
2530                  }
2531                  if(SiS_Pr->ChipType <= SIS_315PRO) {
2532                     if(VCLKIndex == 0) VCLKIndex = 0x41;
2533                     if(VCLKIndex == 1) VCLKIndex = 0x43;
2534                     if(VCLKIndex == 4) VCLKIndex = 0x44;
2535                  }
2536               }
2537            }
2538 
2539         } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {                   /*  TV */
2540 
2541            if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
2542               if(SiS_Pr->SiS_TVMode & TVRPLLDIV2XO)        VCLKIndex = HiTVVCLKDIV2;
2543               else                                         VCLKIndex = HiTVVCLK;
2544               if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode)     VCLKIndex = HiTVSimuVCLK;
2545            } else if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p)  VCLKIndex = YPbPr750pVCLK;
2546            else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p)    VCLKIndex = TVVCLKDIV2;
2547            else if(SiS_Pr->SiS_TVMode & TVRPLLDIV2XO)      VCLKIndex = TVVCLKDIV2;
2548            else                                            VCLKIndex = TVVCLK;
2549 
2550            if(SiS_Pr->ChipType < SIS_315H) VCLKIndex += TVCLKBASE_300;
2551            else                            VCLKIndex += TVCLKBASE_315;
2552 
2553         } else {                                                        /* VGA2 */
2554 
2555            VCLKIndex = VCLKIndexGENCRT;
2556            if(SiS_Pr->ChipType < SIS_315H) {
2557               if(ModeNo > 0x13) {
2558                  if( (SiS_Pr->ChipType == SIS_630) &&
2559                      (SiS_Pr->ChipRevision >= 0x30)) {
2560                     if(VCLKIndex == 0x14) VCLKIndex = 0x34;
2561                  }
2562                  /* Better VGA2 clock for 1280x1024@75 */
2563                  if(VCLKIndex == 0x17) VCLKIndex = 0x45;
2564               }
2565            }
2566         }
2567 
2568      } else {   /* If not programming CRT2 */
2569 
2570         VCLKIndex = VCLKIndexGENCRT;
2571         if(SiS_Pr->ChipType < SIS_315H) {
2572            if(ModeNo > 0x13) {
2573               if( (SiS_Pr->ChipType != SIS_630) &&
2574                   (SiS_Pr->ChipType != SIS_300) ) {
2575                  if(VCLKIndex == 0x1b) VCLKIndex = 0x48;
2576               }
2577            }
2578         }
2579      }
2580 
2581   } else {       /*   LVDS  */
2582 
2583      VCLKIndex = CRT2Index;
2584 
2585      if(SiS_Pr->SiS_SetFlag & ProgrammingCRT2) {
2586 
2587         if( (SiS_Pr->SiS_IF_DEF_CH70xx != 0) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV) ) {
2588 
2589            VCLKIndex &= 0x1f;
2590            tempbx = 0;
2591            if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx += 1;
2592            if(SiS_Pr->SiS_TVMode & TVSetPAL) {
2593               tempbx += 2;
2594               if(SiS_Pr->SiS_ModeType > ModeVGA) {
2595                  if(SiS_Pr->SiS_CHSOverScan) tempbx = 8;
2596               }
2597               if(SiS_Pr->SiS_TVMode & TVSetPALM) {
2598                  tempbx = 4;
2599                  if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx += 1;
2600               } else if(SiS_Pr->SiS_TVMode & TVSetPALN) {
2601                  tempbx = 6;
2602                  if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx += 1;
2603               }
2604            }
2605            switch(tempbx) {
2606              case  0: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUNTSC;  break;
2607              case  1: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKONTSC;  break;
2608              case  2: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUPAL;   break;
2609              case  3: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPAL;   break;
2610              case  4: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUPALM;  break;
2611              case  5: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPALM;  break;
2612              case  6: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUPALN;  break;
2613              case  7: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPALN;  break;
2614              case  8: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKSOPAL;  break;
2615              default: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPAL;   break;
2616            }
2617            VCLKIndex = CHTVVCLKPtr[VCLKIndex];
2618 
2619         } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
2620 
2621            if(SiS_Pr->ChipType < SIS_315H) {
2622               VCLKIndex = SiS_Pr->PanelVCLKIdx300;
2623            } else {
2624               VCLKIndex = SiS_Pr->PanelVCLKIdx315;
2625            }
2626 
2627 #ifdef CONFIG_FB_SIS_300
2628            /* Special Timing: Barco iQ Pro R series */
2629            if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) VCLKIndex = 0x44;
2630 
2631            /* Special Timing: 848x480 and 856x480 parallel lvds panels */
2632            if(SiS_Pr->SiS_CustomT == CUT_PANEL848 || SiS_Pr->SiS_CustomT == CUT_PANEL856) {
2633               if(SiS_Pr->ChipType < SIS_315H) {
2634                  VCLKIndex = VCLK34_300;
2635                  /* if(resinfo == SIS_RI_1360x768) VCLKIndex = ?; */
2636               } else {
2637                  VCLKIndex = VCLK34_315;
2638                  /* if(resinfo == SIS_RI_1360x768) VCLKIndex = ?; */
2639               }
2640            }
2641 #endif
2642 
2643         } else {
2644 
2645            VCLKIndex = VCLKIndexGENCRT;
2646            if(SiS_Pr->ChipType < SIS_315H) {
2647               if(ModeNo > 0x13) {
2648                  if( (SiS_Pr->ChipType == SIS_630) &&
2649                      (SiS_Pr->ChipRevision >= 0x30) ) {
2650                     if(VCLKIndex == 0x14) VCLKIndex = 0x2e;
2651                  }
2652               }
2653            }
2654         }
2655 
2656      } else {  /* if not programming CRT2 */
2657 
2658         VCLKIndex = VCLKIndexGENCRT;
2659         if(SiS_Pr->ChipType < SIS_315H) {
2660            if(ModeNo > 0x13) {
2661               if( (SiS_Pr->ChipType != SIS_630) &&
2662                   (SiS_Pr->ChipType != SIS_300) ) {
2663                  if(VCLKIndex == 0x1b) VCLKIndex = 0x48;
2664               }
2665 #if 0
2666               if(SiS_Pr->ChipType == SIS_730) {
2667                  if(VCLKIndex == 0x0b) VCLKIndex = 0x40;   /* 1024x768-70 */
2668                  if(VCLKIndex == 0x0d) VCLKIndex = 0x41;   /* 1024x768-75 */
2669               }
2670 #endif
2671            }
2672         }
2673 
2674      }
2675 
2676   }
2677 
2678   return VCLKIndex;
2679 }
2680 
2681 /*********************************************/
2682 /*        SET CRT2 MODE TYPE REGISTERS       */
2683 /*********************************************/
2684 
2685 static void
2686 SiS_SetCRT2ModeRegs(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
2687 {
2688   unsigned short i, j, modeflag, tempah=0;
2689   short tempcl;
2690 #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315)
2691   unsigned short tempbl;
2692 #endif
2693 #ifdef CONFIG_FB_SIS_315
2694   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
2695   unsigned short tempah2, tempbl2;
2696 #endif
2697 
2698   modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex);
2699 
2700   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
2701 
2702      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x00,0xAF,0x40);
2703      SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2E,0xF7);
2704 
2705   } else {
2706 
2707      for(i=0,j=4; i<3; i++,j++) SiS_SetReg(SiS_Pr->SiS_Part1Port,j,0);
2708      if(SiS_Pr->ChipType >= SIS_315H) {
2709         SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0x7F);
2710      }
2711 
2712      tempcl = SiS_Pr->SiS_ModeType;
2713 
2714      if(SiS_Pr->ChipType < SIS_315H) {
2715 
2716 #ifdef CONFIG_FB_SIS_300    /* ---- 300 series ---- */
2717 
2718         /* For 301BDH: (with LCD via LVDS) */
2719         if(SiS_Pr->SiS_VBType & VB_NoLCD) {
2720            tempbl = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32);
2721            tempbl &= 0xef;
2722            tempbl |= 0x02;
2723            if((SiS_Pr->SiS_VBInfo & SetCRT2ToTV) || (SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) {
2724               tempbl |= 0x10;
2725               tempbl &= 0xfd;
2726            }
2727            SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,tempbl);
2728         }
2729 
2730         if(ModeNo > 0x13) {
2731            tempcl -= ModeVGA;
2732            if(tempcl >= 0) {
2733               tempah = ((0x10 >> tempcl) | 0x80);
2734            }
2735         } else tempah = 0x80;
2736 
2737         if(SiS_Pr->SiS_VBInfo & SetInSlaveMode)  tempah ^= 0xA0;
2738 
2739 #endif  /* CONFIG_FB_SIS_300 */
2740 
2741      } else {
2742 
2743 #ifdef CONFIG_FB_SIS_315    /* ------- 315/330 series ------ */
2744 
2745         if(ModeNo > 0x13) {
2746            tempcl -= ModeVGA;
2747            if(tempcl >= 0) {
2748               tempah = (0x08 >> tempcl);
2749               if (tempah == 0) tempah = 1;
2750               tempah |= 0x40;
2751            }
2752         } else tempah = 0x40;
2753 
2754         if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) tempah ^= 0x50;
2755 
2756 #endif  /* CONFIG_FB_SIS_315 */
2757 
2758      }
2759 
2760      if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0;
2761 
2762      if(SiS_Pr->ChipType < SIS_315H) {
2763         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,tempah);
2764      } else {
2765 #ifdef CONFIG_FB_SIS_315
2766         if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
2767            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x00,0xa0,tempah);
2768         } else if(SiS_Pr->SiS_VBType & VB_SISVB) {
2769            if(IS_SIS740) {
2770               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,tempah);
2771            } else {
2772               SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x00,0xa0,tempah);
2773            }
2774         }
2775 #endif
2776      }
2777 
2778      if(SiS_Pr->SiS_VBType & VB_SISVB) {
2779 
2780         tempah = 0x01;
2781         if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
2782            tempah |= 0x02;
2783         }
2784         if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) {
2785            tempah ^= 0x05;
2786            if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) {
2787               tempah ^= 0x01;
2788            }
2789         }
2790 
2791         if(SiS_Pr->ChipType < SIS_315H) {
2792 
2793            if(SiS_Pr->SiS_VBInfo & DisableCRT2Display)  tempah = 0;
2794 
2795            tempah = (tempah << 5) & 0xFF;
2796            SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,tempah);
2797            tempah = (tempah >> 5) & 0xFF;
2798 
2799         } else {
2800 
2801            if(SiS_Pr->SiS_VBInfo & DisableCRT2Display)  tempah = 0x08;
2802            else if(!(SiS_IsDualEdge(SiS_Pr)))           tempah |= 0x08;
2803            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2E,0xF0,tempah);
2804            tempah &= ~0x08;
2805 
2806         }
2807 
2808         if((SiS_Pr->SiS_ModeType == ModeVGA) && (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode))) {
2809            tempah |= 0x10;
2810         }
2811 
2812         tempah |= 0x80;
2813         if(SiS_Pr->SiS_VBType & VB_SIS301) {
2814            if(SiS_Pr->PanelXRes < 1280 && SiS_Pr->PanelYRes < 960) tempah &= ~0x80;
2815         }
2816 
2817         if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
2818            if(!(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p | TVSetYPbPr525p))) {
2819               if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
2820                  tempah |= 0x20;
2821               }
2822            }
2823         }
2824 
2825         SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0D,0x40,tempah);
2826 
2827         tempah = 0x80;
2828         if(SiS_Pr->SiS_VBType & VB_SIS301) {
2829            if(SiS_Pr->PanelXRes < 1280 && SiS_Pr->PanelYRes < 960) tempah = 0;
2830         }
2831 
2832         if(SiS_IsDualLink(SiS_Pr)) tempah |= 0x40;
2833 
2834         if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
2835            if(SiS_Pr->SiS_TVMode & TVRPLLDIV2XO) {
2836               tempah |= 0x40;
2837            }
2838         }
2839 
2840         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0C,tempah);
2841 
2842      } else {  /* LVDS */
2843 
2844         if(SiS_Pr->ChipType >= SIS_315H) {
2845 
2846 #ifdef CONFIG_FB_SIS_315
2847            /* LVDS can only be slave in 8bpp modes */
2848            tempah = 0x80;
2849            if((modeflag & CRT2Mode) && (SiS_Pr->SiS_ModeType > ModeVGA)) {
2850               if(SiS_Pr->SiS_VBInfo & DriverMode) {
2851                  tempah |= 0x02;
2852               }
2853            }
2854 
2855            if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode))  tempah |= 0x02;
2856 
2857            if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)        tempah ^= 0x01;
2858 
2859            if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 1;
2860 
2861            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2e,0xF0,tempah);
2862 #endif
2863 
2864         } else {
2865 
2866 #ifdef CONFIG_FB_SIS_300
2867            tempah = 0;
2868            if( (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) && (SiS_Pr->SiS_ModeType > ModeVGA) ) {
2869               tempah |= 0x02;
2870            }
2871            tempah <<= 5;
2872 
2873            if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0;
2874 
2875            SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,tempah);
2876 #endif
2877 
2878         }
2879 
2880      }
2881 
2882   }  /* LCDA */
2883 
2884   if(SiS_Pr->SiS_VBType & VB_SISVB) {
2885 
2886      if(SiS_Pr->ChipType >= SIS_315H) {
2887 
2888 #ifdef CONFIG_FB_SIS_315
2889         /* unsigned char bridgerev = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x01); */
2890 
2891         /* The following is nearly unpreditable and varies from machine
2892          * to machine. Especially the 301DH seems to be a real trouble
2893          * maker. Some BIOSes simply set the registers (like in the
2894          * NoLCD-if-statements here), some set them according to the
2895          * LCDA stuff. It is very likely that some machines are not
2896          * treated correctly in the following, very case-orientated
2897          * code. What do I do then...?
2898          */
2899 
2900         /* 740 variants match for 30xB, 301B-DH, 30xLV */
2901 
2902         if(!(IS_SIS740)) {
2903            tempah = 0x04;                                                  /* For all bridges */
2904            tempbl = 0xfb;
2905            if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
2906               tempah = 0x00;
2907               if(SiS_IsDualEdge(SiS_Pr)) {
2908                  tempbl = 0xff;
2909               }
2910            }
2911            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,tempbl,tempah);
2912         }
2913 
2914         /* The following two are responsible for eventually wrong colors
2915          * in TV output. The DH (VB_NoLCD) conditions are unknown; the
2916          * b0 was found in some 651 machine (Pim; P4_23=0xe5); the b1 version
2917          * in a 650 box (Jake). What is the criteria?
2918          * Addendum: Another combination 651+301B-DH(b1) (Rapo) needs same
2919          * treatment like the 651+301B-DH(b0) case. Seems more to be the
2920          * chipset than the bridge revision.
2921          */
2922 
2923         if((IS_SIS740) || (SiS_Pr->ChipType >= SIS_661) || (SiS_Pr->SiS_ROMNew)) {
2924            tempah = 0x30;
2925            tempbl = 0xc0;
2926            if((SiS_Pr->SiS_VBInfo & DisableCRT2Display) ||
2927               ((SiS_Pr->SiS_ROMNew) && (!(ROMAddr[0x5b] & 0x04)))) {
2928               tempah = 0x00;
2929               tempbl = 0x00;
2930            }
2931            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2c,0xcf,tempah);
2932            SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,0x3f,tempbl);
2933         } else if(SiS_Pr->SiS_VBType & VB_SIS301) {
2934            /* Fixes "TV-blue-bug" on 315+301 */
2935            SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2c,0xcf);      /* For 301   */
2936            SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x21,0x3f);
2937         } else if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
2938            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2c,0x30);       /* For 30xLV */
2939            SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x21,0xc0);
2940         } else if(SiS_Pr->SiS_VBType & VB_NoLCD) {              /* For 301B-DH */
2941            tempah = 0x30; tempah2 = 0xc0;
2942            tempbl = 0xcf; tempbl2 = 0x3f;
2943            if(SiS_Pr->SiS_TVBlue == 0) {
2944                  tempah = tempah2 = 0x00;
2945            } else if(SiS_Pr->SiS_TVBlue == -1) {
2946               /* Set on 651/M650, clear on 315/650 */
2947               if(!(IS_SIS65x)) /* (bridgerev != 0xb0) */ {
2948                  tempah = tempah2 = 0x00;
2949               }
2950            }
2951            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2c,tempbl,tempah);
2952            SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,tempbl2,tempah2);
2953         } else {
2954            tempah = 0x30; tempah2 = 0xc0;                      /* For 30xB, 301C */
2955            tempbl = 0xcf; tempbl2 = 0x3f;
2956            if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
2957               tempah = tempah2 = 0x00;
2958               if(SiS_IsDualEdge(SiS_Pr)) {
2959                  tempbl = tempbl2 = 0xff;
2960               }
2961            }
2962            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2c,tempbl,tempah);
2963            SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,tempbl2,tempah2);
2964         }
2965 
2966         if(IS_SIS740) {
2967            tempah = 0x80;
2968            if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0x00;
2969            SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x23,0x7f,tempah);
2970         } else {
2971            tempah = 0x00;
2972            tempbl = 0x7f;
2973            if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
2974               tempbl = 0xff;
2975               if(!(SiS_IsDualEdge(SiS_Pr))) tempah = 0x80;
2976            }
2977            SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x23,tempbl,tempah);
2978         }
2979 
2980 #endif /* CONFIG_FB_SIS_315 */
2981 
2982      } else if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
2983 
2984 #ifdef CONFIG_FB_SIS_300
2985         SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x21,0x3f);
2986 
2987         if((SiS_Pr->SiS_VBInfo & DisableCRT2Display) ||
2988            ((SiS_Pr->SiS_VBType & VB_NoLCD) &&
2989             (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD))) {
2990            SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x23,0x7F);
2991         } else {
2992            SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x23,0x80);
2993         }
2994 #endif
2995 
2996      }
2997 
2998      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
2999         SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x0D,0x80);
3000         if(SiS_Pr->SiS_VBType & VB_SIS30xCLV) {
3001            SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x3A,0xC0);
3002         }
3003      }
3004 
3005   } else {  /* LVDS */
3006 
3007 #ifdef CONFIG_FB_SIS_315
3008      if(SiS_Pr->ChipType >= SIS_315H) {
3009 
3010         if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
3011 
3012            tempah = 0x04;
3013            tempbl = 0xfb;
3014            if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
3015               tempah = 0x00;
3016               if(SiS_IsDualEdge(SiS_Pr)) tempbl = 0xff;
3017            }
3018            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,tempbl,tempah);
3019 
3020            if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) {
3021               SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb);
3022            }
3023 
3024            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2c,0x30);
3025 
3026         } else if(SiS_Pr->ChipType == SIS_550) {
3027 
3028            SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb);
3029            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2c,0x30);
3030 
3031         }
3032 
3033      }
3034 #endif
3035 
3036   }
3037 
3038 }
3039 
3040 /*********************************************/
3041 /*            GET RESOLUTION DATA            */
3042 /*********************************************/
3043 
3044 unsigned short
3045 SiS_GetResInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
3046 {
3047    if(ModeNo <= 0x13)
3048       return ((unsigned short)SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo);
3049    else
3050       return ((unsigned short)SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO);
3051 }
3052 
3053 static void
3054 SiS_GetCRT2ResInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
3055 {
3056    unsigned short xres, yres, modeflag=0, resindex;
3057 
3058    if(SiS_Pr->UseCustomMode) {
3059       xres = SiS_Pr->CHDisplay;
3060       if(SiS_Pr->CModeFlag & HalfDCLK) xres <<= 1;
3061       SiS_Pr->SiS_VGAHDE = SiS_Pr->SiS_HDE = xres;
3062       /* DoubleScanMode-check done in CheckCalcCustomMode()! */
3063       SiS_Pr->SiS_VGAVDE = SiS_Pr->SiS_VDE = SiS_Pr->CVDisplay;
3064       return;
3065    }
3066 
3067    resindex = SiS_GetResInfo(SiS_Pr,ModeNo,ModeIdIndex);
3068 
3069    if(ModeNo <= 0x13) {
3070       xres = SiS_Pr->SiS_StResInfo[resindex].HTotal;
3071       yres = SiS_Pr->SiS_StResInfo[resindex].VTotal;
3072    } else {
3073       xres = SiS_Pr->SiS_ModeResInfo[resindex].HTotal;
3074       yres = SiS_Pr->SiS_ModeResInfo[resindex].VTotal;
3075       modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3076    }
3077 
3078    if(!SiS_Pr->SiS_IF_DEF_DSTN && !SiS_Pr->SiS_IF_DEF_FSTN) {
3079 
3080       if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_IF_DEF_LVDS == 1)) {
3081          if((ModeNo != 0x03) && (SiS_Pr->SiS_SetFlag & SetDOSMode)) {
3082             if(yres == 350) yres = 400;
3083          }
3084          if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x3a) & 0x01) {
3085             if(ModeNo == 0x12) yres = 400;
3086          }
3087       }
3088 
3089       if(modeflag & HalfDCLK)       xres <<= 1;
3090       if(modeflag & DoubleScanMode) yres <<= 1;
3091 
3092    }
3093 
3094    if((SiS_Pr->SiS_VBType & VB_SISVB) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) {
3095 
3096       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
3097          switch(SiS_Pr->SiS_LCDResInfo) {
3098            case Panel_1024x768:
3099               if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) {
3100                  if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) {
3101                     if(yres == 350) yres = 357;
3102                     if(yres == 400) yres = 420;
3103                     if(yres == 480) yres = 525;
3104                  }
3105               }
3106               break;
3107            case Panel_1280x1024:
3108               if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) {
3109                  /* BIOS bug - does this regardless of scaling */
3110                  if(yres == 400) yres = 405;
3111               }
3112               if(yres == 350) yres = 360;
3113               if(SiS_Pr->SiS_SetFlag & LCDVESATiming) {
3114                  if(yres == 360) yres = 375;
3115               }
3116               break;
3117            case Panel_1600x1200:
3118               if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) {
3119                  if(yres == 1024) yres = 1056;
3120               }
3121               break;
3122          }
3123       }
3124 
3125    } else {
3126 
3127       if(SiS_Pr->SiS_VBType & VB_SISVB) {
3128          if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToHiVision)) {
3129             if(xres == 720) xres = 640;
3130          }
3131       } else if(xres == 720) xres = 640;
3132 
3133       if(SiS_Pr->SiS_SetFlag & SetDOSMode) {
3134          yres = 400;
3135          if(SiS_Pr->ChipType >= SIS_315H) {
3136             if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x17) & 0x80) yres = 480;
3137          } else {
3138             if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x80) yres = 480;
3139          }
3140          if(SiS_Pr->SiS_IF_DEF_DSTN || SiS_Pr->SiS_IF_DEF_FSTN) yres = 480;
3141       }
3142 
3143    }
3144    SiS_Pr->SiS_VGAHDE = SiS_Pr->SiS_HDE = xres;
3145    SiS_Pr->SiS_VGAVDE = SiS_Pr->SiS_VDE = yres;
3146 }
3147 
3148 /*********************************************/
3149 /*           GET CRT2 TIMING DATA            */
3150 /*********************************************/
3151 
3152 static void
3153 SiS_GetCRT2Ptr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
3154                unsigned short RefreshRateTableIndex, unsigned short *CRT2Index,
3155                unsigned short *ResIndex)
3156 {
3157   unsigned short tempbx=0, tempal=0, resinfo=0;
3158 
3159   if(ModeNo <= 0x13) {
3160      tempal = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
3161   } else {
3162      tempal = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
3163      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
3164   }
3165 
3166   if((SiS_Pr->SiS_VBType & VB_SISVB) && (SiS_Pr->SiS_IF_DEF_LVDS == 0)) {
3167 
3168      if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {                            /* LCD */
3169 
3170         tempbx = SiS_Pr->SiS_LCDResInfo;
3171         if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx += 32;
3172 
3173         /* patch index */
3174         if(SiS_Pr->SiS_LCDResInfo == Panel_1680x1050) {
3175            if     (resinfo == SIS_RI_1280x800)  tempal =  9;
3176            else if(resinfo == SIS_RI_1400x1050) tempal = 11;
3177         } else if((SiS_Pr->SiS_LCDResInfo == Panel_1280x800) ||
3178                   (SiS_Pr->SiS_LCDResInfo == Panel_1280x800_2) ||
3179                   (SiS_Pr->SiS_LCDResInfo == Panel_1280x854)) {
3180            if     (resinfo == SIS_RI_1280x768)  tempal =  9;
3181         }
3182 
3183         if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3184            /* Pass 1:1 only (center-screen handled outside) */
3185            /* This is never called for the panel's native resolution */
3186            /* since Pass1:1 will not be set in this case */
3187            tempbx = 100;
3188            if(ModeNo >= 0x13) {
3189               tempal = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC_NS;
3190            }
3191         }
3192 
3193 #ifdef CONFIG_FB_SIS_315
3194         if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) {
3195            if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) {
3196               if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) {
3197                  tempbx = 200;
3198                  if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx++;
3199               }
3200            }
3201         }
3202 #endif
3203 
3204      } else {                                                   /* TV */
3205 
3206         if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
3207            /* if(SiS_Pr->SiS_VGAVDE > 480) SiS_Pr->SiS_TVMode &= (~TVSetTVSimuMode); */
3208            tempbx = 2;
3209            if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
3210               tempbx = 13;
3211               if(!(SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) tempbx = 14;
3212            }
3213         } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
3214            if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p)      tempbx = 7;
3215            else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) tempbx = 6;
3216            else                                         tempbx = 5;
3217            if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode)     tempbx += 5;
3218         } else {
3219            if(SiS_Pr->SiS_TVMode & TVSetPAL)            tempbx = 3;
3220            else                                         tempbx = 4;
3221            if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode)     tempbx += 5;
3222         }
3223 
3224      }
3225 
3226      tempal &= 0x3F;
3227 
3228      if(ModeNo > 0x13) {
3229         if(SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoHiVision) {
3230            switch(resinfo) {
3231            case SIS_RI_720x480:
3232               tempal = 6;
3233               if(SiS_Pr->SiS_TVMode & (TVSetPAL | TVSetPALN))   tempal = 9;
3234               break;
3235            case SIS_RI_720x576:
3236            case SIS_RI_768x576:
3237            case SIS_RI_1024x576: /* Not in NTSC or YPBPR mode (except 1080i)! */
3238               tempal = 6;
3239               if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
3240                  if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p)        tempal = 8;
3241               }
3242               break;
3243            case SIS_RI_800x480:
3244               tempal = 4;
3245               break;
3246            case SIS_RI_512x384:
3247            case SIS_RI_1024x768:
3248               tempal = 7;
3249               if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
3250                  if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p)        tempal = 8;
3251               }
3252               break;
3253            case SIS_RI_1280x720:
3254               if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
3255                  if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p)        tempal = 9;
3256               }
3257               break;
3258            }
3259         }
3260      }
3261 
3262      *CRT2Index = tempbx;
3263      *ResIndex = tempal;
3264 
3265   } else {   /* LVDS, 301B-DH (if running on LCD) */
3266 
3267      tempbx = 0;
3268      if((SiS_Pr->SiS_IF_DEF_CH70xx) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) {
3269 
3270         tempbx = 90;
3271         if(SiS_Pr->SiS_TVMode & TVSetPAL) {
3272            tempbx = 92;
3273            if(SiS_Pr->SiS_ModeType > ModeVGA) {
3274               if(SiS_Pr->SiS_CHSOverScan) tempbx = 99;
3275            }
3276            if(SiS_Pr->SiS_TVMode & TVSetPALM)      tempbx = 94;
3277            else if(SiS_Pr->SiS_TVMode & TVSetPALN) tempbx = 96;
3278         }
3279         if(tempbx != 99) {
3280            if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx++;
3281         }
3282 
3283      } else {
3284 
3285         switch(SiS_Pr->SiS_LCDResInfo) {
3286         case Panel_640x480:   tempbx = 12; break;
3287         case Panel_320x240_1: tempbx = 10; break;
3288         case Panel_320x240_2:
3289         case Panel_320x240_3: tempbx = 14; break;
3290         case Panel_800x600:   tempbx = 16; break;
3291         case Panel_1024x600:  tempbx = 18; break;
3292         case Panel_1152x768:
3293         case Panel_1024x768:  tempbx = 20; break;
3294         case Panel_1280x768:  tempbx = 22; break;
3295         case Panel_1280x1024: tempbx = 24; break;
3296         case Panel_1400x1050: tempbx = 26; break;
3297         case Panel_1600x1200: tempbx = 28; break;
3298 #ifdef CONFIG_FB_SIS_300
3299         case Panel_Barco1366: tempbx = 80; break;
3300 #endif
3301         }
3302 
3303         switch(SiS_Pr->SiS_LCDResInfo) {
3304         case Panel_320x240_1:
3305         case Panel_320x240_2:
3306         case Panel_320x240_3:
3307         case Panel_640x480:
3308            break;
3309         default:
3310            if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++;
3311         }
3312 
3313         if(SiS_Pr->SiS_LCDInfo & LCDPass11) tempbx = 30;
3314 
3315 #ifdef CONFIG_FB_SIS_300
3316         if(SiS_Pr->SiS_CustomT == CUT_BARCO1024) {
3317            tempbx = 82;
3318            if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++;
3319         } else if(SiS_Pr->SiS_CustomT == CUT_PANEL848 || SiS_Pr->SiS_CustomT == CUT_PANEL856) {
3320            tempbx = 84;
3321            if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++;
3322         }
3323 #endif
3324 
3325      }
3326 
3327      (*CRT2Index) = tempbx;
3328      (*ResIndex) = tempal & 0x1F;
3329   }
3330 }
3331 
3332 static void
3333 SiS_GetRAMDAC2DATA(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
3334                 unsigned short RefreshRateTableIndex)
3335 {
3336   unsigned short tempax=0, tempbx=0, index, dotclock;
3337   unsigned short temp1=0, modeflag=0, tempcx=0;
3338 
3339   SiS_Pr->SiS_RVBHCMAX  = 1;
3340   SiS_Pr->SiS_RVBHCFACT = 1;
3341 
3342   if(ModeNo <= 0x13) {
3343 
3344      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
3345      index = SiS_GetModePtr(SiS_Pr,ModeNo,ModeIdIndex);
3346 
3347      tempax = SiS_Pr->SiS_StandTable[index].CRTC[0];
3348      tempbx = SiS_Pr->SiS_StandTable[index].CRTC[6];
3349      temp1 = SiS_Pr->SiS_StandTable[index].CRTC[7];
3350 
3351      dotclock = (modeflag & Charx8Dot) ? 8 : 9;
3352 
3353   } else {
3354 
3355      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3356      index = SiS_GetRefCRT1CRTC(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWideCRT2);
3357 
3358      tempax = SiS_Pr->SiS_CRT1Table[index].CR[0];
3359      tempax |= (SiS_Pr->SiS_CRT1Table[index].CR[14] << 8);
3360      tempax &= 0x03FF;
3361      tempbx = SiS_Pr->SiS_CRT1Table[index].CR[6];
3362      tempcx = SiS_Pr->SiS_CRT1Table[index].CR[13] << 8;
3363      tempcx &= 0x0100;
3364      tempcx <<= 2;
3365      tempbx |= tempcx;
3366      temp1  = SiS_Pr->SiS_CRT1Table[index].CR[7];
3367 
3368      dotclock = 8;
3369 
3370   }
3371 
3372   if(temp1 & 0x01) tempbx |= 0x0100;
3373   if(temp1 & 0x20) tempbx |= 0x0200;
3374 
3375   tempax += 5;
3376   tempax *= dotclock;
3377   if(modeflag & HalfDCLK) tempax <<= 1;
3378 
3379   tempbx++;
3380 
3381   SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = tempax;
3382   SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = tempbx;
3383 }
3384 
3385 static void
3386 SiS_CalcPanelLinkTiming(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
3387                 unsigned short ModeIdIndex, unsigned short RefreshRateTableIndex)
3388 {
3389    unsigned short ResIndex;
3390 
3391    if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3392       if(SiS_Pr->SiS_LCDInfo & LCDPass11) {
3393          if(SiS_Pr->UseCustomMode) {
3394             ResIndex = SiS_Pr->CHTotal;
3395             if(SiS_Pr->CModeFlag & HalfDCLK) ResIndex <<= 1;
3396             SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = ResIndex;
3397             SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->CVTotal;
3398          } else {
3399             if(ModeNo < 0x13) {
3400                ResIndex = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
3401             } else {
3402                ResIndex = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC_NS;
3403             }
3404             if(ResIndex == 0x09) {
3405                if(SiS_Pr->Alternate1600x1200)        ResIndex = 0x20; /* 1600x1200 LCDA */
3406                else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) ResIndex = 0x21; /* 1600x1200 LVDS */
3407             }
3408             SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_NoScaleData[ResIndex].VGAHT;
3409             SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_NoScaleData[ResIndex].VGAVT;
3410             SiS_Pr->SiS_HT    = SiS_Pr->SiS_NoScaleData[ResIndex].LCDHT;
3411             SiS_Pr->SiS_VT    = SiS_Pr->SiS_NoScaleData[ResIndex].LCDVT;
3412          }
3413       } else {
3414          SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = SiS_Pr->PanelHT;
3415          SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->PanelVT;
3416       }
3417    } else {
3418       /* This handles custom modes and custom panels */
3419       SiS_Pr->SiS_HDE = SiS_Pr->PanelXRes;
3420       SiS_Pr->SiS_VDE = SiS_Pr->PanelYRes;
3421       SiS_Pr->SiS_HT  = SiS_Pr->PanelHT;
3422       SiS_Pr->SiS_VT  = SiS_Pr->PanelVT;
3423       SiS_Pr->SiS_VGAHT = SiS_Pr->PanelHT - (SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE);
3424       SiS_Pr->SiS_VGAVT = SiS_Pr->PanelVT - (SiS_Pr->PanelYRes - SiS_Pr->SiS_VGAVDE);
3425    }
3426 }
3427 
3428 static void
3429 SiS_GetCRT2DataLVDS(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
3430                     unsigned short RefreshRateTableIndex)
3431 {
3432    unsigned short CRT2Index, ResIndex, backup;
3433    const struct SiS_LVDSData *LVDSData = NULL;
3434 
3435    SiS_GetCRT2ResInfo(SiS_Pr, ModeNo, ModeIdIndex);
3436 
3437    if(SiS_Pr->SiS_VBType & VB_SISVB) {
3438       SiS_Pr->SiS_RVBHCMAX  = 1;
3439       SiS_Pr->SiS_RVBHCFACT = 1;
3440       SiS_Pr->SiS_NewFlickerMode = 0;
3441       SiS_Pr->SiS_RVBHRS = 50;
3442       SiS_Pr->SiS_RY1COE = 0;
3443       SiS_Pr->SiS_RY2COE = 0;
3444       SiS_Pr->SiS_RY3COE = 0;
3445       SiS_Pr->SiS_RY4COE = 0;
3446       SiS_Pr->SiS_RVBHRS2 = 0;
3447    }
3448 
3449    if((SiS_Pr->SiS_VBType & VB_SISVB) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
3450 
3451 #ifdef CONFIG_FB_SIS_315
3452       SiS_CalcPanelLinkTiming(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3453       SiS_CalcLCDACRT1Timing(SiS_Pr, ModeNo, ModeIdIndex);
3454 #endif
3455 
3456    } else {
3457 
3458       /* 301BDH needs LVDS Data */
3459       backup = SiS_Pr->SiS_IF_DEF_LVDS;
3460       if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) {
3461          SiS_Pr->SiS_IF_DEF_LVDS = 1;
3462       }
3463 
3464       SiS_GetCRT2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex,
3465                                             &CRT2Index, &ResIndex);
3466 
3467       SiS_Pr->SiS_IF_DEF_LVDS = backup;
3468 
3469       switch(CRT2Index) {
3470          case 10: LVDSData = SiS_Pr->SiS_LVDS320x240Data_1;    break;
3471          case 14: LVDSData = SiS_Pr->SiS_LVDS320x240Data_2;    break;
3472          case 12: LVDSData = SiS_Pr->SiS_LVDS640x480Data_1;    break;
3473          case 16: LVDSData = SiS_Pr->SiS_LVDS800x600Data_1;    break;
3474          case 18: LVDSData = SiS_Pr->SiS_LVDS1024x600Data_1;   break;
3475          case 20: LVDSData = SiS_Pr->SiS_LVDS1024x768Data_1;   break;
3476 #ifdef CONFIG_FB_SIS_300
3477          case 80: LVDSData = SiS_Pr->SiS_LVDSBARCO1366Data_1;  break;
3478          case 81: LVDSData = SiS_Pr->SiS_LVDSBARCO1366Data_2;  break;
3479          case 82: LVDSData = SiS_Pr->SiS_LVDSBARCO1024Data_1;  break;
3480          case 84: LVDSData = SiS_Pr->SiS_LVDS848x480Data_1;    break;
3481          case 85: LVDSData = SiS_Pr->SiS_LVDS848x480Data_2;    break;
3482 #endif
3483          case 90: LVDSData = SiS_Pr->SiS_CHTVUNTSCData;        break;
3484          case 91: LVDSData = SiS_Pr->SiS_CHTVONTSCData;        break;
3485          case 92: LVDSData = SiS_Pr->SiS_CHTVUPALData;         break;
3486          case 93: LVDSData = SiS_Pr->SiS_CHTVOPALData;         break;
3487          case 94: LVDSData = SiS_Pr->SiS_CHTVUPALMData;        break;
3488          case 95: LVDSData = SiS_Pr->SiS_CHTVOPALMData;        break;
3489          case 96: LVDSData = SiS_Pr->SiS_CHTVUPALNData;        break;
3490          case 97: LVDSData = SiS_Pr->SiS_CHTVOPALNData;        break;
3491          case 99: LVDSData = SiS_Pr->SiS_CHTVSOPALData;        break;
3492       }
3493 
3494       if(LVDSData) {
3495          SiS_Pr->SiS_VGAHT = (LVDSData+ResIndex)->VGAHT;
3496          SiS_Pr->SiS_VGAVT = (LVDSData+ResIndex)->VGAVT;
3497          SiS_Pr->SiS_HT    = (LVDSData+ResIndex)->LCDHT;
3498          SiS_Pr->SiS_VT    = (LVDSData+ResIndex)->LCDVT;
3499       } else {
3500          SiS_CalcPanelLinkTiming(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3501       }
3502 
3503       if( (!(SiS_Pr->SiS_VBType & VB_SISVB)) &&
3504           (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) &&
3505           (!(SiS_Pr->SiS_LCDInfo & LCDPass11)) ) {
3506          if( (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) ||
3507              (SiS_Pr->SiS_SetFlag & SetDOSMode) ) {
3508             SiS_Pr->SiS_HDE = SiS_Pr->PanelXRes;
3509             SiS_Pr->SiS_VDE = SiS_Pr->PanelYRes;
3510 #ifdef CONFIG_FB_SIS_300
3511             if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) {
3512                if(ResIndex < 0x08) {
3513                   SiS_Pr->SiS_HDE = 1280;
3514                   SiS_Pr->SiS_VDE = 1024;
3515                }
3516             }
3517 #endif
3518          }
3519       }
3520    }
3521 }
3522 
3523 static void
3524 SiS_GetCRT2Data301(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
3525                 unsigned short RefreshRateTableIndex)
3526 {
3527   unsigned char  *ROMAddr = NULL;
3528   unsigned short tempax, tempbx, modeflag, romptr=0;
3529   unsigned short resinfo, CRT2Index, ResIndex;
3530   const struct SiS_LCDData *LCDPtr = NULL;
3531   const struct SiS_TVData  *TVPtr  = NULL;
3532 #ifdef CONFIG_FB_SIS_315
3533   short resinfo661;
3534 #endif
3535 
3536   if(ModeNo <= 0x13) {
3537      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
3538      resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo;
3539   } else if(SiS_Pr->UseCustomMode) {
3540      modeflag = SiS_Pr->CModeFlag;
3541      resinfo = 0;
3542   } else {
3543      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
3544      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
3545 #ifdef CONFIG_FB_SIS_315
3546      resinfo661 = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].ROMMODEIDX661;
3547      if( (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)   &&
3548          (SiS_Pr->SiS_SetFlag & LCDVESATiming) &&
3549          (resinfo661 >= 0)                     &&
3550          (SiS_Pr->SiS_NeedRomModeData) ) {
3551         if((ROMAddr = GetLCDStructPtr661(SiS_Pr))) {
3552            if((romptr = (SISGETROMW(21)))) {
3553               romptr += (resinfo661 * 10);
3554               ROMAddr = SiS_Pr->VirtualRomBase;
3555            }
3556         }
3557      }
3558 #endif
3559   }
3560 
3561   SiS_Pr->SiS_NewFlickerMode = 0;
3562   SiS_Pr->SiS_RVBHRS = 50;
3563   SiS_Pr->SiS_RY1COE = 0;
3564   SiS_Pr->SiS_RY2COE = 0;
3565   SiS_Pr->SiS_RY3COE = 0;
3566   SiS_Pr->SiS_RY4COE = 0;
3567   SiS_Pr->SiS_RVBHRS2 = 0;
3568 
3569   SiS_GetCRT2ResInfo(SiS_Pr,ModeNo,ModeIdIndex);
3570 
3571   if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) {
3572 
3573      if(SiS_Pr->UseCustomMode) {
3574 
3575         SiS_Pr->SiS_RVBHCMAX  = 1;
3576         SiS_Pr->SiS_RVBHCFACT = 1;
3577         SiS_Pr->SiS_HDE       = SiS_Pr->SiS_VGAHDE;
3578         SiS_Pr->SiS_VDE       = SiS_Pr->SiS_VGAVDE;
3579 
3580         tempax = SiS_Pr->CHTotal;
3581         if(modeflag & HalfDCLK) tempax <<= 1;
3582         SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = tempax;
3583         SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->CVTotal;
3584 
3585      } else {
3586 
3587         SiS_GetRAMDAC2DATA(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3588 
3589      }
3590 
3591   } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
3592 
3593      SiS_GetCRT2Ptr(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex,
3594                     &CRT2Index,&ResIndex);
3595 
3596      switch(CRT2Index) {
3597         case  2: TVPtr = SiS_Pr->SiS_ExtHiTVData;   break;
3598         case  3: TVPtr = SiS_Pr->SiS_ExtPALData;    break;
3599         case  4: TVPtr = SiS_Pr->SiS_ExtNTSCData;   break;
3600         case  5: TVPtr = SiS_Pr->SiS_Ext525iData;   break;
3601         case  6: TVPtr = SiS_Pr->SiS_Ext525pData;   break;
3602         case  7: TVPtr = SiS_Pr->SiS_Ext750pData;   break;
3603         case  8: TVPtr = SiS_Pr->SiS_StPALData;     break;
3604         case  9: TVPtr = SiS_Pr->SiS_StNTSCData;    break;
3605         case 10: TVPtr = SiS_Pr->SiS_St525iData;    break;
3606         case 11: TVPtr = SiS_Pr->SiS_St525pData;    break;
3607         case 12: TVPtr = SiS_Pr->SiS_St750pData;    break;
3608         case 13: TVPtr = SiS_Pr->SiS_St1HiTVData;   break;
3609         case 14: TVPtr = SiS_Pr->SiS_St2HiTVData;   break;
3610         default: TVPtr = SiS_Pr->SiS_StPALData;     break;
3611      }
3612 
3613      SiS_Pr->SiS_RVBHCMAX  = (TVPtr+ResIndex)->RVBHCMAX;
3614      SiS_Pr->SiS_RVBHCFACT = (TVPtr+ResIndex)->RVBHCFACT;
3615      SiS_Pr->SiS_VGAHT     = (TVPtr+ResIndex)->VGAHT;
3616      SiS_Pr->SiS_VGAVT     = (TVPtr+ResIndex)->VGAVT;
3617      SiS_Pr->SiS_HDE       = (TVPtr+ResIndex)->TVHDE;
3618      SiS_Pr->SiS_VDE       = (TVPtr+ResIndex)->TVVDE;
3619      SiS_Pr->SiS_RVBHRS2   = (TVPtr+ResIndex)->RVBHRS2 & 0x0fff;
3620      if(modeflag & HalfDCLK) {
3621         SiS_Pr->SiS_RVBHRS = (TVPtr+ResIndex)->HALFRVBHRS;
3622         if(SiS_Pr->SiS_RVBHRS2) {
3623            SiS_Pr->SiS_RVBHRS2 = ((SiS_Pr->SiS_RVBHRS2 + 3) >> 1) - 3;
3624            tempax = ((TVPtr+ResIndex)->RVBHRS2 >> 12) & 0x07;
3625            if((TVPtr+ResIndex)->RVBHRS2 & 0x8000) SiS_Pr->SiS_RVBHRS2 -= tempax;
3626            else                                   SiS_Pr->SiS_RVBHRS2 += tempax;
3627         }
3628      } else {
3629         SiS_Pr->SiS_RVBHRS    = (TVPtr+ResIndex)->RVBHRS;
3630      }
3631      SiS_Pr->SiS_NewFlickerMode = ((TVPtr+ResIndex)->FlickerMode) << 7;
3632 
3633      if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
3634 
3635         if((resinfo == SIS_RI_960x600)   ||
3636            (resinfo == SIS_RI_1024x768)  ||
3637            (resinfo == SIS_RI_1280x1024) ||
3638            (resinfo == SIS_RI_1280x720)) {
3639            SiS_Pr->SiS_NewFlickerMode = 0x40;
3640         }
3641 
3642         if(SiS_Pr->SiS_VGAVDE == 350) SiS_Pr->SiS_TVMode |= TVSetTVSimuMode;
3643 
3644         SiS_Pr->SiS_HT = ExtHiTVHT;
3645         SiS_Pr->SiS_VT = ExtHiTVVT;
3646         if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
3647            if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) {
3648               SiS_Pr->SiS_HT = StHiTVHT;
3649               SiS_Pr->SiS_VT = StHiTVVT;
3650            }
3651         }
3652 
3653      } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
3654 
3655         if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) {
3656            SiS_Pr->SiS_HT = 1650;
3657            SiS_Pr->SiS_VT = 750;
3658         } else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) {
3659            SiS_Pr->SiS_HT = NTSCHT;
3660            if(SiS_Pr->SiS_TVMode & TVSet525p1024) SiS_Pr->SiS_HT = NTSC2HT;
3661            SiS_Pr->SiS_VT = NTSCVT;
3662         } else {
3663            SiS_Pr->SiS_HT = NTSCHT;
3664            if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) SiS_Pr->SiS_HT = NTSC2HT;
3665            SiS_Pr->SiS_VT = NTSCVT;
3666         }
3667 
3668      } else {
3669 
3670         SiS_Pr->SiS_RY1COE = (TVPtr+ResIndex)->RY1COE;
3671         SiS_Pr->SiS_RY2COE = (TVPtr+ResIndex)->RY2COE;
3672         SiS_Pr->SiS_RY3COE = (TVPtr+ResIndex)->RY3COE;
3673         SiS_Pr->SiS_RY4COE = (TVPtr+ResIndex)->RY4COE;
3674 
3675         if(modeflag & HalfDCLK) {
3676            SiS_Pr->SiS_RY1COE = 0x00;
3677            SiS_Pr->SiS_RY2COE = 0xf4;
3678            SiS_Pr->SiS_RY3COE = 0x10;
3679            SiS_Pr->SiS_RY4COE = 0x38;
3680         }
3681 
3682         if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) {
3683            SiS_Pr->SiS_HT = NTSCHT;
3684            if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) SiS_Pr->SiS_HT = NTSC2HT;
3685            SiS_Pr->SiS_VT = NTSCVT;
3686         } else {
3687            SiS_Pr->SiS_HT = PALHT;
3688            SiS_Pr->SiS_VT = PALVT;
3689         }
3690 
3691      }
3692 
3693   } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
3694 
3695      SiS_Pr->SiS_RVBHCMAX  = 1;
3696      SiS_Pr->SiS_RVBHCFACT = 1;
3697 
3698      if(SiS_Pr->UseCustomMode) {
3699 
3700         SiS_Pr->SiS_HDE   = SiS_Pr->SiS_VGAHDE;
3701         SiS_Pr->SiS_VDE   = SiS_Pr->SiS_VGAVDE;
3702 
3703         tempax = SiS_Pr->CHTotal;
3704         if(modeflag & HalfDCLK) tempax <<= 1;
3705         SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = tempax;
3706         SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->CVTotal;
3707 
3708      } else {
3709 
3710         bool gotit = false;
3711 
3712         if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) {
3713 
3714            SiS_Pr->SiS_VGAHT = SiS_Pr->PanelHT;
3715            SiS_Pr->SiS_VGAVT = SiS_Pr->PanelVT;
3716            SiS_Pr->SiS_HT    = SiS_Pr->PanelHT;
3717            SiS_Pr->SiS_VT    = SiS_Pr->PanelVT;
3718            gotit = true;
3719 
3720         } else if( (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) && (romptr) && (ROMAddr) ) {
3721 
3722 #ifdef CONFIG_FB_SIS_315
3723            SiS_Pr->SiS_RVBHCMAX  = ROMAddr[romptr];
3724            SiS_Pr->SiS_RVBHCFACT = ROMAddr[romptr+1];
3725            SiS_Pr->SiS_VGAHT     = ROMAddr[romptr+2] | ((ROMAddr[romptr+3] & 0x0f) << 8);
3726            SiS_Pr->SiS_VGAVT     = (ROMAddr[romptr+4] << 4) | ((ROMAddr[romptr+3] & 0xf0) >> 4);
3727            SiS_Pr->SiS_HT        = ROMAddr[romptr+5] | ((ROMAddr[romptr+6] & 0x0f) << 8);
3728            SiS_Pr->SiS_VT        = (ROMAddr[romptr+7] << 4) | ((ROMAddr[romptr+6] & 0xf0) >> 4);
3729            SiS_Pr->SiS_RVBHRS2   = ROMAddr[romptr+8] | ((ROMAddr[romptr+9] & 0x0f) << 8);
3730            if((SiS_Pr->SiS_RVBHRS2) && (modeflag & HalfDCLK)) {
3731               SiS_Pr->SiS_RVBHRS2 = ((SiS_Pr->SiS_RVBHRS2 + 3) >> 1) - 3;
3732               tempax = (ROMAddr[romptr+9] >> 4) & 0x07;
3733               if(ROMAddr[romptr+9] & 0x80) SiS_Pr->SiS_RVBHRS2 -= tempax;
3734               else                         SiS_Pr->SiS_RVBHRS2 += tempax;
3735            }
3736            if(SiS_Pr->SiS_VGAHT) gotit = true;
3737            else {
3738               SiS_Pr->SiS_LCDInfo |= DontExpandLCD;
3739               SiS_Pr->SiS_LCDInfo &= ~LCDPass11;
3740               SiS_Pr->SiS_RVBHCMAX  = 1;
3741               SiS_Pr->SiS_RVBHCFACT = 1;
3742               SiS_Pr->SiS_VGAHT   = SiS_Pr->PanelHT;
3743               SiS_Pr->SiS_VGAVT   = SiS_Pr->PanelVT;
3744               SiS_Pr->SiS_HT      = SiS_Pr->PanelHT;
3745               SiS_Pr->SiS_VT      = SiS_Pr->PanelVT;
3746               SiS_Pr->SiS_RVBHRS2 = 0;
3747               gotit = true;
3748            }
3749 #endif
3750 
3751         }
3752 
3753         if(!gotit) {
3754 
3755            SiS_GetCRT2Ptr(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex,
3756                           &CRT2Index,&ResIndex);
3757 
3758            switch(CRT2Index) {
3759               case Panel_1024x768      : LCDPtr = SiS_Pr->SiS_ExtLCD1024x768Data;   break;
3760               case Panel_1024x768  + 32: LCDPtr = SiS_Pr->SiS_St2LCD1024x768Data;   break;
3761               case Panel_1280x720      :
3762               case Panel_1280x720  + 32: LCDPtr = SiS_Pr->SiS_LCD1280x720Data;      break;
3763               case Panel_1280x768_2    : LCDPtr = SiS_Pr->SiS_ExtLCD1280x768_2Data; break;
3764               case Panel_1280x768_2+ 32: LCDPtr = SiS_Pr->SiS_StLCD1280x768_2Data;  break;
3765               case Panel_1280x800      :
3766               case Panel_1280x800  + 32: LCDPtr = SiS_Pr->SiS_LCD1280x800Data;      break;
3767               case Panel_1280x800_2    :
3768               case Panel_1280x800_2+ 32: LCDPtr = SiS_Pr->SiS_LCD1280x800_2Data;    break;
3769               case Panel_1280x854      :
3770               case Panel_1280x854  + 32: LCDPtr = SiS_Pr->SiS_LCD1280x854Data;      break;
3771               case Panel_1280x960      :
3772               case Panel_1280x960  + 32: LCDPtr = SiS_Pr->SiS_LCD1280x960Data;      break;
3773               case Panel_1280x1024     : LCDPtr = SiS_Pr->SiS_ExtLCD1280x1024Data;  break;
3774               case Panel_1280x1024 + 32: LCDPtr = SiS_Pr->SiS_St2LCD1280x1024Data;  break;
3775               case Panel_1400x1050     : LCDPtr = SiS_Pr->SiS_ExtLCD1400x1050Data;  break;
3776               case Panel_1400x1050 + 32: LCDPtr = SiS_Pr->SiS_StLCD1400x1050Data;   break;
3777               case Panel_1600x1200     : LCDPtr = SiS_Pr->SiS_ExtLCD1600x1200Data;  break;
3778               case Panel_1600x1200 + 32: LCDPtr = SiS_Pr->SiS_StLCD1600x1200Data;   break;
3779               case Panel_1680x1050     :
3780               case Panel_1680x1050 + 32: LCDPtr = SiS_Pr->SiS_LCD1680x1050Data;     break;
3781               case 100                 : LCDPtr = SiS_Pr->SiS_NoScaleData;          break;
3782 #ifdef CONFIG_FB_SIS_315
3783               case 200                 : LCDPtr = SiS310_ExtCompaq1280x1024Data;    break;
3784               case 201                 : LCDPtr = SiS_Pr->SiS_St2LCD1280x1024Data;  break;
3785 #endif
3786               default                  : LCDPtr = SiS_Pr->SiS_ExtLCD1024x768Data;   break;
3787            }
3788 
3789            SiS_Pr->SiS_RVBHCMAX  = (LCDPtr+ResIndex)->RVBHCMAX;
3790            SiS_Pr->SiS_RVBHCFACT = (LCDPtr+ResIndex)->RVBHCFACT;
3791            SiS_Pr->SiS_VGAHT     = (LCDPtr+ResIndex)->VGAHT;
3792            SiS_Pr->SiS_VGAVT     = (LCDPtr+ResIndex)->VGAVT;
3793            SiS_Pr->SiS_HT        = (LCDPtr+ResIndex)->LCDHT;
3794            SiS_Pr->SiS_VT        = (LCDPtr+ResIndex)->LCDVT;
3795 
3796         }
3797 
3798         tempax = SiS_Pr->PanelXRes;
3799         tempbx = SiS_Pr->PanelYRes;
3800 
3801         switch(SiS_Pr->SiS_LCDResInfo) {
3802         case Panel_1024x768:
3803            if(SiS_Pr->SiS_SetFlag & LCDVESATiming) {
3804               if(SiS_Pr->ChipType < SIS_315H) {
3805                  if     (SiS_Pr->SiS_VGAVDE == 350) tempbx = 560;
3806                  else if(SiS_Pr->SiS_VGAVDE == 400) tempbx = 640;
3807               }
3808            } else {
3809               if     (SiS_Pr->SiS_VGAVDE == 357) tempbx = 527;
3810               else if(SiS_Pr->SiS_VGAVDE == 420) tempbx = 620;
3811               else if(SiS_Pr->SiS_VGAVDE == 525) tempbx = 775;
3812               else if(SiS_Pr->SiS_VGAVDE == 600) tempbx = 775;
3813               else if(SiS_Pr->SiS_VGAVDE == 350) tempbx = 560;
3814               else if(SiS_Pr->SiS_VGAVDE == 400) tempbx = 640;
3815            }
3816            break;
3817         case Panel_1280x960:
3818            if     (SiS_Pr->SiS_VGAVDE == 350)  tempbx = 700;
3819            else if(SiS_Pr->SiS_VGAVDE == 400)  tempbx = 800;
3820            else if(SiS_Pr->SiS_VGAVDE == 1024) tempbx = 960;
3821            break;
3822         case Panel_1280x1024:
3823            if     (SiS_Pr->SiS_VGAVDE == 360) tempbx = 768;
3824            else if(SiS_Pr->SiS_VGAVDE == 375) tempbx = 800;
3825            else if(SiS_Pr->SiS_VGAVDE == 405) tempbx = 864;
3826            break;
3827         case Panel_1600x1200:
3828            if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) {
3829               if     (SiS_Pr->SiS_VGAVDE == 350)  tempbx = 875;
3830               else if(SiS_Pr->SiS_VGAVDE == 400)  tempbx = 1000;
3831            }
3832            break;
3833         }
3834 
3835         if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3836            tempax = SiS_Pr->SiS_VGAHDE;
3837            tempbx = SiS_Pr->SiS_VGAVDE;
3838         }
3839 
3840         SiS_Pr->SiS_HDE = tempax;
3841         SiS_Pr->SiS_VDE = tempbx;
3842      }
3843   }
3844 }
3845 
3846 static void
3847 SiS_GetCRT2Data(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
3848                 unsigned short RefreshRateTableIndex)
3849 {
3850 
3851    if(SiS_Pr->SiS_VBType & VB_SISVB) {
3852 
3853       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
3854          SiS_GetCRT2DataLVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3855       } else {
3856          if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) {
3857             /* Need LVDS Data for LCD on 301B-DH */
3858             SiS_GetCRT2DataLVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3859          } else {
3860             SiS_GetCRT2Data301(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3861          }
3862       }
3863 
3864    } else {
3865 
3866       SiS_GetCRT2DataLVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
3867 
3868    }
3869 }
3870 
3871 /*********************************************/
3872 /*         GET LVDS DES (SKEW) DATA          */
3873 /*********************************************/
3874 
3875 static const struct SiS_LVDSDes *
3876 SiS_GetLVDSDesPtr(struct SiS_Private *SiS_Pr)
3877 {
3878    const struct SiS_LVDSDes *PanelDesPtr = NULL;
3879 
3880 #ifdef CONFIG_FB_SIS_300
3881    if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
3882 
3883       if(SiS_Pr->ChipType < SIS_315H) {
3884          if(SiS_Pr->SiS_LCDTypeInfo == 4) {
3885             if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) {
3886                PanelDesPtr = SiS_Pr->SiS_PanelType04_1a;
3887                if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3888                   PanelDesPtr = SiS_Pr->SiS_PanelType04_2a;
3889                }
3890             } else if(SiS_Pr->SiS_CustomT == CUT_BARCO1024) {
3891                PanelDesPtr = SiS_Pr->SiS_PanelType04_1b;
3892                if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3893                   PanelDesPtr = SiS_Pr->SiS_PanelType04_2b;
3894                }
3895             }
3896          }
3897       }
3898    }
3899 #endif
3900    return PanelDesPtr;
3901 }
3902 
3903 static void
3904 SiS_GetLVDSDesData(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
3905                    unsigned short RefreshRateTableIndex)
3906 {
3907   unsigned short modeflag, ResIndex;
3908   const struct SiS_LVDSDes *PanelDesPtr = NULL;
3909 
3910   SiS_Pr->SiS_LCDHDES = 0;
3911   SiS_Pr->SiS_LCDVDES = 0;
3912 
3913   /* Some special cases */
3914   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
3915 
3916      /* Trumpion */
3917      if(SiS_Pr->SiS_IF_DEF_TRUMPION) {
3918         if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
3919            if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) {
3920               SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
3921            }
3922         }
3923         return;
3924      }
3925 
3926      /* 640x480 on LVDS */
3927      if(SiS_Pr->ChipType < SIS_315H) {
3928         if(SiS_Pr->SiS_LCDResInfo == Panel_640x480 && SiS_Pr->SiS_LCDTypeInfo == 3) {
3929            SiS_Pr->SiS_LCDHDES = 8;
3930            if     (SiS_Pr->SiS_VGAVDE >= 480) SiS_Pr->SiS_LCDVDES = 512;
3931            else if(SiS_Pr->SiS_VGAVDE >= 400) SiS_Pr->SiS_LCDVDES = 436;
3932            else if(SiS_Pr->SiS_VGAVDE >= 350) SiS_Pr->SiS_LCDVDES = 440;
3933            return;
3934         }
3935      }
3936 
3937   } /* LCD */
3938 
3939   if( (SiS_Pr->UseCustomMode)                    ||
3940       (SiS_Pr->SiS_LCDResInfo == Panel_Custom)   ||
3941       (SiS_Pr->SiS_CustomT == CUT_PANEL848)      ||
3942       (SiS_Pr->SiS_CustomT == CUT_PANEL856)      ||
3943       (SiS_Pr->SiS_LCDInfo & LCDPass11) ) {
3944      return;
3945   }
3946 
3947   if(ModeNo <= 0x13) ResIndex = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
3948   else               ResIndex = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
3949 
3950   if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
3951 
3952 #ifdef CONFIG_FB_SIS_315
3953      if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
3954         /* non-pass 1:1 only, see above */
3955         if(SiS_Pr->SiS_VGAHDE != SiS_Pr->PanelXRes) {
3956            SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_HT - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE) / 2);
3957         }
3958         if(SiS_Pr->SiS_VGAVDE != SiS_Pr->PanelYRes) {
3959            SiS_Pr->SiS_LCDVDES = SiS_Pr->SiS_VT - ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VGAVDE) / 2);
3960         }
3961      }
3962      if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) {
3963         switch(SiS_Pr->SiS_CustomT) {
3964         case CUT_UNIWILL1024:
3965         case CUT_UNIWILL10242:
3966         case CUT_CLEVO1400:
3967            if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
3968               SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
3969            }
3970            break;
3971         }
3972         switch(SiS_Pr->SiS_LCDResInfo) {
3973         case Panel_1280x1024:
3974            if(SiS_Pr->SiS_CustomT != CUT_COMPAQ1280) {
3975               SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
3976            }
3977            break;
3978         case Panel_1280x800:    /* Verified for Averatec 6240 */
3979         case Panel_1280x800_2:  /* Verified for Asus A4L */
3980         case Panel_1280x854:    /* Not verified yet FIXME */
3981            SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
3982            break;
3983         }
3984      }
3985 #endif
3986 
3987   } else {
3988 
3989      if((SiS_Pr->SiS_IF_DEF_CH70xx != 0) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) {
3990 
3991         if((SiS_Pr->SiS_TVMode & TVSetPAL) && (!(SiS_Pr->SiS_TVMode & TVSetPALM))) {
3992            if(ResIndex <= 3) SiS_Pr->SiS_LCDHDES = 256;
3993         }
3994 
3995      } else if((PanelDesPtr = SiS_GetLVDSDesPtr(SiS_Pr))) {
3996 
3997         SiS_Pr->SiS_LCDHDES = (PanelDesPtr+ResIndex)->LCDHDES;
3998         SiS_Pr->SiS_LCDVDES = (PanelDesPtr+ResIndex)->LCDVDES;
3999 
4000      } else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
4001 
4002         if(SiS_Pr->SiS_VGAHDE != SiS_Pr->PanelXRes) {
4003            SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_HT - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE) / 2);
4004         }
4005         if(SiS_Pr->SiS_VGAVDE != SiS_Pr->PanelYRes) {
4006            SiS_Pr->SiS_LCDVDES = SiS_Pr->SiS_VT - ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VGAVDE) / 2);
4007         } else {
4008            if(SiS_Pr->ChipType < SIS_315H) {
4009               SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
4010            } else {
4011               switch(SiS_Pr->SiS_LCDResInfo) {
4012               case Panel_800x600:
4013               case Panel_1024x768:
4014               case Panel_1280x1024:
4015                  SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT;
4016                  break;
4017               case Panel_1400x1050:
4018                  SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
4019                  break;
4020               }
4021            }
4022         }
4023 
4024      } else {
4025 
4026         if(SiS_Pr->ChipType < SIS_315H) {
4027 #ifdef CONFIG_FB_SIS_300
4028            switch(SiS_Pr->SiS_LCDResInfo) {
4029            case Panel_800x600:
4030               if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) {
4031                  SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
4032               } else {
4033                  SiS_Pr->SiS_LCDHDES = SiS_Pr->PanelHT + 3;
4034                  SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT;
4035                  if(SiS_Pr->SiS_VGAVDE == 400) SiS_Pr->SiS_LCDVDES -= 2;
4036                  else                          SiS_Pr->SiS_LCDVDES -= 4;
4037               }
4038               break;
4039            case Panel_1024x768:
4040               if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) {
4041                  SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
4042               } else {
4043                  SiS_Pr->SiS_LCDHDES = SiS_Pr->PanelHT - 1;
4044                  if(SiS_Pr->SiS_VGAVDE <= 400) SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 8;
4045                  if(SiS_Pr->SiS_VGAVDE <= 350) SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 12;
4046               }
4047               break;
4048            case Panel_1024x600:
4049            default:
4050               if( (SiS_Pr->SiS_VGAHDE == SiS_Pr->PanelXRes) &&
4051                   (SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) ) {
4052                  SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
4053               } else {
4054                  SiS_Pr->SiS_LCDHDES = SiS_Pr->PanelHT - 1;
4055               }
4056               break;
4057            }
4058 
4059            switch(SiS_Pr->SiS_LCDTypeInfo) {
4060            case 1:
4061               SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_LCDVDES = 0;
4062               break;
4063            case 3: /* 640x480 only? */
4064               SiS_Pr->SiS_LCDHDES = 8;
4065               if     (SiS_Pr->SiS_VGAVDE >= 480) SiS_Pr->SiS_LCDVDES = 512;
4066               else if(SiS_Pr->SiS_VGAVDE >= 400) SiS_Pr->SiS_LCDVDES = 436;
4067               else if(SiS_Pr->SiS_VGAVDE >= 350) SiS_Pr->SiS_LCDVDES = 440;
4068               break;
4069            }
4070 #endif
4071         } else {
4072 #ifdef CONFIG_FB_SIS_315
4073            switch(SiS_Pr->SiS_LCDResInfo) {
4074            case Panel_1024x768:
4075            case Panel_1280x1024:
4076               if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) {
4077                  SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1;
4078               }
4079               break;
4080            case Panel_320x240_1:
4081            case Panel_320x240_2:
4082            case Panel_320x240_3:
4083               SiS_Pr->SiS_LCDVDES = 524;
4084               break;
4085            }
4086 #endif
4087         }
4088      }
4089 
4090      if((ModeNo <= 0x13) && (SiS_Pr->SiS_LCDInfo & DontExpandLCD)) {
4091         modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
4092         if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
4093            if(!(modeflag & HalfDCLK)) SiS_Pr->SiS_LCDHDES = 632;
4094         } else if(!(SiS_Pr->SiS_SetFlag & SetDOSMode)) {
4095            if(SiS_Pr->SiS_LCDResInfo != Panel_1280x1024) {
4096               if(SiS_Pr->SiS_LCDResInfo >= Panel_1024x768) {
4097                  if(SiS_Pr->ChipType < SIS_315H) {
4098                     if(!(modeflag & HalfDCLK)) SiS_Pr->SiS_LCDHDES = 320;
4099                  } else {
4100 #ifdef CONFIG_FB_SIS_315
4101                     if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768)  SiS_Pr->SiS_LCDHDES = 480;
4102                     if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) SiS_Pr->SiS_LCDHDES = 804;
4103                     if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) SiS_Pr->SiS_LCDHDES = 704;
4104                     if(!(modeflag & HalfDCLK)) {
4105                        SiS_Pr->SiS_LCDHDES = 320;
4106                        if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) SiS_Pr->SiS_LCDHDES = 632;
4107                        if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) SiS_Pr->SiS_LCDHDES = 542;
4108                     }
4109 #endif
4110                  }
4111               }
4112            }
4113         }
4114      }
4115   }
4116 }
4117 
4118 /*********************************************/
4119 /*           DISABLE VIDEO BRIDGE            */
4120 /*********************************************/
4121 
4122 #ifdef CONFIG_FB_SIS_315
4123 static int
4124 SiS_HandlePWD(struct SiS_Private *SiS_Pr)
4125 {
4126    int ret = 0;
4127 #ifdef SET_PWD
4128    unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
4129    unsigned short romptr = GetLCDStructPtr661_2(SiS_Pr);
4130    unsigned char  drivermode = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40;
4131    unsigned short temp;
4132 
4133    if( (SiS_Pr->SiS_VBType & VB_SISPWD) &&
4134        (romptr)                         &&
4135        (SiS_Pr->SiS_PWDOffset) ) {
4136       SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2b,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 0]);
4137       SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2c,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 1]);
4138       SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2d,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 2]);
4139       SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2e,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 3]);
4140       SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2f,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 4]);
4141       temp = 0x00;
4142       if((ROMAddr[romptr + 2] & (0x06 << 1)) && !drivermode) {
4143          temp = 0x80;
4144          ret = 1;
4145       }
4146       SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x27,0x7f,temp);
4147    }
4148 #endif
4149    return ret;
4150 }
4151 #endif
4152 
4153 /* NEVER use any variables (VBInfo), this will be called
4154  * from outside the context of modeswitch!
4155  * MUST call getVBType before calling this
4156  */
4157 void
4158 SiS_DisableBridge(struct SiS_Private *SiS_Pr)
4159 {
4160 #ifdef CONFIG_FB_SIS_315
4161   unsigned short tempah, pushax=0, modenum;
4162 #endif
4163   unsigned short temp=0;
4164 
4165   if(SiS_Pr->SiS_VBType & VB_SISVB) {
4166 
4167      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {            /* ===== For 30xB/C/LV ===== */
4168 
4169         if(SiS_Pr->ChipType < SIS_315H) {
4170 
4171 #ifdef CONFIG_FB_SIS_300           /* 300 series */
4172 
4173            if(!(SiS_CR36BIOSWord23b(SiS_Pr))) {
4174               if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4175                  SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFE);
4176               } else {
4177                  SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08);
4178               }
4179               SiS_PanelDelay(SiS_Pr, 3);
4180            }
4181            if(SiS_Is301B(SiS_Pr)) {
4182               SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1f,0x3f);
4183               SiS_ShortDelay(SiS_Pr,1);
4184            }
4185            SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xDF);
4186            SiS_DisplayOff(SiS_Pr);
4187            SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF);
4188            SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF);
4189            SiS_UnLockCRT2(SiS_Pr);
4190            if(!(SiS_Pr->SiS_VBType & VB_SISLVDS)) {
4191               SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x80);
4192               SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40);
4193            }
4194            if( (!(SiS_CRT2IsLCD(SiS_Pr))) ||
4195                (!(SiS_CR36BIOSWord23d(SiS_Pr))) ) {
4196               SiS_PanelDelay(SiS_Pr, 2);
4197               if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4198                  SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFD);
4199               } else {
4200                  SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04);
4201               }
4202            }
4203 
4204 #endif  /* CONFIG_FB_SIS_300 */
4205 
4206         } else {
4207 
4208 #ifdef CONFIG_FB_SIS_315           /* 315 series */
4209 
4210            int didpwd = 0;
4211            bool custom1 = (SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) ||
4212                           (SiS_Pr->SiS_CustomT == CUT_CLEVO1400);
4213 
4214            modenum = SiS_GetReg(SiS_Pr->SiS_P3d4,0x34) & 0x7f;
4215 
4216            if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4217 
4218 #ifdef SET_EMI
4219               if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4220                  if(SiS_Pr->SiS_CustomT != CUT_CLEVO1400) {
4221                     SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c);
4222                  }
4223               }
4224 #endif
4225 
4226               didpwd = SiS_HandlePWD(SiS_Pr);
4227 
4228               if( (modenum <= 0x13)           ||
4229                   (SiS_IsVAMode(SiS_Pr))      ||
4230                   (!(SiS_IsDualEdge(SiS_Pr))) ) {
4231                  if(!didpwd) {
4232                     SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xfe);
4233                     if(custom1) SiS_PanelDelay(SiS_Pr, 3);
4234                  } else {
4235                     SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xfc);
4236                  }
4237               }
4238 
4239               if(!custom1) {
4240                  SiS_DDC2Delay(SiS_Pr,0xff00);
4241                  SiS_DDC2Delay(SiS_Pr,0xe000);
4242                  SiS_SetRegByte(SiS_Pr->SiS_P3c6,0x00);
4243                  pushax = SiS_GetReg(SiS_Pr->SiS_P3c4,0x06);
4244                  if(IS_SIS740) {
4245                     SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x06,0xE3);
4246                  }
4247                  SiS_PanelDelay(SiS_Pr, 3);
4248               }
4249 
4250            }
4251 
4252            if(!(SiS_IsNotM650orLater(SiS_Pr))) {
4253               /* if(SiS_Pr->ChipType < SIS_340) {*/
4254                  tempah = 0xef;
4255                  if(SiS_IsVAMode(SiS_Pr)) tempah = 0xf7;
4256                  SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x4c,tempah);
4257               /*}*/
4258            }
4259 
4260            if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4261               SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1F,~0x10);
4262            }
4263 
4264            tempah = 0x3f;
4265            if(SiS_IsDualEdge(SiS_Pr)) {
4266               tempah = 0x7f;
4267               if(!(SiS_IsVAMode(SiS_Pr))) tempah = 0xbf;
4268            }
4269            SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1F,tempah);
4270 
4271            if((SiS_IsVAMode(SiS_Pr)) ||
4272               ((SiS_Pr->SiS_VBType & VB_SISLVDS) && (modenum <= 0x13))) {
4273 
4274               SiS_DisplayOff(SiS_Pr);
4275               if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4276                  SiS_PanelDelay(SiS_Pr, 2);
4277               }
4278               SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF);
4279               SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1E,0xDF);
4280 
4281            }
4282 
4283            if((!(SiS_IsVAMode(SiS_Pr))) ||
4284               ((SiS_Pr->SiS_VBType & VB_SISLVDS) && (modenum <= 0x13))) {
4285 
4286               if(!(SiS_IsDualEdge(SiS_Pr))) {
4287                  SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xdf);
4288                  SiS_DisplayOff(SiS_Pr);
4289               }
4290               SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x80);
4291 
4292               if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4293                  SiS_PanelDelay(SiS_Pr, 2);
4294               }
4295 
4296               SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF);
4297               temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00);
4298               SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x10);
4299               SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF);
4300               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,temp);
4301 
4302            }
4303 
4304            if(SiS_IsNotM650orLater(SiS_Pr)) {
4305               SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f);
4306            }
4307 
4308            if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4309 
4310               if( (!(SiS_IsVAMode(SiS_Pr)))  &&
4311                   (!(SiS_CRT2IsLCD(SiS_Pr))) &&
4312                   (!(SiS_IsDualEdge(SiS_Pr))) ) {
4313 
4314                  if(custom1) SiS_PanelDelay(SiS_Pr, 2);
4315                  if(!didpwd) {
4316                     SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFD);
4317                  }
4318                  if(custom1) SiS_PanelDelay(SiS_Pr, 4);
4319               }
4320 
4321               if(!custom1) {
4322                  SiS_SetReg(SiS_Pr->SiS_P3c4,0x06,pushax);
4323                  if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4324                     if(SiS_IsVAorLCD(SiS_Pr)) {
4325                        SiS_PanelDelayLoop(SiS_Pr, 3, 20);
4326                     }
4327                  }
4328               }
4329 
4330            }
4331 
4332 #endif /* CONFIG_FB_SIS_315 */
4333 
4334         }
4335 
4336      } else {     /* ============ For 301 ================ */
4337 
4338         if(SiS_Pr->ChipType < SIS_315H) {
4339 #ifdef CONFIG_FB_SIS_300
4340            if(!(SiS_CR36BIOSWord23b(SiS_Pr))) {
4341               SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08);
4342               SiS_PanelDelay(SiS_Pr, 3);
4343            }
4344 #endif
4345         }
4346 
4347         SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xDF);           /* disable VB */
4348         SiS_DisplayOff(SiS_Pr);
4349 
4350         if(SiS_Pr->ChipType >= SIS_315H) {
4351            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x80);
4352         }
4353 
4354         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF);                /* disable lock mode */
4355 
4356         if(SiS_Pr->ChipType >= SIS_315H) {
4357             temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00);
4358             SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x10);
4359             SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);
4360             SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,temp);
4361         } else {
4362 #ifdef CONFIG_FB_SIS_300
4363             SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF);            /* disable CRT2 */
4364             if( (!(SiS_CRT2IsLCD(SiS_Pr))) ||
4365                 (!(SiS_CR36BIOSWord23d(SiS_Pr))) ) {
4366                 SiS_PanelDelay(SiS_Pr, 2);
4367                 SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04);
4368             }
4369 #endif
4370         }
4371 
4372       }
4373 
4374   } else {     /* ============ For LVDS =============*/
4375 
4376     if(SiS_Pr->ChipType < SIS_315H) {
4377 
4378 #ifdef CONFIG_FB_SIS_300        /* 300 series */
4379 
4380         if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) {
4381            SiS_SetCH700x(SiS_Pr,0x0E,0x09);
4382         }
4383 
4384         if(SiS_Pr->ChipType == SIS_730) {
4385            if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x11) & 0x08)) {
4386               SiS_WaitVBRetrace(SiS_Pr);
4387            }
4388            if(!(SiS_CR36BIOSWord23b(SiS_Pr))) {
4389               SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08);
4390               SiS_PanelDelay(SiS_Pr, 3);
4391            }
4392         } else {
4393            if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x11) & 0x08)) {
4394               if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x40)) {
4395                  if(!(SiS_CR36BIOSWord23b(SiS_Pr))) {
4396                     SiS_WaitVBRetrace(SiS_Pr);
4397                     if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x06) & 0x1c)) {
4398                        SiS_DisplayOff(SiS_Pr);
4399                     }
4400                     SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08);
4401                     SiS_PanelDelay(SiS_Pr, 3);
4402                  }
4403               }
4404            }
4405         }
4406 
4407         SiS_DisplayOff(SiS_Pr);
4408 
4409         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF);
4410 
4411         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF);
4412         SiS_UnLockCRT2(SiS_Pr);
4413         SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x80);
4414         SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40);
4415 
4416         if( (!(SiS_CRT2IsLCD(SiS_Pr))) ||
4417             (!(SiS_CR36BIOSWord23d(SiS_Pr))) ) {
4418            SiS_PanelDelay(SiS_Pr, 2);
4419            SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04);
4420         }
4421 
4422 #endif  /* CONFIG_FB_SIS_300 */
4423 
4424     } else {
4425 
4426 #ifdef CONFIG_FB_SIS_315        /* 315 series */
4427 
4428         if(!(SiS_IsNotM650orLater(SiS_Pr))) {
4429            /*if(SiS_Pr->ChipType < SIS_340) { */ /* XGI needs this */
4430               SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x4c,~0x18);
4431            /* } */
4432         }
4433 
4434         if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
4435 
4436            if(SiS_Pr->ChipType == SIS_740) {
4437               temp = SiS_GetCH701x(SiS_Pr,0x61);
4438               if(temp < 1) {
4439                  SiS_SetCH701x(SiS_Pr,0x76,0xac);
4440                  SiS_SetCH701x(SiS_Pr,0x66,0x00);
4441               }
4442 
4443               if( (!(SiS_IsDualEdge(SiS_Pr))) ||
4444                   (SiS_IsTVOrYPbPrOrScart(SiS_Pr)) ) {
4445                  SiS_SetCH701x(SiS_Pr,0x49,0x3e);
4446               }
4447            }
4448 
4449            if( (!(SiS_IsDualEdge(SiS_Pr))) ||
4450                (SiS_IsVAMode(SiS_Pr)) ) {
4451               SiS_Chrontel701xBLOff(SiS_Pr);
4452               SiS_Chrontel701xOff(SiS_Pr);
4453            }
4454 
4455            if(SiS_Pr->ChipType != SIS_740) {
4456               if( (!(SiS_IsDualEdge(SiS_Pr))) ||
4457                   (SiS_IsTVOrYPbPrOrScart(SiS_Pr)) ) {
4458                  SiS_SetCH701x(SiS_Pr,0x49,0x01);
4459               }
4460            }
4461 
4462         }
4463 
4464         if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) {
4465            SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08);
4466            SiS_PanelDelay(SiS_Pr, 3);
4467         }
4468 
4469         if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0)   ||
4470             (!(SiS_IsDualEdge(SiS_Pr))) ||
4471             (!(SiS_IsTVOrYPbPrOrScart(SiS_Pr))) ) {
4472            SiS_DisplayOff(SiS_Pr);
4473         }
4474 
4475         if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0)   ||
4476             (!(SiS_IsDualEdge(SiS_Pr))) ||
4477             (!(SiS_IsVAMode(SiS_Pr))) ) {
4478            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x80);
4479         }
4480 
4481         if(SiS_Pr->ChipType == SIS_740) {
4482            SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f);
4483         }
4484 
4485         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF);
4486 
4487         if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0)   ||
4488             (!(SiS_IsDualEdge(SiS_Pr))) ||
4489             (!(SiS_IsVAMode(SiS_Pr))) ) {
4490            SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF);
4491         }
4492 
4493         if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) {
4494            if(SiS_CRT2IsLCD(SiS_Pr)) {
4495               SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xdf);
4496               if(SiS_Pr->ChipType == SIS_550) {
4497                  SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xbf);
4498                  SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xef);
4499               }
4500            }
4501         } else {
4502            if(SiS_Pr->ChipType == SIS_740) {
4503               if(SiS_IsLCDOrLCDA(SiS_Pr)) {
4504                  SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xdf);
4505               }
4506            } else if(SiS_IsVAMode(SiS_Pr)) {
4507               SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xdf);
4508            }
4509         }
4510 
4511         if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
4512            if(SiS_IsDualEdge(SiS_Pr)) {
4513               /* SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xff); */
4514            } else {
4515               SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb);
4516            }
4517         }
4518 
4519         SiS_UnLockCRT2(SiS_Pr);
4520 
4521         if(SiS_Pr->ChipType == SIS_550) {
4522            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x80); /* DirectDVD PAL?*/
4523            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40); /* VB clock / 4 ? */
4524         } else if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0)   ||
4525                    (!(SiS_IsDualEdge(SiS_Pr))) ||
4526                    (!(SiS_IsVAMode(SiS_Pr))) ) {
4527            SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0xf7);
4528         }
4529 
4530         if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) {
4531            if(SiS_CRT2IsLCD(SiS_Pr)) {
4532               if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) {
4533                  SiS_PanelDelay(SiS_Pr, 2);
4534                  SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04);
4535               }
4536            }
4537         }
4538 
4539 #endif  /* CONFIG_FB_SIS_315 */
4540 
4541     }  /* 315 series */
4542 
4543   }  /* LVDS */
4544 
4545 }
4546 
4547 /*********************************************/
4548 /*            ENABLE VIDEO BRIDGE            */
4549 /*********************************************/
4550 
4551 /* NEVER use any variables (VBInfo), this will be called
4552  * from outside the context of a mode switch!
4553  * MUST call getVBType before calling this
4554  */
4555 static
4556 void
4557 SiS_EnableBridge(struct SiS_Private *SiS_Pr)
4558 {
4559   unsigned short temp=0, tempah;
4560 #ifdef CONFIG_FB_SIS_315
4561   unsigned short temp1, pushax=0;
4562   bool delaylong = false;
4563 #endif
4564 
4565   if(SiS_Pr->SiS_VBType & VB_SISVB) {
4566 
4567     if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {             /* ====== For 301B et al  ====== */
4568 
4569       if(SiS_Pr->ChipType < SIS_315H) {
4570 
4571 #ifdef CONFIG_FB_SIS_300     /* 300 series */
4572 
4573          if(SiS_CRT2IsLCD(SiS_Pr)) {
4574             if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4575                SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x02);
4576             } else if(SiS_Pr->SiS_VBType & VB_NoLCD) {
4577                SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00);
4578             }
4579             if(SiS_Pr->SiS_VBType & (VB_SISLVDS | VB_NoLCD)) {
4580                if(!(SiS_CR36BIOSWord23d(SiS_Pr))) {
4581                   SiS_PanelDelay(SiS_Pr, 0);
4582                }
4583             }
4584          }
4585 
4586          if((SiS_Pr->SiS_VBType & VB_NoLCD) &&
4587             (SiS_CRT2IsLCD(SiS_Pr))) {
4588 
4589             SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);                   /* Enable CRT2 */
4590             SiS_DisplayOn(SiS_Pr);
4591             SiS_UnLockCRT2(SiS_Pr);
4592             SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0xBF);
4593             if(SiS_BridgeInSlavemode(SiS_Pr)) {
4594                SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x01,0x1F);
4595             } else {
4596                SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x01,0x1F,0x40);
4597             }
4598             if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x40)) {
4599                if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x10)) {
4600                   if(!(SiS_CR36BIOSWord23b(SiS_Pr))) {
4601                      SiS_PanelDelay(SiS_Pr, 1);
4602                   }
4603                   SiS_WaitVBRetrace(SiS_Pr);
4604                   SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00);
4605                }
4606             }
4607 
4608          } else {
4609 
4610             temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32) & 0xDF;             /* lock mode */
4611             if(SiS_BridgeInSlavemode(SiS_Pr)) {
4612                tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
4613                if(!(tempah & SetCRT2ToRAMDAC)) temp |= 0x20;
4614             }
4615             SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,temp);
4616             SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);
4617             SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x00,0x1F,0x20);        /* enable VB processor */
4618             SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x1F,0xC0);
4619             SiS_DisplayOn(SiS_Pr);
4620             if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4621                if(SiS_CRT2IsLCD(SiS_Pr)) {
4622                   if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x10)) {
4623                      if(!(SiS_CR36BIOSWord23b(SiS_Pr))) {
4624                         SiS_PanelDelay(SiS_Pr, 1);
4625                      }
4626                      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x01);
4627                   }
4628                }
4629             }
4630 
4631          }
4632 
4633 
4634 #endif /* CONFIG_FB_SIS_300 */
4635 
4636       } else {
4637 
4638 #ifdef CONFIG_FB_SIS_315    /* 315 series */
4639 
4640 #ifdef SET_EMI
4641          unsigned char   r30=0, r31=0, r32=0, r33=0, cr36=0;
4642          int didpwd = 0;
4643          /* unsigned short  emidelay=0; */
4644 #endif
4645 
4646          if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4647             SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1f,0xef);
4648 #ifdef SET_EMI
4649             if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4650                SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c);
4651             }
4652 #endif
4653          }
4654 
4655          if(!(SiS_IsNotM650orLater(SiS_Pr))) {
4656             /*if(SiS_Pr->ChipType < SIS_340) { */
4657                tempah = 0x10;
4658                if(SiS_LCDAEnabled(SiS_Pr)) {
4659                   if(SiS_TVEnabled(SiS_Pr)) tempah = 0x18;
4660                   else                      tempah = 0x08;
4661                }
4662                SiS_SetReg(SiS_Pr->SiS_Part1Port,0x4c,tempah);
4663             /*}*/
4664          }
4665 
4666          if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4667 
4668             SiS_SetRegByte(SiS_Pr->SiS_P3c6,0x00);
4669             SiS_DisplayOff(SiS_Pr);
4670             pushax = SiS_GetReg(SiS_Pr->SiS_P3c4,0x06);
4671             if(IS_SIS740) {
4672                SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x06,0xE3);
4673             }
4674 
4675             didpwd = SiS_HandlePWD(SiS_Pr);
4676 
4677             if(SiS_IsVAorLCD(SiS_Pr)) {
4678                if(!didpwd) {
4679                   if(!(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x02)) {
4680                      SiS_PanelDelayLoop(SiS_Pr, 3, 2);
4681                      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x02);
4682                      SiS_PanelDelayLoop(SiS_Pr, 3, 2);
4683                      if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4684                         SiS_GenericDelay(SiS_Pr, 17664);
4685                      }
4686                   }
4687                } else {
4688                   SiS_PanelDelayLoop(SiS_Pr, 3, 2);
4689                   if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4690                      SiS_GenericDelay(SiS_Pr, 17664);
4691                   }
4692                }
4693             }
4694 
4695             if(!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40)) {
4696                SiS_PanelDelayLoop(SiS_Pr, 3, 10);
4697                delaylong = true;
4698             }
4699 
4700          }
4701 
4702          if(!(SiS_IsVAMode(SiS_Pr))) {
4703 
4704             temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32) & 0xDF;
4705             if(SiS_BridgeInSlavemode(SiS_Pr)) {
4706                tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
4707                if(!(tempah & SetCRT2ToRAMDAC)) {
4708                   if(!(SiS_LCDAEnabled(SiS_Pr))) temp |= 0x20;
4709                }
4710             }
4711             SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,temp);
4712 
4713             SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);                   /* enable CRT2 */
4714 
4715             SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f);
4716             SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2e,0x80);
4717 
4718             if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4719                SiS_PanelDelay(SiS_Pr, 2);
4720             }
4721 
4722          } else {
4723 
4724             SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x20);
4725 
4726          }
4727 
4728          SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x00,0x1f,0x20);
4729          SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2e,0x80);
4730 
4731          if(SiS_Pr->SiS_VBType & VB_SISPOWER) {
4732             if( (SiS_LCDAEnabled(SiS_Pr)) ||
4733                 (SiS_CRT2IsLCD(SiS_Pr)) ) {
4734                /* Enable "LVDS PLL power on" (even on 301C) */
4735                SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x2a,0x7f);
4736                /* Enable "LVDS Driver Power on" (even on 301C) */
4737                SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x7f);
4738             }
4739          }
4740 
4741          tempah = 0xc0;
4742          if(SiS_IsDualEdge(SiS_Pr)) {
4743             tempah = 0x80;
4744             if(!(SiS_IsVAMode(SiS_Pr))) tempah = 0x40;
4745          }
4746          SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x1F,tempah);
4747 
4748          if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
4749 
4750             SiS_PanelDelay(SiS_Pr, 2);
4751 
4752             SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x1f,0x10);
4753             SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2e,0x80);
4754 
4755             if(SiS_Pr->SiS_CustomT != CUT_CLEVO1400) {
4756 #ifdef SET_EMI
4757                if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4758                   SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c);
4759                   SiS_GenericDelay(SiS_Pr, 2048);
4760                }
4761 #endif
4762                SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x27,0x0c);
4763 
4764                if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4765 #ifdef SET_EMI
4766                   cr36 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36);
4767 
4768                   if(SiS_Pr->SiS_ROMNew) {
4769                      unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
4770                      unsigned short romptr = GetLCDStructPtr661_2(SiS_Pr);
4771                      if(romptr) {
4772                         SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x30,0x20); /* Reset */
4773                         SiS_Pr->EMI_30 = 0;
4774                         SiS_Pr->EMI_31 = ROMAddr[romptr + SiS_Pr->SiS_EMIOffset + 0];
4775                         SiS_Pr->EMI_32 = ROMAddr[romptr + SiS_Pr->SiS_EMIOffset + 1];
4776                         SiS_Pr->EMI_33 = ROMAddr[romptr + SiS_Pr->SiS_EMIOffset + 2];
4777                         if(ROMAddr[romptr + 1] & 0x10) SiS_Pr->EMI_30 = 0x40;
4778                         /* emidelay = SISGETROMW((romptr + 0x22)); */
4779                         SiS_Pr->HaveEMI = SiS_Pr->HaveEMILCD = SiS_Pr->OverruleEMI = true;
4780                      }
4781                   }
4782 
4783                   /*                                              (P4_30|0x40)  */
4784                   /* Compal 1400x1050: 0x05, 0x60, 0x00                YES  (1.10.7w;  CR36=69)      */
4785                   /* Compal 1400x1050: 0x0d, 0x70, 0x40                YES  (1.10.7x;  CR36=69)      */
4786                   /* Acer   1280x1024: 0x12, 0xd0, 0x6b                NO   (1.10.9k;  CR36=73)      */
4787                   /* Compaq 1280x1024: 0x0d, 0x70, 0x6b                YES  (1.12.04b; CR36=03)      */
4788                   /* Clevo   1024x768: 0x05, 0x60, 0x33                NO   (1.10.8e;  CR36=12, DL!) */
4789                   /* Clevo   1024x768: 0x0d, 0x70, 0x40 (if type == 3) YES  (1.10.8y;  CR36=?2)      */
4790                   /* Clevo   1024x768: 0x05, 0x60, 0x33 (if type != 3) YES  (1.10.8y;  CR36=?2)      */
4791                   /* Asus    1024x768: ?                                ?   (1.10.8o;  CR36=?2)      */
4792                   /* Asus    1024x768: 0x08, 0x10, 0x3c (problematic)  YES  (1.10.8q;  CR36=22)      */
4793 
4794                   if(SiS_Pr->HaveEMI) {
4795                      r30 = SiS_Pr->EMI_30; r31 = SiS_Pr->EMI_31;
4796                      r32 = SiS_Pr->EMI_32; r33 = SiS_Pr->EMI_33;
4797                   } else {
4798                      r30 = 0;
4799                   }
4800 
4801                   /* EMI_30 is read at driver start; however, the BIOS sets this
4802                    * (if it is used) only if the LCD is in use. In case we caught
4803                    * the machine while on TV output, this bit is not set and we
4804                    * don't know if it should be set - hence our detection is wrong.
4805                    * Work-around this here:
4806                    */
4807 
4808                   if((!SiS_Pr->HaveEMI) || (!SiS_Pr->HaveEMILCD)) {
4809                      switch((cr36 & 0x0f)) {
4810                      case 2:
4811                         r30 |= 0x40;
4812                         if(SiS_Pr->SiS_CustomT == CUT_CLEVO1024) r30 &= ~0x40;
4813                         if(!SiS_Pr->HaveEMI) {
4814                            r31 = 0x05; r32 = 0x60; r33 = 0x33;
4815                            if((cr36 & 0xf0) == 0x30) {
4816                               r31 = 0x0d; r32 = 0x70; r33 = 0x40;
4817                            }
4818                         }
4819                         break;
4820                      case 3:  /* 1280x1024 */
4821                         if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) r30 |= 0x40;
4822                         if(!SiS_Pr->HaveEMI) {
4823                            r31 = 0x12; r32 = 0xd0; r33 = 0x6b;
4824                            if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) {
4825                               r31 = 0x0d; r32 = 0x70; r33 = 0x6b;
4826                            }
4827                         }
4828                         break;
4829                      case 9:  /* 1400x1050 */
4830                         r30 |= 0x40;
4831                         if(!SiS_Pr->HaveEMI) {
4832                            r31 = 0x05; r32 = 0x60; r33 = 0x00;
4833                            if(SiS_Pr->SiS_CustomT == CUT_COMPAL1400_2) {
4834                               r31 = 0x0d; r32 = 0x70; r33 = 0x40;  /* BIOS values */
4835                            }
4836                         }
4837                         break;
4838                      case 11: /* 1600x1200 - unknown */
4839                         r30 |= 0x40;
4840                         if(!SiS_Pr->HaveEMI) {
4841                            r31 = 0x05; r32 = 0x60; r33 = 0x00;
4842                         }
4843                      }
4844                   }
4845 
4846                   /* BIOS values don't work so well sometimes */
4847                   if(!SiS_Pr->OverruleEMI) {
4848 #ifdef COMPAL_HACK
4849                      if(SiS_Pr->SiS_CustomT == CUT_COMPAL1400_2) {
4850                         if((cr36 & 0x0f) == 0x09) {
4851                            r30 = 0x60; r31 = 0x05; r32 = 0x60; r33 = 0x00;
4852                         }
4853                      }
4854 #endif
4855 #ifdef COMPAQ_HACK
4856                      if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) {
4857                         if((cr36 & 0x0f) == 0x03) {
4858                            r30 = 0x20; r31 = 0x12; r32 = 0xd0; r33 = 0x6b;
4859                         }
4860                      }
4861 #endif
4862 #ifdef ASUS_HACK
4863                      if(SiS_Pr->SiS_CustomT == CUT_ASUSA2H_2) {
4864                         if((cr36 & 0x0f) == 0x02) {
4865                            /* r30 = 0x60; r31 = 0x05; r32 = 0x60; r33 = 0x33;  */   /* rev 2 */
4866                            /* r30 = 0x20; r31 = 0x05; r32 = 0x60; r33 = 0x33;  */   /* rev 3 */
4867                            /* r30 = 0x60; r31 = 0x0d; r32 = 0x70; r33 = 0x40;  */   /* rev 4 */
4868                            /* r30 = 0x20; r31 = 0x0d; r32 = 0x70; r33 = 0x40;  */   /* rev 5 */
4869                         }
4870                      }
4871 #endif
4872                   }
4873 
4874                   if(!(SiS_Pr->OverruleEMI && (!r30) && (!r31) && (!r32) && (!r33))) {
4875                      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x30,0x20); /* Reset */
4876                      SiS_GenericDelay(SiS_Pr, 2048);
4877                   }
4878                   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x31,r31);
4879                   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x32,r32);
4880                   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x33,r33);
4881 #endif  /* SET_EMI */
4882 
4883                   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x34,0x10);
4884 
4885 #ifdef SET_EMI
4886                   if( (SiS_LCDAEnabled(SiS_Pr)) ||
4887                       (SiS_CRT2IsLCD(SiS_Pr)) ) {
4888                      if(r30 & 0x40) {
4889                         /*SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x2a,0x80);*/
4890                         SiS_PanelDelayLoop(SiS_Pr, 3, 5);
4891                         if(delaylong) {
4892                            SiS_PanelDelayLoop(SiS_Pr, 3, 5);
4893                            delaylong = false;
4894                         }
4895                         SiS_WaitVBRetrace(SiS_Pr);
4896                         SiS_WaitVBRetrace(SiS_Pr);
4897                         if(SiS_Pr->SiS_CustomT == CUT_ASUSA2H_2) {
4898                            SiS_GenericDelay(SiS_Pr, 1280);
4899                         }
4900                         SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x30,0x40);   /* Enable */
4901                         /*SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x2a,0x7f);*/
4902                      }
4903                   }
4904 #endif
4905                }
4906             }
4907 
4908             if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) {
4909                if(SiS_IsVAorLCD(SiS_Pr)) {
4910                   SiS_PanelDelayLoop(SiS_Pr, 3, 10);
4911                   if(delaylong) {
4912                      SiS_PanelDelayLoop(SiS_Pr, 3, 10);
4913                   }
4914                   SiS_WaitVBRetrace(SiS_Pr);
4915                   if(SiS_Pr->SiS_VBType & VB_SISEMI) {
4916                      SiS_GenericDelay(SiS_Pr, 2048);
4917                      SiS_WaitVBRetrace(SiS_Pr);
4918                   }
4919                   if(!didpwd) {
4920                      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x01);
4921                   } else {
4922                      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x03);
4923                   }
4924                }
4925             }
4926 
4927             SiS_SetReg(SiS_Pr->SiS_P3c4,0x06,pushax);
4928             SiS_DisplayOn(SiS_Pr);
4929             SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xff);
4930 
4931          }
4932 
4933          if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) {
4934             SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x00,0x7f);
4935          }
4936 
4937 #endif /* CONFIG_FB_SIS_315 */
4938 
4939       }
4940 
4941     } else {    /* ============  For 301 ================ */
4942 
4943        if(SiS_Pr->ChipType < SIS_315H) {
4944           if(SiS_CRT2IsLCD(SiS_Pr)) {
4945              SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00);
4946              SiS_PanelDelay(SiS_Pr, 0);
4947           }
4948        }
4949 
4950        temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32) & 0xDF;          /* lock mode */
4951        if(SiS_BridgeInSlavemode(SiS_Pr)) {
4952           tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30);
4953           if(!(tempah & SetCRT2ToRAMDAC)) temp |= 0x20;
4954        }
4955        SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,temp);
4956 
4957        SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);                  /* enable CRT2 */
4958 
4959        if(SiS_Pr->ChipType >= SIS_315H) {
4960           temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x2E);
4961           if(!(temp & 0x80)) {
4962              SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2E,0x80);         /* BVBDOENABLE=1 */
4963           }
4964        }
4965 
4966        SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x00,0x1F,0x20);     /* enable VB processor */
4967 
4968        SiS_VBLongWait(SiS_Pr);
4969        SiS_DisplayOn(SiS_Pr);
4970        if(SiS_Pr->ChipType >= SIS_315H) {
4971           SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x00,0x7f);
4972        }
4973        SiS_VBLongWait(SiS_Pr);
4974 
4975        if(SiS_Pr->ChipType < SIS_315H) {
4976           if(SiS_CRT2IsLCD(SiS_Pr)) {
4977              SiS_PanelDelay(SiS_Pr, 1);
4978              SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00);
4979           }
4980        }
4981 
4982     }
4983 
4984   } else {   /* =================== For LVDS ================== */
4985 
4986     if(SiS_Pr->ChipType < SIS_315H) {
4987 
4988 #ifdef CONFIG_FB_SIS_300    /* 300 series */
4989 
4990        if(SiS_CRT2IsLCD(SiS_Pr)) {
4991           if(SiS_Pr->ChipType == SIS_730) {
4992              SiS_PanelDelay(SiS_Pr, 1);
4993              SiS_PanelDelay(SiS_Pr, 1);
4994              SiS_PanelDelay(SiS_Pr, 1);
4995           }
4996           SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00);
4997           if(!(SiS_CR36BIOSWord23d(SiS_Pr))) {
4998              SiS_PanelDelay(SiS_Pr, 0);
4999           }
5000        }
5001 
5002        SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);
5003        SiS_DisplayOn(SiS_Pr);
5004        SiS_UnLockCRT2(SiS_Pr);
5005        SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0xBF);
5006        if(SiS_BridgeInSlavemode(SiS_Pr)) {
5007           SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x01,0x1F);
5008        } else {
5009           SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x01,0x1F,0x40);
5010        }
5011 
5012        if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) {
5013           if(!(SiS_CRT2IsLCD(SiS_Pr))) {
5014              SiS_WaitVBRetrace(SiS_Pr);
5015              SiS_SetCH700x(SiS_Pr,0x0E,0x0B);
5016           }
5017        }
5018 
5019        if(SiS_CRT2IsLCD(SiS_Pr)) {
5020           if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x40)) {
5021              if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x10)) {
5022                 if(!(SiS_CR36BIOSWord23b(SiS_Pr))) {
5023                    SiS_PanelDelay(SiS_Pr, 1);
5024                    SiS_PanelDelay(SiS_Pr, 1);
5025                 }
5026                 SiS_WaitVBRetrace(SiS_Pr);
5027                 SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00);
5028              }
5029           }
5030        }
5031 
5032 #endif  /* CONFIG_FB_SIS_300 */
5033 
5034     } else {
5035 
5036 #ifdef CONFIG_FB_SIS_315    /* 315 series */
5037 
5038        if(!(SiS_IsNotM650orLater(SiS_Pr))) {
5039           /*if(SiS_Pr->ChipType < SIS_340) {*/  /* XGI needs this */
5040              SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x4c,0x18);
5041           /*}*/
5042        }
5043 
5044        if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) {
5045           if(SiS_CRT2IsLCD(SiS_Pr)) {
5046              SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00);
5047              SiS_PanelDelay(SiS_Pr, 0);
5048           }
5049        }
5050 
5051        SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);
5052        SiS_UnLockCRT2(SiS_Pr);
5053 
5054        SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0xf7);
5055 
5056        if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
5057           temp = SiS_GetCH701x(SiS_Pr,0x66);
5058           temp &= 0x20;
5059           SiS_Chrontel701xBLOff(SiS_Pr);
5060        }
5061 
5062        if(SiS_Pr->ChipType != SIS_550) {
5063           SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f);
5064        }
5065 
5066        if(SiS_Pr->ChipType == SIS_740) {
5067           if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
5068              if(SiS_IsLCDOrLCDA(SiS_Pr)) {
5069                 SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x20);
5070              }
5071           }
5072        }
5073 
5074        temp1 = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x2E);
5075        if(!(temp1 & 0x80)) {
5076           SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2E,0x80);
5077        }
5078 
5079        if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
5080           if(temp) {
5081              SiS_Chrontel701xBLOn(SiS_Pr);
5082           }
5083        }
5084 
5085        if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) {
5086           if(SiS_CRT2IsLCD(SiS_Pr)) {
5087              SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x20);
5088              if(SiS_Pr->ChipType == SIS_550) {
5089                 SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x40);
5090                 SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x10);
5091              }
5092           }
5093        } else if(SiS_IsVAMode(SiS_Pr)) {
5094           if(SiS_Pr->ChipType != SIS_740) {
5095              SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x20);
5096           }
5097        }
5098 
5099        if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) {
5100           SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x00,0x7f);
5101        }
5102 
5103        if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
5104           if(SiS_IsTVOrYPbPrOrScart(SiS_Pr)) {
5105              SiS_Chrontel701xOn(SiS_Pr);
5106           }
5107           if( (SiS_IsVAMode(SiS_Pr)) ||
5108               (SiS_IsLCDOrLCDA(SiS_Pr)) ) {
5109              SiS_ChrontelDoSomething1(SiS_Pr);
5110           }
5111        }
5112 
5113        if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
5114           if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) {
5115              if( (SiS_IsVAMode(SiS_Pr)) ||
5116                  (SiS_IsLCDOrLCDA(SiS_Pr)) ) {
5117                 SiS_Chrontel701xBLOn(SiS_Pr);
5118                 SiS_ChrontelInitTVVSync(SiS_Pr);
5119              }
5120           }
5121        } else if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) {
5122           if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) {
5123              if(SiS_CRT2IsLCD(SiS_Pr)) {
5124                 SiS_PanelDelay(SiS_Pr, 1);
5125                 SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00);
5126              }
5127           }
5128        }
5129 
5130 #endif  /* CONFIG_FB_SIS_315 */
5131 
5132     } /* 310 series */
5133 
5134   }  /* LVDS */
5135 
5136 }
5137 
5138 /*********************************************/
5139 /*         SET PART 1 REGISTER GROUP         */
5140 /*********************************************/
5141 
5142 /* Set CRT2 OFFSET / PITCH */
5143 static void
5144 SiS_SetCRT2Offset(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
5145                 unsigned short RRTI)
5146 {
5147    unsigned short offset;
5148    unsigned char  temp;
5149 
5150    if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) return;
5151 
5152    offset = SiS_GetOffset(SiS_Pr,ModeNo,ModeIdIndex,RRTI);
5153 
5154    SiS_SetReg(SiS_Pr->SiS_Part1Port,0x07,(offset & 0xFF));
5155    SiS_SetReg(SiS_Pr->SiS_Part1Port,0x09,(offset >> 8));
5156 
5157    temp = (unsigned char)(((offset >> 3) & 0xFF) + 1);
5158    if(offset & 0x07) temp++;
5159    SiS_SetReg(SiS_Pr->SiS_Part1Port,0x03,temp);
5160 }
5161 
5162 /* Set CRT2 sync and PanelLink mode */
5163 static void
5164 SiS_SetCRT2Sync(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short RefreshRateTableIndex)
5165 {
5166    unsigned short tempah=0, tempbl, infoflag;
5167 
5168    tempbl = 0xC0;
5169 
5170    if(SiS_Pr->UseCustomMode) {
5171       infoflag = SiS_Pr->CInfoFlag;
5172    } else {
5173       infoflag = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
5174    }
5175 
5176    if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {                                   /* LVDS */
5177 
5178       if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
5179          tempah = 0;
5180       } else if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (SiS_Pr->SiS_LCDInfo & LCDSync)) {
5181          tempah = SiS_Pr->SiS_LCDInfo;
5182       } else tempah = infoflag >> 8;
5183       tempah &= 0xC0;
5184       tempah |= 0x20;
5185       if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10;
5186       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
5187          if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) ||
5188             (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) {
5189             tempah |= 0xf0;
5190          }
5191          if( (SiS_Pr->SiS_IF_DEF_FSTN) ||
5192              (SiS_Pr->SiS_IF_DEF_DSTN) ||
5193              (SiS_Pr->SiS_IF_DEF_TRUMPION) ||
5194              (SiS_Pr->SiS_CustomT == CUT_PANEL848) ||
5195              (SiS_Pr->SiS_CustomT == CUT_PANEL856) ) {
5196             tempah |= 0x30;
5197          }
5198          if( (SiS_Pr->SiS_IF_DEF_FSTN) ||
5199              (SiS_Pr->SiS_IF_DEF_DSTN) ) {
5200             tempah &= ~0xc0;
5201          }
5202       }
5203       if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
5204          if(SiS_Pr->ChipType >= SIS_315H) {
5205             tempah >>= 3;
5206             tempah &= 0x18;
5207             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xE7,tempah);
5208             /* Don't care about 12/18/24 bit mode - TV is via VGA, not PL */
5209          } else {
5210             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,0xe0);
5211          }
5212       } else {
5213          SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah);
5214       }
5215 
5216    } else if(SiS_Pr->SiS_VBType & VB_SISVB) {
5217 
5218       if(SiS_Pr->ChipType < SIS_315H) {
5219 
5220 #ifdef CONFIG_FB_SIS_300  /* ---- 300 series --- */
5221 
5222          if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {                        /* 630 - 301B(-DH) */
5223 
5224             tempah = infoflag >> 8;
5225             tempbl = 0;
5226             if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
5227                if(SiS_Pr->SiS_LCDInfo & LCDSync) {
5228                   tempah = SiS_Pr->SiS_LCDInfo;
5229                   tempbl = (tempah >> 6) & 0x03;
5230                }
5231             }
5232             tempah &= 0xC0;
5233             tempah |= 0x20;
5234             if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10;
5235             tempah |= 0xc0;
5236             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah);
5237             if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) {
5238                SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xf0,tempbl);
5239             }
5240 
5241          } else {                                                       /* 630 - 301 */
5242 
5243             tempah = ((infoflag >> 8) & 0xc0) | 0x20;
5244             if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10;
5245             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah);
5246 
5247          }
5248 
5249 #endif /* CONFIG_FB_SIS_300 */
5250 
5251       } else {
5252 
5253 #ifdef CONFIG_FB_SIS_315  /* ------- 315 series ------ */
5254 
5255          if(SiS_Pr->SiS_VBType & VB_SISLVDS) {                  /* 315 - LVDS */
5256 
5257             tempbl = 0;
5258             if((SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) &&
5259                (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)) {
5260                tempah = infoflag >> 8;
5261                if(SiS_Pr->SiS_LCDInfo & LCDSync) {
5262                  tempbl = ((SiS_Pr->SiS_LCDInfo & 0xc0) >> 6);
5263                }
5264             } else if((SiS_Pr->SiS_CustomT == CUT_CLEVO1400)  &&
5265                       (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050)) {
5266                tempah = infoflag >> 8;
5267                tempbl = 0x03;
5268             } else {
5269                tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37);
5270                tempbl = (tempah >> 6) & 0x03;
5271                tempbl |= 0x08;
5272                if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempbl |= 0x04;
5273             }
5274             tempah &= 0xC0;
5275             tempah |= 0x20;
5276             if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10;
5277             if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)   tempah |= 0xc0;
5278             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah);
5279             if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
5280                if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
5281                   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xf0,tempbl);
5282                }
5283             }
5284 
5285          } else {                                                       /* 315 - TMDS */
5286 
5287             tempah = tempbl = infoflag >> 8;
5288             if(!SiS_Pr->UseCustomMode) {
5289                tempbl = 0;
5290                if((SiS_Pr->SiS_VBType & VB_SIS30xC) && (SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) {
5291                   if(ModeNo <= 0x13) {
5292                      tempah = SiS_GetRegByte((SiS_Pr->SiS_P3ca+0x02));
5293                   }
5294                }
5295                if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5296                   if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
5297                     if(SiS_Pr->SiS_LCDInfo & LCDSync) {
5298                        tempah = SiS_Pr->SiS_LCDInfo;
5299                        tempbl = (tempah >> 6) & 0x03;
5300                     }
5301                   }
5302                }
5303             }
5304             tempah &= 0xC0;
5305             tempah |= 0x20;
5306             if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10;
5307             if(SiS_Pr->SiS_VBType & VB_NoLCD) {
5308                /* Imitate BIOS bug */
5309                if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)  tempah |= 0xc0;
5310             }
5311             if((SiS_Pr->SiS_VBType & VB_SIS30xC) && (SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) {
5312                tempah >>= 3;
5313                tempah &= 0x18;
5314                SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xe7,tempah);
5315             } else {
5316                SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah);
5317                if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
5318                   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
5319                      SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xf0,tempbl);
5320                   }
5321                }
5322             }
5323 
5324          }
5325 #endif  /* CONFIG_FB_SIS_315 */
5326       }
5327    }
5328 }
5329 
5330 /* Set CRT2 FIFO on 300/540/630/730 */
5331 #ifdef CONFIG_FB_SIS_300
5332 static void
5333 SiS_SetCRT2FIFO_300(struct SiS_Private *SiS_Pr,unsigned short ModeNo)
5334 {
5335   unsigned char  *ROMAddr  = SiS_Pr->VirtualRomBase;
5336   unsigned short temp, index, modeidindex, refreshratetableindex;
5337   unsigned short VCLK = 0, MCLK, colorth = 0, data2 = 0;
5338   unsigned short tempbx, tempcl, CRT1ModeNo, CRT2ModeNo, SelectRate_backup;
5339   unsigned int   data, pci50, pciA0;
5340   static const unsigned char colortharray[] = {
5341         1, 1, 2, 2, 3, 4
5342   };
5343 
5344   SelectRate_backup = SiS_Pr->SiS_SelectCRT2Rate;
5345 
5346   if(!SiS_Pr->CRT1UsesCustomMode) {
5347 
5348      CRT1ModeNo = SiS_Pr->SiS_CRT1Mode;                                 /* get CRT1 ModeNo */
5349      SiS_SearchModeID(SiS_Pr, &CRT1ModeNo, &modeidindex);
5350      SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2);
5351      SiS_Pr->SiS_SelectCRT2Rate = 0;
5352      refreshratetableindex = SiS_GetRatePtr(SiS_Pr, CRT1ModeNo, modeidindex);
5353 
5354      if(CRT1ModeNo >= 0x13) {
5355         /* Get VCLK */
5356         index = SiS_GetRefCRTVCLK(SiS_Pr, refreshratetableindex, SiS_Pr->SiS_UseWide);
5357         VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
5358 
5359         /* Get colordepth */
5360         colorth = SiS_GetColorDepth(SiS_Pr,CRT1ModeNo,modeidindex) >> 1;
5361         if(!colorth) colorth++;
5362      }
5363 
5364   } else {
5365 
5366      CRT1ModeNo = 0xfe;
5367 
5368      /* Get VCLK */
5369      VCLK = SiS_Pr->CSRClock_CRT1;
5370 
5371      /* Get color depth */
5372      colorth = colortharray[((SiS_Pr->CModeFlag_CRT1 & ModeTypeMask) - 2)];
5373 
5374   }
5375 
5376   if(CRT1ModeNo >= 0x13) {
5377      /* Get MCLK */
5378      if(SiS_Pr->ChipType == SIS_300) {
5379         index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3A);
5380      } else {
5381         index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1A);
5382      }
5383      index &= 0x07;
5384      MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK;
5385 
5386      temp = ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) >> 6) & 0x03) << 1;
5387      if(!temp) temp++;
5388      temp <<= 2;
5389 
5390      data2 = temp - ((colorth * VCLK) / MCLK);
5391 
5392      temp = (28 * 16) % data2;
5393      data2 = (28 * 16) / data2;
5394      if(temp) data2++;
5395 
5396      if(SiS_Pr->ChipType == SIS_300) {
5397 
5398         SiS_GetFIFOThresholdIndex300(SiS_Pr, &tempbx, &tempcl);
5399         data = SiS_GetFIFOThresholdB300(tempbx, tempcl);
5400 
5401      } else {
5402 
5403         pci50 = sisfb_read_nbridge_pci_dword(SiS_Pr, 0x50);
5404         pciA0 = sisfb_read_nbridge_pci_dword(SiS_Pr, 0xa0);
5405 
5406         if(SiS_Pr->ChipType == SIS_730) {
5407 
5408            index = (unsigned short)(((pciA0 >> 28) & 0x0f) * 3);
5409            index += (unsigned short)(((pci50 >> 9)) & 0x03);
5410 
5411            /* BIOS BUG (2.04.5d, 2.04.6a use ah here, which is unset!) */
5412            index = 0;  /* -- do it like the BIOS anyway... */
5413 
5414         } else {
5415 
5416            pci50 >>= 24;
5417            pciA0 >>= 24;
5418 
5419            index = (pci50 >> 1) & 0x07;
5420 
5421            if(pci50 & 0x01)    index += 6;
5422            if(!(pciA0 & 0x01)) index += 24;
5423 
5424            if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) & 0x80) index += 12;
5425 
5426         }
5427 
5428         data = SiS_GetLatencyFactor630(SiS_Pr, index) + 15;
5429         if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) & 0x80)) data += 5;
5430 
5431      }
5432 
5433      data += data2;                                             /* CRT1 Request Period */
5434 
5435      SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
5436      SiS_Pr->SiS_SelectCRT2Rate = SelectRate_backup;
5437 
5438      if(!SiS_Pr->UseCustomMode) {
5439 
5440         CRT2ModeNo = ModeNo;
5441         SiS_SearchModeID(SiS_Pr, &CRT2ModeNo, &modeidindex);
5442 
5443         refreshratetableindex = SiS_GetRatePtr(SiS_Pr, CRT2ModeNo, modeidindex);
5444 
5445         /* Get VCLK  */
5446         index = SiS_GetVCLK2Ptr(SiS_Pr, CRT2ModeNo, modeidindex, refreshratetableindex);
5447         VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
5448 
5449         if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) || (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) {
5450            if(SiS_Pr->SiS_UseROM) {
5451               if(ROMAddr[0x220] & 0x01) {
5452                  VCLK = ROMAddr[0x229] | (ROMAddr[0x22a] << 8);
5453               }
5454            }
5455         }
5456 
5457      } else {
5458 
5459         /* Get VCLK */
5460         CRT2ModeNo = 0xfe;
5461         VCLK = SiS_Pr->CSRClock;
5462 
5463      }
5464 
5465      /* Get colordepth */
5466      colorth = SiS_GetColorDepth(SiS_Pr,CRT2ModeNo,modeidindex) >> 1;
5467      if(!colorth) colorth++;
5468 
5469      data = data * VCLK * colorth;
5470      temp = data % (MCLK << 4);
5471      data = data / (MCLK << 4);
5472      if(temp) data++;
5473 
5474      if(data < 6) data = 6;
5475      else if(data > 0x14) data = 0x14;
5476 
5477      if(SiS_Pr->ChipType == SIS_300) {
5478         temp = 0x16;
5479         if((data <= 0x0f) || (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024))
5480            temp = 0x13;
5481      } else {
5482         temp = 0x16;
5483         if(( (SiS_Pr->ChipType == SIS_630) ||
5484              (SiS_Pr->ChipType == SIS_730) )  &&
5485            (SiS_Pr->ChipRevision >= 0x30))
5486            temp = 0x1b;
5487      }
5488      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x01,0xe0,temp);
5489 
5490      if((SiS_Pr->ChipType == SIS_630) &&
5491         (SiS_Pr->ChipRevision >= 0x30)) {
5492         if(data > 0x13) data = 0x13;
5493      }
5494      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x02,0xe0,data);
5495 
5496   } else {  /* If mode <= 0x13, we just restore everything */
5497 
5498      SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
5499      SiS_Pr->SiS_SelectCRT2Rate = SelectRate_backup;
5500 
5501   }
5502 }
5503 #endif
5504 
5505 /* Set CRT2 FIFO on 315/330 series */
5506 #ifdef CONFIG_FB_SIS_315
5507 static void
5508 SiS_SetCRT2FIFO_310(struct SiS_Private *SiS_Pr)
5509 {
5510   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,0x3B);
5511   if( (SiS_Pr->ChipType == SIS_760)      &&
5512       (SiS_Pr->SiS_SysFlags & SF_760LFB)  &&
5513       (SiS_Pr->SiS_ModeType == Mode32Bpp) &&
5514       (SiS_Pr->SiS_VGAHDE >= 1280)        &&
5515       (SiS_Pr->SiS_VGAVDE >= 1024) ) {
5516      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2f,0x03);
5517      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,0x3b);
5518      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x4d,0xc0);
5519      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2f,0x01);
5520      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x4d,0xc0);
5521      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x02,0x6e);
5522   } else {
5523      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x02,~0x3f,0x04);
5524   }
5525 
5526 }
5527 #endif
5528 
5529 static unsigned short
5530 SiS_GetVGAHT2(struct SiS_Private *SiS_Pr)
5531 {
5532   unsigned int tempax,tempbx;
5533 
5534   tempbx = (SiS_Pr->SiS_VGAVT - SiS_Pr->SiS_VGAVDE) * SiS_Pr->SiS_RVBHCMAX;
5535   tempax = (SiS_Pr->SiS_VT - SiS_Pr->SiS_VDE) * SiS_Pr->SiS_RVBHCFACT;
5536   tempax = (tempax * SiS_Pr->SiS_HT) / tempbx;
5537   return (unsigned short)tempax;
5538 }
5539 
5540 /* Set Part 1 / SiS bridge slave mode */
5541 static void
5542 SiS_SetGroup1_301(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex,
5543                   unsigned short RefreshRateTableIndex)
5544 {
5545   unsigned short temp, modeflag, i, j, xres=0, VGAVDE;
5546   static const unsigned short CRTranslation[] = {
5547        /* CR0   CR1   CR2   CR3   CR4   CR5   CR6   CR7   */
5548           0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a,
5549        /* CR8   CR9   SR0A  SR0B  SR0C  SR0D  SR0E  CR0F  */
5550           0x00, 0x0b, 0x17, 0x18, 0x19, 0x00, 0x1a, 0x00,
5551        /* CR10  CR11  CR12  CR13  CR14  CR15  CR16  CR17  */
5552           0x0c, 0x0d, 0x0e, 0x00, 0x0f, 0x10, 0x11, 0x00
5553   };
5554 
5555   if(ModeNo <= 0x13) {
5556      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
5557   } else if(SiS_Pr->UseCustomMode) {
5558      modeflag = SiS_Pr->CModeFlag;
5559      xres = SiS_Pr->CHDisplay;
5560   } else {
5561      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
5562      xres = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].XRes;
5563   }
5564 
5565   /* The following is only done if bridge is in slave mode: */
5566 
5567   if(SiS_Pr->ChipType >= SIS_315H) {
5568      if(xres >= 1600) {  /* BIOS: == 1600 */
5569         SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x31,0x04);
5570      }
5571   }
5572 
5573   SiS_Pr->CHTotal = 8224;  /* Max HT, 0x2020, results in 0x3ff in registers */
5574 
5575   SiS_Pr->CHDisplay = SiS_Pr->SiS_VGAHDE;
5576   if(modeflag & HalfDCLK) SiS_Pr->CHDisplay >>= 1;
5577 
5578   SiS_Pr->CHBlankStart = SiS_Pr->CHDisplay;
5579   if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
5580      SiS_Pr->CHBlankStart += 16;
5581   }
5582 
5583   SiS_Pr->CHBlankEnd = 32;
5584   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
5585      if(xres == 1600) SiS_Pr->CHBlankEnd += 80;
5586   }
5587 
5588   temp = SiS_Pr->SiS_VGAHT - 96;
5589   if(!(modeflag & HalfDCLK)) temp -= 32;
5590   if(SiS_Pr->SiS_LCDInfo & LCDPass11) {
5591      temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x04);
5592      temp |= ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x0b) & 0xc0) << 2);
5593      temp -= 3;
5594      temp <<= 3;
5595   } else {
5596      if(SiS_Pr->SiS_RVBHRS2) temp = SiS_Pr->SiS_RVBHRS2;
5597   }
5598   SiS_Pr->CHSyncStart = temp;
5599 
5600   SiS_Pr->CHSyncEnd = 0xffe8;   /* results in 0x2000 in registers */
5601 
5602   SiS_Pr->CVTotal = 2049;       /* Max VT, 0x0801, results in 0x7ff in registers */
5603 
5604   VGAVDE = SiS_Pr->SiS_VGAVDE;
5605   if     (VGAVDE ==  357) VGAVDE =  350;
5606   else if(VGAVDE ==  360) VGAVDE =  350;
5607   else if(VGAVDE ==  375) VGAVDE =  350;
5608   else if(VGAVDE ==  405) VGAVDE =  400;
5609   else if(VGAVDE ==  420) VGAVDE =  400;
5610   else if(VGAVDE ==  525) VGAVDE =  480;
5611   else if(VGAVDE == 1056) VGAVDE = 1024;
5612   SiS_Pr->CVDisplay = VGAVDE;
5613 
5614   SiS_Pr->CVBlankStart = SiS_Pr->CVDisplay;
5615 
5616   SiS_Pr->CVBlankEnd = 1;
5617   if(ModeNo == 0x3c) SiS_Pr->CVBlankEnd = 226;
5618 
5619   temp = (SiS_Pr->SiS_VGAVT - VGAVDE) >> 1;
5620   SiS_Pr->CVSyncStart = VGAVDE + temp;
5621 
5622   temp >>= 3;
5623   SiS_Pr->CVSyncEnd = SiS_Pr->CVSyncStart + temp;
5624 
5625   SiS_CalcCRRegisters(SiS_Pr, 0);
5626   SiS_Pr->CCRT1CRTC[16] &= ~0xE0;
5627 
5628   for(i = 0; i <= 7; i++) {
5629      SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[i]);
5630   }
5631   for(i = 0x10, j = 8; i <= 0x12; i++, j++) {
5632      SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[j]);
5633   }
5634   for(i = 0x15, j = 11; i <= 0x16; i++, j++) {
5635      SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[j]);
5636   }
5637   for(i = 0x0a, j = 13; i <= 0x0c; i++, j++) {
5638      SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[j]);
5639   }
5640 
5641   temp = SiS_Pr->CCRT1CRTC[16] & 0xE0;
5642   SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,CRTranslation[0x0E],0x1F,temp);
5643 
5644   temp = (SiS_Pr->CCRT1CRTC[16] & 0x01) << 5;
5645   if(modeflag & DoubleScanMode) temp |= 0x80;
5646   SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,CRTranslation[0x09],0x5F,temp);
5647 
5648   temp = 0;
5649   temp |= (SiS_GetReg(SiS_Pr->SiS_P3c4,0x01) & 0x01);
5650   if(modeflag & HalfDCLK) temp |= 0x08;
5651   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,temp);                  /* SR01: HalfDCLK[3], 8/9 div dotclock[0] */
5652 
5653   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0F,0x00);                  /* CR14: (text mode: underline location) */
5654   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x12,0x00);                  /* CR17: n/a */
5655 
5656   temp = 0;
5657   if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) {
5658      temp = (SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x01) << 7;
5659   }
5660   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1A,temp);                  /* SR0E, dither[7] */
5661 
5662   temp = SiS_GetRegByte((SiS_Pr->SiS_P3ca+0x02));
5663   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,temp);                  /* ? */
5664 }
5665 
5666 /* Setup panel link
5667  * This is used for LVDS, LCDA and Chrontel TV output
5668  * 300/LVDS+TV, 300/301B-DH, 315/LVDS+TV, 315/LCDA
5669  */
5670 static void
5671 SiS_SetGroup1_LVDS(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
5672                 unsigned short RefreshRateTableIndex)
5673 {
5674   unsigned short modeflag, resinfo = 0;
5675   unsigned short push2, tempax, tempbx, tempcx, temp;
5676   unsigned int   tempeax = 0, tempebx, tempecx, tempvcfact = 0;
5677   bool islvds = false, issis  = false, chkdclkfirst = false;
5678 #ifdef CONFIG_FB_SIS_300
5679   unsigned short crt2crtc = 0;
5680 #endif
5681 #ifdef CONFIG_FB_SIS_315
5682   unsigned short pushcx;
5683 #endif
5684 
5685   if(ModeNo <= 0x13) {
5686      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
5687      resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo;
5688 #ifdef CONFIG_FB_SIS_300
5689      crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
5690 #endif
5691   } else if(SiS_Pr->UseCustomMode) {
5692      modeflag = SiS_Pr->CModeFlag;
5693   } else {
5694      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
5695      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
5696 #ifdef CONFIG_FB_SIS_300
5697      crt2crtc = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
5698 #endif
5699   }
5700 
5701   /* is lvds if really LVDS, or 301B-DH with external LVDS transmitter */
5702   if((SiS_Pr->SiS_IF_DEF_LVDS == 1) || (SiS_Pr->SiS_VBType & VB_NoLCD)) {
5703      islvds = true;
5704   }
5705 
5706   /* is really sis if sis bridge, but not 301B-DH */
5707   if((SiS_Pr->SiS_VBType & VB_SISVB) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) {
5708      issis = true;
5709   }
5710 
5711   if((SiS_Pr->ChipType >= SIS_315H) && (islvds) && (!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA))) {
5712      if((!SiS_Pr->SiS_IF_DEF_FSTN) && (!SiS_Pr->SiS_IF_DEF_DSTN)) {
5713         chkdclkfirst = true;
5714      }
5715   }
5716 
5717 #ifdef CONFIG_FB_SIS_315
5718   if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
5719      if(IS_SIS330) {
5720         SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x10);
5721      } else if(IS_SIS740) {
5722         if(islvds) {
5723            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xfb,0x04);
5724            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x03);
5725         } else if(SiS_Pr->SiS_VBType & VB_SISVB) {
5726            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x10);
5727         }
5728      } else {
5729         if(islvds) {
5730            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xfb,0x04);
5731            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x00);
5732         } else if(SiS_Pr->SiS_VBType & VB_SISVB) {
5733            SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2D,0x0f);
5734            if(SiS_Pr->SiS_VBType & VB_SIS30xC) {
5735               if((SiS_Pr->SiS_LCDResInfo == Panel_1024x768) ||
5736                  (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)) {
5737                  SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x20);
5738               }
5739            }
5740         }
5741      }
5742   }
5743 #endif
5744 
5745   /* Horizontal */
5746 
5747   tempax = SiS_Pr->SiS_LCDHDES;
5748   if(islvds) {
5749      if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5750         if(!SiS_Pr->SiS_IF_DEF_FSTN && !SiS_Pr->SiS_IF_DEF_DSTN) {
5751            if((SiS_Pr->SiS_LCDResInfo == Panel_640x480) &&
5752               (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode))) {
5753               tempax -= 8;
5754            }
5755         }
5756      }
5757   }
5758 
5759   temp = (tempax & 0x0007);
5760   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1A,temp);                  /* BPLHDESKEW[2:0]   */
5761   temp = (tempax >> 3) & 0x00FF;
5762   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,temp);                  /* BPLHDESKEW[10:3]  */
5763 
5764   tempbx = SiS_Pr->SiS_HDE;
5765   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5766      if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
5767         tempbx = SiS_Pr->PanelXRes;
5768      }
5769      if((SiS_Pr->SiS_LCDResInfo == Panel_320x240_1) ||
5770         (SiS_Pr->SiS_LCDResInfo == Panel_320x240_2) ||
5771         (SiS_Pr->SiS_LCDResInfo == Panel_320x240_3)) {
5772         tempbx >>= 1;
5773      }
5774   }
5775 
5776   tempax += tempbx;
5777   if(tempax >= SiS_Pr->SiS_HT) tempax -= SiS_Pr->SiS_HT;
5778 
5779   temp = tempax;
5780   if(temp & 0x07) temp += 8;
5781   temp >>= 3;
5782   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x17,temp);                  /* BPLHDEE  */
5783 
5784   tempcx = (SiS_Pr->SiS_HT - tempbx) >> 2;
5785 
5786   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5787      if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
5788         if(SiS_Pr->PanelHRS != 999) tempcx = SiS_Pr->PanelHRS;
5789      }
5790   }
5791 
5792   tempcx += tempax;
5793   if(tempcx >= SiS_Pr->SiS_HT) tempcx -= SiS_Pr->SiS_HT;
5794 
5795   temp = (tempcx >> 3) & 0x00FF;
5796   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5797      if(SiS_Pr->SiS_IF_DEF_TRUMPION) {
5798         if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
5799            switch(ModeNo) {
5800            case 0x04:
5801            case 0x05:
5802            case 0x0d: temp = 0x56; break;
5803            case 0x10: temp = 0x60; break;
5804            case 0x13: temp = 0x5f; break;
5805            case 0x40:
5806            case 0x41:
5807            case 0x4f:
5808            case 0x43:
5809            case 0x44:
5810            case 0x62:
5811            case 0x56:
5812            case 0x53:
5813            case 0x5d:
5814            case 0x5e: temp = 0x54; break;
5815            }
5816         }
5817      }
5818   }
5819   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,temp);                  /* BPLHRS */
5820 
5821   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5822      temp += 2;
5823      if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
5824         temp += 8;
5825         if(SiS_Pr->PanelHRE != 999) {
5826            temp = tempcx + SiS_Pr->PanelHRE;
5827            if(temp >= SiS_Pr->SiS_HT) temp -= SiS_Pr->SiS_HT;
5828            temp >>= 3;
5829         }
5830      }
5831   } else {
5832      temp += 10;
5833   }
5834 
5835   temp &= 0x1F;
5836   temp |= ((tempcx & 0x07) << 5);
5837   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x15,temp);                  /* BPLHRE */
5838 
5839   /* Vertical */
5840 
5841   tempax = SiS_Pr->SiS_VGAVDE;
5842   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5843      if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
5844         tempax = SiS_Pr->PanelYRes;
5845      }
5846   }
5847 
5848   tempbx = SiS_Pr->SiS_LCDVDES + tempax;
5849   if(tempbx >= SiS_Pr->SiS_VT) tempbx -= SiS_Pr->SiS_VT;
5850 
5851   push2 = tempbx;
5852 
5853   tempcx = SiS_Pr->SiS_VGAVT - SiS_Pr->SiS_VGAVDE;
5854   if(SiS_Pr->ChipType < SIS_315H) {
5855      if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5856         if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
5857            tempcx = SiS_Pr->SiS_VGAVT - SiS_Pr->PanelYRes;
5858         }
5859      }
5860   }
5861   if(islvds) tempcx >>= 1;
5862   else       tempcx >>= 2;
5863 
5864   if( (SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) &&
5865       (!(SiS_Pr->SiS_LCDInfo & LCDPass11))                  &&
5866       (SiS_Pr->PanelVRS != 999) ) {
5867      tempcx = SiS_Pr->PanelVRS;
5868      tempbx += tempcx;
5869      if(issis) tempbx++;
5870   } else {
5871      tempbx += tempcx;
5872      if(SiS_Pr->ChipType < SIS_315H) tempbx++;
5873      else if(issis)                   tempbx++;
5874   }
5875 
5876   if(tempbx >= SiS_Pr->SiS_VT) tempbx -= SiS_Pr->SiS_VT;
5877 
5878   temp = tempbx & 0x00FF;
5879   if(SiS_Pr->SiS_IF_DEF_TRUMPION) {
5880      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
5881         if(ModeNo == 0x10) temp = 0xa9;
5882      }
5883   }
5884   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,temp);                  /* BPLVRS */
5885 
5886   tempcx >>= 3;
5887   tempcx++;
5888 
5889   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5890      if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
5891         if(SiS_Pr->PanelVRE != 999) tempcx = SiS_Pr->PanelVRE;
5892      }
5893   }
5894 
5895   tempcx += tempbx;
5896   temp = tempcx & 0x000F;
5897   SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0xF0,temp);        /* BPLVRE  */
5898 
5899   temp = ((tempbx >> 8) & 0x07) << 3;
5900   if(SiS_Pr->SiS_IF_DEF_FSTN || SiS_Pr->SiS_IF_DEF_DSTN) {
5901      if(SiS_Pr->SiS_HDE != 640) {
5902         if(SiS_Pr->SiS_VGAVDE != SiS_Pr->SiS_VDE)  temp |= 0x40;
5903      }
5904   } else if(SiS_Pr->SiS_VGAVDE != SiS_Pr->SiS_VDE) temp |= 0x40;
5905   if(SiS_Pr->SiS_SetFlag & EnableLVDSDDA)          temp |= 0x40;
5906   tempbx = 0x87;
5907   if((SiS_Pr->ChipType >= SIS_315H) ||
5908      (SiS_Pr->ChipRevision >= 0x30)) {
5909      tempbx = 0x07;
5910      if((SiS_Pr->SiS_IF_DEF_CH70xx == 1) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) {
5911         if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x03)    temp |= 0x80;
5912      }
5913      /* Chrontel 701x operates in 24bit mode (8-8-8, 2x12bit multiplexed) via VGA2 */
5914      if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) {
5915         if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
5916            if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x06) & 0x10)      temp |= 0x80;
5917         } else {
5918            if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x01) temp |= 0x80;
5919         }
5920      }
5921   }
5922   SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x1A,tempbx,temp);
5923 
5924   tempbx = push2;                                               /* BPLVDEE */
5925 
5926   tempcx = SiS_Pr->SiS_LCDVDES;                                 /* BPLVDES */
5927 
5928   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
5929      switch(SiS_Pr->SiS_LCDResInfo) {
5930      case Panel_640x480:
5931         tempbx = SiS_Pr->SiS_VGAVDE - 1;
5932         tempcx = SiS_Pr->SiS_VGAVDE;
5933         break;
5934      case Panel_800x600:
5935         if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
5936            if(resinfo == SIS_RI_800x600) tempcx++;
5937         }
5938         break;
5939      case Panel_1024x600:
5940         if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
5941            if(resinfo == SIS_RI_1024x600) tempcx++;
5942            if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
5943               if(resinfo == SIS_RI_800x600) tempcx++;
5944            }
5945         }
5946         break;
5947      case Panel_1024x768:
5948         if(SiS_Pr->ChipType < SIS_315H) {
5949            if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
5950               if(resinfo == SIS_RI_1024x768) tempcx++;
5951            }
5952         }
5953         break;
5954      }
5955   }
5956 
5957   temp = ((tempbx >> 8) & 0x07) << 3;
5958   temp |= ((tempcx >> 8) & 0x07);
5959   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1D,temp);
5960   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1C,tempbx);
5961   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1B,tempcx);
5962 
5963   /* Vertical scaling */
5964 
5965   if(SiS_Pr->ChipType < SIS_315H) {
5966 
5967 #ifdef CONFIG_FB_SIS_300      /* 300 series */
5968      tempeax = SiS_Pr->SiS_VGAVDE << 6;
5969      temp = (tempeax % (unsigned int)SiS_Pr->SiS_VDE);
5970      tempeax = tempeax / (unsigned int)SiS_Pr->SiS_VDE;
5971      if(temp) tempeax++;
5972 
5973      if(SiS_Pr->SiS_SetFlag & EnableLVDSDDA) tempeax = 0x3F;
5974 
5975      temp = (unsigned short)(tempeax & 0x00FF);
5976      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1E,temp);       /* BPLVCFACT */
5977      tempvcfact = temp;
5978 #endif /* CONFIG_FB_SIS_300 */
5979 
5980   } else {
5981 
5982 #ifdef CONFIG_FB_SIS_315  /* 315 series */
5983      tempeax = SiS_Pr->SiS_VGAVDE << 18;
5984      tempebx = SiS_Pr->SiS_VDE;
5985      temp = (tempeax % tempebx);
5986      tempeax = tempeax / tempebx;
5987      if(temp) tempeax++;
5988      tempvcfact = tempeax;
5989 
5990      temp = (unsigned short)(tempeax & 0x00FF);
5991      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x37,temp);
5992      temp = (unsigned short)((tempeax & 0x00FF00) >> 8);
5993      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x36,temp);
5994      temp = (unsigned short)((tempeax & 0x00030000) >> 16);
5995      if(SiS_Pr->SiS_VDE == SiS_Pr->SiS_VGAVDE) temp |= 0x04;
5996      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x35,temp);
5997 
5998      if(SiS_Pr->SiS_VBType & VB_SISPART4SCALER) {
5999         temp = (unsigned short)(tempeax & 0x00FF);
6000         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x3c,temp);
6001         temp = (unsigned short)((tempeax & 0x00FF00) >> 8);
6002         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x3b,temp);
6003         temp = (unsigned short)(((tempeax & 0x00030000) >> 16) << 6);
6004         SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x3a,0x3f,temp);
6005         temp = 0;
6006         if(SiS_Pr->SiS_VDE != SiS_Pr->SiS_VGAVDE) temp |= 0x08;
6007         SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x30,0xf3,temp);
6008      }
6009 #endif
6010 
6011   }
6012 
6013   /* Horizontal scaling */
6014 
6015   tempeax = SiS_Pr->SiS_VGAHDE;         /* 1f = ( (VGAHDE * 65536) / ( (VGAHDE * 65536) / HDE ) ) - 1*/
6016   if(chkdclkfirst) {
6017      if(modeflag & HalfDCLK) tempeax >>= 1;
6018   }
6019   tempebx = tempeax << 16;
6020   if(SiS_Pr->SiS_HDE == tempeax) {
6021      tempecx = 0xFFFF;
6022   } else {
6023      tempecx = tempebx / SiS_Pr->SiS_HDE;
6024      if(SiS_Pr->ChipType >= SIS_315H) {
6025         if(tempebx % SiS_Pr->SiS_HDE) tempecx++;
6026      }
6027   }
6028 
6029   if(SiS_Pr->ChipType >= SIS_315H) {
6030      tempeax = (tempebx / tempecx) - 1;
6031   } else {
6032      tempeax = ((SiS_Pr->SiS_VGAHT << 16) / tempecx) - 1;
6033   }
6034   tempecx = (tempecx << 16) | (tempeax & 0xFFFF);
6035   temp = (unsigned short)(tempecx & 0x00FF);
6036   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1F,temp);
6037 
6038   if(SiS_Pr->ChipType >= SIS_315H) {
6039      tempeax = (SiS_Pr->SiS_VGAVDE << 18) / tempvcfact;
6040      tempbx = (unsigned short)(tempeax & 0xFFFF);
6041   } else {
6042      tempeax = SiS_Pr->SiS_VGAVDE << 6;
6043      tempbx = tempvcfact & 0x3f;
6044      if(tempbx == 0) tempbx = 64;
6045      tempeax /= tempbx;
6046      tempbx = (unsigned short)(tempeax & 0xFFFF);
6047   }
6048   if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) tempbx--;
6049   if(SiS_Pr->SiS_SetFlag & EnableLVDSDDA) {
6050      if((!SiS_Pr->SiS_IF_DEF_FSTN) && (!SiS_Pr->SiS_IF_DEF_DSTN)) tempbx = 1;
6051      else if(SiS_Pr->SiS_LCDResInfo != Panel_640x480)             tempbx = 1;
6052   }
6053 
6054   temp = ((tempbx >> 8) & 0x07) << 3;
6055   temp = temp | ((tempecx >> 8) & 0x07);
6056   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x20,temp);
6057   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x21,tempbx);
6058 
6059   tempecx >>= 16;                                               /* BPLHCFACT  */
6060   if(!chkdclkfirst) {
6061      if(modeflag & HalfDCLK) tempecx >>= 1;
6062   }
6063   temp = (unsigned short)((tempecx & 0xFF00) >> 8);
6064   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x22,temp);
6065   temp = (unsigned short)(tempecx & 0x00FF);
6066   SiS_SetReg(SiS_Pr->SiS_Part1Port,0x23,temp);
6067 
6068 #ifdef CONFIG_FB_SIS_315
6069   if(SiS_Pr->ChipType >= SIS_315H) {
6070      if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
6071         if((islvds) || (SiS_Pr->SiS_VBInfo & VB_SISLVDS)) {
6072            SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1e,0x20);
6073         }
6074      } else {
6075         if(islvds) {
6076            if(SiS_Pr->ChipType == SIS_740) {
6077               SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x03);
6078            } else {
6079               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1e,0x23);
6080            }
6081         }
6082      }
6083   }
6084 #endif
6085 
6086 #ifdef CONFIG_FB_SIS_300
6087   if(SiS_Pr->SiS_IF_DEF_TRUMPION) {
6088      unsigned char *ROMAddr = SiS_Pr->VirtualRomBase;
6089      unsigned char *trumpdata;
6090      int   i, j = crt2crtc;
6091      unsigned char TrumpMode13[4]   = { 0x01, 0x10, 0x2c, 0x00 };
6092      unsigned char TrumpMode10_1[4] = { 0x01, 0x10, 0x27, 0x00 };
6093      unsigned char TrumpMode10_2[4] = { 0x01, 0x16, 0x10, 0x00 };
6094 
6095      if(SiS_Pr->SiS_UseROM) {
6096         trumpdata = &ROMAddr[0x8001 + (j * 80)];
6097      } else {
6098         if(SiS_Pr->SiS_LCDTypeInfo == 0x0e) j += 7;
6099         trumpdata = &SiS300_TrumpionData[j][0];
6100      }
6101 
6102      SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0xbf);
6103      for(i=0; i<5; i++) {
6104         SiS_SetTrumpionBlock(SiS_Pr, trumpdata);
6105      }
6106      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
6107         if(ModeNo == 0x13) {
6108            for(i=0; i<4; i++) {
6109               SiS_SetTrumpionBlock(SiS_Pr, &TrumpMode13[0]);
6110            }
6111         } else if(ModeNo == 0x10) {
6112            for(i=0; i<4; i++) {
6113               SiS_SetTrumpionBlock(SiS_Pr, &TrumpMode10_1[0]);
6114               SiS_SetTrumpionBlock(SiS_Pr, &TrumpMode10_2[0]);
6115            }
6116         }
6117      }
6118      SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40);
6119   }
6120 #endif
6121 
6122 #ifdef CONFIG_FB_SIS_315
6123   if(SiS_Pr->SiS_IF_DEF_FSTN || SiS_Pr->SiS_IF_DEF_DSTN) {
6124      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x25,0x00);
6125      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x26,0x00);
6126      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x27,0x00);
6127      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x28,0x87);
6128      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x29,0x5A);
6129      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2A,0x4B);
6130      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x44,~0x07,0x03);
6131      tempax = SiS_Pr->SiS_HDE;                                  /* Blps = lcdhdee(lcdhdes+HDE) + 64 */
6132      if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 ||
6133         SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 ||
6134         SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1;
6135      tempax += 64;
6136      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x38,tempax & 0xff);
6137      temp = (tempax >> 8) << 3;
6138      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,~0x078,temp);
6139      tempax += 32;                                              /* Blpe = lBlps+32 */
6140      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x39,tempax & 0xff);
6141      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3A,0x00);               /* Bflml = 0 */
6142      SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x3C,~0x007);
6143 
6144      tempax = SiS_Pr->SiS_VDE;
6145      if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 ||
6146         SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 ||
6147         SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1;
6148      tempax >>= 1;
6149      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3B,tempax & 0xff);
6150      temp = (tempax >> 8) << 3;
6151      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x3C,~0x038,temp);
6152 
6153      tempeax = SiS_Pr->SiS_HDE;
6154      if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 ||
6155         SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 ||
6156         SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempeax >>= 1;
6157      tempeax <<= 2;                                             /* BDxFIFOSTOP = (HDE*4)/128 */
6158      temp = tempeax & 0x7f;
6159      tempeax >>= 7;
6160      if(temp) tempeax++;
6161      temp = tempeax & 0x3f;
6162      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x45,temp);
6163      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3F,0x00);               /* BDxWadrst0 */
6164      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3E,0x00);
6165      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3D,0x10);
6166      SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x3C,~0x040);
6167 
6168      tempax = SiS_Pr->SiS_HDE;
6169      if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 ||
6170         SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 ||
6171         SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1;
6172      tempax >>= 4;                                              /* BDxWadroff = HDE*4/8/8 */
6173      pushcx = tempax;
6174      temp = tempax & 0x00FF;
6175      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x43,temp);
6176      temp = ((tempax & 0xFF00) >> 8) << 3;
6177      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port, 0x44, 0x07, temp);
6178 
6179      tempax = SiS_Pr->SiS_VDE;                                  /* BDxWadrst1 = BDxWadrst0 + BDxWadroff * VDE */
6180      if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 ||
6181         SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 ||
6182         SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1;
6183      tempeax = tempax * pushcx;
6184      temp = tempeax & 0xFF;
6185      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x42,temp);
6186      temp = (tempeax & 0xFF00) >> 8;
6187      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x41,temp);
6188      temp = ((tempeax & 0xFF0000) >> 16) | 0x10;
6189      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x40,temp);
6190      temp = ((tempeax & 0x01000000) >> 24) << 7;
6191      SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port, 0x3C, 0x7F, temp);
6192 
6193      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2F,0x03);
6194      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x03,0x50);
6195      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x04,0x00);
6196      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2F,0x01);
6197      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0x38);
6198 
6199      if(SiS_Pr->SiS_IF_DEF_FSTN) {
6200         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2b,0x02);
6201         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2c,0x00);
6202         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2d,0x00);
6203         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x35,0x0c);
6204         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x36,0x00);
6205         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x37,0x00);
6206         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x38,0x80);
6207         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x39,0xA0);
6208         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3a,0x00);
6209         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3b,0xf0);
6210         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3c,0x00);
6211         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3d,0x10);
6212         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3e,0x00);
6213         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3f,0x00);
6214         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x40,0x10);
6215         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x41,0x25);
6216         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x42,0x80);
6217         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x43,0x14);
6218         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x44,0x03);
6219         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x45,0x0a);
6220      }
6221   }
6222 #endif  /* CONFIG_FB_SIS_315 */
6223 }
6224 
6225 /* Set Part 1 */
6226 static void
6227 SiS_SetGroup1(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
6228                 unsigned short RefreshRateTableIndex)
6229 {
6230 #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315)
6231   unsigned char   *ROMAddr = SiS_Pr->VirtualRomBase;
6232 #endif
6233   unsigned short  temp=0, tempax=0, tempbx=0, tempcx=0, bridgeadd=0;
6234   unsigned short  pushbx=0, CRT1Index=0, modeflag, resinfo=0;
6235 #ifdef CONFIG_FB_SIS_315
6236   unsigned short  tempbl=0;
6237 #endif
6238 
6239   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
6240      SiS_SetGroup1_LVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
6241      return;
6242   }
6243 
6244   if(ModeNo <= 0x13) {
6245      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
6246   } else if(SiS_Pr->UseCustomMode) {
6247      modeflag = SiS_Pr->CModeFlag;
6248   } else {
6249      CRT1Index = SiS_GetRefCRT1CRTC(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWideCRT2);
6250      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
6251      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
6252   }
6253 
6254   SiS_SetCRT2Offset(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
6255 
6256   if( ! ((SiS_Pr->ChipType >= SIS_315H) &&
6257          (SiS_Pr->SiS_IF_DEF_LVDS == 1) &&
6258          (SiS_Pr->SiS_VBInfo & SetInSlaveMode)) ) {
6259 
6260      if(SiS_Pr->ChipType < SIS_315H ) {
6261 #ifdef CONFIG_FB_SIS_300
6262         SiS_SetCRT2FIFO_300(SiS_Pr, ModeNo);
6263 #endif
6264      } else {
6265 #ifdef CONFIG_FB_SIS_315
6266         SiS_SetCRT2FIFO_310(SiS_Pr);
6267 #endif
6268      }
6269 
6270      /* 1. Horizontal setup */
6271 
6272      if(SiS_Pr->ChipType < SIS_315H ) {
6273 
6274 #ifdef CONFIG_FB_SIS_300   /* ------------- 300 series --------------*/
6275 
6276         temp = (SiS_Pr->SiS_VGAHT - 1) & 0x0FF;                   /* BTVGA2HT 0x08,0x09 */
6277         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x08,temp);              /* CRT2 Horizontal Total */
6278 
6279         temp = (((SiS_Pr->SiS_VGAHT - 1) & 0xFF00) >> 8) << 4;
6280         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x09,0x0f,temp);    /* CRT2 Horizontal Total Overflow [7:4] */
6281 
6282         temp = (SiS_Pr->SiS_VGAHDE + 12) & 0x0FF;                 /* BTVGA2HDEE 0x0A,0x0C */
6283         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0A,temp);              /* CRT2 Horizontal Display Enable End */
6284 
6285         pushbx = SiS_Pr->SiS_VGAHDE + 12;                         /* bx  BTVGA2HRS 0x0B,0x0C */
6286         tempcx = (SiS_Pr->SiS_VGAHT - SiS_Pr->SiS_VGAHDE) >> 2;
6287         tempbx = pushbx + tempcx;
6288         tempcx <<= 1;
6289         tempcx += tempbx;
6290 
6291         bridgeadd = 12;
6292 
6293 #endif /* CONFIG_FB_SIS_300 */
6294 
6295      } else {
6296 
6297 #ifdef CONFIG_FB_SIS_315  /* ------------------- 315/330 series --------------- */
6298 
6299         tempcx = SiS_Pr->SiS_VGAHT;                               /* BTVGA2HT 0x08,0x09 */
6300         if(modeflag & HalfDCLK) {
6301            if(SiS_Pr->SiS_VBType & VB_SISVB) {
6302               tempcx >>= 1;
6303            } else {
6304               tempax = SiS_Pr->SiS_VGAHDE >> 1;
6305               tempcx = SiS_Pr->SiS_HT - SiS_Pr->SiS_HDE + tempax;
6306               if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
6307                  tempcx = SiS_Pr->SiS_HT - tempax;
6308               }
6309            }
6310         }
6311         tempcx--;
6312         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x08,tempcx);            /* CRT2 Horizontal Total */
6313         temp = (tempcx >> 4) & 0xF0;
6314         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x09,0x0F,temp);    /* CRT2 Horizontal Total Overflow [7:4] */
6315 
6316         tempcx = SiS_Pr->SiS_VGAHT;                               /* BTVGA2HDEE 0x0A,0x0C */
6317         tempbx = SiS_Pr->SiS_VGAHDE;
6318         tempcx -= tempbx;
6319         tempcx >>= 2;
6320         if(modeflag & HalfDCLK) {
6321            tempbx >>= 1;
6322            tempcx >>= 1;
6323         }
6324         tempbx += 16;
6325 
6326         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0A,tempbx);            /* CRT2 Horizontal Display Enable End */
6327 
6328         pushbx = tempbx;
6329         tempcx >>= 1;
6330         tempbx += tempcx;
6331         tempcx += tempbx;
6332 
6333         bridgeadd = 16;
6334 
6335         if(SiS_Pr->SiS_VBType & VB_SISVB) {
6336            if(SiS_Pr->ChipType >= SIS_661) {
6337               if((SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) ||
6338                  (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)) {
6339                  if(resinfo == SIS_RI_1280x1024) {
6340                     tempcx = (tempcx & 0xff00) | 0x30;
6341                  } else if(resinfo == SIS_RI_1600x1200) {
6342                     tempcx = (tempcx & 0xff00) | 0xff;
6343                  }
6344               }
6345            }
6346         }
6347 
6348 #endif  /* CONFIG_FB_SIS_315 */
6349 
6350      }  /* 315/330 series */
6351 
6352      if(SiS_Pr->SiS_VBType & VB_SISVB) {
6353 
6354         if(SiS_Pr->UseCustomMode) {
6355            tempbx = SiS_Pr->CHSyncStart + bridgeadd;
6356            tempcx = SiS_Pr->CHSyncEnd + bridgeadd;
6357            tempax = SiS_Pr->SiS_VGAHT;
6358            if(modeflag & HalfDCLK) tempax >>= 1;
6359            tempax--;
6360            if(tempcx > tempax) tempcx = tempax;
6361         }
6362 
6363         if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) {
6364            unsigned char cr4, cr14, cr5, cr15;
6365            if(SiS_Pr->UseCustomMode) {
6366               cr4  = SiS_Pr->CCRT1CRTC[4];
6367               cr14 = SiS_Pr->CCRT1CRTC[14];
6368               cr5  = SiS_Pr->CCRT1CRTC[5];
6369               cr15 = SiS_Pr->CCRT1CRTC[15];
6370            } else {
6371               cr4  = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[4];
6372               cr14 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[14];
6373               cr5  = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[5];
6374               cr15 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[15];
6375            }
6376            tempbx = ((cr4 | ((cr14 & 0xC0) << 2)) - 3) << 3;                /* (VGAHRS-3)*8 */
6377            tempcx = (((cr5 & 0x1f) | ((cr15 & 0x04) << (5-2))) - 3) << 3;   /* (VGAHRE-3)*8 */
6378            tempcx &= 0x00FF;
6379            tempcx |= (tempbx & 0xFF00);
6380            tempbx += bridgeadd;
6381            tempcx += bridgeadd;
6382            tempax = SiS_Pr->SiS_VGAHT;
6383            if(modeflag & HalfDCLK) tempax >>= 1;
6384            tempax--;
6385            if(tempcx > tempax) tempcx = tempax;
6386         }
6387 
6388         if(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSet525p1024)) {
6389            tempbx = 1040;
6390            tempcx = 1044;   /* HWCursor bug! */
6391         }
6392 
6393      }
6394 
6395      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0B,tempbx);               /* CRT2 Horizontal Retrace Start */
6396 
6397      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0D,tempcx);               /* CRT2 Horizontal Retrace End */
6398 
6399      temp = ((tempbx >> 8) & 0x0F) | ((pushbx >> 4) & 0xF0);
6400      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0C,temp);                 /* Overflow */
6401 
6402      /* 2. Vertical setup */
6403 
6404      tempcx = SiS_Pr->SiS_VGAVT - 1;
6405      temp = tempcx & 0x00FF;
6406 
6407      if(SiS_Pr->ChipType < SIS_661) {
6408         if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
6409            if(SiS_Pr->ChipType < SIS_315H) {
6410               if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
6411                  if(SiS_Pr->SiS_VBInfo & (SetCRT2ToSVIDEO | SetCRT2ToAVIDEO)) {
6412                     temp--;
6413                  }
6414               }
6415            } else {
6416               temp--;
6417            }
6418         } else if(SiS_Pr->ChipType >= SIS_315H) {
6419            temp--;
6420         }
6421      }
6422      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0E,temp);                 /* CRT2 Vertical Total */
6423 
6424      tempbx = SiS_Pr->SiS_VGAVDE - 1;
6425      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0F,tempbx);               /* CRT2 Vertical Display Enable End */
6426 
6427      temp = ((tempbx >> 5) & 0x38) | ((tempcx >> 8) & 0x07);
6428      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x12,temp);                 /* Overflow */
6429 
6430      if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->ChipType < SIS_661)) {
6431         tempbx++;
6432         tempax = tempbx;
6433         tempcx++;
6434         tempcx -= tempax;
6435         tempcx >>= 2;
6436         tempbx += tempcx;
6437         if(tempcx < 4) tempcx = 4;
6438         tempcx >>= 2;
6439         tempcx += tempbx;
6440         tempcx++;
6441      } else {
6442         tempbx = (SiS_Pr->SiS_VGAVT + SiS_Pr->SiS_VGAVDE) >> 1;                 /*  BTVGA2VRS     0x10,0x11   */
6443         tempcx = ((SiS_Pr->SiS_VGAVT - SiS_Pr->SiS_VGAVDE) >> 4) + tempbx + 1;  /*  BTVGA2VRE     0x11        */
6444      }
6445 
6446      if(SiS_Pr->SiS_VBType & VB_SISVB) {
6447         if(SiS_Pr->UseCustomMode) {
6448            tempbx = SiS_Pr->CVSyncStart;
6449            tempcx = SiS_Pr->CVSyncEnd;
6450         }
6451         if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) {
6452            unsigned char cr8, cr7, cr13;
6453            if(SiS_Pr->UseCustomMode) {
6454               cr8    = SiS_Pr->CCRT1CRTC[8];
6455               cr7    = SiS_Pr->CCRT1CRTC[7];
6456               cr13   = SiS_Pr->CCRT1CRTC[13];
6457               tempcx = SiS_Pr->CCRT1CRTC[9];
6458            } else {
6459               cr8    = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[8];
6460               cr7    = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[7];
6461               cr13   = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[13];
6462               tempcx = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[9];
6463            }
6464            tempbx = cr8;
6465            if(cr7  & 0x04) tempbx |= 0x0100;
6466            if(cr7  & 0x80) tempbx |= 0x0200;
6467            if(cr13 & 0x08) tempbx |= 0x0400;
6468         }
6469      }
6470      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x10,tempbx);               /* CRT2 Vertical Retrace Start */
6471 
6472      temp = ((tempbx >> 4) & 0x70) | (tempcx & 0x0F);
6473      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x11,temp);                 /* CRT2 Vert. Retrace End; Overflow */
6474 
6475      /* 3. Panel delay compensation */
6476 
6477      if(SiS_Pr->ChipType < SIS_315H) {
6478 
6479 #ifdef CONFIG_FB_SIS_300  /* ---------- 300 series -------------- */
6480 
6481         if(SiS_Pr->SiS_VBType & VB_SISVB) {
6482            temp = 0x20;
6483            if(SiS_Pr->ChipType == SIS_300) {
6484               temp = 0x10;
6485               if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768)  temp = 0x2c;
6486               if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) temp = 0x20;
6487            }
6488            if(SiS_Pr->SiS_VBType & VB_SIS301) {
6489               if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) temp = 0x20;
6490            }
6491            if(SiS_Pr->SiS_LCDResInfo == Panel_1280x960)     temp = 0x24;
6492            if(SiS_Pr->SiS_LCDResInfo == Panel_Custom)       temp = 0x2c;
6493            if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)             temp = 0x08;
6494            if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
6495               if(SiS_Pr->SiS_VBInfo & SetInSlaveMode)       temp = 0x2c;
6496               else                                          temp = 0x20;
6497            }
6498            if(SiS_Pr->SiS_UseROM) {
6499               if(ROMAddr[0x220] & 0x80) {
6500                  if(SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoYPbPrHiVision)
6501                     temp = ROMAddr[0x221];
6502                  else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision)
6503                     temp = ROMAddr[0x222];
6504                  else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)
6505                     temp = ROMAddr[0x223];
6506                  else
6507                     temp = ROMAddr[0x224];
6508               }
6509            }
6510            if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
6511               if(SiS_Pr->PDC != -1)  temp = SiS_Pr->PDC;
6512            }
6513 
6514         } else {
6515            temp = 0x20;
6516            if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) {
6517               if(SiS_Pr->SiS_LCDResInfo == Panel_640x480) temp = 0x04;
6518            }
6519            if(SiS_Pr->SiS_UseROM) {
6520               if(ROMAddr[0x220] & 0x80) {
6521                  temp = ROMAddr[0x220];
6522               }
6523            }
6524            if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
6525               if(SiS_Pr->PDC != -1) temp = SiS_Pr->PDC;
6526            }
6527         }
6528 
6529         temp &= 0x3c;
6530 
6531         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,~0x3C,temp);   /* Panel Link Delay Compensation; (Software Command Reset; Power Saving) */
6532 
6533 #endif  /* CONFIG_FB_SIS_300 */
6534 
6535      } else {
6536 
6537 #ifdef CONFIG_FB_SIS_315   /* --------------- 315/330 series ---------------*/
6538 
6539         if(SiS_Pr->ChipType < SIS_661) {
6540 
6541            if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
6542 
6543               if(SiS_Pr->ChipType == SIS_740) temp = 0x03;
6544               else                            temp = 0x00;
6545 
6546               if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) temp = 0x0a;
6547               tempbl = 0xF0;
6548               if(SiS_Pr->ChipType == SIS_650) {
6549                  if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
6550                     if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) tempbl = 0x0F;
6551                  }
6552               }
6553 
6554               if(SiS_Pr->SiS_IF_DEF_DSTN || SiS_Pr->SiS_IF_DEF_FSTN) {
6555                  temp = 0x08;
6556                  tempbl = 0;
6557                  if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) {
6558                     if(ROMAddr[0x13c] & 0x80) tempbl = 0xf0;
6559                  }
6560               }
6561 
6562               SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,tempbl,temp);      /* Panel Link Delay Compensation */
6563            }
6564 
6565         } /* < 661 */
6566 
6567         tempax = 0;
6568         if(modeflag & DoubleScanMode) tempax |= 0x80;
6569         if(modeflag & HalfDCLK)       tempax |= 0x40;
6570         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2C,0x3f,tempax);
6571 
6572 #endif  /* CONFIG_FB_SIS_315 */
6573 
6574      }
6575 
6576   }  /* Slavemode */
6577 
6578   if(SiS_Pr->SiS_VBType & VB_SISVB) {
6579      if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) {
6580         /* For 301BDH with LCD, we set up the Panel Link */
6581         SiS_SetGroup1_LVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
6582      } else if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
6583         SiS_SetGroup1_301(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
6584      }
6585   } else {
6586      if(SiS_Pr->ChipType < SIS_315H) {
6587         SiS_SetGroup1_LVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
6588      } else {
6589         if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
6590            if((!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) || (SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
6591               SiS_SetGroup1_LVDS(SiS_Pr, ModeNo,ModeIdIndex,RefreshRateTableIndex);
6592            }
6593         } else {
6594            SiS_SetGroup1_LVDS(SiS_Pr, ModeNo,ModeIdIndex,RefreshRateTableIndex);
6595         }
6596      }
6597   }
6598 }
6599 
6600 /*********************************************/
6601 /*         SET PART 2 REGISTER GROUP         */
6602 /*********************************************/
6603 
6604 #ifdef CONFIG_FB_SIS_315
6605 static unsigned char *
6606 SiS_GetGroup2CLVXPtr(struct SiS_Private *SiS_Pr, int tabletype)
6607 {
6608    const unsigned char *tableptr = NULL;
6609    unsigned short      a, b, p = 0;
6610 
6611    a = SiS_Pr->SiS_VGAHDE;
6612    b = SiS_Pr->SiS_HDE;
6613    if(tabletype) {
6614       a = SiS_Pr->SiS_VGAVDE;
6615       b = SiS_Pr->SiS_VDE;
6616    }
6617 
6618    if(a < b) {
6619       tableptr = SiS_Part2CLVX_1;
6620    } else if(a == b) {
6621       tableptr = SiS_Part2CLVX_2;
6622    } else {
6623       if(SiS_Pr->SiS_TVMode & TVSetPAL) {
6624          tableptr = SiS_Part2CLVX_4;
6625       } else {
6626          tableptr = SiS_Part2CLVX_3;
6627       }
6628       if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
6629          if(SiS_Pr->SiS_TVMode & TVSetYPbPr525i)        tableptr = SiS_Part2CLVX_3;
6630          else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p)   tableptr = SiS_Part2CLVX_3;
6631          else                                           tableptr = SiS_Part2CLVX_5;
6632       } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
6633          tableptr = SiS_Part2CLVX_6;
6634       }
6635       do {
6636          if((tableptr[p] | tableptr[p+1] << 8) == a) break;
6637          p += 0x42;
6638       } while((tableptr[p] | tableptr[p+1] << 8) != 0xffff);
6639       if((tableptr[p] | tableptr[p+1] << 8) == 0xffff) p -= 0x42;
6640    }
6641    p += 2;
6642    return ((unsigned char *)&tableptr[p]);
6643 }
6644 
6645 static void
6646 SiS_SetGroup2_C_ELV(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
6647                     unsigned short RefreshRateTableIndex)
6648 {
6649    unsigned char *tableptr;
6650    unsigned char temp;
6651    int i, j;
6652 
6653    if(!(SiS_Pr->SiS_VBType & VB_SISTAP4SCALER)) return;
6654 
6655    tableptr = SiS_GetGroup2CLVXPtr(SiS_Pr, 0);
6656    for(i = 0x80, j = 0; i <= 0xbf; i++, j++) {
6657       SiS_SetReg(SiS_Pr->SiS_Part2Port, i, tableptr[j]);
6658    }
6659    if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
6660       tableptr = SiS_GetGroup2CLVXPtr(SiS_Pr, 1);
6661       for(i = 0xc0, j = 0; i <= 0xff; i++, j++) {
6662          SiS_SetReg(SiS_Pr->SiS_Part2Port, i, tableptr[j]);
6663       }
6664    }
6665    temp = 0x10;
6666    if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) temp |= 0x04;
6667    SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x4e,0xeb,temp);
6668 }
6669 
6670 static bool
6671 SiS_GetCRT2Part2Ptr(struct SiS_Private *SiS_Pr,unsigned short ModeNo,unsigned short ModeIdIndex,
6672                     unsigned short RefreshRateTableIndex,unsigned short *CRT2Index,
6673                     unsigned short *ResIndex)
6674 {
6675 
6676   if(SiS_Pr->ChipType < SIS_315H) return false;
6677 
6678   if(ModeNo <= 0x13)
6679      (*ResIndex) = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
6680   else
6681      (*ResIndex) = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
6682 
6683   (*ResIndex) &= 0x3f;
6684   (*CRT2Index) = 0;
6685 
6686   if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
6687      if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) {
6688         (*CRT2Index) = 200;
6689      }
6690   }
6691 
6692   if(SiS_Pr->SiS_CustomT == CUT_ASUSA2H_2) {
6693      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
6694         if(SiS_Pr->SiS_SetFlag & LCDVESATiming) (*CRT2Index) = 206;
6695      }
6696   }
6697   return (((*CRT2Index) != 0));
6698 }
6699 #endif
6700 
6701 #ifdef CONFIG_FB_SIS_300
6702 static void
6703 SiS_Group2LCDSpecial(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short crt2crtc)
6704 {
6705    unsigned short tempcx;
6706    static const unsigned char atable[] = {
6707        0xc3,0x9e,0xc3,0x9e,0x02,0x02,0x02,
6708        0xab,0x87,0xab,0x9e,0xe7,0x02,0x02
6709    };
6710 
6711    if(!SiS_Pr->UseCustomMode) {
6712       if( ( ( (SiS_Pr->ChipType == SIS_630) ||
6713               (SiS_Pr->ChipType == SIS_730) ) &&
6714             (SiS_Pr->ChipRevision > 2) )  &&
6715           (SiS_Pr->SiS_LCDResInfo == Panel_1024x768) &&
6716           (!(SiS_Pr->SiS_SetFlag & LCDVESATiming))  &&
6717           (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) ) {
6718          if(ModeNo == 0x13) {
6719             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,0xB9);
6720             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x05,0xCC);
6721             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,0xA6);
6722          } else if((crt2crtc & 0x3F) == 4) {
6723             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x2B);
6724             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x13);
6725             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,0xE5);
6726             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x05,0x08);
6727             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,0xE2);
6728          }
6729       }
6730 
6731       if(SiS_Pr->ChipType < SIS_315H) {
6732          if(SiS_Pr->SiS_LCDTypeInfo == 0x0c) {
6733             crt2crtc &= 0x1f;
6734             tempcx = 0;
6735             if(!(SiS_Pr->SiS_VBInfo & SetNotSimuMode)) {
6736                if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
6737                   tempcx += 7;
6738                }
6739             }
6740             tempcx += crt2crtc;
6741             if(crt2crtc >= 4) {
6742                SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,0xff);
6743             }
6744 
6745             if(!(SiS_Pr->SiS_VBInfo & SetNotSimuMode)) {
6746                if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
6747                   if(crt2crtc == 4) {
6748                      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x28);
6749                   }
6750                }
6751             }
6752             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x18);
6753             SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,atable[tempcx]);
6754          }
6755       }
6756    }
6757 }
6758 
6759 /* For ECS A907. Highly preliminary. */
6760 static void
6761 SiS_Set300Part2Regs(struct SiS_Private *SiS_Pr, unsigned short ModeIdIndex, unsigned short RefreshRateTableIndex,
6762                     unsigned short ModeNo)
6763 {
6764   const struct SiS_Part2PortTbl *CRT2Part2Ptr = NULL;
6765   unsigned short crt2crtc, resindex;
6766   int i, j;
6767 
6768   if(SiS_Pr->ChipType != SIS_300) return;
6769   if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) return;
6770   if(SiS_Pr->UseCustomMode) return;
6771 
6772   if(ModeNo <= 0x13) {
6773      crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
6774   } else {
6775      crt2crtc = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
6776   }
6777 
6778   resindex = crt2crtc & 0x3F;
6779   if(SiS_Pr->SiS_SetFlag & LCDVESATiming) CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_1;
6780   else                                    CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_2;
6781 
6782   /* The BIOS code (1.16.51,56) is obviously a fragment! */
6783   if(ModeNo > 0x13) {
6784      CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_1;
6785      resindex = 4;
6786   }
6787 
6788   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x01,0x80,(CRT2Part2Ptr+resindex)->CR[0]);
6789   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x02,0x80,(CRT2Part2Ptr+resindex)->CR[1]);
6790   for(i = 2, j = 0x04; j <= 0x06; i++, j++ ) {
6791      SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]);
6792   }
6793   for(j = 0x1c; j <= 0x1d; i++, j++ ) {
6794      SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]);
6795   }
6796   for(j = 0x1f; j <= 0x21; i++, j++ ) {
6797      SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]);
6798   }
6799   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x23,(CRT2Part2Ptr+resindex)->CR[10]);
6800   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0x0f,(CRT2Part2Ptr+resindex)->CR[11]);
6801 }
6802 #endif
6803 
6804 static void
6805 SiS_SetTVSpecial(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
6806 {
6807   if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) return;
6808   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoHiVision)) return;
6809   if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p)) return;
6810 
6811   if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) {
6812      if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) {
6813         static const unsigned char specialtv[] = {
6814                 0xa7,0x07,0xf2,0x6e,0x17,0x8b,0x73,0x53,
6815                 0x13,0x40,0x34,0xf4,0x63,0xbb,0xcc,0x7a,
6816                 0x58,0xe4,0x73,0xda,0x13
6817         };
6818         int i, j;
6819         for(i = 0x1c, j = 0; i <= 0x30; i++, j++) {
6820            SiS_SetReg(SiS_Pr->SiS_Part2Port,i,specialtv[j]);
6821         }
6822         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x43,0x72);
6823         if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750)) {
6824            if(SiS_Pr->SiS_TVMode & TVSetPALM) {
6825               SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x14);
6826               SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x1b);
6827            } else {
6828               SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x14);  /* 15 */
6829               SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x1a);  /* 1b */
6830            }
6831         }
6832      }
6833   } else {
6834      if((ModeNo == 0x38) || (ModeNo == 0x4a) || (ModeNo == 0x64) ||
6835         (ModeNo == 0x52) || (ModeNo == 0x58) || (ModeNo == 0x5c)) {
6836         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x1b);  /* 21 */
6837         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x54);  /* 5a */
6838      } else {
6839         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x1a);  /* 21 */
6840         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x53);  /* 5a */
6841      }
6842   }
6843 }
6844 
6845 static void
6846 SiS_SetGroup2_Tail(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
6847 {
6848   unsigned short temp;
6849 
6850   if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) {
6851      if(SiS_Pr->SiS_VGAVDE == 525) {
6852         temp = 0xc3;
6853         if(SiS_Pr->SiS_ModeType <= ModeVGA) {
6854            temp++;
6855            if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) temp += 2;
6856         }
6857         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2f,temp);
6858         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x30,0xb3);
6859      } else if(SiS_Pr->SiS_VGAVDE == 420) {
6860         temp = 0x4d;
6861         if(SiS_Pr->SiS_ModeType <= ModeVGA) {
6862            temp++;
6863            if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) temp++;
6864         }
6865         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2f,temp);
6866      }
6867   }
6868 
6869   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
6870      if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) {
6871         if(SiS_Pr->SiS_VBType & VB_SIS30xB) {
6872            SiS_SetRegOR(SiS_Pr->SiS_Part2Port,0x1a,0x03);
6873            /* Not always for LV, see SetGrp2 */
6874         }
6875         temp = 1;
6876         if(ModeNo <= 0x13) temp = 3;
6877         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x0b,temp);
6878      }
6879 #if 0
6880      /* 651+301C, for 1280x768 - do I really need that? */
6881      if((SiS_Pr->SiS_PanelXRes == 1280) && (SiS_Pr->SiS_PanelYRes == 768)) {
6882         if(SiS_Pr->SiS_VBInfo & SetSimuScanMode) {
6883            if(((SiS_Pr->SiS_HDE == 640) && (SiS_Pr->SiS_VDE == 480)) ||
6884               ((SiS_Pr->SiS_HDE == 320) && (SiS_Pr->SiS_VDE == 240))) {
6885               SiS_SetReg(SiS_Part2Port,0x01,0x2b);
6886               SiS_SetReg(SiS_Part2Port,0x02,0x13);
6887               SiS_SetReg(SiS_Part2Port,0x04,0xe5);
6888               SiS_SetReg(SiS_Part2Port,0x05,0x08);
6889               SiS_SetReg(SiS_Part2Port,0x06,0xe2);
6890               SiS_SetReg(SiS_Part2Port,0x1c,0x21);
6891               SiS_SetReg(SiS_Part2Port,0x1d,0x45);
6892               SiS_SetReg(SiS_Part2Port,0x1f,0x0b);
6893               SiS_SetReg(SiS_Part2Port,0x20,0x00);
6894               SiS_SetReg(SiS_Part2Port,0x21,0xa9);
6895               SiS_SetReg(SiS_Part2Port,0x23,0x0b);
6896               SiS_SetReg(SiS_Part2Port,0x25,0x04);
6897            }
6898         }
6899      }
6900 #endif
6901   }
6902 }
6903 
6904 static void
6905 SiS_SetGroup2(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
6906                 unsigned short RefreshRateTableIndex)
6907 {
6908   unsigned short i, j, tempax, tempbx, tempcx, tempch, tempcl, temp;
6909   unsigned short push2, modeflag, crt2crtc, bridgeoffset;
6910   unsigned int   longtemp, PhaseIndex;
6911   bool           newtvphase;
6912   const unsigned char *TimingPoint;
6913 #ifdef CONFIG_FB_SIS_315
6914   unsigned short resindex, CRT2Index;
6915   const struct SiS_Part2PortTbl *CRT2Part2Ptr = NULL;
6916 
6917   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) return;
6918 #endif
6919 
6920   if(ModeNo <= 0x13) {
6921      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
6922      crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
6923   } else if(SiS_Pr->UseCustomMode) {
6924      modeflag = SiS_Pr->CModeFlag;
6925      crt2crtc = 0;
6926   } else {
6927      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
6928      crt2crtc = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
6929   }
6930 
6931   temp = 0;
6932   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToAVIDEO)) temp |= 0x08;
6933   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToSVIDEO)) temp |= 0x04;
6934   if(SiS_Pr->SiS_VBInfo & SetCRT2ToSCART)     temp |= 0x02;
6935   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision)  temp |= 0x01;
6936 
6937   if(!(SiS_Pr->SiS_TVMode & TVSetPAL))        temp |= 0x10;
6938 
6939   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x00,temp);
6940 
6941   PhaseIndex  = 0x01; /* SiS_PALPhase */
6942   TimingPoint = SiS_Pr->SiS_PALTiming;
6943 
6944   newtvphase = false;
6945   if( (SiS_Pr->SiS_VBType & VB_SIS30xBLV) &&
6946       ( (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) ||
6947         (SiS_Pr->SiS_TVMode & TVSetTVSimuMode) ) ) {
6948      newtvphase = true;
6949   }
6950 
6951   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
6952 
6953      TimingPoint = SiS_Pr->SiS_HiTVExtTiming;
6954      if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
6955         TimingPoint = SiS_Pr->SiS_HiTVSt2Timing;
6956         if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) {
6957            TimingPoint = SiS_Pr->SiS_HiTVSt1Timing;
6958         }
6959      }
6960 
6961   } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
6962 
6963      i = 0;
6964      if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p)      i = 2;
6965      else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) i = 1;
6966 
6967      TimingPoint = &SiS_YPbPrTable[i][0];
6968 
6969      PhaseIndex = 0x00; /* SiS_NTSCPhase */
6970 
6971   } else if(SiS_Pr->SiS_TVMode & TVSetPAL) {
6972 
6973      if(newtvphase) PhaseIndex = 0x09; /* SiS_PALPhase2 */
6974 
6975   } else {
6976 
6977      TimingPoint = SiS_Pr->SiS_NTSCTiming;
6978      PhaseIndex  = (SiS_Pr->SiS_TVMode & TVSetNTSCJ) ? 0x01 : 0x00;     /* SiS_PALPhase : SiS_NTSCPhase */
6979      if(newtvphase) PhaseIndex += 8;                                    /* SiS_PALPhase2 : SiS_NTSCPhase2 */
6980 
6981   }
6982 
6983   if(SiS_Pr->SiS_TVMode & (TVSetPALM | TVSetPALN)) {
6984      PhaseIndex = (SiS_Pr->SiS_TVMode & TVSetPALM) ? 0x02 : 0x03;       /* SiS_PALMPhase : SiS_PALNPhase */
6985      if(newtvphase) PhaseIndex += 8;                                    /* SiS_PALMPhase2 : SiS_PALNPhase2 */
6986   }
6987 
6988   if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) {
6989      if(SiS_Pr->SiS_TVMode & TVSetPALM) {
6990         PhaseIndex = 0x05; /* SiS_SpecialPhaseM */
6991      } else if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) {
6992         PhaseIndex = 0x11; /* SiS_SpecialPhaseJ */
6993      } else {
6994         PhaseIndex = 0x10; /* SiS_SpecialPhase */
6995      }
6996   }
6997 
6998   for(i = 0x31, j = 0; i <= 0x34; i++, j++) {
6999      SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS_TVPhase[(PhaseIndex * 4) + j]);
7000   }
7001 
7002   for(i = 0x01, j = 0; i <= 0x2D; i++, j++) {
7003      SiS_SetReg(SiS_Pr->SiS_Part2Port,i,TimingPoint[j]);
7004   }
7005   for(i = 0x39; i <= 0x45; i++, j++) {
7006      SiS_SetReg(SiS_Pr->SiS_Part2Port,i,TimingPoint[j]);
7007   }
7008 
7009   if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
7010      if(SiS_Pr->SiS_ModeType != ModeText) {
7011         SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x3A,0x1F);
7012      }
7013   }
7014 
7015   SiS_SetRegOR(SiS_Pr->SiS_Part2Port,0x0A,SiS_Pr->SiS_NewFlickerMode);
7016 
7017   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x35,SiS_Pr->SiS_RY1COE);
7018   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x36,SiS_Pr->SiS_RY2COE);
7019   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x37,SiS_Pr->SiS_RY3COE);
7020   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x38,SiS_Pr->SiS_RY4COE);
7021 
7022   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision)    tempax = 950;
7023   else if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p)  tempax = 680;
7024   else if(SiS_Pr->SiS_TVMode & TVSetPAL)        tempax = 520;
7025   else                                          tempax = 440; /* NTSC, YPbPr 525 */
7026 
7027   if( ((SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) && (SiS_Pr->SiS_VDE <= tempax)) ||
7028       ( (SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoHiVision) &&
7029         ((SiS_Pr->SiS_VGAHDE == 1024) || (SiS_Pr->SiS_VDE <= tempax)) ) ) {
7030 
7031      tempax -= SiS_Pr->SiS_VDE;
7032      tempax >>= 1;
7033      if(!(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p))) {
7034         tempax >>= 1;
7035      }
7036      tempax &= 0x00ff;
7037 
7038      temp = tempax + (unsigned short)TimingPoint[0];
7039      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,temp);
7040 
7041      temp = tempax + (unsigned short)TimingPoint[1];
7042      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,temp);
7043 
7044      if((SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoYPbPrHiVision) && (SiS_Pr->SiS_VGAHDE >= 1024)) {
7045         if(SiS_Pr->SiS_TVMode & TVSetPAL) {
7046            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x1b);
7047            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x54);
7048         } else {
7049            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x17);
7050            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x1d);
7051         }
7052      }
7053 
7054   }
7055 
7056   tempcx = SiS_Pr->SiS_HT;
7057   if(SiS_IsDualLink(SiS_Pr)) tempcx >>= 1;
7058   tempcx--;
7059   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) tempcx--;
7060   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1B,tempcx);
7061   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1D,0xF0,((tempcx >> 8) & 0x0f));
7062 
7063   tempcx = SiS_Pr->SiS_HT >> 1;
7064   if(SiS_IsDualLink(SiS_Pr)) tempcx >>= 1;
7065   tempcx += 7;
7066   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) tempcx -= 4;
7067   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x22,0x0F,((tempcx << 4) & 0xf0));
7068 
7069   tempbx = TimingPoint[j] | (TimingPoint[j+1] << 8);
7070   tempbx += tempcx;
7071   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x24,tempbx);
7072   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0x0F,((tempbx >> 4) & 0xf0));
7073 
7074   tempbx += 8;
7075   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
7076      tempbx -= 4;
7077      tempcx = tempbx;
7078   }
7079   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x29,0x0F,((tempbx << 4) & 0xf0));
7080 
7081   j += 2;
7082   tempcx += (TimingPoint[j] | (TimingPoint[j+1] << 8));
7083   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x27,tempcx);
7084   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x28,0x0F,((tempcx >> 4) & 0xf0));
7085 
7086   tempcx += 8;
7087   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) tempcx -= 4;
7088   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2A,0x0F,((tempcx << 4) & 0xf0));
7089 
7090   tempcx = SiS_Pr->SiS_HT >> 1;
7091   if(SiS_IsDualLink(SiS_Pr)) tempcx >>= 1;
7092   j += 2;
7093   tempcx -= (TimingPoint[j] | ((TimingPoint[j+1]) << 8));
7094   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2D,0x0F,((tempcx << 4) & 0xf0));
7095 
7096   tempcx -= 11;
7097   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) {
7098      tempcx = SiS_GetVGAHT2(SiS_Pr) - 1;
7099   }
7100   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2E,tempcx);
7101 
7102   tempbx = SiS_Pr->SiS_VDE;
7103   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
7104      if(SiS_Pr->SiS_VGAVDE == 360) tempbx = 746;
7105      if(SiS_Pr->SiS_VGAVDE == 375) tempbx = 746;
7106      if(SiS_Pr->SiS_VGAVDE == 405) tempbx = 853;
7107   } else if( (SiS_Pr->SiS_VBInfo & SetCRT2ToTV) &&
7108              (!(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p|TVSetYPbPr750p))) ) {
7109      tempbx >>= 1;
7110      if(SiS_Pr->ChipType >= SIS_315H) {
7111         if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) {
7112            if((ModeNo <= 0x13) && (crt2crtc == 1)) tempbx++;
7113         } else if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
7114            if(SiS_Pr->SiS_ModeType <= ModeVGA) {
7115               if(crt2crtc == 4) tempbx++;
7116            }
7117         }
7118      }
7119      if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
7120         if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
7121            if((ModeNo == 0x2f) || (ModeNo == 0x5d) || (ModeNo == 0x5e)) tempbx++;
7122         }
7123         if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) {
7124            if(ModeNo == 0x03) tempbx++; /* From 1.10.7w - doesn't make sense */
7125         }
7126      }
7127   }
7128   tempbx -= 2;
7129   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2F,tempbx);
7130 
7131   temp = (tempcx >> 8) & 0x0F;
7132   temp |= ((tempbx >> 2) & 0xC0);
7133   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToSVIDEO | SetCRT2ToAVIDEO)) {
7134      temp |= 0x10;
7135      if(SiS_Pr->SiS_VBInfo & SetCRT2ToAVIDEO) temp |= 0x20;
7136   }
7137   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x30,temp);
7138 
7139   if(SiS_Pr->SiS_VBType & VB_SISPART4OVERFLOW) {
7140      SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x10,0xdf,((tempbx & 0x0400) >> 5));
7141   }
7142 
7143   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
7144      tempbx = SiS_Pr->SiS_VDE;
7145      if( (SiS_Pr->SiS_VBInfo & SetCRT2ToTV) &&
7146          (!(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p))) ) {
7147         tempbx >>= 1;
7148      }
7149      tempbx -= 3;
7150      temp = ((tempbx >> 3) & 0x60) | 0x18;
7151      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x46,temp);
7152      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x47,tempbx);
7153 
7154      if(SiS_Pr->SiS_VBType & VB_SISPART4OVERFLOW) {
7155         SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x10,0xbf,((tempbx & 0x0400) >> 4));
7156      }
7157   }
7158 
7159   tempbx = 0;
7160   if(!(modeflag & HalfDCLK)) {
7161      if(SiS_Pr->SiS_VGAHDE >= SiS_Pr->SiS_HDE) {
7162         tempax = 0;
7163         tempbx |= 0x20;
7164      }
7165   }
7166 
7167   tempch = tempcl = 0x01;
7168   if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
7169      if(SiS_Pr->SiS_VGAHDE >= 960) {
7170         if((!(modeflag & HalfDCLK)) || (SiS_Pr->ChipType < SIS_315H)) {
7171            tempcl = 0x20;
7172            if(SiS_Pr->SiS_VGAHDE >= 1280) {
7173               tempch = 20;
7174               tempbx &= ~0x20;
7175            } else {
7176               tempch = 25; /* OK */
7177            }
7178         }
7179      }
7180   }
7181 
7182   if(!(tempbx & 0x20)) {
7183      if(modeflag & HalfDCLK) tempcl <<= 1;
7184      longtemp = ((SiS_Pr->SiS_VGAHDE * tempch) / tempcl) << 13;
7185      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) longtemp <<= 3;
7186      tempax = longtemp / SiS_Pr->SiS_HDE;
7187      if(longtemp % SiS_Pr->SiS_HDE) tempax++;
7188      tempbx |= ((tempax >> 8) & 0x1F);
7189      tempcx = tempax >> 13;
7190   }
7191 
7192   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x44,tempax);
7193   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x45,0xC0,tempbx);
7194 
7195   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
7196 
7197      tempcx &= 0x07;
7198      if(tempbx & 0x20) tempcx = 0;
7199      SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x46,0xF8,tempcx);
7200 
7201      if(SiS_Pr->SiS_TVMode & TVSetPAL) {
7202         tempbx = 0x0382;
7203         tempcx = 0x007e;
7204      } else {
7205         tempbx = 0x0369;
7206         tempcx = 0x0061;
7207      }
7208      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x4B,tempbx);
7209      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x4C,tempcx);
7210      temp = (tempcx & 0x0300) >> 6;
7211      temp |= ((tempbx >> 8) & 0x03);
7212      if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
7213         temp |= 0x10;
7214         if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p)      temp |= 0x20;
7215         else if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) temp |= 0x40;
7216      }
7217      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x4D,temp);
7218 
7219      temp = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x43);
7220      SiS_SetReg(SiS_Pr->SiS_Part2Port,0x43,(temp - 3));
7221 
7222      SiS_SetTVSpecial(SiS_Pr, ModeNo);
7223 
7224      if(SiS_Pr->SiS_VBType & VB_SIS30xCLV) {
7225         temp = 0;
7226         if(SiS_Pr->SiS_TVMode & TVSetPALM) temp = 8;
7227         SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x4e,0xf7,temp);
7228      }
7229 
7230   }
7231 
7232   if(SiS_Pr->SiS_TVMode & TVSetPALM) {
7233      if(!(SiS_Pr->SiS_TVMode & TVSetNTSC1024)) {
7234         temp = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x01);
7235         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,(temp - 1));
7236      }
7237      SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xEF);
7238   }
7239 
7240   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
7241      if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
7242         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x0B,0x00);
7243      }
7244   }
7245 
7246   if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) return;
7247 
7248   /* From here: Part2 LCD setup */
7249 
7250   tempbx = SiS_Pr->SiS_HDE;
7251   if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1;
7252   tempbx--;                                     /* RHACTE = HDE - 1 */
7253   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2C,tempbx);
7254   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2B,0x0F,((tempbx >> 4) & 0xf0));
7255 
7256   temp = 0x01;
7257   if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) {
7258      if(SiS_Pr->SiS_ModeType == ModeEGA) {
7259         if(SiS_Pr->SiS_VGAHDE >= 1024) {
7260            temp = 0x02;
7261            if(SiS_Pr->SiS_SetFlag & LCDVESATiming) {
7262               temp = 0x01;
7263            }
7264         }
7265      }
7266   }
7267   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x0B,temp);
7268 
7269   tempbx = SiS_Pr->SiS_VDE - 1;
7270   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x03,tempbx);
7271   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x0C,0xF8,((tempbx >> 8) & 0x07));
7272 
7273   tempcx = SiS_Pr->SiS_VT - 1;
7274   SiS_SetReg(SiS_Pr->SiS_Part2Port,0x19,tempcx);
7275   temp = (tempcx >> 3) & 0xE0;
7276   if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) {
7277      /* Enable dithering; only do this for 32bpp mode */
7278      if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x01) {
7279         temp |= 0x10;
7280      }
7281   }
7282   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1A,0x0f,temp);
7283 
7284   SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x09,0xF0);
7285   SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x0A,0xF0);
7286 
7287   SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x17,0xFB);
7288   SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x18,0xDF);
7289 
7290 #ifdef CONFIG_FB_SIS_315
7291   if(SiS_GetCRT2Part2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex,
7292                                                 &CRT2Index, &resindex)) {
7293       switch(CRT2Index) {
7294         case 206: CRT2Part2Ptr = SiS310_CRT2Part2_Asus1024x768_3;    break;
7295         default:
7296         case 200: CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_1;   break;
7297       }
7298 
7299       SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x01,0x80,(CRT2Part2Ptr+resindex)->CR[0]);
7300       SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x02,0x80,(CRT2Part2Ptr+resindex)->CR[1]);
7301       for(i = 2, j = 0x04; j <= 0x06; i++, j++ ) {
7302         SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]);
7303       }
7304       for(j = 0x1c; j <= 0x1d; i++, j++ ) {
7305         SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]);
7306       }
7307       for(j = 0x1f; j <= 0x21; i++, j++ ) {
7308         SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]);
7309       }
7310       SiS_SetReg(SiS_Pr->SiS_Part2Port,0x23,(CRT2Part2Ptr+resindex)->CR[10]);
7311       SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0x0f,(CRT2Part2Ptr+resindex)->CR[11]);
7312 
7313       SiS_SetGroup2_Tail(SiS_Pr, ModeNo);
7314 
7315   } else {
7316 #endif
7317 
7318     /* Checked for 1024x768, 1280x1024, 1400x1050, 1600x1200 */
7319     /*             Clevo dual-link 1024x768 */
7320     /*             Compaq 1280x1024 has HT 1696 sometimes (calculation OK, if given HT is correct)  */
7321     /*             Acer: OK, but uses different setting for VESA timing at 640/800/1024 and 640x400 */
7322 
7323     if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
7324        if((SiS_Pr->SiS_LCDInfo & LCDPass11) || (SiS_Pr->PanelYRes == SiS_Pr->SiS_VDE)) {
7325           tempbx = SiS_Pr->SiS_VDE - 1;
7326           tempcx = SiS_Pr->SiS_VT - 1;
7327        } else {
7328           tempbx = SiS_Pr->SiS_VDE + ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VDE) / 2);
7329           tempcx = SiS_Pr->SiS_VT - ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VDE) / 2);
7330        }
7331     } else {
7332        tempbx = SiS_Pr->PanelYRes;
7333        tempcx = SiS_Pr->SiS_VT;
7334        tempax = 1;
7335        if(SiS_Pr->PanelYRes != SiS_Pr->SiS_VDE) {
7336           tempax = SiS_Pr->PanelYRes;
7337           /* if(SiS_Pr->SiS_VGAVDE == 525) tempax += 0x3c;   */  /* 651+301C */
7338           if(SiS_Pr->PanelYRes < SiS_Pr->SiS_VDE) {
7339              tempax = tempcx = 0;
7340           } else {
7341              tempax -= SiS_Pr->SiS_VDE;
7342           }
7343           tempax >>= 1;
7344        }
7345        tempcx -= tempax; /* lcdvdes */
7346        tempbx -= tempax; /* lcdvdee */
7347     }
7348 
7349     /* Non-expanding: lcdvdes = tempcx = VT-1; lcdvdee = tempbx = VDE-1 */
7350 
7351     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x05,tempcx);      /* lcdvdes  */
7352     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,tempbx);      /* lcdvdee  */
7353 
7354     temp = (tempbx >> 5) & 0x38;
7355     temp |= ((tempcx >> 8) & 0x07);
7356     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,temp);
7357 
7358     tempax = SiS_Pr->SiS_VDE;
7359     if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) {
7360        tempax = SiS_Pr->PanelYRes;
7361     }
7362     tempcx = (SiS_Pr->SiS_VT - tempax) >> 4;
7363     if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) {
7364        if(SiS_Pr->PanelYRes != SiS_Pr->SiS_VDE) {
7365           tempcx = (SiS_Pr->SiS_VT - tempax) / 10;
7366        }
7367     }
7368 
7369     tempbx = ((SiS_Pr->SiS_VT + SiS_Pr->SiS_VDE) >> 1) - 1;
7370     if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
7371        if(SiS_Pr->PanelYRes != SiS_Pr->SiS_VDE) {
7372           if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { /* ? */
7373              tempax = SiS_Pr->SiS_VT - SiS_Pr->PanelYRes;
7374              if(tempax % 4) { tempax >>= 2; tempax++; }
7375              else           { tempax >>= 2;           }
7376              tempbx -= (tempax - 1);
7377           } else {
7378              tempbx -= 10;
7379              if(tempbx <= SiS_Pr->SiS_VDE) tempbx = SiS_Pr->SiS_VDE + 1;
7380           }
7381        }
7382     }
7383     if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
7384        tempbx++;
7385        if((!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) || (crt2crtc == 6)) {
7386           if(SiS_Pr->SiS_SetFlag & LCDVESATiming) {
7387              tempbx = 770;
7388              tempcx = 3;
7389           }
7390        }
7391     }
7392 
7393     /* non-expanding: lcdvrs = ((VT + VDE) / 2) - 10 */
7394 
7395     if(SiS_Pr->UseCustomMode) {
7396        tempbx = SiS_Pr->CVSyncStart;
7397     }
7398 
7399     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,tempbx);          /* lcdvrs */
7400 
7401     temp = (tempbx >> 4) & 0xF0;
7402     tempbx += (tempcx + 1);
7403     temp |= (tempbx & 0x0F);
7404 
7405     if(SiS_Pr->UseCustomMode) {
7406        temp &= 0xf0;
7407        temp |= (SiS_Pr->CVSyncEnd & 0x0f);
7408     }
7409 
7410     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,temp);
7411 
7412 #ifdef CONFIG_FB_SIS_300
7413     SiS_Group2LCDSpecial(SiS_Pr, ModeNo, crt2crtc);
7414 #endif
7415 
7416     bridgeoffset = 7;
7417     if(SiS_Pr->SiS_VBType & VB_SIS30xBLV)       bridgeoffset += 2;
7418     if(SiS_Pr->SiS_VBType & VB_SIS30xCLV)       bridgeoffset += 2; /* OK for Averatec 1280x800 (301C) */
7419     if(SiS_IsDualLink(SiS_Pr))                  bridgeoffset++;
7420     else if(SiS_Pr->SiS_VBType & VB_SIS302LV)   bridgeoffset++;    /* OK for Asus A4L 1280x800 */
7421     /* Higher bridgeoffset shifts to the LEFT */
7422 
7423     temp = 0;
7424     if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) {
7425        if(SiS_Pr->PanelXRes != SiS_Pr->SiS_HDE) {
7426           temp = SiS_Pr->SiS_HT - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_HDE) / 2);
7427           if(SiS_IsDualLink(SiS_Pr)) temp >>= 1;
7428        }
7429     }
7430     temp += bridgeoffset;
7431     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1F,temp);             /* lcdhdes */
7432     SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x20,0x0F,((temp >> 4) & 0xf0));
7433 
7434     tempcx = SiS_Pr->SiS_HT;
7435     tempax = tempbx = SiS_Pr->SiS_HDE;
7436     if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) {
7437        if(SiS_Pr->PanelXRes != SiS_Pr->SiS_HDE) {
7438           tempax = SiS_Pr->PanelXRes;
7439           tempbx = SiS_Pr->PanelXRes - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_HDE) / 2);
7440        }
7441     }
7442     if(SiS_IsDualLink(SiS_Pr)) {
7443        tempcx >>= 1;
7444        tempbx >>= 1;
7445        tempax >>= 1;
7446     }
7447 
7448     tempbx += bridgeoffset;
7449 
7450     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x23,tempbx);          /* lcdhdee */
7451     SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0xF0,((tempbx >> 8) & 0x0f));
7452 
7453     tempcx = (tempcx - tempax) >> 2;
7454 
7455     tempbx += tempcx;
7456     push2 = tempbx;
7457 
7458     if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) {
7459        if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) {
7460           if(SiS_Pr->SiS_LCDInfo & LCDPass11) {
7461              if(SiS_Pr->SiS_HDE == 1280) tempbx = (tempbx & 0xff00) | 0x47;
7462           }
7463        }
7464     }
7465 
7466     if(SiS_Pr->UseCustomMode) {
7467        tempbx = SiS_Pr->CHSyncStart;
7468        if(modeflag & HalfDCLK) tempbx <<= 1;
7469        if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1;
7470        tempbx += bridgeoffset;
7471     }
7472 
7473     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1C,tempbx);          /* lcdhrs */
7474     SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1D,0x0F,((tempbx >> 4) & 0xf0));
7475 
7476     tempbx = push2;
7477 
7478     tempcx <<= 1;
7479     if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) {
7480        if(SiS_Pr->PanelXRes != SiS_Pr->SiS_HDE) tempcx >>= 2;
7481     }
7482     tempbx += tempcx;
7483 
7484     if(SiS_Pr->UseCustomMode) {
7485        tempbx = SiS_Pr->CHSyncEnd;
7486        if(modeflag & HalfDCLK) tempbx <<= 1;
7487        if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1;
7488        tempbx += bridgeoffset;
7489     }
7490 
7491     SiS_SetReg(SiS_Pr->SiS_Part2Port,0x21,tempbx);          /* lcdhre */
7492 
7493     SiS_SetGroup2_Tail(SiS_Pr, ModeNo);
7494 
7495 #ifdef CONFIG_FB_SIS_300
7496     SiS_Set300Part2Regs(SiS_Pr, ModeIdIndex, RefreshRateTableIndex, ModeNo);
7497 #endif
7498 #ifdef CONFIG_FB_SIS_315
7499   } /* CRT2-LCD from table */
7500 #endif
7501 }
7502 
7503 /*********************************************/
7504 /*         SET PART 3 REGISTER GROUP         */
7505 /*********************************************/
7506 
7507 static void
7508 SiS_SetGroup3(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
7509 {
7510   unsigned short i;
7511   const unsigned char *tempdi;
7512 
7513   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) return;
7514 
7515 #ifndef SIS_CP
7516   SiS_SetReg(SiS_Pr->SiS_Part3Port,0x00,0x00);
7517 #else
7518   SIS_CP_INIT301_CP
7519 #endif
7520 
7521   if(SiS_Pr->SiS_TVMode & TVSetPAL) {
7522      SiS_SetReg(SiS_Pr->SiS_Part3Port,0x13,0xFA);
7523      SiS_SetReg(SiS_Pr->SiS_Part3Port,0x14,0xC8);
7524   } else {
7525      SiS_SetReg(SiS_Pr->SiS_Part3Port,0x13,0xF5);
7526      SiS_SetReg(SiS_Pr->SiS_Part3Port,0x14,0xB7);
7527   }
7528 
7529   if(SiS_Pr->SiS_TVMode & TVSetPALM) {
7530      SiS_SetReg(SiS_Pr->SiS_Part3Port,0x13,0xFA);
7531      SiS_SetReg(SiS_Pr->SiS_Part3Port,0x14,0xC8);
7532      SiS_SetReg(SiS_Pr->SiS_Part3Port,0x3D,0xA8);
7533   }
7534 
7535   tempdi = NULL;
7536   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
7537      tempdi = SiS_Pr->SiS_HiTVGroup3Data;
7538      if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) {
7539         tempdi = SiS_Pr->SiS_HiTVGroup3Simu;
7540      }
7541   } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) {
7542      if(!(SiS_Pr->SiS_TVMode & TVSetYPbPr525i)) {
7543         tempdi = SiS_HiTVGroup3_1;
7544         if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) tempdi = SiS_HiTVGroup3_2;
7545      }
7546   }
7547   if(tempdi) {
7548      for(i=0; i<=0x3E; i++) {
7549         SiS_SetReg(SiS_Pr->SiS_Part3Port,i,tempdi[i]);
7550      }
7551      if(SiS_Pr->SiS_VBType & VB_SIS30xCLV) {
7552         if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) {
7553            SiS_SetReg(SiS_Pr->SiS_Part3Port,0x28,0x3f);
7554         }
7555      }
7556   }
7557 
7558 #ifdef SIS_CP
7559   SIS_CP_INIT301_CP2
7560 #endif
7561 }
7562 
7563 /*********************************************/
7564 /*         SET PART 4 REGISTER GROUP         */
7565 /*********************************************/
7566 
7567 #ifdef CONFIG_FB_SIS_315
7568 #if 0
7569 static void
7570 SiS_ShiftXPos(struct SiS_Private *SiS_Pr, int shift)
7571 {
7572    unsigned short temp, temp1, temp2;
7573 
7574    temp1 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x1f);
7575    temp2 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x20);
7576    temp = (unsigned short)((int)((temp1 | ((temp2 & 0xf0) << 4))) + shift);
7577    SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1f,temp);
7578    SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x20,0x0f,((temp >> 4) & 0xf0));
7579    temp = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x2b) & 0x0f;
7580    temp = (unsigned short)((int)(temp) + shift);
7581    SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2b,0xf0,(temp & 0x0f));
7582    temp1 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x43);
7583    temp2 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x42);
7584    temp = (unsigned short)((int)((temp1 | ((temp2 & 0xf0) << 4))) + shift);
7585    SiS_SetReg(SiS_Pr->SiS_Part2Port,0x43,temp);
7586    SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x42,0x0f,((temp >> 4) & 0xf0));
7587 }
7588 #endif
7589 
7590 static void
7591 SiS_SetGroup4_C_ELV(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
7592 {
7593    unsigned short temp, temp1;
7594    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
7595 
7596    if(!(SiS_Pr->SiS_VBType & VB_SIS30xCLV)) return;
7597    if(!(SiS_Pr->SiS_VBInfo & (SetCRT2ToHiVision | SetCRT2ToYPbPr525750))) return;
7598 
7599    if(SiS_Pr->ChipType >= XGI_20) return;
7600 
7601    if((SiS_Pr->ChipType >= SIS_661) && (SiS_Pr->SiS_ROMNew)) {
7602       if(!(ROMAddr[0x61] & 0x04)) return;
7603    }
7604 
7605    SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x3a,0x08);
7606    temp = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x3a);
7607    if(!(temp & 0x01)) {
7608       SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x3a,0xdf);
7609       SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x25,0xfc);
7610       if((SiS_Pr->ChipType < SIS_661) && (!(SiS_Pr->SiS_ROMNew))) {
7611          SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x25,0xf8);
7612       }
7613       SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x0f,0xfb);
7614       if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p)      temp = 0x0000;
7615       else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) temp = 0x0002;
7616       else if(SiS_Pr->SiS_TVMode & TVSetHiVision)  temp = 0x0400;
7617       else                                         temp = 0x0402;
7618       if((SiS_Pr->ChipType >= SIS_661) || (SiS_Pr->SiS_ROMNew)) {
7619          temp1 = 0;
7620          if(SiS_Pr->SiS_TVMode & TVAspect43) temp1 = 4;
7621          SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0f,0xfb,temp1);
7622          if(SiS_Pr->SiS_TVMode & TVAspect43LB) temp |= 0x01;
7623          SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x26,0x7c,(temp & 0xff));
7624          SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x3a,0xfb,(temp >> 8));
7625          if(ModeNo > 0x13) {
7626             SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x39,0xfd);
7627          }
7628       } else {
7629          temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x3b) & 0x03;
7630          if(temp1 == 0x01) temp |= 0x01;
7631          if(temp1 == 0x03) temp |= 0x04;  /* ? why not 0x10? */
7632          SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x26,0xf8,(temp & 0xff));
7633          SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x3a,0xfb,(temp >> 8));
7634          if(ModeNo > 0x13) {
7635             SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x3b,0xfd);
7636          }
7637       }
7638 
7639 #if 0
7640       if(SiS_Pr->ChipType >= SIS_661) {                 /* ? */
7641          if(SiS_Pr->SiS_TVMode & TVAspect43) {
7642             if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) {
7643                if(resinfo == SIS_RI_1024x768) {
7644                   SiS_ShiftXPos(SiS_Pr, 97);
7645                } else {
7646                   SiS_ShiftXPos(SiS_Pr, 111);
7647                }
7648             } else if(SiS_Pr->SiS_TVMode & TVSetHiVision) {
7649                SiS_ShiftXPos(SiS_Pr, 136);
7650             }
7651          }
7652       }
7653 #endif
7654 
7655    }
7656 
7657 }
7658 #endif
7659 
7660 static void
7661 SiS_SetCRT2VCLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
7662                  unsigned short RefreshRateTableIndex)
7663 {
7664   unsigned short vclkindex, temp, reg1, reg2;
7665 
7666   if(SiS_Pr->UseCustomMode) {
7667      reg1 = SiS_Pr->CSR2B;
7668      reg2 = SiS_Pr->CSR2C;
7669   } else {
7670      vclkindex = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
7671      reg1 = SiS_Pr->SiS_VBVCLKData[vclkindex].Part4_A;
7672      reg2 = SiS_Pr->SiS_VBVCLKData[vclkindex].Part4_B;
7673   }
7674 
7675   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
7676      if(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSet525p1024)) {
7677         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,0x57);
7678         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0b,0x46);
7679         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1f,0xf6);
7680      } else {
7681         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,reg1);
7682         SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0b,reg2);
7683      }
7684   } else {
7685      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,0x01);
7686      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0b,reg2);
7687      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,reg1);
7688   }
7689   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x12,0x00);
7690   temp = 0x08;
7691   if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) temp |= 0x20;
7692   SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x12,temp);
7693 }
7694 
7695 static void
7696 SiS_SetDualLinkEtc(struct SiS_Private *SiS_Pr)
7697 {
7698   if(SiS_Pr->ChipType >= SIS_315H) {
7699      if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) {
7700         if((SiS_CRT2IsLCD(SiS_Pr)) ||
7701            (SiS_IsVAMode(SiS_Pr))) {
7702            if(SiS_Pr->SiS_LCDInfo & LCDDualLink) {
7703               SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x27,0x2c);
7704            } else {
7705               SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x27,~0x20);
7706            }
7707         }
7708      }
7709   }
7710   if(SiS_Pr->SiS_VBType & VB_SISEMI) {
7711      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2a,0x00);
7712 #ifdef SET_EMI
7713      SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c);
7714 #endif
7715      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x34,0x10);
7716   }
7717 }
7718 
7719 static void
7720 SiS_SetGroup4(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
7721                 unsigned short RefreshRateTableIndex)
7722 {
7723   unsigned short tempax, tempcx, tempbx, modeflag, temp, resinfo;
7724   unsigned int   tempebx, tempeax, templong;
7725 
7726   if(ModeNo <= 0x13) {
7727      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
7728      resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo;
7729   } else if(SiS_Pr->UseCustomMode) {
7730      modeflag = SiS_Pr->CModeFlag;
7731      resinfo = 0;
7732   } else {
7733      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
7734      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
7735   }
7736 
7737   if(SiS_Pr->ChipType >= SIS_315H) {
7738      if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
7739         if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
7740            SiS_SetReg(SiS_Pr->SiS_Part4Port,0x24,0x0e);
7741         }
7742      }
7743   }
7744 
7745   if(SiS_Pr->SiS_VBType & (VB_SIS30xCLV | VB_SIS302LV)) {
7746      if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
7747         SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x10,0x9f);
7748      }
7749   }
7750 
7751   if(SiS_Pr->ChipType >= SIS_315H) {
7752      if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
7753         SiS_SetDualLinkEtc(SiS_Pr);
7754         return;
7755      }
7756   }
7757 
7758   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x13,SiS_Pr->SiS_RVBHCFACT);
7759 
7760   tempbx = SiS_Pr->SiS_RVBHCMAX;
7761   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x14,tempbx);
7762 
7763   temp = (tempbx >> 1) & 0x80;
7764 
7765   tempcx = SiS_Pr->SiS_VGAHT - 1;
7766   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x16,tempcx);
7767 
7768   temp |= ((tempcx >> 5) & 0x78);
7769 
7770   tempcx = SiS_Pr->SiS_VGAVT - 1;
7771   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) tempcx -= 5;
7772   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x17,tempcx);
7773 
7774   temp |= ((tempcx >> 8) & 0x07);
7775   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x15,temp);
7776 
7777   tempbx = SiS_Pr->SiS_VGAHDE;
7778   if(modeflag & HalfDCLK)    tempbx >>= 1;
7779   if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1;
7780 
7781   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
7782      temp = 0;
7783      if(tempbx > 800)        temp = 0x60;
7784   } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
7785      temp = 0;
7786      if(tempbx > 1024)       temp = 0xC0;
7787      else if(tempbx >= 960)  temp = 0xA0;
7788   } else if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p)) {
7789      temp = 0;
7790      if(tempbx >= 1280)      temp = 0x40;
7791      else if(tempbx >= 1024) temp = 0x20;
7792   } else {
7793      temp = 0x80;
7794      if(tempbx >= 1024)      temp = 0xA0;
7795   }
7796 
7797   temp |= SiS_Pr->Init_P4_0E;
7798 
7799   if(SiS_Pr->SiS_VBType & VB_SIS301) {
7800      if(SiS_Pr->SiS_LCDResInfo != Panel_1280x1024) {
7801         temp &= 0xf0;
7802         temp |= 0x0A;
7803      }
7804   }
7805 
7806   SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0E,0x10,temp);
7807 
7808   tempeax = SiS_Pr->SiS_VGAVDE;
7809   tempebx = SiS_Pr->SiS_VDE;
7810   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
7811      if(!(temp & 0xE0)) tempebx >>=1;
7812   }
7813 
7814   tempcx = SiS_Pr->SiS_RVBHRS;
7815   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x18,tempcx);
7816   tempcx >>= 8;
7817   tempcx |= 0x40;
7818 
7819   if(tempeax <= tempebx) {
7820      tempcx ^= 0x40;
7821   } else {
7822      tempeax -= tempebx;
7823   }
7824 
7825   tempeax *= (256 * 1024);
7826   templong = tempeax % tempebx;
7827   tempeax /= tempebx;
7828   if(templong) tempeax++;
7829 
7830   temp = (unsigned short)(tempeax & 0x000000FF);
7831   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1B,temp);
7832   temp = (unsigned short)((tempeax & 0x0000FF00) >> 8);
7833   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1A,temp);
7834   temp = (unsigned short)((tempeax >> 12) & 0x70); /* sic! */
7835   temp |= (tempcx & 0x4F);
7836   SiS_SetReg(SiS_Pr->SiS_Part4Port,0x19,temp);
7837 
7838   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
7839 
7840      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1C,0x28);
7841 
7842      /* Calc Linebuffer max address and set/clear decimode */
7843      tempbx = 0;
7844      if(SiS_Pr->SiS_TVMode & (TVSetHiVision | TVSetYPbPr750p)) tempbx = 0x08;
7845      tempax = SiS_Pr->SiS_VGAHDE;
7846      if(modeflag & HalfDCLK)    tempax >>= 1;
7847      if(SiS_IsDualLink(SiS_Pr)) tempax >>= 1;
7848      if(tempax > 800) {
7849         if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
7850            tempax -= 800;
7851         } else {
7852            tempbx = 0x08;
7853            if(tempax == 960)       tempax *= 25; /* Correct */
7854            else if(tempax == 1024) tempax *= 25;
7855            else                    tempax *= 20;
7856            temp = tempax % 32;
7857            tempax /= 32;
7858            if(temp) tempax++;
7859            tempax++;
7860            if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
7861               if(resinfo == SIS_RI_1024x768 ||
7862                  resinfo == SIS_RI_1024x576 ||
7863                  resinfo == SIS_RI_1280x1024 ||
7864                  resinfo == SIS_RI_1280x720) {
7865                  /* Otherwise white line or garbage at right edge */
7866                  tempax = (tempax & 0xff00) | 0x20;
7867               }
7868            }
7869         }
7870      }
7871      tempax--;
7872      temp = ((tempax >> 4) & 0x30) | tempbx;
7873      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1D,tempax);
7874      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1E,temp);
7875 
7876      temp = 0x0036; tempbx = 0xD0;
7877      if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_VBType & VB_SISLVDS)) {
7878         temp = 0x0026; tempbx = 0xC0; /* See En/DisableBridge() */
7879      }
7880      if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
7881         if(!(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSetHiVision | TVSetYPbPr750p | TVSetYPbPr525p))) {
7882            temp |= 0x01;
7883            if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
7884               if(!(SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) {
7885                  temp &= ~0x01;
7886               }
7887            }
7888         }
7889      }
7890      SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x1F,tempbx,temp);
7891 
7892      tempbx = SiS_Pr->SiS_HT >> 1;
7893      if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1;
7894      tempbx -= 2;
7895      SiS_SetReg(SiS_Pr->SiS_Part4Port,0x22,tempbx);
7896      temp = (tempbx >> 5) & 0x38;
7897      SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,0xC0,temp);
7898 
7899      if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
7900         if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
7901            SiS_SetReg(SiS_Pr->SiS_Part4Port,0x24,0x0e);
7902            /* LCD-too-dark-error-source, see FinalizeLCD() */
7903         }
7904      }
7905 
7906      SiS_SetDualLinkEtc(SiS_Pr);
7907 
7908   }  /* 301B */
7909 
7910   SiS_SetCRT2VCLK(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
7911 }
7912 
7913 /*********************************************/
7914 /*         SET PART 5 REGISTER GROUP         */
7915 /*********************************************/
7916 
7917 static void
7918 SiS_SetGroup5(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
7919 {
7920 
7921   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)  return;
7922 
7923   if(SiS_Pr->SiS_ModeType == ModeVGA) {
7924      if(!(SiS_Pr->SiS_VBInfo & (SetInSlaveMode | LoadDACFlag))) {
7925         SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20);
7926         SiS_LoadDAC(SiS_Pr, ModeNo, ModeIdIndex);
7927      }
7928   }
7929 }
7930 
7931 /*********************************************/
7932 /*     MODIFY CRT1 GROUP FOR SLAVE MODE      */
7933 /*********************************************/
7934 
7935 static bool
7936 SiS_GetLVDSCRT1Ptr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
7937                    unsigned short RefreshRateTableIndex, unsigned short *ResIndex,
7938                    unsigned short *DisplayType)
7939  {
7940   unsigned short modeflag = 0;
7941   bool checkhd = true;
7942 
7943   /* Pass 1:1 not supported here */
7944 
7945   if(ModeNo <= 0x13) {
7946      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
7947      (*ResIndex) = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
7948   } else {
7949      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
7950      (*ResIndex) = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
7951   }
7952 
7953   (*ResIndex) &= 0x3F;
7954 
7955   if((SiS_Pr->SiS_IF_DEF_CH70xx) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) {
7956 
7957      (*DisplayType) = 80;
7958      if((SiS_Pr->SiS_TVMode & TVSetPAL) && (!(SiS_Pr->SiS_TVMode & TVSetPALM))) {
7959         (*DisplayType) = 82;
7960         if(SiS_Pr->SiS_ModeType > ModeVGA) {
7961            if(SiS_Pr->SiS_CHSOverScan) (*DisplayType) = 84;
7962         }
7963      }
7964      if((*DisplayType) != 84) {
7965         if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) (*DisplayType)++;
7966      }
7967 
7968   } else {
7969 
7970      (*DisplayType = 0);
7971      switch(SiS_Pr->SiS_LCDResInfo) {
7972      case Panel_320x240_1: (*DisplayType) = 50;
7973                            checkhd = false;
7974                            break;
7975      case Panel_320x240_2: (*DisplayType) = 14;
7976                            break;
7977      case Panel_320x240_3: (*DisplayType) = 18;
7978                            break;
7979      case Panel_640x480:   (*DisplayType) = 10;
7980                            break;
7981      case Panel_1024x600:  (*DisplayType) = 26;
7982                            break;
7983      default: return true;
7984      }
7985 
7986      if(checkhd) {
7987         if(modeflag & HalfDCLK) (*DisplayType)++;
7988      }
7989 
7990      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x600) {
7991         if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) (*DisplayType) += 2;
7992      }
7993 
7994   }
7995 
7996   return true;
7997 }
7998 
7999 static void
8000 SiS_ModCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
8001                 unsigned short RefreshRateTableIndex)
8002 {
8003   unsigned short tempah, i, modeflag, j, ResIndex, DisplayType;
8004   const struct SiS_LVDSCRT1Data *LVDSCRT1Ptr=NULL;
8005   static const unsigned short CRIdx[] = {
8006         0x00, 0x02, 0x03, 0x04, 0x05, 0x06,
8007         0x07, 0x10, 0x11, 0x15, 0x16
8008   };
8009 
8010   if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) ||
8011      (SiS_Pr->SiS_CustomT == CUT_BARCO1024) ||
8012      (SiS_Pr->SiS_CustomT == CUT_PANEL848)  ||
8013      (SiS_Pr->SiS_CustomT == CUT_PANEL856) )
8014      return;
8015 
8016   if(SiS_Pr->SiS_IF_DEF_LVDS) {
8017      if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
8018         if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) return;
8019      }
8020   } else if(SiS_Pr->SiS_VBType & VB_SISVB) {
8021      if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) return;
8022   } else return;
8023 
8024   if(SiS_Pr->SiS_LCDInfo & LCDPass11) return;
8025 
8026   if(SiS_Pr->ChipType < SIS_315H) {
8027      if(SiS_Pr->SiS_SetFlag & SetDOSMode) return;
8028   }
8029 
8030   if(!(SiS_GetLVDSCRT1Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex,
8031                           &ResIndex, &DisplayType))) {
8032      return;
8033   }
8034 
8035   switch(DisplayType) {
8036     case 50: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_1;           break; /* xSTN */
8037     case 14: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_2;           break; /* xSTN */
8038     case 15: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_2_H;         break; /* xSTN */
8039     case 18: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_3;           break; /* xSTN */
8040     case 19: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_3_H;         break; /* xSTN */
8041     case 10: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1640x480_1;           break;
8042     case 11: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1640x480_1_H;         break;
8043 #if 0 /* Works better with calculated numbers */
8044     case 26: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_1;          break;
8045     case 27: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_1_H;        break;
8046     case 28: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_2;          break;
8047     case 29: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_2_H;        break;
8048 #endif
8049     case 80: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1UNTSC;               break;
8050     case 81: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1ONTSC;               break;
8051     case 82: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1UPAL;                break;
8052     case 83: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1OPAL;                break;
8053     case 84: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1SOPAL;               break;
8054   }
8055 
8056   if(LVDSCRT1Ptr) {
8057 
8058      SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f);
8059 
8060      for(i = 0; i <= 10; i++) {
8061         tempah = (LVDSCRT1Ptr + ResIndex)->CR[i];
8062         SiS_SetReg(SiS_Pr->SiS_P3d4,CRIdx[i],tempah);
8063      }
8064 
8065      for(i = 0x0A, j = 11; i <= 0x0C; i++, j++) {
8066         tempah = (LVDSCRT1Ptr + ResIndex)->CR[j];
8067         SiS_SetReg(SiS_Pr->SiS_P3c4,i,tempah);
8068      }
8069 
8070      tempah = (LVDSCRT1Ptr + ResIndex)->CR[14] & 0xE0;
8071      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0x1f,tempah);
8072 
8073      if(ModeNo <= 0x13) modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
8074      else               modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
8075 
8076      tempah = ((LVDSCRT1Ptr + ResIndex)->CR[14] & 0x01) << 5;
8077      if(modeflag & DoubleScanMode) tempah |= 0x80;
8078      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,~0x020,tempah);
8079 
8080   } else {
8081 
8082      SiS_CalcLCDACRT1Timing(SiS_Pr, ModeNo, ModeIdIndex);
8083 
8084   }
8085 }
8086 
8087 /*********************************************/
8088 /*              SET CRT2 ECLK                */
8089 /*********************************************/
8090 
8091 static void
8092 SiS_SetCRT2ECLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
8093            unsigned short RefreshRateTableIndex)
8094 {
8095   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
8096   unsigned short clkbase, vclkindex = 0;
8097   unsigned char  sr2b, sr2c;
8098 
8099   if(SiS_Pr->SiS_LCDInfo & LCDPass11) {
8100      SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2);
8101      if(SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK == 2) {
8102         RefreshRateTableIndex--;
8103      }
8104      vclkindex = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex,
8105                                     RefreshRateTableIndex);
8106      SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
8107   } else {
8108      vclkindex = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex,
8109                                     RefreshRateTableIndex);
8110   }
8111 
8112   sr2b = SiS_Pr->SiS_VCLKData[vclkindex].SR2B;
8113   sr2c = SiS_Pr->SiS_VCLKData[vclkindex].SR2C;
8114 
8115   if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) || (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) {
8116      if(SiS_Pr->SiS_UseROM) {
8117         if(ROMAddr[0x220] & 0x01) {
8118            sr2b = ROMAddr[0x227];
8119            sr2c = ROMAddr[0x228];
8120         }
8121      }
8122   }
8123 
8124   clkbase = 0x02B;
8125   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
8126      if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) {
8127         clkbase += 3;
8128      }
8129   }
8130 
8131   SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x20);
8132   SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase,sr2b);
8133   SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase+1,sr2c);
8134   SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x10);
8135   SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase,sr2b);
8136   SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase+1,sr2c);
8137   SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x00);
8138   SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase,sr2b);
8139   SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase+1,sr2c);
8140 }
8141 
8142 /*********************************************/
8143 /*           SET UP CHRONTEL CHIPS           */
8144 /*********************************************/
8145 
8146 static void
8147 SiS_SetCHTVReg(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
8148                unsigned short RefreshRateTableIndex)
8149 {
8150    unsigned short TVType, resindex;
8151    const struct SiS_CHTVRegData *CHTVRegData = NULL;
8152 
8153    if(ModeNo <= 0x13)
8154       resindex = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
8155    else
8156       resindex = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
8157 
8158    resindex &= 0x3F;
8159 
8160    TVType = 0;
8161    if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) TVType += 1;
8162    if(SiS_Pr->SiS_TVMode & TVSetPAL) {
8163       TVType += 2;
8164       if(SiS_Pr->SiS_ModeType > ModeVGA) {
8165          if(SiS_Pr->SiS_CHSOverScan) TVType = 8;
8166       }
8167       if(SiS_Pr->SiS_TVMode & TVSetPALM) {
8168          TVType = 4;
8169          if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) TVType += 1;
8170       } else if(SiS_Pr->SiS_TVMode & TVSetPALN) {
8171          TVType = 6;
8172          if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) TVType += 1;
8173       }
8174    }
8175 
8176    switch(TVType) {
8177       case  0: CHTVRegData = SiS_Pr->SiS_CHTVReg_UNTSC; break;
8178       case  1: CHTVRegData = SiS_Pr->SiS_CHTVReg_ONTSC; break;
8179       case  2: CHTVRegData = SiS_Pr->SiS_CHTVReg_UPAL;  break;
8180       case  3: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPAL;  break;
8181       case  4: CHTVRegData = SiS_Pr->SiS_CHTVReg_UPALM; break;
8182       case  5: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPALM; break;
8183       case  6: CHTVRegData = SiS_Pr->SiS_CHTVReg_UPALN; break;
8184       case  7: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPALN; break;
8185       case  8: CHTVRegData = SiS_Pr->SiS_CHTVReg_SOPAL; break;
8186       default: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPAL;  break;
8187    }
8188 
8189 
8190    if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) {
8191 
8192 #ifdef CONFIG_FB_SIS_300
8193 
8194       /* Chrontel 7005 - I assume that it does not come with a 315 series chip */
8195 
8196       /* We don't support modes >800x600 */
8197       if (resindex > 5) return;
8198 
8199       if(SiS_Pr->SiS_TVMode & TVSetPAL) {
8200          SiS_SetCH700x(SiS_Pr,0x04,0x43);  /* 0x40=76uA (PAL); 0x03=15bit non-multi RGB*/
8201          SiS_SetCH700x(SiS_Pr,0x09,0x69);  /* Black level for PAL (105)*/
8202       } else {
8203          SiS_SetCH700x(SiS_Pr,0x04,0x03);   /* upper nibble=71uA (NTSC), 0x03=15bit non-multi RGB*/
8204          SiS_SetCH700x(SiS_Pr,0x09,0x71);   /* Black level for NTSC (113)*/
8205       }
8206 
8207       SiS_SetCH700x(SiS_Pr,0x00,CHTVRegData[resindex].Reg[0]);  /* Mode register */
8208       SiS_SetCH700x(SiS_Pr,0x07,CHTVRegData[resindex].Reg[1]);  /* Start active video register */
8209       SiS_SetCH700x(SiS_Pr,0x08,CHTVRegData[resindex].Reg[2]);  /* Position overflow register */
8210       SiS_SetCH700x(SiS_Pr,0x0a,CHTVRegData[resindex].Reg[3]);  /* Horiz Position register */
8211       SiS_SetCH700x(SiS_Pr,0x0b,CHTVRegData[resindex].Reg[4]);  /* Vertical Position register */
8212 
8213       /* Set minimum flicker filter for Luma channel (SR1-0=00),
8214                 minimum text enhancement (S3-2=10),
8215                 maximum flicker filter for Chroma channel (S5-4=10)
8216                 =00101000=0x28 (When reading, S1-0->S3-2, and S3-2->S1-0!)
8217        */
8218       SiS_SetCH700x(SiS_Pr,0x01,0x28);
8219 
8220       /* Set video bandwidth
8221             High bandwidth Luma composite video filter(S0=1)
8222             low bandwidth Luma S-video filter (S2-1=00)
8223             disable peak filter in S-video channel (S3=0)
8224             high bandwidth Chroma Filter (S5-4=11)
8225             =00110001=0x31
8226       */
8227       SiS_SetCH700x(SiS_Pr,0x03,0xb1);       /* old: 3103 */
8228 
8229       /* Register 0x3D does not exist in non-macrovision register map
8230             (Maybe this is a macrovision register?)
8231        */
8232 #ifndef SIS_CP
8233       SiS_SetCH70xx(SiS_Pr,0x3d,0x00);
8234 #endif
8235 
8236       /* Register 0x10 only contains 1 writable bit (S0) for sensing,
8237              all other bits a read-only. Macrovision?
8238        */
8239       SiS_SetCH70xxANDOR(SiS_Pr,0x10,0x00,0x1F);
8240 
8241       /* Register 0x11 only contains 3 writable bits (S0-S2) for
8242              contrast enhancement (set to 010 -> gain 1 Yout = 17/16*(Yin-30) )
8243        */
8244       SiS_SetCH70xxANDOR(SiS_Pr,0x11,0x02,0xF8);
8245 
8246       /* Clear DSEN
8247        */
8248       SiS_SetCH70xxANDOR(SiS_Pr,0x1c,0x00,0xEF);
8249 
8250       if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) {            /* ---- NTSC ---- */
8251          if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) {
8252             if(resindex == 0x04) {                      /* 640x480 overscan: Mode 16 */
8253                SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF);       /* loop filter off */
8254                SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE);       /* ACIV on, no need to set FSCI */
8255             } else if(resindex == 0x05) {               /* 800x600 overscan: Mode 23 */
8256                SiS_SetCH70xxANDOR(SiS_Pr,0x18,0x01,0xF0);       /* 0x18-0x1f: FSCI 469,762,048 */
8257                SiS_SetCH70xxANDOR(SiS_Pr,0x19,0x0C,0xF0);
8258                SiS_SetCH70xxANDOR(SiS_Pr,0x1a,0x00,0xF0);
8259                SiS_SetCH70xxANDOR(SiS_Pr,0x1b,0x00,0xF0);
8260                SiS_SetCH70xxANDOR(SiS_Pr,0x1c,0x00,0xF0);
8261                SiS_SetCH70xxANDOR(SiS_Pr,0x1d,0x00,0xF0);
8262                SiS_SetCH70xxANDOR(SiS_Pr,0x1e,0x00,0xF0);
8263                SiS_SetCH70xxANDOR(SiS_Pr,0x1f,0x00,0xF0);
8264                SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x01,0xEF);       /* Loop filter on for mode 23 */
8265                SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x00,0xFE);       /* ACIV off, need to set FSCI */
8266             }
8267          } else {
8268             if(resindex == 0x04) {                      /* ----- 640x480 underscan; Mode 17 */
8269                SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF);       /* loop filter off */
8270                SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE);
8271             } else if(resindex == 0x05) {               /* ----- 800x600 underscan: Mode 24 */
8272 #if 0
8273                SiS_SetCH70xxANDOR(SiS_Pr,0x18,0x01,0xF0);       /* (FSCI was 0x1f1c71c7 - this is for mode 22) */
8274                SiS_SetCH70xxANDOR(SiS_Pr,0x19,0x09,0xF0);       /* FSCI for mode 24 is 428,554,851 */
8275                SiS_SetCH70xxANDOR(SiS_Pr,0x1a,0x08,0xF0);       /* 198b3a63 */
8276                SiS_SetCH70xxANDOR(SiS_Pr,0x1b,0x0b,0xF0);
8277                SiS_SetCH70xxANDOR(SiS_Pr,0x1c,0x04,0xF0);
8278                SiS_SetCH70xxANDOR(SiS_Pr,0x1d,0x01,0xF0);
8279                SiS_SetCH70xxANDOR(SiS_Pr,0x1e,0x06,0xF0);
8280                SiS_SetCH70xxANDOR(SiS_Pr,0x1f,0x05,0xF0);
8281                SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF);       /* loop filter off for mode 24 */
8282                SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x00,0xFE);       * ACIV off, need to set FSCI */
8283 #endif         /* All alternatives wrong (datasheet wrong?), don't use FSCI */
8284                SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF);        /* loop filter off */
8285                SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE);
8286             }
8287          }
8288       } else {                                          /* ---- PAL ---- */
8289         /* We don't play around with FSCI in PAL mode */
8290         SiS_SetCH70xxANDOR(SiS_Pr, 0x20, 0x00, 0xEF);   /* loop filter off */
8291         SiS_SetCH70xxANDOR(SiS_Pr, 0x21, 0x01, 0xFE);   /* ACIV on */
8292       }
8293 
8294 #endif  /* 300 */
8295 
8296    } else {
8297 
8298       /* Chrontel 7019 - assumed that it does not come with a 300 series chip */
8299 
8300 #ifdef CONFIG_FB_SIS_315
8301 
8302       unsigned short temp;
8303 
8304       /* We don't support modes >1024x768 */
8305       if (resindex > 6) return;
8306 
8307       temp = CHTVRegData[resindex].Reg[0];
8308       if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) temp |= 0x10;
8309       SiS_SetCH701x(SiS_Pr,0x00,temp);
8310 
8311       SiS_SetCH701x(SiS_Pr,0x01,CHTVRegData[resindex].Reg[1]);
8312       SiS_SetCH701x(SiS_Pr,0x02,CHTVRegData[resindex].Reg[2]);
8313       SiS_SetCH701x(SiS_Pr,0x04,CHTVRegData[resindex].Reg[3]);
8314       SiS_SetCH701x(SiS_Pr,0x03,CHTVRegData[resindex].Reg[4]);
8315       SiS_SetCH701x(SiS_Pr,0x05,CHTVRegData[resindex].Reg[5]);
8316       SiS_SetCH701x(SiS_Pr,0x06,CHTVRegData[resindex].Reg[6]);
8317 
8318       temp = CHTVRegData[resindex].Reg[7];
8319       if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) temp = 0x66;
8320       SiS_SetCH701x(SiS_Pr,0x07,temp);
8321 
8322       SiS_SetCH701x(SiS_Pr,0x08,CHTVRegData[resindex].Reg[8]);
8323       SiS_SetCH701x(SiS_Pr,0x15,CHTVRegData[resindex].Reg[9]);
8324       SiS_SetCH701x(SiS_Pr,0x1f,CHTVRegData[resindex].Reg[10]);
8325       SiS_SetCH701x(SiS_Pr,0x0c,CHTVRegData[resindex].Reg[11]);
8326       SiS_SetCH701x(SiS_Pr,0x0d,CHTVRegData[resindex].Reg[12]);
8327       SiS_SetCH701x(SiS_Pr,0x0e,CHTVRegData[resindex].Reg[13]);
8328       SiS_SetCH701x(SiS_Pr,0x0f,CHTVRegData[resindex].Reg[14]);
8329       SiS_SetCH701x(SiS_Pr,0x10,CHTVRegData[resindex].Reg[15]);
8330 
8331       temp = SiS_GetCH701x(SiS_Pr,0x21) & ~0x02;
8332       /* D1 should be set for PAL, PAL-N and NTSC-J,
8333          but I won't do that for PAL unless somebody
8334          tells me to do so. Since the BIOS uses
8335          non-default CIV values and blacklevels,
8336          this might be compensated anyway.
8337        */
8338       if(SiS_Pr->SiS_TVMode & (TVSetPALN | TVSetNTSCJ)) temp |= 0x02;
8339       SiS_SetCH701x(SiS_Pr,0x21,temp);
8340 
8341 #endif  /* 315 */
8342 
8343    }
8344 
8345 #ifdef SIS_CP
8346    SIS_CP_INIT301_CP3
8347 #endif
8348 
8349 }
8350 
8351 #ifdef CONFIG_FB_SIS_315  /* ----------- 315 series only ---------- */
8352 
8353 void
8354 SiS_Chrontel701xBLOn(struct SiS_Private *SiS_Pr)
8355 {
8356    unsigned short temp;
8357 
8358    /* Enable Chrontel 7019 LCD panel backlight */
8359    if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
8360       if(SiS_Pr->ChipType == SIS_740) {
8361          SiS_SetCH701x(SiS_Pr,0x66,0x65);
8362       } else {
8363          temp = SiS_GetCH701x(SiS_Pr,0x66);
8364          temp |= 0x20;
8365          SiS_SetCH701x(SiS_Pr,0x66,temp);
8366       }
8367    }
8368 }
8369 
8370 void
8371 SiS_Chrontel701xBLOff(struct SiS_Private *SiS_Pr)
8372 {
8373    unsigned short temp;
8374 
8375    /* Disable Chrontel 7019 LCD panel backlight */
8376    if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
8377       temp = SiS_GetCH701x(SiS_Pr,0x66);
8378       temp &= 0xDF;
8379       SiS_SetCH701x(SiS_Pr,0x66,temp);
8380    }
8381 }
8382 
8383 static void
8384 SiS_ChrontelPowerSequencing(struct SiS_Private *SiS_Pr)
8385 {
8386   static const unsigned char regtable[]      = { 0x67, 0x68, 0x69, 0x6a, 0x6b };
8387   static const unsigned char table1024_740[] = { 0x01, 0x02, 0x01, 0x01, 0x01 };
8388   static const unsigned char table1400_740[] = { 0x01, 0x6e, 0x01, 0x01, 0x01 };
8389   static const unsigned char asus1024_740[]  = { 0x19, 0x6e, 0x01, 0x19, 0x09 };
8390   static const unsigned char asus1400_740[]  = { 0x19, 0x6e, 0x01, 0x19, 0x09 };
8391   static const unsigned char table1024_650[] = { 0x01, 0x02, 0x01, 0x01, 0x02 };
8392   static const unsigned char table1400_650[] = { 0x01, 0x02, 0x01, 0x01, 0x02 };
8393   const unsigned char *tableptr = NULL;
8394   int i;
8395 
8396   /* Set up Power up/down timing */
8397 
8398   if(SiS_Pr->ChipType == SIS_740) {
8399      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
8400         if(SiS_Pr->SiS_CustomT == CUT_ASUSL3000D) tableptr = asus1024_740;
8401         else                                      tableptr = table1024_740;
8402      } else if((SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) ||
8403                (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) ||
8404                (SiS_Pr->SiS_LCDResInfo == Panel_1600x1200)) {
8405         if(SiS_Pr->SiS_CustomT == CUT_ASUSL3000D) tableptr = asus1400_740;
8406         else                                      tableptr = table1400_740;
8407      } else return;
8408   } else {
8409      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
8410         tableptr = table1024_650;
8411      } else if((SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) ||
8412                (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) ||
8413                (SiS_Pr->SiS_LCDResInfo == Panel_1600x1200)) {
8414         tableptr = table1400_650;
8415      } else return;
8416   }
8417 
8418   for(i=0; i<5; i++) {
8419      SiS_SetCH701x(SiS_Pr, regtable[i], tableptr[i]);
8420   }
8421 }
8422 
8423 static void
8424 SiS_SetCH701xForLCD(struct SiS_Private *SiS_Pr)
8425 {
8426   const unsigned char *tableptr = NULL;
8427   unsigned short tempbh;
8428   int i;
8429   static const unsigned char regtable[] = {
8430                 0x1c, 0x5f, 0x64, 0x6f, 0x70, 0x71,
8431                 0x72, 0x73, 0x74, 0x76, 0x78, 0x7d, 0x66
8432   };
8433   static const unsigned char table1024_740[] = {
8434                 0x60, 0x02, 0x00, 0x07, 0x40, 0xed,
8435                 0xa3, 0xc8, 0xc7, 0xac, 0xe0, 0x02, 0x44
8436   };
8437   static const unsigned char table1280_740[] = {
8438                 0x60, 0x03, 0x11, 0x00, 0x40, 0xe3,
8439                 0xad, 0xdb, 0xf6, 0xac, 0xe0, 0x02, 0x44
8440   };
8441   static const unsigned char table1400_740[] = {
8442                 0x60, 0x03, 0x11, 0x00, 0x40, 0xe3,
8443                 0xad, 0xdb, 0xf6, 0xac, 0xe0, 0x02, 0x44
8444   };
8445   static const unsigned char table1600_740[] = {
8446                 0x60, 0x04, 0x11, 0x00, 0x40, 0xe3,
8447                 0xad, 0xde, 0xf6, 0xac, 0x60, 0x1a, 0x44
8448   };
8449   static const unsigned char table1024_650[] = {
8450                 0x60, 0x02, 0x00, 0x07, 0x40, 0xed,
8451                 0xa3, 0xc8, 0xc7, 0xac, 0x60, 0x02
8452   };
8453   static const unsigned char table1280_650[] = {
8454                 0x60, 0x03, 0x11, 0x00, 0x40, 0xe3,
8455                 0xad, 0xdb, 0xf6, 0xac, 0xe0, 0x02
8456   };
8457   static const unsigned char table1400_650[] = {
8458                 0x60, 0x03, 0x11, 0x00, 0x40, 0xef,
8459                 0xad, 0xdb, 0xf6, 0xac, 0x60, 0x02
8460   };
8461   static const unsigned char table1600_650[] = {
8462                 0x60, 0x04, 0x11, 0x00, 0x40, 0xe3,
8463                 0xad, 0xde, 0xf6, 0xac, 0x60, 0x1a
8464   };
8465 
8466   if(SiS_Pr->ChipType == SIS_740) {
8467      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768)       tableptr = table1024_740;
8468      else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) tableptr = table1280_740;
8469      else if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) tableptr = table1400_740;
8470      else if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) tableptr = table1600_740;
8471      else return;
8472   } else {
8473      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768)       tableptr = table1024_650;
8474      else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) tableptr = table1280_650;
8475      else if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) tableptr = table1400_650;
8476      else if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) tableptr = table1600_650;
8477      else return;
8478   }
8479 
8480   tempbh = SiS_GetCH701x(SiS_Pr,0x74);
8481   if((tempbh == 0xf6) || (tempbh == 0xc7)) {
8482      tempbh = SiS_GetCH701x(SiS_Pr,0x73);
8483      if(tempbh == 0xc8) {
8484         if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) return;
8485      } else if(tempbh == 0xdb) {
8486         if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) return;
8487         if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) return;
8488      } else if(tempbh == 0xde) {
8489         if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) return;
8490      }
8491   }
8492 
8493   if(SiS_Pr->ChipType == SIS_740) tempbh = 0x0d;
8494   else                            tempbh = 0x0c;
8495 
8496   for(i = 0; i < tempbh; i++) {
8497      SiS_SetCH701x(SiS_Pr, regtable[i], tableptr[i]);
8498   }
8499   SiS_ChrontelPowerSequencing(SiS_Pr);
8500   tempbh = SiS_GetCH701x(SiS_Pr,0x1e);
8501   tempbh |= 0xc0;
8502   SiS_SetCH701x(SiS_Pr,0x1e,tempbh);
8503 
8504   if(SiS_Pr->ChipType == SIS_740) {
8505      tempbh = SiS_GetCH701x(SiS_Pr,0x1c);
8506      tempbh &= 0xfb;
8507      SiS_SetCH701x(SiS_Pr,0x1c,tempbh);
8508      SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2d,0x03);
8509      tempbh = SiS_GetCH701x(SiS_Pr,0x64);
8510      tempbh |= 0x40;
8511      SiS_SetCH701x(SiS_Pr,0x64,tempbh);
8512      tempbh = SiS_GetCH701x(SiS_Pr,0x03);
8513      tempbh &= 0x3f;
8514      SiS_SetCH701x(SiS_Pr,0x03,tempbh);
8515   }
8516 }
8517 
8518 static void
8519 SiS_ChrontelResetVSync(struct SiS_Private *SiS_Pr)
8520 {
8521   unsigned char temp, temp1;
8522 
8523   temp1 = SiS_GetCH701x(SiS_Pr,0x49);
8524   SiS_SetCH701x(SiS_Pr,0x49,0x3e);
8525   temp = SiS_GetCH701x(SiS_Pr,0x47);
8526   temp &= 0x7f; /* Use external VSYNC */
8527   SiS_SetCH701x(SiS_Pr,0x47,temp);
8528   SiS_LongDelay(SiS_Pr, 3);
8529   temp = SiS_GetCH701x(SiS_Pr,0x47);
8530   temp |= 0x80; /* Use internal VSYNC */
8531   SiS_SetCH701x(SiS_Pr,0x47,temp);
8532   SiS_SetCH701x(SiS_Pr,0x49,temp1);
8533 }
8534 
8535 static void
8536 SiS_Chrontel701xOn(struct SiS_Private *SiS_Pr)
8537 {
8538   unsigned short temp;
8539 
8540   if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
8541      if(SiS_Pr->ChipType == SIS_740) {
8542         temp = SiS_GetCH701x(SiS_Pr,0x1c);
8543         temp |= 0x04;   /* Invert XCLK phase */
8544         SiS_SetCH701x(SiS_Pr,0x1c,temp);
8545      }
8546      if(SiS_IsYPbPr(SiS_Pr)) {
8547         temp = SiS_GetCH701x(SiS_Pr,0x01);
8548         temp &= 0x3f;
8549         temp |= 0x80;   /* Enable YPrPb (HDTV) */
8550         SiS_SetCH701x(SiS_Pr,0x01,temp);
8551      }
8552      if(SiS_IsChScart(SiS_Pr)) {
8553         temp = SiS_GetCH701x(SiS_Pr,0x01);
8554         temp &= 0x3f;
8555         temp |= 0xc0;   /* Enable SCART + CVBS */
8556         SiS_SetCH701x(SiS_Pr,0x01,temp);
8557      }
8558      if(SiS_Pr->ChipType == SIS_740) {
8559         SiS_ChrontelResetVSync(SiS_Pr);
8560         SiS_SetCH701x(SiS_Pr,0x49,0x20);   /* Enable TV path */
8561      } else {
8562         SiS_SetCH701x(SiS_Pr,0x49,0x20);   /* Enable TV path */
8563         temp = SiS_GetCH701x(SiS_Pr,0x49);
8564         if(SiS_IsYPbPr(SiS_Pr)) {
8565            temp = SiS_GetCH701x(SiS_Pr,0x73);
8566            temp |= 0x60;
8567            SiS_SetCH701x(SiS_Pr,0x73,temp);
8568         }
8569         temp = SiS_GetCH701x(SiS_Pr,0x47);
8570         temp &= 0x7f;
8571         SiS_SetCH701x(SiS_Pr,0x47,temp);
8572         SiS_LongDelay(SiS_Pr, 2);
8573         temp = SiS_GetCH701x(SiS_Pr,0x47);
8574         temp |= 0x80;
8575         SiS_SetCH701x(SiS_Pr,0x47,temp);
8576      }
8577   }
8578 }
8579 
8580 static void
8581 SiS_Chrontel701xOff(struct SiS_Private *SiS_Pr)
8582 {
8583   unsigned short temp;
8584 
8585   /* Complete power down of LVDS */
8586   if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
8587      if(SiS_Pr->ChipType == SIS_740) {
8588         SiS_LongDelay(SiS_Pr, 1);
8589         SiS_GenericDelay(SiS_Pr, 5887);
8590         SiS_SetCH701x(SiS_Pr,0x76,0xac);
8591         SiS_SetCH701x(SiS_Pr,0x66,0x00);
8592      } else {
8593         SiS_LongDelay(SiS_Pr, 2);
8594         temp = SiS_GetCH701x(SiS_Pr,0x76);
8595         temp &= 0xfc;
8596         SiS_SetCH701x(SiS_Pr,0x76,temp);
8597         SiS_SetCH701x(SiS_Pr,0x66,0x00);
8598      }
8599   }
8600 }
8601 
8602 static void
8603 SiS_ChrontelResetDB(struct SiS_Private *SiS_Pr)
8604 {
8605      unsigned short temp;
8606 
8607      if(SiS_Pr->ChipType == SIS_740) {
8608 
8609         temp = SiS_GetCH701x(SiS_Pr,0x4a);  /* Version ID */
8610         temp &= 0x01;
8611         if(!temp) {
8612 
8613            if(SiS_WeHaveBacklightCtrl(SiS_Pr)) {
8614               temp = SiS_GetCH701x(SiS_Pr,0x49);
8615               SiS_SetCH701x(SiS_Pr,0x49,0x3e);
8616            }
8617 
8618            /* Reset Chrontel 7019 datapath */
8619            SiS_SetCH701x(SiS_Pr,0x48,0x10);
8620            SiS_LongDelay(SiS_Pr, 1);
8621            SiS_SetCH701x(SiS_Pr,0x48,0x18);
8622 
8623            if(SiS_WeHaveBacklightCtrl(SiS_Pr)) {
8624               SiS_ChrontelResetVSync(SiS_Pr);
8625               SiS_SetCH701x(SiS_Pr,0x49,temp);
8626            }
8627 
8628         } else {
8629 
8630            /* Clear/set/clear GPIO */
8631            temp = SiS_GetCH701x(SiS_Pr,0x5c);
8632            temp &= 0xef;
8633            SiS_SetCH701x(SiS_Pr,0x5c,temp);
8634            temp = SiS_GetCH701x(SiS_Pr,0x5c);
8635            temp |= 0x10;
8636            SiS_SetCH701x(SiS_Pr,0x5c,temp);
8637            temp = SiS_GetCH701x(SiS_Pr,0x5c);
8638            temp &= 0xef;
8639            SiS_SetCH701x(SiS_Pr,0x5c,temp);
8640            temp = SiS_GetCH701x(SiS_Pr,0x61);
8641            if(!temp) {
8642               SiS_SetCH701xForLCD(SiS_Pr);
8643            }
8644         }
8645 
8646      } else { /* 650 */
8647         /* Reset Chrontel 7019 datapath */
8648         SiS_SetCH701x(SiS_Pr,0x48,0x10);
8649         SiS_LongDelay(SiS_Pr, 1);
8650         SiS_SetCH701x(SiS_Pr,0x48,0x18);
8651      }
8652 }
8653 
8654 static void
8655 SiS_ChrontelInitTVVSync(struct SiS_Private *SiS_Pr)
8656 {
8657      unsigned short temp;
8658 
8659      if(SiS_Pr->ChipType == SIS_740) {
8660 
8661         if(SiS_WeHaveBacklightCtrl(SiS_Pr)) {
8662            SiS_ChrontelResetVSync(SiS_Pr);
8663         }
8664 
8665      } else {
8666 
8667         SiS_SetCH701x(SiS_Pr,0x76,0xaf);  /* Power up LVDS block */
8668         temp = SiS_GetCH701x(SiS_Pr,0x49);
8669         temp &= 1;
8670         if(temp != 1) {  /* TV block powered? (0 = yes, 1 = no) */
8671            temp = SiS_GetCH701x(SiS_Pr,0x47);
8672            temp &= 0x70;
8673            SiS_SetCH701x(SiS_Pr,0x47,temp);  /* enable VSYNC */
8674            SiS_LongDelay(SiS_Pr, 3);
8675            temp = SiS_GetCH701x(SiS_Pr,0x47);
8676            temp |= 0x80;
8677            SiS_SetCH701x(SiS_Pr,0x47,temp);  /* disable VSYNC */
8678         }
8679 
8680      }
8681 }
8682 
8683 static void
8684 SiS_ChrontelDoSomething3(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
8685 {
8686      unsigned short temp,temp1;
8687 
8688      if(SiS_Pr->ChipType == SIS_740) {
8689 
8690         temp = SiS_GetCH701x(SiS_Pr,0x61);
8691         if(temp < 1) {
8692            temp++;
8693            SiS_SetCH701x(SiS_Pr,0x61,temp);
8694         }
8695         SiS_SetCH701x(SiS_Pr,0x66,0x45);  /* Panel power on */
8696         SiS_SetCH701x(SiS_Pr,0x76,0xaf);  /* All power on */
8697         SiS_LongDelay(SiS_Pr, 1);
8698         SiS_GenericDelay(SiS_Pr, 5887);
8699 
8700      } else {  /* 650 */
8701 
8702         temp1 = 0;
8703         temp = SiS_GetCH701x(SiS_Pr,0x61);
8704         if(temp < 2) {
8705            temp++;
8706            SiS_SetCH701x(SiS_Pr,0x61,temp);
8707            temp1 = 1;
8708         }
8709         SiS_SetCH701x(SiS_Pr,0x76,0xac);
8710         temp = SiS_GetCH701x(SiS_Pr,0x66);
8711         temp |= 0x5f;
8712         SiS_SetCH701x(SiS_Pr,0x66,temp);
8713         if(ModeNo > 0x13) {
8714            if(SiS_WeHaveBacklightCtrl(SiS_Pr)) {
8715               SiS_GenericDelay(SiS_Pr, 1023);
8716            } else {
8717               SiS_GenericDelay(SiS_Pr, 767);
8718            }
8719         } else {
8720            if(!temp1)
8721               SiS_GenericDelay(SiS_Pr, 767);
8722         }
8723         temp = SiS_GetCH701x(SiS_Pr,0x76);
8724         temp |= 0x03;
8725         SiS_SetCH701x(SiS_Pr,0x76,temp);
8726         temp = SiS_GetCH701x(SiS_Pr,0x66);
8727         temp &= 0x7f;
8728         SiS_SetCH701x(SiS_Pr,0x66,temp);
8729         SiS_LongDelay(SiS_Pr, 1);
8730 
8731      }
8732 }
8733 
8734 static void
8735 SiS_ChrontelDoSomething2(struct SiS_Private *SiS_Pr)
8736 {
8737      unsigned short temp;
8738 
8739      SiS_LongDelay(SiS_Pr, 1);
8740 
8741      do {
8742        temp = SiS_GetCH701x(SiS_Pr,0x66);
8743        temp &= 0x04;  /* PLL stable? -> bail out */
8744        if(temp == 0x04) break;
8745 
8746        if(SiS_Pr->ChipType == SIS_740) {
8747           /* Power down LVDS output, PLL normal operation */
8748           SiS_SetCH701x(SiS_Pr,0x76,0xac);
8749        }
8750 
8751        SiS_SetCH701xForLCD(SiS_Pr);
8752 
8753        temp = SiS_GetCH701x(SiS_Pr,0x76);
8754        temp &= 0xfb;  /* Reset PLL */
8755        SiS_SetCH701x(SiS_Pr,0x76,temp);
8756        SiS_LongDelay(SiS_Pr, 2);
8757        temp = SiS_GetCH701x(SiS_Pr,0x76);
8758        temp |= 0x04;  /* PLL normal operation */
8759        SiS_SetCH701x(SiS_Pr,0x76,temp);
8760        if(SiS_Pr->ChipType == SIS_740) {
8761           SiS_SetCH701x(SiS_Pr,0x78,0xe0);      /* PLL loop filter */
8762        } else {
8763           SiS_SetCH701x(SiS_Pr,0x78,0x60);
8764        }
8765        SiS_LongDelay(SiS_Pr, 2);
8766     } while(0);
8767 
8768     SiS_SetCH701x(SiS_Pr,0x77,0x00);  /* MV? */
8769 }
8770 
8771 static void
8772 SiS_ChrontelDoSomething1(struct SiS_Private *SiS_Pr)
8773 {
8774      unsigned short temp;
8775 
8776      temp = SiS_GetCH701x(SiS_Pr,0x03);
8777      temp |= 0x80;      /* Set datapath 1 to TV   */
8778      temp &= 0xbf;      /* Set datapath 2 to LVDS */
8779      SiS_SetCH701x(SiS_Pr,0x03,temp);
8780 
8781      if(SiS_Pr->ChipType == SIS_740) {
8782 
8783         temp = SiS_GetCH701x(SiS_Pr,0x1c);
8784         temp &= 0xfb;   /* Normal XCLK phase */
8785         SiS_SetCH701x(SiS_Pr,0x1c,temp);
8786 
8787         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2d,0x03);
8788 
8789         temp = SiS_GetCH701x(SiS_Pr,0x64);
8790         temp |= 0x40;   /* ? Bit not defined */
8791         SiS_SetCH701x(SiS_Pr,0x64,temp);
8792 
8793         temp = SiS_GetCH701x(SiS_Pr,0x03);
8794         temp &= 0x3f;   /* D1 input to both LVDS and TV */
8795         SiS_SetCH701x(SiS_Pr,0x03,temp);
8796 
8797         if(SiS_Pr->SiS_CustomT == CUT_ASUSL3000D) {
8798            SiS_SetCH701x(SiS_Pr,0x63,0x40); /* LVDS off */
8799            SiS_LongDelay(SiS_Pr, 1);
8800            SiS_SetCH701x(SiS_Pr,0x63,0x00); /* LVDS on */
8801            SiS_ChrontelResetDB(SiS_Pr);
8802            SiS_ChrontelDoSomething2(SiS_Pr);
8803            SiS_ChrontelDoSomething3(SiS_Pr, 0);
8804         } else {
8805            temp = SiS_GetCH701x(SiS_Pr,0x66);
8806            if(temp != 0x45) {
8807               SiS_ChrontelResetDB(SiS_Pr);
8808               SiS_ChrontelDoSomething2(SiS_Pr);
8809               SiS_ChrontelDoSomething3(SiS_Pr, 0);
8810            }
8811         }
8812 
8813      } else { /* 650 */
8814 
8815         SiS_ChrontelResetDB(SiS_Pr);
8816         SiS_ChrontelDoSomething2(SiS_Pr);
8817         temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x34);
8818         SiS_ChrontelDoSomething3(SiS_Pr,temp);
8819         SiS_SetCH701x(SiS_Pr,0x76,0xaf);  /* All power on, LVDS normal operation */
8820 
8821      }
8822 
8823 }
8824 #endif  /* 315 series  */
8825 
8826 /*********************************************/
8827 /*      MAIN: SET CRT2 REGISTER GROUP        */
8828 /*********************************************/
8829 
8830 bool
8831 SiS_SetCRT2Group(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
8832 {
8833 #ifdef CONFIG_FB_SIS_300
8834    unsigned char  *ROMAddr  = SiS_Pr->VirtualRomBase;
8835 #endif
8836    unsigned short ModeIdIndex, RefreshRateTableIndex;
8837 
8838    SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
8839 
8840    if(!SiS_Pr->UseCustomMode) {
8841       SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex);
8842    } else {
8843       ModeIdIndex = 0;
8844    }
8845 
8846    /* Used for shifting CR33 */
8847    SiS_Pr->SiS_SelectCRT2Rate = 4;
8848 
8849    SiS_UnLockCRT2(SiS_Pr);
8850 
8851    RefreshRateTableIndex = SiS_GetRatePtr(SiS_Pr, ModeNo, ModeIdIndex);
8852 
8853    SiS_SaveCRT2Info(SiS_Pr,ModeNo);
8854 
8855    if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8856       SiS_DisableBridge(SiS_Pr);
8857       if((SiS_Pr->SiS_IF_DEF_LVDS == 1) && (SiS_Pr->ChipType == SIS_730)) {
8858          SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,0x80);
8859       }
8860       SiS_SetCRT2ModeRegs(SiS_Pr, ModeNo, ModeIdIndex);
8861    }
8862 
8863    if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) {
8864       SiS_LockCRT2(SiS_Pr);
8865       SiS_DisplayOn(SiS_Pr);
8866       return true;
8867    }
8868 
8869    SiS_GetCRT2Data(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8870 
8871    /* Set up Panel Link for LVDS and LCDA */
8872    SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_LCDVDES = 0;
8873    if( (SiS_Pr->SiS_IF_DEF_LVDS == 1) ||
8874        ((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) ||
8875        ((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_VBType & VB_SIS30xBLV)) ) {
8876       SiS_GetLVDSDesData(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8877    }
8878 
8879    if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8880       SiS_SetGroup1(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8881    }
8882 
8883    if(SiS_Pr->SiS_VBType & VB_SISVB) {
8884 
8885       if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8886 
8887          SiS_SetGroup2(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8888 #ifdef CONFIG_FB_SIS_315
8889          SiS_SetGroup2_C_ELV(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8890 #endif
8891          SiS_SetGroup3(SiS_Pr, ModeNo, ModeIdIndex);
8892          SiS_SetGroup4(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8893 #ifdef CONFIG_FB_SIS_315
8894          SiS_SetGroup4_C_ELV(SiS_Pr, ModeNo, ModeIdIndex);
8895 #endif
8896          SiS_SetGroup5(SiS_Pr, ModeNo, ModeIdIndex);
8897 
8898          SiS_SetCRT2Sync(SiS_Pr, ModeNo, RefreshRateTableIndex);
8899 
8900          /* For 301BDH (Panel link initialization): */
8901          if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) {
8902 
8903             if(!((SiS_Pr->SiS_SetFlag & SetDOSMode) && ((ModeNo == 0x03) || (ModeNo == 0x10)))) {
8904                if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
8905                   SiS_ModCRT1CRTC(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8906                }
8907             }
8908             SiS_SetCRT2ECLK(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8909          }
8910       }
8911 
8912    } else {
8913 
8914       SiS_SetCRT2Sync(SiS_Pr, ModeNo, RefreshRateTableIndex);
8915 
8916       SiS_ModCRT1CRTC(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex);
8917 
8918       SiS_SetCRT2ECLK(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex);
8919 
8920       if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8921          if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
8922             if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
8923                if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) {
8924 #ifdef CONFIG_FB_SIS_315
8925                   SiS_SetCH701xForLCD(SiS_Pr);
8926 #endif
8927                }
8928             }
8929             if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
8930                SiS_SetCHTVReg(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex);
8931             }
8932          }
8933       }
8934 
8935    }
8936 
8937 #ifdef CONFIG_FB_SIS_300
8938    if(SiS_Pr->ChipType < SIS_315H) {
8939       if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8940          if(SiS_Pr->SiS_UseOEM) {
8941             if((SiS_Pr->SiS_UseROM) && (SiS_Pr->SiS_UseOEM == -1)) {
8942                if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) {
8943                   SiS_OEM300Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8944                }
8945             } else {
8946                SiS_OEM300Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8947             }
8948          }
8949          if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
8950             if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) ||
8951                (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) {
8952                SetOEMLCDData2(SiS_Pr, ModeNo, ModeIdIndex,RefreshRateTableIndex);
8953             }
8954             SiS_DisplayOn(SiS_Pr);
8955          }
8956       }
8957    }
8958 #endif
8959 
8960 #ifdef CONFIG_FB_SIS_315
8961    if(SiS_Pr->ChipType >= SIS_315H) {
8962       if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8963          if(SiS_Pr->ChipType < SIS_661) {
8964             SiS_FinalizeLCD(SiS_Pr, ModeNo, ModeIdIndex);
8965             SiS_OEM310Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8966          } else {
8967             SiS_OEM661Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex);
8968          }
8969          SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x40);
8970       }
8971    }
8972 #endif
8973 
8974    if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8975       SiS_EnableBridge(SiS_Pr);
8976    }
8977 
8978    SiS_DisplayOn(SiS_Pr);
8979 
8980    if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) {
8981       if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
8982          /* Disable LCD panel when using TV */
8983          SiS_SetRegSR11ANDOR(SiS_Pr,0xFF,0x0C);
8984       } else {
8985          /* Disable TV when using LCD */
8986          SiS_SetCH70xxANDOR(SiS_Pr,0x0e,0x01,0xf8);
8987       }
8988    }
8989 
8990    if(SiS_Pr->SiS_SetFlag & LowModeTests) {
8991       SiS_LockCRT2(SiS_Pr);
8992    }
8993 
8994    return true;
8995 }
8996 
8997 
8998 /*********************************************/
8999 /*     ENABLE/DISABLE LCD BACKLIGHT (SIS)    */
9000 /*********************************************/
9001 
9002 void
9003 SiS_SiS30xBLOn(struct SiS_Private *SiS_Pr)
9004 {
9005   /* Switch on LCD backlight on SiS30xLV */
9006   SiS_DDC2Delay(SiS_Pr,0xff00);
9007   if(!(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x02)) {
9008      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x02);
9009      SiS_WaitVBRetrace(SiS_Pr);
9010   }
9011   if(!(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x01)) {
9012      SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x01);
9013   }
9014 }
9015 
9016 void
9017 SiS_SiS30xBLOff(struct SiS_Private *SiS_Pr)
9018 {
9019   /* Switch off LCD backlight on SiS30xLV */
9020   SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFE);
9021   SiS_DDC2Delay(SiS_Pr,0xff00);
9022 }
9023 
9024 /*********************************************/
9025 /*          DDC RELATED FUNCTIONS            */
9026 /*********************************************/
9027 
9028 static void
9029 SiS_SetupDDCN(struct SiS_Private *SiS_Pr)
9030 {
9031   SiS_Pr->SiS_DDC_NData = ~SiS_Pr->SiS_DDC_Data;
9032   SiS_Pr->SiS_DDC_NClk  = ~SiS_Pr->SiS_DDC_Clk;
9033   if((SiS_Pr->SiS_DDC_Index == 0x11) && (SiS_Pr->SiS_SensibleSR11)) {
9034      SiS_Pr->SiS_DDC_NData &= 0x0f;
9035      SiS_Pr->SiS_DDC_NClk  &= 0x0f;
9036   }
9037 }
9038 
9039 #ifdef CONFIG_FB_SIS_300
9040 static unsigned char *
9041 SiS_SetTrumpBlockLoop(struct SiS_Private *SiS_Pr, unsigned char *dataptr)
9042 {
9043   int i, j, num;
9044   unsigned short tempah,temp;
9045   unsigned char *mydataptr;
9046 
9047   for(i=0; i<20; i++) {                         /* Do 20 attempts to write */
9048      mydataptr = dataptr;
9049      num = *mydataptr++;
9050      if(!num) return mydataptr;
9051      if(i) {
9052         SiS_SetStop(SiS_Pr);
9053         SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT * 2);
9054      }
9055      if(SiS_SetStart(SiS_Pr)) continue;         /* Set start condition */
9056      tempah = SiS_Pr->SiS_DDC_DeviceAddr;
9057      temp = SiS_WriteDDC2Data(SiS_Pr,tempah);   /* Write DAB (S0=0=write) */
9058      if(temp) continue;                         /*    (ERROR: no ack) */
9059      tempah = *mydataptr++;
9060      temp = SiS_WriteDDC2Data(SiS_Pr,tempah);   /* Write register number */
9061      if(temp) continue;                         /*    (ERROR: no ack) */
9062      for(j=0; j<num; j++) {
9063         tempah = *mydataptr++;
9064         temp = SiS_WriteDDC2Data(SiS_Pr,tempah);/* Write DAB (S0=0=write) */
9065         if(temp) break;
9066      }
9067      if(temp) continue;
9068      if(SiS_SetStop(SiS_Pr)) continue;
9069      return mydataptr;
9070   }
9071   return NULL;
9072 }
9073 
9074 static bool
9075 SiS_SetTrumpionBlock(struct SiS_Private *SiS_Pr, unsigned char *dataptr)
9076 {
9077   SiS_Pr->SiS_DDC_DeviceAddr = 0xF0;            /* DAB (Device Address Byte) */
9078   SiS_Pr->SiS_DDC_Index = 0x11;                 /* Bit 0 = SC;  Bit 1 = SD */
9079   SiS_Pr->SiS_DDC_Data  = 0x02;                 /* Bitmask in IndexReg for Data */
9080   SiS_Pr->SiS_DDC_Clk   = 0x01;                 /* Bitmask in IndexReg for Clk */
9081   SiS_SetupDDCN(SiS_Pr);
9082 
9083   SiS_SetSwitchDDC2(SiS_Pr);
9084 
9085   while(*dataptr) {
9086      dataptr = SiS_SetTrumpBlockLoop(SiS_Pr, dataptr);
9087      if(!dataptr) return false;
9088   }
9089   return true;
9090 }
9091 #endif
9092 
9093 /* The Chrontel 700x is connected to the 630/730 via
9094  * the 630/730's DDC/I2C port.
9095  *
9096  * On 630(S)T chipset, the index changed from 0x11 to
9097  * 0x0a, possibly for working around the DDC problems
9098  */
9099 
9100 static bool
9101 SiS_SetChReg(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val, unsigned short myor)
9102 {
9103   unsigned short temp, i;
9104 
9105   for(i=0; i<20; i++) {                         /* Do 20 attempts to write */
9106      if(i) {
9107         SiS_SetStop(SiS_Pr);
9108         SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT * 4);
9109      }
9110      if(SiS_SetStart(SiS_Pr)) continue;                                 /* Set start condition */
9111      temp = SiS_WriteDDC2Data(SiS_Pr, SiS_Pr->SiS_DDC_DeviceAddr);      /* Write DAB (S0=0=write) */
9112      if(temp) continue;                                                 /*    (ERROR: no ack) */
9113      temp = SiS_WriteDDC2Data(SiS_Pr, (reg | myor));                    /* Write RAB (700x: set bit 7, see datasheet) */
9114      if(temp) continue;                                                 /*    (ERROR: no ack) */
9115      temp = SiS_WriteDDC2Data(SiS_Pr, val);                             /* Write data */
9116      if(temp) continue;                                                 /*    (ERROR: no ack) */
9117      if(SiS_SetStop(SiS_Pr)) continue;                                  /* Set stop condition */
9118      SiS_Pr->SiS_ChrontelInit = 1;
9119      return true;
9120   }
9121   return false;
9122 }
9123 
9124 /* Write to Chrontel 700x */
9125 void
9126 SiS_SetCH700x(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val)
9127 {
9128   SiS_Pr->SiS_DDC_DeviceAddr = 0xEA;            /* DAB (Device Address Byte) */
9129 
9130   SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT);
9131 
9132   if(!(SiS_Pr->SiS_ChrontelInit)) {
9133      SiS_Pr->SiS_DDC_Index = 0x11;              /* Bit 0 = SC;  Bit 1 = SD */
9134      SiS_Pr->SiS_DDC_Data  = 0x02;              /* Bitmask in IndexReg for Data */
9135      SiS_Pr->SiS_DDC_Clk   = 0x01;              /* Bitmask in IndexReg for Clk */
9136      SiS_SetupDDCN(SiS_Pr);
9137   }
9138 
9139   if( (!(SiS_SetChReg(SiS_Pr, reg, val, 0x80))) &&
9140       (!(SiS_Pr->SiS_ChrontelInit)) ) {
9141      SiS_Pr->SiS_DDC_Index = 0x0a;
9142      SiS_Pr->SiS_DDC_Data  = 0x80;
9143      SiS_Pr->SiS_DDC_Clk   = 0x40;
9144      SiS_SetupDDCN(SiS_Pr);
9145 
9146      SiS_SetChReg(SiS_Pr, reg, val, 0x80);
9147   }
9148 }
9149 
9150 /* Write to Chrontel 701x */
9151 /* Parameter is [Data (S15-S8) | Register no (S7-S0)] */
9152 void
9153 SiS_SetCH701x(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val)
9154 {
9155   SiS_Pr->SiS_DDC_Index = 0x11;                 /* Bit 0 = SC;  Bit 1 = SD */
9156   SiS_Pr->SiS_DDC_Data  = 0x08;                 /* Bitmask in IndexReg for Data */
9157   SiS_Pr->SiS_DDC_Clk   = 0x04;                 /* Bitmask in IndexReg for Clk */
9158   SiS_SetupDDCN(SiS_Pr);
9159   SiS_Pr->SiS_DDC_DeviceAddr = 0xEA;            /* DAB (Device Address Byte) */
9160   SiS_SetChReg(SiS_Pr, reg, val, 0);
9161 }
9162 
9163 static
9164 void
9165 SiS_SetCH70xx(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val)
9166 {
9167   if(SiS_Pr->SiS_IF_DEF_CH70xx == 1)
9168      SiS_SetCH700x(SiS_Pr, reg, val);
9169   else
9170      SiS_SetCH701x(SiS_Pr, reg, val);
9171 }
9172 
9173 static unsigned short
9174 SiS_GetChReg(struct SiS_Private *SiS_Pr, unsigned short myor)
9175 {
9176   unsigned short tempah, temp, i;
9177 
9178   for(i=0; i<20; i++) {                         /* Do 20 attempts to read */
9179      if(i) {
9180         SiS_SetStop(SiS_Pr);
9181         SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT * 4);
9182      }
9183      if(SiS_SetStart(SiS_Pr)) continue;                                 /* Set start condition */
9184      temp = SiS_WriteDDC2Data(SiS_Pr,SiS_Pr->SiS_DDC_DeviceAddr);       /* Write DAB (S0=0=write) */
9185      if(temp) continue;                                                 /*        (ERROR: no ack) */
9186      temp = SiS_WriteDDC2Data(SiS_Pr,SiS_Pr->SiS_DDC_ReadAddr | myor);  /* Write RAB (700x: | 0x80) */
9187      if(temp) continue;                                                 /*        (ERROR: no ack) */
9188      if (SiS_SetStart(SiS_Pr)) continue;                                /* Re-start */
9189      temp = SiS_WriteDDC2Data(SiS_Pr,SiS_Pr->SiS_DDC_DeviceAddr | 0x01);/* DAB (S0=1=read) */
9190      if(temp) continue;                                                 /*        (ERROR: no ack) */
9191      tempah = SiS_ReadDDC2Data(SiS_Pr);                                 /* Read byte */
9192      if(SiS_SetStop(SiS_Pr)) continue;                                  /* Stop condition */
9193      SiS_Pr->SiS_ChrontelInit = 1;
9194      return tempah;
9195   }
9196   return 0xFFFF;
9197 }
9198 
9199 /* Read from Chrontel 700x */
9200 /* Parameter is [Register no (S7-S0)] */
9201 unsigned short
9202 SiS_GetCH700x(struct SiS_Private *SiS_Pr, unsigned short tempbx)
9203 {
9204   unsigned short result;
9205 
9206   SiS_Pr->SiS_DDC_DeviceAddr = 0xEA;            /* DAB */
9207 
9208   SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT);
9209 
9210   if(!(SiS_Pr->SiS_ChrontelInit)) {
9211      SiS_Pr->SiS_DDC_Index = 0x11;              /* Bit 0 = SC;  Bit 1 = SD */
9212      SiS_Pr->SiS_DDC_Data  = 0x02;              /* Bitmask in IndexReg for Data */
9213      SiS_Pr->SiS_DDC_Clk   = 0x01;              /* Bitmask in IndexReg for Clk */
9214      SiS_SetupDDCN(SiS_Pr);
9215   }
9216 
9217   SiS_Pr->SiS_DDC_ReadAddr = tempbx;
9218 
9219   if( ((result = SiS_GetChReg(SiS_Pr,0x80)) == 0xFFFF) &&
9220       (!SiS_Pr->SiS_ChrontelInit) ) {
9221 
9222      SiS_Pr->SiS_DDC_Index = 0x0a;
9223      SiS_Pr->SiS_DDC_Data  = 0x80;
9224      SiS_Pr->SiS_DDC_Clk   = 0x40;
9225      SiS_SetupDDCN(SiS_Pr);
9226 
9227      result = SiS_GetChReg(SiS_Pr,0x80);
9228   }
9229   return result;
9230 }
9231 
9232 /* Read from Chrontel 701x */
9233 /* Parameter is [Register no (S7-S0)] */
9234 unsigned short
9235 SiS_GetCH701x(struct SiS_Private *SiS_Pr, unsigned short tempbx)
9236 {
9237   SiS_Pr->SiS_DDC_Index = 0x11;                 /* Bit 0 = SC;  Bit 1 = SD */
9238   SiS_Pr->SiS_DDC_Data  = 0x08;                 /* Bitmask in IndexReg for Data */
9239   SiS_Pr->SiS_DDC_Clk   = 0x04;                 /* Bitmask in IndexReg for Clk */
9240   SiS_SetupDDCN(SiS_Pr);
9241   SiS_Pr->SiS_DDC_DeviceAddr = 0xEA;            /* DAB */
9242 
9243   SiS_Pr->SiS_DDC_ReadAddr = tempbx;
9244 
9245   return SiS_GetChReg(SiS_Pr,0);
9246 }
9247 
9248 /* Read from Chrontel 70xx */
9249 /* Parameter is [Register no (S7-S0)] */
9250 static
9251 unsigned short
9252 SiS_GetCH70xx(struct SiS_Private *SiS_Pr, unsigned short tempbx)
9253 {
9254   if(SiS_Pr->SiS_IF_DEF_CH70xx == 1)
9255      return SiS_GetCH700x(SiS_Pr, tempbx);
9256   else
9257      return SiS_GetCH701x(SiS_Pr, tempbx);
9258 }
9259 
9260 void
9261 SiS_SetCH70xxANDOR(struct SiS_Private *SiS_Pr, unsigned short reg,
9262                 unsigned char myor, unsigned short myand)
9263 {
9264   unsigned short tempbl;
9265 
9266   tempbl = (SiS_GetCH70xx(SiS_Pr, (reg & 0xFF)) & myand) | myor;
9267   SiS_SetCH70xx(SiS_Pr, reg, tempbl);
9268 }
9269 
9270 /* Our own DDC functions */
9271 static
9272 unsigned short
9273 SiS_InitDDCRegs(struct SiS_Private *SiS_Pr, unsigned int VBFlags, int VGAEngine,
9274                 unsigned short adaptnum, unsigned short DDCdatatype, bool checkcr32,
9275                 unsigned int VBFlags2)
9276 {
9277      unsigned char ddcdtype[] = { 0xa0, 0xa0, 0xa0, 0xa2, 0xa6 };
9278      unsigned char flag, cr32;
9279      unsigned short        temp = 0, myadaptnum = adaptnum;
9280 
9281      if(adaptnum != 0) {
9282         if(!(VBFlags2 & VB2_SISTMDSBRIDGE)) return 0xFFFF;
9283         if((VBFlags2 & VB2_30xBDH) && (adaptnum == 1)) return 0xFFFF;
9284      }
9285 
9286      /* adapternum for SiS bridges: 0 = CRT1, 1 = LCD, 2 = VGA2 */
9287 
9288      SiS_Pr->SiS_ChrontelInit = 0;   /* force re-detection! */
9289 
9290      SiS_Pr->SiS_DDC_SecAddr = 0;
9291      SiS_Pr->SiS_DDC_DeviceAddr = ddcdtype[DDCdatatype];
9292      SiS_Pr->SiS_DDC_Port = SiS_Pr->SiS_P3c4;
9293      SiS_Pr->SiS_DDC_Index = 0x11;
9294      flag = 0xff;
9295 
9296      cr32 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x32);
9297 
9298 #if 0
9299      if(VBFlags2 & VB2_SISBRIDGE) {
9300         if(myadaptnum == 0) {
9301            if(!(cr32 & 0x20)) {
9302               myadaptnum = 2;
9303               if(!(cr32 & 0x10)) {
9304                  myadaptnum = 1;
9305                  if(!(cr32 & 0x08)) {
9306                     myadaptnum = 0;
9307                  }
9308               }
9309            }
9310         }
9311      }
9312 #endif
9313 
9314      if(VGAEngine == SIS_300_VGA) {             /* 300 series */
9315 
9316         if(myadaptnum != 0) {
9317            flag = 0;
9318            if(VBFlags2 & VB2_SISBRIDGE) {
9319               SiS_Pr->SiS_DDC_Port = SiS_Pr->SiS_Part4Port;
9320               SiS_Pr->SiS_DDC_Index = 0x0f;
9321            }
9322         }
9323 
9324         if(!(VBFlags2 & VB2_301)) {
9325            if((cr32 & 0x80) && (checkcr32)) {
9326               if(myadaptnum >= 1) {
9327                  if(!(cr32 & 0x08)) {
9328                      myadaptnum = 1;
9329                      if(!(cr32 & 0x10)) return 0xFFFF;
9330                  }
9331               }
9332            }
9333         }
9334 
9335         temp = 4 - (myadaptnum * 2);
9336         if(flag) temp = 0;
9337 
9338      } else {                                           /* 315/330 series */
9339 
9340         /* here we simplify: 0 = CRT1, 1 = CRT2 (VGA, LCD) */
9341 
9342         if(VBFlags2 & VB2_SISBRIDGE) {
9343            if(myadaptnum == 2) {
9344               myadaptnum = 1;
9345            }
9346         }
9347 
9348         if(myadaptnum == 1) {
9349            flag = 0;
9350            if(VBFlags2 & VB2_SISBRIDGE) {
9351               SiS_Pr->SiS_DDC_Port = SiS_Pr->SiS_Part4Port;
9352               SiS_Pr->SiS_DDC_Index = 0x0f;
9353            }
9354         }
9355 
9356         if((cr32 & 0x80) && (checkcr32)) {
9357            if(myadaptnum >= 1) {
9358               if(!(cr32 & 0x08)) {
9359                  myadaptnum = 1;
9360                  if(!(cr32 & 0x10)) return 0xFFFF;
9361               }
9362            }
9363         }
9364 
9365         temp = myadaptnum;
9366         if(myadaptnum == 1) {
9367            temp = 0;
9368            if(VBFlags2 & VB2_LVDS) flag = 0xff;
9369         }
9370 
9371         if(flag) temp = 0;
9372     }
9373 
9374     SiS_Pr->SiS_DDC_Data = 0x02 << temp;
9375     SiS_Pr->SiS_DDC_Clk  = 0x01 << temp;
9376 
9377     SiS_SetupDDCN(SiS_Pr);
9378 
9379     return 0;
9380 }
9381 
9382 static unsigned short
9383 SiS_WriteDABDDC(struct SiS_Private *SiS_Pr)
9384 {
9385    if(SiS_SetStart(SiS_Pr)) return 0xFFFF;
9386    if(SiS_WriteDDC2Data(SiS_Pr, SiS_Pr->SiS_DDC_DeviceAddr)) {
9387       return 0xFFFF;
9388    }
9389    if(SiS_WriteDDC2Data(SiS_Pr, SiS_Pr->SiS_DDC_SecAddr)) {
9390       return 0xFFFF;
9391    }
9392    return 0;
9393 }
9394 
9395 static unsigned short
9396 SiS_PrepareReadDDC(struct SiS_Private *SiS_Pr)
9397 {
9398    if(SiS_SetStart(SiS_Pr)) return 0xFFFF;
9399    if(SiS_WriteDDC2Data(SiS_Pr, (SiS_Pr->SiS_DDC_DeviceAddr | 0x01))) {
9400       return 0xFFFF;
9401    }
9402    return 0;
9403 }
9404 
9405 static unsigned short
9406 SiS_PrepareDDC(struct SiS_Private *SiS_Pr)
9407 {
9408    if(SiS_WriteDABDDC(SiS_Pr)) SiS_WriteDABDDC(SiS_Pr);
9409    if(SiS_PrepareReadDDC(SiS_Pr)) return (SiS_PrepareReadDDC(SiS_Pr));
9410    return 0;
9411 }
9412 
9413 static void
9414 SiS_SendACK(struct SiS_Private *SiS_Pr, unsigned short yesno)
9415 {
9416    SiS_SetSCLKLow(SiS_Pr);
9417    if(yesno) {
9418       SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9419                       SiS_Pr->SiS_DDC_Index,
9420                       SiS_Pr->SiS_DDC_NData,
9421                       SiS_Pr->SiS_DDC_Data);
9422    } else {
9423       SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9424                       SiS_Pr->SiS_DDC_Index,
9425                       SiS_Pr->SiS_DDC_NData,
9426                       0);
9427    }
9428    SiS_SetSCLKHigh(SiS_Pr);
9429 }
9430 
9431 static unsigned short
9432 SiS_DoProbeDDC(struct SiS_Private *SiS_Pr)
9433 {
9434     unsigned char mask, value;
9435     unsigned short  temp, ret=0;
9436     bool failed = false;
9437 
9438     SiS_SetSwitchDDC2(SiS_Pr);
9439     if(SiS_PrepareDDC(SiS_Pr)) {
9440          SiS_SetStop(SiS_Pr);
9441          return 0xFFFF;
9442     }
9443     mask = 0xf0;
9444     value = 0x20;
9445     if(SiS_Pr->SiS_DDC_DeviceAddr == 0xa0) {
9446        temp = (unsigned char)SiS_ReadDDC2Data(SiS_Pr);
9447        SiS_SendACK(SiS_Pr, 0);
9448        if(temp == 0) {
9449            mask = 0xff;
9450            value = 0xff;
9451        } else {
9452            failed = true;
9453            ret = 0xFFFF;
9454        }
9455     }
9456     if(!failed) {
9457        temp = (unsigned char)SiS_ReadDDC2Data(SiS_Pr);
9458        SiS_SendACK(SiS_Pr, 1);
9459        temp &= mask;
9460        if(temp == value) ret = 0;
9461        else {
9462           ret = 0xFFFF;
9463           if(SiS_Pr->SiS_DDC_DeviceAddr == 0xa0) {
9464              if(temp == 0x30) ret = 0;
9465           }
9466        }
9467     }
9468     SiS_SetStop(SiS_Pr);
9469     return ret;
9470 }
9471 
9472 static
9473 unsigned short
9474 SiS_ProbeDDC(struct SiS_Private *SiS_Pr)
9475 {
9476    unsigned short flag;
9477 
9478    flag = 0x180;
9479    SiS_Pr->SiS_DDC_DeviceAddr = 0xa0;
9480    if(!(SiS_DoProbeDDC(SiS_Pr))) flag |= 0x02;
9481    SiS_Pr->SiS_DDC_DeviceAddr = 0xa2;
9482    if(!(SiS_DoProbeDDC(SiS_Pr))) flag |= 0x08;
9483    SiS_Pr->SiS_DDC_DeviceAddr = 0xa6;
9484    if(!(SiS_DoProbeDDC(SiS_Pr))) flag |= 0x10;
9485    if(!(flag & 0x1a)) flag = 0;
9486    return flag;
9487 }
9488 
9489 static
9490 unsigned short
9491 SiS_ReadDDC(struct SiS_Private *SiS_Pr, unsigned short DDCdatatype, unsigned char *buffer)
9492 {
9493    unsigned short flag, length, i;
9494    unsigned char chksum,gotcha;
9495 
9496    if(DDCdatatype > 4) return 0xFFFF;
9497 
9498    flag = 0;
9499    SiS_SetSwitchDDC2(SiS_Pr);
9500    if(!(SiS_PrepareDDC(SiS_Pr))) {
9501       length = 127;
9502       if(DDCdatatype != 1) length = 255;
9503       chksum = 0;
9504       gotcha = 0;
9505       for(i=0; i<length; i++) {
9506          buffer[i] = (unsigned char)SiS_ReadDDC2Data(SiS_Pr);
9507          chksum += buffer[i];
9508          gotcha |= buffer[i];
9509          SiS_SendACK(SiS_Pr, 0);
9510       }
9511       buffer[i] = (unsigned char)SiS_ReadDDC2Data(SiS_Pr);
9512       chksum += buffer[i];
9513       SiS_SendACK(SiS_Pr, 1);
9514       if(gotcha) flag = (unsigned short)chksum;
9515       else flag = 0xFFFF;
9516    } else {
9517       flag = 0xFFFF;
9518    }
9519    SiS_SetStop(SiS_Pr);
9520    return flag;
9521 }
9522 
9523 /* Our private DDC functions
9524 
9525    It complies somewhat with the corresponding VESA function
9526    in arguments and return values.
9527 
9528    Since this is probably called before the mode is changed,
9529    we use our pre-detected pSiS-values instead of SiS_Pr as
9530    regards chipset and video bridge type.
9531 
9532    Arguments:
9533        adaptnum: 0=CRT1(analog), 1=CRT2/LCD(digital), 2=CRT2/VGA2(analog)
9534                  CRT2 DDC is only supported on SiS301, 301B, 301C, 302B.
9535                  LCDA is CRT1, but DDC is read from CRT2 port.
9536        DDCdatatype: 0=Probe, 1=EDID, 2=EDID+VDIF, 3=EDID V2 (P&D), 4=EDID V2 (FPDI-2)
9537        buffer: ptr to 256 data bytes which will be filled with read data.
9538 
9539    Returns 0xFFFF if error, otherwise
9540        if DDCdatatype > 0:  Returns 0 if reading OK (included a correct checksum)
9541        if DDCdatatype = 0:  Returns supported DDC modes
9542 
9543  */
9544 unsigned short
9545 SiS_HandleDDC(struct SiS_Private *SiS_Pr, unsigned int VBFlags, int VGAEngine,
9546               unsigned short adaptnum, unsigned short DDCdatatype, unsigned char *buffer,
9547               unsigned int VBFlags2)
9548 {
9549    unsigned char  sr1f, cr17=1;
9550    unsigned short result;
9551 
9552    if(adaptnum > 2)
9553       return 0xFFFF;
9554 
9555    if(DDCdatatype > 4)
9556       return 0xFFFF;
9557 
9558    if((!(VBFlags2 & VB2_VIDEOBRIDGE)) && (adaptnum > 0))
9559       return 0xFFFF;
9560 
9561    if(SiS_InitDDCRegs(SiS_Pr, VBFlags, VGAEngine, adaptnum, DDCdatatype, false, VBFlags2) == 0xFFFF)
9562       return 0xFFFF;
9563 
9564    sr1f = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1f);
9565    SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x1f,0x3f,0x04);
9566    if(VGAEngine == SIS_300_VGA) {
9567       cr17 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x17) & 0x80;
9568       if(!cr17) {
9569          SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x17,0x80);
9570          SiS_SetReg(SiS_Pr->SiS_P3c4,0x00,0x01);
9571          SiS_SetReg(SiS_Pr->SiS_P3c4,0x00,0x03);
9572       }
9573    }
9574    if((sr1f) || (!cr17)) {
9575       SiS_WaitRetrace1(SiS_Pr);
9576       SiS_WaitRetrace1(SiS_Pr);
9577       SiS_WaitRetrace1(SiS_Pr);
9578       SiS_WaitRetrace1(SiS_Pr);
9579    }
9580 
9581    if(DDCdatatype == 0) {
9582       result = SiS_ProbeDDC(SiS_Pr);
9583    } else {
9584       result = SiS_ReadDDC(SiS_Pr, DDCdatatype, buffer);
9585       if((!result) && (DDCdatatype == 1)) {
9586          if((buffer[0] == 0x00) && (buffer[1] == 0xff) &&
9587             (buffer[2] == 0xff) && (buffer[3] == 0xff) &&
9588             (buffer[4] == 0xff) && (buffer[5] == 0xff) &&
9589             (buffer[6] == 0xff) && (buffer[7] == 0x00) &&
9590             (buffer[0x12] == 1)) {
9591             if(!SiS_Pr->DDCPortMixup) {
9592                if(adaptnum == 1) {
9593                   if(!(buffer[0x14] & 0x80)) result = 0xFFFE;
9594                } else {
9595                   if(buffer[0x14] & 0x80)    result = 0xFFFE;
9596                }
9597             }
9598          }
9599       }
9600    }
9601    SiS_SetReg(SiS_Pr->SiS_P3c4,0x1f,sr1f);
9602    if(VGAEngine == SIS_300_VGA) {
9603       SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x17,0x7f,cr17);
9604    }
9605    return result;
9606 }
9607 
9608 /* Generic I2C functions for Chrontel & DDC --------- */
9609 
9610 static void
9611 SiS_SetSwitchDDC2(struct SiS_Private *SiS_Pr)
9612 {
9613   SiS_SetSCLKHigh(SiS_Pr);
9614   SiS_WaitRetrace1(SiS_Pr);
9615 
9616   SiS_SetSCLKLow(SiS_Pr);
9617   SiS_WaitRetrace1(SiS_Pr);
9618 }
9619 
9620 unsigned short
9621 SiS_ReadDDC1Bit(struct SiS_Private *SiS_Pr)
9622 {
9623    SiS_WaitRetrace1(SiS_Pr);
9624    return ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x11) & 0x02) >> 1);
9625 }
9626 
9627 /* Set I2C start condition */
9628 /* This is done by a SD high-to-low transition while SC is high */
9629 static unsigned short
9630 SiS_SetStart(struct SiS_Private *SiS_Pr)
9631 {
9632   if(SiS_SetSCLKLow(SiS_Pr)) return 0xFFFF;                     /* (SC->low)  */
9633   SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9634                   SiS_Pr->SiS_DDC_Index,
9635                   SiS_Pr->SiS_DDC_NData,
9636                   SiS_Pr->SiS_DDC_Data);                        /* SD->high */
9637   if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF;                    /* SC->high */
9638   SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9639                   SiS_Pr->SiS_DDC_Index,
9640                   SiS_Pr->SiS_DDC_NData,
9641                   0x00);                                        /* SD->low = start condition */
9642   if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF;                    /* (SC->low) */
9643   return 0;
9644 }
9645 
9646 /* Set I2C stop condition */
9647 /* This is done by a SD low-to-high transition while SC is high */
9648 static unsigned short
9649 SiS_SetStop(struct SiS_Private *SiS_Pr)
9650 {
9651   if(SiS_SetSCLKLow(SiS_Pr)) return 0xFFFF;                     /* (SC->low) */
9652   SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9653                   SiS_Pr->SiS_DDC_Index,
9654                   SiS_Pr->SiS_DDC_NData,
9655                   0x00);                                        /* SD->low   */
9656   if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF;                    /* SC->high  */
9657   SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9658                   SiS_Pr->SiS_DDC_Index,
9659                   SiS_Pr->SiS_DDC_NData,
9660                   SiS_Pr->SiS_DDC_Data);                        /* SD->high = stop condition */
9661   if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF;                    /* (SC->high) */
9662   return 0;
9663 }
9664 
9665 /* Write 8 bits of data */
9666 static unsigned short
9667 SiS_WriteDDC2Data(struct SiS_Private *SiS_Pr, unsigned short tempax)
9668 {
9669   unsigned short i,flag,temp;
9670 
9671   flag = 0x80;
9672   for(i = 0; i < 8; i++) {
9673     SiS_SetSCLKLow(SiS_Pr);                                     /* SC->low */
9674     if(tempax & flag) {
9675       SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9676                       SiS_Pr->SiS_DDC_Index,
9677                       SiS_Pr->SiS_DDC_NData,
9678                       SiS_Pr->SiS_DDC_Data);                    /* Write bit (1) to SD */
9679     } else {
9680       SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9681                       SiS_Pr->SiS_DDC_Index,
9682                       SiS_Pr->SiS_DDC_NData,
9683                       0x00);                                    /* Write bit (0) to SD */
9684     }
9685     SiS_SetSCLKHigh(SiS_Pr);                                    /* SC->high */
9686     flag >>= 1;
9687   }
9688   temp = SiS_CheckACK(SiS_Pr);                                  /* Check acknowledge */
9689   return temp;
9690 }
9691 
9692 static unsigned short
9693 SiS_ReadDDC2Data(struct SiS_Private *SiS_Pr)
9694 {
9695   unsigned short i, temp, getdata;
9696 
9697   getdata = 0;
9698   for(i = 0; i < 8; i++) {
9699     getdata <<= 1;
9700     SiS_SetSCLKLow(SiS_Pr);
9701     SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9702                     SiS_Pr->SiS_DDC_Index,
9703                     SiS_Pr->SiS_DDC_NData,
9704                     SiS_Pr->SiS_DDC_Data);
9705     SiS_SetSCLKHigh(SiS_Pr);
9706     temp = SiS_GetReg(SiS_Pr->SiS_DDC_Port,SiS_Pr->SiS_DDC_Index);
9707     if(temp & SiS_Pr->SiS_DDC_Data) getdata |= 0x01;
9708   }
9709   return getdata;
9710 }
9711 
9712 static unsigned short
9713 SiS_SetSCLKLow(struct SiS_Private *SiS_Pr)
9714 {
9715   SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9716                   SiS_Pr->SiS_DDC_Index,
9717                   SiS_Pr->SiS_DDC_NClk,
9718                   0x00);                                        /* SetSCLKLow()  */
9719   SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT);
9720   return 0;
9721 }
9722 
9723 static unsigned short
9724 SiS_SetSCLKHigh(struct SiS_Private *SiS_Pr)
9725 {
9726   unsigned short temp, watchdog=1000;
9727 
9728   SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9729                   SiS_Pr->SiS_DDC_Index,
9730                   SiS_Pr->SiS_DDC_NClk,
9731                   SiS_Pr->SiS_DDC_Clk);                         /* SetSCLKHigh()  */
9732   do {
9733     temp = SiS_GetReg(SiS_Pr->SiS_DDC_Port,SiS_Pr->SiS_DDC_Index);
9734   } while((!(temp & SiS_Pr->SiS_DDC_Clk)) && --watchdog);
9735   if (!watchdog) {
9736         return 0xFFFF;
9737   }
9738   SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT);
9739   return 0;
9740 }
9741 
9742 /* Check I2C acknowledge */
9743 /* Returns 0 if ack ok, non-0 if ack not ok */
9744 static unsigned short
9745 SiS_CheckACK(struct SiS_Private *SiS_Pr)
9746 {
9747   unsigned short tempah;
9748 
9749   SiS_SetSCLKLow(SiS_Pr);                                          /* (SC->low) */
9750   SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port,
9751                   SiS_Pr->SiS_DDC_Index,
9752                   SiS_Pr->SiS_DDC_NData,
9753                   SiS_Pr->SiS_DDC_Data);                           /* (SD->high) */
9754   SiS_SetSCLKHigh(SiS_Pr);                                         /* SC->high = clock impulse for ack */
9755   tempah = SiS_GetReg(SiS_Pr->SiS_DDC_Port,SiS_Pr->SiS_DDC_Index); /* Read SD */
9756   SiS_SetSCLKLow(SiS_Pr);                                          /* SC->low = end of clock impulse */
9757   if(tempah & SiS_Pr->SiS_DDC_Data) return 1;                      /* Ack OK if bit = 0 */
9758   return 0;
9759 }
9760 
9761 /* End of I2C functions ----------------------- */
9762 
9763 
9764 /* =============== SiS 315/330 O.E.M. ================= */
9765 
9766 #ifdef CONFIG_FB_SIS_315
9767 
9768 static unsigned short
9769 GetRAMDACromptr(struct SiS_Private *SiS_Pr)
9770 {
9771   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
9772   unsigned short romptr;
9773 
9774   if(SiS_Pr->ChipType < SIS_330) {
9775      romptr = SISGETROMW(0x128);
9776      if(SiS_Pr->SiS_VBType & VB_SIS30xB)
9777         romptr = SISGETROMW(0x12a);
9778   } else {
9779      romptr = SISGETROMW(0x1a8);
9780      if(SiS_Pr->SiS_VBType & VB_SIS30xB)
9781         romptr = SISGETROMW(0x1aa);
9782   }
9783   return romptr;
9784 }
9785 
9786 static unsigned short
9787 GetLCDromptr(struct SiS_Private *SiS_Pr)
9788 {
9789   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
9790   unsigned short romptr;
9791 
9792   if(SiS_Pr->ChipType < SIS_330) {
9793      romptr = SISGETROMW(0x120);
9794      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV)
9795         romptr = SISGETROMW(0x122);
9796   } else {
9797      romptr = SISGETROMW(0x1a0);
9798      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV)
9799         romptr = SISGETROMW(0x1a2);
9800   }
9801   return romptr;
9802 }
9803 
9804 static unsigned short
9805 GetTVromptr(struct SiS_Private *SiS_Pr)
9806 {
9807   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
9808   unsigned short romptr;
9809 
9810   if(SiS_Pr->ChipType < SIS_330) {
9811      romptr = SISGETROMW(0x114);
9812      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV)
9813         romptr = SISGETROMW(0x11a);
9814   } else {
9815      romptr = SISGETROMW(0x194);
9816      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV)
9817         romptr = SISGETROMW(0x19a);
9818   }
9819   return romptr;
9820 }
9821 
9822 static unsigned short
9823 GetLCDPtrIndexBIOS(struct SiS_Private *SiS_Pr)
9824 {
9825   unsigned short index;
9826 
9827   if((IS_SIS650) && (SiS_Pr->SiS_VBType & VB_SISLVDS)) {
9828      if(!(SiS_IsNotM650orLater(SiS_Pr))) {
9829         if((index = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) & 0xf0)) {
9830            index >>= 4;
9831            index *= 3;
9832            if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) index += 2;
9833            else if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) index++;
9834            return index;
9835         }
9836      }
9837   }
9838 
9839   index = SiS_GetBIOSLCDResInfo(SiS_Pr) & 0x0F;
9840   if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050)      index -= 5;
9841   if(SiS_Pr->SiS_VBType & VB_SIS301C) {  /* 1.15.20 and later (not VB specific) */
9842      if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) index -= 5;
9843      if(SiS_Pr->SiS_LCDResInfo == Panel_1280x768) index -= 5;
9844   } else {
9845      if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) index -= 6;
9846   }
9847   index--;
9848   index *= 3;
9849   if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) index += 2;
9850   else if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) index++;
9851   return index;
9852 }
9853 
9854 static unsigned short
9855 GetLCDPtrIndex(struct SiS_Private *SiS_Pr)
9856 {
9857   unsigned short index;
9858 
9859   index = ((SiS_GetBIOSLCDResInfo(SiS_Pr) & 0x0F) - 1) * 3;
9860   if(SiS_Pr->SiS_LCDInfo & DontExpandLCD)         index += 2;
9861   else if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) index++;
9862   return index;
9863 }
9864 
9865 static unsigned short
9866 GetTVPtrIndex(struct SiS_Private *SiS_Pr)
9867 {
9868   unsigned short index;
9869 
9870   index = 0;
9871   if(SiS_Pr->SiS_TVMode & TVSetPAL) index = 1;
9872   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) index = 2;
9873 
9874   if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) index = 0;
9875 
9876   index <<= 1;
9877 
9878   if((SiS_Pr->SiS_VBInfo & SetInSlaveMode) &&
9879      (SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) {
9880      index++;
9881   }
9882 
9883   return index;
9884 }
9885 
9886 static unsigned int
9887 GetOEMTVPtr661_2_GEN(struct SiS_Private *SiS_Pr, int addme)
9888 {
9889    unsigned short index = 0, temp = 0;
9890 
9891    if(SiS_Pr->SiS_TVMode & TVSetPAL)   index = 1;
9892    if(SiS_Pr->SiS_TVMode & TVSetPALM)  index = 2;
9893    if(SiS_Pr->SiS_TVMode & TVSetPALN)  index = 3;
9894    if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) index = 6;
9895    if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) {
9896       index = 4;
9897       if(SiS_Pr->SiS_TVMode & TVSetPALM)  index++;
9898       if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) index = 7;
9899    }
9900 
9901    if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
9902       if((!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) ||
9903          (SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) {
9904          index += addme;
9905          temp++;
9906       }
9907       temp += 0x0100;
9908    }
9909    return (unsigned int)(index | (temp << 16));
9910 }
9911 
9912 static unsigned int
9913 GetOEMTVPtr661_2_OLD(struct SiS_Private *SiS_Pr)
9914 {
9915    return (GetOEMTVPtr661_2_GEN(SiS_Pr, 8));
9916 }
9917 
9918 #if 0
9919 static unsigned int
9920 GetOEMTVPtr661_2_NEW(struct SiS_Private *SiS_Pr)
9921 {
9922    return (GetOEMTVPtr661_2_GEN(SiS_Pr, 6));
9923 }
9924 #endif
9925 
9926 static int
9927 GetOEMTVPtr661(struct SiS_Private *SiS_Pr)
9928 {
9929    int index = 0;
9930 
9931    if(SiS_Pr->SiS_TVMode & TVSetPAL)          index = 2;
9932    if(SiS_Pr->SiS_ROMNew) {
9933       if(SiS_Pr->SiS_TVMode & TVSetYPbPr525i) index = 4;
9934       if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) index = 6;
9935       if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) index = 8;
9936       if(SiS_Pr->SiS_TVMode & TVSetHiVision)  index = 10;
9937    } else {
9938       if(SiS_Pr->SiS_TVMode & TVSetHiVision)  index = 4;
9939       if(SiS_Pr->SiS_TVMode & TVSetYPbPr525i) index = 6;
9940       if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) index = 8;
9941       if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) index = 10;
9942    }
9943 
9944    if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) index++;
9945 
9946    return index;
9947 }
9948 
9949 static void
9950 SetDelayComp(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
9951 {
9952   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
9953   unsigned short delay=0,index,myindex,temp,romptr=0;
9954   bool dochiptest = true;
9955 
9956   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
9957      SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x20,0xbf);
9958   } else {
9959      SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x35,0x7f);
9960   }
9961 
9962   /* Find delay (from ROM, internal tables, PCI subsystem) */
9963 
9964   if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) {                    /* ------------ VGA */
9965 
9966      if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) {
9967         romptr = GetRAMDACromptr(SiS_Pr);
9968      }
9969      if(romptr) delay = ROMAddr[romptr];
9970      else {
9971         delay = 0x04;
9972         if(SiS_Pr->SiS_VBType & VB_SIS30xB) {
9973            if(IS_SIS650) {
9974               delay = 0x0a;
9975            } else if(IS_SIS740) {
9976               delay = 0x00;
9977            } else {
9978               delay = 0x0c;
9979            }
9980         } else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
9981            delay = 0x00;
9982         }
9983      }
9984 
9985   } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD|SetCRT2ToLCDA)) {  /* ---------- LCD/LCDA */
9986 
9987      bool gotitfrompci = false;
9988 
9989      /* Could we detect a PDC for LCD or did we get a user-defined? If yes, use it */
9990 
9991      if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
9992         if(SiS_Pr->PDC != -1) {
9993            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,((SiS_Pr->PDC >> 1) & 0x0f));
9994            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,0x7f,((SiS_Pr->PDC & 0x01) << 7));
9995            return;
9996         }
9997      } else {
9998         if(SiS_Pr->PDCA != -1) {
9999            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,((SiS_Pr->PDCA << 3) & 0xf0));
10000            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x20,0xbf,((SiS_Pr->PDCA & 0x01) << 6));
10001            return;
10002         }
10003      }
10004 
10005      /* Custom Panel? */
10006 
10007      if(SiS_Pr->SiS_LCDResInfo == Panel_Custom) {
10008         if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
10009            delay = 0x00;
10010            if((SiS_Pr->PanelXRes <= 1280) && (SiS_Pr->PanelYRes <= 1024)) {
10011               delay = 0x20;
10012            }
10013            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,delay);
10014         } else {
10015            delay = 0x0c;
10016            if(SiS_Pr->SiS_VBType & VB_SIS301C) {
10017               delay = 0x03;
10018               if((SiS_Pr->PanelXRes > 1280) && (SiS_Pr->PanelYRes > 1024)) {
10019                  delay = 0x00;
10020               }
10021            } else if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
10022               if(IS_SIS740) delay = 0x01;
10023               else          delay = 0x03;
10024            }
10025            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,delay);
10026         }
10027         return;
10028      }
10029 
10030      /* This is a piece of typical SiS crap: They code the OEM LCD
10031       * delay into the code, at no defined place in the BIOS.
10032       * We now have to start doing a PCI subsystem check here.
10033       */
10034 
10035      switch(SiS_Pr->SiS_CustomT) {
10036      case CUT_COMPAQ1280:
10037      case CUT_COMPAQ12802:
10038         if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) {
10039            gotitfrompci = true;
10040            dochiptest = false;
10041            delay = 0x03;
10042         }
10043         break;
10044      case CUT_CLEVO1400:
10045      case CUT_CLEVO14002:
10046         gotitfrompci = true;
10047         dochiptest = false;
10048         delay = 0x02;
10049         break;
10050      case CUT_CLEVO1024:
10051      case CUT_CLEVO10242:
10052         if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
10053            gotitfrompci = true;
10054            dochiptest = false;
10055            delay = 0x33;
10056            SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2D,delay);
10057            delay &= 0x0f;
10058         }
10059         break;
10060      }
10061 
10062      /* Could we find it through the PCI ID? If no, use ROM or table */
10063 
10064      if(!gotitfrompci) {
10065 
10066         index = GetLCDPtrIndexBIOS(SiS_Pr);
10067         myindex = GetLCDPtrIndex(SiS_Pr);
10068 
10069         if(IS_SIS650 && (SiS_Pr->SiS_VBType & VB_SISLVDS)) {
10070 
10071            if(SiS_IsNotM650orLater(SiS_Pr)) {
10072 
10073               if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) {
10074                  /* Always use the second pointer on 650; some BIOSes */
10075                  /* still carry old 301 data at the first location    */
10076                  /* romptr = SISGETROMW(0x120);                       */
10077                  /* if(SiS_Pr->SiS_VBType & VB_SIS302LV)              */
10078                  romptr = SISGETROMW(0x122);
10079                  if(!romptr) return;
10080                  delay = ROMAddr[(romptr + index)];
10081               } else {
10082                  delay = SiS310_LCDDelayCompensation_650301LV[myindex];
10083               }
10084 
10085           } else {
10086 
10087              delay = SiS310_LCDDelayCompensation_651301LV[myindex];
10088              if(SiS_Pr->SiS_VBType & (VB_SIS302LV | VB_SIS302ELV))
10089                 delay = SiS310_LCDDelayCompensation_651302LV[myindex];
10090 
10091           }
10092 
10093         } else if(SiS_Pr->SiS_UseROM                          &&
10094                   (!(SiS_Pr->SiS_ROMNew))                     &&
10095                   (SiS_Pr->SiS_LCDResInfo != Panel_1280x1024) &&
10096                   (SiS_Pr->SiS_LCDResInfo != Panel_1280x768)  &&
10097                   (SiS_Pr->SiS_LCDResInfo != Panel_1280x960)  &&
10098                   (SiS_Pr->SiS_LCDResInfo != Panel_1600x1200)  &&
10099                   ((romptr = GetLCDromptr(SiS_Pr)))) {
10100 
10101            /* Data for 1280x1024 wrong in 301B BIOS */
10102            /* Data for 1600x1200 wrong in 301C BIOS */
10103            delay = ROMAddr[(romptr + index)];
10104 
10105         } else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
10106 
10107            if(IS_SIS740) delay = 0x03;
10108            else          delay = 0x00;
10109 
10110         } else {
10111 
10112            delay = SiS310_LCDDelayCompensation_301[myindex];
10113            if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
10114               if(IS_SIS740) delay = 0x01;
10115               else if(SiS_Pr->ChipType <= SIS_315PRO) delay = SiS310_LCDDelayCompensation_3xx301LV[myindex];
10116               else          delay = SiS310_LCDDelayCompensation_650301LV[myindex];
10117            } else if(SiS_Pr->SiS_VBType & VB_SIS301C) {
10118               if(IS_SIS740) delay = 0x01;  /* ? */
10119               else          delay = 0x03;
10120               if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) delay = 0x00; /* experience */
10121            } else if(SiS_Pr->SiS_VBType & VB_SIS30xB) {
10122               if(IS_SIS740) delay = 0x01;
10123               else          delay = SiS310_LCDDelayCompensation_3xx301B[myindex];
10124            }
10125 
10126         }
10127 
10128      }  /* got it from PCI */
10129 
10130      if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
10131         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0x0F,((delay << 4) & 0xf0));
10132         dochiptest = false;
10133      }
10134 
10135   } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {                 /* ------------ TV */
10136 
10137      index = GetTVPtrIndex(SiS_Pr);
10138 
10139      if(IS_SIS650 && (SiS_Pr->SiS_VBType & VB_SISLVDS)) {
10140 
10141         if(SiS_IsNotM650orLater(SiS_Pr)) {
10142 
10143            if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) {
10144               /* Always use the second pointer on 650; some BIOSes */
10145               /* still carry old 301 data at the first location    */
10146               /* romptr = SISGETROMW(0x114);                       */
10147               /* if(SiS_Pr->SiS_VBType & VB_SIS302LV)              */
10148               romptr = SISGETROMW(0x11a);
10149               if(!romptr) return;
10150               delay = ROMAddr[romptr + index];
10151 
10152            } else {
10153 
10154               delay = SiS310_TVDelayCompensation_301B[index];
10155 
10156            }
10157 
10158         } else {
10159 
10160            switch(SiS_Pr->SiS_CustomT) {
10161            case CUT_COMPAQ1280:
10162            case CUT_COMPAQ12802:
10163            case CUT_CLEVO1400:
10164            case CUT_CLEVO14002:
10165               delay = 0x02;
10166               dochiptest = false;
10167               break;
10168            case CUT_CLEVO1024:
10169            case CUT_CLEVO10242:
10170               delay = 0x03;
10171               dochiptest = false;
10172               break;
10173            default:
10174               delay = SiS310_TVDelayCompensation_651301LV[index];
10175               if(SiS_Pr->SiS_VBType & VB_SIS302LV) {
10176                  delay = SiS310_TVDelayCompensation_651302LV[index];
10177               }
10178            }
10179         }
10180 
10181      } else if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) {
10182 
10183         romptr = GetTVromptr(SiS_Pr);
10184         if(!romptr) return;
10185         delay = ROMAddr[romptr + index];
10186 
10187      } else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
10188 
10189         delay = SiS310_TVDelayCompensation_LVDS[index];
10190 
10191      } else {
10192 
10193         delay = SiS310_TVDelayCompensation_301[index];
10194         if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
10195            if(IS_SIS740) {
10196               delay = SiS310_TVDelayCompensation_740301B[index];
10197               /* LV: use 301 data? BIOS bug? */
10198            } else {
10199               delay = SiS310_TVDelayCompensation_301B[index];
10200               if(SiS_Pr->SiS_VBType & VB_SIS301C) delay = 0x02;
10201            }
10202         }
10203 
10204      }
10205 
10206      if(SiS_LCDAEnabled(SiS_Pr)) {
10207         delay &= 0x0f;
10208         dochiptest = false;
10209      }
10210 
10211   } else return;
10212 
10213   /* Write delay */
10214 
10215   if(SiS_Pr->SiS_VBType & VB_SISVB) {
10216 
10217      if(IS_SIS650 && (SiS_Pr->SiS_VBType & VB_SISLVDS) && dochiptest) {
10218 
10219         temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) & 0xf0) >> 4;
10220         if(temp == 8) {         /* 1400x1050 BIOS (COMPAL) */
10221            delay &= 0x0f;
10222            delay |= 0xb0;
10223         } else if(temp == 6) {
10224            delay &= 0x0f;
10225            delay |= 0xc0;
10226         } else if(temp > 7) {   /* 1280x1024 BIOS (which one?) */
10227            delay = 0x35;
10228         }
10229         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2D,delay);
10230 
10231      } else {
10232 
10233         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0xF0,delay);
10234 
10235      }
10236 
10237   } else {  /* LVDS */
10238 
10239      if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
10240         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0xF0,delay);
10241      } else {
10242         if(IS_SIS650 && (SiS_Pr->SiS_IF_DEF_CH70xx != 0)) {
10243            delay <<= 4;
10244            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0x0F,delay);
10245         } else {
10246            SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0xF0,delay);
10247         }
10248      }
10249 
10250   }
10251 
10252 }
10253 
10254 static void
10255 SetAntiFlicker(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
10256 {
10257   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
10258   unsigned short index,temp,temp1,romptr=0;
10259 
10260   if(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p|TVSetYPbPr525p)) return;
10261 
10262   if(ModeNo<=0x13)
10263      index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].VB_StTVFlickerIndex;
10264   else
10265      index = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].VB_ExtTVFlickerIndex;
10266 
10267   temp = GetTVPtrIndex(SiS_Pr);
10268   temp >>= 1;     /* 0: NTSC/YPbPr, 1: PAL, 2: HiTV */
10269   temp1 = temp;
10270 
10271   if(SiS_Pr->SiS_UseROM && (!(SiS_Pr->SiS_ROMNew))) {
10272      if(SiS_Pr->ChipType >= SIS_661) {
10273         temp1 = GetOEMTVPtr661(SiS_Pr);
10274         temp1 >>= 1;
10275         romptr = SISGETROMW(0x260);
10276         if(SiS_Pr->ChipType >= SIS_760) {
10277            romptr = SISGETROMW(0x360);
10278         }
10279      } else if(SiS_Pr->ChipType >= SIS_330) {
10280         romptr = SISGETROMW(0x192);
10281      } else {
10282         romptr = SISGETROMW(0x112);
10283      }
10284   }
10285 
10286   if(romptr) {
10287      temp1 <<= 1;
10288      temp = ROMAddr[romptr + temp1 + index];
10289   } else {
10290      temp = SiS310_TVAntiFlick1[temp][index];
10291   }
10292   temp <<= 4;
10293 
10294   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x0A,0x8f,temp);  /* index 0A D[6:4] */
10295 }
10296 
10297 static void
10298 SetEdgeEnhance(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex)
10299 {
10300   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
10301   unsigned short index,temp,temp1,romptr=0;
10302 
10303   temp = temp1 = GetTVPtrIndex(SiS_Pr) >> 1;    /* 0: NTSC/YPbPr, 1: PAL, 2: HiTV */
10304 
10305   if(ModeNo <= 0x13)
10306      index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].VB_StTVEdgeIndex;
10307   else
10308      index = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].VB_ExtTVEdgeIndex;
10309 
10310   if(SiS_Pr->SiS_UseROM && (!(SiS_Pr->SiS_ROMNew))) {
10311      if(SiS_Pr->ChipType >= SIS_661) {
10312         romptr = SISGETROMW(0x26c);
10313         if(SiS_Pr->ChipType >= SIS_760) {
10314            romptr = SISGETROMW(0x36c);
10315         }
10316         temp1 = GetOEMTVPtr661(SiS_Pr);
10317         temp1 >>= 1;
10318      } else if(SiS_Pr->ChipType >= SIS_330) {
10319         romptr = SISGETROMW(0x1a4);
10320      } else {
10321         romptr = SISGETROMW(0x124);
10322      }
10323   }
10324 
10325   if(romptr) {
10326      temp1 <<= 1;
10327      temp = ROMAddr[romptr + temp1 + index];
10328   } else {
10329      temp = SiS310_TVEdge1[temp][index];
10330   }
10331   temp <<= 5;
10332   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x3A,0x1F,temp);  /* index 0A D[7:5] */
10333 }
10334 
10335 static void
10336 SetYFilter(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex)
10337 {
10338   unsigned short index, temp, i, j;
10339 
10340   if(ModeNo <= 0x13) {
10341      index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].VB_StTVYFilterIndex;
10342   } else {
10343      index = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].VB_ExtTVYFilterIndex;
10344   }
10345 
10346   temp = GetTVPtrIndex(SiS_Pr) >> 1;  /* 0: NTSC/YPbPr, 1: PAL, 2: HiTV */
10347 
10348   if(SiS_Pr->SiS_TVMode & TVSetNTSCJ)        temp = 1;  /* NTSC-J uses PAL */
10349   else if(SiS_Pr->SiS_TVMode & TVSetPALM)    temp = 3;  /* PAL-M */
10350   else if(SiS_Pr->SiS_TVMode & TVSetPALN)    temp = 4;  /* PAL-N */
10351   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) temp = 1;  /* HiVision uses PAL */
10352 
10353   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
10354      for(i=0x35, j=0; i<=0x38; i++, j++) {
10355         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVYFilter2[temp][index][j]);
10356      }
10357      for(i=0x48; i<=0x4A; i++, j++) {
10358         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVYFilter2[temp][index][j]);
10359      }
10360   } else {
10361      for(i=0x35, j=0; i<=0x38; i++, j++) {
10362         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVYFilter1[temp][index][j]);
10363      }
10364   }
10365 }
10366 
10367 static void
10368 SetPhaseIncr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
10369 {
10370   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
10371   unsigned short index,temp,i,j,resinfo,romptr=0;
10372   unsigned int  lindex;
10373 
10374   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) return;
10375 
10376   /* NTSC-J data not in BIOS, and already set in SetGroup2 */
10377   if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) return;
10378 
10379   if((SiS_Pr->ChipType >= SIS_661) || SiS_Pr->SiS_ROMNew) {
10380      lindex = GetOEMTVPtr661_2_OLD(SiS_Pr) & 0xffff;
10381      lindex <<= 2;
10382      for(j=0, i=0x31; i<=0x34; i++, j++) {
10383         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS_TVPhase[lindex + j]);
10384      }
10385      return;
10386   }
10387 
10388   /* PAL-M, PAL-N not in BIOS, and already set in SetGroup2 */
10389   if(SiS_Pr->SiS_TVMode & (TVSetPALM | TVSetPALN)) return;
10390 
10391   if(ModeNo<=0x13) {
10392      resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo;
10393   } else {
10394      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
10395   }
10396 
10397   temp = GetTVPtrIndex(SiS_Pr);
10398   /* 0: NTSC Graphics, 1: NTSC Text,    2: PAL Graphics,
10399    * 3: PAL Text,      4: HiTV Graphics 5: HiTV Text
10400    */
10401   if(SiS_Pr->SiS_UseROM) {
10402      romptr = SISGETROMW(0x116);
10403      if(SiS_Pr->ChipType >= SIS_330) {
10404         romptr = SISGETROMW(0x196);
10405      }
10406      if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
10407         romptr = SISGETROMW(0x11c);
10408         if(SiS_Pr->ChipType >= SIS_330) {
10409            romptr = SISGETROMW(0x19c);
10410         }
10411         if((SiS_Pr->SiS_VBInfo & SetInSlaveMode) && (!(SiS_Pr->SiS_TVMode & TVSetTVSimuMode))) {
10412            romptr = SISGETROMW(0x116);
10413            if(SiS_Pr->ChipType >= SIS_330) {
10414               romptr = SISGETROMW(0x196);
10415            }
10416         }
10417      }
10418   }
10419   if(romptr) {
10420      romptr += (temp << 2);
10421      for(j=0, i=0x31; i<=0x34; i++, j++) {
10422         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,ROMAddr[romptr + j]);
10423      }
10424   } else {
10425      index = temp % 2;
10426      temp >>= 1;          /* 0:NTSC, 1:PAL, 2:HiTV */
10427      for(j=0, i=0x31; i<=0x34; i++, j++) {
10428         if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV))
10429            SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVPhaseIncr1[temp][index][j]);
10430         else if((!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) || (SiS_Pr->SiS_TVMode & TVSetTVSimuMode))
10431            SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVPhaseIncr2[temp][index][j]);
10432         else
10433            SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVPhaseIncr1[temp][index][j]);
10434      }
10435   }
10436 
10437   if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) && (!(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision))) {
10438      if((!(SiS_Pr->SiS_TVMode & (TVSetPAL | TVSetYPbPr525p | TVSetYPbPr750p))) && (ModeNo > 0x13)) {
10439         if((resinfo == SIS_RI_640x480) ||
10440            (resinfo == SIS_RI_800x600)) {
10441            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x31,0x21);
10442            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x32,0xf0);
10443            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x33,0xf5);
10444            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x34,0x7f);
10445         } else if(resinfo == SIS_RI_1024x768) {
10446            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x31,0x1e);
10447            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x32,0x8b);
10448            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x33,0xfb);
10449            SiS_SetReg(SiS_Pr->SiS_Part2Port,0x34,0x7b);
10450         }
10451      }
10452   }
10453 }
10454 
10455 static void
10456 SetDelayComp661(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
10457                 unsigned short ModeIdIndex, unsigned short RTI)
10458 {
10459    unsigned short delay = 0, romptr = 0, index, lcdpdcindex;
10460    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
10461 
10462    if(!(SiS_Pr->SiS_VBInfo & (SetCRT2ToTV | SetCRT2ToLCD | SetCRT2ToLCDA | SetCRT2ToRAMDAC)))
10463       return;
10464 
10465    /* 1. New ROM: VGA2 and LCD/LCDA-Pass1:1 */
10466    /* (If a custom mode is used, Pass1:1 is always set; hence we do this:) */
10467 
10468    if(SiS_Pr->SiS_ROMNew) {
10469       if((SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)                         ||
10470          ((SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) &&
10471           (SiS_Pr->SiS_LCDInfo & LCDPass11))) {
10472          index = 25;
10473          if(SiS_Pr->UseCustomMode) {
10474             index = SiS_Pr->CSRClock;
10475          } else if(ModeNo > 0x13) {
10476             index = SiS_GetVCLK2Ptr(SiS_Pr,ModeNo,ModeIdIndex,RTI);
10477             index = SiS_Pr->SiS_VCLKData[index].CLOCK;
10478          }
10479          if(index < 25) index = 25;
10480          index = ((index / 25) - 1) << 1;
10481          if((ROMAddr[0x5b] & 0x80) || (SiS_Pr->SiS_VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToLCD))) {
10482             index++;
10483          }
10484          romptr = SISGETROMW(0x104);
10485          delay = ROMAddr[romptr + index];
10486          if(SiS_Pr->SiS_VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToLCD)) {
10487             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,((delay >> 1) & 0x0f));
10488             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,0x7f,((delay & 0x01) << 7));
10489          } else {
10490             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,((delay << 3) & 0xf0));
10491             SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x20,0xbf,((delay & 0x01) << 6));
10492          }
10493          return;
10494       }
10495    }
10496 
10497    /* 2. Old ROM: VGA2 and LCD/LCDA-Pass 1:1 */
10498 
10499    if(SiS_Pr->UseCustomMode) delay = 0x04;
10500    else if(ModeNo <= 0x13)   delay = 0x04;
10501    else                      delay = (SiS_Pr->SiS_RefIndex[RTI].Ext_PDC >> 4);
10502    delay |= (delay << 8);
10503 
10504    if(SiS_Pr->ChipType >= XGI_20) {
10505 
10506       delay = 0x0606;
10507       if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
10508 
10509          delay = 0x0404;
10510          if(SiS_Pr->SiS_XGIROM) {
10511              index = GetTVPtrIndex(SiS_Pr);
10512              if((romptr = SISGETROMW(0x35e))) {
10513                 delay = (ROMAddr[romptr + index] & 0x0f) << 1;
10514                 delay |= (delay << 8);
10515              }
10516          }
10517 
10518          if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) {
10519             if(SiS_Pr->ChipType == XGI_40 && SiS_Pr->ChipRevision == 0x02) {
10520                delay -= 0x0404;
10521             }
10522          }
10523       }
10524 
10525    } else if(SiS_Pr->ChipType >= SIS_340) {
10526 
10527       delay = 0x0606;
10528       if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
10529          delay = 0x0404;
10530       }
10531       /* TODO (eventually) */
10532 
10533    } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
10534 
10535       /* 3. TV */
10536 
10537       index = GetOEMTVPtr661(SiS_Pr);
10538       if(SiS_Pr->SiS_ROMNew) {
10539          romptr = SISGETROMW(0x106);
10540          if(SiS_Pr->SiS_VBType & VB_UMC) romptr += 12;
10541          delay = ROMAddr[romptr + index];
10542       } else {
10543          delay = 0x04;
10544          if(index > 3) delay = 0;
10545       }
10546 
10547    } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
10548 
10549       /* 4. LCD, LCDA (for new ROM only LV and non-Pass 1:1) */
10550 
10551       if( (SiS_Pr->SiS_LCDResInfo != Panel_Custom) &&
10552           ((romptr = GetLCDStructPtr661_2(SiS_Pr))) ) {
10553 
10554          lcdpdcindex = (SiS_Pr->SiS_VBType & VB_UMC) ? 14 : 12;
10555 
10556          /* For LVDS (and sometimes TMDS), the BIOS must know about the correct value */
10557          delay = ROMAddr[romptr + lcdpdcindex + 1];     /* LCD  */
10558          delay |= (ROMAddr[romptr + lcdpdcindex] << 8); /* LCDA */
10559 
10560       } else {
10561 
10562          /* TMDS: Set our own, since BIOS has no idea */
10563          /* (This is done on >=661 only, since <661 is calling this only for LVDS) */
10564          if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
10565             switch(SiS_Pr->SiS_LCDResInfo) {
10566             case Panel_1024x768:  delay = 0x0008; break;
10567             case Panel_1280x720:  delay = 0x0004; break;
10568             case Panel_1280x768:
10569             case Panel_1280x768_2:delay = 0x0004; break;
10570             case Panel_1280x800:
10571             case Panel_1280x800_2:delay = 0x0004; break; /* Verified for 1280x800 */
10572             case Panel_1280x854:  delay = 0x0004; break; /* FIXME */
10573             case Panel_1280x1024: delay = 0x1e04; break;
10574             case Panel_1400x1050: delay = 0x0004; break;
10575             case Panel_1600x1200: delay = 0x0400; break;
10576             case Panel_1680x1050: delay = 0x0e04; break;
10577             default:
10578                if((SiS_Pr->PanelXRes <= 1024) && (SiS_Pr->PanelYRes <= 768)) {
10579                   delay = 0x0008;
10580                } else if((SiS_Pr->PanelXRes == 1280) && (SiS_Pr->PanelYRes == 1024)) {
10581                   delay = 0x1e04;
10582                } else if((SiS_Pr->PanelXRes <= 1400) && (SiS_Pr->PanelYRes <= 1050)) {
10583                   delay = 0x0004;
10584                } else if((SiS_Pr->PanelXRes <= 1600) && (SiS_Pr->PanelYRes <= 1200)) {
10585                   delay = 0x0400;
10586                } else
10587                   delay = 0x0e04;
10588                break;
10589             }
10590          }
10591 
10592          /* Override by detected or user-set values */
10593          /* (but only if, for some reason, we can't read value from BIOS) */
10594          if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (SiS_Pr->PDC != -1)) {
10595             delay = SiS_Pr->PDC & 0x1f;
10596          }
10597          if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) && (SiS_Pr->PDCA != -1)) {
10598             delay = (SiS_Pr->PDCA & 0x1f) << 8;
10599          }
10600 
10601       }
10602 
10603    }
10604 
10605    if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
10606       delay >>= 8;
10607       SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,((delay << 3) & 0xf0));
10608       SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x20,0xbf,((delay & 0x01) << 6));
10609    } else {
10610       SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,((delay >> 1) & 0x0f));
10611       SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,0x7f,((delay & 0x01) << 7));
10612    }
10613 }
10614 
10615 static void
10616 SetCRT2SyncDither661(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short RTI)
10617 {
10618    unsigned short infoflag;
10619    unsigned char  temp;
10620 
10621    if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
10622 
10623       if(ModeNo <= 0x13) {
10624          infoflag = SiS_GetRegByte(SiS_Pr->SiS_P3ca+2);
10625       } else if(SiS_Pr->UseCustomMode) {
10626          infoflag = SiS_Pr->CInfoFlag;
10627       } else {
10628          infoflag = SiS_Pr->SiS_RefIndex[RTI].Ext_InfoFlag;
10629       }
10630 
10631       if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) {
10632          infoflag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37); /* No longer check D5 */
10633       }
10634 
10635       infoflag &= 0xc0;
10636 
10637       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
10638          temp = (infoflag >> 6) | 0x0c;
10639          if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) {
10640             temp ^= 0x04;
10641             if(SiS_Pr->SiS_ModeType >= Mode24Bpp) temp |= 0x10;
10642          }
10643          SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xe0,temp);
10644       } else {
10645          temp = 0x30;
10646          if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) temp = 0x20;
10647          temp |= infoflag;
10648          SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0f,temp);
10649          temp = 0;
10650          if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) {
10651             if(SiS_Pr->SiS_ModeType >= Mode24Bpp) temp |= 0x80;
10652          }
10653          SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x1a,0x7f,temp);
10654       }
10655 
10656    }
10657 }
10658 
10659 static void
10660 SetPanelParms661(struct SiS_Private *SiS_Pr)
10661 {
10662    unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
10663    unsigned short romptr, temp1, temp2;
10664 
10665    if(SiS_Pr->SiS_VBType & (VB_SISLVDS | VB_SIS30xC)) {
10666       SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x24,0x0f);
10667    }
10668 
10669    if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
10670       if(SiS_Pr->LVDSHL != -1) {
10671          SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,SiS_Pr->LVDSHL);
10672       }
10673    }
10674 
10675    if(SiS_Pr->SiS_ROMNew) {
10676 
10677       if((romptr = GetLCDStructPtr661_2(SiS_Pr))) {
10678          if(SiS_Pr->SiS_VBType & VB_SISLVDS) {
10679             temp1 = (ROMAddr[romptr] & 0x03) | 0x0c;
10680             temp2 = 0xfc;
10681             if(SiS_Pr->LVDSHL != -1) {
10682               temp1 &= 0xfc;
10683               temp2 = 0xf3;
10684             }
10685             SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,temp2,temp1);
10686          }
10687          if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
10688             temp1 = (ROMAddr[romptr + 1] & 0x80) >> 1;
10689             SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0d,0xbf,temp1);
10690          }
10691       }
10692 
10693    }
10694 }
10695 
10696 static void
10697 SiS_OEM310Setting(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, unsigned short RRTI)
10698 {
10699    if((SiS_Pr->SiS_ROMNew) && (SiS_Pr->SiS_VBType & VB_SISLVDS)) {
10700       SetDelayComp661(SiS_Pr, ModeNo, ModeIdIndex, RRTI);
10701       if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
10702          SetCRT2SyncDither661(SiS_Pr, ModeNo, RRTI);
10703          SetPanelParms661(SiS_Pr);
10704       }
10705    } else {
10706       SetDelayComp(SiS_Pr,ModeNo);
10707    }
10708 
10709    if((SiS_Pr->SiS_VBType & VB_SISVB) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) {
10710       SetAntiFlicker(SiS_Pr,ModeNo,ModeIdIndex);
10711       SetPhaseIncr(SiS_Pr,ModeNo,ModeIdIndex);
10712       SetYFilter(SiS_Pr,ModeNo,ModeIdIndex);
10713       if(SiS_Pr->SiS_VBType & VB_SIS301) {
10714          SetEdgeEnhance(SiS_Pr,ModeNo,ModeIdIndex);
10715       }
10716    }
10717 }
10718 
10719 static void
10720 SiS_OEM661Setting(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
10721                         unsigned short ModeIdIndex, unsigned short RRTI)
10722 {
10723    if(SiS_Pr->SiS_VBType & VB_SISVB) {
10724 
10725       SetDelayComp661(SiS_Pr, ModeNo, ModeIdIndex, RRTI);
10726 
10727       if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
10728          SetCRT2SyncDither661(SiS_Pr, ModeNo, RRTI);
10729          SetPanelParms661(SiS_Pr);
10730       }
10731 
10732       if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
10733          SetPhaseIncr(SiS_Pr, ModeNo, ModeIdIndex);
10734          SetYFilter(SiS_Pr, ModeNo, ModeIdIndex);
10735          SetAntiFlicker(SiS_Pr, ModeNo, ModeIdIndex);
10736          if(SiS_Pr->SiS_VBType & VB_SIS301) {
10737             SetEdgeEnhance(SiS_Pr, ModeNo, ModeIdIndex);
10738          }
10739       }
10740    }
10741 }
10742 
10743 /* FinalizeLCD
10744  * This finalizes some CRT2 registers for the very panel used.
10745  * If we have a backup if these registers, we use it; otherwise
10746  * we set the register according to most BIOSes. However, this
10747  * function looks quite different in every BIOS, so you better
10748  * pray that we have a backup...
10749  */
10750 static void
10751 SiS_FinalizeLCD(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
10752 {
10753   unsigned short tempcl,tempch,tempbl,tempbh,tempbx,tempax,temp;
10754   unsigned short resinfo,modeflag;
10755 
10756   if(!(SiS_Pr->SiS_VBType & VB_SISLVDS)) return;
10757   if(SiS_Pr->SiS_ROMNew) return;
10758 
10759   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
10760      if(SiS_Pr->LVDSHL != -1) {
10761         SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,SiS_Pr->LVDSHL);
10762      }
10763   }
10764 
10765   if(SiS_Pr->SiS_LCDResInfo == Panel_Custom) return;
10766   if(SiS_Pr->UseCustomMode) return;
10767 
10768   switch(SiS_Pr->SiS_CustomT) {
10769   case CUT_COMPAQ1280:
10770   case CUT_COMPAQ12802:
10771   case CUT_CLEVO1400:
10772   case CUT_CLEVO14002:
10773      return;
10774   }
10775 
10776   if(ModeNo <= 0x13) {
10777      resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo;
10778      modeflag =  SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
10779   } else {
10780      resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO;
10781      modeflag =  SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
10782   }
10783 
10784   if(IS_SIS650) {
10785      if(!(SiS_GetReg(SiS_Pr->SiS_P3d4, 0x5f) & 0xf0)) {
10786         if(SiS_Pr->SiS_CustomT == CUT_CLEVO1024) {
10787            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x02);
10788         } else {
10789            SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x03);
10790         }
10791      }
10792   }
10793 
10794   if(SiS_Pr->SiS_CustomT == CUT_CLEVO1024) {
10795      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
10796         /* Maybe all panels? */
10797         if(SiS_Pr->LVDSHL == -1) {
10798            SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,0x01);
10799         }
10800         return;
10801      }
10802   }
10803 
10804   if(SiS_Pr->SiS_CustomT == CUT_CLEVO10242) {
10805      if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
10806         if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
10807            if(SiS_Pr->LVDSHL == -1) {
10808               /* Maybe all panels? */
10809               SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,0x01);
10810            }
10811            if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
10812               tempch = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4;
10813               if(tempch == 3) {
10814                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02);
10815                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x25);
10816                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,0x00);
10817                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x1b);
10818               }
10819            }
10820            return;
10821         }
10822      }
10823   }
10824 
10825   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) {
10826      if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
10827         if(SiS_Pr->SiS_VBType & VB_SISEMI) {
10828            SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2a,0x00);
10829 #ifdef SET_EMI
10830            SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c);
10831 #endif
10832            SiS_SetReg(SiS_Pr->SiS_Part4Port,0x34,0x10);
10833         }
10834      } else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) {
10835         if(SiS_Pr->LVDSHL == -1) {
10836            /* Maybe ACER only? */
10837            SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,0x01);
10838         }
10839      }
10840      tempch = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4;
10841      if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
10842         if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) {
10843            SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1f,0x76);
10844         } else if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
10845            if(tempch == 0x03) {
10846               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02);
10847               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x25);
10848               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,0x00);
10849               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x1b);
10850            }
10851            if(SiS_Pr->Backup && (SiS_Pr->Backup_Mode == ModeNo)) {
10852               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,SiS_Pr->Backup_14);
10853               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x15,SiS_Pr->Backup_15);
10854               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,SiS_Pr->Backup_16);
10855               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x17,SiS_Pr->Backup_17);
10856               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,SiS_Pr->Backup_18);
10857               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,SiS_Pr->Backup_19);
10858               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1a,SiS_Pr->Backup_1a);
10859               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,SiS_Pr->Backup_1b);
10860               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,SiS_Pr->Backup_1c);
10861               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,SiS_Pr->Backup_1d);
10862            } else if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) {  /* 1.10.8w */
10863               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,0x90);
10864               if(ModeNo <= 0x13) {
10865                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x11);
10866                  if((resinfo == 0) || (resinfo == 2)) return;
10867                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x18);
10868                  if((resinfo == 1) || (resinfo == 3)) return;
10869               }
10870               SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02);
10871               if((ModeNo > 0x13) && (resinfo == SIS_RI_1024x768)) {
10872                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02);  /* 1.10.7u */
10873 #if 0
10874                  tempbx = 806;  /* 0x326 */                      /* other older BIOSes */
10875                  tempbx--;
10876                  temp = tempbx & 0xff;
10877                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,temp);
10878                  temp = (tempbx >> 8) & 0x03;
10879                  SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x1d,0xf8,temp);
10880 #endif
10881               }
10882            } else if(ModeNo <= 0x13) {
10883               if(ModeNo <= 1) {
10884                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x70);
10885                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0xff);
10886                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x48);
10887                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x12);
10888               }
10889               if(!(modeflag & HalfDCLK)) {
10890                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,0x20);
10891                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x15,0x1a);
10892                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,0x28);
10893                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x17,0x00);
10894                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x4c);
10895                  SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0xdc);
10896                  if(ModeNo == 0x12) {
10897                     switch(tempch) {
10898                        case 0:
10899                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x95);
10900                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0xdc);
10901                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1a,0x10);
10902                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x95);
10903                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,0x48);
10904                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x12);
10905                           break;
10906                        case 2:
10907                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x95);
10908                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x48);
10909                           break;
10910                        case 3:
10911                           SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x95);
10912                           break;
10913                     }
10914                  }
10915               }
10916            }
10917         }
10918      } else {
10919         tempcl = tempbh = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x01);
10920         tempcl &= 0x0f;
10921         tempbh &= 0x70;
10922         tempbh >>= 4;
10923         tempbl = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x04);
10924         tempbx = (tempbh << 8) | tempbl;
10925         if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
10926            if((resinfo == SIS_RI_1024x768) || (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD))) {
10927               if(SiS_Pr->SiS_SetFlag & LCDVESATiming) {
10928                  tempbx = 770;
10929               } else {
10930                  if(tempbx > 770) tempbx = 770;
10931                  if(SiS_Pr->SiS_VGAVDE < 600) {
10932                     tempax = 768 - SiS_Pr->SiS_VGAVDE;
10933                     tempax >>= 4;                                /* 1.10.7w; 1.10.6s: 3;  */
10934                     if(SiS_Pr->SiS_VGAVDE <= 480)  tempax >>= 4; /* 1.10.7w; 1.10.6s: < 480; >>=1; */
10935                     tempbx -= tempax;
10936                  }
10937               }
10938            } else return;
10939         }
10940         temp = tempbx & 0xff;
10941         SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,temp);
10942         temp = ((tempbx & 0xff00) >> 4) | tempcl;
10943         SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x01,0x80,temp);
10944      }
10945   }
10946 }
10947 
10948 #endif
10949 
10950 /*  =================  SiS 300 O.E.M. ================== */
10951 
10952 #ifdef CONFIG_FB_SIS_300
10953 
10954 static void
10955 SetOEMLCDData2(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex,
10956                 unsigned short RefTabIndex)
10957 {
10958   unsigned short crt2crtc=0, modeflag, myindex=0;
10959   unsigned char  temp;
10960   int i;
10961 
10962   if(ModeNo <= 0x13) {
10963      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
10964      crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
10965   } else {
10966      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
10967      crt2crtc = SiS_Pr->SiS_RefIndex[RefTabIndex].Ext_CRT2CRTC;
10968   }
10969 
10970   crt2crtc &= 0x3f;
10971 
10972   if(SiS_Pr->SiS_CustomT == CUT_BARCO1024) {
10973      SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xdf);
10974   }
10975 
10976   if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) {
10977      if(modeflag & HalfDCLK) myindex = 1;
10978 
10979      if(SiS_Pr->SiS_SetFlag & LowModeTests) {
10980         for(i=0; i<7; i++) {
10981            if(barco_p1[myindex][crt2crtc][i][0]) {
10982               SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,
10983                               barco_p1[myindex][crt2crtc][i][0],
10984                               barco_p1[myindex][crt2crtc][i][2],
10985                               barco_p1[myindex][crt2crtc][i][1]);
10986            }
10987         }
10988      }
10989      temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00);
10990      if(temp & 0x80) {
10991         temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x18);
10992         temp++;
10993         SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,temp);
10994      }
10995   }
10996 }
10997 
10998 static unsigned short
10999 GetOEMLCDPtr(struct SiS_Private *SiS_Pr, int Flag)
11000 {
11001   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
11002   unsigned short tempbx=0,romptr=0;
11003   static const unsigned char customtable300[] = {
11004         0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
11005         0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
11006   };
11007   static const unsigned char customtable630[] = {
11008         0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
11009         0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
11010   };
11011 
11012   if(SiS_Pr->ChipType == SIS_300) {
11013 
11014     tempbx = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) & 0x0f;
11015     if(SiS_Pr->SiS_VBType & VB_SIS301) tempbx &= 0x07;
11016     tempbx -= 2;
11017     if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx += 4;
11018     if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) {
11019        if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx += 3;
11020     }
11021     if(SiS_Pr->SiS_UseROM) {
11022        if(ROMAddr[0x235] & 0x80) {
11023           tempbx = SiS_Pr->SiS_LCDTypeInfo;
11024           if(Flag) {
11025              romptr = SISGETROMW(0x255);
11026              if(romptr) tempbx = ROMAddr[romptr + SiS_Pr->SiS_LCDTypeInfo];
11027              else       tempbx = customtable300[SiS_Pr->SiS_LCDTypeInfo];
11028              if(tempbx == 0xFF) return 0xFFFF;
11029           }
11030           tempbx <<= 1;
11031           if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx++;
11032        }
11033     }
11034 
11035   } else {
11036 
11037     if(Flag) {
11038        if(SiS_Pr->SiS_UseROM) {
11039           romptr = SISGETROMW(0x255);
11040           if(romptr) tempbx = ROMAddr[romptr + SiS_Pr->SiS_LCDTypeInfo];
11041           else       tempbx = 0xff;
11042        } else {
11043           tempbx = customtable630[SiS_Pr->SiS_LCDTypeInfo];
11044        }
11045        if(tempbx == 0xFF) return 0xFFFF;
11046        tempbx <<= 2;
11047        if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) tempbx += 2;
11048        if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++;
11049        return tempbx;
11050     }
11051     tempbx = SiS_Pr->SiS_LCDTypeInfo << 2;
11052     if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) tempbx += 2;
11053     if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++;
11054 
11055   }
11056 
11057   return tempbx;
11058 }
11059 
11060 static void
11061 SetOEMLCDDelay(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex)
11062 {
11063   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
11064   unsigned short index,temp,romptr=0;
11065 
11066   if(SiS_Pr->SiS_LCDResInfo == Panel_Custom) return;
11067 
11068   if(SiS_Pr->SiS_UseROM) {
11069      if(!(ROMAddr[0x237] & 0x01)) return;
11070      if(!(ROMAddr[0x237] & 0x02)) return;
11071      romptr = SISGETROMW(0x24b);
11072   }
11073 
11074   /* The Panel Compensation Delay should be set according to tables
11075    * here. Unfortunately, various BIOS versions don't care about
11076    * a uniform way using eg. ROM byte 0x220, but use different
11077    * hard coded delays (0x04, 0x20, 0x18) in SetGroup1().
11078    * Thus we don't set this if the user selected a custom pdc or if
11079    * we otherwise detected a valid pdc.
11080    */
11081   if(SiS_Pr->PDC != -1) return;
11082 
11083   temp = GetOEMLCDPtr(SiS_Pr, 0);
11084 
11085   if(SiS_Pr->UseCustomMode)
11086      index = 0;
11087   else
11088      index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_LCDDelayIndex;
11089 
11090   if(SiS_Pr->ChipType != SIS_300) {
11091      if(romptr) {
11092         romptr += (temp * 2);
11093         romptr = SISGETROMW(romptr);
11094         romptr += index;
11095         temp = ROMAddr[romptr];
11096      } else {
11097         if(SiS_Pr->SiS_VBType & VB_SISVB) {
11098            temp = SiS300_OEMLCDDelay2[temp][index];
11099         } else {
11100            temp = SiS300_OEMLCDDelay3[temp][index];
11101         }
11102      }
11103   } else {
11104      if(SiS_Pr->SiS_UseROM && (ROMAddr[0x235] & 0x80)) {
11105         if(romptr) {
11106            romptr += (temp * 2);
11107            romptr = SISGETROMW(romptr);
11108            romptr += index;
11109            temp = ROMAddr[romptr];
11110         } else {
11111            temp = SiS300_OEMLCDDelay5[temp][index];
11112         }
11113      } else {
11114         if(SiS_Pr->SiS_UseROM) {
11115            romptr = ROMAddr[0x249] | (ROMAddr[0x24a] << 8);
11116            if(romptr) {
11117               romptr += (temp * 2);
11118               romptr = SISGETROMW(romptr);
11119               romptr += index;
11120               temp = ROMAddr[romptr];
11121            } else {
11122               temp = SiS300_OEMLCDDelay4[temp][index];
11123            }
11124         } else {
11125            temp = SiS300_OEMLCDDelay4[temp][index];
11126         }
11127      }
11128   }
11129   temp &= 0x3c;
11130   SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,~0x3C,temp);  /* index 0A D[6:4] */
11131 }
11132 
11133 static void
11134 SetOEMLCDData(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
11135 {
11136 #if 0  /* Unfinished; Data table missing */
11137   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
11138   unsigned short index,temp;
11139 
11140   if((SiS_Pr->SiS_UseROM) {
11141      if(!(ROMAddr[0x237] & 0x01)) return;
11142      if(!(ROMAddr[0x237] & 0x04)) return;
11143      /* No rom pointer in BIOS header! */
11144   }
11145 
11146   temp = GetOEMLCDPtr(SiS_Pr, 1);
11147   if(temp == 0xFFFF) return;
11148 
11149   index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex]._VB_LCDHIndex;
11150   for(i=0x14, j=0; i<=0x17; i++, j++) {
11151       SiS_SetReg(SiS_Pr->SiS_Part1Port,i,SiS300_LCDHData[temp][index][j]);
11152   }
11153   SiS_SetRegANDOR(SiS_SiS_Part1Port,0x1a, 0xf8, (SiS300_LCDHData[temp][index][j] & 0x07));
11154 
11155   index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex]._VB_LCDVIndex;
11156   SiS_SetReg(SiS_SiS_Part1Port,0x18, SiS300_LCDVData[temp][index][0]);
11157   SiS_SetRegANDOR(SiS_SiS_Part1Port,0x19, 0xF0, SiS300_LCDVData[temp][index][1]);
11158   SiS_SetRegANDOR(SiS_SiS_Part1Port,0x1A, 0xC7, (SiS300_LCDVData[temp][index][2] & 0x38));
11159   for(i=0x1b, j=3; i<=0x1d; i++, j++) {
11160       SiS_SetReg(SiS_Pr->SiS_Part1Port,i,SiS300_LCDVData[temp][index][j]);
11161   }
11162 #endif
11163 }
11164 
11165 static unsigned short
11166 GetOEMTVPtr(struct SiS_Private *SiS_Pr)
11167 {
11168   unsigned short index;
11169 
11170   index = 0;
11171   if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode))  index += 4;
11172   if(SiS_Pr->SiS_VBType & VB_SISVB) {
11173      if(SiS_Pr->SiS_VBInfo & SetCRT2ToSCART)  index += 2;
11174      else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) index += 3;
11175      else if(SiS_Pr->SiS_TVMode & TVSetPAL)   index += 1;
11176   } else {
11177      if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) index += 2;
11178      if(SiS_Pr->SiS_TVMode & TVSetPAL)        index += 1;
11179   }
11180   return index;
11181 }
11182 
11183 static void
11184 SetOEMTVDelay(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
11185 {
11186   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
11187   unsigned short index,temp,romptr=0;
11188 
11189   if(SiS_Pr->SiS_UseROM) {
11190      if(!(ROMAddr[0x238] & 0x01)) return;
11191      if(!(ROMAddr[0x238] & 0x02)) return;
11192      romptr = SISGETROMW(0x241);
11193   }
11194 
11195   temp = GetOEMTVPtr(SiS_Pr);
11196 
11197   index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVDelayIndex;
11198 
11199   if(romptr) {
11200      romptr += (temp * 2);
11201      romptr = SISGETROMW(romptr);
11202      romptr += index;
11203      temp = ROMAddr[romptr];
11204   } else {
11205      if(SiS_Pr->SiS_VBType & VB_SISVB) {
11206         temp = SiS300_OEMTVDelay301[temp][index];
11207      } else {
11208         temp = SiS300_OEMTVDelayLVDS[temp][index];
11209      }
11210   }
11211   temp &= 0x3c;
11212   SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,~0x3C,temp);
11213 }
11214 
11215 static void
11216 SetOEMAntiFlicker(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
11217 {
11218   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
11219   unsigned short index,temp,romptr=0;
11220 
11221   if(SiS_Pr->SiS_UseROM) {
11222      if(!(ROMAddr[0x238] & 0x01)) return;
11223      if(!(ROMAddr[0x238] & 0x04)) return;
11224      romptr = SISGETROMW(0x243);
11225   }
11226 
11227   temp = GetOEMTVPtr(SiS_Pr);
11228 
11229   index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVFlickerIndex;
11230 
11231   if(romptr) {
11232      romptr += (temp * 2);
11233      romptr = SISGETROMW(romptr);
11234      romptr += index;
11235      temp = ROMAddr[romptr];
11236   } else {
11237      temp = SiS300_OEMTVFlicker[temp][index];
11238   }
11239   temp &= 0x70;
11240   SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x0A,0x8F,temp);
11241 }
11242 
11243 static void
11244 SetOEMPhaseIncr(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex)
11245 {
11246   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
11247   unsigned short index,i,j,temp,romptr=0;
11248 
11249   if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) return;
11250 
11251   if(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSetNTSCJ | TVSetPALM | TVSetPALN)) return;
11252 
11253   if(SiS_Pr->SiS_UseROM) {
11254      if(!(ROMAddr[0x238] & 0x01)) return;
11255      if(!(ROMAddr[0x238] & 0x08)) return;
11256      romptr = SISGETROMW(0x245);
11257   }
11258 
11259   temp = GetOEMTVPtr(SiS_Pr);
11260 
11261   index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVPhaseIndex;
11262 
11263   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
11264      for(i=0x31, j=0; i<=0x34; i++, j++) {
11265         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Phase2[temp][index][j]);
11266      }
11267   } else {
11268      if(romptr) {
11269         romptr += (temp * 2);
11270         romptr = SISGETROMW(romptr);
11271         romptr += (index * 4);
11272         for(i=0x31, j=0; i<=0x34; i++, j++) {
11273            SiS_SetReg(SiS_Pr->SiS_Part2Port,i,ROMAddr[romptr + j]);
11274         }
11275      } else {
11276         for(i=0x31, j=0; i<=0x34; i++, j++) {
11277            SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Phase1[temp][index][j]);
11278         }
11279      }
11280   }
11281 }
11282 
11283 static void
11284 SetOEMYFilter(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex)
11285 {
11286   unsigned char  *ROMAddr = SiS_Pr->VirtualRomBase;
11287   unsigned short index,temp,i,j,romptr=0;
11288 
11289   if(SiS_Pr->SiS_VBInfo & (SetCRT2ToSCART | SetCRT2ToHiVision | SetCRT2ToYPbPr525750)) return;
11290 
11291   if(SiS_Pr->SiS_UseROM) {
11292      if(!(ROMAddr[0x238] & 0x01)) return;
11293      if(!(ROMAddr[0x238] & 0x10)) return;
11294      romptr = SISGETROMW(0x247);
11295   }
11296 
11297   temp = GetOEMTVPtr(SiS_Pr);
11298 
11299   if(SiS_Pr->SiS_TVMode & TVSetPALM)      temp = 8;
11300   else if(SiS_Pr->SiS_TVMode & TVSetPALN) temp = 9;
11301   /* NTSCJ uses NTSC filters */
11302 
11303   index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVYFilterIndex;
11304 
11305   if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) {
11306       for(i=0x35, j=0; i<=0x38; i++, j++) {
11307         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Filter2[temp][index][j]);
11308       }
11309       for(i=0x48; i<=0x4A; i++, j++) {
11310         SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Filter2[temp][index][j]);
11311       }
11312   } else {
11313       if((romptr) && (!(SiS_Pr->SiS_TVMode & (TVSetPALM|TVSetPALN)))) {
11314          romptr += (temp * 2);
11315          romptr = SISGETROMW(romptr);
11316          romptr += (index * 4);
11317          for(i=0x35, j=0; i<=0x38; i++, j++) {
11318             SiS_SetReg(SiS_Pr->SiS_Part2Port,i,ROMAddr[romptr + j]);
11319          }
11320       } else {
11321          for(i=0x35, j=0; i<=0x38; i++, j++) {
11322             SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Filter1[temp][index][j]);
11323          }
11324       }
11325   }
11326 }
11327 
11328 static unsigned short
11329 SiS_SearchVBModeID(struct SiS_Private *SiS_Pr, unsigned short *ModeNo)
11330 {
11331    unsigned short ModeIdIndex;
11332    unsigned char  VGAINFO = SiS_Pr->SiS_VGAINFO;
11333 
11334    if(*ModeNo <= 5) *ModeNo |= 1;
11335 
11336    for(ModeIdIndex=0; ; ModeIdIndex++) {
11337       if(SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].ModeID == *ModeNo) break;
11338       if(SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].ModeID == 0xFF)    return 0;
11339    }
11340 
11341    if(*ModeNo != 0x07) {
11342       if(*ModeNo > 0x03) return ModeIdIndex;
11343       if(VGAINFO & 0x80) return ModeIdIndex;
11344       ModeIdIndex++;
11345    }
11346 
11347    if(VGAINFO & 0x10) ModeIdIndex++;   /* 400 lines */
11348                                        /* else 350 lines */
11349    return ModeIdIndex;
11350 }
11351 
11352 static void
11353 SiS_OEM300Setting(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex,
11354                   unsigned short RefTableIndex)
11355 {
11356   unsigned short OEMModeIdIndex = 0;
11357 
11358   if(!SiS_Pr->UseCustomMode) {
11359      OEMModeIdIndex = SiS_SearchVBModeID(SiS_Pr,&ModeNo);
11360      if(!(OEMModeIdIndex)) return;
11361   }
11362 
11363   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
11364      SetOEMLCDDelay(SiS_Pr, ModeNo, OEMModeIdIndex);
11365      if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
11366         SetOEMLCDData(SiS_Pr, ModeNo, OEMModeIdIndex);
11367      }
11368   }
11369   if(SiS_Pr->UseCustomMode) return;
11370   if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
11371      SetOEMTVDelay(SiS_Pr, ModeNo,OEMModeIdIndex);
11372      if(SiS_Pr->SiS_VBType & VB_SISVB) {
11373         SetOEMAntiFlicker(SiS_Pr, ModeNo, OEMModeIdIndex);
11374         SetOEMPhaseIncr(SiS_Pr, ModeNo, OEMModeIdIndex);
11375         SetOEMYFilter(SiS_Pr, ModeNo, OEMModeIdIndex);
11376      }
11377   }
11378 }
11379 #endif
11380
/* [<][>][^][v][top][bottom][index][help] */
root/drivers/video/fbdev/sis/init301.c

DEFINITIONS
