diff options
| author | Tomi Valkeinen <tomi.valkeinen@ti.com> | 2014-02-13 14:31:38 +0100 |
|---|---|---|
| committer | Tomi Valkeinen <tomi.valkeinen@ti.com> | 2014-04-17 07:10:19 +0200 |
| commit | f7018c21350204c4cf628462f229d44d03545254 (patch) | |
| tree | 408787177164cf51cc06f7aabdb04fcff8d2b6aa /drivers/video/sis/init301.c | |
| parent | video: bf54x-lq043fb: fix build error (diff) | |
| download | linux-f7018c21350204c4cf628462f229d44d03545254.tar.xz linux-f7018c21350204c4cf628462f229d44d03545254.zip | |
video: move fbdev to drivers/video/fbdev
The drivers/video directory is a mess. It contains generic video related
files, directories for backlight, console, linux logo, lots of fbdev
device drivers, fbdev framework files.
Make some order into the chaos by creating drivers/video/fbdev
directory, and move all fbdev related files there.
No functionality is changed, although I guess it is possible that some
subtle Makefile build order related issue could be created by this
patch.
Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ti.com>
Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Acked-by: Geert Uytterhoeven <geert@linux-m68k.org>
Acked-by: Rob Clark <robdclark@gmail.com>
Acked-by: Jingoo Han <jg1.han@samsung.com>
Acked-by: Daniel Vetter <daniel.vetter@ffwll.ch>
Diffstat (limited to 'drivers/video/sis/init301.c')
| -rw-r--r-- | drivers/video/sis/init301.c | 11071 |
1 files changed, 0 insertions, 11071 deletions
diff --git a/drivers/video/sis/init301.c b/drivers/video/sis/init301.c deleted file mode 100644 index a89e3cafd5ad..000000000000 --- a/drivers/video/sis/init301.c +++ /dev/null @@ -1,11071 +0,0 @@ -/* $XFree86$ */ -/* $XdotOrg$ */ -/* - * Mode initializing code (CRT2 section) - * for SiS 300/305/540/630/730, - * SiS 315/550/[M]650/651/[M]661[FGM]X/[M]74x[GX]/330/[M]76x[GX], - * XGI V3XT/V5/V8, Z7 - * (Universal module for Linux kernel framebuffer and X.org/XFree86 4.x) - * - * Copyright (C) 2001-2005 by Thomas Winischhofer, Vienna, Austria - * - * If distributed as part of the Linux kernel, the following license terms - * apply: - * - * * This program is free software; you can redistribute it and/or modify - * * it under the terms of the GNU General Public License as published by - * * the Free Software Foundation; either version 2 of the named License, - * * or any later version. - * * - * * This program is distributed in the hope that it will be useful, - * * but WITHOUT ANY WARRANTY; without even the implied warranty of - * * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * * GNU General Public License for more details. - * * - * * You should have received a copy of the GNU General Public License - * * along with this program; if not, write to the Free Software - * * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA - * - * Otherwise, the following license terms apply: - * - * * Redistribution and use in source and binary forms, with or without - * * modification, are permitted provided that the following conditions - * * are met: - * * 1) Redistributions of source code must retain the above copyright - * * notice, this list of conditions and the following disclaimer. - * * 2) Redistributions in binary form must reproduce the above copyright - * * notice, this list of conditions and the following disclaimer in the - * * documentation and/or other materials provided with the distribution. - * * 3) The name of the author may not be used to endorse or promote products - * * derived from this software without specific prior written permission. - * * - * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR - * * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES - * * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. - * * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, - * * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT - * * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, - * * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY - * * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT - * * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF - * * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. - * - * Author: Thomas Winischhofer <thomas@winischhofer.net> - * - * Formerly based on non-functional code-fragements for 300 series by SiS, Inc. - * Used by permission. - * - */ - -#if 1 -#define SET_EMI /* 302LV/ELV: Set EMI values */ -#endif - -#if 1 -#define SET_PWD /* 301/302LV: Set PWD */ -#endif - -#define COMPAL_HACK /* Needed for Compal 1400x1050 (EMI) */ -#define COMPAQ_HACK /* Needed for Inventec/Compaq 1280x1024 (EMI) */ -#define ASUS_HACK /* Needed for Asus A2H 1024x768 (EMI) */ - -#include "init301.h" - -#ifdef CONFIG_FB_SIS_300 -#include "oem300.h" -#endif - -#ifdef CONFIG_FB_SIS_315 -#include "oem310.h" -#endif - -#define SiS_I2CDELAY 1000 -#define SiS_I2CDELAYSHORT 150 - -static unsigned short SiS_GetBIOSLCDResInfo(struct SiS_Private *SiS_Pr); -static void SiS_SetCH70xx(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val); - -/*********************************************/ -/* HELPER: Lock/Unlock CRT2 */ -/*********************************************/ - -void -SiS_UnLockCRT2(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->ChipType == XGI_20) - return; - else if(SiS_Pr->ChipType >= SIS_315H) - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2f,0x01); - else - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x24,0x01); -} - -static -void -SiS_LockCRT2(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->ChipType == XGI_20) - return; - else if(SiS_Pr->ChipType >= SIS_315H) - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2F,0xFE); - else - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x24,0xFE); -} - -/*********************************************/ -/* HELPER: Write SR11 */ -/*********************************************/ - -static void -SiS_SetRegSR11ANDOR(struct SiS_Private *SiS_Pr, unsigned short DataAND, unsigned short DataOR) -{ - if(SiS_Pr->ChipType >= SIS_661) { - DataAND &= 0x0f; - DataOR &= 0x0f; - } - SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x11,DataAND,DataOR); -} - -/*********************************************/ -/* HELPER: Get Pointer to LCD structure */ -/*********************************************/ - -#ifdef CONFIG_FB_SIS_315 -static unsigned char * -GetLCDStructPtr661(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned char *myptr = NULL; - unsigned short romindex = 0, reg = 0, idx = 0; - - /* Use the BIOS tables only for LVDS panels; TMDS is unreliable - * due to the variaty of panels the BIOS doesn't know about. - * Exception: If the BIOS has better knowledge (such as in case - * of machines with a 301C and a panel that does not support DDC) - * use the BIOS data as well. - */ - - if((SiS_Pr->SiS_ROMNew) && - ((SiS_Pr->SiS_VBType & VB_SISLVDS) || (!SiS_Pr->PanelSelfDetected))) { - - if(SiS_Pr->ChipType < SIS_661) reg = 0x3c; - else reg = 0x7d; - - idx = (SiS_GetReg(SiS_Pr->SiS_P3d4,reg) & 0x1f) * 26; - - if(idx < (8*26)) { - myptr = (unsigned char *)&SiS_LCDStruct661[idx]; - } - romindex = SISGETROMW(0x100); - if(romindex) { - romindex += idx; - myptr = &ROMAddr[romindex]; - } - } - return myptr; -} - -static unsigned short -GetLCDStructPtr661_2(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short romptr = 0; - - /* Use the BIOS tables only for LVDS panels; TMDS is unreliable - * due to the variaty of panels the BIOS doesn't know about. - * Exception: If the BIOS has better knowledge (such as in case - * of machines with a 301C and a panel that does not support DDC) - * use the BIOS data as well. - */ - - if((SiS_Pr->SiS_ROMNew) && - ((SiS_Pr->SiS_VBType & VB_SISLVDS) || (!SiS_Pr->PanelSelfDetected))) { - romptr = SISGETROMW(0x102); - romptr += ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4) * SiS_Pr->SiS661LCD2TableSize); - } - - return romptr; -} -#endif - -/*********************************************/ -/* Adjust Rate for CRT2 */ -/*********************************************/ - -static bool -SiS_AdjustCRT2Rate(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RRTI, unsigned short *i) -{ - unsigned short checkmask=0, modeid, infoflag; - - modeid = SiS_Pr->SiS_RefIndex[RRTI + (*i)].ModeID; - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) { - - checkmask |= SupportRAMDAC2; - if(SiS_Pr->ChipType >= SIS_315H) { - checkmask |= SupportRAMDAC2_135; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - checkmask |= SupportRAMDAC2_162; - if(SiS_Pr->SiS_VBType & VB_SISRAMDAC202) { - checkmask |= SupportRAMDAC2_202; - } - } - } - - } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - - checkmask |= SupportLCD; - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (SiS_Pr->SiS_LCDInfo & LCDPass11)) { - if(modeid == 0x2e) checkmask |= Support64048060Hz; - } - } - } - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - - checkmask |= SupportHiVision; - - } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToYPbPr525750|SetCRT2ToAVIDEO|SetCRT2ToSVIDEO|SetCRT2ToSCART)) { - - checkmask |= SupportTV; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - checkmask |= SupportTV1024; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) { - checkmask |= SupportYPbPr750p; - } - } - } - - } - - } else { /* LVDS */ - - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - checkmask |= SupportCHTV; - } - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - checkmask |= SupportLCD; - } - - } - - /* Look backwards in table for matching CRT2 mode */ - for(; SiS_Pr->SiS_RefIndex[RRTI + (*i)].ModeID == modeid; (*i)--) { - infoflag = SiS_Pr->SiS_RefIndex[RRTI + (*i)].Ext_InfoFlag; - if(infoflag & checkmask) return true; - if((*i) == 0) break; - } - - /* Look through the whole mode-section of the table from the beginning - * for a matching CRT2 mode if no mode was found yet. - */ - for((*i) = 0; ; (*i)++) { - if(SiS_Pr->SiS_RefIndex[RRTI + (*i)].ModeID != modeid) break; - infoflag = SiS_Pr->SiS_RefIndex[RRTI + (*i)].Ext_InfoFlag; - if(infoflag & checkmask) return true; - } - return false; -} - -/*********************************************/ -/* Get rate index */ -/*********************************************/ - -unsigned short -SiS_GetRatePtr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned short RRTI,i,backup_i; - unsigned short modeflag,index,temp,backupindex; - static const unsigned short LCDRefreshIndex[] = { - 0x00, 0x00, 0x01, 0x01, - 0x01, 0x01, 0x01, 0x01, - 0x01, 0x01, 0x01, 0x01, - 0x01, 0x01, 0x01, 0x01, - 0x00, 0x00, 0x00, 0x00 - }; - - /* Do NOT check for UseCustomMode here, will skrew up FIFO */ - if(ModeNo == 0xfe) return 0; - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(modeflag & HalfDCLK) return 0; - } - } - - if(ModeNo < 0x14) return 0xFFFF; - - index = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x33) >> SiS_Pr->SiS_SelectCRT2Rate) & 0x0F; - backupindex = index; - - if(index > 0) index--; - - if(SiS_Pr->SiS_SetFlag & ProgrammingCRT2) { - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(SiS_Pr->SiS_VBType & VB_NoLCD) index = 0; - else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) index = backupindex = 0; - } - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_VBType & VB_NoLCD)) { - temp = LCDRefreshIndex[SiS_GetBIOSLCDResInfo(SiS_Pr)]; - if(index > temp) index = temp; - } - } - } else { - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) index = 0; - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) index = 0; - } - } - } - - RRTI = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].REFindex; - ModeNo = SiS_Pr->SiS_RefIndex[RRTI].ModeID; - - if(SiS_Pr->ChipType >= SIS_315H) { - if(!(SiS_Pr->SiS_VBInfo & DriverMode)) { - if( (SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_VESAID == 0x105) || - (SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_VESAID == 0x107) ) { - if(backupindex <= 1) RRTI++; - } - } - } - - i = 0; - do { - if(SiS_Pr->SiS_RefIndex[RRTI + i].ModeID != ModeNo) break; - temp = SiS_Pr->SiS_RefIndex[RRTI + i].Ext_InfoFlag; - temp &= ModeTypeMask; - if(temp < SiS_Pr->SiS_ModeType) break; - i++; - index--; - } while(index != 0xFFFF); - - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) { - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - temp = SiS_Pr->SiS_RefIndex[RRTI + i - 1].Ext_InfoFlag; - if(temp & InterlaceMode) i++; - } - } - - i--; - - if((SiS_Pr->SiS_SetFlag & ProgrammingCRT2) && (!(SiS_Pr->SiS_VBInfo & DisableCRT2Display))) { - backup_i = i; - if(!(SiS_AdjustCRT2Rate(SiS_Pr, ModeNo, ModeIdIndex, RRTI, &i))) { - i = backup_i; - } - } - - return (RRTI + i); -} - -/*********************************************/ -/* STORE CRT2 INFO in CR34 */ -/*********************************************/ - -static void -SiS_SaveCRT2Info(struct SiS_Private *SiS_Pr, unsigned short ModeNo) -{ - unsigned short temp1, temp2; - - /* Store CRT1 ModeNo in CR34 */ - SiS_SetReg(SiS_Pr->SiS_P3d4,0x34,ModeNo); - temp1 = (SiS_Pr->SiS_VBInfo & SetInSlaveMode) >> 8; - temp2 = ~(SetInSlaveMode >> 8); - SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x31,temp2,temp1); -} - -/*********************************************/ -/* HELPER: GET SOME DATA FROM BIOS ROM */ -/*********************************************/ - -#ifdef CONFIG_FB_SIS_300 -static bool -SiS_CR36BIOSWord23b(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short temp,temp1; - - if(SiS_Pr->SiS_UseROM) { - if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) { - temp = 1 << ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4) & 0x0f); - temp1 = SISGETROMW(0x23b); - if(temp1 & temp) return true; - } - } - return false; -} - -static bool -SiS_CR36BIOSWord23d(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short temp,temp1; - - if(SiS_Pr->SiS_UseROM) { - if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) { - temp = 1 << ((SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4) & 0x0f); - temp1 = SISGETROMW(0x23d); - if(temp1 & temp) return true; - } - } - return false; -} -#endif - -/*********************************************/ -/* HELPER: DELAY FUNCTIONS */ -/*********************************************/ - -void -SiS_DDC2Delay(struct SiS_Private *SiS_Pr, unsigned int delaytime) -{ - while (delaytime-- > 0) - SiS_GetReg(SiS_Pr->SiS_P3c4, 0x05); -} - -#if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) -static void -SiS_GenericDelay(struct SiS_Private *SiS_Pr, unsigned short delay) -{ - SiS_DDC2Delay(SiS_Pr, delay * 36); -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static void -SiS_LongDelay(struct SiS_Private *SiS_Pr, unsigned short delay) -{ - while(delay--) { - SiS_GenericDelay(SiS_Pr, 6623); - } -} -#endif - -#if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) -static void -SiS_ShortDelay(struct SiS_Private *SiS_Pr, unsigned short delay) -{ - while(delay--) { - SiS_GenericDelay(SiS_Pr, 66); - } -} -#endif - -static void -SiS_PanelDelay(struct SiS_Private *SiS_Pr, unsigned short DelayTime) -{ -#if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short PanelID, DelayIndex, Delay=0; -#endif - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 - - PanelID = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36); - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->SiS_VBType & VB_SIS301) PanelID &= 0xf7; - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x18) & 0x10)) PanelID = 0x12; - } - DelayIndex = PanelID >> 4; - if((DelayTime >= 2) && ((PanelID & 0x0f) == 1)) { - Delay = 3; - } else { - if(DelayTime >= 2) DelayTime -= 2; - if(!(DelayTime & 0x01)) { - Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[0]; - } else { - Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[1]; - } - if(SiS_Pr->SiS_UseROM) { - if(ROMAddr[0x220] & 0x40) { - if(!(DelayTime & 0x01)) Delay = (unsigned short)ROMAddr[0x225]; - else Delay = (unsigned short)ROMAddr[0x226]; - } - } - } - SiS_ShortDelay(SiS_Pr, Delay); - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 - - if((SiS_Pr->ChipType >= SIS_661) || - (SiS_Pr->ChipType <= SIS_315PRO) || - (SiS_Pr->ChipType == SIS_330) || - (SiS_Pr->SiS_ROMNew)) { - - if(!(DelayTime & 0x01)) { - SiS_DDC2Delay(SiS_Pr, 0x1000); - } else { - SiS_DDC2Delay(SiS_Pr, 0x4000); - } - - } else if((SiS_Pr->SiS_IF_DEF_LVDS == 1) /* || - (SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) || - (SiS_Pr->SiS_CustomT == CUT_CLEVO1400) */ ) { /* 315 series, LVDS; Special */ - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) { - PanelID = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36); - if(SiS_Pr->SiS_CustomT == CUT_CLEVO1400) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x1b) & 0x10)) PanelID = 0x12; - } - if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) { - DelayIndex = PanelID & 0x0f; - } else { - DelayIndex = PanelID >> 4; - } - if((DelayTime >= 2) && ((PanelID & 0x0f) == 1)) { - Delay = 3; - } else { - if(DelayTime >= 2) DelayTime -= 2; - if(!(DelayTime & 0x01)) { - Delay = SiS_Pr->SiS_PanelDelayTblLVDS[DelayIndex].timer[0]; - } else { - Delay = SiS_Pr->SiS_PanelDelayTblLVDS[DelayIndex].timer[1]; - } - if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) { - if(ROMAddr[0x13c] & 0x40) { - if(!(DelayTime & 0x01)) { - Delay = (unsigned short)ROMAddr[0x17e]; - } else { - Delay = (unsigned short)ROMAddr[0x17f]; - } - } - } - } - SiS_ShortDelay(SiS_Pr, Delay); - } - - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { /* 315 series, all bridges */ - - DelayIndex = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4; - if(!(DelayTime & 0x01)) { - Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[0]; - } else { - Delay = SiS_Pr->SiS_PanelDelayTbl[DelayIndex].timer[1]; - } - Delay <<= 8; - SiS_DDC2Delay(SiS_Pr, Delay); - - } - -#endif /* CONFIG_FB_SIS_315 */ - - } -} - -#ifdef CONFIG_FB_SIS_315 -static void -SiS_PanelDelayLoop(struct SiS_Private *SiS_Pr, unsigned short DelayTime, unsigned short DelayLoop) -{ - int i; - for(i = 0; i < DelayLoop; i++) { - SiS_PanelDelay(SiS_Pr, DelayTime); - } -} -#endif - -/*********************************************/ -/* HELPER: WAIT-FOR-RETRACE FUNCTIONS */ -/*********************************************/ - -void -SiS_WaitRetrace1(struct SiS_Private *SiS_Pr) -{ - unsigned short watchdog; - - if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x1f) & 0xc0) return; - if(!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x17) & 0x80)) return; - - watchdog = 65535; - while((SiS_GetRegByte(SiS_Pr->SiS_P3da) & 0x08) && --watchdog); - watchdog = 65535; - while((!(SiS_GetRegByte(SiS_Pr->SiS_P3da) & 0x08)) && --watchdog); -} - -#if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) -static void -SiS_WaitRetrace2(struct SiS_Private *SiS_Pr, unsigned short reg) -{ - unsigned short watchdog; - - watchdog = 65535; - while((SiS_GetReg(SiS_Pr->SiS_Part1Port,reg) & 0x02) && --watchdog); - watchdog = 65535; - while((!(SiS_GetReg(SiS_Pr->SiS_Part1Port,reg) & 0x02)) && --watchdog); -} -#endif - -static void -SiS_WaitVBRetrace(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->ChipType < SIS_315H) { -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - if(!(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x20)) return; - } - if(!(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x80)) { - SiS_WaitRetrace1(SiS_Pr); - } else { - SiS_WaitRetrace2(SiS_Pr, 0x25); - } -#endif - } else { -#ifdef CONFIG_FB_SIS_315 - if(!(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x40)) { - SiS_WaitRetrace1(SiS_Pr); - } else { - SiS_WaitRetrace2(SiS_Pr, 0x30); - } -#endif - } -} - -static void -SiS_VBWait(struct SiS_Private *SiS_Pr) -{ - unsigned short tempal,temp,i,j; - - temp = 0; - for(i = 0; i < 3; i++) { - for(j = 0; j < 100; j++) { - tempal = SiS_GetRegByte(SiS_Pr->SiS_P3da); - if(temp & 0x01) { - if((tempal & 0x08)) continue; - else break; - } else { - if(!(tempal & 0x08)) continue; - else break; - } - } - temp ^= 0x01; - } -} - -static void -SiS_VBLongWait(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - SiS_VBWait(SiS_Pr); - } else { - SiS_WaitRetrace1(SiS_Pr); - } -} - -/*********************************************/ -/* HELPER: MISC */ -/*********************************************/ - -#ifdef CONFIG_FB_SIS_300 -static bool -SiS_Is301B(struct SiS_Private *SiS_Pr) -{ - if(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x01) >= 0xb0) return true; - return false; -} -#endif - -static bool -SiS_CRT2IsLCD(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->ChipType == SIS_730) { - if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x20) return true; - } - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x30) & 0x20) return true; - return false; -} - -bool -SiS_IsDualEdge(struct SiS_Private *SiS_Pr) -{ -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType >= SIS_315H) { - if((SiS_Pr->ChipType != SIS_650) || (SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xf0)) { - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & EnableDualEdge) return true; - } - } -#endif - return false; -} - -bool -SiS_IsVAMode(struct SiS_Private *SiS_Pr) -{ -#ifdef CONFIG_FB_SIS_315 - unsigned short flag; - - if(SiS_Pr->ChipType >= SIS_315H) { - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38); - if((flag & EnableDualEdge) && (flag & SetToLCDA)) return true; - } -#endif - return false; -} - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_IsVAorLCD(struct SiS_Private *SiS_Pr) -{ - if(SiS_IsVAMode(SiS_Pr)) return true; - if(SiS_CRT2IsLCD(SiS_Pr)) return true; - return false; -} -#endif - -static bool -SiS_IsDualLink(struct SiS_Private *SiS_Pr) -{ -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType >= SIS_315H) { - if((SiS_CRT2IsLCD(SiS_Pr)) || - (SiS_IsVAMode(SiS_Pr))) { - if(SiS_Pr->SiS_LCDInfo & LCDDualLink) return true; - } - } -#endif - return false; -} - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_TVEnabled(struct SiS_Private *SiS_Pr) -{ - if((SiS_GetReg(SiS_Pr->SiS_Part2Port,0x00) & 0x0f) != 0x0c) return true; - if(SiS_Pr->SiS_VBType & VB_SISYPBPR) { - if(SiS_GetReg(SiS_Pr->SiS_Part2Port,0x4d) & 0x10) return true; - } - return false; -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_LCDAEnabled(struct SiS_Private *SiS_Pr) -{ - if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x13) & 0x04) return true; - return false; -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_WeHaveBacklightCtrl(struct SiS_Private *SiS_Pr) -{ - if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->ChipType < SIS_661)) { - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x79) & 0x10) return true; - } - return false; -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_IsNotM650orLater(struct SiS_Private *SiS_Pr) -{ - unsigned short flag; - - if(SiS_Pr->ChipType == SIS_650) { - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xf0; - /* Check for revision != A0 only */ - if((flag == 0xe0) || (flag == 0xc0) || - (flag == 0xb0) || (flag == 0x90)) return false; - } else if(SiS_Pr->ChipType >= SIS_661) return false; - return true; -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_IsYPbPr(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->ChipType >= SIS_315H) { - /* YPrPb = 0x08 */ - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & EnableCHYPbPr) return true; - } - return false; -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_IsChScart(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->ChipType >= SIS_315H) { - /* Scart = 0x04 */ - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & EnableCHScart) return true; - } - return false; -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_IsTVOrYPbPrOrScart(struct SiS_Private *SiS_Pr) -{ - unsigned short flag; - - if(SiS_Pr->ChipType >= SIS_315H) { - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - if(flag & SetCRT2ToTV) return true; - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38); - if(flag & EnableCHYPbPr) return true; /* = YPrPb = 0x08 */ - if(flag & EnableCHScart) return true; /* = Scart = 0x04 - TW */ - } else { - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - if(flag & SetCRT2ToTV) return true; - } - return false; -} -#endif - -#ifdef CONFIG_FB_SIS_315 -static bool -SiS_IsLCDOrLCDA(struct SiS_Private *SiS_Pr) -{ - unsigned short flag; - - if(SiS_Pr->ChipType >= SIS_315H) { - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - if(flag & SetCRT2ToLCD) return true; - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38); - if(flag & SetToLCDA) return true; - } else { - flag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - if(flag & SetCRT2ToLCD) return true; - } - return false; -} -#endif - -static bool -SiS_HaveBridge(struct SiS_Private *SiS_Pr) -{ - unsigned short flag; - - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - return true; - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { - flag = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x00); - if((flag == 1) || (flag == 2)) return true; - } - return false; -} - -static bool -SiS_BridgeIsEnabled(struct SiS_Private *SiS_Pr) -{ - unsigned short flag; - - if(SiS_HaveBridge(SiS_Pr)) { - flag = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00); - if(SiS_Pr->ChipType < SIS_315H) { - flag &= 0xa0; - if((flag == 0x80) || (flag == 0x20)) return true; - } else { - flag &= 0x50; - if((flag == 0x40) || (flag == 0x10)) return true; - } - } - return false; -} - -static bool -SiS_BridgeInSlavemode(struct SiS_Private *SiS_Pr) -{ - unsigned short flag1; - - flag1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31); - if(flag1 & (SetInSlaveMode >> 8)) return true; - return false; -} - -/*********************************************/ -/* GET VIDEO BRIDGE CONFIG INFO */ -/*********************************************/ - -/* Setup general purpose IO for Chrontel communication */ -#ifdef CONFIG_FB_SIS_300 -void -SiS_SetChrontelGPIO(struct SiS_Private *SiS_Pr, unsigned short myvbinfo) -{ - unsigned int acpibase; - unsigned short temp; - - if(!(SiS_Pr->SiS_ChSW)) return; - - acpibase = sisfb_read_lpc_pci_dword(SiS_Pr, 0x74); - acpibase &= 0xFFFF; - if(!acpibase) return; - temp = SiS_GetRegShort((acpibase + 0x3c)); /* ACPI register 0x3c: GP Event 1 I/O mode select */ - temp &= 0xFEFF; - SiS_SetRegShort((acpibase + 0x3c), temp); - temp = SiS_GetRegShort((acpibase + 0x3c)); - temp = SiS_GetRegShort((acpibase + 0x3a)); /* ACPI register 0x3a: GP Pin Level (low/high) */ - temp &= 0xFEFF; - if(!(myvbinfo & SetCRT2ToTV)) temp |= 0x0100; - SiS_SetRegShort((acpibase + 0x3a), temp); - temp = SiS_GetRegShort((acpibase + 0x3a)); -} -#endif - -void -SiS_GetVBInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo, - unsigned short ModeIdIndex, int checkcrt2mode) -{ - unsigned short tempax, tempbx, temp; - unsigned short modeflag, resinfo = 0; - - SiS_Pr->SiS_SetFlag = 0; - - modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); - - SiS_Pr->SiS_ModeType = modeflag & ModeTypeMask; - - if((ModeNo > 0x13) && (!SiS_Pr->UseCustomMode)) { - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - } - - tempbx = 0; - - if(SiS_HaveBridge(SiS_Pr)) { - - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - tempbx |= temp; - tempax = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) << 8; - tempax &= (DriverMode | LoadDACFlag | SetNotSimuMode | SetPALTV); - tempbx |= tempax; - -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_VBType & VB_SISLCDA) { - if(ModeNo == 0x03) { - /* Mode 0x03 is never in driver mode */ - SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x31,0xbf); - } - if(!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & (DriverMode >> 8))) { - /* Reset LCDA setting if not driver mode */ - SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x38,0xfc); - } - if(IS_SIS650) { - if(SiS_Pr->SiS_UseLCDA) { - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x5f) & 0xF0) { - if((ModeNo <= 0x13) || (!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & (DriverMode >> 8)))) { - SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x38,(EnableDualEdge | SetToLCDA)); - } - } - } - } - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38); - if((temp & (EnableDualEdge | SetToLCDA)) == (EnableDualEdge | SetToLCDA)) { - tempbx |= SetCRT2ToLCDA; - } - } - - if(SiS_Pr->ChipType >= SIS_661) { /* New CR layout */ - tempbx &= ~(SetCRT2ToYPbPr525750 | SetCRT2ToHiVision); - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x38) & 0x04) { - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35) & 0xe0; - if(temp == 0x60) tempbx |= SetCRT2ToHiVision; - else if(SiS_Pr->SiS_VBType & VB_SISYPBPR) { - tempbx |= SetCRT2ToYPbPr525750; - } - } - } - - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38); - if(temp & SetToLCDA) { - tempbx |= SetCRT2ToLCDA; - } - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(temp & EnableCHYPbPr) { - tempbx |= SetCRT2ToCHYPbPr; - } - } - } - } - -#endif /* CONFIG_FB_SIS_315 */ - - if(!(SiS_Pr->SiS_VBType & VB_SISVGA2)) { - tempbx &= ~(SetCRT2ToRAMDAC); - } - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - temp = SetCRT2ToSVIDEO | - SetCRT2ToAVIDEO | - SetCRT2ToSCART | - SetCRT2ToLCDA | - SetCRT2ToLCD | - SetCRT2ToRAMDAC | - SetCRT2ToHiVision | - SetCRT2ToYPbPr525750; - } else { - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - temp = SetCRT2ToAVIDEO | - SetCRT2ToSVIDEO | - SetCRT2ToSCART | - SetCRT2ToLCDA | - SetCRT2ToLCD | - SetCRT2ToCHYPbPr; - } else { - temp = SetCRT2ToLCDA | - SetCRT2ToLCD; - } - } else { - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - temp = SetCRT2ToTV | SetCRT2ToLCD; - } else { - temp = SetCRT2ToLCD; - } - } - } - - if(!(tempbx & temp)) { - tempax = DisableCRT2Display; - tempbx = 0; - } - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - unsigned short clearmask = ( DriverMode | - DisableCRT2Display | - LoadDACFlag | - SetNotSimuMode | - SetInSlaveMode | - SetPALTV | - SwitchCRT2 | - SetSimuScanMode ); - - if(tempbx & SetCRT2ToLCDA) tempbx &= (clearmask | SetCRT2ToLCDA); - if(tempbx & SetCRT2ToRAMDAC) tempbx &= (clearmask | SetCRT2ToRAMDAC); - if(tempbx & SetCRT2ToLCD) tempbx &= (clearmask | SetCRT2ToLCD); - if(tempbx & SetCRT2ToSCART) tempbx &= (clearmask | SetCRT2ToSCART); - if(tempbx & SetCRT2ToHiVision) tempbx &= (clearmask | SetCRT2ToHiVision); - if(tempbx & SetCRT2ToYPbPr525750) tempbx &= (clearmask | SetCRT2ToYPbPr525750); - - } else { - - if(SiS_Pr->ChipType >= SIS_315H) { - if(tempbx & SetCRT2ToLCDA) { - tempbx &= (0xFF00|SwitchCRT2|SetSimuScanMode); - } - } - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(tempbx & SetCRT2ToTV) { - tempbx &= (0xFF00|SetCRT2ToTV|SwitchCRT2|SetSimuScanMode); - } - } - if(tempbx & SetCRT2ToLCD) { - tempbx &= (0xFF00|SetCRT2ToLCD|SwitchCRT2|SetSimuScanMode); - } - if(SiS_Pr->ChipType >= SIS_315H) { - if(tempbx & SetCRT2ToLCDA) { - tempbx |= SetCRT2ToLCD; - } - } - - } - - if(tempax & DisableCRT2Display) { - if(!(tempbx & (SwitchCRT2 | SetSimuScanMode))) { - tempbx = SetSimuScanMode | DisableCRT2Display; - } - } - - if(!(tempbx & DriverMode)) tempbx |= SetSimuScanMode; - - /* LVDS/CHRONTEL (LCD/TV) and 301BDH (LCD) can only be slave in 8bpp modes */ - if(SiS_Pr->SiS_ModeType <= ModeVGA) { - if( (SiS_Pr->SiS_IF_DEF_LVDS == 1) || - ((SiS_Pr->SiS_VBType & VB_NoLCD) && (tempbx & SetCRT2ToLCD)) ) { - modeflag &= (~CRT2Mode); - } - } - - if(!(tempbx & SetSimuScanMode)) { - if(tempbx & SwitchCRT2) { - if((!(modeflag & CRT2Mode)) && (checkcrt2mode)) { - if(resinfo != SIS_RI_1600x1200) { - tempbx |= SetSimuScanMode; - } - } - } else { - if(SiS_BridgeIsEnabled(SiS_Pr)) { - if(!(tempbx & DriverMode)) { - if(SiS_BridgeInSlavemode(SiS_Pr)) { - tempbx |= SetSimuScanMode; - } - } - } - } - } - - if(!(tempbx & DisableCRT2Display)) { - if(tempbx & DriverMode) { - if(tempbx & SetSimuScanMode) { - if((!(modeflag & CRT2Mode)) && (checkcrt2mode)) { - if(resinfo != SIS_RI_1600x1200) { - tempbx |= SetInSlaveMode; - } - } - } - } else { - tempbx |= SetInSlaveMode; - } - } - - } - - SiS_Pr->SiS_VBInfo = tempbx; - -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->ChipType == SIS_630) { - SiS_SetChrontelGPIO(SiS_Pr, SiS_Pr->SiS_VBInfo); - } -#endif - -#if 0 - printk(KERN_DEBUG "sisfb: (init301: VBInfo= 0x%04x, SetFlag=0x%04x)\n", - SiS_Pr->SiS_VBInfo, SiS_Pr->SiS_SetFlag); -#endif -} - -/*********************************************/ -/* DETERMINE YPbPr MODE */ -/*********************************************/ - -void -SiS_SetYPbPr(struct SiS_Private *SiS_Pr) -{ - - unsigned char temp; - - /* Note: This variable is only used on 30xLV systems. - * CR38 has a different meaning on LVDS/CH7019 systems. - * On 661 and later, these bits moved to CR35. - * - * On 301, 301B, only HiVision 1080i is supported. - * On 30xLV, 301C, only YPbPr 1080i is supported. - */ - - SiS_Pr->SiS_YPbPr = 0; - if(SiS_Pr->ChipType >= SIS_661) return; - - if(SiS_Pr->SiS_VBType) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - SiS_Pr->SiS_YPbPr = YPbPrHiVision; - } - } - - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_VBType & VB_SISYPBPR) { - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38); - if(temp & 0x08) { - switch((temp >> 4)) { - case 0x00: SiS_Pr->SiS_YPbPr = YPbPr525i; break; - case 0x01: SiS_Pr->SiS_YPbPr = YPbPr525p; break; - case 0x02: SiS_Pr->SiS_YPbPr = YPbPr750p; break; - case 0x03: SiS_Pr->SiS_YPbPr = YPbPrHiVision; break; - } - } - } - } - -} - -/*********************************************/ -/* DETERMINE TVMode flag */ -/*********************************************/ - -void -SiS_SetTVMode(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short temp, temp1, resinfo = 0, romindex = 0; - unsigned char OutputSelect = *SiS_Pr->pSiS_OutputSelect; - - SiS_Pr->SiS_TVMode = 0; - - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) return; - if(SiS_Pr->UseCustomMode) return; - - if(ModeNo > 0x13) { - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - } - - if(SiS_Pr->ChipType < SIS_661) { - - if(SiS_Pr->SiS_VBInfo & SetPALTV) SiS_Pr->SiS_TVMode |= TVSetPAL; - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - temp = 0; - if((SiS_Pr->ChipType == SIS_630) || - (SiS_Pr->ChipType == SIS_730)) { - temp = 0x35; - romindex = 0xfe; - } else if(SiS_Pr->ChipType >= SIS_315H) { - temp = 0x38; - if(SiS_Pr->ChipType < XGI_20) { - romindex = 0xf3; - if(SiS_Pr->ChipType >= SIS_330) romindex = 0x11b; - } - } - if(temp) { - if(romindex && SiS_Pr->SiS_UseROM && (!(SiS_Pr->SiS_ROMNew))) { - OutputSelect = ROMAddr[romindex]; - if(!(OutputSelect & EnablePALMN)) { - SiS_SetRegAND(SiS_Pr->SiS_P3d4,temp,0x3F); - } - } - temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,temp); - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - if(temp1 & EnablePALM) { /* 0x40 */ - SiS_Pr->SiS_TVMode |= TVSetPALM; - SiS_Pr->SiS_TVMode &= ~TVSetPAL; - } else if(temp1 & EnablePALN) { /* 0x80 */ - SiS_Pr->SiS_TVMode |= TVSetPALN; - } - } else { - if(temp1 & EnableNTSCJ) { /* 0x40 */ - SiS_Pr->SiS_TVMode |= TVSetNTSCJ; - } - } - } - /* Translate HiVision/YPbPr to our new flags */ - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - if(SiS_Pr->SiS_YPbPr == YPbPr750p) SiS_Pr->SiS_TVMode |= TVSetYPbPr750p; - else if(SiS_Pr->SiS_YPbPr == YPbPr525p) SiS_Pr->SiS_TVMode |= TVSetYPbPr525p; - else if(SiS_Pr->SiS_YPbPr == YPbPrHiVision) SiS_Pr->SiS_TVMode |= TVSetHiVision; - else SiS_Pr->SiS_TVMode |= TVSetYPbPr525i; - if(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p | TVSetYPbPr525p | TVSetYPbPr525i)) { - SiS_Pr->SiS_VBInfo &= ~SetCRT2ToHiVision; - SiS_Pr->SiS_VBInfo |= SetCRT2ToYPbPr525750; - } else if(SiS_Pr->SiS_TVMode & TVSetHiVision) { - SiS_Pr->SiS_TVMode |= TVSetPAL; - } - } - } else if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(SiS_Pr->SiS_CHOverScan) { - if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) { - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35); - if((temp & TVOverScan) || (SiS_Pr->SiS_CHOverScan == 1)) { - SiS_Pr->SiS_TVMode |= TVSetCHOverScan; - } - } else if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x79); - if((temp & 0x80) || (SiS_Pr->SiS_CHOverScan == 1)) { - SiS_Pr->SiS_TVMode |= TVSetCHOverScan; - } - } - if(SiS_Pr->SiS_CHSOverScan) { - SiS_Pr->SiS_TVMode |= TVSetCHOverScan; - } - } - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x38); - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - if(temp & EnablePALM) SiS_Pr->SiS_TVMode |= TVSetPALM; - else if(temp & EnablePALN) SiS_Pr->SiS_TVMode |= TVSetPALN; - } else { - if(temp & EnableNTSCJ) { - SiS_Pr->SiS_TVMode |= TVSetNTSCJ; - } - } - } - } - - } else { /* 661 and later */ - - temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35); - if(temp1 & 0x01) { - SiS_Pr->SiS_TVMode |= TVSetPAL; - if(temp1 & 0x08) { - SiS_Pr->SiS_TVMode |= TVSetPALN; - } else if(temp1 & 0x04) { - if(SiS_Pr->SiS_VBType & VB_SISVB) { - SiS_Pr->SiS_TVMode &= ~TVSetPAL; - } - SiS_Pr->SiS_TVMode |= TVSetPALM; - } - } else { - if(temp1 & 0x02) { - SiS_Pr->SiS_TVMode |= TVSetNTSCJ; - } - } - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(SiS_Pr->SiS_CHOverScan) { - if((temp1 & 0x10) || (SiS_Pr->SiS_CHOverScan == 1)) { - SiS_Pr->SiS_TVMode |= TVSetCHOverScan; - } - } - } - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - temp1 &= 0xe0; - if(temp1 == 0x00) SiS_Pr->SiS_TVMode |= TVSetYPbPr525i; - else if(temp1 == 0x20) SiS_Pr->SiS_TVMode |= TVSetYPbPr525p; - else if(temp1 == 0x40) SiS_Pr->SiS_TVMode |= TVSetYPbPr750p; - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - SiS_Pr->SiS_TVMode |= (TVSetHiVision | TVSetPAL); - } - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToYPbPr525750 | SetCRT2ToHiVision)) { - if(resinfo == SIS_RI_800x480 || resinfo == SIS_RI_1024x576 || resinfo == SIS_RI_1280x720) { - SiS_Pr->SiS_TVMode |= TVAspect169; - } else { - temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x39); - if(temp1 & 0x02) { - if(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p | TVSetHiVision)) { - SiS_Pr->SiS_TVMode |= TVAspect169; - } else { - SiS_Pr->SiS_TVMode |= TVAspect43LB; - } - } else { - SiS_Pr->SiS_TVMode |= TVAspect43; - } - } - } - } - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToSCART) SiS_Pr->SiS_TVMode |= TVSetPAL; - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - SiS_Pr->SiS_TVMode |= TVSetPAL; - SiS_Pr->SiS_TVMode &= ~(TVSetPALM | TVSetPALN | TVSetNTSCJ); - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525i | TVSetYPbPr525p | TVSetYPbPr750p)) { - SiS_Pr->SiS_TVMode &= ~(TVSetPAL | TVSetNTSCJ | TVSetPALM | TVSetPALN); - } - } - - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - if(!(SiS_Pr->SiS_VBInfo & SetNotSimuMode)) { - SiS_Pr->SiS_TVMode |= TVSetTVSimuMode; - } - } - - if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) { - if(resinfo == SIS_RI_1024x768) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) { - SiS_Pr->SiS_TVMode |= TVSet525p1024; - } else if(!(SiS_Pr->SiS_TVMode & (TVSetHiVision | TVSetYPbPr750p))) { - SiS_Pr->SiS_TVMode |= TVSetNTSC1024; - } - } - } - - SiS_Pr->SiS_TVMode |= TVRPLLDIV2XO; - if((SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) && - (SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - SiS_Pr->SiS_TVMode &= ~TVRPLLDIV2XO; - } else if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p)) { - SiS_Pr->SiS_TVMode &= ~TVRPLLDIV2XO; - } else if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) { - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) { - SiS_Pr->SiS_TVMode &= ~TVRPLLDIV2XO; - } - } - - } - - SiS_Pr->SiS_VBInfo &= ~SetPALTV; -} - -/*********************************************/ -/* GET LCD INFO */ -/*********************************************/ - -static unsigned short -SiS_GetBIOSLCDResInfo(struct SiS_Private *SiS_Pr) -{ - unsigned short temp = SiS_Pr->SiS_LCDResInfo; - /* Translate my LCDResInfo to BIOS value */ - switch(temp) { - case Panel_1280x768_2: temp = Panel_1280x768; break; - case Panel_1280x800_2: temp = Panel_1280x800; break; - case Panel_1280x854: temp = Panel661_1280x854; break; - } - return temp; -} - -static void -SiS_GetLCDInfoBIOS(struct SiS_Private *SiS_Pr) -{ -#ifdef CONFIG_FB_SIS_315 - unsigned char *ROMAddr; - unsigned short temp; - - if((ROMAddr = GetLCDStructPtr661(SiS_Pr))) { - if((temp = SISGETROMW(6)) != SiS_Pr->PanelHT) { - SiS_Pr->SiS_NeedRomModeData = true; - SiS_Pr->PanelHT = temp; - } - if((temp = SISGETROMW(8)) != SiS_Pr->PanelVT) { - SiS_Pr->SiS_NeedRomModeData = true; - SiS_Pr->PanelVT = temp; - } - SiS_Pr->PanelHRS = SISGETROMW(10); - SiS_Pr->PanelHRE = SISGETROMW(12); - SiS_Pr->PanelVRS = SISGETROMW(14); - SiS_Pr->PanelVRE = SISGETROMW(16); - SiS_Pr->PanelVCLKIdx315 = VCLK_CUSTOM_315; - SiS_Pr->SiS_VCLKData[VCLK_CUSTOM_315].CLOCK = - SiS_Pr->SiS_VBVCLKData[VCLK_CUSTOM_315].CLOCK = (unsigned short)((unsigned char)ROMAddr[18]); - SiS_Pr->SiS_VCLKData[VCLK_CUSTOM_315].SR2B = - SiS_Pr->SiS_VBVCLKData[VCLK_CUSTOM_315].Part4_A = ROMAddr[19]; - SiS_Pr->SiS_VCLKData[VCLK_CUSTOM_315].SR2C = - SiS_Pr->SiS_VBVCLKData[VCLK_CUSTOM_315].Part4_B = ROMAddr[20]; - - } -#endif -} - -static void -SiS_CheckScaling(struct SiS_Private *SiS_Pr, unsigned short resinfo, - const unsigned char *nonscalingmodes) -{ - int i = 0; - while(nonscalingmodes[i] != 0xff) { - if(nonscalingmodes[i++] == resinfo) { - if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) || - (SiS_Pr->UsePanelScaler == -1)) { - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - break; - } - } -} - -void -SiS_GetLCDResInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned short temp,modeflag,resinfo=0,modexres=0,modeyres=0; - bool panelcanscale = false; -#ifdef CONFIG_FB_SIS_300 - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - static const unsigned char SiS300SeriesLCDRes[] = - { 0, 1, 2, 3, 7, 4, 5, 8, - 0, 0, 10, 0, 0, 0, 0, 15 }; -#endif -#ifdef CONFIG_FB_SIS_315 - unsigned char *myptr = NULL; -#endif - - SiS_Pr->SiS_LCDResInfo = 0; - SiS_Pr->SiS_LCDTypeInfo = 0; - SiS_Pr->SiS_LCDInfo = 0; - SiS_Pr->PanelHRS = 999; /* HSync start */ - SiS_Pr->PanelHRE = 999; /* HSync end */ - SiS_Pr->PanelVRS = 999; /* VSync start */ - SiS_Pr->PanelVRE = 999; /* VSync end */ - SiS_Pr->SiS_NeedRomModeData = false; - - /* Alternative 1600x1200@60 timing for 1600x1200 LCDA */ - SiS_Pr->Alternate1600x1200 = false; - - if(!(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA))) return; - - modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); - - if((ModeNo > 0x13) && (!SiS_Pr->UseCustomMode)) { - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - modexres = SiS_Pr->SiS_ModeResInfo[resinfo].HTotal; - modeyres = SiS_Pr->SiS_ModeResInfo[resinfo].VTotal; - } - - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36); - - /* For broken BIOSes: Assume 1024x768 */ - if(temp == 0) temp = 0x02; - - if((SiS_Pr->ChipType >= SIS_661) || (SiS_Pr->SiS_ROMNew)) { - SiS_Pr->SiS_LCDTypeInfo = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x39) & 0x7c) >> 2; - } else if((SiS_Pr->ChipType < SIS_315H) || (SiS_Pr->ChipType >= SIS_661)) { - SiS_Pr->SiS_LCDTypeInfo = temp >> 4; - } else { - SiS_Pr->SiS_LCDTypeInfo = (temp & 0x0F) - 1; - } - temp &= 0x0f; -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->ChipType < SIS_315H) { - /* Very old BIOSes only know 7 sizes (NetVista 2179, 1.01g) */ - if(SiS_Pr->SiS_VBType & VB_SIS301) { - if(temp < 0x0f) temp &= 0x07; - } - /* Translate 300 series LCDRes to 315 series for unified usage */ - temp = SiS300SeriesLCDRes[temp]; - } -#endif - - /* Translate to our internal types */ -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType == SIS_550) { - if (temp == Panel310_1152x768) temp = Panel_320x240_2; /* Verified working */ - else if(temp == Panel310_320x240_2) temp = Panel_320x240_2; - else if(temp == Panel310_320x240_3) temp = Panel_320x240_3; - } else if(SiS_Pr->ChipType >= SIS_661) { - if(temp == Panel661_1280x854) temp = Panel_1280x854; - } -#endif - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { /* SiS LVDS */ - if(temp == Panel310_1280x768) { - temp = Panel_1280x768_2; - } - if(SiS_Pr->SiS_ROMNew) { - if(temp == Panel661_1280x800) { - temp = Panel_1280x800_2; - } - } - } - - SiS_Pr->SiS_LCDResInfo = temp; - -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) { - SiS_Pr->SiS_LCDResInfo = Panel_Barco1366; - } else if(SiS_Pr->SiS_CustomT == CUT_PANEL848) { - SiS_Pr->SiS_LCDResInfo = Panel_848x480; - } else if(SiS_Pr->SiS_CustomT == CUT_PANEL856) { - SiS_Pr->SiS_LCDResInfo = Panel_856x480; - } - } -#endif - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->SiS_LCDResInfo < SiS_Pr->SiS_PanelMin301) - SiS_Pr->SiS_LCDResInfo = SiS_Pr->SiS_PanelMin301; - } else { - if(SiS_Pr->SiS_LCDResInfo < SiS_Pr->SiS_PanelMinLVDS) - SiS_Pr->SiS_LCDResInfo = SiS_Pr->SiS_PanelMinLVDS; - } - - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37); - SiS_Pr->SiS_LCDInfo = temp & ~0x000e; - /* Need temp below! */ - - /* These must/can't scale no matter what */ - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_320x240_1: - case Panel_320x240_2: - case Panel_320x240_3: - case Panel_1280x960: - SiS_Pr->SiS_LCDInfo &= ~DontExpandLCD; - break; - case Panel_640x480: - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - - panelcanscale = (bool)(SiS_Pr->SiS_LCDInfo & DontExpandLCD); - - if(!SiS_Pr->UsePanelScaler) SiS_Pr->SiS_LCDInfo &= ~DontExpandLCD; - else if(SiS_Pr->UsePanelScaler == 1) SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - - /* Dual link, Pass 1:1 BIOS default, etc. */ -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType >= SIS_661) { - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - if(temp & 0x08) SiS_Pr->SiS_LCDInfo |= LCDPass11; - } - if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) { - if(SiS_Pr->SiS_ROMNew) { - if(temp & 0x02) SiS_Pr->SiS_LCDInfo |= LCDDualLink; - } else if((myptr = GetLCDStructPtr661(SiS_Pr))) { - if(myptr[2] & 0x01) SiS_Pr->SiS_LCDInfo |= LCDDualLink; - } - } - } else if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x39) & 0x01) SiS_Pr->SiS_LCDInfo |= LCDPass11; - } - if((SiS_Pr->SiS_ROMNew) && (!(SiS_Pr->PanelSelfDetected))) { - SiS_Pr->SiS_LCDInfo &= ~(LCDRGB18Bit); - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x35); - if(temp & 0x01) SiS_Pr->SiS_LCDInfo |= LCDRGB18Bit; - if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) { - if(temp & 0x02) SiS_Pr->SiS_LCDInfo |= LCDDualLink; - } - } else if(!(SiS_Pr->SiS_ROMNew)) { - if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) { - if((SiS_Pr->SiS_CustomT == CUT_CLEVO1024) && - (SiS_Pr->SiS_LCDResInfo == Panel_1024x768)) { - SiS_Pr->SiS_LCDInfo |= LCDDualLink; - } - if((SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) || - (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) || - (SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) || - (SiS_Pr->SiS_LCDResInfo == Panel_1680x1050)) { - SiS_Pr->SiS_LCDInfo |= LCDDualLink; - } - } - } - } -#endif - - /* Pass 1:1 */ - if((SiS_Pr->SiS_IF_DEF_LVDS == 1) || (SiS_Pr->SiS_VBType & VB_NoLCD)) { - /* Always center screen on LVDS (if scaling is disabled) */ - SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - /* Always center screen on SiS LVDS (if scaling is disabled) */ - SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - } else { - /* By default, pass 1:1 on SiS TMDS (if scaling is supported) */ - if(panelcanscale) SiS_Pr->SiS_LCDInfo |= LCDPass11; - if(SiS_Pr->CenterScreen == 1) SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - } - } - - SiS_Pr->PanelVCLKIdx300 = VCLK65_300; - SiS_Pr->PanelVCLKIdx315 = VCLK108_2_315; - - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_320x240_1: - case Panel_320x240_2: - case Panel_320x240_3: SiS_Pr->PanelXRes = 640; SiS_Pr->PanelYRes = 480; - SiS_Pr->PanelVRS = 24; SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx300 = VCLK28; - SiS_Pr->PanelVCLKIdx315 = VCLK28; - break; - case Panel_640x480: SiS_Pr->PanelXRes = 640; SiS_Pr->PanelYRes = 480; - SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx300 = VCLK28; - SiS_Pr->PanelVCLKIdx315 = VCLK28; - break; - case Panel_800x600: SiS_Pr->PanelXRes = 800; SiS_Pr->PanelYRes = 600; - SiS_Pr->PanelHT = 1056; SiS_Pr->PanelVT = 628; - SiS_Pr->PanelHRS = 40; SiS_Pr->PanelHRE = 128; - SiS_Pr->PanelVRS = 1; SiS_Pr->PanelVRE = 4; - SiS_Pr->PanelVCLKIdx300 = VCLK40; - SiS_Pr->PanelVCLKIdx315 = VCLK40; - break; - case Panel_1024x600: SiS_Pr->PanelXRes = 1024; SiS_Pr->PanelYRes = 600; - SiS_Pr->PanelHT = 1344; SiS_Pr->PanelVT = 800; - SiS_Pr->PanelHRS = 24; SiS_Pr->PanelHRE = 136; - SiS_Pr->PanelVRS = 2 /* 88 */ ; SiS_Pr->PanelVRE = 6; - SiS_Pr->PanelVCLKIdx300 = VCLK65_300; - SiS_Pr->PanelVCLKIdx315 = VCLK65_315; - break; - case Panel_1024x768: SiS_Pr->PanelXRes = 1024; SiS_Pr->PanelYRes = 768; - SiS_Pr->PanelHT = 1344; SiS_Pr->PanelVT = 806; - SiS_Pr->PanelHRS = 24; SiS_Pr->PanelHRE = 136; - SiS_Pr->PanelVRS = 3; SiS_Pr->PanelVRE = 6; - if(SiS_Pr->ChipType < SIS_315H) { - SiS_Pr->PanelHRS = 23; - SiS_Pr->PanelVRE = 5; - } - SiS_Pr->PanelVCLKIdx300 = VCLK65_300; - SiS_Pr->PanelVCLKIdx315 = VCLK65_315; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1152x768: SiS_Pr->PanelXRes = 1152; SiS_Pr->PanelYRes = 768; - SiS_Pr->PanelHT = 1344; SiS_Pr->PanelVT = 806; - SiS_Pr->PanelHRS = 24; SiS_Pr->PanelHRE = 136; - SiS_Pr->PanelVRS = 3; SiS_Pr->PanelVRE = 6; - if(SiS_Pr->ChipType < SIS_315H) { - SiS_Pr->PanelHRS = 23; - SiS_Pr->PanelVRE = 5; - } - SiS_Pr->PanelVCLKIdx300 = VCLK65_300; - SiS_Pr->PanelVCLKIdx315 = VCLK65_315; - break; - case Panel_1152x864: SiS_Pr->PanelXRes = 1152; SiS_Pr->PanelYRes = 864; - break; - case Panel_1280x720: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 720; - SiS_Pr->PanelHT = 1650; SiS_Pr->PanelVT = 750; - SiS_Pr->PanelHRS = 110; SiS_Pr->PanelHRE = 40; - SiS_Pr->PanelVRS = 5; SiS_Pr->PanelVRE = 5; - SiS_Pr->PanelVCLKIdx315 = VCLK_1280x720; - /* Data above for TMDS (projector); get from BIOS for LVDS */ - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1280x768: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 768; - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - SiS_Pr->PanelHT = 1408; SiS_Pr->PanelVT = 806; - SiS_Pr->PanelVCLKIdx300 = VCLK81_300; /* ? */ - SiS_Pr->PanelVCLKIdx315 = VCLK81_315; /* ? */ - } else { - SiS_Pr->PanelHT = 1688; SiS_Pr->PanelVT = 802; - SiS_Pr->PanelHRS = 48; SiS_Pr->PanelHRS = 112; - SiS_Pr->PanelVRS = 3; SiS_Pr->PanelVRE = 6; - SiS_Pr->PanelVCLKIdx300 = VCLK81_300; - SiS_Pr->PanelVCLKIdx315 = VCLK81_315; - } - break; - case Panel_1280x768_2: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 768; - SiS_Pr->PanelHT = 1660; SiS_Pr->PanelVT = 806; - SiS_Pr->PanelHRS = 48; SiS_Pr->PanelHRE = 112; - SiS_Pr->PanelVRS = 3; SiS_Pr->PanelVRE = 6; - SiS_Pr->PanelVCLKIdx315 = VCLK_1280x768_2; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1280x800: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 800; - SiS_Pr->PanelHT = 1408; SiS_Pr->PanelVT = 816; - SiS_Pr->PanelHRS = 21; SiS_Pr->PanelHRE = 24; - SiS_Pr->PanelVRS = 4; SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx315 = VCLK_1280x800_315; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1280x800_2: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 800; - SiS_Pr->PanelHT = 1552; SiS_Pr->PanelVT = 812; - SiS_Pr->PanelHRS = 48; SiS_Pr->PanelHRE = 112; - SiS_Pr->PanelVRS = 4; SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx315 = VCLK_1280x800_315_2; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1280x854: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 854; - SiS_Pr->PanelHT = 1664; SiS_Pr->PanelVT = 861; - SiS_Pr->PanelHRS = 16; SiS_Pr->PanelHRE = 112; - SiS_Pr->PanelVRS = 1; SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx315 = VCLK_1280x854; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1280x960: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 960; - SiS_Pr->PanelHT = 1800; SiS_Pr->PanelVT = 1000; - SiS_Pr->PanelVCLKIdx300 = VCLK108_3_300; - SiS_Pr->PanelVCLKIdx315 = VCLK108_3_315; - if(resinfo == SIS_RI_1280x1024) { - SiS_Pr->PanelVCLKIdx300 = VCLK100_300; - SiS_Pr->PanelVCLKIdx315 = VCLK100_315; - } - break; - case Panel_1280x1024: SiS_Pr->PanelXRes = 1280; SiS_Pr->PanelYRes = 1024; - SiS_Pr->PanelHT = 1688; SiS_Pr->PanelVT = 1066; - SiS_Pr->PanelHRS = 48; SiS_Pr->PanelHRE = 112; - SiS_Pr->PanelVRS = 1; SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx300 = VCLK108_3_300; - SiS_Pr->PanelVCLKIdx315 = VCLK108_2_315; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1400x1050: SiS_Pr->PanelXRes = 1400; SiS_Pr->PanelYRes = 1050; - SiS_Pr->PanelHT = 1688; SiS_Pr->PanelVT = 1066; - SiS_Pr->PanelHRS = 48; SiS_Pr->PanelHRE = 112; - SiS_Pr->PanelVRS = 1; SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx315 = VCLK108_2_315; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1600x1200: SiS_Pr->PanelXRes = 1600; SiS_Pr->PanelYRes = 1200; - SiS_Pr->PanelHT = 2160; SiS_Pr->PanelVT = 1250; - SiS_Pr->PanelHRS = 64; SiS_Pr->PanelHRE = 192; - SiS_Pr->PanelVRS = 1; SiS_Pr->PanelVRE = 3; - SiS_Pr->PanelVCLKIdx315 = VCLK162_315; - if(SiS_Pr->SiS_VBType & VB_SISTMDSLCDA) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - SiS_Pr->PanelHT = 1760; SiS_Pr->PanelVT = 1235; - SiS_Pr->PanelHRS = 48; SiS_Pr->PanelHRE = 32; - SiS_Pr->PanelVRS = 2; SiS_Pr->PanelVRE = 4; - SiS_Pr->PanelVCLKIdx315 = VCLK130_315; - SiS_Pr->Alternate1600x1200 = true; - } - } else if(SiS_Pr->SiS_IF_DEF_LVDS) { - SiS_Pr->PanelHT = 2048; SiS_Pr->PanelVT = 1320; - SiS_Pr->PanelHRS = SiS_Pr->PanelHRE = 999; - SiS_Pr->PanelVRS = SiS_Pr->PanelVRE = 999; - } - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_1680x1050: SiS_Pr->PanelXRes = 1680; SiS_Pr->PanelYRes = 1050; - SiS_Pr->PanelHT = 1900; SiS_Pr->PanelVT = 1066; - SiS_Pr->PanelHRS = 26; SiS_Pr->PanelHRE = 76; - SiS_Pr->PanelVRS = 3; SiS_Pr->PanelVRE = 6; - SiS_Pr->PanelVCLKIdx315 = VCLK121_315; - SiS_GetLCDInfoBIOS(SiS_Pr); - break; - case Panel_Barco1366: SiS_Pr->PanelXRes = 1360; SiS_Pr->PanelYRes = 1024; - SiS_Pr->PanelHT = 1688; SiS_Pr->PanelVT = 1066; - break; - case Panel_848x480: SiS_Pr->PanelXRes = 848; SiS_Pr->PanelYRes = 480; - SiS_Pr->PanelHT = 1088; SiS_Pr->PanelVT = 525; - break; - case Panel_856x480: SiS_Pr->PanelXRes = 856; SiS_Pr->PanelYRes = 480; - SiS_Pr->PanelHT = 1088; SiS_Pr->PanelVT = 525; - break; - case Panel_Custom: SiS_Pr->PanelXRes = SiS_Pr->CP_MaxX; - SiS_Pr->PanelYRes = SiS_Pr->CP_MaxY; - SiS_Pr->PanelHT = SiS_Pr->CHTotal; - SiS_Pr->PanelVT = SiS_Pr->CVTotal; - if(SiS_Pr->CP_PreferredIndex != -1) { - SiS_Pr->PanelXRes = SiS_Pr->CP_HDisplay[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelYRes = SiS_Pr->CP_VDisplay[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelHT = SiS_Pr->CP_HTotal[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelVT = SiS_Pr->CP_VTotal[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelHRS = SiS_Pr->CP_HSyncStart[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelHRE = SiS_Pr->CP_HSyncEnd[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelVRS = SiS_Pr->CP_VSyncStart[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelVRE = SiS_Pr->CP_VSyncEnd[SiS_Pr->CP_PreferredIndex]; - SiS_Pr->PanelHRS -= SiS_Pr->PanelXRes; - SiS_Pr->PanelHRE -= SiS_Pr->PanelHRS; - SiS_Pr->PanelVRS -= SiS_Pr->PanelYRes; - SiS_Pr->PanelVRE -= SiS_Pr->PanelVRS; - if(SiS_Pr->CP_PrefClock) { - int idx; - SiS_Pr->PanelVCLKIdx315 = VCLK_CUSTOM_315; - SiS_Pr->PanelVCLKIdx300 = VCLK_CUSTOM_300; - if(SiS_Pr->ChipType < SIS_315H) idx = VCLK_CUSTOM_300; - else idx = VCLK_CUSTOM_315; - SiS_Pr->SiS_VCLKData[idx].CLOCK = - SiS_Pr->SiS_VBVCLKData[idx].CLOCK = SiS_Pr->CP_PrefClock; - SiS_Pr->SiS_VCLKData[idx].SR2B = - SiS_Pr->SiS_VBVCLKData[idx].Part4_A = SiS_Pr->CP_PrefSR2B; - SiS_Pr->SiS_VCLKData[idx].SR2C = - SiS_Pr->SiS_VBVCLKData[idx].Part4_B = SiS_Pr->CP_PrefSR2C; - } - } - break; - default: SiS_Pr->PanelXRes = 1024; SiS_Pr->PanelYRes = 768; - SiS_Pr->PanelHT = 1344; SiS_Pr->PanelVT = 806; - break; - } - - /* Special cases */ - if( (SiS_Pr->SiS_IF_DEF_FSTN) || - (SiS_Pr->SiS_IF_DEF_DSTN) || - (SiS_Pr->SiS_CustomT == CUT_BARCO1366) || - (SiS_Pr->SiS_CustomT == CUT_BARCO1024) || - (SiS_Pr->SiS_CustomT == CUT_PANEL848) || - (SiS_Pr->SiS_CustomT == CUT_PANEL856) ) { - SiS_Pr->PanelHRS = 999; - SiS_Pr->PanelHRE = 999; - } - - if( (SiS_Pr->SiS_CustomT == CUT_BARCO1366) || - (SiS_Pr->SiS_CustomT == CUT_BARCO1024) || - (SiS_Pr->SiS_CustomT == CUT_PANEL848) || - (SiS_Pr->SiS_CustomT == CUT_PANEL856) ) { - SiS_Pr->PanelVRS = 999; - SiS_Pr->PanelVRE = 999; - } - - /* DontExpand overrule */ - if((SiS_Pr->SiS_VBType & VB_SISVB) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) { - - if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (modeflag & NoSupportLCDScale)) { - /* No scaling for this mode on any panel (LCD=CRT2)*/ - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - - switch(SiS_Pr->SiS_LCDResInfo) { - - case Panel_Custom: - case Panel_1152x864: - case Panel_1280x768: /* TMDS only */ - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - break; - - case Panel_800x600: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, 0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - break; - } - case Panel_1024x768: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - 0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - break; - } - case Panel_1280x720: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - 0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - if(SiS_Pr->PanelHT == 1650) { - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - break; - } - case Panel_1280x768_2: { /* LVDS only */ - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - switch(resinfo) { - case SIS_RI_1280x720: if(SiS_Pr->UsePanelScaler == -1) { - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - break; - } - break; - } - case Panel_1280x800: { /* SiS TMDS special (Averatec 6200 series) */ - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,SIS_RI_1280x720,SIS_RI_1280x768,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - break; - } - case Panel_1280x800_2: { /* SiS LVDS */ - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - switch(resinfo) { - case SIS_RI_1280x720: - case SIS_RI_1280x768: if(SiS_Pr->UsePanelScaler == -1) { - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - break; - } - break; - } - case Panel_1280x854: { /* SiS LVDS */ - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - switch(resinfo) { - case SIS_RI_1280x720: - case SIS_RI_1280x768: - case SIS_RI_1280x800: if(SiS_Pr->UsePanelScaler == -1) { - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - break; - } - break; - } - case Panel_1280x960: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x720,SIS_RI_1280x768,SIS_RI_1280x800, - SIS_RI_1280x854,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - break; - } - case Panel_1280x1024: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x720,SIS_RI_1280x768,SIS_RI_1280x800, - SIS_RI_1280x854,SIS_RI_1280x960,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - break; - } - case Panel_1400x1050: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x768,SIS_RI_1280x800,SIS_RI_1280x854, - SIS_RI_1280x960,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - switch(resinfo) { - case SIS_RI_1280x720: if(SiS_Pr->UsePanelScaler == -1) { - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - } - break; - case SIS_RI_1280x1024: SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - break; - } - break; - } - case Panel_1600x1200: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x720,SIS_RI_1280x768,SIS_RI_1280x800, - SIS_RI_1280x854,SIS_RI_1280x960,SIS_RI_1360x768,SIS_RI_1360x1024,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - break; - } - case Panel_1680x1050: { - static const unsigned char nonscalingmodes[] = { - SIS_RI_720x480, SIS_RI_720x576, SIS_RI_768x576, SIS_RI_800x480, SIS_RI_848x480, - SIS_RI_856x480, SIS_RI_960x540, SIS_RI_960x600, SIS_RI_1024x576,SIS_RI_1024x600, - SIS_RI_1152x768,SIS_RI_1152x864,SIS_RI_1280x854,SIS_RI_1280x960,SIS_RI_1360x768, - SIS_RI_1360x1024,0xff - }; - SiS_CheckScaling(SiS_Pr, resinfo, nonscalingmodes); - break; - } - } - } - -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - if(SiS_Pr->SiS_CustomT == CUT_PANEL848 || SiS_Pr->SiS_CustomT == CUT_PANEL856) { - SiS_Pr->SiS_LCDInfo = 0x80 | 0x40 | 0x20; /* neg h/v sync, RGB24(D0 = 0) */ - } - } - - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - if(SiS_Pr->SiS_UseROM) { - if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) { - if(!(ROMAddr[0x235] & 0x02)) { - SiS_Pr->SiS_LCDInfo &= (~DontExpandLCD); - } - } - } - } else if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - if((SiS_Pr->SiS_SetFlag & SetDOSMode) && ((ModeNo == 0x03) || (ModeNo == 0x10))) { - SiS_Pr->SiS_LCDInfo &= (~DontExpandLCD); - } - } - } -#endif - - /* Special cases */ - - if(modexres == SiS_Pr->PanelXRes && modeyres == SiS_Pr->PanelYRes) { - SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - } - - if(SiS_Pr->SiS_IF_DEF_TRUMPION) { - SiS_Pr->SiS_LCDInfo |= (DontExpandLCD | LCDPass11); - } - - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_640x480: - SiS_Pr->SiS_LCDInfo |= (DontExpandLCD | LCDPass11); - break; - case Panel_1280x800: - /* Don't pass 1:1 by default (TMDS special) */ - if(SiS_Pr->CenterScreen == -1) SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - break; - case Panel_1280x960: - SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - break; - case Panel_Custom: - if((!SiS_Pr->CP_PrefClock) || - (modexres > SiS_Pr->PanelXRes) || (modeyres > SiS_Pr->PanelYRes)) { - SiS_Pr->SiS_LCDInfo |= LCDPass11; - } - break; - } - - if((SiS_Pr->UseCustomMode) || (SiS_Pr->SiS_CustomT == CUT_UNKNOWNLCD)) { - SiS_Pr->SiS_LCDInfo |= (DontExpandLCD | LCDPass11); - } - - /* (In)validate LCDPass11 flag */ - if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) { - SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - } - - /* LVDS DDA */ - if(!((SiS_Pr->ChipType < SIS_315H) && (SiS_Pr->SiS_SetFlag & SetDOSMode))) { - - if((SiS_Pr->SiS_IF_DEF_LVDS == 1) || (SiS_Pr->SiS_VBType & VB_NoLCD)) { - if(SiS_Pr->SiS_IF_DEF_TRUMPION == 0) { - if(ModeNo == 0x12) { - if(SiS_Pr->SiS_LCDInfo & LCDPass11) { - SiS_Pr->SiS_SetFlag |= EnableLVDSDDA; - } - } else if(ModeNo > 0x13) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x600) { - if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) { - if((resinfo == SIS_RI_800x600) || (resinfo == SIS_RI_400x300)) { - SiS_Pr->SiS_SetFlag |= EnableLVDSDDA; - } - } - } - } - } - } - - if(modeflag & HalfDCLK) { - if(SiS_Pr->SiS_IF_DEF_TRUMPION == 1) { - SiS_Pr->SiS_SetFlag |= EnableLVDSDDA; - } else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - SiS_Pr->SiS_SetFlag |= EnableLVDSDDA; - } else if(SiS_Pr->SiS_LCDResInfo == Panel_640x480) { - SiS_Pr->SiS_SetFlag |= EnableLVDSDDA; - } else if(ModeNo > 0x13) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(resinfo == SIS_RI_512x384) SiS_Pr->SiS_SetFlag |= EnableLVDSDDA; - } else if(SiS_Pr->SiS_LCDResInfo == Panel_800x600) { - if(resinfo == SIS_RI_400x300) SiS_Pr->SiS_SetFlag |= EnableLVDSDDA; - } - } - } - - } - - /* VESA timing */ - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - if(SiS_Pr->SiS_VBInfo & SetNotSimuMode) { - SiS_Pr->SiS_SetFlag |= LCDVESATiming; - } - } else { - SiS_Pr->SiS_SetFlag |= LCDVESATiming; - } - -#if 0 - printk(KERN_DEBUG "sisfb: (LCDInfo=0x%04x LCDResInfo=0x%02x LCDTypeInfo=0x%02x)\n", - SiS_Pr->SiS_LCDInfo, SiS_Pr->SiS_LCDResInfo, SiS_Pr->SiS_LCDTypeInfo); -#endif -} - -/*********************************************/ -/* GET VCLK */ -/*********************************************/ - -unsigned short -SiS_GetVCLK2Ptr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short CRT2Index, VCLKIndex = 0, VCLKIndexGEN = 0, VCLKIndexGENCRT = 0; - unsigned short modeflag, resinfo, tempbx; - const unsigned char *CHTVVCLKPtr = NULL; - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo; - CRT2Index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - VCLKIndexGEN = (SiS_GetRegByte((SiS_Pr->SiS_P3ca+0x02)) >> 2) & 0x03; - VCLKIndexGENCRT = VCLKIndexGEN; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - CRT2Index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - VCLKIndexGEN = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK; - VCLKIndexGENCRT = SiS_GetRefCRTVCLK(SiS_Pr, RefreshRateTableIndex, - (SiS_Pr->SiS_SetFlag & ProgrammingCRT2) ? SiS_Pr->SiS_UseWideCRT2 : SiS_Pr->SiS_UseWide); - } - - if(SiS_Pr->SiS_VBType & VB_SISVB) { /* 30x/B/LV */ - - if(SiS_Pr->SiS_SetFlag & ProgrammingCRT2) { - - CRT2Index >>= 6; - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { /* LCD */ - - if(SiS_Pr->ChipType < SIS_315H) { - VCLKIndex = SiS_Pr->PanelVCLKIdx300; - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (SiS_Pr->SiS_LCDInfo & LCDPass11)) { - VCLKIndex = VCLKIndexGEN; - } - } else { - VCLKIndex = SiS_Pr->PanelVCLKIdx315; - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (SiS_Pr->SiS_LCDInfo & LCDPass11)) { - switch(resinfo) { - /* Correct those whose IndexGEN doesn't match VBVCLK array */ - case SIS_RI_720x480: VCLKIndex = VCLK_720x480; break; - case SIS_RI_720x576: VCLKIndex = VCLK_720x576; break; - case SIS_RI_768x576: VCLKIndex = VCLK_768x576; break; - case SIS_RI_848x480: VCLKIndex = VCLK_848x480; break; - case SIS_RI_856x480: VCLKIndex = VCLK_856x480; break; - case SIS_RI_800x480: VCLKIndex = VCLK_800x480; break; - case SIS_RI_1024x576: VCLKIndex = VCLK_1024x576; break; - case SIS_RI_1152x864: VCLKIndex = VCLK_1152x864; break; - case SIS_RI_1280x720: VCLKIndex = VCLK_1280x720; break; - case SIS_RI_1360x768: VCLKIndex = VCLK_1360x768; break; - default: VCLKIndex = VCLKIndexGEN; - } - - if(ModeNo <= 0x13) { - if(SiS_Pr->ChipType <= SIS_315PRO) { - if(SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC == 1) VCLKIndex = 0x42; - } else { - if(SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC == 1) VCLKIndex = 0x00; - } - } - if(SiS_Pr->ChipType <= SIS_315PRO) { - if(VCLKIndex == 0) VCLKIndex = 0x41; - if(VCLKIndex == 1) VCLKIndex = 0x43; - if(VCLKIndex == 4) VCLKIndex = 0x44; - } - } - } - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { /* TV */ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - if(SiS_Pr->SiS_TVMode & TVRPLLDIV2XO) VCLKIndex = HiTVVCLKDIV2; - else VCLKIndex = HiTVVCLK; - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) VCLKIndex = HiTVSimuVCLK; - } else if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) VCLKIndex = YPbPr750pVCLK; - else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) VCLKIndex = TVVCLKDIV2; - else if(SiS_Pr->SiS_TVMode & TVRPLLDIV2XO) VCLKIndex = TVVCLKDIV2; - else VCLKIndex = TVVCLK; - - if(SiS_Pr->ChipType < SIS_315H) VCLKIndex += TVCLKBASE_300; - else VCLKIndex += TVCLKBASE_315; - - } else { /* VGA2 */ - - VCLKIndex = VCLKIndexGENCRT; - if(SiS_Pr->ChipType < SIS_315H) { - if(ModeNo > 0x13) { - if( (SiS_Pr->ChipType == SIS_630) && - (SiS_Pr->ChipRevision >= 0x30)) { - if(VCLKIndex == 0x14) VCLKIndex = 0x34; - } - /* Better VGA2 clock for 1280x1024@75 */ - if(VCLKIndex == 0x17) VCLKIndex = 0x45; - } - } - } - - } else { /* If not programming CRT2 */ - - VCLKIndex = VCLKIndexGENCRT; - if(SiS_Pr->ChipType < SIS_315H) { - if(ModeNo > 0x13) { - if( (SiS_Pr->ChipType != SIS_630) && - (SiS_Pr->ChipType != SIS_300) ) { - if(VCLKIndex == 0x1b) VCLKIndex = 0x48; - } - } - } - } - - } else { /* LVDS */ - - VCLKIndex = CRT2Index; - - if(SiS_Pr->SiS_SetFlag & ProgrammingCRT2) { - - if( (SiS_Pr->SiS_IF_DEF_CH70xx != 0) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV) ) { - - VCLKIndex &= 0x1f; - tempbx = 0; - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx += 1; - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - tempbx += 2; - if(SiS_Pr->SiS_ModeType > ModeVGA) { - if(SiS_Pr->SiS_CHSOverScan) tempbx = 8; - } - if(SiS_Pr->SiS_TVMode & TVSetPALM) { - tempbx = 4; - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx += 1; - } else if(SiS_Pr->SiS_TVMode & TVSetPALN) { - tempbx = 6; - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx += 1; - } - } - switch(tempbx) { - case 0: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUNTSC; break; - case 1: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKONTSC; break; - case 2: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUPAL; break; - case 3: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPAL; break; - case 4: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUPALM; break; - case 5: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPALM; break; - case 6: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKUPALN; break; - case 7: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPALN; break; - case 8: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKSOPAL; break; - default: CHTVVCLKPtr = SiS_Pr->SiS_CHTVVCLKOPAL; break; - } - VCLKIndex = CHTVVCLKPtr[VCLKIndex]; - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - - if(SiS_Pr->ChipType < SIS_315H) { - VCLKIndex = SiS_Pr->PanelVCLKIdx300; - } else { - VCLKIndex = SiS_Pr->PanelVCLKIdx315; - } - -#ifdef CONFIG_FB_SIS_300 - /* Special Timing: Barco iQ Pro R series */ - if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) VCLKIndex = 0x44; - - /* Special Timing: 848x480 and 856x480 parallel lvds panels */ - if(SiS_Pr->SiS_CustomT == CUT_PANEL848 || SiS_Pr->SiS_CustomT == CUT_PANEL856) { - if(SiS_Pr->ChipType < SIS_315H) { - VCLKIndex = VCLK34_300; - /* if(resinfo == SIS_RI_1360x768) VCLKIndex = ?; */ - } else { - VCLKIndex = VCLK34_315; - /* if(resinfo == SIS_RI_1360x768) VCLKIndex = ?; */ - } - } -#endif - - } else { - - VCLKIndex = VCLKIndexGENCRT; - if(SiS_Pr->ChipType < SIS_315H) { - if(ModeNo > 0x13) { - if( (SiS_Pr->ChipType == SIS_630) && - (SiS_Pr->ChipRevision >= 0x30) ) { - if(VCLKIndex == 0x14) VCLKIndex = 0x2e; - } - } - } - } - - } else { /* if not programming CRT2 */ - - VCLKIndex = VCLKIndexGENCRT; - if(SiS_Pr->ChipType < SIS_315H) { - if(ModeNo > 0x13) { - if( (SiS_Pr->ChipType != SIS_630) && - (SiS_Pr->ChipType != SIS_300) ) { - if(VCLKIndex == 0x1b) VCLKIndex = 0x48; - } -#if 0 - if(SiS_Pr->ChipType == SIS_730) { - if(VCLKIndex == 0x0b) VCLKIndex = 0x40; /* 1024x768-70 */ - if(VCLKIndex == 0x0d) VCLKIndex = 0x41; /* 1024x768-75 */ - } -#endif - } - } - - } - - } - - return VCLKIndex; -} - -/*********************************************/ -/* SET CRT2 MODE TYPE REGISTERS */ -/*********************************************/ - -static void -SiS_SetCRT2ModeRegs(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned short i, j, modeflag, tempah=0; - short tempcl; -#if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) - unsigned short tempbl; -#endif -#ifdef CONFIG_FB_SIS_315 - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short tempah2, tempbl2; -#endif - - modeflag = SiS_GetModeFlag(SiS_Pr, ModeNo, ModeIdIndex); - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x00,0xAF,0x40); - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2E,0xF7); - - } else { - - for(i=0,j=4; i<3; i++,j++) SiS_SetReg(SiS_Pr->SiS_Part1Port,j,0); - if(SiS_Pr->ChipType >= SIS_315H) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0x7F); - } - - tempcl = SiS_Pr->SiS_ModeType; - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* ---- 300 series ---- */ - - /* For 301BDH: (with LCD via LVDS) */ - if(SiS_Pr->SiS_VBType & VB_NoLCD) { - tempbl = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32); - tempbl &= 0xef; - tempbl |= 0x02; - if((SiS_Pr->SiS_VBInfo & SetCRT2ToTV) || (SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) { - tempbl |= 0x10; - tempbl &= 0xfd; - } - SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,tempbl); - } - - if(ModeNo > 0x13) { - tempcl -= ModeVGA; - if(tempcl >= 0) { - tempah = ((0x10 >> tempcl) | 0x80); - } - } else tempah = 0x80; - - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) tempah ^= 0xA0; - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* ------- 315/330 series ------ */ - - if(ModeNo > 0x13) { - tempcl -= ModeVGA; - if(tempcl >= 0) { - tempah = (0x08 >> tempcl); - if (tempah == 0) tempah = 1; - tempah |= 0x40; - } - } else tempah = 0x40; - - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) tempah ^= 0x50; - -#endif /* CONFIG_FB_SIS_315 */ - - } - - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0; - - if(SiS_Pr->ChipType < SIS_315H) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,tempah); - } else { -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x00,0xa0,tempah); - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(IS_SIS740) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,tempah); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x00,0xa0,tempah); - } - } -#endif - } - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - tempah = 0x01; - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - tempah |= 0x02; - } - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) { - tempah ^= 0x05; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) { - tempah ^= 0x01; - } - } - - if(SiS_Pr->ChipType < SIS_315H) { - - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0; - - tempah = (tempah << 5) & 0xFF; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,tempah); - tempah = (tempah >> 5) & 0xFF; - - } else { - - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0x08; - else if(!(SiS_IsDualEdge(SiS_Pr))) tempah |= 0x08; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2E,0xF0,tempah); - tempah &= ~0x08; - - } - - if((SiS_Pr->SiS_ModeType == ModeVGA) && (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode))) { - tempah |= 0x10; - } - - tempah |= 0x80; - if(SiS_Pr->SiS_VBType & VB_SIS301) { - if(SiS_Pr->PanelXRes < 1280 && SiS_Pr->PanelYRes < 960) tempah &= ~0x80; - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(!(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p | TVSetYPbPr525p))) { - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - tempah |= 0x20; - } - } - } - - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0D,0x40,tempah); - - tempah = 0x80; - if(SiS_Pr->SiS_VBType & VB_SIS301) { - if(SiS_Pr->PanelXRes < 1280 && SiS_Pr->PanelYRes < 960) tempah = 0; - } - - if(SiS_IsDualLink(SiS_Pr)) tempah |= 0x40; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(SiS_Pr->SiS_TVMode & TVRPLLDIV2XO) { - tempah |= 0x40; - } - } - - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0C,tempah); - - } else { /* LVDS */ - - if(SiS_Pr->ChipType >= SIS_315H) { - -#ifdef CONFIG_FB_SIS_315 - /* LVDS can only be slave in 8bpp modes */ - tempah = 0x80; - if((modeflag & CRT2Mode) && (SiS_Pr->SiS_ModeType > ModeVGA)) { - if(SiS_Pr->SiS_VBInfo & DriverMode) { - tempah |= 0x02; - } - } - - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) tempah |= 0x02; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) tempah ^= 0x01; - - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 1; - - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2e,0xF0,tempah); -#endif - - } else { - -#ifdef CONFIG_FB_SIS_300 - tempah = 0; - if( (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) && (SiS_Pr->SiS_ModeType > ModeVGA) ) { - tempah |= 0x02; - } - tempah <<= 5; - - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0; - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,tempah); -#endif - - } - - } - - } /* LCDA */ - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->ChipType >= SIS_315H) { - -#ifdef CONFIG_FB_SIS_315 - /* unsigned char bridgerev = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x01); */ - - /* The following is nearly unpreditable and varies from machine - * to machine. Especially the 301DH seems to be a real trouble - * maker. Some BIOSes simply set the registers (like in the - * NoLCD-if-statements here), some set them according to the - * LCDA stuff. It is very likely that some machines are not - * treated correctly in the following, very case-orientated - * code. What do I do then...? - */ - - /* 740 variants match for 30xB, 301B-DH, 30xLV */ - - if(!(IS_SIS740)) { - tempah = 0x04; /* For all bridges */ - tempbl = 0xfb; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - tempah = 0x00; - if(SiS_IsDualEdge(SiS_Pr)) { - tempbl = 0xff; - } - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,tempbl,tempah); - } - - /* The following two are responsible for eventually wrong colors - * in TV output. The DH (VB_NoLCD) conditions are unknown; the - * b0 was found in some 651 machine (Pim; P4_23=0xe5); the b1 version - * in a 650 box (Jake). What is the criteria? - * Addendum: Another combination 651+301B-DH(b1) (Rapo) needs same - * treatment like the 651+301B-DH(b0) case. Seems more to be the - * chipset than the bridge revision. - */ - - if((IS_SIS740) || (SiS_Pr->ChipType >= SIS_661) || (SiS_Pr->SiS_ROMNew)) { - tempah = 0x30; - tempbl = 0xc0; - if((SiS_Pr->SiS_VBInfo & DisableCRT2Display) || - ((SiS_Pr->SiS_ROMNew) && (!(ROMAddr[0x5b] & 0x04)))) { - tempah = 0x00; - tempbl = 0x00; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2c,0xcf,tempah); - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,0x3f,tempbl); - } else if(SiS_Pr->SiS_VBType & VB_SIS301) { - /* Fixes "TV-blue-bug" on 315+301 */ - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2c,0xcf); /* For 301 */ - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x21,0x3f); - } else if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2c,0x30); /* For 30xLV */ - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x21,0xc0); - } else if(SiS_Pr->SiS_VBType & VB_NoLCD) { /* For 301B-DH */ - tempah = 0x30; tempah2 = 0xc0; - tempbl = 0xcf; tempbl2 = 0x3f; - if(SiS_Pr->SiS_TVBlue == 0) { - tempah = tempah2 = 0x00; - } else if(SiS_Pr->SiS_TVBlue == -1) { - /* Set on 651/M650, clear on 315/650 */ - if(!(IS_SIS65x)) /* (bridgerev != 0xb0) */ { - tempah = tempah2 = 0x00; - } - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2c,tempbl,tempah); - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,tempbl2,tempah2); - } else { - tempah = 0x30; tempah2 = 0xc0; /* For 30xB, 301C */ - tempbl = 0xcf; tempbl2 = 0x3f; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - tempah = tempah2 = 0x00; - if(SiS_IsDualEdge(SiS_Pr)) { - tempbl = tempbl2 = 0xff; - } - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2c,tempbl,tempah); - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,tempbl2,tempah2); - } - - if(IS_SIS740) { - tempah = 0x80; - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) tempah = 0x00; - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x23,0x7f,tempah); - } else { - tempah = 0x00; - tempbl = 0x7f; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - tempbl = 0xff; - if(!(SiS_IsDualEdge(SiS_Pr))) tempah = 0x80; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x23,tempbl,tempah); - } - -#endif /* CONFIG_FB_SIS_315 */ - - } else if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - -#ifdef CONFIG_FB_SIS_300 - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x21,0x3f); - - if((SiS_Pr->SiS_VBInfo & DisableCRT2Display) || - ((SiS_Pr->SiS_VBType & VB_NoLCD) && - (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD))) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x23,0x7F); - } else { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x23,0x80); - } -#endif - - } - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x0D,0x80); - if(SiS_Pr->SiS_VBType & VB_SIS30xCLV) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x3A,0xC0); - } - } - - } else { /* LVDS */ - -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType >= SIS_315H) { - - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - - tempah = 0x04; - tempbl = 0xfb; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - tempah = 0x00; - if(SiS_IsDualEdge(SiS_Pr)) tempbl = 0xff; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,tempbl,tempah); - - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb); - } - - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2c,0x30); - - } else if(SiS_Pr->ChipType == SIS_550) { - - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2c,0x30); - - } - - } -#endif - - } - -} - -/*********************************************/ -/* GET RESOLUTION DATA */ -/*********************************************/ - -unsigned short -SiS_GetResInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - if(ModeNo <= 0x13) - return ((unsigned short)SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo); - else - return ((unsigned short)SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO); -} - -static void -SiS_GetCRT2ResInfo(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned short xres, yres, modeflag=0, resindex; - - if(SiS_Pr->UseCustomMode) { - xres = SiS_Pr->CHDisplay; - if(SiS_Pr->CModeFlag & HalfDCLK) xres <<= 1; - SiS_Pr->SiS_VGAHDE = SiS_Pr->SiS_HDE = xres; - /* DoubleScanMode-check done in CheckCalcCustomMode()! */ - SiS_Pr->SiS_VGAVDE = SiS_Pr->SiS_VDE = SiS_Pr->CVDisplay; - return; - } - - resindex = SiS_GetResInfo(SiS_Pr,ModeNo,ModeIdIndex); - - if(ModeNo <= 0x13) { - xres = SiS_Pr->SiS_StResInfo[resindex].HTotal; - yres = SiS_Pr->SiS_StResInfo[resindex].VTotal; - } else { - xres = SiS_Pr->SiS_ModeResInfo[resindex].HTotal; - yres = SiS_Pr->SiS_ModeResInfo[resindex].VTotal; - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - } - - if(!SiS_Pr->SiS_IF_DEF_DSTN && !SiS_Pr->SiS_IF_DEF_FSTN) { - - if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_IF_DEF_LVDS == 1)) { - if((ModeNo != 0x03) && (SiS_Pr->SiS_SetFlag & SetDOSMode)) { - if(yres == 350) yres = 400; - } - if(SiS_GetReg(SiS_Pr->SiS_P3d4,0x3a) & 0x01) { - if(ModeNo == 0x12) yres = 400; - } - } - - if(modeflag & HalfDCLK) xres <<= 1; - if(modeflag & DoubleScanMode) yres <<= 1; - - } - - if((SiS_Pr->SiS_VBType & VB_SISVB) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) { - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_1024x768: - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) { - if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) { - if(yres == 350) yres = 357; - if(yres == 400) yres = 420; - if(yres == 480) yres = 525; - } - } - break; - case Panel_1280x1024: - if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) { - /* BIOS bug - does this regardless of scaling */ - if(yres == 400) yres = 405; - } - if(yres == 350) yres = 360; - if(SiS_Pr->SiS_SetFlag & LCDVESATiming) { - if(yres == 360) yres = 375; - } - break; - case Panel_1600x1200: - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) { - if(yres == 1024) yres = 1056; - } - break; - } - } - - } else { - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToHiVision)) { - if(xres == 720) xres = 640; - } - } else if(xres == 720) xres = 640; - - if(SiS_Pr->SiS_SetFlag & SetDOSMode) { - yres = 400; - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x17) & 0x80) yres = 480; - } else { - if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x80) yres = 480; - } - if(SiS_Pr->SiS_IF_DEF_DSTN || SiS_Pr->SiS_IF_DEF_FSTN) yres = 480; - } - - } - SiS_Pr->SiS_VGAHDE = SiS_Pr->SiS_HDE = xres; - SiS_Pr->SiS_VGAVDE = SiS_Pr->SiS_VDE = yres; -} - -/*********************************************/ -/* GET CRT2 TIMING DATA */ -/*********************************************/ - -static void -SiS_GetCRT2Ptr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex, unsigned short *CRT2Index, - unsigned short *ResIndex) -{ - unsigned short tempbx=0, tempal=0, resinfo=0; - - if(ModeNo <= 0x13) { - tempal = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - } else { - tempal = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - } - - if((SiS_Pr->SiS_VBType & VB_SISVB) && (SiS_Pr->SiS_IF_DEF_LVDS == 0)) { - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { /* LCD */ - - tempbx = SiS_Pr->SiS_LCDResInfo; - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx += 32; - - /* patch index */ - if(SiS_Pr->SiS_LCDResInfo == Panel_1680x1050) { - if (resinfo == SIS_RI_1280x800) tempal = 9; - else if(resinfo == SIS_RI_1400x1050) tempal = 11; - } else if((SiS_Pr->SiS_LCDResInfo == Panel_1280x800) || - (SiS_Pr->SiS_LCDResInfo == Panel_1280x800_2) || - (SiS_Pr->SiS_LCDResInfo == Panel_1280x854)) { - if (resinfo == SIS_RI_1280x768) tempal = 9; - } - - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - /* Pass 1:1 only (center-screen handled outside) */ - /* This is never called for the panel's native resolution */ - /* since Pass1:1 will not be set in this case */ - tempbx = 100; - if(ModeNo >= 0x13) { - tempal = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC_NS; - } - } - -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) { - if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) { - tempbx = 200; - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx++; - } - } - } -#endif - - } else { /* TV */ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - /* if(SiS_Pr->SiS_VGAVDE > 480) SiS_Pr->SiS_TVMode &= (~TVSetTVSimuMode); */ - tempbx = 2; - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - tempbx = 13; - if(!(SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) tempbx = 14; - } - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) tempbx = 7; - else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) tempbx = 6; - else tempbx = 5; - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) tempbx += 5; - } else { - if(SiS_Pr->SiS_TVMode & TVSetPAL) tempbx = 3; - else tempbx = 4; - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) tempbx += 5; - } - - } - - tempal &= 0x3F; - - if(ModeNo > 0x13) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoHiVision) { - switch(resinfo) { - case SIS_RI_720x480: - tempal = 6; - if(SiS_Pr->SiS_TVMode & (TVSetPAL | TVSetPALN)) tempal = 9; - break; - case SIS_RI_720x576: - case SIS_RI_768x576: - case SIS_RI_1024x576: /* Not in NTSC or YPBPR mode (except 1080i)! */ - tempal = 6; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) tempal = 8; - } - break; - case SIS_RI_800x480: - tempal = 4; - break; - case SIS_RI_512x384: - case SIS_RI_1024x768: - tempal = 7; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) tempal = 8; - } - break; - case SIS_RI_1280x720: - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) tempal = 9; - } - break; - } - } - } - - *CRT2Index = tempbx; - *ResIndex = tempal; - - } else { /* LVDS, 301B-DH (if running on LCD) */ - - tempbx = 0; - if((SiS_Pr->SiS_IF_DEF_CH70xx) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) { - - tempbx = 90; - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - tempbx = 92; - if(SiS_Pr->SiS_ModeType > ModeVGA) { - if(SiS_Pr->SiS_CHSOverScan) tempbx = 99; - } - if(SiS_Pr->SiS_TVMode & TVSetPALM) tempbx = 94; - else if(SiS_Pr->SiS_TVMode & TVSetPALN) tempbx = 96; - } - if(tempbx != 99) { - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) tempbx++; - } - - } else { - - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_640x480: tempbx = 12; break; - case Panel_320x240_1: tempbx = 10; break; - case Panel_320x240_2: - case Panel_320x240_3: tempbx = 14; break; - case Panel_800x600: tempbx = 16; break; - case Panel_1024x600: tempbx = 18; break; - case Panel_1152x768: - case Panel_1024x768: tempbx = 20; break; - case Panel_1280x768: tempbx = 22; break; - case Panel_1280x1024: tempbx = 24; break; - case Panel_1400x1050: tempbx = 26; break; - case Panel_1600x1200: tempbx = 28; break; -#ifdef CONFIG_FB_SIS_300 - case Panel_Barco1366: tempbx = 80; break; -#endif - } - - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_320x240_1: - case Panel_320x240_2: - case Panel_320x240_3: - case Panel_640x480: - break; - default: - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++; - } - - if(SiS_Pr->SiS_LCDInfo & LCDPass11) tempbx = 30; - -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->SiS_CustomT == CUT_BARCO1024) { - tempbx = 82; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++; - } else if(SiS_Pr->SiS_CustomT == CUT_PANEL848 || SiS_Pr->SiS_CustomT == CUT_PANEL856) { - tempbx = 84; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++; - } -#endif - - } - - (*CRT2Index) = tempbx; - (*ResIndex) = tempal & 0x1F; - } -} - -static void -SiS_GetRAMDAC2DATA(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short tempax=0, tempbx=0, index, dotclock; - unsigned short temp1=0, modeflag=0, tempcx=0; - - SiS_Pr->SiS_RVBHCMAX = 1; - SiS_Pr->SiS_RVBHCFACT = 1; - - if(ModeNo <= 0x13) { - - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - index = SiS_GetModePtr(SiS_Pr,ModeNo,ModeIdIndex); - - tempax = SiS_Pr->SiS_StandTable[index].CRTC[0]; - tempbx = SiS_Pr->SiS_StandTable[index].CRTC[6]; - temp1 = SiS_Pr->SiS_StandTable[index].CRTC[7]; - - dotclock = (modeflag & Charx8Dot) ? 8 : 9; - - } else { - - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - index = SiS_GetRefCRT1CRTC(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWideCRT2); - - tempax = SiS_Pr->SiS_CRT1Table[index].CR[0]; - tempax |= (SiS_Pr->SiS_CRT1Table[index].CR[14] << 8); - tempax &= 0x03FF; - tempbx = SiS_Pr->SiS_CRT1Table[index].CR[6]; - tempcx = SiS_Pr->SiS_CRT1Table[index].CR[13] << 8; - tempcx &= 0x0100; - tempcx <<= 2; - tempbx |= tempcx; - temp1 = SiS_Pr->SiS_CRT1Table[index].CR[7]; - - dotclock = 8; - - } - - if(temp1 & 0x01) tempbx |= 0x0100; - if(temp1 & 0x20) tempbx |= 0x0200; - - tempax += 5; - tempax *= dotclock; - if(modeflag & HalfDCLK) tempax <<= 1; - - tempbx++; - - SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = tempax; - SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = tempbx; -} - -static void -SiS_CalcPanelLinkTiming(struct SiS_Private *SiS_Pr, unsigned short ModeNo, - unsigned short ModeIdIndex, unsigned short RefreshRateTableIndex) -{ - unsigned short ResIndex; - - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - if(SiS_Pr->SiS_LCDInfo & LCDPass11) { - if(SiS_Pr->UseCustomMode) { - ResIndex = SiS_Pr->CHTotal; - if(SiS_Pr->CModeFlag & HalfDCLK) ResIndex <<= 1; - SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = ResIndex; - SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->CVTotal; - } else { - if(ModeNo < 0x13) { - ResIndex = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - } else { - ResIndex = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC_NS; - } - if(ResIndex == 0x09) { - if(SiS_Pr->Alternate1600x1200) ResIndex = 0x20; /* 1600x1200 LCDA */ - else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) ResIndex = 0x21; /* 1600x1200 LVDS */ - } - SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_NoScaleData[ResIndex].VGAHT; - SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_NoScaleData[ResIndex].VGAVT; - SiS_Pr->SiS_HT = SiS_Pr->SiS_NoScaleData[ResIndex].LCDHT; - SiS_Pr->SiS_VT = SiS_Pr->SiS_NoScaleData[ResIndex].LCDVT; - } - } else { - SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = SiS_Pr->PanelHT; - SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->PanelVT; - } - } else { - /* This handles custom modes and custom panels */ - SiS_Pr->SiS_HDE = SiS_Pr->PanelXRes; - SiS_Pr->SiS_VDE = SiS_Pr->PanelYRes; - SiS_Pr->SiS_HT = SiS_Pr->PanelHT; - SiS_Pr->SiS_VT = SiS_Pr->PanelVT; - SiS_Pr->SiS_VGAHT = SiS_Pr->PanelHT - (SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE); - SiS_Pr->SiS_VGAVT = SiS_Pr->PanelVT - (SiS_Pr->PanelYRes - SiS_Pr->SiS_VGAVDE); - } -} - -static void -SiS_GetCRT2DataLVDS(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short CRT2Index, ResIndex, backup; - const struct SiS_LVDSData *LVDSData = NULL; - - SiS_GetCRT2ResInfo(SiS_Pr, ModeNo, ModeIdIndex); - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - SiS_Pr->SiS_RVBHCMAX = 1; - SiS_Pr->SiS_RVBHCFACT = 1; - SiS_Pr->SiS_NewFlickerMode = 0; - SiS_Pr->SiS_RVBHRS = 50; - SiS_Pr->SiS_RY1COE = 0; - SiS_Pr->SiS_RY2COE = 0; - SiS_Pr->SiS_RY3COE = 0; - SiS_Pr->SiS_RY4COE = 0; - SiS_Pr->SiS_RVBHRS2 = 0; - } - - if((SiS_Pr->SiS_VBType & VB_SISVB) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - -#ifdef CONFIG_FB_SIS_315 - SiS_CalcPanelLinkTiming(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - SiS_CalcLCDACRT1Timing(SiS_Pr, ModeNo, ModeIdIndex); -#endif - - } else { - - /* 301BDH needs LVDS Data */ - backup = SiS_Pr->SiS_IF_DEF_LVDS; - if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) { - SiS_Pr->SiS_IF_DEF_LVDS = 1; - } - - SiS_GetCRT2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex, - &CRT2Index, &ResIndex); - - SiS_Pr->SiS_IF_DEF_LVDS = backup; - - switch(CRT2Index) { - case 10: LVDSData = SiS_Pr->SiS_LVDS320x240Data_1; break; - case 14: LVDSData = SiS_Pr->SiS_LVDS320x240Data_2; break; - case 12: LVDSData = SiS_Pr->SiS_LVDS640x480Data_1; break; - case 16: LVDSData = SiS_Pr->SiS_LVDS800x600Data_1; break; - case 18: LVDSData = SiS_Pr->SiS_LVDS1024x600Data_1; break; - case 20: LVDSData = SiS_Pr->SiS_LVDS1024x768Data_1; break; -#ifdef CONFIG_FB_SIS_300 - case 80: LVDSData = SiS_Pr->SiS_LVDSBARCO1366Data_1; break; - case 81: LVDSData = SiS_Pr->SiS_LVDSBARCO1366Data_2; break; - case 82: LVDSData = SiS_Pr->SiS_LVDSBARCO1024Data_1; break; - case 84: LVDSData = SiS_Pr->SiS_LVDS848x480Data_1; break; - case 85: LVDSData = SiS_Pr->SiS_LVDS848x480Data_2; break; -#endif - case 90: LVDSData = SiS_Pr->SiS_CHTVUNTSCData; break; - case 91: LVDSData = SiS_Pr->SiS_CHTVONTSCData; break; - case 92: LVDSData = SiS_Pr->SiS_CHTVUPALData; break; - case 93: LVDSData = SiS_Pr->SiS_CHTVOPALData; break; - case 94: LVDSData = SiS_Pr->SiS_CHTVUPALMData; break; - case 95: LVDSData = SiS_Pr->SiS_CHTVOPALMData; break; - case 96: LVDSData = SiS_Pr->SiS_CHTVUPALNData; break; - case 97: LVDSData = SiS_Pr->SiS_CHTVOPALNData; break; - case 99: LVDSData = SiS_Pr->SiS_CHTVSOPALData; break; - } - - if(LVDSData) { - SiS_Pr->SiS_VGAHT = (LVDSData+ResIndex)->VGAHT; - SiS_Pr->SiS_VGAVT = (LVDSData+ResIndex)->VGAVT; - SiS_Pr->SiS_HT = (LVDSData+ResIndex)->LCDHT; - SiS_Pr->SiS_VT = (LVDSData+ResIndex)->LCDVT; - } else { - SiS_CalcPanelLinkTiming(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - - if( (!(SiS_Pr->SiS_VBType & VB_SISVB)) && - (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && - (!(SiS_Pr->SiS_LCDInfo & LCDPass11)) ) { - if( (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) || - (SiS_Pr->SiS_SetFlag & SetDOSMode) ) { - SiS_Pr->SiS_HDE = SiS_Pr->PanelXRes; - SiS_Pr->SiS_VDE = SiS_Pr->PanelYRes; -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) { - if(ResIndex < 0x08) { - SiS_Pr->SiS_HDE = 1280; - SiS_Pr->SiS_VDE = 1024; - } - } -#endif - } - } - } -} - -static void -SiS_GetCRT2Data301(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned char *ROMAddr = NULL; - unsigned short tempax, tempbx, modeflag, romptr=0; - unsigned short resinfo, CRT2Index, ResIndex; - const struct SiS_LCDData *LCDPtr = NULL; - const struct SiS_TVData *TVPtr = NULL; -#ifdef CONFIG_FB_SIS_315 - short resinfo661; -#endif - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo; - } else if(SiS_Pr->UseCustomMode) { - modeflag = SiS_Pr->CModeFlag; - resinfo = 0; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; -#ifdef CONFIG_FB_SIS_315 - resinfo661 = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].ROMMODEIDX661; - if( (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && - (SiS_Pr->SiS_SetFlag & LCDVESATiming) && - (resinfo661 >= 0) && - (SiS_Pr->SiS_NeedRomModeData) ) { - if((ROMAddr = GetLCDStructPtr661(SiS_Pr))) { - if((romptr = (SISGETROMW(21)))) { - romptr += (resinfo661 * 10); - ROMAddr = SiS_Pr->VirtualRomBase; - } - } - } -#endif - } - - SiS_Pr->SiS_NewFlickerMode = 0; - SiS_Pr->SiS_RVBHRS = 50; - SiS_Pr->SiS_RY1COE = 0; - SiS_Pr->SiS_RY2COE = 0; - SiS_Pr->SiS_RY3COE = 0; - SiS_Pr->SiS_RY4COE = 0; - SiS_Pr->SiS_RVBHRS2 = 0; - - SiS_GetCRT2ResInfo(SiS_Pr,ModeNo,ModeIdIndex); - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) { - - if(SiS_Pr->UseCustomMode) { - - SiS_Pr->SiS_RVBHCMAX = 1; - SiS_Pr->SiS_RVBHCFACT = 1; - SiS_Pr->SiS_HDE = SiS_Pr->SiS_VGAHDE; - SiS_Pr->SiS_VDE = SiS_Pr->SiS_VGAVDE; - - tempax = SiS_Pr->CHTotal; - if(modeflag & HalfDCLK) tempax <<= 1; - SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = tempax; - SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->CVTotal; - - } else { - - SiS_GetRAMDAC2DATA(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - - } - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - - SiS_GetCRT2Ptr(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex, - &CRT2Index,&ResIndex); - - switch(CRT2Index) { - case 2: TVPtr = SiS_Pr->SiS_ExtHiTVData; break; - case 3: TVPtr = SiS_Pr->SiS_ExtPALData; break; - case 4: TVPtr = SiS_Pr->SiS_ExtNTSCData; break; - case 5: TVPtr = SiS_Pr->SiS_Ext525iData; break; - case 6: TVPtr = SiS_Pr->SiS_Ext525pData; break; - case 7: TVPtr = SiS_Pr->SiS_Ext750pData; break; - case 8: TVPtr = SiS_Pr->SiS_StPALData; break; - case 9: TVPtr = SiS_Pr->SiS_StNTSCData; break; - case 10: TVPtr = SiS_Pr->SiS_St525iData; break; - case 11: TVPtr = SiS_Pr->SiS_St525pData; break; - case 12: TVPtr = SiS_Pr->SiS_St750pData; break; - case 13: TVPtr = SiS_Pr->SiS_St1HiTVData; break; - case 14: TVPtr = SiS_Pr->SiS_St2HiTVData; break; - default: TVPtr = SiS_Pr->SiS_StPALData; break; - } - - SiS_Pr->SiS_RVBHCMAX = (TVPtr+ResIndex)->RVBHCMAX; - SiS_Pr->SiS_RVBHCFACT = (TVPtr+ResIndex)->RVBHCFACT; - SiS_Pr->SiS_VGAHT = (TVPtr+ResIndex)->VGAHT; - SiS_Pr->SiS_VGAVT = (TVPtr+ResIndex)->VGAVT; - SiS_Pr->SiS_HDE = (TVPtr+ResIndex)->TVHDE; - SiS_Pr->SiS_VDE = (TVPtr+ResIndex)->TVVDE; - SiS_Pr->SiS_RVBHRS2 = (TVPtr+ResIndex)->RVBHRS2 & 0x0fff; - if(modeflag & HalfDCLK) { - SiS_Pr->SiS_RVBHRS = (TVPtr+ResIndex)->HALFRVBHRS; - if(SiS_Pr->SiS_RVBHRS2) { - SiS_Pr->SiS_RVBHRS2 = ((SiS_Pr->SiS_RVBHRS2 + 3) >> 1) - 3; - tempax = ((TVPtr+ResIndex)->RVBHRS2 >> 12) & 0x07; - if((TVPtr+ResIndex)->RVBHRS2 & 0x8000) SiS_Pr->SiS_RVBHRS2 -= tempax; - else SiS_Pr->SiS_RVBHRS2 += tempax; - } - } else { - SiS_Pr->SiS_RVBHRS = (TVPtr+ResIndex)->RVBHRS; - } - SiS_Pr->SiS_NewFlickerMode = ((TVPtr+ResIndex)->FlickerMode) << 7; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - - if((resinfo == SIS_RI_960x600) || - (resinfo == SIS_RI_1024x768) || - (resinfo == SIS_RI_1280x1024) || - (resinfo == SIS_RI_1280x720)) { - SiS_Pr->SiS_NewFlickerMode = 0x40; - } - - if(SiS_Pr->SiS_VGAVDE == 350) SiS_Pr->SiS_TVMode |= TVSetTVSimuMode; - - SiS_Pr->SiS_HT = ExtHiTVHT; - SiS_Pr->SiS_VT = ExtHiTVVT; - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) { - SiS_Pr->SiS_HT = StHiTVHT; - SiS_Pr->SiS_VT = StHiTVVT; - } - } - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) { - SiS_Pr->SiS_HT = 1650; - SiS_Pr->SiS_VT = 750; - } else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) { - SiS_Pr->SiS_HT = NTSCHT; - if(SiS_Pr->SiS_TVMode & TVSet525p1024) SiS_Pr->SiS_HT = NTSC2HT; - SiS_Pr->SiS_VT = NTSCVT; - } else { - SiS_Pr->SiS_HT = NTSCHT; - if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) SiS_Pr->SiS_HT = NTSC2HT; - SiS_Pr->SiS_VT = NTSCVT; - } - - } else { - - SiS_Pr->SiS_RY1COE = (TVPtr+ResIndex)->RY1COE; - SiS_Pr->SiS_RY2COE = (TVPtr+ResIndex)->RY2COE; - SiS_Pr->SiS_RY3COE = (TVPtr+ResIndex)->RY3COE; - SiS_Pr->SiS_RY4COE = (TVPtr+ResIndex)->RY4COE; - - if(modeflag & HalfDCLK) { - SiS_Pr->SiS_RY1COE = 0x00; - SiS_Pr->SiS_RY2COE = 0xf4; - SiS_Pr->SiS_RY3COE = 0x10; - SiS_Pr->SiS_RY4COE = 0x38; - } - - if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) { - SiS_Pr->SiS_HT = NTSCHT; - if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) SiS_Pr->SiS_HT = NTSC2HT; - SiS_Pr->SiS_VT = NTSCVT; - } else { - SiS_Pr->SiS_HT = PALHT; - SiS_Pr->SiS_VT = PALVT; - } - - } - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - - SiS_Pr->SiS_RVBHCMAX = 1; - SiS_Pr->SiS_RVBHCFACT = 1; - - if(SiS_Pr->UseCustomMode) { - - SiS_Pr->SiS_HDE = SiS_Pr->SiS_VGAHDE; - SiS_Pr->SiS_VDE = SiS_Pr->SiS_VGAVDE; - - tempax = SiS_Pr->CHTotal; - if(modeflag & HalfDCLK) tempax <<= 1; - SiS_Pr->SiS_VGAHT = SiS_Pr->SiS_HT = tempax; - SiS_Pr->SiS_VGAVT = SiS_Pr->SiS_VT = SiS_Pr->CVTotal; - - } else { - - bool gotit = false; - - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) { - - SiS_Pr->SiS_VGAHT = SiS_Pr->PanelHT; - SiS_Pr->SiS_VGAVT = SiS_Pr->PanelVT; - SiS_Pr->SiS_HT = SiS_Pr->PanelHT; - SiS_Pr->SiS_VT = SiS_Pr->PanelVT; - gotit = true; - - } else if( (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) && (romptr) && (ROMAddr) ) { - -#ifdef CONFIG_FB_SIS_315 - SiS_Pr->SiS_RVBHCMAX = ROMAddr[romptr]; - SiS_Pr->SiS_RVBHCFACT = ROMAddr[romptr+1]; - SiS_Pr->SiS_VGAHT = ROMAddr[romptr+2] | ((ROMAddr[romptr+3] & 0x0f) << 8); - SiS_Pr->SiS_VGAVT = (ROMAddr[romptr+4] << 4) | ((ROMAddr[romptr+3] & 0xf0) >> 4); - SiS_Pr->SiS_HT = ROMAddr[romptr+5] | ((ROMAddr[romptr+6] & 0x0f) << 8); - SiS_Pr->SiS_VT = (ROMAddr[romptr+7] << 4) | ((ROMAddr[romptr+6] & 0xf0) >> 4); - SiS_Pr->SiS_RVBHRS2 = ROMAddr[romptr+8] | ((ROMAddr[romptr+9] & 0x0f) << 8); - if((SiS_Pr->SiS_RVBHRS2) && (modeflag & HalfDCLK)) { - SiS_Pr->SiS_RVBHRS2 = ((SiS_Pr->SiS_RVBHRS2 + 3) >> 1) - 3; - tempax = (ROMAddr[romptr+9] >> 4) & 0x07; - if(ROMAddr[romptr+9] & 0x80) SiS_Pr->SiS_RVBHRS2 -= tempax; - else SiS_Pr->SiS_RVBHRS2 += tempax; - } - if(SiS_Pr->SiS_VGAHT) gotit = true; - else { - SiS_Pr->SiS_LCDInfo |= DontExpandLCD; - SiS_Pr->SiS_LCDInfo &= ~LCDPass11; - SiS_Pr->SiS_RVBHCMAX = 1; - SiS_Pr->SiS_RVBHCFACT = 1; - SiS_Pr->SiS_VGAHT = SiS_Pr->PanelHT; - SiS_Pr->SiS_VGAVT = SiS_Pr->PanelVT; - SiS_Pr->SiS_HT = SiS_Pr->PanelHT; - SiS_Pr->SiS_VT = SiS_Pr->PanelVT; - SiS_Pr->SiS_RVBHRS2 = 0; - gotit = true; - } -#endif - - } - - if(!gotit) { - - SiS_GetCRT2Ptr(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex, - &CRT2Index,&ResIndex); - - switch(CRT2Index) { - case Panel_1024x768 : LCDPtr = SiS_Pr->SiS_ExtLCD1024x768Data; break; - case Panel_1024x768 + 32: LCDPtr = SiS_Pr->SiS_St2LCD1024x768Data; break; - case Panel_1280x720 : - case Panel_1280x720 + 32: LCDPtr = SiS_Pr->SiS_LCD1280x720Data; break; - case Panel_1280x768_2 : LCDPtr = SiS_Pr->SiS_ExtLCD1280x768_2Data; break; - case Panel_1280x768_2+ 32: LCDPtr = SiS_Pr->SiS_StLCD1280x768_2Data; break; - case Panel_1280x800 : - case Panel_1280x800 + 32: LCDPtr = SiS_Pr->SiS_LCD1280x800Data; break; - case Panel_1280x800_2 : - case Panel_1280x800_2+ 32: LCDPtr = SiS_Pr->SiS_LCD1280x800_2Data; break; - case Panel_1280x854 : - case Panel_1280x854 + 32: LCDPtr = SiS_Pr->SiS_LCD1280x854Data; break; - case Panel_1280x960 : - case Panel_1280x960 + 32: LCDPtr = SiS_Pr->SiS_LCD1280x960Data; break; - case Panel_1280x1024 : LCDPtr = SiS_Pr->SiS_ExtLCD1280x1024Data; break; - case Panel_1280x1024 + 32: LCDPtr = SiS_Pr->SiS_St2LCD1280x1024Data; break; - case Panel_1400x1050 : LCDPtr = SiS_Pr->SiS_ExtLCD1400x1050Data; break; - case Panel_1400x1050 + 32: LCDPtr = SiS_Pr->SiS_StLCD1400x1050Data; break; - case Panel_1600x1200 : LCDPtr = SiS_Pr->SiS_ExtLCD1600x1200Data; break; - case Panel_1600x1200 + 32: LCDPtr = SiS_Pr->SiS_StLCD1600x1200Data; break; - case Panel_1680x1050 : - case Panel_1680x1050 + 32: LCDPtr = SiS_Pr->SiS_LCD1680x1050Data; break; - case 100 : LCDPtr = SiS_Pr->SiS_NoScaleData; break; -#ifdef CONFIG_FB_SIS_315 - case 200 : LCDPtr = SiS310_ExtCompaq1280x1024Data; break; - case 201 : LCDPtr = SiS_Pr->SiS_St2LCD1280x1024Data; break; -#endif - default : LCDPtr = SiS_Pr->SiS_ExtLCD1024x768Data; break; - } - - SiS_Pr->SiS_RVBHCMAX = (LCDPtr+ResIndex)->RVBHCMAX; - SiS_Pr->SiS_RVBHCFACT = (LCDPtr+ResIndex)->RVBHCFACT; - SiS_Pr->SiS_VGAHT = (LCDPtr+ResIndex)->VGAHT; - SiS_Pr->SiS_VGAVT = (LCDPtr+ResIndex)->VGAVT; - SiS_Pr->SiS_HT = (LCDPtr+ResIndex)->LCDHT; - SiS_Pr->SiS_VT = (LCDPtr+ResIndex)->LCDVT; - - } - - tempax = SiS_Pr->PanelXRes; - tempbx = SiS_Pr->PanelYRes; - - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_1024x768: - if(SiS_Pr->SiS_SetFlag & LCDVESATiming) { - if(SiS_Pr->ChipType < SIS_315H) { - if (SiS_Pr->SiS_VGAVDE == 350) tempbx = 560; - else if(SiS_Pr->SiS_VGAVDE == 400) tempbx = 640; - } - } else { - if (SiS_Pr->SiS_VGAVDE == 357) tempbx = 527; - else if(SiS_Pr->SiS_VGAVDE == 420) tempbx = 620; - else if(SiS_Pr->SiS_VGAVDE == 525) tempbx = 775; - else if(SiS_Pr->SiS_VGAVDE == 600) tempbx = 775; - else if(SiS_Pr->SiS_VGAVDE == 350) tempbx = 560; - else if(SiS_Pr->SiS_VGAVDE == 400) tempbx = 640; - } - break; - case Panel_1280x960: - if (SiS_Pr->SiS_VGAVDE == 350) tempbx = 700; - else if(SiS_Pr->SiS_VGAVDE == 400) tempbx = 800; - else if(SiS_Pr->SiS_VGAVDE == 1024) tempbx = 960; - break; - case Panel_1280x1024: - if (SiS_Pr->SiS_VGAVDE == 360) tempbx = 768; - else if(SiS_Pr->SiS_VGAVDE == 375) tempbx = 800; - else if(SiS_Pr->SiS_VGAVDE == 405) tempbx = 864; - break; - case Panel_1600x1200: - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) { - if (SiS_Pr->SiS_VGAVDE == 350) tempbx = 875; - else if(SiS_Pr->SiS_VGAVDE == 400) tempbx = 1000; - } - break; - } - - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - tempax = SiS_Pr->SiS_VGAHDE; - tempbx = SiS_Pr->SiS_VGAVDE; - } - - SiS_Pr->SiS_HDE = tempax; - SiS_Pr->SiS_VDE = tempbx; - } - } -} - -static void -SiS_GetCRT2Data(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - SiS_GetCRT2DataLVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } else { - if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) { - /* Need LVDS Data for LCD on 301B-DH */ - SiS_GetCRT2DataLVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } else { - SiS_GetCRT2Data301(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - } - - } else { - - SiS_GetCRT2DataLVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - - } -} - -/*********************************************/ -/* GET LVDS DES (SKEW) DATA */ -/*********************************************/ - -static const struct SiS_LVDSDes * -SiS_GetLVDSDesPtr(struct SiS_Private *SiS_Pr) -{ - const struct SiS_LVDSDes *PanelDesPtr = NULL; - -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_LCDTypeInfo == 4) { - if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) { - PanelDesPtr = SiS_Pr->SiS_PanelType04_1a; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - PanelDesPtr = SiS_Pr->SiS_PanelType04_2a; - } - } else if(SiS_Pr->SiS_CustomT == CUT_BARCO1024) { - PanelDesPtr = SiS_Pr->SiS_PanelType04_1b; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - PanelDesPtr = SiS_Pr->SiS_PanelType04_2b; - } - } - } - } - } -#endif - return PanelDesPtr; -} - -static void -SiS_GetLVDSDesData(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short modeflag, ResIndex; - const struct SiS_LVDSDes *PanelDesPtr = NULL; - - SiS_Pr->SiS_LCDHDES = 0; - SiS_Pr->SiS_LCDVDES = 0; - - /* Some special cases */ - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - - /* Trumpion */ - if(SiS_Pr->SiS_IF_DEF_TRUMPION) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } - } - return; - } - - /* 640x480 on LVDS */ - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_LCDResInfo == Panel_640x480 && SiS_Pr->SiS_LCDTypeInfo == 3) { - SiS_Pr->SiS_LCDHDES = 8; - if (SiS_Pr->SiS_VGAVDE >= 480) SiS_Pr->SiS_LCDVDES = 512; - else if(SiS_Pr->SiS_VGAVDE >= 400) SiS_Pr->SiS_LCDVDES = 436; - else if(SiS_Pr->SiS_VGAVDE >= 350) SiS_Pr->SiS_LCDVDES = 440; - return; - } - } - - } /* LCD */ - - if( (SiS_Pr->UseCustomMode) || - (SiS_Pr->SiS_LCDResInfo == Panel_Custom) || - (SiS_Pr->SiS_CustomT == CUT_PANEL848) || - (SiS_Pr->SiS_CustomT == CUT_PANEL856) || - (SiS_Pr->SiS_LCDInfo & LCDPass11) ) { - return; - } - - if(ModeNo <= 0x13) ResIndex = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - else ResIndex = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - - if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - /* non-pass 1:1 only, see above */ - if(SiS_Pr->SiS_VGAHDE != SiS_Pr->PanelXRes) { - SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_HT - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE) / 2); - } - if(SiS_Pr->SiS_VGAVDE != SiS_Pr->PanelYRes) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->SiS_VT - ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VGAVDE) / 2); - } - } - if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) { - switch(SiS_Pr->SiS_CustomT) { - case CUT_UNIWILL1024: - case CUT_UNIWILL10242: - case CUT_CLEVO1400: - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } - break; - } - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_1280x1024: - if(SiS_Pr->SiS_CustomT != CUT_COMPAQ1280) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } - break; - case Panel_1280x800: /* Verified for Averatec 6240 */ - case Panel_1280x800_2: /* Verified for Asus A4L */ - case Panel_1280x854: /* Not verified yet FIXME */ - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - break; - } - } -#endif - - } else { - - if((SiS_Pr->SiS_IF_DEF_CH70xx != 0) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) { - - if((SiS_Pr->SiS_TVMode & TVSetPAL) && (!(SiS_Pr->SiS_TVMode & TVSetPALM))) { - if(ResIndex <= 3) SiS_Pr->SiS_LCDHDES = 256; - } - - } else if((PanelDesPtr = SiS_GetLVDSDesPtr(SiS_Pr))) { - - SiS_Pr->SiS_LCDHDES = (PanelDesPtr+ResIndex)->LCDHDES; - SiS_Pr->SiS_LCDVDES = (PanelDesPtr+ResIndex)->LCDVDES; - - } else if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - - if(SiS_Pr->SiS_VGAHDE != SiS_Pr->PanelXRes) { - SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_HT - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_VGAHDE) / 2); - } - if(SiS_Pr->SiS_VGAVDE != SiS_Pr->PanelYRes) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->SiS_VT - ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VGAVDE) / 2); - } else { - if(SiS_Pr->ChipType < SIS_315H) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } else { - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_800x600: - case Panel_1024x768: - case Panel_1280x1024: - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT; - break; - case Panel_1400x1050: - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - break; - } - } - } - - } else { - - if(SiS_Pr->ChipType < SIS_315H) { -#ifdef CONFIG_FB_SIS_300 - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_800x600: - if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } else { - SiS_Pr->SiS_LCDHDES = SiS_Pr->PanelHT + 3; - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT; - if(SiS_Pr->SiS_VGAVDE == 400) SiS_Pr->SiS_LCDVDES -= 2; - else SiS_Pr->SiS_LCDVDES -= 4; - } - break; - case Panel_1024x768: - if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } else { - SiS_Pr->SiS_LCDHDES = SiS_Pr->PanelHT - 1; - if(SiS_Pr->SiS_VGAVDE <= 400) SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 8; - if(SiS_Pr->SiS_VGAVDE <= 350) SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 12; - } - break; - case Panel_1024x600: - default: - if( (SiS_Pr->SiS_VGAHDE == SiS_Pr->PanelXRes) && - (SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) ) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } else { - SiS_Pr->SiS_LCDHDES = SiS_Pr->PanelHT - 1; - } - break; - } - - switch(SiS_Pr->SiS_LCDTypeInfo) { - case 1: - SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_LCDVDES = 0; - break; - case 3: /* 640x480 only? */ - SiS_Pr->SiS_LCDHDES = 8; - if (SiS_Pr->SiS_VGAVDE >= 480) SiS_Pr->SiS_LCDVDES = 512; - else if(SiS_Pr->SiS_VGAVDE >= 400) SiS_Pr->SiS_LCDVDES = 436; - else if(SiS_Pr->SiS_VGAVDE >= 350) SiS_Pr->SiS_LCDVDES = 440; - break; - } -#endif - } else { -#ifdef CONFIG_FB_SIS_315 - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_1024x768: - case Panel_1280x1024: - if(SiS_Pr->SiS_VGAVDE == SiS_Pr->PanelYRes) { - SiS_Pr->SiS_LCDVDES = SiS_Pr->PanelVT - 1; - } - break; - case Panel_320x240_1: - case Panel_320x240_2: - case Panel_320x240_3: - SiS_Pr->SiS_LCDVDES = 524; - break; - } -#endif - } - } - - if((ModeNo <= 0x13) && (SiS_Pr->SiS_LCDInfo & DontExpandLCD)) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - if(!(modeflag & HalfDCLK)) SiS_Pr->SiS_LCDHDES = 632; - } else if(!(SiS_Pr->SiS_SetFlag & SetDOSMode)) { - if(SiS_Pr->SiS_LCDResInfo != Panel_1280x1024) { - if(SiS_Pr->SiS_LCDResInfo >= Panel_1024x768) { - if(SiS_Pr->ChipType < SIS_315H) { - if(!(modeflag & HalfDCLK)) SiS_Pr->SiS_LCDHDES = 320; - } else { -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) SiS_Pr->SiS_LCDHDES = 480; - if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) SiS_Pr->SiS_LCDHDES = 804; - if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) SiS_Pr->SiS_LCDHDES = 704; - if(!(modeflag & HalfDCLK)) { - SiS_Pr->SiS_LCDHDES = 320; - if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) SiS_Pr->SiS_LCDHDES = 632; - if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) SiS_Pr->SiS_LCDHDES = 542; - } -#endif - } - } - } - } - } - } -} - -/*********************************************/ -/* DISABLE VIDEO BRIDGE */ -/*********************************************/ - -#ifdef CONFIG_FB_SIS_315 -static int -SiS_HandlePWD(struct SiS_Private *SiS_Pr) -{ - int ret = 0; -#ifdef SET_PWD - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short romptr = GetLCDStructPtr661_2(SiS_Pr); - unsigned char drivermode = SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40; - unsigned short temp; - - if( (SiS_Pr->SiS_VBType & VB_SISPWD) && - (romptr) && - (SiS_Pr->SiS_PWDOffset) ) { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2b,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 0]); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2c,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 1]); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2d,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 2]); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2e,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 3]); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2f,ROMAddr[romptr + SiS_Pr->SiS_PWDOffset + 4]); - temp = 0x00; - if((ROMAddr[romptr + 2] & (0x06 << 1)) && !drivermode) { - temp = 0x80; - ret = 1; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x27,0x7f,temp); - } -#endif - return ret; -} -#endif - -/* NEVER use any variables (VBInfo), this will be called - * from outside the context of modeswitch! - * MUST call getVBType before calling this - */ -void -SiS_DisableBridge(struct SiS_Private *SiS_Pr) -{ -#ifdef CONFIG_FB_SIS_315 - unsigned short tempah, pushax=0, modenum; -#endif - unsigned short temp=0; - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { /* ===== For 30xB/C/LV ===== */ - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* 300 series */ - - if(!(SiS_CR36BIOSWord23b(SiS_Pr))) { - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFE); - } else { - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08); - } - SiS_PanelDelay(SiS_Pr, 3); - } - if(SiS_Is301B(SiS_Pr)) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1f,0x3f); - SiS_ShortDelay(SiS_Pr,1); - } - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xDF); - SiS_DisplayOff(SiS_Pr); - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF); - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF); - SiS_UnLockCRT2(SiS_Pr); - if(!(SiS_Pr->SiS_VBType & VB_SISLVDS)) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x80); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40); - } - if( (!(SiS_CRT2IsLCD(SiS_Pr))) || - (!(SiS_CR36BIOSWord23d(SiS_Pr))) ) { - SiS_PanelDelay(SiS_Pr, 2); - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFD); - } else { - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04); - } - } - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* 315 series */ - - int didpwd = 0; - bool custom1 = (SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) || - (SiS_Pr->SiS_CustomT == CUT_CLEVO1400); - - modenum = SiS_GetReg(SiS_Pr->SiS_P3d4,0x34) & 0x7f; - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - -#ifdef SET_EMI - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - if(SiS_Pr->SiS_CustomT != CUT_CLEVO1400) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c); - } - } -#endif - - didpwd = SiS_HandlePWD(SiS_Pr); - - if( (modenum <= 0x13) || - (SiS_IsVAMode(SiS_Pr)) || - (!(SiS_IsDualEdge(SiS_Pr))) ) { - if(!didpwd) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xfe); - if(custom1) SiS_PanelDelay(SiS_Pr, 3); - } else { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xfc); - } - } - - if(!custom1) { - SiS_DDC2Delay(SiS_Pr,0xff00); - SiS_DDC2Delay(SiS_Pr,0xe000); - SiS_SetRegByte(SiS_Pr->SiS_P3c6,0x00); - pushax = SiS_GetReg(SiS_Pr->SiS_P3c4,0x06); - if(IS_SIS740) { - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x06,0xE3); - } - SiS_PanelDelay(SiS_Pr, 3); - } - - } - - if(!(SiS_IsNotM650orLater(SiS_Pr))) { - /* if(SiS_Pr->ChipType < SIS_340) {*/ - tempah = 0xef; - if(SiS_IsVAMode(SiS_Pr)) tempah = 0xf7; - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x4c,tempah); - /*}*/ - } - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1F,~0x10); - } - - tempah = 0x3f; - if(SiS_IsDualEdge(SiS_Pr)) { - tempah = 0x7f; - if(!(SiS_IsVAMode(SiS_Pr))) tempah = 0xbf; - } - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1F,tempah); - - if((SiS_IsVAMode(SiS_Pr)) || - ((SiS_Pr->SiS_VBType & VB_SISLVDS) && (modenum <= 0x13))) { - - SiS_DisplayOff(SiS_Pr); - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_PanelDelay(SiS_Pr, 2); - } - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF); - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1E,0xDF); - - } - - if((!(SiS_IsVAMode(SiS_Pr))) || - ((SiS_Pr->SiS_VBType & VB_SISLVDS) && (modenum <= 0x13))) { - - if(!(SiS_IsDualEdge(SiS_Pr))) { - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xdf); - SiS_DisplayOff(SiS_Pr); - } - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x80); - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_PanelDelay(SiS_Pr, 2); - } - - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF); - temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x10); - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,temp); - - } - - if(SiS_IsNotM650orLater(SiS_Pr)) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f); - } - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - - if( (!(SiS_IsVAMode(SiS_Pr))) && - (!(SiS_CRT2IsLCD(SiS_Pr))) && - (!(SiS_IsDualEdge(SiS_Pr))) ) { - - if(custom1) SiS_PanelDelay(SiS_Pr, 2); - if(!didpwd) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFD); - } - if(custom1) SiS_PanelDelay(SiS_Pr, 4); - } - - if(!custom1) { - SiS_SetReg(SiS_Pr->SiS_P3c4,0x06,pushax); - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - if(SiS_IsVAorLCD(SiS_Pr)) { - SiS_PanelDelayLoop(SiS_Pr, 3, 20); - } - } - } - - } - -#endif /* CONFIG_FB_SIS_315 */ - - } - - } else { /* ============ For 301 ================ */ - - if(SiS_Pr->ChipType < SIS_315H) { -#ifdef CONFIG_FB_SIS_300 - if(!(SiS_CR36BIOSWord23b(SiS_Pr))) { - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08); - SiS_PanelDelay(SiS_Pr, 3); - } -#endif - } - - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xDF); /* disable VB */ - SiS_DisplayOff(SiS_Pr); - - if(SiS_Pr->ChipType >= SIS_315H) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x80); - } - - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF); /* disable lock mode */ - - if(SiS_Pr->ChipType >= SIS_315H) { - temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x10); - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,temp); - } else { -#ifdef CONFIG_FB_SIS_300 - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF); /* disable CRT2 */ - if( (!(SiS_CRT2IsLCD(SiS_Pr))) || - (!(SiS_CR36BIOSWord23d(SiS_Pr))) ) { - SiS_PanelDelay(SiS_Pr, 2); - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04); - } -#endif - } - - } - - } else { /* ============ For LVDS =============*/ - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* 300 series */ - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) { - SiS_SetCH700x(SiS_Pr,0x0E,0x09); - } - - if(SiS_Pr->ChipType == SIS_730) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x11) & 0x08)) { - SiS_WaitVBRetrace(SiS_Pr); - } - if(!(SiS_CR36BIOSWord23b(SiS_Pr))) { - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08); - SiS_PanelDelay(SiS_Pr, 3); - } - } else { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x11) & 0x08)) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x40)) { - if(!(SiS_CR36BIOSWord23b(SiS_Pr))) { - SiS_WaitVBRetrace(SiS_Pr); - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x06) & 0x1c)) { - SiS_DisplayOff(SiS_Pr); - } - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08); - SiS_PanelDelay(SiS_Pr, 3); - } - } - } - } - - SiS_DisplayOff(SiS_Pr); - - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF); - - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF); - SiS_UnLockCRT2(SiS_Pr); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x80); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40); - - if( (!(SiS_CRT2IsLCD(SiS_Pr))) || - (!(SiS_CR36BIOSWord23d(SiS_Pr))) ) { - SiS_PanelDelay(SiS_Pr, 2); - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04); - } - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* 315 series */ - - if(!(SiS_IsNotM650orLater(SiS_Pr))) { - /*if(SiS_Pr->ChipType < SIS_340) { */ /* XGI needs this */ - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x4c,~0x18); - /* } */ - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - - if(SiS_Pr->ChipType == SIS_740) { - temp = SiS_GetCH701x(SiS_Pr,0x61); - if(temp < 1) { - SiS_SetCH701x(SiS_Pr,0x76,0xac); - SiS_SetCH701x(SiS_Pr,0x66,0x00); - } - - if( (!(SiS_IsDualEdge(SiS_Pr))) || - (SiS_IsTVOrYPbPrOrScart(SiS_Pr)) ) { - SiS_SetCH701x(SiS_Pr,0x49,0x3e); - } - } - - if( (!(SiS_IsDualEdge(SiS_Pr))) || - (SiS_IsVAMode(SiS_Pr)) ) { - SiS_Chrontel701xBLOff(SiS_Pr); - SiS_Chrontel701xOff(SiS_Pr); - } - - if(SiS_Pr->ChipType != SIS_740) { - if( (!(SiS_IsDualEdge(SiS_Pr))) || - (SiS_IsTVOrYPbPrOrScart(SiS_Pr)) ) { - SiS_SetCH701x(SiS_Pr,0x49,0x01); - } - } - - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) { - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x08); - SiS_PanelDelay(SiS_Pr, 3); - } - - if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0) || - (!(SiS_IsDualEdge(SiS_Pr))) || - (!(SiS_IsTVOrYPbPrOrScart(SiS_Pr))) ) { - SiS_DisplayOff(SiS_Pr); - } - - if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0) || - (!(SiS_IsDualEdge(SiS_Pr))) || - (!(SiS_IsVAMode(SiS_Pr))) ) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x00,0x80); - } - - if(SiS_Pr->ChipType == SIS_740) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f); - } - - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x32,0xDF); - - if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0) || - (!(SiS_IsDualEdge(SiS_Pr))) || - (!(SiS_IsVAMode(SiS_Pr))) ) { - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1E,0xDF); - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xdf); - if(SiS_Pr->ChipType == SIS_550) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xbf); - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xef); - } - } - } else { - if(SiS_Pr->ChipType == SIS_740) { - if(SiS_IsLCDOrLCDA(SiS_Pr)) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xdf); - } - } else if(SiS_IsVAMode(SiS_Pr)) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x1e,0xdf); - } - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(SiS_IsDualEdge(SiS_Pr)) { - /* SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xff); */ - } else { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xfb); - } - } - - SiS_UnLockCRT2(SiS_Pr); - - if(SiS_Pr->ChipType == SIS_550) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x80); /* DirectDVD PAL?*/ - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40); /* VB clock / 4 ? */ - } else if( (SiS_Pr->SiS_IF_DEF_CH70xx == 0) || - (!(SiS_IsDualEdge(SiS_Pr))) || - (!(SiS_IsVAMode(SiS_Pr))) ) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0xf7); - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) { - SiS_PanelDelay(SiS_Pr, 2); - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x04); - } - } - } - -#endif /* CONFIG_FB_SIS_315 */ - - } /* 315 series */ - - } /* LVDS */ - -} - -/*********************************************/ -/* ENABLE VIDEO BRIDGE */ -/*********************************************/ - -/* NEVER use any variables (VBInfo), this will be called - * from outside the context of a mode switch! - * MUST call getVBType before calling this - */ -static -void -SiS_EnableBridge(struct SiS_Private *SiS_Pr) -{ - unsigned short temp=0, tempah; -#ifdef CONFIG_FB_SIS_315 - unsigned short temp1, pushax=0; - bool delaylong = false; -#endif - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { /* ====== For 301B et al ====== */ - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* 300 series */ - - if(SiS_CRT2IsLCD(SiS_Pr)) { - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x02); - } else if(SiS_Pr->SiS_VBType & VB_NoLCD) { - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00); - } - if(SiS_Pr->SiS_VBType & (VB_SISLVDS | VB_NoLCD)) { - if(!(SiS_CR36BIOSWord23d(SiS_Pr))) { - SiS_PanelDelay(SiS_Pr, 0); - } - } - } - - if((SiS_Pr->SiS_VBType & VB_NoLCD) && - (SiS_CRT2IsLCD(SiS_Pr))) { - - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); /* Enable CRT2 */ - SiS_DisplayOn(SiS_Pr); - SiS_UnLockCRT2(SiS_Pr); - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0xBF); - if(SiS_BridgeInSlavemode(SiS_Pr)) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x01,0x1F); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x01,0x1F,0x40); - } - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x40)) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x10)) { - if(!(SiS_CR36BIOSWord23b(SiS_Pr))) { - SiS_PanelDelay(SiS_Pr, 1); - } - SiS_WaitVBRetrace(SiS_Pr); - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00); - } - } - - } else { - - temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32) & 0xDF; /* lock mode */ - if(SiS_BridgeInSlavemode(SiS_Pr)) { - tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - if(!(tempah & SetCRT2ToRAMDAC)) temp |= 0x20; - } - SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,temp); - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x00,0x1F,0x20); /* enable VB processor */ - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x1F,0xC0); - SiS_DisplayOn(SiS_Pr); - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x10)) { - if(!(SiS_CR36BIOSWord23b(SiS_Pr))) { - SiS_PanelDelay(SiS_Pr, 1); - } - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x01); - } - } - } - - } - - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* 315 series */ - -#ifdef SET_EMI - unsigned char r30=0, r31=0, r32=0, r33=0, cr36=0; - int didpwd = 0; - /* unsigned short emidelay=0; */ -#endif - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x1f,0xef); -#ifdef SET_EMI - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c); - } -#endif - } - - if(!(SiS_IsNotM650orLater(SiS_Pr))) { - /*if(SiS_Pr->ChipType < SIS_340) { */ - tempah = 0x10; - if(SiS_LCDAEnabled(SiS_Pr)) { - if(SiS_TVEnabled(SiS_Pr)) tempah = 0x18; - else tempah = 0x08; - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x4c,tempah); - /*}*/ - } - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - - SiS_SetRegByte(SiS_Pr->SiS_P3c6,0x00); - SiS_DisplayOff(SiS_Pr); - pushax = SiS_GetReg(SiS_Pr->SiS_P3c4,0x06); - if(IS_SIS740) { - SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x06,0xE3); - } - - didpwd = SiS_HandlePWD(SiS_Pr); - - if(SiS_IsVAorLCD(SiS_Pr)) { - if(!didpwd) { - if(!(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x02)) { - SiS_PanelDelayLoop(SiS_Pr, 3, 2); - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x02); - SiS_PanelDelayLoop(SiS_Pr, 3, 2); - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - SiS_GenericDelay(SiS_Pr, 17664); - } - } - } else { - SiS_PanelDelayLoop(SiS_Pr, 3, 2); - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - SiS_GenericDelay(SiS_Pr, 17664); - } - } - } - - if(!(SiS_GetReg(SiS_Pr->SiS_P3d4,0x31) & 0x40)) { - SiS_PanelDelayLoop(SiS_Pr, 3, 10); - delaylong = true; - } - - } - - if(!(SiS_IsVAMode(SiS_Pr))) { - - temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32) & 0xDF; - if(SiS_BridgeInSlavemode(SiS_Pr)) { - tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - if(!(tempah & SetCRT2ToRAMDAC)) { - if(!(SiS_LCDAEnabled(SiS_Pr))) temp |= 0x20; - } - } - SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,temp); - - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); /* enable CRT2 */ - - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2e,0x80); - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - SiS_PanelDelay(SiS_Pr, 2); - } - - } else { - - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x20); - - } - - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x00,0x1f,0x20); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2e,0x80); - - if(SiS_Pr->SiS_VBType & VB_SISPOWER) { - if( (SiS_LCDAEnabled(SiS_Pr)) || - (SiS_CRT2IsLCD(SiS_Pr)) ) { - /* Enable "LVDS PLL power on" (even on 301C) */ - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x2a,0x7f); - /* Enable "LVDS Driver Power on" (even on 301C) */ - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x7f); - } - } - - tempah = 0xc0; - if(SiS_IsDualEdge(SiS_Pr)) { - tempah = 0x80; - if(!(SiS_IsVAMode(SiS_Pr))) tempah = 0x40; - } - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x1F,tempah); - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - - SiS_PanelDelay(SiS_Pr, 2); - - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x1f,0x10); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2e,0x80); - - if(SiS_Pr->SiS_CustomT != CUT_CLEVO1400) { -#ifdef SET_EMI - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c); - SiS_GenericDelay(SiS_Pr, 2048); - } -#endif - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x27,0x0c); - - if(SiS_Pr->SiS_VBType & VB_SISEMI) { -#ifdef SET_EMI - cr36 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36); - - if(SiS_Pr->SiS_ROMNew) { - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short romptr = GetLCDStructPtr661_2(SiS_Pr); - if(romptr) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x30,0x20); /* Reset */ - SiS_Pr->EMI_30 = 0; - SiS_Pr->EMI_31 = ROMAddr[romptr + SiS_Pr->SiS_EMIOffset + 0]; - SiS_Pr->EMI_32 = ROMAddr[romptr + SiS_Pr->SiS_EMIOffset + 1]; - SiS_Pr->EMI_33 = ROMAddr[romptr + SiS_Pr->SiS_EMIOffset + 2]; - if(ROMAddr[romptr + 1] & 0x10) SiS_Pr->EMI_30 = 0x40; - /* emidelay = SISGETROMW((romptr + 0x22)); */ - SiS_Pr->HaveEMI = SiS_Pr->HaveEMILCD = SiS_Pr->OverruleEMI = true; - } - } - - /* (P4_30|0x40) */ - /* Compal 1400x1050: 0x05, 0x60, 0x00 YES (1.10.7w; CR36=69) */ - /* Compal 1400x1050: 0x0d, 0x70, 0x40 YES (1.10.7x; CR36=69) */ - /* Acer 1280x1024: 0x12, 0xd0, 0x6b NO (1.10.9k; CR36=73) */ - /* Compaq 1280x1024: 0x0d, 0x70, 0x6b YES (1.12.04b; CR36=03) */ - /* Clevo 1024x768: 0x05, 0x60, 0x33 NO (1.10.8e; CR36=12, DL!) */ - /* Clevo 1024x768: 0x0d, 0x70, 0x40 (if type == 3) YES (1.10.8y; CR36=?2) */ - /* Clevo 1024x768: 0x05, 0x60, 0x33 (if type != 3) YES (1.10.8y; CR36=?2) */ - /* Asus 1024x768: ? ? (1.10.8o; CR36=?2) */ - /* Asus 1024x768: 0x08, 0x10, 0x3c (problematic) YES (1.10.8q; CR36=22) */ - - if(SiS_Pr->HaveEMI) { - r30 = SiS_Pr->EMI_30; r31 = SiS_Pr->EMI_31; - r32 = SiS_Pr->EMI_32; r33 = SiS_Pr->EMI_33; - } else { - r30 = 0; - } - - /* EMI_30 is read at driver start; however, the BIOS sets this - * (if it is used) only if the LCD is in use. In case we caught - * the machine while on TV output, this bit is not set and we - * don't know if it should be set - hence our detection is wrong. - * Work-around this here: - */ - - if((!SiS_Pr->HaveEMI) || (!SiS_Pr->HaveEMILCD)) { - switch((cr36 & 0x0f)) { - case 2: - r30 |= 0x40; - if(SiS_Pr->SiS_CustomT == CUT_CLEVO1024) r30 &= ~0x40; - if(!SiS_Pr->HaveEMI) { - r31 = 0x05; r32 = 0x60; r33 = 0x33; - if((cr36 & 0xf0) == 0x30) { - r31 = 0x0d; r32 = 0x70; r33 = 0x40; - } - } - break; - case 3: /* 1280x1024 */ - if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) r30 |= 0x40; - if(!SiS_Pr->HaveEMI) { - r31 = 0x12; r32 = 0xd0; r33 = 0x6b; - if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) { - r31 = 0x0d; r32 = 0x70; r33 = 0x6b; - } - } - break; - case 9: /* 1400x1050 */ - r30 |= 0x40; - if(!SiS_Pr->HaveEMI) { - r31 = 0x05; r32 = 0x60; r33 = 0x00; - if(SiS_Pr->SiS_CustomT == CUT_COMPAL1400_2) { - r31 = 0x0d; r32 = 0x70; r33 = 0x40; /* BIOS values */ - } - } - break; - case 11: /* 1600x1200 - unknown */ - r30 |= 0x40; - if(!SiS_Pr->HaveEMI) { - r31 = 0x05; r32 = 0x60; r33 = 0x00; - } - } - } - - /* BIOS values don't work so well sometimes */ - if(!SiS_Pr->OverruleEMI) { -#ifdef COMPAL_HACK - if(SiS_Pr->SiS_CustomT == CUT_COMPAL1400_2) { - if((cr36 & 0x0f) == 0x09) { - r30 = 0x60; r31 = 0x05; r32 = 0x60; r33 = 0x00; - } - } -#endif -#ifdef COMPAQ_HACK - if(SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) { - if((cr36 & 0x0f) == 0x03) { - r30 = 0x20; r31 = 0x12; r32 = 0xd0; r33 = 0x6b; - } - } -#endif -#ifdef ASUS_HACK - if(SiS_Pr->SiS_CustomT == CUT_ASUSA2H_2) { - if((cr36 & 0x0f) == 0x02) { - /* r30 = 0x60; r31 = 0x05; r32 = 0x60; r33 = 0x33; */ /* rev 2 */ - /* r30 = 0x20; r31 = 0x05; r32 = 0x60; r33 = 0x33; */ /* rev 3 */ - /* r30 = 0x60; r31 = 0x0d; r32 = 0x70; r33 = 0x40; */ /* rev 4 */ - /* r30 = 0x20; r31 = 0x0d; r32 = 0x70; r33 = 0x40; */ /* rev 5 */ - } - } -#endif - } - - if(!(SiS_Pr->OverruleEMI && (!r30) && (!r31) && (!r32) && (!r33))) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x30,0x20); /* Reset */ - SiS_GenericDelay(SiS_Pr, 2048); - } - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x31,r31); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x32,r32); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x33,r33); -#endif /* SET_EMI */ - - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x34,0x10); - -#ifdef SET_EMI - if( (SiS_LCDAEnabled(SiS_Pr)) || - (SiS_CRT2IsLCD(SiS_Pr)) ) { - if(r30 & 0x40) { - /*SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x2a,0x80);*/ - SiS_PanelDelayLoop(SiS_Pr, 3, 5); - if(delaylong) { - SiS_PanelDelayLoop(SiS_Pr, 3, 5); - delaylong = false; - } - SiS_WaitVBRetrace(SiS_Pr); - SiS_WaitVBRetrace(SiS_Pr); - if(SiS_Pr->SiS_CustomT == CUT_ASUSA2H_2) { - SiS_GenericDelay(SiS_Pr, 1280); - } - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x30,0x40); /* Enable */ - /*SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x2a,0x7f);*/ - } - } -#endif - } - } - - if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) { - if(SiS_IsVAorLCD(SiS_Pr)) { - SiS_PanelDelayLoop(SiS_Pr, 3, 10); - if(delaylong) { - SiS_PanelDelayLoop(SiS_Pr, 3, 10); - } - SiS_WaitVBRetrace(SiS_Pr); - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - SiS_GenericDelay(SiS_Pr, 2048); - SiS_WaitVBRetrace(SiS_Pr); - } - if(!didpwd) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x01); - } else { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x03); - } - } - } - - SiS_SetReg(SiS_Pr->SiS_P3c4,0x06,pushax); - SiS_DisplayOn(SiS_Pr); - SiS_SetRegByte(SiS_Pr->SiS_P3c6,0xff); - - } - - if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x00,0x7f); - } - -#endif /* CONFIG_FB_SIS_315 */ - - } - - } else { /* ============ For 301 ================ */ - - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00); - SiS_PanelDelay(SiS_Pr, 0); - } - } - - temp = SiS_GetReg(SiS_Pr->SiS_P3c4,0x32) & 0xDF; /* lock mode */ - if(SiS_BridgeInSlavemode(SiS_Pr)) { - tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x30); - if(!(tempah & SetCRT2ToRAMDAC)) temp |= 0x20; - } - SiS_SetReg(SiS_Pr->SiS_P3c4,0x32,temp); - - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); /* enable CRT2 */ - - if(SiS_Pr->ChipType >= SIS_315H) { - temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x2E); - if(!(temp & 0x80)) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2E,0x80); /* BVBDOENABLE=1 */ - } - } - - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x00,0x1F,0x20); /* enable VB processor */ - - SiS_VBLongWait(SiS_Pr); - SiS_DisplayOn(SiS_Pr); - if(SiS_Pr->ChipType >= SIS_315H) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x00,0x7f); - } - SiS_VBLongWait(SiS_Pr); - - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - SiS_PanelDelay(SiS_Pr, 1); - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00); - } - } - - } - - } else { /* =================== For LVDS ================== */ - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* 300 series */ - - if(SiS_CRT2IsLCD(SiS_Pr)) { - if(SiS_Pr->ChipType == SIS_730) { - SiS_PanelDelay(SiS_Pr, 1); - SiS_PanelDelay(SiS_Pr, 1); - SiS_PanelDelay(SiS_Pr, 1); - } - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00); - if(!(SiS_CR36BIOSWord23d(SiS_Pr))) { - SiS_PanelDelay(SiS_Pr, 0); - } - } - - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); - SiS_DisplayOn(SiS_Pr); - SiS_UnLockCRT2(SiS_Pr); - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0xBF); - if(SiS_BridgeInSlavemode(SiS_Pr)) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x01,0x1F); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x01,0x1F,0x40); - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) { - if(!(SiS_CRT2IsLCD(SiS_Pr))) { - SiS_WaitVBRetrace(SiS_Pr); - SiS_SetCH700x(SiS_Pr,0x0E,0x0B); - } - } - - if(SiS_CRT2IsLCD(SiS_Pr)) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x13) & 0x40)) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x16) & 0x10)) { - if(!(SiS_CR36BIOSWord23b(SiS_Pr))) { - SiS_PanelDelay(SiS_Pr, 1); - SiS_PanelDelay(SiS_Pr, 1); - } - SiS_WaitVBRetrace(SiS_Pr); - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00); - } - } - } - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* 315 series */ - - if(!(SiS_IsNotM650orLater(SiS_Pr))) { - /*if(SiS_Pr->ChipType < SIS_340) {*/ /* XGI needs this */ - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x4c,0x18); - /*}*/ - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - SiS_SetRegSR11ANDOR(SiS_Pr,0xFB,0x00); - SiS_PanelDelay(SiS_Pr, 0); - } - } - - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); - SiS_UnLockCRT2(SiS_Pr); - - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0xf7); - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - temp = SiS_GetCH701x(SiS_Pr,0x66); - temp &= 0x20; - SiS_Chrontel701xBLOff(SiS_Pr); - } - - if(SiS_Pr->ChipType != SIS_550) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2e,0x7f); - } - - if(SiS_Pr->ChipType == SIS_740) { - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(SiS_IsLCDOrLCDA(SiS_Pr)) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x20); - } - } - } - - temp1 = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x2E); - if(!(temp1 & 0x80)) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2E,0x80); - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(temp) { - SiS_Chrontel701xBLOn(SiS_Pr); - } - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x20); - if(SiS_Pr->ChipType == SIS_550) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x40); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x10); - } - } - } else if(SiS_IsVAMode(SiS_Pr)) { - if(SiS_Pr->ChipType != SIS_740) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1E,0x20); - } - } - - if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x00,0x7f); - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(SiS_IsTVOrYPbPrOrScart(SiS_Pr)) { - SiS_Chrontel701xOn(SiS_Pr); - } - if( (SiS_IsVAMode(SiS_Pr)) || - (SiS_IsLCDOrLCDA(SiS_Pr)) ) { - SiS_ChrontelDoSomething1(SiS_Pr); - } - } - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) { - if( (SiS_IsVAMode(SiS_Pr)) || - (SiS_IsLCDOrLCDA(SiS_Pr)) ) { - SiS_Chrontel701xBLOn(SiS_Pr); - SiS_ChrontelInitTVVSync(SiS_Pr); - } - } - } else if(SiS_Pr->SiS_IF_DEF_CH70xx == 0) { - if(!(SiS_WeHaveBacklightCtrl(SiS_Pr))) { - if(SiS_CRT2IsLCD(SiS_Pr)) { - SiS_PanelDelay(SiS_Pr, 1); - SiS_SetRegSR11ANDOR(SiS_Pr,0xF7,0x00); - } - } - } - -#endif /* CONFIG_FB_SIS_315 */ - - } /* 310 series */ - - } /* LVDS */ - -} - -/*********************************************/ -/* SET PART 1 REGISTER GROUP */ -/*********************************************/ - -/* Set CRT2 OFFSET / PITCH */ -static void -SiS_SetCRT2Offset(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RRTI) -{ - unsigned short offset; - unsigned char temp; - - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) return; - - offset = SiS_GetOffset(SiS_Pr,ModeNo,ModeIdIndex,RRTI); - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x07,(offset & 0xFF)); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x09,(offset >> 8)); - - temp = (unsigned char)(((offset >> 3) & 0xFF) + 1); - if(offset & 0x07) temp++; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x03,temp); -} - -/* Set CRT2 sync and PanelLink mode */ -static void -SiS_SetCRT2Sync(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short RefreshRateTableIndex) -{ - unsigned short tempah=0, tempbl, infoflag; - - tempbl = 0xC0; - - if(SiS_Pr->UseCustomMode) { - infoflag = SiS_Pr->CInfoFlag; - } else { - infoflag = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag; - } - - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { /* LVDS */ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - tempah = 0; - } else if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (SiS_Pr->SiS_LCDInfo & LCDSync)) { - tempah = SiS_Pr->SiS_LCDInfo; - } else tempah = infoflag >> 8; - tempah &= 0xC0; - tempah |= 0x20; - if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) || - (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) { - tempah |= 0xf0; - } - if( (SiS_Pr->SiS_IF_DEF_FSTN) || - (SiS_Pr->SiS_IF_DEF_DSTN) || - (SiS_Pr->SiS_IF_DEF_TRUMPION) || - (SiS_Pr->SiS_CustomT == CUT_PANEL848) || - (SiS_Pr->SiS_CustomT == CUT_PANEL856) ) { - tempah |= 0x30; - } - if( (SiS_Pr->SiS_IF_DEF_FSTN) || - (SiS_Pr->SiS_IF_DEF_DSTN) ) { - tempah &= ~0xc0; - } - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(SiS_Pr->ChipType >= SIS_315H) { - tempah >>= 3; - tempah &= 0x18; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xE7,tempah); - /* Don't care about 12/18/24 bit mode - TV is via VGA, not PL */ - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,0xe0); - } - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah); - } - - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* ---- 300 series --- */ - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { /* 630 - 301B(-DH) */ - - tempah = infoflag >> 8; - tempbl = 0; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(SiS_Pr->SiS_LCDInfo & LCDSync) { - tempah = SiS_Pr->SiS_LCDInfo; - tempbl = (tempah >> 6) & 0x03; - } - } - tempah &= 0xC0; - tempah |= 0x20; - if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10; - tempah |= 0xc0; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah); - if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xf0,tempbl); - } - - } else { /* 630 - 301 */ - - tempah = ((infoflag >> 8) & 0xc0) | 0x20; - if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah); - - } - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* ------- 315 series ------ */ - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { /* 315 - LVDS */ - - tempbl = 0; - if((SiS_Pr->SiS_CustomT == CUT_COMPAQ1280) && - (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)) { - tempah = infoflag >> 8; - if(SiS_Pr->SiS_LCDInfo & LCDSync) { - tempbl = ((SiS_Pr->SiS_LCDInfo & 0xc0) >> 6); - } - } else if((SiS_Pr->SiS_CustomT == CUT_CLEVO1400) && - (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050)) { - tempah = infoflag >> 8; - tempbl = 0x03; - } else { - tempah = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37); - tempbl = (tempah >> 6) & 0x03; - tempbl |= 0x08; - if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempbl |= 0x04; - } - tempah &= 0xC0; - tempah |= 0x20; - if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) tempah |= 0xc0; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah); - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xf0,tempbl); - } - } - - } else { /* 315 - TMDS */ - - tempah = tempbl = infoflag >> 8; - if(!SiS_Pr->UseCustomMode) { - tempbl = 0; - if((SiS_Pr->SiS_VBType & VB_SIS30xC) && (SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) { - if(ModeNo <= 0x13) { - tempah = SiS_GetRegByte((SiS_Pr->SiS_P3ca+0x02)); - } - } - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - if(SiS_Pr->SiS_LCDInfo & LCDSync) { - tempah = SiS_Pr->SiS_LCDInfo; - tempbl = (tempah >> 6) & 0x03; - } - } - } - } - tempah &= 0xC0; - tempah |= 0x20; - if(!(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit)) tempah |= 0x10; - if(SiS_Pr->SiS_VBType & VB_NoLCD) { - /* Imitate BIOS bug */ - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) tempah |= 0xc0; - } - if((SiS_Pr->SiS_VBType & VB_SIS30xC) && (SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC)) { - tempah >>= 3; - tempah &= 0x18; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xe7,tempah); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0F,tempah); - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xf0,tempbl); - } - } - } - - } -#endif /* CONFIG_FB_SIS_315 */ - } - } -} - -/* Set CRT2 FIFO on 300/540/630/730 */ -#ifdef CONFIG_FB_SIS_300 -static void -SiS_SetCRT2FIFO_300(struct SiS_Private *SiS_Pr,unsigned short ModeNo) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short temp, index, modeidindex, refreshratetableindex; - unsigned short VCLK = 0, MCLK, colorth = 0, data2 = 0; - unsigned short tempbx, tempcl, CRT1ModeNo, CRT2ModeNo, SelectRate_backup; - unsigned int data, pci50, pciA0; - static const unsigned char colortharray[] = { - 1, 1, 2, 2, 3, 4 - }; - - SelectRate_backup = SiS_Pr->SiS_SelectCRT2Rate; - - if(!SiS_Pr->CRT1UsesCustomMode) { - - CRT1ModeNo = SiS_Pr->SiS_CRT1Mode; /* get CRT1 ModeNo */ - SiS_SearchModeID(SiS_Pr, &CRT1ModeNo, &modeidindex); - SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2); - SiS_Pr->SiS_SelectCRT2Rate = 0; - refreshratetableindex = SiS_GetRatePtr(SiS_Pr, CRT1ModeNo, modeidindex); - - if(CRT1ModeNo >= 0x13) { - /* Get VCLK */ - index = SiS_GetRefCRTVCLK(SiS_Pr, refreshratetableindex, SiS_Pr->SiS_UseWide); - VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK; - - /* Get colordepth */ - colorth = SiS_GetColorDepth(SiS_Pr,CRT1ModeNo,modeidindex) >> 1; - if(!colorth) colorth++; - } - - } else { - - CRT1ModeNo = 0xfe; - - /* Get VCLK */ - VCLK = SiS_Pr->CSRClock_CRT1; - - /* Get color depth */ - colorth = colortharray[((SiS_Pr->CModeFlag_CRT1 & ModeTypeMask) - 2)]; - - } - - if(CRT1ModeNo >= 0x13) { - /* Get MCLK */ - if(SiS_Pr->ChipType == SIS_300) { - index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x3A); - } else { - index = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1A); - } - index &= 0x07; - MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK; - - temp = ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) >> 6) & 0x03) << 1; - if(!temp) temp++; - temp <<= 2; - - data2 = temp - ((colorth * VCLK) / MCLK); - - temp = (28 * 16) % data2; - data2 = (28 * 16) / data2; - if(temp) data2++; - - if(SiS_Pr->ChipType == SIS_300) { - - SiS_GetFIFOThresholdIndex300(SiS_Pr, &tempbx, &tempcl); - data = SiS_GetFIFOThresholdB300(tempbx, tempcl); - - } else { - - pci50 = sisfb_read_nbridge_pci_dword(SiS_Pr, 0x50); - pciA0 = sisfb_read_nbridge_pci_dword(SiS_Pr, 0xa0); - - if(SiS_Pr->ChipType == SIS_730) { - - index = (unsigned short)(((pciA0 >> 28) & 0x0f) * 3); - index += (unsigned short)(((pci50 >> 9)) & 0x03); - - /* BIOS BUG (2.04.5d, 2.04.6a use ah here, which is unset!) */ - index = 0; /* -- do it like the BIOS anyway... */ - - } else { - - pci50 >>= 24; - pciA0 >>= 24; - - index = (pci50 >> 1) & 0x07; - - if(pci50 & 0x01) index += 6; - if(!(pciA0 & 0x01)) index += 24; - - if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) & 0x80) index += 12; - - } - - data = SiS_GetLatencyFactor630(SiS_Pr, index) + 15; - if(!(SiS_GetReg(SiS_Pr->SiS_P3c4,0x14) & 0x80)) data += 5; - - } - - data += data2; /* CRT1 Request Period */ - - SiS_Pr->SiS_SetFlag |= ProgrammingCRT2; - SiS_Pr->SiS_SelectCRT2Rate = SelectRate_backup; - - if(!SiS_Pr->UseCustomMode) { - - CRT2ModeNo = ModeNo; - SiS_SearchModeID(SiS_Pr, &CRT2ModeNo, &modeidindex); - - refreshratetableindex = SiS_GetRatePtr(SiS_Pr, CRT2ModeNo, modeidindex); - - /* Get VCLK */ - index = SiS_GetVCLK2Ptr(SiS_Pr, CRT2ModeNo, modeidindex, refreshratetableindex); - VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK; - - if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) || (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) { - if(SiS_Pr->SiS_UseROM) { - if(ROMAddr[0x220] & 0x01) { - VCLK = ROMAddr[0x229] | (ROMAddr[0x22a] << 8); - } - } - } - - } else { - - /* Get VCLK */ - CRT2ModeNo = 0xfe; - VCLK = SiS_Pr->CSRClock; - - } - - /* Get colordepth */ - colorth = SiS_GetColorDepth(SiS_Pr,CRT2ModeNo,modeidindex) >> 1; - if(!colorth) colorth++; - - data = data * VCLK * colorth; - temp = data % (MCLK << 4); - data = data / (MCLK << 4); - if(temp) data++; - - if(data < 6) data = 6; - else if(data > 0x14) data = 0x14; - - if(SiS_Pr->ChipType == SIS_300) { - temp = 0x16; - if((data <= 0x0f) || (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)) - temp = 0x13; - } else { - temp = 0x16; - if(( (SiS_Pr->ChipType == SIS_630) || - (SiS_Pr->ChipType == SIS_730) ) && - (SiS_Pr->ChipRevision >= 0x30)) - temp = 0x1b; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x01,0xe0,temp); - - if((SiS_Pr->ChipType == SIS_630) && - (SiS_Pr->ChipRevision >= 0x30)) { - if(data > 0x13) data = 0x13; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x02,0xe0,data); - - } else { /* If mode <= 0x13, we just restore everything */ - - SiS_Pr->SiS_SetFlag |= ProgrammingCRT2; - SiS_Pr->SiS_SelectCRT2Rate = SelectRate_backup; - - } -} -#endif - -/* Set CRT2 FIFO on 315/330 series */ -#ifdef CONFIG_FB_SIS_315 -static void -SiS_SetCRT2FIFO_310(struct SiS_Private *SiS_Pr) -{ - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,0x3B); - if( (SiS_Pr->ChipType == SIS_760) && - (SiS_Pr->SiS_SysFlags & SF_760LFB) && - (SiS_Pr->SiS_ModeType == Mode32Bpp) && - (SiS_Pr->SiS_VGAHDE >= 1280) && - (SiS_Pr->SiS_VGAVDE >= 1024) ) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2f,0x03); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x01,0x3b); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x4d,0xc0); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2f,0x01); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x4d,0xc0); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x02,0x6e); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x02,~0x3f,0x04); - } - -} -#endif - -static unsigned short -SiS_GetVGAHT2(struct SiS_Private *SiS_Pr) -{ - unsigned int tempax,tempbx; - - tempbx = (SiS_Pr->SiS_VGAVT - SiS_Pr->SiS_VGAVDE) * SiS_Pr->SiS_RVBHCMAX; - tempax = (SiS_Pr->SiS_VT - SiS_Pr->SiS_VDE) * SiS_Pr->SiS_RVBHCFACT; - tempax = (tempax * SiS_Pr->SiS_HT) / tempbx; - return (unsigned short)tempax; -} - -/* Set Part 1 / SiS bridge slave mode */ -static void -SiS_SetGroup1_301(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short temp, modeflag, i, j, xres=0, VGAVDE; - static const unsigned short CRTranslation[] = { - /* CR0 CR1 CR2 CR3 CR4 CR5 CR6 CR7 */ - 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, - /* CR8 CR9 SR0A SR0B SR0C SR0D SR0E CR0F */ - 0x00, 0x0b, 0x17, 0x18, 0x19, 0x00, 0x1a, 0x00, - /* CR10 CR11 CR12 CR13 CR14 CR15 CR16 CR17 */ - 0x0c, 0x0d, 0x0e, 0x00, 0x0f, 0x10, 0x11, 0x00 - }; - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - } else if(SiS_Pr->UseCustomMode) { - modeflag = SiS_Pr->CModeFlag; - xres = SiS_Pr->CHDisplay; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - xres = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].XRes; - } - - /* The following is only done if bridge is in slave mode: */ - - if(SiS_Pr->ChipType >= SIS_315H) { - if(xres >= 1600) { /* BIOS: == 1600 */ - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x31,0x04); - } - } - - SiS_Pr->CHTotal = 8224; /* Max HT, 0x2020, results in 0x3ff in registers */ - - SiS_Pr->CHDisplay = SiS_Pr->SiS_VGAHDE; - if(modeflag & HalfDCLK) SiS_Pr->CHDisplay >>= 1; - - SiS_Pr->CHBlankStart = SiS_Pr->CHDisplay; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - SiS_Pr->CHBlankStart += 16; - } - - SiS_Pr->CHBlankEnd = 32; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(xres == 1600) SiS_Pr->CHBlankEnd += 80; - } - - temp = SiS_Pr->SiS_VGAHT - 96; - if(!(modeflag & HalfDCLK)) temp -= 32; - if(SiS_Pr->SiS_LCDInfo & LCDPass11) { - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x04); - temp |= ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x0b) & 0xc0) << 2); - temp -= 3; - temp <<= 3; - } else { - if(SiS_Pr->SiS_RVBHRS2) temp = SiS_Pr->SiS_RVBHRS2; - } - SiS_Pr->CHSyncStart = temp; - - SiS_Pr->CHSyncEnd = 0xffe8; /* results in 0x2000 in registers */ - - SiS_Pr->CVTotal = 2049; /* Max VT, 0x0801, results in 0x7ff in registers */ - - VGAVDE = SiS_Pr->SiS_VGAVDE; - if (VGAVDE == 357) VGAVDE = 350; - else if(VGAVDE == 360) VGAVDE = 350; - else if(VGAVDE == 375) VGAVDE = 350; - else if(VGAVDE == 405) VGAVDE = 400; - else if(VGAVDE == 420) VGAVDE = 400; - else if(VGAVDE == 525) VGAVDE = 480; - else if(VGAVDE == 1056) VGAVDE = 1024; - SiS_Pr->CVDisplay = VGAVDE; - - SiS_Pr->CVBlankStart = SiS_Pr->CVDisplay; - - SiS_Pr->CVBlankEnd = 1; - if(ModeNo == 0x3c) SiS_Pr->CVBlankEnd = 226; - - temp = (SiS_Pr->SiS_VGAVT - VGAVDE) >> 1; - SiS_Pr->CVSyncStart = VGAVDE + temp; - - temp >>= 3; - SiS_Pr->CVSyncEnd = SiS_Pr->CVSyncStart + temp; - - SiS_CalcCRRegisters(SiS_Pr, 0); - SiS_Pr->CCRT1CRTC[16] &= ~0xE0; - - for(i = 0; i <= 7; i++) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[i]); - } - for(i = 0x10, j = 8; i <= 0x12; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[j]); - } - for(i = 0x15, j = 11; i <= 0x16; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[j]); - } - for(i = 0x0a, j = 13; i <= 0x0c; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,CRTranslation[i],SiS_Pr->CCRT1CRTC[j]); - } - - temp = SiS_Pr->CCRT1CRTC[16] & 0xE0; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,CRTranslation[0x0E],0x1F,temp); - - temp = (SiS_Pr->CCRT1CRTC[16] & 0x01) << 5; - if(modeflag & DoubleScanMode) temp |= 0x80; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,CRTranslation[0x09],0x5F,temp); - - temp = 0; - temp |= (SiS_GetReg(SiS_Pr->SiS_P3c4,0x01) & 0x01); - if(modeflag & HalfDCLK) temp |= 0x08; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,temp); /* SR01: HalfDCLK[3], 8/9 div dotclock[0] */ - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0F,0x00); /* CR14: (text mode: underline location) */ - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x12,0x00); /* CR17: n/a */ - - temp = 0; - if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) { - temp = (SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x01) << 7; - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1A,temp); /* SR0E, dither[7] */ - - temp = SiS_GetRegByte((SiS_Pr->SiS_P3ca+0x02)); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,temp); /* ? */ -} - -/* Setup panel link - * This is used for LVDS, LCDA and Chrontel TV output - * 300/LVDS+TV, 300/301B-DH, 315/LVDS+TV, 315/LCDA - */ -static void -SiS_SetGroup1_LVDS(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short modeflag, resinfo = 0; - unsigned short push2, tempax, tempbx, tempcx, temp; - unsigned int tempeax = 0, tempebx, tempecx, tempvcfact = 0; - bool islvds = false, issis = false, chkdclkfirst = false; -#ifdef CONFIG_FB_SIS_300 - unsigned short crt2crtc = 0; -#endif -#ifdef CONFIG_FB_SIS_315 - unsigned short pushcx; -#endif - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo; -#ifdef CONFIG_FB_SIS_300 - crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; -#endif - } else if(SiS_Pr->UseCustomMode) { - modeflag = SiS_Pr->CModeFlag; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; -#ifdef CONFIG_FB_SIS_300 - crt2crtc = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; -#endif - } - - /* is lvds if really LVDS, or 301B-DH with external LVDS transmitter */ - if((SiS_Pr->SiS_IF_DEF_LVDS == 1) || (SiS_Pr->SiS_VBType & VB_NoLCD)) { - islvds = true; - } - - /* is really sis if sis bridge, but not 301B-DH */ - if((SiS_Pr->SiS_VBType & VB_SISVB) && (!(SiS_Pr->SiS_VBType & VB_NoLCD))) { - issis = true; - } - - if((SiS_Pr->ChipType >= SIS_315H) && (islvds) && (!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA))) { - if((!SiS_Pr->SiS_IF_DEF_FSTN) && (!SiS_Pr->SiS_IF_DEF_DSTN)) { - chkdclkfirst = true; - } - } - -#ifdef CONFIG_FB_SIS_315 - if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - if(IS_SIS330) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x10); - } else if(IS_SIS740) { - if(islvds) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xfb,0x04); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x03); - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x10); - } - } else { - if(islvds) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,0xfb,0x04); - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x00); - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x2D,0x0f); - if(SiS_Pr->SiS_VBType & VB_SIS30xC) { - if((SiS_Pr->SiS_LCDResInfo == Panel_1024x768) || - (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x2D,0x20); - } - } - } - } - } -#endif - - /* Horizontal */ - - tempax = SiS_Pr->SiS_LCDHDES; - if(islvds) { - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!SiS_Pr->SiS_IF_DEF_FSTN && !SiS_Pr->SiS_IF_DEF_DSTN) { - if((SiS_Pr->SiS_LCDResInfo == Panel_640x480) && - (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode))) { - tempax -= 8; - } - } - } - } - - temp = (tempax & 0x0007); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1A,temp); /* BPLHDESKEW[2:0] */ - temp = (tempax >> 3) & 0x00FF; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,temp); /* BPLHDESKEW[10:3] */ - - tempbx = SiS_Pr->SiS_HDE; - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - tempbx = SiS_Pr->PanelXRes; - } - if((SiS_Pr->SiS_LCDResInfo == Panel_320x240_1) || - (SiS_Pr->SiS_LCDResInfo == Panel_320x240_2) || - (SiS_Pr->SiS_LCDResInfo == Panel_320x240_3)) { - tempbx >>= 1; - } - } - - tempax += tempbx; - if(tempax >= SiS_Pr->SiS_HT) tempax -= SiS_Pr->SiS_HT; - - temp = tempax; - if(temp & 0x07) temp += 8; - temp >>= 3; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x17,temp); /* BPLHDEE */ - - tempcx = (SiS_Pr->SiS_HT - tempbx) >> 2; - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - if(SiS_Pr->PanelHRS != 999) tempcx = SiS_Pr->PanelHRS; - } - } - - tempcx += tempax; - if(tempcx >= SiS_Pr->SiS_HT) tempcx -= SiS_Pr->SiS_HT; - - temp = (tempcx >> 3) & 0x00FF; - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(SiS_Pr->SiS_IF_DEF_TRUMPION) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - switch(ModeNo) { - case 0x04: - case 0x05: - case 0x0d: temp = 0x56; break; - case 0x10: temp = 0x60; break; - case 0x13: temp = 0x5f; break; - case 0x40: - case 0x41: - case 0x4f: - case 0x43: - case 0x44: - case 0x62: - case 0x56: - case 0x53: - case 0x5d: - case 0x5e: temp = 0x54; break; - } - } - } - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,temp); /* BPLHRS */ - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - temp += 2; - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - temp += 8; - if(SiS_Pr->PanelHRE != 999) { - temp = tempcx + SiS_Pr->PanelHRE; - if(temp >= SiS_Pr->SiS_HT) temp -= SiS_Pr->SiS_HT; - temp >>= 3; - } - } - } else { - temp += 10; - } - - temp &= 0x1F; - temp |= ((tempcx & 0x07) << 5); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x15,temp); /* BPLHRE */ - - /* Vertical */ - - tempax = SiS_Pr->SiS_VGAVDE; - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - tempax = SiS_Pr->PanelYRes; - } - } - - tempbx = SiS_Pr->SiS_LCDVDES + tempax; - if(tempbx >= SiS_Pr->SiS_VT) tempbx -= SiS_Pr->SiS_VT; - - push2 = tempbx; - - tempcx = SiS_Pr->SiS_VGAVT - SiS_Pr->SiS_VGAVDE; - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - tempcx = SiS_Pr->SiS_VGAVT - SiS_Pr->PanelYRes; - } - } - } - if(islvds) tempcx >>= 1; - else tempcx >>= 2; - - if( (SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) && - (!(SiS_Pr->SiS_LCDInfo & LCDPass11)) && - (SiS_Pr->PanelVRS != 999) ) { - tempcx = SiS_Pr->PanelVRS; - tempbx += tempcx; - if(issis) tempbx++; - } else { - tempbx += tempcx; - if(SiS_Pr->ChipType < SIS_315H) tempbx++; - else if(issis) tempbx++; - } - - if(tempbx >= SiS_Pr->SiS_VT) tempbx -= SiS_Pr->SiS_VT; - - temp = tempbx & 0x00FF; - if(SiS_Pr->SiS_IF_DEF_TRUMPION) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(ModeNo == 0x10) temp = 0xa9; - } - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,temp); /* BPLVRS */ - - tempcx >>= 3; - tempcx++; - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - if(SiS_Pr->PanelVRE != 999) tempcx = SiS_Pr->PanelVRE; - } - } - - tempcx += tempbx; - temp = tempcx & 0x000F; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0xF0,temp); /* BPLVRE */ - - temp = ((tempbx >> 8) & 0x07) << 3; - if(SiS_Pr->SiS_IF_DEF_FSTN || SiS_Pr->SiS_IF_DEF_DSTN) { - if(SiS_Pr->SiS_HDE != 640) { - if(SiS_Pr->SiS_VGAVDE != SiS_Pr->SiS_VDE) temp |= 0x40; - } - } else if(SiS_Pr->SiS_VGAVDE != SiS_Pr->SiS_VDE) temp |= 0x40; - if(SiS_Pr->SiS_SetFlag & EnableLVDSDDA) temp |= 0x40; - tempbx = 0x87; - if((SiS_Pr->ChipType >= SIS_315H) || - (SiS_Pr->ChipRevision >= 0x30)) { - tempbx = 0x07; - if((SiS_Pr->SiS_IF_DEF_CH70xx == 1) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) { - if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x03) temp |= 0x80; - } - /* Chrontel 701x operates in 24bit mode (8-8-8, 2x12bit multiplexed) via VGA2 */ - if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - if(SiS_GetReg(SiS_Pr->SiS_P3c4,0x06) & 0x10) temp |= 0x80; - } else { - if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x01) temp |= 0x80; - } - } - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x1A,tempbx,temp); - - tempbx = push2; /* BPLVDEE */ - - tempcx = SiS_Pr->SiS_LCDVDES; /* BPLVDES */ - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_640x480: - tempbx = SiS_Pr->SiS_VGAVDE - 1; - tempcx = SiS_Pr->SiS_VGAVDE; - break; - case Panel_800x600: - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - if(resinfo == SIS_RI_800x600) tempcx++; - } - break; - case Panel_1024x600: - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - if(resinfo == SIS_RI_1024x600) tempcx++; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - if(resinfo == SIS_RI_800x600) tempcx++; - } - } - break; - case Panel_1024x768: - if(SiS_Pr->ChipType < SIS_315H) { - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - if(resinfo == SIS_RI_1024x768) tempcx++; - } - } - break; - } - } - - temp = ((tempbx >> 8) & 0x07) << 3; - temp |= ((tempcx >> 8) & 0x07); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1D,temp); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1C,tempbx); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1B,tempcx); - - /* Vertical scaling */ - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* 300 series */ - tempeax = SiS_Pr->SiS_VGAVDE << 6; - temp = (tempeax % (unsigned int)SiS_Pr->SiS_VDE); - tempeax = tempeax / (unsigned int)SiS_Pr->SiS_VDE; - if(temp) tempeax++; - - if(SiS_Pr->SiS_SetFlag & EnableLVDSDDA) tempeax = 0x3F; - - temp = (unsigned short)(tempeax & 0x00FF); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1E,temp); /* BPLVCFACT */ - tempvcfact = temp; -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* 315 series */ - tempeax = SiS_Pr->SiS_VGAVDE << 18; - tempebx = SiS_Pr->SiS_VDE; - temp = (tempeax % tempebx); - tempeax = tempeax / tempebx; - if(temp) tempeax++; - tempvcfact = tempeax; - - temp = (unsigned short)(tempeax & 0x00FF); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x37,temp); - temp = (unsigned short)((tempeax & 0x00FF00) >> 8); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x36,temp); - temp = (unsigned short)((tempeax & 0x00030000) >> 16); - if(SiS_Pr->SiS_VDE == SiS_Pr->SiS_VGAVDE) temp |= 0x04; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x35,temp); - - if(SiS_Pr->SiS_VBType & VB_SISPART4SCALER) { - temp = (unsigned short)(tempeax & 0x00FF); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x3c,temp); - temp = (unsigned short)((tempeax & 0x00FF00) >> 8); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x3b,temp); - temp = (unsigned short)(((tempeax & 0x00030000) >> 16) << 6); - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x3a,0x3f,temp); - temp = 0; - if(SiS_Pr->SiS_VDE != SiS_Pr->SiS_VGAVDE) temp |= 0x08; - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x30,0xf3,temp); - } -#endif - - } - - /* Horizontal scaling */ - - tempeax = SiS_Pr->SiS_VGAHDE; /* 1f = ( (VGAHDE * 65536) / ( (VGAHDE * 65536) / HDE ) ) - 1*/ - if(chkdclkfirst) { - if(modeflag & HalfDCLK) tempeax >>= 1; - } - tempebx = tempeax << 16; - if(SiS_Pr->SiS_HDE == tempeax) { - tempecx = 0xFFFF; - } else { - tempecx = tempebx / SiS_Pr->SiS_HDE; - if(SiS_Pr->ChipType >= SIS_315H) { - if(tempebx % SiS_Pr->SiS_HDE) tempecx++; - } - } - - if(SiS_Pr->ChipType >= SIS_315H) { - tempeax = (tempebx / tempecx) - 1; - } else { - tempeax = ((SiS_Pr->SiS_VGAHT << 16) / tempecx) - 1; - } - tempecx = (tempecx << 16) | (tempeax & 0xFFFF); - temp = (unsigned short)(tempecx & 0x00FF); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1F,temp); - - if(SiS_Pr->ChipType >= SIS_315H) { - tempeax = (SiS_Pr->SiS_VGAVDE << 18) / tempvcfact; - tempbx = (unsigned short)(tempeax & 0xFFFF); - } else { - tempeax = SiS_Pr->SiS_VGAVDE << 6; - tempbx = tempvcfact & 0x3f; - if(tempbx == 0) tempbx = 64; - tempeax /= tempbx; - tempbx = (unsigned short)(tempeax & 0xFFFF); - } - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) tempbx--; - if(SiS_Pr->SiS_SetFlag & EnableLVDSDDA) { - if((!SiS_Pr->SiS_IF_DEF_FSTN) && (!SiS_Pr->SiS_IF_DEF_DSTN)) tempbx = 1; - else if(SiS_Pr->SiS_LCDResInfo != Panel_640x480) tempbx = 1; - } - - temp = ((tempbx >> 8) & 0x07) << 3; - temp = temp | ((tempecx >> 8) & 0x07); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x20,temp); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x21,tempbx); - - tempecx >>= 16; /* BPLHCFACT */ - if(!chkdclkfirst) { - if(modeflag & HalfDCLK) tempecx >>= 1; - } - temp = (unsigned short)((tempecx & 0xFF00) >> 8); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x22,temp); - temp = (unsigned short)(tempecx & 0x00FF); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x23,temp); - -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - if((islvds) || (SiS_Pr->SiS_VBInfo & VB_SISLVDS)) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1e,0x20); - } - } else { - if(islvds) { - if(SiS_Pr->ChipType == SIS_740) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x03); - } else { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1e,0x23); - } - } - } - } -#endif - -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->SiS_IF_DEF_TRUMPION) { - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned char *trumpdata; - int i, j = crt2crtc; - unsigned char TrumpMode13[4] = { 0x01, 0x10, 0x2c, 0x00 }; - unsigned char TrumpMode10_1[4] = { 0x01, 0x10, 0x27, 0x00 }; - unsigned char TrumpMode10_2[4] = { 0x01, 0x16, 0x10, 0x00 }; - - if(SiS_Pr->SiS_UseROM) { - trumpdata = &ROMAddr[0x8001 + (j * 80)]; - } else { - if(SiS_Pr->SiS_LCDTypeInfo == 0x0e) j += 7; - trumpdata = &SiS300_TrumpionData[j][0]; - } - - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x02,0xbf); - for(i=0; i<5; i++) { - SiS_SetTrumpionBlock(SiS_Pr, trumpdata); - } - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(ModeNo == 0x13) { - for(i=0; i<4; i++) { - SiS_SetTrumpionBlock(SiS_Pr, &TrumpMode13[0]); - } - } else if(ModeNo == 0x10) { - for(i=0; i<4; i++) { - SiS_SetTrumpionBlock(SiS_Pr, &TrumpMode10_1[0]); - SiS_SetTrumpionBlock(SiS_Pr, &TrumpMode10_2[0]); - } - } - } - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x02,0x40); - } -#endif - -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->SiS_IF_DEF_FSTN || SiS_Pr->SiS_IF_DEF_DSTN) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x25,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x26,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x27,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x28,0x87); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x29,0x5A); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2A,0x4B); - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x44,~0x07,0x03); - tempax = SiS_Pr->SiS_HDE; /* Blps = lcdhdee(lcdhdes+HDE) + 64 */ - if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1; - tempax += 64; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x38,tempax & 0xff); - temp = (tempax >> 8) << 3; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,~0x078,temp); - tempax += 32; /* Blpe = lBlps+32 */ - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x39,tempax & 0xff); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3A,0x00); /* Bflml = 0 */ - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x3C,~0x007); - - tempax = SiS_Pr->SiS_VDE; - if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1; - tempax >>= 1; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3B,tempax & 0xff); - temp = (tempax >> 8) << 3; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x3C,~0x038,temp); - - tempeax = SiS_Pr->SiS_HDE; - if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempeax >>= 1; - tempeax <<= 2; /* BDxFIFOSTOP = (HDE*4)/128 */ - temp = tempeax & 0x7f; - tempeax >>= 7; - if(temp) tempeax++; - temp = tempeax & 0x3f; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x45,temp); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3F,0x00); /* BDxWadrst0 */ - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3E,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3D,0x10); - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x3C,~0x040); - - tempax = SiS_Pr->SiS_HDE; - if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1; - tempax >>= 4; /* BDxWadroff = HDE*4/8/8 */ - pushcx = tempax; - temp = tempax & 0x00FF; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x43,temp); - temp = ((tempax & 0xFF00) >> 8) << 3; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port, 0x44, 0x07, temp); - - tempax = SiS_Pr->SiS_VDE; /* BDxWadrst1 = BDxWadrst0 + BDxWadroff * VDE */ - if(SiS_Pr->SiS_LCDResInfo == Panel_320x240_1 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_2 || - SiS_Pr->SiS_LCDResInfo == Panel_320x240_3) tempax >>= 1; - tempeax = tempax * pushcx; - temp = tempeax & 0xFF; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x42,temp); - temp = (tempeax & 0xFF00) >> 8; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x41,temp); - temp = ((tempeax & 0xFF0000) >> 16) | 0x10; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x40,temp); - temp = ((tempeax & 0x01000000) >> 24) << 7; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port, 0x3C, 0x7F, temp); - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2F,0x03); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x03,0x50); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x04,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2F,0x01); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0x38); - - if(SiS_Pr->SiS_IF_DEF_FSTN) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2b,0x02); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2c,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2d,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x35,0x0c); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x36,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x37,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x38,0x80); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x39,0xA0); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3a,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3b,0xf0); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3c,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3d,0x10); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3e,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x3f,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x40,0x10); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x41,0x25); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x42,0x80); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x43,0x14); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x44,0x03); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x45,0x0a); - } - } -#endif /* CONFIG_FB_SIS_315 */ -} - -/* Set Part 1 */ -static void -SiS_SetGroup1(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ -#if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; -#endif - unsigned short temp=0, tempax=0, tempbx=0, tempcx=0, bridgeadd=0; - unsigned short pushbx=0, CRT1Index=0, modeflag, resinfo=0; -#ifdef CONFIG_FB_SIS_315 - unsigned short tempbl=0; -#endif - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - SiS_SetGroup1_LVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - return; - } - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - } else if(SiS_Pr->UseCustomMode) { - modeflag = SiS_Pr->CModeFlag; - } else { - CRT1Index = SiS_GetRefCRT1CRTC(SiS_Pr, RefreshRateTableIndex, SiS_Pr->SiS_UseWideCRT2); - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - } - - SiS_SetCRT2Offset(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - - if( ! ((SiS_Pr->ChipType >= SIS_315H) && - (SiS_Pr->SiS_IF_DEF_LVDS == 1) && - (SiS_Pr->SiS_VBInfo & SetInSlaveMode)) ) { - - if(SiS_Pr->ChipType < SIS_315H ) { -#ifdef CONFIG_FB_SIS_300 - SiS_SetCRT2FIFO_300(SiS_Pr, ModeNo); -#endif - } else { -#ifdef CONFIG_FB_SIS_315 - SiS_SetCRT2FIFO_310(SiS_Pr); -#endif - } - - /* 1. Horizontal setup */ - - if(SiS_Pr->ChipType < SIS_315H ) { - -#ifdef CONFIG_FB_SIS_300 /* ------------- 300 series --------------*/ - - temp = (SiS_Pr->SiS_VGAHT - 1) & 0x0FF; /* BTVGA2HT 0x08,0x09 */ - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x08,temp); /* CRT2 Horizontal Total */ - - temp = (((SiS_Pr->SiS_VGAHT - 1) & 0xFF00) >> 8) << 4; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x09,0x0f,temp); /* CRT2 Horizontal Total Overflow [7:4] */ - - temp = (SiS_Pr->SiS_VGAHDE + 12) & 0x0FF; /* BTVGA2HDEE 0x0A,0x0C */ - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0A,temp); /* CRT2 Horizontal Display Enable End */ - - pushbx = SiS_Pr->SiS_VGAHDE + 12; /* bx BTVGA2HRS 0x0B,0x0C */ - tempcx = (SiS_Pr->SiS_VGAHT - SiS_Pr->SiS_VGAHDE) >> 2; - tempbx = pushbx + tempcx; - tempcx <<= 1; - tempcx += tempbx; - - bridgeadd = 12; - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* ------------------- 315/330 series --------------- */ - - tempcx = SiS_Pr->SiS_VGAHT; /* BTVGA2HT 0x08,0x09 */ - if(modeflag & HalfDCLK) { - if(SiS_Pr->SiS_VBType & VB_SISVB) { - tempcx >>= 1; - } else { - tempax = SiS_Pr->SiS_VGAHDE >> 1; - tempcx = SiS_Pr->SiS_HT - SiS_Pr->SiS_HDE + tempax; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - tempcx = SiS_Pr->SiS_HT - tempax; - } - } - } - tempcx--; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x08,tempcx); /* CRT2 Horizontal Total */ - temp = (tempcx >> 4) & 0xF0; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x09,0x0F,temp); /* CRT2 Horizontal Total Overflow [7:4] */ - - tempcx = SiS_Pr->SiS_VGAHT; /* BTVGA2HDEE 0x0A,0x0C */ - tempbx = SiS_Pr->SiS_VGAHDE; - tempcx -= tempbx; - tempcx >>= 2; - if(modeflag & HalfDCLK) { - tempbx >>= 1; - tempcx >>= 1; - } - tempbx += 16; - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0A,tempbx); /* CRT2 Horizontal Display Enable End */ - - pushbx = tempbx; - tempcx >>= 1; - tempbx += tempcx; - tempcx += tempbx; - - bridgeadd = 16; - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->ChipType >= SIS_661) { - if((SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) || - (SiS_Pr->SiS_LCDResInfo == Panel_1280x1024)) { - if(resinfo == SIS_RI_1280x1024) { - tempcx = (tempcx & 0xff00) | 0x30; - } else if(resinfo == SIS_RI_1600x1200) { - tempcx = (tempcx & 0xff00) | 0xff; - } - } - } - } - -#endif /* CONFIG_FB_SIS_315 */ - - } /* 315/330 series */ - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->UseCustomMode) { - tempbx = SiS_Pr->CHSyncStart + bridgeadd; - tempcx = SiS_Pr->CHSyncEnd + bridgeadd; - tempax = SiS_Pr->SiS_VGAHT; - if(modeflag & HalfDCLK) tempax >>= 1; - tempax--; - if(tempcx > tempax) tempcx = tempax; - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) { - unsigned char cr4, cr14, cr5, cr15; - if(SiS_Pr->UseCustomMode) { - cr4 = SiS_Pr->CCRT1CRTC[4]; - cr14 = SiS_Pr->CCRT1CRTC[14]; - cr5 = SiS_Pr->CCRT1CRTC[5]; - cr15 = SiS_Pr->CCRT1CRTC[15]; - } else { - cr4 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[4]; - cr14 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[14]; - cr5 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[5]; - cr15 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[15]; - } - tempbx = ((cr4 | ((cr14 & 0xC0) << 2)) - 3) << 3; /* (VGAHRS-3)*8 */ - tempcx = (((cr5 & 0x1f) | ((cr15 & 0x04) << (5-2))) - 3) << 3; /* (VGAHRE-3)*8 */ - tempcx &= 0x00FF; - tempcx |= (tempbx & 0xFF00); - tempbx += bridgeadd; - tempcx += bridgeadd; - tempax = SiS_Pr->SiS_VGAHT; - if(modeflag & HalfDCLK) tempax >>= 1; - tempax--; - if(tempcx > tempax) tempcx = tempax; - } - - if(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSet525p1024)) { - tempbx = 1040; - tempcx = 1044; /* HWCursor bug! */ - } - - } - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0B,tempbx); /* CRT2 Horizontal Retrace Start */ - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0D,tempcx); /* CRT2 Horizontal Retrace End */ - - temp = ((tempbx >> 8) & 0x0F) | ((pushbx >> 4) & 0xF0); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0C,temp); /* Overflow */ - - /* 2. Vertical setup */ - - tempcx = SiS_Pr->SiS_VGAVT - 1; - temp = tempcx & 0x00FF; - - if(SiS_Pr->ChipType < SIS_661) { - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToSVIDEO | SetCRT2ToAVIDEO)) { - temp--; - } - } - } else { - temp--; - } - } else if(SiS_Pr->ChipType >= SIS_315H) { - temp--; - } - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0E,temp); /* CRT2 Vertical Total */ - - tempbx = SiS_Pr->SiS_VGAVDE - 1; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x0F,tempbx); /* CRT2 Vertical Display Enable End */ - - temp = ((tempbx >> 5) & 0x38) | ((tempcx >> 8) & 0x07); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x12,temp); /* Overflow */ - - if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->ChipType < SIS_661)) { - tempbx++; - tempax = tempbx; - tempcx++; - tempcx -= tempax; - tempcx >>= 2; - tempbx += tempcx; - if(tempcx < 4) tempcx = 4; - tempcx >>= 2; - tempcx += tempbx; - tempcx++; - } else { - tempbx = (SiS_Pr->SiS_VGAVT + SiS_Pr->SiS_VGAVDE) >> 1; /* BTVGA2VRS 0x10,0x11 */ - tempcx = ((SiS_Pr->SiS_VGAVT - SiS_Pr->SiS_VGAVDE) >> 4) + tempbx + 1; /* BTVGA2VRE 0x11 */ - } - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->UseCustomMode) { - tempbx = SiS_Pr->CVSyncStart; - tempcx = SiS_Pr->CVSyncEnd; - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) { - unsigned char cr8, cr7, cr13; - if(SiS_Pr->UseCustomMode) { - cr8 = SiS_Pr->CCRT1CRTC[8]; - cr7 = SiS_Pr->CCRT1CRTC[7]; - cr13 = SiS_Pr->CCRT1CRTC[13]; - tempcx = SiS_Pr->CCRT1CRTC[9]; - } else { - cr8 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[8]; - cr7 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[7]; - cr13 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[13]; - tempcx = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[9]; - } - tempbx = cr8; - if(cr7 & 0x04) tempbx |= 0x0100; - if(cr7 & 0x80) tempbx |= 0x0200; - if(cr13 & 0x08) tempbx |= 0x0400; - } - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x10,tempbx); /* CRT2 Vertical Retrace Start */ - - temp = ((tempbx >> 4) & 0x70) | (tempcx & 0x0F); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x11,temp); /* CRT2 Vert. Retrace End; Overflow */ - - /* 3. Panel delay compensation */ - - if(SiS_Pr->ChipType < SIS_315H) { - -#ifdef CONFIG_FB_SIS_300 /* ---------- 300 series -------------- */ - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - temp = 0x20; - if(SiS_Pr->ChipType == SIS_300) { - temp = 0x10; - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) temp = 0x2c; - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) temp = 0x20; - } - if(SiS_Pr->SiS_VBType & VB_SIS301) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) temp = 0x20; - } - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x960) temp = 0x24; - if(SiS_Pr->SiS_LCDResInfo == Panel_Custom) temp = 0x2c; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) temp = 0x08; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) temp = 0x2c; - else temp = 0x20; - } - if(SiS_Pr->SiS_UseROM) { - if(ROMAddr[0x220] & 0x80) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoYPbPrHiVision) - temp = ROMAddr[0x221]; - else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) - temp = ROMAddr[0x222]; - else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) - temp = ROMAddr[0x223]; - else - temp = ROMAddr[0x224]; - } - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(SiS_Pr->PDC != -1) temp = SiS_Pr->PDC; - } - - } else { - temp = 0x20; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) { - if(SiS_Pr->SiS_LCDResInfo == Panel_640x480) temp = 0x04; - } - if(SiS_Pr->SiS_UseROM) { - if(ROMAddr[0x220] & 0x80) { - temp = ROMAddr[0x220]; - } - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(SiS_Pr->PDC != -1) temp = SiS_Pr->PDC; - } - } - - temp &= 0x3c; - - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,~0x3C,temp); /* Panel Link Delay Compensation; (Software Command Reset; Power Saving) */ - -#endif /* CONFIG_FB_SIS_300 */ - - } else { - -#ifdef CONFIG_FB_SIS_315 /* --------------- 315/330 series ---------------*/ - - if(SiS_Pr->ChipType < SIS_661) { - - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - - if(SiS_Pr->ChipType == SIS_740) temp = 0x03; - else temp = 0x00; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) temp = 0x0a; - tempbl = 0xF0; - if(SiS_Pr->ChipType == SIS_650) { - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) tempbl = 0x0F; - } - } - - if(SiS_Pr->SiS_IF_DEF_DSTN || SiS_Pr->SiS_IF_DEF_FSTN) { - temp = 0x08; - tempbl = 0; - if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) { - if(ROMAddr[0x13c] & 0x80) tempbl = 0xf0; - } - } - - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,tempbl,temp); /* Panel Link Delay Compensation */ - } - - } /* < 661 */ - - tempax = 0; - if(modeflag & DoubleScanMode) tempax |= 0x80; - if(modeflag & HalfDCLK) tempax |= 0x40; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2C,0x3f,tempax); - -#endif /* CONFIG_FB_SIS_315 */ - - } - - } /* Slavemode */ - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) { - /* For 301BDH with LCD, we set up the Panel Link */ - SiS_SetGroup1_LVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } else if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - SiS_SetGroup1_301(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - } else { - if(SiS_Pr->ChipType < SIS_315H) { - SiS_SetGroup1_LVDS(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } else { - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if((!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) || (SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - SiS_SetGroup1_LVDS(SiS_Pr, ModeNo,ModeIdIndex,RefreshRateTableIndex); - } - } else { - SiS_SetGroup1_LVDS(SiS_Pr, ModeNo,ModeIdIndex,RefreshRateTableIndex); - } - } - } -} - -/*********************************************/ -/* SET PART 2 REGISTER GROUP */ -/*********************************************/ - -#ifdef CONFIG_FB_SIS_315 -static unsigned char * -SiS_GetGroup2CLVXPtr(struct SiS_Private *SiS_Pr, int tabletype) -{ - const unsigned char *tableptr = NULL; - unsigned short a, b, p = 0; - - a = SiS_Pr->SiS_VGAHDE; - b = SiS_Pr->SiS_HDE; - if(tabletype) { - a = SiS_Pr->SiS_VGAVDE; - b = SiS_Pr->SiS_VDE; - } - - if(a < b) { - tableptr = SiS_Part2CLVX_1; - } else if(a == b) { - tableptr = SiS_Part2CLVX_2; - } else { - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - tableptr = SiS_Part2CLVX_4; - } else { - tableptr = SiS_Part2CLVX_3; - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525i) tableptr = SiS_Part2CLVX_3; - else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) tableptr = SiS_Part2CLVX_3; - else tableptr = SiS_Part2CLVX_5; - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - tableptr = SiS_Part2CLVX_6; - } - do { - if((tableptr[p] | tableptr[p+1] << 8) == a) break; - p += 0x42; - } while((tableptr[p] | tableptr[p+1] << 8) != 0xffff); - if((tableptr[p] | tableptr[p+1] << 8) == 0xffff) p -= 0x42; - } - p += 2; - return ((unsigned char *)&tableptr[p]); -} - -static void -SiS_SetGroup2_C_ELV(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned char *tableptr; - unsigned char temp; - int i, j; - - if(!(SiS_Pr->SiS_VBType & VB_SISTAP4SCALER)) return; - - tableptr = SiS_GetGroup2CLVXPtr(SiS_Pr, 0); - for(i = 0x80, j = 0; i <= 0xbf; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port, i, tableptr[j]); - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - tableptr = SiS_GetGroup2CLVXPtr(SiS_Pr, 1); - for(i = 0xc0, j = 0; i <= 0xff; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port, i, tableptr[j]); - } - } - temp = 0x10; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) temp |= 0x04; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x4e,0xeb,temp); -} - -static bool -SiS_GetCRT2Part2Ptr(struct SiS_Private *SiS_Pr,unsigned short ModeNo,unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex,unsigned short *CRT2Index, - unsigned short *ResIndex) -{ - - if(SiS_Pr->ChipType < SIS_315H) return false; - - if(ModeNo <= 0x13) - (*ResIndex) = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - else - (*ResIndex) = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - - (*ResIndex) &= 0x3f; - (*CRT2Index) = 0; - - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) { - (*CRT2Index) = 200; - } - } - - if(SiS_Pr->SiS_CustomT == CUT_ASUSA2H_2) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(SiS_Pr->SiS_SetFlag & LCDVESATiming) (*CRT2Index) = 206; - } - } - return (((*CRT2Index) != 0)); -} -#endif - -#ifdef CONFIG_FB_SIS_300 -static void -SiS_Group2LCDSpecial(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short crt2crtc) -{ - unsigned short tempcx; - static const unsigned char atable[] = { - 0xc3,0x9e,0xc3,0x9e,0x02,0x02,0x02, - 0xab,0x87,0xab,0x9e,0xe7,0x02,0x02 - }; - - if(!SiS_Pr->UseCustomMode) { - if( ( ( (SiS_Pr->ChipType == SIS_630) || - (SiS_Pr->ChipType == SIS_730) ) && - (SiS_Pr->ChipRevision > 2) ) && - (SiS_Pr->SiS_LCDResInfo == Panel_1024x768) && - (!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) && - (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) ) { - if(ModeNo == 0x13) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,0xB9); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x05,0xCC); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,0xA6); - } else if((crt2crtc & 0x3F) == 4) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x2B); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x13); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,0xE5); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x05,0x08); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,0xE2); - } - } - - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_LCDTypeInfo == 0x0c) { - crt2crtc &= 0x1f; - tempcx = 0; - if(!(SiS_Pr->SiS_VBInfo & SetNotSimuMode)) { - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - tempcx += 7; - } - } - tempcx += crt2crtc; - if(crt2crtc >= 4) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,0xff); - } - - if(!(SiS_Pr->SiS_VBInfo & SetNotSimuMode)) { - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - if(crt2crtc == 4) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x28); - } - } - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x18); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,atable[tempcx]); - } - } - } -} - -/* For ECS A907. Highly preliminary. */ -static void -SiS_Set300Part2Regs(struct SiS_Private *SiS_Pr, unsigned short ModeIdIndex, unsigned short RefreshRateTableIndex, - unsigned short ModeNo) -{ - const struct SiS_Part2PortTbl *CRT2Part2Ptr = NULL; - unsigned short crt2crtc, resindex; - int i, j; - - if(SiS_Pr->ChipType != SIS_300) return; - if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) return; - if(SiS_Pr->UseCustomMode) return; - - if(ModeNo <= 0x13) { - crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - } else { - crt2crtc = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - } - - resindex = crt2crtc & 0x3F; - if(SiS_Pr->SiS_SetFlag & LCDVESATiming) CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_1; - else CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_2; - - /* The BIOS code (1.16.51,56) is obviously a fragment! */ - if(ModeNo > 0x13) { - CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_1; - resindex = 4; - } - - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x01,0x80,(CRT2Part2Ptr+resindex)->CR[0]); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x02,0x80,(CRT2Part2Ptr+resindex)->CR[1]); - for(i = 2, j = 0x04; j <= 0x06; i++, j++ ) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]); - } - for(j = 0x1c; j <= 0x1d; i++, j++ ) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]); - } - for(j = 0x1f; j <= 0x21; i++, j++ ) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]); - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x23,(CRT2Part2Ptr+resindex)->CR[10]); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0x0f,(CRT2Part2Ptr+resindex)->CR[11]); -} -#endif - -static void -SiS_SetTVSpecial(struct SiS_Private *SiS_Pr, unsigned short ModeNo) -{ - if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) return; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoHiVision)) return; - if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p)) return; - - if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) { - if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) { - const unsigned char specialtv[] = { - 0xa7,0x07,0xf2,0x6e,0x17,0x8b,0x73,0x53, - 0x13,0x40,0x34,0xf4,0x63,0xbb,0xcc,0x7a, - 0x58,0xe4,0x73,0xda,0x13 - }; - int i, j; - for(i = 0x1c, j = 0; i <= 0x30; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,specialtv[j]); - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x43,0x72); - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750)) { - if(SiS_Pr->SiS_TVMode & TVSetPALM) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x14); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x1b); - } else { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x14); /* 15 */ - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x1a); /* 1b */ - } - } - } - } else { - if((ModeNo == 0x38) || (ModeNo == 0x4a) || (ModeNo == 0x64) || - (ModeNo == 0x52) || (ModeNo == 0x58) || (ModeNo == 0x5c)) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x1b); /* 21 */ - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x54); /* 5a */ - } else { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x1a); /* 21 */ - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x53); /* 5a */ - } - } -} - -static void -SiS_SetGroup2_Tail(struct SiS_Private *SiS_Pr, unsigned short ModeNo) -{ - unsigned short temp; - - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) { - if(SiS_Pr->SiS_VGAVDE == 525) { - temp = 0xc3; - if(SiS_Pr->SiS_ModeType <= ModeVGA) { - temp++; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) temp += 2; - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2f,temp); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x30,0xb3); - } else if(SiS_Pr->SiS_VGAVDE == 420) { - temp = 0x4d; - if(SiS_Pr->SiS_ModeType <= ModeVGA) { - temp++; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) temp++; - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2f,temp); - } - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) { - if(SiS_Pr->SiS_VBType & VB_SIS30xB) { - SiS_SetRegOR(SiS_Pr->SiS_Part2Port,0x1a,0x03); - /* Not always for LV, see SetGrp2 */ - } - temp = 1; - if(ModeNo <= 0x13) temp = 3; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x0b,temp); - } -#if 0 - /* 651+301C, for 1280x768 - do I really need that? */ - if((SiS_Pr->SiS_PanelXRes == 1280) && (SiS_Pr->SiS_PanelYRes == 768)) { - if(SiS_Pr->SiS_VBInfo & SetSimuScanMode) { - if(((SiS_Pr->SiS_HDE == 640) && (SiS_Pr->SiS_VDE == 480)) || - ((SiS_Pr->SiS_HDE == 320) && (SiS_Pr->SiS_VDE == 240))) { - SiS_SetReg(SiS_Part2Port,0x01,0x2b); - SiS_SetReg(SiS_Part2Port,0x02,0x13); - SiS_SetReg(SiS_Part2Port,0x04,0xe5); - SiS_SetReg(SiS_Part2Port,0x05,0x08); - SiS_SetReg(SiS_Part2Port,0x06,0xe2); - SiS_SetReg(SiS_Part2Port,0x1c,0x21); - SiS_SetReg(SiS_Part2Port,0x1d,0x45); - SiS_SetReg(SiS_Part2Port,0x1f,0x0b); - SiS_SetReg(SiS_Part2Port,0x20,0x00); - SiS_SetReg(SiS_Part2Port,0x21,0xa9); - SiS_SetReg(SiS_Part2Port,0x23,0x0b); - SiS_SetReg(SiS_Part2Port,0x25,0x04); - } - } - } -#endif - } -} - -static void -SiS_SetGroup2(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short i, j, tempax, tempbx, tempcx, tempch, tempcl, temp; - unsigned short push2, modeflag, crt2crtc, bridgeoffset; - unsigned int longtemp, PhaseIndex; - bool newtvphase; - const unsigned char *TimingPoint; -#ifdef CONFIG_FB_SIS_315 - unsigned short resindex, CRT2Index; - const struct SiS_Part2PortTbl *CRT2Part2Ptr = NULL; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) return; -#endif - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - } else if(SiS_Pr->UseCustomMode) { - modeflag = SiS_Pr->CModeFlag; - crt2crtc = 0; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - crt2crtc = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - } - - temp = 0; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToAVIDEO)) temp |= 0x08; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToSVIDEO)) temp |= 0x04; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToSCART) temp |= 0x02; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) temp |= 0x01; - - if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) temp |= 0x10; - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x00,temp); - - PhaseIndex = 0x01; /* SiS_PALPhase */ - TimingPoint = SiS_Pr->SiS_PALTiming; - - newtvphase = false; - if( (SiS_Pr->SiS_VBType & VB_SIS30xBLV) && - ( (!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) || - (SiS_Pr->SiS_TVMode & TVSetTVSimuMode) ) ) { - newtvphase = true; - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - - TimingPoint = SiS_Pr->SiS_HiTVExtTiming; - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - TimingPoint = SiS_Pr->SiS_HiTVSt2Timing; - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) { - TimingPoint = SiS_Pr->SiS_HiTVSt1Timing; - } - } - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - - i = 0; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) i = 2; - else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) i = 1; - - TimingPoint = &SiS_YPbPrTable[i][0]; - - PhaseIndex = 0x00; /* SiS_NTSCPhase */ - - } else if(SiS_Pr->SiS_TVMode & TVSetPAL) { - - if(newtvphase) PhaseIndex = 0x09; /* SiS_PALPhase2 */ - - } else { - - TimingPoint = SiS_Pr->SiS_NTSCTiming; - PhaseIndex = (SiS_Pr->SiS_TVMode & TVSetNTSCJ) ? 0x01 : 0x00; /* SiS_PALPhase : SiS_NTSCPhase */ - if(newtvphase) PhaseIndex += 8; /* SiS_PALPhase2 : SiS_NTSCPhase2 */ - - } - - if(SiS_Pr->SiS_TVMode & (TVSetPALM | TVSetPALN)) { - PhaseIndex = (SiS_Pr->SiS_TVMode & TVSetPALM) ? 0x02 : 0x03; /* SiS_PALMPhase : SiS_PALNPhase */ - if(newtvphase) PhaseIndex += 8; /* SiS_PALMPhase2 : SiS_PALNPhase2 */ - } - - if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) { - if(SiS_Pr->SiS_TVMode & TVSetPALM) { - PhaseIndex = 0x05; /* SiS_SpecialPhaseM */ - } else if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) { - PhaseIndex = 0x11; /* SiS_SpecialPhaseJ */ - } else { - PhaseIndex = 0x10; /* SiS_SpecialPhase */ - } - } - - for(i = 0x31, j = 0; i <= 0x34; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS_TVPhase[(PhaseIndex * 4) + j]); - } - - for(i = 0x01, j = 0; i <= 0x2D; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,TimingPoint[j]); - } - for(i = 0x39; i <= 0x45; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,TimingPoint[j]); - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(SiS_Pr->SiS_ModeType != ModeText) { - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x3A,0x1F); - } - } - - SiS_SetRegOR(SiS_Pr->SiS_Part2Port,0x0A,SiS_Pr->SiS_NewFlickerMode); - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x35,SiS_Pr->SiS_RY1COE); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x36,SiS_Pr->SiS_RY2COE); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x37,SiS_Pr->SiS_RY3COE); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x38,SiS_Pr->SiS_RY4COE); - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) tempax = 950; - else if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) tempax = 680; - else if(SiS_Pr->SiS_TVMode & TVSetPAL) tempax = 520; - else tempax = 440; /* NTSC, YPbPr 525 */ - - if( ((SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) && (SiS_Pr->SiS_VDE <= tempax)) || - ( (SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoHiVision) && - ((SiS_Pr->SiS_VGAHDE == 1024) || (SiS_Pr->SiS_VDE <= tempax)) ) ) { - - tempax -= SiS_Pr->SiS_VDE; - tempax >>= 1; - if(!(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p))) { - tempax >>= 1; - } - tempax &= 0x00ff; - - temp = tempax + (unsigned short)TimingPoint[0]; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,temp); - - temp = tempax + (unsigned short)TimingPoint[1]; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,temp); - - if((SiS_Pr->SiS_VBInfo & SetCRT2ToTVNoYPbPrHiVision) && (SiS_Pr->SiS_VGAHDE >= 1024)) { - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x1b); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x54); - } else { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,0x17); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,0x1d); - } - } - - } - - tempcx = SiS_Pr->SiS_HT; - if(SiS_IsDualLink(SiS_Pr)) tempcx >>= 1; - tempcx--; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) tempcx--; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1B,tempcx); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1D,0xF0,((tempcx >> 8) & 0x0f)); - - tempcx = SiS_Pr->SiS_HT >> 1; - if(SiS_IsDualLink(SiS_Pr)) tempcx >>= 1; - tempcx += 7; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) tempcx -= 4; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x22,0x0F,((tempcx << 4) & 0xf0)); - - tempbx = TimingPoint[j] | (TimingPoint[j+1] << 8); - tempbx += tempcx; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x24,tempbx); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0x0F,((tempbx >> 4) & 0xf0)); - - tempbx += 8; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - tempbx -= 4; - tempcx = tempbx; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x29,0x0F,((tempbx << 4) & 0xf0)); - - j += 2; - tempcx += (TimingPoint[j] | (TimingPoint[j+1] << 8)); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x27,tempcx); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x28,0x0F,((tempcx >> 4) & 0xf0)); - - tempcx += 8; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) tempcx -= 4; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2A,0x0F,((tempcx << 4) & 0xf0)); - - tempcx = SiS_Pr->SiS_HT >> 1; - if(SiS_IsDualLink(SiS_Pr)) tempcx >>= 1; - j += 2; - tempcx -= (TimingPoint[j] | ((TimingPoint[j+1]) << 8)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2D,0x0F,((tempcx << 4) & 0xf0)); - - tempcx -= 11; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) { - tempcx = SiS_GetVGAHT2(SiS_Pr) - 1; - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2E,tempcx); - - tempbx = SiS_Pr->SiS_VDE; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(SiS_Pr->SiS_VGAVDE == 360) tempbx = 746; - if(SiS_Pr->SiS_VGAVDE == 375) tempbx = 746; - if(SiS_Pr->SiS_VGAVDE == 405) tempbx = 853; - } else if( (SiS_Pr->SiS_VBInfo & SetCRT2ToTV) && - (!(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p|TVSetYPbPr750p))) ) { - tempbx >>= 1; - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) { - if((ModeNo <= 0x13) && (crt2crtc == 1)) tempbx++; - } else if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - if(SiS_Pr->SiS_ModeType <= ModeVGA) { - if(crt2crtc == 4) tempbx++; - } - } - } - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - if((ModeNo == 0x2f) || (ModeNo == 0x5d) || (ModeNo == 0x5e)) tempbx++; - } - if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) { - if(ModeNo == 0x03) tempbx++; /* From 1.10.7w - doesn't make sense */ - } - } - } - tempbx -= 2; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2F,tempbx); - - temp = (tempcx >> 8) & 0x0F; - temp |= ((tempbx >> 2) & 0xC0); - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToSVIDEO | SetCRT2ToAVIDEO)) { - temp |= 0x10; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToAVIDEO) temp |= 0x20; - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x30,temp); - - if(SiS_Pr->SiS_VBType & VB_SISPART4OVERFLOW) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x10,0xdf,((tempbx & 0x0400) >> 5)); - } - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - tempbx = SiS_Pr->SiS_VDE; - if( (SiS_Pr->SiS_VBInfo & SetCRT2ToTV) && - (!(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p))) ) { - tempbx >>= 1; - } - tempbx -= 3; - temp = ((tempbx >> 3) & 0x60) | 0x18; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x46,temp); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x47,tempbx); - - if(SiS_Pr->SiS_VBType & VB_SISPART4OVERFLOW) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x10,0xbf,((tempbx & 0x0400) >> 4)); - } - } - - tempbx = 0; - if(!(modeflag & HalfDCLK)) { - if(SiS_Pr->SiS_VGAHDE >= SiS_Pr->SiS_HDE) { - tempax = 0; - tempbx |= 0x20; - } - } - - tempch = tempcl = 0x01; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(SiS_Pr->SiS_VGAHDE >= 960) { - if((!(modeflag & HalfDCLK)) || (SiS_Pr->ChipType < SIS_315H)) { - tempcl = 0x20; - if(SiS_Pr->SiS_VGAHDE >= 1280) { - tempch = 20; - tempbx &= ~0x20; - } else if(SiS_Pr->SiS_VGAHDE >= 1024) { - tempch = 25; - } else { - tempch = 25; /* OK */ - } - } - } - } - - if(!(tempbx & 0x20)) { - if(modeflag & HalfDCLK) tempcl <<= 1; - longtemp = ((SiS_Pr->SiS_VGAHDE * tempch) / tempcl) << 13; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) longtemp <<= 3; - tempax = longtemp / SiS_Pr->SiS_HDE; - if(longtemp % SiS_Pr->SiS_HDE) tempax++; - tempbx |= ((tempax >> 8) & 0x1F); - tempcx = tempax >> 13; - } - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x44,tempax); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x45,0xC0,tempbx); - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - - tempcx &= 0x07; - if(tempbx & 0x20) tempcx = 0; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x46,0xF8,tempcx); - - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - tempbx = 0x0382; - tempcx = 0x007e; - } else { - tempbx = 0x0369; - tempcx = 0x0061; - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x4B,tempbx); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x4C,tempcx); - temp = (tempcx & 0x0300) >> 6; - temp |= ((tempbx >> 8) & 0x03); - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - temp |= 0x10; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) temp |= 0x20; - else if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) temp |= 0x40; - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x4D,temp); - - temp = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x43); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x43,(temp - 3)); - - SiS_SetTVSpecial(SiS_Pr, ModeNo); - - if(SiS_Pr->SiS_VBType & VB_SIS30xCLV) { - temp = 0; - if(SiS_Pr->SiS_TVMode & TVSetPALM) temp = 8; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x4e,0xf7,temp); - } - - } - - if(SiS_Pr->SiS_TVMode & TVSetPALM) { - if(!(SiS_Pr->SiS_TVMode & TVSetNTSC1024)) { - temp = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x01); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,(temp - 1)); - } - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x00,0xEF); - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x0B,0x00); - } - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) return; - - /* From here: Part2 LCD setup */ - - tempbx = SiS_Pr->SiS_HDE; - if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1; - tempbx--; /* RHACTE = HDE - 1 */ - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x2C,tempbx); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2B,0x0F,((tempbx >> 4) & 0xf0)); - - temp = 0x01; - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) { - if(SiS_Pr->SiS_ModeType == ModeEGA) { - if(SiS_Pr->SiS_VGAHDE >= 1024) { - temp = 0x02; - if(SiS_Pr->SiS_SetFlag & LCDVESATiming) { - temp = 0x01; - } - } - } - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x0B,temp); - - tempbx = SiS_Pr->SiS_VDE - 1; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x03,tempbx); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x0C,0xF8,((tempbx >> 8) & 0x07)); - - tempcx = SiS_Pr->SiS_VT - 1; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x19,tempcx); - temp = (tempcx >> 3) & 0xE0; - if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) { - /* Enable dithering; only do this for 32bpp mode */ - if(SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00) & 0x01) { - temp |= 0x10; - } - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1A,0x0f,temp); - - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x09,0xF0); - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x0A,0xF0); - - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x17,0xFB); - SiS_SetRegAND(SiS_Pr->SiS_Part2Port,0x18,0xDF); - -#ifdef CONFIG_FB_SIS_315 - if(SiS_GetCRT2Part2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex, - &CRT2Index, &resindex)) { - switch(CRT2Index) { - case 206: CRT2Part2Ptr = SiS310_CRT2Part2_Asus1024x768_3; break; - default: - case 200: CRT2Part2Ptr = SiS_Pr->SiS_CRT2Part2_1024x768_1; break; - } - - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x01,0x80,(CRT2Part2Ptr+resindex)->CR[0]); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x02,0x80,(CRT2Part2Ptr+resindex)->CR[1]); - for(i = 2, j = 0x04; j <= 0x06; i++, j++ ) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]); - } - for(j = 0x1c; j <= 0x1d; i++, j++ ) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]); - } - for(j = 0x1f; j <= 0x21; i++, j++ ) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,j,(CRT2Part2Ptr+resindex)->CR[i]); - } - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x23,(CRT2Part2Ptr+resindex)->CR[10]); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0x0f,(CRT2Part2Ptr+resindex)->CR[11]); - - SiS_SetGroup2_Tail(SiS_Pr, ModeNo); - - } else { -#endif - - /* Checked for 1024x768, 1280x1024, 1400x1050, 1600x1200 */ - /* Clevo dual-link 1024x768 */ - /* Compaq 1280x1024 has HT 1696 sometimes (calculation OK, if given HT is correct) */ - /* Acer: OK, but uses different setting for VESA timing at 640/800/1024 and 640x400 */ - - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - if((SiS_Pr->SiS_LCDInfo & LCDPass11) || (SiS_Pr->PanelYRes == SiS_Pr->SiS_VDE)) { - tempbx = SiS_Pr->SiS_VDE - 1; - tempcx = SiS_Pr->SiS_VT - 1; - } else { - tempbx = SiS_Pr->SiS_VDE + ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VDE) / 2); - tempcx = SiS_Pr->SiS_VT - ((SiS_Pr->PanelYRes - SiS_Pr->SiS_VDE) / 2); - } - } else { - tempbx = SiS_Pr->PanelYRes; - tempcx = SiS_Pr->SiS_VT; - tempax = 1; - if(SiS_Pr->PanelYRes != SiS_Pr->SiS_VDE) { - tempax = SiS_Pr->PanelYRes; - /* if(SiS_Pr->SiS_VGAVDE == 525) tempax += 0x3c; */ /* 651+301C */ - if(SiS_Pr->PanelYRes < SiS_Pr->SiS_VDE) { - tempax = tempcx = 0; - } else { - tempax -= SiS_Pr->SiS_VDE; - } - tempax >>= 1; - } - tempcx -= tempax; /* lcdvdes */ - tempbx -= tempax; /* lcdvdee */ - } - - /* Non-expanding: lcdvdes = tempcx = VT-1; lcdvdee = tempbx = VDE-1 */ - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x05,tempcx); /* lcdvdes */ - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x06,tempbx); /* lcdvdee */ - - temp = (tempbx >> 5) & 0x38; - temp |= ((tempcx >> 8) & 0x07); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x02,temp); - - tempax = SiS_Pr->SiS_VDE; - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) { - tempax = SiS_Pr->PanelYRes; - } - tempcx = (SiS_Pr->SiS_VT - tempax) >> 4; - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) { - if(SiS_Pr->PanelYRes != SiS_Pr->SiS_VDE) { - tempcx = (SiS_Pr->SiS_VT - tempax) / 10; - } - } - - tempbx = ((SiS_Pr->SiS_VT + SiS_Pr->SiS_VDE) >> 1) - 1; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - if(SiS_Pr->PanelYRes != SiS_Pr->SiS_VDE) { - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { /* ? */ - tempax = SiS_Pr->SiS_VT - SiS_Pr->PanelYRes; - if(tempax % 4) { tempax >>= 2; tempax++; } - else { tempax >>= 2; } - tempbx -= (tempax - 1); - } else { - tempbx -= 10; - if(tempbx <= SiS_Pr->SiS_VDE) tempbx = SiS_Pr->SiS_VDE + 1; - } - } - } - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - tempbx++; - if((!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) || (crt2crtc == 6)) { - if(SiS_Pr->SiS_SetFlag & LCDVESATiming) { - tempbx = 770; - tempcx = 3; - } - } - } - - /* non-expanding: lcdvrs = ((VT + VDE) / 2) - 10 */ - - if(SiS_Pr->UseCustomMode) { - tempbx = SiS_Pr->CVSyncStart; - } - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,tempbx); /* lcdvrs */ - - temp = (tempbx >> 4) & 0xF0; - tempbx += (tempcx + 1); - temp |= (tempbx & 0x0F); - - if(SiS_Pr->UseCustomMode) { - temp &= 0xf0; - temp |= (SiS_Pr->CVSyncEnd & 0x0f); - } - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x01,temp); - -#ifdef CONFIG_FB_SIS_300 - SiS_Group2LCDSpecial(SiS_Pr, ModeNo, crt2crtc); -#endif - - bridgeoffset = 7; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) bridgeoffset += 2; - if(SiS_Pr->SiS_VBType & VB_SIS30xCLV) bridgeoffset += 2; /* OK for Averatec 1280x800 (301C) */ - if(SiS_IsDualLink(SiS_Pr)) bridgeoffset++; - else if(SiS_Pr->SiS_VBType & VB_SIS302LV) bridgeoffset++; /* OK for Asus A4L 1280x800 */ - /* Higher bridgeoffset shifts to the LEFT */ - - temp = 0; - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) { - if(SiS_Pr->PanelXRes != SiS_Pr->SiS_HDE) { - temp = SiS_Pr->SiS_HT - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_HDE) / 2); - if(SiS_IsDualLink(SiS_Pr)) temp >>= 1; - } - } - temp += bridgeoffset; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1F,temp); /* lcdhdes */ - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x20,0x0F,((temp >> 4) & 0xf0)); - - tempcx = SiS_Pr->SiS_HT; - tempax = tempbx = SiS_Pr->SiS_HDE; - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) { - if(SiS_Pr->PanelXRes != SiS_Pr->SiS_HDE) { - tempax = SiS_Pr->PanelXRes; - tempbx = SiS_Pr->PanelXRes - ((SiS_Pr->PanelXRes - SiS_Pr->SiS_HDE) / 2); - } - } - if(SiS_IsDualLink(SiS_Pr)) { - tempcx >>= 1; - tempbx >>= 1; - tempax >>= 1; - } - - tempbx += bridgeoffset; - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x23,tempbx); /* lcdhdee */ - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x25,0xF0,((tempbx >> 8) & 0x0f)); - - tempcx = (tempcx - tempax) >> 2; - - tempbx += tempcx; - push2 = tempbx; - - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) { - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) { - if(SiS_Pr->SiS_LCDInfo & LCDPass11) { - if(SiS_Pr->SiS_HDE == 1280) tempbx = (tempbx & 0xff00) | 0x47; - } - } - } - - if(SiS_Pr->UseCustomMode) { - tempbx = SiS_Pr->CHSyncStart; - if(modeflag & HalfDCLK) tempbx <<= 1; - if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1; - tempbx += bridgeoffset; - } - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1C,tempbx); /* lcdhrs */ - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1D,0x0F,((tempbx >> 4) & 0xf0)); - - tempbx = push2; - - tempcx <<= 1; - if((SiS_Pr->SiS_LCDInfo & DontExpandLCD) && (!(SiS_Pr->SiS_LCDInfo & LCDPass11))) { - if(SiS_Pr->PanelXRes != SiS_Pr->SiS_HDE) tempcx >>= 2; - } - tempbx += tempcx; - - if(SiS_Pr->UseCustomMode) { - tempbx = SiS_Pr->CHSyncEnd; - if(modeflag & HalfDCLK) tempbx <<= 1; - if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1; - tempbx += bridgeoffset; - } - - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x21,tempbx); /* lcdhre */ - - SiS_SetGroup2_Tail(SiS_Pr, ModeNo); - -#ifdef CONFIG_FB_SIS_300 - SiS_Set300Part2Regs(SiS_Pr, ModeIdIndex, RefreshRateTableIndex, ModeNo); -#endif -#ifdef CONFIG_FB_SIS_315 - } /* CRT2-LCD from table */ -#endif -} - -/*********************************************/ -/* SET PART 3 REGISTER GROUP */ -/*********************************************/ - -static void -SiS_SetGroup3(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned short i; - const unsigned char *tempdi; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) return; - -#ifndef SIS_CP - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x00,0x00); -#else - SIS_CP_INIT301_CP -#endif - - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x13,0xFA); - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x14,0xC8); - } else { - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x13,0xF5); - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x14,0xB7); - } - - if(SiS_Pr->SiS_TVMode & TVSetPALM) { - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x13,0xFA); - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x14,0xC8); - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x3D,0xA8); - } - - tempdi = NULL; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - tempdi = SiS_Pr->SiS_HiTVGroup3Data; - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) { - tempdi = SiS_Pr->SiS_HiTVGroup3Simu; - } - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) { - if(!(SiS_Pr->SiS_TVMode & TVSetYPbPr525i)) { - tempdi = SiS_HiTVGroup3_1; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) tempdi = SiS_HiTVGroup3_2; - } - } - if(tempdi) { - for(i=0; i<=0x3E; i++) { - SiS_SetReg(SiS_Pr->SiS_Part3Port,i,tempdi[i]); - } - if(SiS_Pr->SiS_VBType & VB_SIS30xCLV) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) { - SiS_SetReg(SiS_Pr->SiS_Part3Port,0x28,0x3f); - } - } - } - -#ifdef SIS_CP - SIS_CP_INIT301_CP2 -#endif -} - -/*********************************************/ -/* SET PART 4 REGISTER GROUP */ -/*********************************************/ - -#ifdef CONFIG_FB_SIS_315 -#if 0 -static void -SiS_ShiftXPos(struct SiS_Private *SiS_Pr, int shift) -{ - unsigned short temp, temp1, temp2; - - temp1 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x1f); - temp2 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x20); - temp = (unsigned short)((int)((temp1 | ((temp2 & 0xf0) << 4))) + shift); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x1f,temp); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x20,0x0f,((temp >> 4) & 0xf0)); - temp = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x2b) & 0x0f; - temp = (unsigned short)((int)(temp) + shift); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x2b,0xf0,(temp & 0x0f)); - temp1 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x43); - temp2 = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x42); - temp = (unsigned short)((int)((temp1 | ((temp2 & 0xf0) << 4))) + shift); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x43,temp); - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x42,0x0f,((temp >> 4) & 0xf0)); -} -#endif - -static void -SiS_SetGroup4_C_ELV(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned short temp, temp1, resinfo = 0; - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - - if(!(SiS_Pr->SiS_VBType & VB_SIS30xCLV)) return; - if(!(SiS_Pr->SiS_VBInfo & (SetCRT2ToHiVision | SetCRT2ToYPbPr525750))) return; - - if(SiS_Pr->ChipType >= XGI_20) return; - - if((SiS_Pr->ChipType >= SIS_661) && (SiS_Pr->SiS_ROMNew)) { - if(!(ROMAddr[0x61] & 0x04)) return; - } - - if(ModeNo > 0x13) { - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - } - - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x3a,0x08); - temp = SiS_GetReg(SiS_Pr->SiS_Part4Port,0x3a); - if(!(temp & 0x01)) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x3a,0xdf); - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x25,0xfc); - if((SiS_Pr->ChipType < SIS_661) && (!(SiS_Pr->SiS_ROMNew))) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x25,0xf8); - } - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x0f,0xfb); - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) temp = 0x0000; - else if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) temp = 0x0002; - else if(SiS_Pr->SiS_TVMode & TVSetHiVision) temp = 0x0400; - else temp = 0x0402; - if((SiS_Pr->ChipType >= SIS_661) || (SiS_Pr->SiS_ROMNew)) { - temp1 = 0; - if(SiS_Pr->SiS_TVMode & TVAspect43) temp1 = 4; - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0f,0xfb,temp1); - if(SiS_Pr->SiS_TVMode & TVAspect43LB) temp |= 0x01; - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x26,0x7c,(temp & 0xff)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x3a,0xfb,(temp >> 8)); - if(ModeNo > 0x13) { - SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x39,0xfd); - } - } else { - temp1 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x3b) & 0x03; - if(temp1 == 0x01) temp |= 0x01; - if(temp1 == 0x03) temp |= 0x04; /* ? why not 0x10? */ - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x26,0xf8,(temp & 0xff)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x3a,0xfb,(temp >> 8)); - if(ModeNo > 0x13) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x3b,0xfd); - } - } - -#if 0 - if(SiS_Pr->ChipType >= SIS_661) { /* ? */ - if(SiS_Pr->SiS_TVMode & TVAspect43) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) { - if(resinfo == SIS_RI_1024x768) { - SiS_ShiftXPos(SiS_Pr, 97); - } else { - SiS_ShiftXPos(SiS_Pr, 111); - } - } else if(SiS_Pr->SiS_TVMode & TVSetHiVision) { - SiS_ShiftXPos(SiS_Pr, 136); - } - } - } -#endif - - } - -} -#endif - -static void -SiS_SetCRT2VCLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short vclkindex, temp, reg1, reg2; - - if(SiS_Pr->UseCustomMode) { - reg1 = SiS_Pr->CSR2B; - reg2 = SiS_Pr->CSR2C; - } else { - vclkindex = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - reg1 = SiS_Pr->SiS_VBVCLKData[vclkindex].Part4_A; - reg2 = SiS_Pr->SiS_VBVCLKData[vclkindex].Part4_B; - } - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - if(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSet525p1024)) { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,0x57); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0b,0x46); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1f,0xf6); - } else { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,reg1); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0b,reg2); - } - } else { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,0x01); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0b,reg2); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x0a,reg1); - } - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x12,0x00); - temp = 0x08; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) temp |= 0x20; - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x12,temp); -} - -static void -SiS_SetDualLinkEtc(struct SiS_Private *SiS_Pr) -{ - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_VBType & VB_SISDUALLINK) { - if((SiS_CRT2IsLCD(SiS_Pr)) || - (SiS_IsVAMode(SiS_Pr))) { - if(SiS_Pr->SiS_LCDInfo & LCDDualLink) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x27,0x2c); - } else { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x27,~0x20); - } - } - } - } - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2a,0x00); -#ifdef SET_EMI - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c); -#endif - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x34,0x10); - } -} - -static void -SiS_SetGroup4(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short tempax, tempcx, tempbx, modeflag, temp, resinfo; - unsigned int tempebx, tempeax, templong; - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo; - } else if(SiS_Pr->UseCustomMode) { - modeflag = SiS_Pr->CModeFlag; - resinfo = 0; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - } - - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x24,0x0e); - } - } - } - - if(SiS_Pr->SiS_VBType & (VB_SIS30xCLV | VB_SIS302LV)) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x10,0x9f); - } - } - - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - SiS_SetDualLinkEtc(SiS_Pr); - return; - } - } - - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x13,SiS_Pr->SiS_RVBHCFACT); - - tempbx = SiS_Pr->SiS_RVBHCMAX; - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x14,tempbx); - - temp = (tempbx >> 1) & 0x80; - - tempcx = SiS_Pr->SiS_VGAHT - 1; - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x16,tempcx); - - temp |= ((tempcx >> 5) & 0x78); - - tempcx = SiS_Pr->SiS_VGAVT - 1; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) tempcx -= 5; - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x17,tempcx); - - temp |= ((tempcx >> 8) & 0x07); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x15,temp); - - tempbx = SiS_Pr->SiS_VGAHDE; - if(modeflag & HalfDCLK) tempbx >>= 1; - if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - temp = 0; - if(tempbx > 800) temp = 0x60; - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - temp = 0; - if(tempbx > 1024) temp = 0xC0; - else if(tempbx >= 960) temp = 0xA0; - } else if(SiS_Pr->SiS_TVMode & (TVSetYPbPr525p | TVSetYPbPr750p)) { - temp = 0; - if(tempbx >= 1280) temp = 0x40; - else if(tempbx >= 1024) temp = 0x20; - } else { - temp = 0x80; - if(tempbx >= 1024) temp = 0xA0; - } - - temp |= SiS_Pr->Init_P4_0E; - - if(SiS_Pr->SiS_VBType & VB_SIS301) { - if(SiS_Pr->SiS_LCDResInfo != Panel_1280x1024) { - temp &= 0xf0; - temp |= 0x0A; - } - } - - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0E,0x10,temp); - - tempeax = SiS_Pr->SiS_VGAVDE; - tempebx = SiS_Pr->SiS_VDE; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - if(!(temp & 0xE0)) tempebx >>=1; - } - - tempcx = SiS_Pr->SiS_RVBHRS; - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x18,tempcx); - tempcx >>= 8; - tempcx |= 0x40; - - if(tempeax <= tempebx) { - tempcx ^= 0x40; - } else { - tempeax -= tempebx; - } - - tempeax *= (256 * 1024); - templong = tempeax % tempebx; - tempeax /= tempebx; - if(templong) tempeax++; - - temp = (unsigned short)(tempeax & 0x000000FF); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1B,temp); - temp = (unsigned short)((tempeax & 0x0000FF00) >> 8); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1A,temp); - temp = (unsigned short)((tempeax >> 12) & 0x70); /* sic! */ - temp |= (tempcx & 0x4F); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x19,temp); - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1C,0x28); - - /* Calc Linebuffer max address and set/clear decimode */ - tempbx = 0; - if(SiS_Pr->SiS_TVMode & (TVSetHiVision | TVSetYPbPr750p)) tempbx = 0x08; - tempax = SiS_Pr->SiS_VGAHDE; - if(modeflag & HalfDCLK) tempax >>= 1; - if(SiS_IsDualLink(SiS_Pr)) tempax >>= 1; - if(tempax > 800) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - tempax -= 800; - } else { - tempbx = 0x08; - if(tempax == 960) tempax *= 25; /* Correct */ - else if(tempax == 1024) tempax *= 25; - else tempax *= 20; - temp = tempax % 32; - tempax /= 32; - if(temp) tempax++; - tempax++; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(resinfo == SIS_RI_1024x768 || - resinfo == SIS_RI_1024x576 || - resinfo == SIS_RI_1280x1024 || - resinfo == SIS_RI_1280x720) { - /* Otherwise white line or garbage at right edge */ - tempax = (tempax & 0xff00) | 0x20; - } - } - } - } - tempax--; - temp = ((tempax >> 4) & 0x30) | tempbx; - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1D,tempax); - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x1E,temp); - - temp = 0x0036; tempbx = 0xD0; - if((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_VBType & VB_SISLVDS)) { - temp = 0x0026; tempbx = 0xC0; /* See En/DisableBridge() */ - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - if(!(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSetHiVision | TVSetYPbPr750p | TVSetYPbPr525p))) { - temp |= 0x01; - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - if(!(SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) { - temp &= ~0x01; - } - } - } - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x1F,tempbx,temp); - - tempbx = SiS_Pr->SiS_HT >> 1; - if(SiS_IsDualLink(SiS_Pr)) tempbx >>= 1; - tempbx -= 2; - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x22,tempbx); - temp = (tempbx >> 5) & 0x38; - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x21,0xC0,temp); - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x24,0x0e); - /* LCD-too-dark-error-source, see FinalizeLCD() */ - } - } - - SiS_SetDualLinkEtc(SiS_Pr); - - } /* 301B */ - - SiS_SetCRT2VCLK(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); -} - -/*********************************************/ -/* SET PART 5 REGISTER GROUP */ -/*********************************************/ - -static void -SiS_SetGroup5(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) return; - - if(SiS_Pr->SiS_ModeType == ModeVGA) { - if(!(SiS_Pr->SiS_VBInfo & (SetInSlaveMode | LoadDACFlag))) { - SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1E,0x20); - SiS_LoadDAC(SiS_Pr, ModeNo, ModeIdIndex); - } - } -} - -/*********************************************/ -/* MODIFY CRT1 GROUP FOR SLAVE MODE */ -/*********************************************/ - -static bool -SiS_GetLVDSCRT1Ptr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex, unsigned short *ResIndex, - unsigned short *DisplayType) - { - unsigned short modeflag = 0; - bool checkhd = true; - - /* Pass 1:1 not supported here */ - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - (*ResIndex) = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - (*ResIndex) = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - } - - (*ResIndex) &= 0x3F; - - if((SiS_Pr->SiS_IF_DEF_CH70xx) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) { - - (*DisplayType) = 80; - if((SiS_Pr->SiS_TVMode & TVSetPAL) && (!(SiS_Pr->SiS_TVMode & TVSetPALM))) { - (*DisplayType) = 82; - if(SiS_Pr->SiS_ModeType > ModeVGA) { - if(SiS_Pr->SiS_CHSOverScan) (*DisplayType) = 84; - } - } - if((*DisplayType) != 84) { - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) (*DisplayType)++; - } - - } else { - - (*DisplayType = 0); - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_320x240_1: (*DisplayType) = 50; - checkhd = false; - break; - case Panel_320x240_2: (*DisplayType) = 14; - break; - case Panel_320x240_3: (*DisplayType) = 18; - break; - case Panel_640x480: (*DisplayType) = 10; - break; - case Panel_1024x600: (*DisplayType) = 26; - break; - default: return true; - } - - if(checkhd) { - if(modeflag & HalfDCLK) (*DisplayType)++; - } - - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x600) { - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) (*DisplayType) += 2; - } - - } - - return true; -} - -static void -SiS_ModCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short tempah, i, modeflag, j, ResIndex, DisplayType; - const struct SiS_LVDSCRT1Data *LVDSCRT1Ptr=NULL; - static const unsigned short CRIdx[] = { - 0x00, 0x02, 0x03, 0x04, 0x05, 0x06, - 0x07, 0x10, 0x11, 0x15, 0x16 - }; - - if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) || - (SiS_Pr->SiS_CustomT == CUT_BARCO1024) || - (SiS_Pr->SiS_CustomT == CUT_PANEL848) || - (SiS_Pr->SiS_CustomT == CUT_PANEL856) ) - return; - - if(SiS_Pr->SiS_IF_DEF_LVDS) { - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) return; - } - } else if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) return; - } else return; - - if(SiS_Pr->SiS_LCDInfo & LCDPass11) return; - - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_SetFlag & SetDOSMode) return; - } - - if(!(SiS_GetLVDSCRT1Ptr(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex, - &ResIndex, &DisplayType))) { - return; - } - - switch(DisplayType) { - case 50: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_1; break; /* xSTN */ - case 14: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_2; break; /* xSTN */ - case 15: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_2_H; break; /* xSTN */ - case 18: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_3; break; /* xSTN */ - case 19: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1320x240_3_H; break; /* xSTN */ - case 10: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1640x480_1; break; - case 11: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT1640x480_1_H; break; -#if 0 /* Works better with calculated numbers */ - case 26: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_1; break; - case 27: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_1_H; break; - case 28: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_2; break; - case 29: LVDSCRT1Ptr = SiS_Pr->SiS_LVDSCRT11024x600_2_H; break; -#endif - case 80: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1UNTSC; break; - case 81: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1ONTSC; break; - case 82: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1UPAL; break; - case 83: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1OPAL; break; - case 84: LVDSCRT1Ptr = SiS_Pr->SiS_CHTVCRT1SOPAL; break; - } - - if(LVDSCRT1Ptr) { - - SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f); - - for(i = 0; i <= 10; i++) { - tempah = (LVDSCRT1Ptr + ResIndex)->CR[i]; - SiS_SetReg(SiS_Pr->SiS_P3d4,CRIdx[i],tempah); - } - - for(i = 0x0A, j = 11; i <= 0x0C; i++, j++) { - tempah = (LVDSCRT1Ptr + ResIndex)->CR[j]; - SiS_SetReg(SiS_Pr->SiS_P3c4,i,tempah); - } - - tempah = (LVDSCRT1Ptr + ResIndex)->CR[14] & 0xE0; - SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0x1f,tempah); - - if(ModeNo <= 0x13) modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - else modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - - tempah = ((LVDSCRT1Ptr + ResIndex)->CR[14] & 0x01) << 5; - if(modeflag & DoubleScanMode) tempah |= 0x80; - SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,~0x020,tempah); - - } else { - - SiS_CalcLCDACRT1Timing(SiS_Pr, ModeNo, ModeIdIndex); - - } -} - -/*********************************************/ -/* SET CRT2 ECLK */ -/*********************************************/ - -static void -SiS_SetCRT2ECLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short clkbase, vclkindex = 0; - unsigned char sr2b, sr2c; - - if(SiS_Pr->SiS_LCDInfo & LCDPass11) { - SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2); - if(SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK == 2) { - RefreshRateTableIndex--; - } - vclkindex = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, - RefreshRateTableIndex); - SiS_Pr->SiS_SetFlag |= ProgrammingCRT2; - } else { - vclkindex = SiS_GetVCLK2Ptr(SiS_Pr, ModeNo, ModeIdIndex, - RefreshRateTableIndex); - } - - sr2b = SiS_Pr->SiS_VCLKData[vclkindex].SR2B; - sr2c = SiS_Pr->SiS_VCLKData[vclkindex].SR2C; - - if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) || (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) { - if(SiS_Pr->SiS_UseROM) { - if(ROMAddr[0x220] & 0x01) { - sr2b = ROMAddr[0x227]; - sr2c = ROMAddr[0x228]; - } - } - } - - clkbase = 0x02B; - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) { - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) { - clkbase += 3; - } - } - - SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x20); - SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase,sr2b); - SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase+1,sr2c); - SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x10); - SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase,sr2b); - SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase+1,sr2c); - SiS_SetReg(SiS_Pr->SiS_P3c4,0x31,0x00); - SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase,sr2b); - SiS_SetReg(SiS_Pr->SiS_P3c4,clkbase+1,sr2c); -} - -/*********************************************/ -/* SET UP CHRONTEL CHIPS */ -/*********************************************/ - -static void -SiS_SetCHTVReg(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefreshRateTableIndex) -{ - unsigned short TVType, resindex; - const struct SiS_CHTVRegData *CHTVRegData = NULL; - - if(ModeNo <= 0x13) - resindex = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - else - resindex = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC; - - resindex &= 0x3F; - - TVType = 0; - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) TVType += 1; - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - TVType += 2; - if(SiS_Pr->SiS_ModeType > ModeVGA) { - if(SiS_Pr->SiS_CHSOverScan) TVType = 8; - } - if(SiS_Pr->SiS_TVMode & TVSetPALM) { - TVType = 4; - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) TVType += 1; - } else if(SiS_Pr->SiS_TVMode & TVSetPALN) { - TVType = 6; - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) TVType += 1; - } - } - - switch(TVType) { - case 0: CHTVRegData = SiS_Pr->SiS_CHTVReg_UNTSC; break; - case 1: CHTVRegData = SiS_Pr->SiS_CHTVReg_ONTSC; break; - case 2: CHTVRegData = SiS_Pr->SiS_CHTVReg_UPAL; break; - case 3: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPAL; break; - case 4: CHTVRegData = SiS_Pr->SiS_CHTVReg_UPALM; break; - case 5: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPALM; break; - case 6: CHTVRegData = SiS_Pr->SiS_CHTVReg_UPALN; break; - case 7: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPALN; break; - case 8: CHTVRegData = SiS_Pr->SiS_CHTVReg_SOPAL; break; - default: CHTVRegData = SiS_Pr->SiS_CHTVReg_OPAL; break; - } - - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) { - -#ifdef CONFIG_FB_SIS_300 - - /* Chrontel 7005 - I assume that it does not come with a 315 series chip */ - - /* We don't support modes >800x600 */ - if (resindex > 5) return; - - if(SiS_Pr->SiS_TVMode & TVSetPAL) { - SiS_SetCH700x(SiS_Pr,0x04,0x43); /* 0x40=76uA (PAL); 0x03=15bit non-multi RGB*/ - SiS_SetCH700x(SiS_Pr,0x09,0x69); /* Black level for PAL (105)*/ - } else { - SiS_SetCH700x(SiS_Pr,0x04,0x03); /* upper nibble=71uA (NTSC), 0x03=15bit non-multi RGB*/ - SiS_SetCH700x(SiS_Pr,0x09,0x71); /* Black level for NTSC (113)*/ - } - - SiS_SetCH700x(SiS_Pr,0x00,CHTVRegData[resindex].Reg[0]); /* Mode register */ - SiS_SetCH700x(SiS_Pr,0x07,CHTVRegData[resindex].Reg[1]); /* Start active video register */ - SiS_SetCH700x(SiS_Pr,0x08,CHTVRegData[resindex].Reg[2]); /* Position overflow register */ - SiS_SetCH700x(SiS_Pr,0x0a,CHTVRegData[resindex].Reg[3]); /* Horiz Position register */ - SiS_SetCH700x(SiS_Pr,0x0b,CHTVRegData[resindex].Reg[4]); /* Vertical Position register */ - - /* Set minimum flicker filter for Luma channel (SR1-0=00), - minimum text enhancement (S3-2=10), - maximum flicker filter for Chroma channel (S5-4=10) - =00101000=0x28 (When reading, S1-0->S3-2, and S3-2->S1-0!) - */ - SiS_SetCH700x(SiS_Pr,0x01,0x28); - - /* Set video bandwidth - High bandwidth Luma composite video filter(S0=1) - low bandwidth Luma S-video filter (S2-1=00) - disable peak filter in S-video channel (S3=0) - high bandwidth Chroma Filter (S5-4=11) - =00110001=0x31 - */ - SiS_SetCH700x(SiS_Pr,0x03,0xb1); /* old: 3103 */ - - /* Register 0x3D does not exist in non-macrovision register map - (Maybe this is a macrovision register?) - */ -#ifndef SIS_CP - SiS_SetCH70xx(SiS_Pr,0x3d,0x00); -#endif - - /* Register 0x10 only contains 1 writable bit (S0) for sensing, - all other bits a read-only. Macrovision? - */ - SiS_SetCH70xxANDOR(SiS_Pr,0x10,0x00,0x1F); - - /* Register 0x11 only contains 3 writable bits (S0-S2) for - contrast enhancement (set to 010 -> gain 1 Yout = 17/16*(Yin-30) ) - */ - SiS_SetCH70xxANDOR(SiS_Pr,0x11,0x02,0xF8); - - /* Clear DSEN - */ - SiS_SetCH70xxANDOR(SiS_Pr,0x1c,0x00,0xEF); - - if(!(SiS_Pr->SiS_TVMode & TVSetPAL)) { /* ---- NTSC ---- */ - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) { - if(resindex == 0x04) { /* 640x480 overscan: Mode 16 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF); /* loop filter off */ - SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE); /* ACIV on, no need to set FSCI */ - } else if(resindex == 0x05) { /* 800x600 overscan: Mode 23 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x18,0x01,0xF0); /* 0x18-0x1f: FSCI 469,762,048 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x19,0x0C,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1a,0x00,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1b,0x00,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1c,0x00,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1d,0x00,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1e,0x00,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1f,0x00,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x01,0xEF); /* Loop filter on for mode 23 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x00,0xFE); /* ACIV off, need to set FSCI */ - } - } else { - if(resindex == 0x04) { /* ----- 640x480 underscan; Mode 17 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF); /* loop filter off */ - SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE); - } else if(resindex == 0x05) { /* ----- 800x600 underscan: Mode 24 */ -#if 0 - SiS_SetCH70xxANDOR(SiS_Pr,0x18,0x01,0xF0); /* (FSCI was 0x1f1c71c7 - this is for mode 22) */ - SiS_SetCH70xxANDOR(SiS_Pr,0x19,0x09,0xF0); /* FSCI for mode 24 is 428,554,851 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x1a,0x08,0xF0); /* 198b3a63 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x1b,0x0b,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1c,0x04,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1d,0x01,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1e,0x06,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x1f,0x05,0xF0); - SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF); /* loop filter off for mode 24 */ - SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x00,0xFE); * ACIV off, need to set FSCI */ -#endif /* All alternatives wrong (datasheet wrong?), don't use FSCI */ - SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF); /* loop filter off */ - SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE); - } - } - } else { /* ---- PAL ---- */ - /* We don't play around with FSCI in PAL mode */ - if(resindex == 0x04) { - SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF); /* loop filter off */ - SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE); /* ACIV on */ - } else { - SiS_SetCH70xxANDOR(SiS_Pr,0x20,0x00,0xEF); /* loop filter off */ - SiS_SetCH70xxANDOR(SiS_Pr,0x21,0x01,0xFE); /* ACIV on */ - } - } - -#endif /* 300 */ - - } else { - - /* Chrontel 7019 - assumed that it does not come with a 300 series chip */ - -#ifdef CONFIG_FB_SIS_315 - - unsigned short temp; - - /* We don't support modes >1024x768 */ - if (resindex > 6) return; - - temp = CHTVRegData[resindex].Reg[0]; - if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) temp |= 0x10; - SiS_SetCH701x(SiS_Pr,0x00,temp); - - SiS_SetCH701x(SiS_Pr,0x01,CHTVRegData[resindex].Reg[1]); - SiS_SetCH701x(SiS_Pr,0x02,CHTVRegData[resindex].Reg[2]); - SiS_SetCH701x(SiS_Pr,0x04,CHTVRegData[resindex].Reg[3]); - SiS_SetCH701x(SiS_Pr,0x03,CHTVRegData[resindex].Reg[4]); - SiS_SetCH701x(SiS_Pr,0x05,CHTVRegData[resindex].Reg[5]); - SiS_SetCH701x(SiS_Pr,0x06,CHTVRegData[resindex].Reg[6]); - - temp = CHTVRegData[resindex].Reg[7]; - if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) temp = 0x66; - SiS_SetCH701x(SiS_Pr,0x07,temp); - - SiS_SetCH701x(SiS_Pr,0x08,CHTVRegData[resindex].Reg[8]); - SiS_SetCH701x(SiS_Pr,0x15,CHTVRegData[resindex].Reg[9]); - SiS_SetCH701x(SiS_Pr,0x1f,CHTVRegData[resindex].Reg[10]); - SiS_SetCH701x(SiS_Pr,0x0c,CHTVRegData[resindex].Reg[11]); - SiS_SetCH701x(SiS_Pr,0x0d,CHTVRegData[resindex].Reg[12]); - SiS_SetCH701x(SiS_Pr,0x0e,CHTVRegData[resindex].Reg[13]); - SiS_SetCH701x(SiS_Pr,0x0f,CHTVRegData[resindex].Reg[14]); - SiS_SetCH701x(SiS_Pr,0x10,CHTVRegData[resindex].Reg[15]); - - temp = SiS_GetCH701x(SiS_Pr,0x21) & ~0x02; - /* D1 should be set for PAL, PAL-N and NTSC-J, - but I won't do that for PAL unless somebody - tells me to do so. Since the BIOS uses - non-default CIV values and blacklevels, - this might be compensated anyway. - */ - if(SiS_Pr->SiS_TVMode & (TVSetPALN | TVSetNTSCJ)) temp |= 0x02; - SiS_SetCH701x(SiS_Pr,0x21,temp); - -#endif /* 315 */ - - } - -#ifdef SIS_CP - SIS_CP_INIT301_CP3 -#endif - -} - -#ifdef CONFIG_FB_SIS_315 /* ----------- 315 series only ---------- */ - -void -SiS_Chrontel701xBLOn(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - /* Enable Chrontel 7019 LCD panel backlight */ - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(SiS_Pr->ChipType == SIS_740) { - SiS_SetCH701x(SiS_Pr,0x66,0x65); - } else { - temp = SiS_GetCH701x(SiS_Pr,0x66); - temp |= 0x20; - SiS_SetCH701x(SiS_Pr,0x66,temp); - } - } -} - -void -SiS_Chrontel701xBLOff(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - /* Disable Chrontel 7019 LCD panel backlight */ - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - temp = SiS_GetCH701x(SiS_Pr,0x66); - temp &= 0xDF; - SiS_SetCH701x(SiS_Pr,0x66,temp); - } -} - -static void -SiS_ChrontelPowerSequencing(struct SiS_Private *SiS_Pr) -{ - static const unsigned char regtable[] = { 0x67, 0x68, 0x69, 0x6a, 0x6b }; - static const unsigned char table1024_740[] = { 0x01, 0x02, 0x01, 0x01, 0x01 }; - static const unsigned char table1400_740[] = { 0x01, 0x6e, 0x01, 0x01, 0x01 }; - static const unsigned char asus1024_740[] = { 0x19, 0x6e, 0x01, 0x19, 0x09 }; - static const unsigned char asus1400_740[] = { 0x19, 0x6e, 0x01, 0x19, 0x09 }; - static const unsigned char table1024_650[] = { 0x01, 0x02, 0x01, 0x01, 0x02 }; - static const unsigned char table1400_650[] = { 0x01, 0x02, 0x01, 0x01, 0x02 }; - const unsigned char *tableptr = NULL; - int i; - - /* Set up Power up/down timing */ - - if(SiS_Pr->ChipType == SIS_740) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(SiS_Pr->SiS_CustomT == CUT_ASUSL3000D) tableptr = asus1024_740; - else tableptr = table1024_740; - } else if((SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) || - (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) || - (SiS_Pr->SiS_LCDResInfo == Panel_1600x1200)) { - if(SiS_Pr->SiS_CustomT == CUT_ASUSL3000D) tableptr = asus1400_740; - else tableptr = table1400_740; - } else return; - } else { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - tableptr = table1024_650; - } else if((SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) || - (SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) || - (SiS_Pr->SiS_LCDResInfo == Panel_1600x1200)) { - tableptr = table1400_650; - } else return; - } - - for(i=0; i<5; i++) { - SiS_SetCH701x(SiS_Pr, regtable[i], tableptr[i]); - } -} - -static void -SiS_SetCH701xForLCD(struct SiS_Private *SiS_Pr) -{ - const unsigned char *tableptr = NULL; - unsigned short tempbh; - int i; - static const unsigned char regtable[] = { - 0x1c, 0x5f, 0x64, 0x6f, 0x70, 0x71, - 0x72, 0x73, 0x74, 0x76, 0x78, 0x7d, 0x66 - }; - static const unsigned char table1024_740[] = { - 0x60, 0x02, 0x00, 0x07, 0x40, 0xed, - 0xa3, 0xc8, 0xc7, 0xac, 0xe0, 0x02, 0x44 - }; - static const unsigned char table1280_740[] = { - 0x60, 0x03, 0x11, 0x00, 0x40, 0xe3, - 0xad, 0xdb, 0xf6, 0xac, 0xe0, 0x02, 0x44 - }; - static const unsigned char table1400_740[] = { - 0x60, 0x03, 0x11, 0x00, 0x40, 0xe3, - 0xad, 0xdb, 0xf6, 0xac, 0xe0, 0x02, 0x44 - }; - static const unsigned char table1600_740[] = { - 0x60, 0x04, 0x11, 0x00, 0x40, 0xe3, - 0xad, 0xde, 0xf6, 0xac, 0x60, 0x1a, 0x44 - }; - static const unsigned char table1024_650[] = { - 0x60, 0x02, 0x00, 0x07, 0x40, 0xed, - 0xa3, 0xc8, 0xc7, 0xac, 0x60, 0x02 - }; - static const unsigned char table1280_650[] = { - 0x60, 0x03, 0x11, 0x00, 0x40, 0xe3, - 0xad, 0xdb, 0xf6, 0xac, 0xe0, 0x02 - }; - static const unsigned char table1400_650[] = { - 0x60, 0x03, 0x11, 0x00, 0x40, 0xef, - 0xad, 0xdb, 0xf6, 0xac, 0x60, 0x02 - }; - static const unsigned char table1600_650[] = { - 0x60, 0x04, 0x11, 0x00, 0x40, 0xe3, - 0xad, 0xde, 0xf6, 0xac, 0x60, 0x1a - }; - - if(SiS_Pr->ChipType == SIS_740) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) tableptr = table1024_740; - else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) tableptr = table1280_740; - else if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) tableptr = table1400_740; - else if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) tableptr = table1600_740; - else return; - } else { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) tableptr = table1024_650; - else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) tableptr = table1280_650; - else if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) tableptr = table1400_650; - else if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) tableptr = table1600_650; - else return; - } - - tempbh = SiS_GetCH701x(SiS_Pr,0x74); - if((tempbh == 0xf6) || (tempbh == 0xc7)) { - tempbh = SiS_GetCH701x(SiS_Pr,0x73); - if(tempbh == 0xc8) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) return; - } else if(tempbh == 0xdb) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) return; - if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) return; - } else if(tempbh == 0xde) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) return; - } - } - - if(SiS_Pr->ChipType == SIS_740) tempbh = 0x0d; - else tempbh = 0x0c; - - for(i = 0; i < tempbh; i++) { - SiS_SetCH701x(SiS_Pr, regtable[i], tableptr[i]); - } - SiS_ChrontelPowerSequencing(SiS_Pr); - tempbh = SiS_GetCH701x(SiS_Pr,0x1e); - tempbh |= 0xc0; - SiS_SetCH701x(SiS_Pr,0x1e,tempbh); - - if(SiS_Pr->ChipType == SIS_740) { - tempbh = SiS_GetCH701x(SiS_Pr,0x1c); - tempbh &= 0xfb; - SiS_SetCH701x(SiS_Pr,0x1c,tempbh); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2d,0x03); - tempbh = SiS_GetCH701x(SiS_Pr,0x64); - tempbh |= 0x40; - SiS_SetCH701x(SiS_Pr,0x64,tempbh); - tempbh = SiS_GetCH701x(SiS_Pr,0x03); - tempbh &= 0x3f; - SiS_SetCH701x(SiS_Pr,0x03,tempbh); - } -} - -static void -SiS_ChrontelResetVSync(struct SiS_Private *SiS_Pr) -{ - unsigned char temp, temp1; - - temp1 = SiS_GetCH701x(SiS_Pr,0x49); - SiS_SetCH701x(SiS_Pr,0x49,0x3e); - temp = SiS_GetCH701x(SiS_Pr,0x47); - temp &= 0x7f; /* Use external VSYNC */ - SiS_SetCH701x(SiS_Pr,0x47,temp); - SiS_LongDelay(SiS_Pr, 3); - temp = SiS_GetCH701x(SiS_Pr,0x47); - temp |= 0x80; /* Use internal VSYNC */ - SiS_SetCH701x(SiS_Pr,0x47,temp); - SiS_SetCH701x(SiS_Pr,0x49,temp1); -} - -static void -SiS_Chrontel701xOn(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(SiS_Pr->ChipType == SIS_740) { - temp = SiS_GetCH701x(SiS_Pr,0x1c); - temp |= 0x04; /* Invert XCLK phase */ - SiS_SetCH701x(SiS_Pr,0x1c,temp); - } - if(SiS_IsYPbPr(SiS_Pr)) { - temp = SiS_GetCH701x(SiS_Pr,0x01); - temp &= 0x3f; - temp |= 0x80; /* Enable YPrPb (HDTV) */ - SiS_SetCH701x(SiS_Pr,0x01,temp); - } - if(SiS_IsChScart(SiS_Pr)) { - temp = SiS_GetCH701x(SiS_Pr,0x01); - temp &= 0x3f; - temp |= 0xc0; /* Enable SCART + CVBS */ - SiS_SetCH701x(SiS_Pr,0x01,temp); - } - if(SiS_Pr->ChipType == SIS_740) { - SiS_ChrontelResetVSync(SiS_Pr); - SiS_SetCH701x(SiS_Pr,0x49,0x20); /* Enable TV path */ - } else { - SiS_SetCH701x(SiS_Pr,0x49,0x20); /* Enable TV path */ - temp = SiS_GetCH701x(SiS_Pr,0x49); - if(SiS_IsYPbPr(SiS_Pr)) { - temp = SiS_GetCH701x(SiS_Pr,0x73); - temp |= 0x60; - SiS_SetCH701x(SiS_Pr,0x73,temp); - } - temp = SiS_GetCH701x(SiS_Pr,0x47); - temp &= 0x7f; - SiS_SetCH701x(SiS_Pr,0x47,temp); - SiS_LongDelay(SiS_Pr, 2); - temp = SiS_GetCH701x(SiS_Pr,0x47); - temp |= 0x80; - SiS_SetCH701x(SiS_Pr,0x47,temp); - } - } -} - -static void -SiS_Chrontel701xOff(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - /* Complete power down of LVDS */ - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { - if(SiS_Pr->ChipType == SIS_740) { - SiS_LongDelay(SiS_Pr, 1); - SiS_GenericDelay(SiS_Pr, 5887); - SiS_SetCH701x(SiS_Pr,0x76,0xac); - SiS_SetCH701x(SiS_Pr,0x66,0x00); - } else { - SiS_LongDelay(SiS_Pr, 2); - temp = SiS_GetCH701x(SiS_Pr,0x76); - temp &= 0xfc; - SiS_SetCH701x(SiS_Pr,0x76,temp); - SiS_SetCH701x(SiS_Pr,0x66,0x00); - } - } -} - -static void -SiS_ChrontelResetDB(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - if(SiS_Pr->ChipType == SIS_740) { - - temp = SiS_GetCH701x(SiS_Pr,0x4a); /* Version ID */ - temp &= 0x01; - if(!temp) { - - if(SiS_WeHaveBacklightCtrl(SiS_Pr)) { - temp = SiS_GetCH701x(SiS_Pr,0x49); - SiS_SetCH701x(SiS_Pr,0x49,0x3e); - } - - /* Reset Chrontel 7019 datapath */ - SiS_SetCH701x(SiS_Pr,0x48,0x10); - SiS_LongDelay(SiS_Pr, 1); - SiS_SetCH701x(SiS_Pr,0x48,0x18); - - if(SiS_WeHaveBacklightCtrl(SiS_Pr)) { - SiS_ChrontelResetVSync(SiS_Pr); - SiS_SetCH701x(SiS_Pr,0x49,temp); - } - - } else { - - /* Clear/set/clear GPIO */ - temp = SiS_GetCH701x(SiS_Pr,0x5c); - temp &= 0xef; - SiS_SetCH701x(SiS_Pr,0x5c,temp); - temp = SiS_GetCH701x(SiS_Pr,0x5c); - temp |= 0x10; - SiS_SetCH701x(SiS_Pr,0x5c,temp); - temp = SiS_GetCH701x(SiS_Pr,0x5c); - temp &= 0xef; - SiS_SetCH701x(SiS_Pr,0x5c,temp); - temp = SiS_GetCH701x(SiS_Pr,0x61); - if(!temp) { - SiS_SetCH701xForLCD(SiS_Pr); - } - } - - } else { /* 650 */ - /* Reset Chrontel 7019 datapath */ - SiS_SetCH701x(SiS_Pr,0x48,0x10); - SiS_LongDelay(SiS_Pr, 1); - SiS_SetCH701x(SiS_Pr,0x48,0x18); - } -} - -static void -SiS_ChrontelInitTVVSync(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - if(SiS_Pr->ChipType == SIS_740) { - - if(SiS_WeHaveBacklightCtrl(SiS_Pr)) { - SiS_ChrontelResetVSync(SiS_Pr); - } - - } else { - - SiS_SetCH701x(SiS_Pr,0x76,0xaf); /* Power up LVDS block */ - temp = SiS_GetCH701x(SiS_Pr,0x49); - temp &= 1; - if(temp != 1) { /* TV block powered? (0 = yes, 1 = no) */ - temp = SiS_GetCH701x(SiS_Pr,0x47); - temp &= 0x70; - SiS_SetCH701x(SiS_Pr,0x47,temp); /* enable VSYNC */ - SiS_LongDelay(SiS_Pr, 3); - temp = SiS_GetCH701x(SiS_Pr,0x47); - temp |= 0x80; - SiS_SetCH701x(SiS_Pr,0x47,temp); /* disable VSYNC */ - } - - } -} - -static void -SiS_ChrontelDoSomething3(struct SiS_Private *SiS_Pr, unsigned short ModeNo) -{ - unsigned short temp,temp1; - - if(SiS_Pr->ChipType == SIS_740) { - - temp = SiS_GetCH701x(SiS_Pr,0x61); - if(temp < 1) { - temp++; - SiS_SetCH701x(SiS_Pr,0x61,temp); - } - SiS_SetCH701x(SiS_Pr,0x66,0x45); /* Panel power on */ - SiS_SetCH701x(SiS_Pr,0x76,0xaf); /* All power on */ - SiS_LongDelay(SiS_Pr, 1); - SiS_GenericDelay(SiS_Pr, 5887); - - } else { /* 650 */ - - temp1 = 0; - temp = SiS_GetCH701x(SiS_Pr,0x61); - if(temp < 2) { - temp++; - SiS_SetCH701x(SiS_Pr,0x61,temp); - temp1 = 1; - } - SiS_SetCH701x(SiS_Pr,0x76,0xac); - temp = SiS_GetCH701x(SiS_Pr,0x66); - temp |= 0x5f; - SiS_SetCH701x(SiS_Pr,0x66,temp); - if(ModeNo > 0x13) { - if(SiS_WeHaveBacklightCtrl(SiS_Pr)) { - SiS_GenericDelay(SiS_Pr, 1023); - } else { - SiS_GenericDelay(SiS_Pr, 767); - } - } else { - if(!temp1) - SiS_GenericDelay(SiS_Pr, 767); - } - temp = SiS_GetCH701x(SiS_Pr,0x76); - temp |= 0x03; - SiS_SetCH701x(SiS_Pr,0x76,temp); - temp = SiS_GetCH701x(SiS_Pr,0x66); - temp &= 0x7f; - SiS_SetCH701x(SiS_Pr,0x66,temp); - SiS_LongDelay(SiS_Pr, 1); - - } -} - -static void -SiS_ChrontelDoSomething2(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - SiS_LongDelay(SiS_Pr, 1); - - do { - temp = SiS_GetCH701x(SiS_Pr,0x66); - temp &= 0x04; /* PLL stable? -> bail out */ - if(temp == 0x04) break; - - if(SiS_Pr->ChipType == SIS_740) { - /* Power down LVDS output, PLL normal operation */ - SiS_SetCH701x(SiS_Pr,0x76,0xac); - } - - SiS_SetCH701xForLCD(SiS_Pr); - - temp = SiS_GetCH701x(SiS_Pr,0x76); - temp &= 0xfb; /* Reset PLL */ - SiS_SetCH701x(SiS_Pr,0x76,temp); - SiS_LongDelay(SiS_Pr, 2); - temp = SiS_GetCH701x(SiS_Pr,0x76); - temp |= 0x04; /* PLL normal operation */ - SiS_SetCH701x(SiS_Pr,0x76,temp); - if(SiS_Pr->ChipType == SIS_740) { - SiS_SetCH701x(SiS_Pr,0x78,0xe0); /* PLL loop filter */ - } else { - SiS_SetCH701x(SiS_Pr,0x78,0x60); - } - SiS_LongDelay(SiS_Pr, 2); - } while(0); - - SiS_SetCH701x(SiS_Pr,0x77,0x00); /* MV? */ -} - -static void -SiS_ChrontelDoSomething1(struct SiS_Private *SiS_Pr) -{ - unsigned short temp; - - temp = SiS_GetCH701x(SiS_Pr,0x03); - temp |= 0x80; /* Set datapath 1 to TV */ - temp &= 0xbf; /* Set datapath 2 to LVDS */ - SiS_SetCH701x(SiS_Pr,0x03,temp); - - if(SiS_Pr->ChipType == SIS_740) { - - temp = SiS_GetCH701x(SiS_Pr,0x1c); - temp &= 0xfb; /* Normal XCLK phase */ - SiS_SetCH701x(SiS_Pr,0x1c,temp); - - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2d,0x03); - - temp = SiS_GetCH701x(SiS_Pr,0x64); - temp |= 0x40; /* ? Bit not defined */ - SiS_SetCH701x(SiS_Pr,0x64,temp); - - temp = SiS_GetCH701x(SiS_Pr,0x03); - temp &= 0x3f; /* D1 input to both LVDS and TV */ - SiS_SetCH701x(SiS_Pr,0x03,temp); - - if(SiS_Pr->SiS_CustomT == CUT_ASUSL3000D) { - SiS_SetCH701x(SiS_Pr,0x63,0x40); /* LVDS off */ - SiS_LongDelay(SiS_Pr, 1); - SiS_SetCH701x(SiS_Pr,0x63,0x00); /* LVDS on */ - SiS_ChrontelResetDB(SiS_Pr); - SiS_ChrontelDoSomething2(SiS_Pr); - SiS_ChrontelDoSomething3(SiS_Pr, 0); - } else { - temp = SiS_GetCH701x(SiS_Pr,0x66); - if(temp != 0x45) { - SiS_ChrontelResetDB(SiS_Pr); - SiS_ChrontelDoSomething2(SiS_Pr); - SiS_ChrontelDoSomething3(SiS_Pr, 0); - } - } - - } else { /* 650 */ - - SiS_ChrontelResetDB(SiS_Pr); - SiS_ChrontelDoSomething2(SiS_Pr); - temp = SiS_GetReg(SiS_Pr->SiS_P3d4,0x34); - SiS_ChrontelDoSomething3(SiS_Pr,temp); - SiS_SetCH701x(SiS_Pr,0x76,0xaf); /* All power on, LVDS normal operation */ - - } - -} -#endif /* 315 series */ - -/*********************************************/ -/* MAIN: SET CRT2 REGISTER GROUP */ -/*********************************************/ - -bool -SiS_SetCRT2Group(struct SiS_Private *SiS_Pr, unsigned short ModeNo) -{ -#ifdef CONFIG_FB_SIS_300 - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; -#endif - unsigned short ModeIdIndex, RefreshRateTableIndex; - - SiS_Pr->SiS_SetFlag |= ProgrammingCRT2; - - if(!SiS_Pr->UseCustomMode) { - SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex); - } else { - ModeIdIndex = 0; - } - - /* Used for shifting CR33 */ - SiS_Pr->SiS_SelectCRT2Rate = 4; - - SiS_UnLockCRT2(SiS_Pr); - - RefreshRateTableIndex = SiS_GetRatePtr(SiS_Pr, ModeNo, ModeIdIndex); - - SiS_SaveCRT2Info(SiS_Pr,ModeNo); - - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - SiS_DisableBridge(SiS_Pr); - if((SiS_Pr->SiS_IF_DEF_LVDS == 1) && (SiS_Pr->ChipType == SIS_730)) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x00,0x80); - } - SiS_SetCRT2ModeRegs(SiS_Pr, ModeNo, ModeIdIndex); - } - - if(SiS_Pr->SiS_VBInfo & DisableCRT2Display) { - SiS_LockCRT2(SiS_Pr); - SiS_DisplayOn(SiS_Pr); - return true; - } - - SiS_GetCRT2Data(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - - /* Set up Panel Link for LVDS and LCDA */ - SiS_Pr->SiS_LCDHDES = SiS_Pr->SiS_LCDVDES = 0; - if( (SiS_Pr->SiS_IF_DEF_LVDS == 1) || - ((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) || - ((SiS_Pr->ChipType >= SIS_315H) && (SiS_Pr->SiS_VBType & VB_SIS30xBLV)) ) { - SiS_GetLVDSDesData(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - SiS_SetGroup1(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - - SiS_SetGroup2(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); -#ifdef CONFIG_FB_SIS_315 - SiS_SetGroup2_C_ELV(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); -#endif - SiS_SetGroup3(SiS_Pr, ModeNo, ModeIdIndex); - SiS_SetGroup4(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); -#ifdef CONFIG_FB_SIS_315 - SiS_SetGroup4_C_ELV(SiS_Pr, ModeNo, ModeIdIndex); -#endif - SiS_SetGroup5(SiS_Pr, ModeNo, ModeIdIndex); - - SiS_SetCRT2Sync(SiS_Pr, ModeNo, RefreshRateTableIndex); - - /* For 301BDH (Panel link initialization): */ - if((SiS_Pr->SiS_VBType & VB_NoLCD) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD)) { - - if(!((SiS_Pr->SiS_SetFlag & SetDOSMode) && ((ModeNo == 0x03) || (ModeNo == 0x10)))) { - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) { - SiS_ModCRT1CRTC(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - } - SiS_SetCRT2ECLK(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - } - - } else { - - SiS_SetCRT2Sync(SiS_Pr, ModeNo, RefreshRateTableIndex); - - SiS_ModCRT1CRTC(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex); - - SiS_SetCRT2ECLK(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex); - - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) { - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(SiS_Pr->SiS_IF_DEF_CH70xx == 2) { -#ifdef CONFIG_FB_SIS_315 - SiS_SetCH701xForLCD(SiS_Pr); -#endif - } - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - SiS_SetCHTVReg(SiS_Pr,ModeNo,ModeIdIndex,RefreshRateTableIndex); - } - } - } - - } - -#ifdef CONFIG_FB_SIS_300 - if(SiS_Pr->ChipType < SIS_315H) { - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - if(SiS_Pr->SiS_UseOEM) { - if((SiS_Pr->SiS_UseROM) && (SiS_Pr->SiS_UseOEM == -1)) { - if((ROMAddr[0x233] == 0x12) && (ROMAddr[0x234] == 0x34)) { - SiS_OEM300Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - } else { - SiS_OEM300Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - } - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - if((SiS_Pr->SiS_CustomT == CUT_BARCO1366) || - (SiS_Pr->SiS_CustomT == CUT_BARCO1024)) { - SetOEMLCDData2(SiS_Pr, ModeNo, ModeIdIndex,RefreshRateTableIndex); - } - SiS_DisplayOn(SiS_Pr); - } - } - } -#endif - -#ifdef CONFIG_FB_SIS_315 - if(SiS_Pr->ChipType >= SIS_315H) { - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - if(SiS_Pr->ChipType < SIS_661) { - SiS_FinalizeLCD(SiS_Pr, ModeNo, ModeIdIndex); - SiS_OEM310Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } else { - SiS_OEM661Setting(SiS_Pr, ModeNo, ModeIdIndex, RefreshRateTableIndex); - } - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x01,0x40); - } - } -#endif - - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - SiS_EnableBridge(SiS_Pr); - } - - SiS_DisplayOn(SiS_Pr); - - if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - /* Disable LCD panel when using TV */ - SiS_SetRegSR11ANDOR(SiS_Pr,0xFF,0x0C); - } else { - /* Disable TV when using LCD */ - SiS_SetCH70xxANDOR(SiS_Pr,0x0e,0x01,0xf8); - } - } - - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - SiS_LockCRT2(SiS_Pr); - } - - return true; -} - - -/*********************************************/ -/* ENABLE/DISABLE LCD BACKLIGHT (SIS) */ -/*********************************************/ - -void -SiS_SiS30xBLOn(struct SiS_Private *SiS_Pr) -{ - /* Switch on LCD backlight on SiS30xLV */ - SiS_DDC2Delay(SiS_Pr,0xff00); - if(!(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x02)) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x02); - SiS_WaitVBRetrace(SiS_Pr); - } - if(!(SiS_GetReg(SiS_Pr->SiS_Part4Port,0x26) & 0x01)) { - SiS_SetRegOR(SiS_Pr->SiS_Part4Port,0x26,0x01); - } -} - -void -SiS_SiS30xBLOff(struct SiS_Private *SiS_Pr) -{ - /* Switch off LCD backlight on SiS30xLV */ - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x26,0xFE); - SiS_DDC2Delay(SiS_Pr,0xff00); -} - -/*********************************************/ -/* DDC RELATED FUNCTIONS */ -/*********************************************/ - -static void -SiS_SetupDDCN(struct SiS_Private *SiS_Pr) -{ - SiS_Pr->SiS_DDC_NData = ~SiS_Pr->SiS_DDC_Data; - SiS_Pr->SiS_DDC_NClk = ~SiS_Pr->SiS_DDC_Clk; - if((SiS_Pr->SiS_DDC_Index == 0x11) && (SiS_Pr->SiS_SensibleSR11)) { - SiS_Pr->SiS_DDC_NData &= 0x0f; - SiS_Pr->SiS_DDC_NClk &= 0x0f; - } -} - -#ifdef CONFIG_FB_SIS_300 -static unsigned char * -SiS_SetTrumpBlockLoop(struct SiS_Private *SiS_Pr, unsigned char *dataptr) -{ - int i, j, num; - unsigned short tempah,temp; - unsigned char *mydataptr; - - for(i=0; i<20; i++) { /* Do 20 attempts to write */ - mydataptr = dataptr; - num = *mydataptr++; - if(!num) return mydataptr; - if(i) { - SiS_SetStop(SiS_Pr); - SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT * 2); - } - if(SiS_SetStart(SiS_Pr)) continue; /* Set start condition */ - tempah = SiS_Pr->SiS_DDC_DeviceAddr; - temp = SiS_WriteDDC2Data(SiS_Pr,tempah); /* Write DAB (S0=0=write) */ - if(temp) continue; /* (ERROR: no ack) */ - tempah = *mydataptr++; - temp = SiS_WriteDDC2Data(SiS_Pr,tempah); /* Write register number */ - if(temp) continue; /* (ERROR: no ack) */ - for(j=0; j<num; j++) { - tempah = *mydataptr++; - temp = SiS_WriteDDC2Data(SiS_Pr,tempah);/* Write DAB (S0=0=write) */ - if(temp) break; - } - if(temp) continue; - if(SiS_SetStop(SiS_Pr)) continue; - return mydataptr; - } - return NULL; -} - -static bool -SiS_SetTrumpionBlock(struct SiS_Private *SiS_Pr, unsigned char *dataptr) -{ - SiS_Pr->SiS_DDC_DeviceAddr = 0xF0; /* DAB (Device Address Byte) */ - SiS_Pr->SiS_DDC_Index = 0x11; /* Bit 0 = SC; Bit 1 = SD */ - SiS_Pr->SiS_DDC_Data = 0x02; /* Bitmask in IndexReg for Data */ - SiS_Pr->SiS_DDC_Clk = 0x01; /* Bitmask in IndexReg for Clk */ - SiS_SetupDDCN(SiS_Pr); - - SiS_SetSwitchDDC2(SiS_Pr); - - while(*dataptr) { - dataptr = SiS_SetTrumpBlockLoop(SiS_Pr, dataptr); - if(!dataptr) return false; - } - return true; -} -#endif - -/* The Chrontel 700x is connected to the 630/730 via - * the 630/730's DDC/I2C port. - * - * On 630(S)T chipset, the index changed from 0x11 to - * 0x0a, possibly for working around the DDC problems - */ - -static bool -SiS_SetChReg(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val, unsigned short myor) -{ - unsigned short temp, i; - - for(i=0; i<20; i++) { /* Do 20 attempts to write */ - if(i) { - SiS_SetStop(SiS_Pr); - SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT * 4); - } - if(SiS_SetStart(SiS_Pr)) continue; /* Set start condition */ - temp = SiS_WriteDDC2Data(SiS_Pr, SiS_Pr->SiS_DDC_DeviceAddr); /* Write DAB (S0=0=write) */ - if(temp) continue; /* (ERROR: no ack) */ - temp = SiS_WriteDDC2Data(SiS_Pr, (reg | myor)); /* Write RAB (700x: set bit 7, see datasheet) */ - if(temp) continue; /* (ERROR: no ack) */ - temp = SiS_WriteDDC2Data(SiS_Pr, val); /* Write data */ - if(temp) continue; /* (ERROR: no ack) */ - if(SiS_SetStop(SiS_Pr)) continue; /* Set stop condition */ - SiS_Pr->SiS_ChrontelInit = 1; - return true; - } - return false; -} - -/* Write to Chrontel 700x */ -void -SiS_SetCH700x(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val) -{ - SiS_Pr->SiS_DDC_DeviceAddr = 0xEA; /* DAB (Device Address Byte) */ - - SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT); - - if(!(SiS_Pr->SiS_ChrontelInit)) { - SiS_Pr->SiS_DDC_Index = 0x11; /* Bit 0 = SC; Bit 1 = SD */ - SiS_Pr->SiS_DDC_Data = 0x02; /* Bitmask in IndexReg for Data */ - SiS_Pr->SiS_DDC_Clk = 0x01; /* Bitmask in IndexReg for Clk */ - SiS_SetupDDCN(SiS_Pr); - } - - if( (!(SiS_SetChReg(SiS_Pr, reg, val, 0x80))) && - (!(SiS_Pr->SiS_ChrontelInit)) ) { - SiS_Pr->SiS_DDC_Index = 0x0a; - SiS_Pr->SiS_DDC_Data = 0x80; - SiS_Pr->SiS_DDC_Clk = 0x40; - SiS_SetupDDCN(SiS_Pr); - - SiS_SetChReg(SiS_Pr, reg, val, 0x80); - } -} - -/* Write to Chrontel 701x */ -/* Parameter is [Data (S15-S8) | Register no (S7-S0)] */ -void -SiS_SetCH701x(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val) -{ - SiS_Pr->SiS_DDC_Index = 0x11; /* Bit 0 = SC; Bit 1 = SD */ - SiS_Pr->SiS_DDC_Data = 0x08; /* Bitmask in IndexReg for Data */ - SiS_Pr->SiS_DDC_Clk = 0x04; /* Bitmask in IndexReg for Clk */ - SiS_SetupDDCN(SiS_Pr); - SiS_Pr->SiS_DDC_DeviceAddr = 0xEA; /* DAB (Device Address Byte) */ - SiS_SetChReg(SiS_Pr, reg, val, 0); -} - -static -void -SiS_SetCH70xx(struct SiS_Private *SiS_Pr, unsigned short reg, unsigned char val) -{ - if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) - SiS_SetCH700x(SiS_Pr, reg, val); - else - SiS_SetCH701x(SiS_Pr, reg, val); -} - -static unsigned short -SiS_GetChReg(struct SiS_Private *SiS_Pr, unsigned short myor) -{ - unsigned short tempah, temp, i; - - for(i=0; i<20; i++) { /* Do 20 attempts to read */ - if(i) { - SiS_SetStop(SiS_Pr); - SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT * 4); - } - if(SiS_SetStart(SiS_Pr)) continue; /* Set start condition */ - temp = SiS_WriteDDC2Data(SiS_Pr,SiS_Pr->SiS_DDC_DeviceAddr); /* Write DAB (S0=0=write) */ - if(temp) continue; /* (ERROR: no ack) */ - temp = SiS_WriteDDC2Data(SiS_Pr,SiS_Pr->SiS_DDC_ReadAddr | myor); /* Write RAB (700x: | 0x80) */ - if(temp) continue; /* (ERROR: no ack) */ - if (SiS_SetStart(SiS_Pr)) continue; /* Re-start */ - temp = SiS_WriteDDC2Data(SiS_Pr,SiS_Pr->SiS_DDC_DeviceAddr | 0x01);/* DAB (S0=1=read) */ - if(temp) continue; /* (ERROR: no ack) */ - tempah = SiS_ReadDDC2Data(SiS_Pr); /* Read byte */ - if(SiS_SetStop(SiS_Pr)) continue; /* Stop condition */ - SiS_Pr->SiS_ChrontelInit = 1; - return tempah; - } - return 0xFFFF; -} - -/* Read from Chrontel 700x */ -/* Parameter is [Register no (S7-S0)] */ -unsigned short -SiS_GetCH700x(struct SiS_Private *SiS_Pr, unsigned short tempbx) -{ - unsigned short result; - - SiS_Pr->SiS_DDC_DeviceAddr = 0xEA; /* DAB */ - - SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT); - - if(!(SiS_Pr->SiS_ChrontelInit)) { - SiS_Pr->SiS_DDC_Index = 0x11; /* Bit 0 = SC; Bit 1 = SD */ - SiS_Pr->SiS_DDC_Data = 0x02; /* Bitmask in IndexReg for Data */ - SiS_Pr->SiS_DDC_Clk = 0x01; /* Bitmask in IndexReg for Clk */ - SiS_SetupDDCN(SiS_Pr); - } - - SiS_Pr->SiS_DDC_ReadAddr = tempbx; - - if( ((result = SiS_GetChReg(SiS_Pr,0x80)) == 0xFFFF) && - (!SiS_Pr->SiS_ChrontelInit) ) { - - SiS_Pr->SiS_DDC_Index = 0x0a; - SiS_Pr->SiS_DDC_Data = 0x80; - SiS_Pr->SiS_DDC_Clk = 0x40; - SiS_SetupDDCN(SiS_Pr); - - result = SiS_GetChReg(SiS_Pr,0x80); - } - return result; -} - -/* Read from Chrontel 701x */ -/* Parameter is [Register no (S7-S0)] */ -unsigned short -SiS_GetCH701x(struct SiS_Private *SiS_Pr, unsigned short tempbx) -{ - SiS_Pr->SiS_DDC_Index = 0x11; /* Bit 0 = SC; Bit 1 = SD */ - SiS_Pr->SiS_DDC_Data = 0x08; /* Bitmask in IndexReg for Data */ - SiS_Pr->SiS_DDC_Clk = 0x04; /* Bitmask in IndexReg for Clk */ - SiS_SetupDDCN(SiS_Pr); - SiS_Pr->SiS_DDC_DeviceAddr = 0xEA; /* DAB */ - - SiS_Pr->SiS_DDC_ReadAddr = tempbx; - - return SiS_GetChReg(SiS_Pr,0); -} - -/* Read from Chrontel 70xx */ -/* Parameter is [Register no (S7-S0)] */ -static -unsigned short -SiS_GetCH70xx(struct SiS_Private *SiS_Pr, unsigned short tempbx) -{ - if(SiS_Pr->SiS_IF_DEF_CH70xx == 1) - return SiS_GetCH700x(SiS_Pr, tempbx); - else - return SiS_GetCH701x(SiS_Pr, tempbx); -} - -void -SiS_SetCH70xxANDOR(struct SiS_Private *SiS_Pr, unsigned short reg, - unsigned char myor, unsigned short myand) -{ - unsigned short tempbl; - - tempbl = (SiS_GetCH70xx(SiS_Pr, (reg & 0xFF)) & myand) | myor; - SiS_SetCH70xx(SiS_Pr, reg, tempbl); -} - -/* Our own DDC functions */ -static -unsigned short -SiS_InitDDCRegs(struct SiS_Private *SiS_Pr, unsigned int VBFlags, int VGAEngine, - unsigned short adaptnum, unsigned short DDCdatatype, bool checkcr32, - unsigned int VBFlags2) -{ - unsigned char ddcdtype[] = { 0xa0, 0xa0, 0xa0, 0xa2, 0xa6 }; - unsigned char flag, cr32; - unsigned short temp = 0, myadaptnum = adaptnum; - - if(adaptnum != 0) { - if(!(VBFlags2 & VB2_SISTMDSBRIDGE)) return 0xFFFF; - if((VBFlags2 & VB2_30xBDH) && (adaptnum == 1)) return 0xFFFF; - } - - /* adapternum for SiS bridges: 0 = CRT1, 1 = LCD, 2 = VGA2 */ - - SiS_Pr->SiS_ChrontelInit = 0; /* force re-detection! */ - - SiS_Pr->SiS_DDC_SecAddr = 0; - SiS_Pr->SiS_DDC_DeviceAddr = ddcdtype[DDCdatatype]; - SiS_Pr->SiS_DDC_Port = SiS_Pr->SiS_P3c4; - SiS_Pr->SiS_DDC_Index = 0x11; - flag = 0xff; - - cr32 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x32); - -#if 0 - if(VBFlags2 & VB2_SISBRIDGE) { - if(myadaptnum == 0) { - if(!(cr32 & 0x20)) { - myadaptnum = 2; - if(!(cr32 & 0x10)) { - myadaptnum = 1; - if(!(cr32 & 0x08)) { - myadaptnum = 0; - } - } - } - } - } -#endif - - if(VGAEngine == SIS_300_VGA) { /* 300 series */ - - if(myadaptnum != 0) { - flag = 0; - if(VBFlags2 & VB2_SISBRIDGE) { - SiS_Pr->SiS_DDC_Port = SiS_Pr->SiS_Part4Port; - SiS_Pr->SiS_DDC_Index = 0x0f; - } - } - - if(!(VBFlags2 & VB2_301)) { - if((cr32 & 0x80) && (checkcr32)) { - if(myadaptnum >= 1) { - if(!(cr32 & 0x08)) { - myadaptnum = 1; - if(!(cr32 & 0x10)) return 0xFFFF; - } - } - } - } - - temp = 4 - (myadaptnum * 2); - if(flag) temp = 0; - - } else { /* 315/330 series */ - - /* here we simplify: 0 = CRT1, 1 = CRT2 (VGA, LCD) */ - - if(VBFlags2 & VB2_SISBRIDGE) { - if(myadaptnum == 2) { - myadaptnum = 1; - } - } - - if(myadaptnum == 1) { - flag = 0; - if(VBFlags2 & VB2_SISBRIDGE) { - SiS_Pr->SiS_DDC_Port = SiS_Pr->SiS_Part4Port; - SiS_Pr->SiS_DDC_Index = 0x0f; - } - } - - if((cr32 & 0x80) && (checkcr32)) { - if(myadaptnum >= 1) { - if(!(cr32 & 0x08)) { - myadaptnum = 1; - if(!(cr32 & 0x10)) return 0xFFFF; - } - } - } - - temp = myadaptnum; - if(myadaptnum == 1) { - temp = 0; - if(VBFlags2 & VB2_LVDS) flag = 0xff; - } - - if(flag) temp = 0; - } - - SiS_Pr->SiS_DDC_Data = 0x02 << temp; - SiS_Pr->SiS_DDC_Clk = 0x01 << temp; - - SiS_SetupDDCN(SiS_Pr); - - return 0; -} - -static unsigned short -SiS_WriteDABDDC(struct SiS_Private *SiS_Pr) -{ - if(SiS_SetStart(SiS_Pr)) return 0xFFFF; - if(SiS_WriteDDC2Data(SiS_Pr, SiS_Pr->SiS_DDC_DeviceAddr)) { - return 0xFFFF; - } - if(SiS_WriteDDC2Data(SiS_Pr, SiS_Pr->SiS_DDC_SecAddr)) { - return 0xFFFF; - } - return 0; -} - -static unsigned short -SiS_PrepareReadDDC(struct SiS_Private *SiS_Pr) -{ - if(SiS_SetStart(SiS_Pr)) return 0xFFFF; - if(SiS_WriteDDC2Data(SiS_Pr, (SiS_Pr->SiS_DDC_DeviceAddr | 0x01))) { - return 0xFFFF; - } - return 0; -} - -static unsigned short -SiS_PrepareDDC(struct SiS_Private *SiS_Pr) -{ - if(SiS_WriteDABDDC(SiS_Pr)) SiS_WriteDABDDC(SiS_Pr); - if(SiS_PrepareReadDDC(SiS_Pr)) return (SiS_PrepareReadDDC(SiS_Pr)); - return 0; -} - -static void -SiS_SendACK(struct SiS_Private *SiS_Pr, unsigned short yesno) -{ - SiS_SetSCLKLow(SiS_Pr); - if(yesno) { - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - SiS_Pr->SiS_DDC_Data); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - 0); - } - SiS_SetSCLKHigh(SiS_Pr); -} - -static unsigned short -SiS_DoProbeDDC(struct SiS_Private *SiS_Pr) -{ - unsigned char mask, value; - unsigned short temp, ret=0; - bool failed = false; - - SiS_SetSwitchDDC2(SiS_Pr); - if(SiS_PrepareDDC(SiS_Pr)) { - SiS_SetStop(SiS_Pr); - return 0xFFFF; - } - mask = 0xf0; - value = 0x20; - if(SiS_Pr->SiS_DDC_DeviceAddr == 0xa0) { - temp = (unsigned char)SiS_ReadDDC2Data(SiS_Pr); - SiS_SendACK(SiS_Pr, 0); - if(temp == 0) { - mask = 0xff; - value = 0xff; - } else { - failed = true; - ret = 0xFFFF; - } - } - if(!failed) { - temp = (unsigned char)SiS_ReadDDC2Data(SiS_Pr); - SiS_SendACK(SiS_Pr, 1); - temp &= mask; - if(temp == value) ret = 0; - else { - ret = 0xFFFF; - if(SiS_Pr->SiS_DDC_DeviceAddr == 0xa0) { - if(temp == 0x30) ret = 0; - } - } - } - SiS_SetStop(SiS_Pr); - return ret; -} - -static -unsigned short -SiS_ProbeDDC(struct SiS_Private *SiS_Pr) -{ - unsigned short flag; - - flag = 0x180; - SiS_Pr->SiS_DDC_DeviceAddr = 0xa0; - if(!(SiS_DoProbeDDC(SiS_Pr))) flag |= 0x02; - SiS_Pr->SiS_DDC_DeviceAddr = 0xa2; - if(!(SiS_DoProbeDDC(SiS_Pr))) flag |= 0x08; - SiS_Pr->SiS_DDC_DeviceAddr = 0xa6; - if(!(SiS_DoProbeDDC(SiS_Pr))) flag |= 0x10; - if(!(flag & 0x1a)) flag = 0; - return flag; -} - -static -unsigned short -SiS_ReadDDC(struct SiS_Private *SiS_Pr, unsigned short DDCdatatype, unsigned char *buffer) -{ - unsigned short flag, length, i; - unsigned char chksum,gotcha; - - if(DDCdatatype > 4) return 0xFFFF; - - flag = 0; - SiS_SetSwitchDDC2(SiS_Pr); - if(!(SiS_PrepareDDC(SiS_Pr))) { - length = 127; - if(DDCdatatype != 1) length = 255; - chksum = 0; - gotcha = 0; - for(i=0; i<length; i++) { - buffer[i] = (unsigned char)SiS_ReadDDC2Data(SiS_Pr); - chksum += buffer[i]; - gotcha |= buffer[i]; - SiS_SendACK(SiS_Pr, 0); - } - buffer[i] = (unsigned char)SiS_ReadDDC2Data(SiS_Pr); - chksum += buffer[i]; - SiS_SendACK(SiS_Pr, 1); - if(gotcha) flag = (unsigned short)chksum; - else flag = 0xFFFF; - } else { - flag = 0xFFFF; - } - SiS_SetStop(SiS_Pr); - return flag; -} - -/* Our private DDC functions - - It complies somewhat with the corresponding VESA function - in arguments and return values. - - Since this is probably called before the mode is changed, - we use our pre-detected pSiS-values instead of SiS_Pr as - regards chipset and video bridge type. - - Arguments: - adaptnum: 0=CRT1(analog), 1=CRT2/LCD(digital), 2=CRT2/VGA2(analog) - CRT2 DDC is only supported on SiS301, 301B, 301C, 302B. - LCDA is CRT1, but DDC is read from CRT2 port. - DDCdatatype: 0=Probe, 1=EDID, 2=EDID+VDIF, 3=EDID V2 (P&D), 4=EDID V2 (FPDI-2) - buffer: ptr to 256 data bytes which will be filled with read data. - - Returns 0xFFFF if error, otherwise - if DDCdatatype > 0: Returns 0 if reading OK (included a correct checksum) - if DDCdatatype = 0: Returns supported DDC modes - - */ -unsigned short -SiS_HandleDDC(struct SiS_Private *SiS_Pr, unsigned int VBFlags, int VGAEngine, - unsigned short adaptnum, unsigned short DDCdatatype, unsigned char *buffer, - unsigned int VBFlags2) -{ - unsigned char sr1f, cr17=1; - unsigned short result; - - if(adaptnum > 2) - return 0xFFFF; - - if(DDCdatatype > 4) - return 0xFFFF; - - if((!(VBFlags2 & VB2_VIDEOBRIDGE)) && (adaptnum > 0)) - return 0xFFFF; - - if(SiS_InitDDCRegs(SiS_Pr, VBFlags, VGAEngine, adaptnum, DDCdatatype, false, VBFlags2) == 0xFFFF) - return 0xFFFF; - - sr1f = SiS_GetReg(SiS_Pr->SiS_P3c4,0x1f); - SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x1f,0x3f,0x04); - if(VGAEngine == SIS_300_VGA) { - cr17 = SiS_GetReg(SiS_Pr->SiS_P3d4,0x17) & 0x80; - if(!cr17) { - SiS_SetRegOR(SiS_Pr->SiS_P3d4,0x17,0x80); - SiS_SetReg(SiS_Pr->SiS_P3c4,0x00,0x01); - SiS_SetReg(SiS_Pr->SiS_P3c4,0x00,0x03); - } - } - if((sr1f) || (!cr17)) { - SiS_WaitRetrace1(SiS_Pr); - SiS_WaitRetrace1(SiS_Pr); - SiS_WaitRetrace1(SiS_Pr); - SiS_WaitRetrace1(SiS_Pr); - } - - if(DDCdatatype == 0) { - result = SiS_ProbeDDC(SiS_Pr); - } else { - result = SiS_ReadDDC(SiS_Pr, DDCdatatype, buffer); - if((!result) && (DDCdatatype == 1)) { - if((buffer[0] == 0x00) && (buffer[1] == 0xff) && - (buffer[2] == 0xff) && (buffer[3] == 0xff) && - (buffer[4] == 0xff) && (buffer[5] == 0xff) && - (buffer[6] == 0xff) && (buffer[7] == 0x00) && - (buffer[0x12] == 1)) { - if(!SiS_Pr->DDCPortMixup) { - if(adaptnum == 1) { - if(!(buffer[0x14] & 0x80)) result = 0xFFFE; - } else { - if(buffer[0x14] & 0x80) result = 0xFFFE; - } - } - } - } - } - SiS_SetReg(SiS_Pr->SiS_P3c4,0x1f,sr1f); - if(VGAEngine == SIS_300_VGA) { - SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x17,0x7f,cr17); - } - return result; -} - -/* Generic I2C functions for Chrontel & DDC --------- */ - -static void -SiS_SetSwitchDDC2(struct SiS_Private *SiS_Pr) -{ - SiS_SetSCLKHigh(SiS_Pr); - SiS_WaitRetrace1(SiS_Pr); - - SiS_SetSCLKLow(SiS_Pr); - SiS_WaitRetrace1(SiS_Pr); -} - -unsigned short -SiS_ReadDDC1Bit(struct SiS_Private *SiS_Pr) -{ - SiS_WaitRetrace1(SiS_Pr); - return ((SiS_GetReg(SiS_Pr->SiS_P3c4,0x11) & 0x02) >> 1); -} - -/* Set I2C start condition */ -/* This is done by a SD high-to-low transition while SC is high */ -static unsigned short -SiS_SetStart(struct SiS_Private *SiS_Pr) -{ - if(SiS_SetSCLKLow(SiS_Pr)) return 0xFFFF; /* (SC->low) */ - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - SiS_Pr->SiS_DDC_Data); /* SD->high */ - if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF; /* SC->high */ - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - 0x00); /* SD->low = start condition */ - if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF; /* (SC->low) */ - return 0; -} - -/* Set I2C stop condition */ -/* This is done by a SD low-to-high transition while SC is high */ -static unsigned short -SiS_SetStop(struct SiS_Private *SiS_Pr) -{ - if(SiS_SetSCLKLow(SiS_Pr)) return 0xFFFF; /* (SC->low) */ - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - 0x00); /* SD->low */ - if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF; /* SC->high */ - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - SiS_Pr->SiS_DDC_Data); /* SD->high = stop condition */ - if(SiS_SetSCLKHigh(SiS_Pr)) return 0xFFFF; /* (SC->high) */ - return 0; -} - -/* Write 8 bits of data */ -static unsigned short -SiS_WriteDDC2Data(struct SiS_Private *SiS_Pr, unsigned short tempax) -{ - unsigned short i,flag,temp; - - flag = 0x80; - for(i = 0; i < 8; i++) { - SiS_SetSCLKLow(SiS_Pr); /* SC->low */ - if(tempax & flag) { - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - SiS_Pr->SiS_DDC_Data); /* Write bit (1) to SD */ - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - 0x00); /* Write bit (0) to SD */ - } - SiS_SetSCLKHigh(SiS_Pr); /* SC->high */ - flag >>= 1; - } - temp = SiS_CheckACK(SiS_Pr); /* Check acknowledge */ - return temp; -} - -static unsigned short -SiS_ReadDDC2Data(struct SiS_Private *SiS_Pr) -{ - unsigned short i, temp, getdata; - - getdata = 0; - for(i = 0; i < 8; i++) { - getdata <<= 1; - SiS_SetSCLKLow(SiS_Pr); - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - SiS_Pr->SiS_DDC_Data); - SiS_SetSCLKHigh(SiS_Pr); - temp = SiS_GetReg(SiS_Pr->SiS_DDC_Port,SiS_Pr->SiS_DDC_Index); - if(temp & SiS_Pr->SiS_DDC_Data) getdata |= 0x01; - } - return getdata; -} - -static unsigned short -SiS_SetSCLKLow(struct SiS_Private *SiS_Pr) -{ - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NClk, - 0x00); /* SetSCLKLow() */ - SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT); - return 0; -} - -static unsigned short -SiS_SetSCLKHigh(struct SiS_Private *SiS_Pr) -{ - unsigned short temp, watchdog=1000; - - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NClk, - SiS_Pr->SiS_DDC_Clk); /* SetSCLKHigh() */ - do { - temp = SiS_GetReg(SiS_Pr->SiS_DDC_Port,SiS_Pr->SiS_DDC_Index); - } while((!(temp & SiS_Pr->SiS_DDC_Clk)) && --watchdog); - if (!watchdog) { - return 0xFFFF; - } - SiS_DDC2Delay(SiS_Pr,SiS_I2CDELAYSHORT); - return 0; -} - -/* Check I2C acknowledge */ -/* Returns 0 if ack ok, non-0 if ack not ok */ -static unsigned short -SiS_CheckACK(struct SiS_Private *SiS_Pr) -{ - unsigned short tempah; - - SiS_SetSCLKLow(SiS_Pr); /* (SC->low) */ - SiS_SetRegANDOR(SiS_Pr->SiS_DDC_Port, - SiS_Pr->SiS_DDC_Index, - SiS_Pr->SiS_DDC_NData, - SiS_Pr->SiS_DDC_Data); /* (SD->high) */ - SiS_SetSCLKHigh(SiS_Pr); /* SC->high = clock impulse for ack */ - tempah = SiS_GetReg(SiS_Pr->SiS_DDC_Port,SiS_Pr->SiS_DDC_Index); /* Read SD */ - SiS_SetSCLKLow(SiS_Pr); /* SC->low = end of clock impulse */ - if(tempah & SiS_Pr->SiS_DDC_Data) return 1; /* Ack OK if bit = 0 */ - return 0; -} - -/* End of I2C functions ----------------------- */ - - -/* =============== SiS 315/330 O.E.M. ================= */ - -#ifdef CONFIG_FB_SIS_315 - -static unsigned short -GetRAMDACromptr(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short romptr; - - if(SiS_Pr->ChipType < SIS_330) { - romptr = SISGETROMW(0x128); - if(SiS_Pr->SiS_VBType & VB_SIS30xB) - romptr = SISGETROMW(0x12a); - } else { - romptr = SISGETROMW(0x1a8); - if(SiS_Pr->SiS_VBType & VB_SIS30xB) - romptr = SISGETROMW(0x1aa); - } - return romptr; -} - -static unsigned short -GetLCDromptr(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short romptr; - - if(SiS_Pr->ChipType < SIS_330) { - romptr = SISGETROMW(0x120); - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) - romptr = SISGETROMW(0x122); - } else { - romptr = SISGETROMW(0x1a0); - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) - romptr = SISGETROMW(0x1a2); - } - return romptr; -} - -static unsigned short -GetTVromptr(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short romptr; - - if(SiS_Pr->ChipType < SIS_330) { - romptr = SISGETROMW(0x114); - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) - romptr = SISGETROMW(0x11a); - } else { - romptr = SISGETROMW(0x194); - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) - romptr = SISGETROMW(0x19a); - } - return romptr; -} - -static unsigned short -GetLCDPtrIndexBIOS(struct SiS_Private *SiS_Pr) -{ - unsigned short index; - - if((IS_SIS650) && (SiS_Pr->SiS_VBType & VB_SISLVDS)) { - if(!(SiS_IsNotM650orLater(SiS_Pr))) { - if((index = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) & 0xf0)) { - index >>= 4; - index *= 3; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) index += 2; - else if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) index++; - return index; - } - } - } - - index = SiS_GetBIOSLCDResInfo(SiS_Pr) & 0x0F; - if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) index -= 5; - if(SiS_Pr->SiS_VBType & VB_SIS301C) { /* 1.15.20 and later (not VB specific) */ - if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) index -= 5; - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x768) index -= 5; - } else { - if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) index -= 6; - } - index--; - index *= 3; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) index += 2; - else if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) index++; - return index; -} - -static unsigned short -GetLCDPtrIndex(struct SiS_Private *SiS_Pr) -{ - unsigned short index; - - index = ((SiS_GetBIOSLCDResInfo(SiS_Pr) & 0x0F) - 1) * 3; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) index += 2; - else if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) index++; - return index; -} - -static unsigned short -GetTVPtrIndex(struct SiS_Private *SiS_Pr) -{ - unsigned short index; - - index = 0; - if(SiS_Pr->SiS_TVMode & TVSetPAL) index = 1; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) index = 2; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToYPbPr525750) index = 0; - - index <<= 1; - - if((SiS_Pr->SiS_VBInfo & SetInSlaveMode) && - (SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) { - index++; - } - - return index; -} - -static unsigned int -GetOEMTVPtr661_2_GEN(struct SiS_Private *SiS_Pr, int addme) -{ - unsigned short index = 0, temp = 0; - - if(SiS_Pr->SiS_TVMode & TVSetPAL) index = 1; - if(SiS_Pr->SiS_TVMode & TVSetPALM) index = 2; - if(SiS_Pr->SiS_TVMode & TVSetPALN) index = 3; - if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) index = 6; - if(SiS_Pr->SiS_TVMode & TVSetNTSC1024) { - index = 4; - if(SiS_Pr->SiS_TVMode & TVSetPALM) index++; - if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) index = 7; - } - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - if((!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) || - (SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) { - index += addme; - temp++; - } - temp += 0x0100; - } - return (unsigned int)(index | (temp << 16)); -} - -static unsigned int -GetOEMTVPtr661_2_OLD(struct SiS_Private *SiS_Pr) -{ - return (GetOEMTVPtr661_2_GEN(SiS_Pr, 8)); -} - -#if 0 -static unsigned int -GetOEMTVPtr661_2_NEW(struct SiS_Private *SiS_Pr) -{ - return (GetOEMTVPtr661_2_GEN(SiS_Pr, 6)); -} -#endif - -static int -GetOEMTVPtr661(struct SiS_Private *SiS_Pr) -{ - int index = 0; - - if(SiS_Pr->SiS_TVMode & TVSetPAL) index = 2; - if(SiS_Pr->SiS_ROMNew) { - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525i) index = 4; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) index = 6; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) index = 8; - if(SiS_Pr->SiS_TVMode & TVSetHiVision) index = 10; - } else { - if(SiS_Pr->SiS_TVMode & TVSetHiVision) index = 4; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525i) index = 6; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr525p) index = 8; - if(SiS_Pr->SiS_TVMode & TVSetYPbPr750p) index = 10; - } - - if(SiS_Pr->SiS_TVMode & TVSetTVSimuMode) index++; - - return index; -} - -static void -SetDelayComp(struct SiS_Private *SiS_Pr, unsigned short ModeNo) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short delay=0,index,myindex,temp,romptr=0; - bool dochiptest = true; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x20,0xbf); - } else { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x35,0x7f); - } - - /* Find delay (from ROM, internal tables, PCI subsystem) */ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) { /* ------------ VGA */ - - if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) { - romptr = GetRAMDACromptr(SiS_Pr); - } - if(romptr) delay = ROMAddr[romptr]; - else { - delay = 0x04; - if(SiS_Pr->SiS_VBType & VB_SIS30xB) { - if(IS_SIS650) { - delay = 0x0a; - } else if(IS_SIS740) { - delay = 0x00; - } else if(SiS_Pr->ChipType < SIS_330) { - delay = 0x0c; - } else { - delay = 0x0c; - } - } else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - delay = 0x00; - } - } - - } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD|SetCRT2ToLCDA)) { /* ---------- LCD/LCDA */ - - bool gotitfrompci = false; - - /* Could we detect a PDC for LCD or did we get a user-defined? If yes, use it */ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - if(SiS_Pr->PDC != -1) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,((SiS_Pr->PDC >> 1) & 0x0f)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,0x7f,((SiS_Pr->PDC & 0x01) << 7)); - return; - } - } else { - if(SiS_Pr->PDCA != -1) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,((SiS_Pr->PDCA << 3) & 0xf0)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x20,0xbf,((SiS_Pr->PDCA & 0x01) << 6)); - return; - } - } - - /* Custom Panel? */ - - if(SiS_Pr->SiS_LCDResInfo == Panel_Custom) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - delay = 0x00; - if((SiS_Pr->PanelXRes <= 1280) && (SiS_Pr->PanelYRes <= 1024)) { - delay = 0x20; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,delay); - } else { - delay = 0x0c; - if(SiS_Pr->SiS_VBType & VB_SIS301C) { - delay = 0x03; - if((SiS_Pr->PanelXRes > 1280) && (SiS_Pr->PanelYRes > 1024)) { - delay = 0x00; - } - } else if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - if(IS_SIS740) delay = 0x01; - else delay = 0x03; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,delay); - } - return; - } - - /* This is a piece of typical SiS crap: They code the OEM LCD - * delay into the code, at no defined place in the BIOS. - * We now have to start doing a PCI subsystem check here. - */ - - switch(SiS_Pr->SiS_CustomT) { - case CUT_COMPAQ1280: - case CUT_COMPAQ12802: - if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) { - gotitfrompci = true; - dochiptest = false; - delay = 0x03; - } - break; - case CUT_CLEVO1400: - case CUT_CLEVO14002: - gotitfrompci = true; - dochiptest = false; - delay = 0x02; - break; - case CUT_CLEVO1024: - case CUT_CLEVO10242: - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - gotitfrompci = true; - dochiptest = false; - delay = 0x33; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2D,delay); - delay &= 0x0f; - } - break; - } - - /* Could we find it through the PCI ID? If no, use ROM or table */ - - if(!gotitfrompci) { - - index = GetLCDPtrIndexBIOS(SiS_Pr); - myindex = GetLCDPtrIndex(SiS_Pr); - - if(IS_SIS650 && (SiS_Pr->SiS_VBType & VB_SISLVDS)) { - - if(SiS_IsNotM650orLater(SiS_Pr)) { - - if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) { - /* Always use the second pointer on 650; some BIOSes */ - /* still carry old 301 data at the first location */ - /* romptr = SISGETROMW(0x120); */ - /* if(SiS_Pr->SiS_VBType & VB_SIS302LV) */ - romptr = SISGETROMW(0x122); - if(!romptr) return; - delay = ROMAddr[(romptr + index)]; - } else { - delay = SiS310_LCDDelayCompensation_650301LV[myindex]; - } - - } else { - - delay = SiS310_LCDDelayCompensation_651301LV[myindex]; - if(SiS_Pr->SiS_VBType & (VB_SIS302LV | VB_SIS302ELV)) - delay = SiS310_LCDDelayCompensation_651302LV[myindex]; - - } - - } else if(SiS_Pr->SiS_UseROM && - (!(SiS_Pr->SiS_ROMNew)) && - (SiS_Pr->SiS_LCDResInfo != Panel_1280x1024) && - (SiS_Pr->SiS_LCDResInfo != Panel_1280x768) && - (SiS_Pr->SiS_LCDResInfo != Panel_1280x960) && - (SiS_Pr->SiS_LCDResInfo != Panel_1600x1200) && - ((romptr = GetLCDromptr(SiS_Pr)))) { - - /* Data for 1280x1024 wrong in 301B BIOS */ - /* Data for 1600x1200 wrong in 301C BIOS */ - delay = ROMAddr[(romptr + index)]; - - } else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - - if(IS_SIS740) delay = 0x03; - else delay = 0x00; - - } else { - - delay = SiS310_LCDDelayCompensation_301[myindex]; - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - if(IS_SIS740) delay = 0x01; - else if(SiS_Pr->ChipType <= SIS_315PRO) delay = SiS310_LCDDelayCompensation_3xx301LV[myindex]; - else delay = SiS310_LCDDelayCompensation_650301LV[myindex]; - } else if(SiS_Pr->SiS_VBType & VB_SIS301C) { - if(IS_SIS740) delay = 0x01; /* ? */ - else delay = 0x03; - if(SiS_Pr->SiS_LCDResInfo == Panel_1600x1200) delay = 0x00; /* experience */ - } else if(SiS_Pr->SiS_VBType & VB_SIS30xB) { - if(IS_SIS740) delay = 0x01; - else delay = SiS310_LCDDelayCompensation_3xx301B[myindex]; - } - - } - - } /* got it from PCI */ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0x0F,((delay << 4) & 0xf0)); - dochiptest = false; - } - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { /* ------------ TV */ - - index = GetTVPtrIndex(SiS_Pr); - - if(IS_SIS650 && (SiS_Pr->SiS_VBType & VB_SISLVDS)) { - - if(SiS_IsNotM650orLater(SiS_Pr)) { - - if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) { - /* Always use the second pointer on 650; some BIOSes */ - /* still carry old 301 data at the first location */ - /* romptr = SISGETROMW(0x114); */ - /* if(SiS_Pr->SiS_VBType & VB_SIS302LV) */ - romptr = SISGETROMW(0x11a); - if(!romptr) return; - delay = ROMAddr[romptr + index]; - - } else { - - delay = SiS310_TVDelayCompensation_301B[index]; - - } - - } else { - - switch(SiS_Pr->SiS_CustomT) { - case CUT_COMPAQ1280: - case CUT_COMPAQ12802: - case CUT_CLEVO1400: - case CUT_CLEVO14002: - delay = 0x02; - dochiptest = false; - break; - case CUT_CLEVO1024: - case CUT_CLEVO10242: - delay = 0x03; - dochiptest = false; - break; - default: - delay = SiS310_TVDelayCompensation_651301LV[index]; - if(SiS_Pr->SiS_VBType & VB_SIS302LV) { - delay = SiS310_TVDelayCompensation_651302LV[index]; - } - } - } - - } else if((SiS_Pr->SiS_UseROM) && (!(SiS_Pr->SiS_ROMNew))) { - - romptr = GetTVromptr(SiS_Pr); - if(!romptr) return; - delay = ROMAddr[romptr + index]; - - } else if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - - delay = SiS310_TVDelayCompensation_LVDS[index]; - - } else { - - delay = SiS310_TVDelayCompensation_301[index]; - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - if(IS_SIS740) { - delay = SiS310_TVDelayCompensation_740301B[index]; - /* LV: use 301 data? BIOS bug? */ - } else { - delay = SiS310_TVDelayCompensation_301B[index]; - if(SiS_Pr->SiS_VBType & VB_SIS301C) delay = 0x02; - } - } - - } - - if(SiS_LCDAEnabled(SiS_Pr)) { - delay &= 0x0f; - dochiptest = false; - } - - } else return; - - /* Write delay */ - - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - if(IS_SIS650 && (SiS_Pr->SiS_VBType & VB_SISLVDS) && dochiptest) { - - temp = (SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) & 0xf0) >> 4; - if(temp == 8) { /* 1400x1050 BIOS (COMPAL) */ - delay &= 0x0f; - delay |= 0xb0; - } else if(temp == 6) { - delay &= 0x0f; - delay |= 0xc0; - } else if(temp > 7) { /* 1280x1024 BIOS (which one?) */ - delay = 0x35; - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x2D,delay); - - } else { - - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0xF0,delay); - - } - - } else { /* LVDS */ - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0xF0,delay); - } else { - if(IS_SIS650 && (SiS_Pr->SiS_IF_DEF_CH70xx != 0)) { - delay <<= 4; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0x0F,delay); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2D,0xF0,delay); - } - } - - } - -} - -static void -SetAntiFlicker(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp,temp1,romptr=0; - - if(SiS_Pr->SiS_TVMode & (TVSetYPbPr750p|TVSetYPbPr525p)) return; - - if(ModeNo<=0x13) - index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].VB_StTVFlickerIndex; - else - index = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].VB_ExtTVFlickerIndex; - - temp = GetTVPtrIndex(SiS_Pr); - temp >>= 1; /* 0: NTSC/YPbPr, 1: PAL, 2: HiTV */ - temp1 = temp; - - if(SiS_Pr->SiS_UseROM && (!(SiS_Pr->SiS_ROMNew))) { - if(SiS_Pr->ChipType >= SIS_661) { - temp1 = GetOEMTVPtr661(SiS_Pr); - temp1 >>= 1; - romptr = SISGETROMW(0x260); - if(SiS_Pr->ChipType >= SIS_760) { - romptr = SISGETROMW(0x360); - } - } else if(SiS_Pr->ChipType >= SIS_330) { - romptr = SISGETROMW(0x192); - } else { - romptr = SISGETROMW(0x112); - } - } - - if(romptr) { - temp1 <<= 1; - temp = ROMAddr[romptr + temp1 + index]; - } else { - temp = SiS310_TVAntiFlick1[temp][index]; - } - temp <<= 4; - - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x0A,0x8f,temp); /* index 0A D[6:4] */ -} - -static void -SetEdgeEnhance(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp,temp1,romptr=0; - - temp = temp1 = GetTVPtrIndex(SiS_Pr) >> 1; /* 0: NTSC/YPbPr, 1: PAL, 2: HiTV */ - - if(ModeNo <= 0x13) - index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].VB_StTVEdgeIndex; - else - index = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].VB_ExtTVEdgeIndex; - - if(SiS_Pr->SiS_UseROM && (!(SiS_Pr->SiS_ROMNew))) { - if(SiS_Pr->ChipType >= SIS_661) { - romptr = SISGETROMW(0x26c); - if(SiS_Pr->ChipType >= SIS_760) { - romptr = SISGETROMW(0x36c); - } - temp1 = GetOEMTVPtr661(SiS_Pr); - temp1 >>= 1; - } else if(SiS_Pr->ChipType >= SIS_330) { - romptr = SISGETROMW(0x1a4); - } else { - romptr = SISGETROMW(0x124); - } - } - - if(romptr) { - temp1 <<= 1; - temp = ROMAddr[romptr + temp1 + index]; - } else { - temp = SiS310_TVEdge1[temp][index]; - } - temp <<= 5; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x3A,0x1F,temp); /* index 0A D[7:5] */ -} - -static void -SetYFilter(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex) -{ - unsigned short index, temp, i, j; - - if(ModeNo <= 0x13) { - index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].VB_StTVYFilterIndex; - } else { - index = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].VB_ExtTVYFilterIndex; - } - - temp = GetTVPtrIndex(SiS_Pr) >> 1; /* 0: NTSC/YPbPr, 1: PAL, 2: HiTV */ - - if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) temp = 1; /* NTSC-J uses PAL */ - else if(SiS_Pr->SiS_TVMode & TVSetPALM) temp = 3; /* PAL-M */ - else if(SiS_Pr->SiS_TVMode & TVSetPALN) temp = 4; /* PAL-N */ - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) temp = 1; /* HiVision uses PAL */ - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - for(i=0x35, j=0; i<=0x38; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVYFilter2[temp][index][j]); - } - for(i=0x48; i<=0x4A; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVYFilter2[temp][index][j]); - } - } else { - for(i=0x35, j=0; i<=0x38; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVYFilter1[temp][index][j]); - } - } -} - -static void -SetPhaseIncr(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp,i,j,resinfo,romptr=0; - unsigned int lindex; - - if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) return; - - /* NTSC-J data not in BIOS, and already set in SetGroup2 */ - if(SiS_Pr->SiS_TVMode & TVSetNTSCJ) return; - - if((SiS_Pr->ChipType >= SIS_661) || SiS_Pr->SiS_ROMNew) { - lindex = GetOEMTVPtr661_2_OLD(SiS_Pr) & 0xffff; - lindex <<= 2; - for(j=0, i=0x31; i<=0x34; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS_TVPhase[lindex + j]); - } - return; - } - - /* PAL-M, PAL-N not in BIOS, and already set in SetGroup2 */ - if(SiS_Pr->SiS_TVMode & (TVSetPALM | TVSetPALN)) return; - - if(ModeNo<=0x13) { - resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo; - } else { - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - } - - temp = GetTVPtrIndex(SiS_Pr); - /* 0: NTSC Graphics, 1: NTSC Text, 2: PAL Graphics, - * 3: PAL Text, 4: HiTV Graphics 5: HiTV Text - */ - if(SiS_Pr->SiS_UseROM) { - romptr = SISGETROMW(0x116); - if(SiS_Pr->ChipType >= SIS_330) { - romptr = SISGETROMW(0x196); - } - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - romptr = SISGETROMW(0x11c); - if(SiS_Pr->ChipType >= SIS_330) { - romptr = SISGETROMW(0x19c); - } - if((SiS_Pr->SiS_VBInfo & SetInSlaveMode) && (!(SiS_Pr->SiS_TVMode & TVSetTVSimuMode))) { - romptr = SISGETROMW(0x116); - if(SiS_Pr->ChipType >= SIS_330) { - romptr = SISGETROMW(0x196); - } - } - } - } - if(romptr) { - romptr += (temp << 2); - for(j=0, i=0x31; i<=0x34; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,ROMAddr[romptr + j]); - } - } else { - index = temp % 2; - temp >>= 1; /* 0:NTSC, 1:PAL, 2:HiTV */ - for(j=0, i=0x31; i<=0x34; i++, j++) { - if(!(SiS_Pr->SiS_VBType & VB_SIS30xBLV)) - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVPhaseIncr1[temp][index][j]); - else if((!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) || (SiS_Pr->SiS_TVMode & TVSetTVSimuMode)) - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVPhaseIncr2[temp][index][j]); - else - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS310_TVPhaseIncr1[temp][index][j]); - } - } - - if((SiS_Pr->SiS_VBType & VB_SIS30xBLV) && (!(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision))) { - if((!(SiS_Pr->SiS_TVMode & (TVSetPAL | TVSetYPbPr525p | TVSetYPbPr750p))) && (ModeNo > 0x13)) { - if((resinfo == SIS_RI_640x480) || - (resinfo == SIS_RI_800x600)) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x31,0x21); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x32,0xf0); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x33,0xf5); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x34,0x7f); - } else if(resinfo == SIS_RI_1024x768) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x31,0x1e); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x32,0x8b); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x33,0xfb); - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x34,0x7b); - } - } - } -} - -static void -SetDelayComp661(struct SiS_Private *SiS_Pr, unsigned short ModeNo, - unsigned short ModeIdIndex, unsigned short RTI) -{ - unsigned short delay = 0, romptr = 0, index, lcdpdcindex; - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - - if(!(SiS_Pr->SiS_VBInfo & (SetCRT2ToTV | SetCRT2ToLCD | SetCRT2ToLCDA | SetCRT2ToRAMDAC))) - return; - - /* 1. New ROM: VGA2 and LCD/LCDA-Pass1:1 */ - /* (If a custom mode is used, Pass1:1 is always set; hence we do this:) */ - - if(SiS_Pr->SiS_ROMNew) { - if((SiS_Pr->SiS_VBInfo & SetCRT2ToRAMDAC) || - ((SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) && - (SiS_Pr->SiS_LCDInfo & LCDPass11))) { - index = 25; - if(SiS_Pr->UseCustomMode) { - index = SiS_Pr->CSRClock; - } else if(ModeNo > 0x13) { - index = SiS_GetVCLK2Ptr(SiS_Pr,ModeNo,ModeIdIndex,RTI); - index = SiS_Pr->SiS_VCLKData[index].CLOCK; - } - if(index < 25) index = 25; - index = ((index / 25) - 1) << 1; - if((ROMAddr[0x5b] & 0x80) || (SiS_Pr->SiS_VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToLCD))) { - index++; - } - romptr = SISGETROMW(0x104); - delay = ROMAddr[romptr + index]; - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToRAMDAC | SetCRT2ToLCD)) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,((delay >> 1) & 0x0f)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,0x7f,((delay & 0x01) << 7)); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,((delay << 3) & 0xf0)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x20,0xbf,((delay & 0x01) << 6)); - } - return; - } - } - - /* 2. Old ROM: VGA2 and LCD/LCDA-Pass 1:1 */ - - if(SiS_Pr->UseCustomMode) delay = 0x04; - else if(ModeNo <= 0x13) delay = 0x04; - else delay = (SiS_Pr->SiS_RefIndex[RTI].Ext_PDC >> 4); - delay |= (delay << 8); - - if(SiS_Pr->ChipType >= XGI_20) { - - delay = 0x0606; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - - delay = 0x0404; - if(SiS_Pr->SiS_XGIROM) { - index = GetTVPtrIndex(SiS_Pr); - if((romptr = SISGETROMW(0x35e))) { - delay = (ROMAddr[romptr + index] & 0x0f) << 1; - delay |= (delay << 8); - } - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) { - if(SiS_Pr->ChipType == XGI_40 && SiS_Pr->ChipRevision == 0x02) { - delay -= 0x0404; - } - } - } - - } else if(SiS_Pr->ChipType >= SIS_340) { - - delay = 0x0606; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - delay = 0x0404; - } - /* TODO (eventually) */ - - } else if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - - /* 3. TV */ - - index = GetOEMTVPtr661(SiS_Pr); - if(SiS_Pr->SiS_ROMNew) { - romptr = SISGETROMW(0x106); - if(SiS_Pr->SiS_VBType & VB_UMC) romptr += 12; - delay = ROMAddr[romptr + index]; - } else { - delay = 0x04; - if(index > 3) delay = 0; - } - - } else if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - - /* 4. LCD, LCDA (for new ROM only LV and non-Pass 1:1) */ - - if( (SiS_Pr->SiS_LCDResInfo != Panel_Custom) && - ((romptr = GetLCDStructPtr661_2(SiS_Pr))) ) { - - lcdpdcindex = (SiS_Pr->SiS_VBType & VB_UMC) ? 14 : 12; - - /* For LVDS (and sometimes TMDS), the BIOS must know about the correct value */ - delay = ROMAddr[romptr + lcdpdcindex + 1]; /* LCD */ - delay |= (ROMAddr[romptr + lcdpdcindex] << 8); /* LCDA */ - - } else { - - /* TMDS: Set our own, since BIOS has no idea */ - /* (This is done on >=661 only, since <661 is calling this only for LVDS) */ - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - switch(SiS_Pr->SiS_LCDResInfo) { - case Panel_1024x768: delay = 0x0008; break; - case Panel_1280x720: delay = 0x0004; break; - case Panel_1280x768: - case Panel_1280x768_2:delay = 0x0004; break; - case Panel_1280x800: - case Panel_1280x800_2:delay = 0x0004; break; /* Verified for 1280x800 */ - case Panel_1280x854: delay = 0x0004; break; /* FIXME */ - case Panel_1280x1024: delay = 0x1e04; break; - case Panel_1400x1050: delay = 0x0004; break; - case Panel_1600x1200: delay = 0x0400; break; - case Panel_1680x1050: delay = 0x0e04; break; - default: - if((SiS_Pr->PanelXRes <= 1024) && (SiS_Pr->PanelYRes <= 768)) { - delay = 0x0008; - } else if((SiS_Pr->PanelXRes == 1280) && (SiS_Pr->PanelYRes == 1024)) { - delay = 0x1e04; - } else if((SiS_Pr->PanelXRes <= 1400) && (SiS_Pr->PanelYRes <= 1050)) { - delay = 0x0004; - } else if((SiS_Pr->PanelXRes <= 1600) && (SiS_Pr->PanelYRes <= 1200)) { - delay = 0x0400; - } else - delay = 0x0e04; - break; - } - } - - /* Override by detected or user-set values */ - /* (but only if, for some reason, we can't read value from BIOS) */ - if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) && (SiS_Pr->PDC != -1)) { - delay = SiS_Pr->PDC & 0x1f; - } - if((SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) && (SiS_Pr->PDCA != -1)) { - delay = (SiS_Pr->PDCA & 0x1f) << 8; - } - - } - - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - delay >>= 8; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0x0f,((delay << 3) & 0xf0)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x20,0xbf,((delay & 0x01) << 6)); - } else { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2d,0xf0,((delay >> 1) & 0x0f)); - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x35,0x7f,((delay & 0x01) << 7)); - } -} - -static void -SetCRT2SyncDither661(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short RTI) -{ - unsigned short infoflag; - unsigned char temp; - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - - if(ModeNo <= 0x13) { - infoflag = SiS_GetRegByte(SiS_Pr->SiS_P3ca+2); - } else if(SiS_Pr->UseCustomMode) { - infoflag = SiS_Pr->CInfoFlag; - } else { - infoflag = SiS_Pr->SiS_RefIndex[RTI].Ext_InfoFlag; - } - - if(!(SiS_Pr->SiS_LCDInfo & LCDPass11)) { - infoflag = SiS_GetReg(SiS_Pr->SiS_P3d4,0x37); /* No longer check D5 */ - } - - infoflag &= 0xc0; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - temp = (infoflag >> 6) | 0x0c; - if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) { - temp ^= 0x04; - if(SiS_Pr->SiS_ModeType >= Mode24Bpp) temp |= 0x10; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x1a,0xe0,temp); - } else { - temp = 0x30; - if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) temp = 0x20; - temp |= infoflag; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x19,0x0f,temp); - temp = 0; - if(SiS_Pr->SiS_LCDInfo & LCDRGB18Bit) { - if(SiS_Pr->SiS_ModeType >= Mode24Bpp) temp |= 0x80; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x1a,0x7f,temp); - } - - } -} - -static void -SetPanelParms661(struct SiS_Private *SiS_Pr) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short romptr, temp1, temp2; - - if(SiS_Pr->SiS_VBType & (VB_SISLVDS | VB_SIS30xC)) { - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x24,0x0f); - } - - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - if(SiS_Pr->LVDSHL != -1) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,SiS_Pr->LVDSHL); - } - } - - if(SiS_Pr->SiS_ROMNew) { - - if((romptr = GetLCDStructPtr661_2(SiS_Pr))) { - if(SiS_Pr->SiS_VBType & VB_SISLVDS) { - temp1 = (ROMAddr[romptr] & 0x03) | 0x0c; - temp2 = 0xfc; - if(SiS_Pr->LVDSHL != -1) { - temp1 &= 0xfc; - temp2 = 0xf3; - } - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,temp2,temp1); - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - temp1 = (ROMAddr[romptr + 1] & 0x80) >> 1; - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x0d,0xbf,temp1); - } - } - - } -} - -static void -SiS_OEM310Setting(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, unsigned short RRTI) -{ - if((SiS_Pr->SiS_ROMNew) && (SiS_Pr->SiS_VBType & VB_SISLVDS)) { - SetDelayComp661(SiS_Pr, ModeNo, ModeIdIndex, RRTI); - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - SetCRT2SyncDither661(SiS_Pr, ModeNo, RRTI); - SetPanelParms661(SiS_Pr); - } - } else { - SetDelayComp(SiS_Pr,ModeNo); - } - - if((SiS_Pr->SiS_VBType & VB_SISVB) && (SiS_Pr->SiS_VBInfo & SetCRT2ToTV)) { - SetAntiFlicker(SiS_Pr,ModeNo,ModeIdIndex); - SetPhaseIncr(SiS_Pr,ModeNo,ModeIdIndex); - SetYFilter(SiS_Pr,ModeNo,ModeIdIndex); - if(SiS_Pr->SiS_VBType & VB_SIS301) { - SetEdgeEnhance(SiS_Pr,ModeNo,ModeIdIndex); - } - } -} - -static void -SiS_OEM661Setting(struct SiS_Private *SiS_Pr, unsigned short ModeNo, - unsigned short ModeIdIndex, unsigned short RRTI) -{ - if(SiS_Pr->SiS_VBType & VB_SISVB) { - - SetDelayComp661(SiS_Pr, ModeNo, ModeIdIndex, RRTI); - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - SetCRT2SyncDither661(SiS_Pr, ModeNo, RRTI); - SetPanelParms661(SiS_Pr); - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - SetPhaseIncr(SiS_Pr, ModeNo, ModeIdIndex); - SetYFilter(SiS_Pr, ModeNo, ModeIdIndex); - SetAntiFlicker(SiS_Pr, ModeNo, ModeIdIndex); - if(SiS_Pr->SiS_VBType & VB_SIS301) { - SetEdgeEnhance(SiS_Pr, ModeNo, ModeIdIndex); - } - } - } -} - -/* FinalizeLCD - * This finalizes some CRT2 registers for the very panel used. - * If we have a backup if these registers, we use it; otherwise - * we set the register according to most BIOSes. However, this - * function looks quite different in every BIOS, so you better - * pray that we have a backup... - */ -static void -SiS_FinalizeLCD(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned short tempcl,tempch,tempbl,tempbh,tempbx,tempax,temp; - unsigned short resinfo,modeflag; - - if(!(SiS_Pr->SiS_VBType & VB_SISLVDS)) return; - if(SiS_Pr->SiS_ROMNew) return; - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(SiS_Pr->LVDSHL != -1) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,SiS_Pr->LVDSHL); - } - } - - if(SiS_Pr->SiS_LCDResInfo == Panel_Custom) return; - if(SiS_Pr->UseCustomMode) return; - - switch(SiS_Pr->SiS_CustomT) { - case CUT_COMPAQ1280: - case CUT_COMPAQ12802: - case CUT_CLEVO1400: - case CUT_CLEVO14002: - return; - } - - if(ModeNo <= 0x13) { - resinfo = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ResInfo; - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - } else { - resinfo = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_RESINFO; - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - } - - if(IS_SIS650) { - if(!(SiS_GetReg(SiS_Pr->SiS_P3d4, 0x5f) & 0xf0)) { - if(SiS_Pr->SiS_CustomT == CUT_CLEVO1024) { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x02); - } else { - SiS_SetRegOR(SiS_Pr->SiS_Part1Port,0x1e,0x03); - } - } - } - - if(SiS_Pr->SiS_CustomT == CUT_CLEVO1024) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - /* Maybe all panels? */ - if(SiS_Pr->LVDSHL == -1) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,0x01); - } - return; - } - } - - if(SiS_Pr->SiS_CustomT == CUT_CLEVO10242) { - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(SiS_Pr->LVDSHL == -1) { - /* Maybe all panels? */ - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,0x01); - } - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - tempch = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4; - if(tempch == 3) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x25); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x1b); - } - } - return; - } - } - } - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToLCDA)) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(SiS_Pr->SiS_VBType & VB_SISEMI) { - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x2a,0x00); -#ifdef SET_EMI - SiS_SetRegAND(SiS_Pr->SiS_Part4Port,0x30,0x0c); -#endif - SiS_SetReg(SiS_Pr->SiS_Part4Port,0x34,0x10); - } - } else if(SiS_Pr->SiS_LCDResInfo == Panel_1280x1024) { - if(SiS_Pr->LVDSHL == -1) { - /* Maybe ACER only? */ - SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x24,0xfc,0x01); - } - } - tempch = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) >> 4; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) { - if(SiS_Pr->SiS_LCDResInfo == Panel_1400x1050) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1f,0x76); - } else if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(tempch == 0x03) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x25); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x1b); - } - if(SiS_Pr->Backup && (SiS_Pr->Backup_Mode == ModeNo)) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,SiS_Pr->Backup_14); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x15,SiS_Pr->Backup_15); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,SiS_Pr->Backup_16); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x17,SiS_Pr->Backup_17); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,SiS_Pr->Backup_18); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,SiS_Pr->Backup_19); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1a,SiS_Pr->Backup_1a); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,SiS_Pr->Backup_1b); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,SiS_Pr->Backup_1c); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,SiS_Pr->Backup_1d); - } else if(!(SiS_Pr->SiS_LCDInfo & DontExpandLCD)) { /* 1.10.8w */ - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,0x90); - if(ModeNo <= 0x13) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x11); - if((resinfo == 0) || (resinfo == 2)) return; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x18); - if((resinfo == 1) || (resinfo == 3)) return; - } - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02); - if((ModeNo > 0x13) && (resinfo == SIS_RI_1024x768)) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x02); /* 1.10.7u */ -#if 0 - tempbx = 806; /* 0x326 */ /* other older BIOSes */ - tempbx--; - temp = tempbx & 0xff; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,temp); - temp = (tempbx >> 8) & 0x03; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x1d,0xf8,temp); -#endif - } - } else if(ModeNo <= 0x13) { - if(ModeNo <= 1) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x70); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0xff); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x48); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x12); - } - if(!(modeflag & HalfDCLK)) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x14,0x20); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x15,0x1a); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x16,0x28); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x17,0x00); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x4c); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0xdc); - if(ModeNo == 0x12) { - switch(tempch) { - case 0: - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x95); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x19,0xdc); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1a,0x10); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x95); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1c,0x48); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1d,0x12); - break; - case 2: - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,0x95); - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x48); - break; - case 3: - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x1b,0x95); - break; - } - } - } - } - } - } else { - tempcl = tempbh = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x01); - tempcl &= 0x0f; - tempbh &= 0x70; - tempbh >>= 4; - tempbl = SiS_GetReg(SiS_Pr->SiS_Part2Port,0x04); - tempbx = (tempbh << 8) | tempbl; - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if((resinfo == SIS_RI_1024x768) || (!(SiS_Pr->SiS_LCDInfo & DontExpandLCD))) { - if(SiS_Pr->SiS_SetFlag & LCDVESATiming) { - tempbx = 770; - } else { - if(tempbx > 770) tempbx = 770; - if(SiS_Pr->SiS_VGAVDE < 600) { - tempax = 768 - SiS_Pr->SiS_VGAVDE; - tempax >>= 4; /* 1.10.7w; 1.10.6s: 3; */ - if(SiS_Pr->SiS_VGAVDE <= 480) tempax >>= 4; /* 1.10.7w; 1.10.6s: < 480; >>=1; */ - tempbx -= tempax; - } - } - } else return; - } - temp = tempbx & 0xff; - SiS_SetReg(SiS_Pr->SiS_Part2Port,0x04,temp); - temp = ((tempbx & 0xff00) >> 4) | tempcl; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x01,0x80,temp); - } - } -} - -#endif - -/* ================= SiS 300 O.E.M. ================== */ - -#ifdef CONFIG_FB_SIS_300 - -static void -SetOEMLCDData2(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex, - unsigned short RefTabIndex) -{ - unsigned short crt2crtc=0, modeflag, myindex=0; - unsigned char temp; - int i; - - if(ModeNo <= 0x13) { - modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; - crt2crtc = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC; - } else { - modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; - crt2crtc = SiS_Pr->SiS_RefIndex[RefTabIndex].Ext_CRT2CRTC; - } - - crt2crtc &= 0x3f; - - if(SiS_Pr->SiS_CustomT == CUT_BARCO1024) { - SiS_SetRegAND(SiS_Pr->SiS_Part1Port,0x13,0xdf); - } - - if(SiS_Pr->SiS_CustomT == CUT_BARCO1366) { - if(modeflag & HalfDCLK) myindex = 1; - - if(SiS_Pr->SiS_SetFlag & LowModeTests) { - for(i=0; i<7; i++) { - if(barco_p1[myindex][crt2crtc][i][0]) { - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port, - barco_p1[myindex][crt2crtc][i][0], - barco_p1[myindex][crt2crtc][i][2], - barco_p1[myindex][crt2crtc][i][1]); - } - } - } - temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x00); - if(temp & 0x80) { - temp = SiS_GetReg(SiS_Pr->SiS_Part1Port,0x18); - temp++; - SiS_SetReg(SiS_Pr->SiS_Part1Port,0x18,temp); - } - } -} - -static unsigned short -GetOEMLCDPtr(struct SiS_Private *SiS_Pr, int Flag) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short tempbx=0,romptr=0; - static const unsigned char customtable300[] = { - 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff, - 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff - }; - static const unsigned char customtable630[] = { - 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff, - 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff - }; - - if(SiS_Pr->ChipType == SIS_300) { - - tempbx = SiS_GetReg(SiS_Pr->SiS_P3d4,0x36) & 0x0f; - if(SiS_Pr->SiS_VBType & VB_SIS301) tempbx &= 0x07; - tempbx -= 2; - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx += 4; - if(SiS_Pr->SiS_LCDResInfo == Panel_1024x768) { - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx += 3; - } - if(SiS_Pr->SiS_UseROM) { - if(ROMAddr[0x235] & 0x80) { - tempbx = SiS_Pr->SiS_LCDTypeInfo; - if(Flag) { - romptr = SISGETROMW(0x255); - if(romptr) tempbx = ROMAddr[romptr + SiS_Pr->SiS_LCDTypeInfo]; - else tempbx = customtable300[SiS_Pr->SiS_LCDTypeInfo]; - if(tempbx == 0xFF) return 0xFFFF; - } - tempbx <<= 1; - if(!(SiS_Pr->SiS_SetFlag & LCDVESATiming)) tempbx++; - } - } - - } else { - - if(Flag) { - if(SiS_Pr->SiS_UseROM) { - romptr = SISGETROMW(0x255); - if(romptr) tempbx = ROMAddr[romptr + SiS_Pr->SiS_LCDTypeInfo]; - else tempbx = 0xff; - } else { - tempbx = customtable630[SiS_Pr->SiS_LCDTypeInfo]; - } - if(tempbx == 0xFF) return 0xFFFF; - tempbx <<= 2; - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) tempbx += 2; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++; - return tempbx; - } - tempbx = SiS_Pr->SiS_LCDTypeInfo << 2; - if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) tempbx += 2; - if(SiS_Pr->SiS_LCDInfo & DontExpandLCD) tempbx++; - - } - - return tempbx; -} - -static void -SetOEMLCDDelay(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp,romptr=0; - - if(SiS_Pr->SiS_LCDResInfo == Panel_Custom) return; - - if(SiS_Pr->SiS_UseROM) { - if(!(ROMAddr[0x237] & 0x01)) return; - if(!(ROMAddr[0x237] & 0x02)) return; - romptr = SISGETROMW(0x24b); - } - - /* The Panel Compensation Delay should be set according to tables - * here. Unfortunately, various BIOS versions don't care about - * a uniform way using eg. ROM byte 0x220, but use different - * hard coded delays (0x04, 0x20, 0x18) in SetGroup1(). - * Thus we don't set this if the user selected a custom pdc or if - * we otherwise detected a valid pdc. - */ - if(SiS_Pr->PDC != -1) return; - - temp = GetOEMLCDPtr(SiS_Pr, 0); - - if(SiS_Pr->UseCustomMode) - index = 0; - else - index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_LCDDelayIndex; - - if(SiS_Pr->ChipType != SIS_300) { - if(romptr) { - romptr += (temp * 2); - romptr = SISGETROMW(romptr); - romptr += index; - temp = ROMAddr[romptr]; - } else { - if(SiS_Pr->SiS_VBType & VB_SISVB) { - temp = SiS300_OEMLCDDelay2[temp][index]; - } else { - temp = SiS300_OEMLCDDelay3[temp][index]; - } - } - } else { - if(SiS_Pr->SiS_UseROM && (ROMAddr[0x235] & 0x80)) { - if(romptr) { - romptr += (temp * 2); - romptr = SISGETROMW(romptr); - romptr += index; - temp = ROMAddr[romptr]; - } else { - temp = SiS300_OEMLCDDelay5[temp][index]; - } - } else { - if(SiS_Pr->SiS_UseROM) { - romptr = ROMAddr[0x249] | (ROMAddr[0x24a] << 8); - if(romptr) { - romptr += (temp * 2); - romptr = SISGETROMW(romptr); - romptr += index; - temp = ROMAddr[romptr]; - } else { - temp = SiS300_OEMLCDDelay4[temp][index]; - } - } else { - temp = SiS300_OEMLCDDelay4[temp][index]; - } - } - } - temp &= 0x3c; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,~0x3C,temp); /* index 0A D[6:4] */ -} - -static void -SetOEMLCDData(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ -#if 0 /* Unfinished; Data table missing */ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp; - - if((SiS_Pr->SiS_UseROM) { - if(!(ROMAddr[0x237] & 0x01)) return; - if(!(ROMAddr[0x237] & 0x04)) return; - /* No rom pointer in BIOS header! */ - } - - temp = GetOEMLCDPtr(SiS_Pr, 1); - if(temp == 0xFFFF) return; - - index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex]._VB_LCDHIndex; - for(i=0x14, j=0; i<=0x17; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,i,SiS300_LCDHData[temp][index][j]); - } - SiS_SetRegANDOR(SiS_SiS_Part1Port,0x1a, 0xf8, (SiS300_LCDHData[temp][index][j] & 0x07)); - - index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex]._VB_LCDVIndex; - SiS_SetReg(SiS_SiS_Part1Port,0x18, SiS300_LCDVData[temp][index][0]); - SiS_SetRegANDOR(SiS_SiS_Part1Port,0x19, 0xF0, SiS300_LCDVData[temp][index][1]); - SiS_SetRegANDOR(SiS_SiS_Part1Port,0x1A, 0xC7, (SiS300_LCDVData[temp][index][2] & 0x38)); - for(i=0x1b, j=3; i<=0x1d; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part1Port,i,SiS300_LCDVData[temp][index][j]); - } -#endif -} - -static unsigned short -GetOEMTVPtr(struct SiS_Private *SiS_Pr) -{ - unsigned short index; - - index = 0; - if(!(SiS_Pr->SiS_VBInfo & SetInSlaveMode)) index += 4; - if(SiS_Pr->SiS_VBType & VB_SISVB) { - if(SiS_Pr->SiS_VBInfo & SetCRT2ToSCART) index += 2; - else if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) index += 3; - else if(SiS_Pr->SiS_TVMode & TVSetPAL) index += 1; - } else { - if(SiS_Pr->SiS_TVMode & TVSetCHOverScan) index += 2; - if(SiS_Pr->SiS_TVMode & TVSetPAL) index += 1; - } - return index; -} - -static void -SetOEMTVDelay(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp,romptr=0; - - if(SiS_Pr->SiS_UseROM) { - if(!(ROMAddr[0x238] & 0x01)) return; - if(!(ROMAddr[0x238] & 0x02)) return; - romptr = SISGETROMW(0x241); - } - - temp = GetOEMTVPtr(SiS_Pr); - - index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVDelayIndex; - - if(romptr) { - romptr += (temp * 2); - romptr = SISGETROMW(romptr); - romptr += index; - temp = ROMAddr[romptr]; - } else { - if(SiS_Pr->SiS_VBType & VB_SISVB) { - temp = SiS300_OEMTVDelay301[temp][index]; - } else { - temp = SiS300_OEMTVDelayLVDS[temp][index]; - } - } - temp &= 0x3c; - SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x13,~0x3C,temp); -} - -static void -SetOEMAntiFlicker(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp,romptr=0; - - if(SiS_Pr->SiS_UseROM) { - if(!(ROMAddr[0x238] & 0x01)) return; - if(!(ROMAddr[0x238] & 0x04)) return; - romptr = SISGETROMW(0x243); - } - - temp = GetOEMTVPtr(SiS_Pr); - - index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVFlickerIndex; - - if(romptr) { - romptr += (temp * 2); - romptr = SISGETROMW(romptr); - romptr += index; - temp = ROMAddr[romptr]; - } else { - temp = SiS300_OEMTVFlicker[temp][index]; - } - temp &= 0x70; - SiS_SetRegANDOR(SiS_Pr->SiS_Part2Port,0x0A,0x8F,temp); -} - -static void -SetOEMPhaseIncr(struct SiS_Private *SiS_Pr, unsigned short ModeNo,unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,i,j,temp,romptr=0; - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToHiVision) return; - - if(SiS_Pr->SiS_TVMode & (TVSetNTSC1024 | TVSetNTSCJ | TVSetPALM | TVSetPALN)) return; - - if(SiS_Pr->SiS_UseROM) { - if(!(ROMAddr[0x238] & 0x01)) return; - if(!(ROMAddr[0x238] & 0x08)) return; - romptr = SISGETROMW(0x245); - } - - temp = GetOEMTVPtr(SiS_Pr); - - index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVPhaseIndex; - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - for(i=0x31, j=0; i<=0x34; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Phase2[temp][index][j]); - } - } else { - if(romptr) { - romptr += (temp * 2); - romptr = SISGETROMW(romptr); - romptr += (index * 4); - for(i=0x31, j=0; i<=0x34; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,ROMAddr[romptr + j]); - } - } else { - for(i=0x31, j=0; i<=0x34; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Phase1[temp][index][j]); - } - } - } -} - -static void -SetOEMYFilter(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex) -{ - unsigned char *ROMAddr = SiS_Pr->VirtualRomBase; - unsigned short index,temp,i,j,romptr=0; - - if(SiS_Pr->SiS_VBInfo & (SetCRT2ToSCART | SetCRT2ToHiVision | SetCRT2ToYPbPr525750)) return; - - if(SiS_Pr->SiS_UseROM) { - if(!(ROMAddr[0x238] & 0x01)) return; - if(!(ROMAddr[0x238] & 0x10)) return; - romptr = SISGETROMW(0x247); - } - - temp = GetOEMTVPtr(SiS_Pr); - - if(SiS_Pr->SiS_TVMode & TVSetPALM) temp = 8; - else if(SiS_Pr->SiS_TVMode & TVSetPALN) temp = 9; - /* NTSCJ uses NTSC filters */ - - index = SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].VB_TVYFilterIndex; - - if(SiS_Pr->SiS_VBType & VB_SIS30xBLV) { - for(i=0x35, j=0; i<=0x38; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Filter2[temp][index][j]); - } - for(i=0x48; i<=0x4A; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Filter2[temp][index][j]); - } - } else { - if((romptr) && (!(SiS_Pr->SiS_TVMode & (TVSetPALM|TVSetPALN)))) { - romptr += (temp * 2); - romptr = SISGETROMW(romptr); - romptr += (index * 4); - for(i=0x35, j=0; i<=0x38; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,ROMAddr[romptr + j]); - } - } else { - for(i=0x35, j=0; i<=0x38; i++, j++) { - SiS_SetReg(SiS_Pr->SiS_Part2Port,i,SiS300_Filter1[temp][index][j]); - } - } - } -} - -static unsigned short -SiS_SearchVBModeID(struct SiS_Private *SiS_Pr, unsigned short *ModeNo) -{ - unsigned short ModeIdIndex; - unsigned char VGAINFO = SiS_Pr->SiS_VGAINFO; - - if(*ModeNo <= 5) *ModeNo |= 1; - - for(ModeIdIndex=0; ; ModeIdIndex++) { - if(SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].ModeID == *ModeNo) break; - if(SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].ModeID == 0xFF) return 0; - } - - if(*ModeNo != 0x07) { - if(*ModeNo > 0x03) return ModeIdIndex; - if(VGAINFO & 0x80) return ModeIdIndex; - ModeIdIndex++; - } - - if(VGAINFO & 0x10) ModeIdIndex++; /* 400 lines */ - /* else 350 lines */ - return ModeIdIndex; -} - -static void -SiS_OEM300Setting(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short ModeIdIndex, - unsigned short RefTableIndex) -{ - unsigned short OEMModeIdIndex = 0; - - if(!SiS_Pr->UseCustomMode) { - OEMModeIdIndex = SiS_SearchVBModeID(SiS_Pr,&ModeNo); - if(!(OEMModeIdIndex)) return; - } - - if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) { - SetOEMLCDDelay(SiS_Pr, ModeNo, OEMModeIdIndex); - if(SiS_Pr->SiS_IF_DEF_LVDS == 1) { - SetOEMLCDData(SiS_Pr, ModeNo, OEMModeIdIndex); - } - } - if(SiS_Pr->UseCustomMode) return; - if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) { - SetOEMTVDelay(SiS_Pr, ModeNo,OEMModeIdIndex); - if(SiS_Pr->SiS_VBType & VB_SISVB) { - SetOEMAntiFlicker(SiS_Pr, ModeNo, OEMModeIdIndex); - SetOEMPhaseIncr(SiS_Pr, ModeNo, OEMModeIdIndex); - SetOEMYFilter(SiS_Pr, ModeNo, OEMModeIdIndex); - } - } -} -#endif - |