开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > Linux/Unix编程 > 查看源码
init.c
资源名称：linux-2.4.20.tar.gz　[点击查看]
上传用户：jlfgdled
上传日期：2013-04-10
资源大小：33168k
文件大小：159k
源码类别：

Linux/Unix编程

开发平台：

Unix_Linux

init.c：源码内容
  2.   SiS_Pr->SiS_SelectCRT2Rate = 0;
  3.   SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2);
  5. #ifdef LINUX_XF86
  6.   xf86DrvMsg(0, X_PROBED, "(init: VBType=0x%04x, VBInfo=0x%04x)n",
  7.                     SiS_Pr->SiS_VBType, SiS_Pr->SiS_VBInfo);
  8. #endif
  10.   if(SiS_Pr->SiS_VBInfo & SetSimuScanMode) {
  11.      if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
  12.         SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
  13.      }
  14.   }
  16.   if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
  17. SiS_Pr->SiS_SetFlag |= ProgrammingCRT2;
  18.   }
  20.   RefreshRateTableIndex = SiS_GetRatePtrCRT2(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,HwDeviceExtension);
  22.   if(!(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
  23. SiS_Pr->SiS_SetFlag &= (~ProgrammingCRT2);
  24.   }
  26.   if (RefreshRateTableIndex != 0xFFFF) {
  27.      SiS_SetSync(SiS_Pr,ROMAddr,RefreshRateTableIndex);
  28.      SiS_SetCRT1CRTC(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,RefreshRateTableIndex,HwDeviceExtension);
  29.      SiS_SetCRT1Offset(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,RefreshRateTableIndex,HwDeviceExtension);
  30.      SiS_SetCRT1VCLK(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,HwDeviceExtension,RefreshRateTableIndex);
  31.   }
  33. #ifdef SIS300
  34.   if(HwDeviceExtension->jChipType == SIS_300){
  35.       SiS_SetCRT1FIFO_300(SiS_Pr,ROMAddr,ModeNo,HwDeviceExtension,RefreshRateTableIndex);
  36.   }
  37.   if((HwDeviceExtension->jChipType == SIS_630)||
  38.      (HwDeviceExtension->jChipType == SIS_730)||
  39.      (HwDeviceExtension->jChipType == SIS_540)) {
  40.       SiS_SetCRT1FIFO_630(SiS_Pr,ROMAddr,ModeNo,HwDeviceExtension,RefreshRateTableIndex);
  41.   }
  42. #endif
  43. #ifdef SIS315H
  44.   if(HwDeviceExtension->jChipType >= SIS_315H) {
  45.       SiS_SetCRT1FIFO_310(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,HwDeviceExtension);
  46.   }
  47. #endif
  49.   SiS_SetCRT1ModeRegs(SiS_Pr,ROMAddr,HwDeviceExtension,ModeNo,ModeIdIndex,RefreshRateTableIndex);
  51.   SiS_LoadDAC(SiS_Pr,HwDeviceExtension,ROMAddr,ModeNo,ModeIdIndex);
  53. #ifndef LINUX_XF86
  54.   if(SiS_Pr->SiS_flag_clearbuffer) {
  55.         SiS_ClearBuffer(SiS_Pr,HwDeviceExtension,ModeNo);
  56.   }
  57. #endif
  59.   if(!(SiS_Pr->SiS_VBInfo & (SetSimuScanMode | SwitchToCRT2 | SetCRT2ToLCDA))) {
  60.         SiS_LongWait(SiS_Pr);
  61.         SiS_DisplayOn(SiS_Pr);
  62.   }
  63. }
  65. #ifdef LINUX_XF86
  66. void
  67. SiS_SetPitch(SiS_Private *SiS_Pr, ScrnInfoPtr pScrn, UShort BaseAddr)
  68. {
  69.    SISPtr pSiS = SISPTR(pScrn);
  71.    /* TW: We need to set pitch for CRT1 if bridge is in SlaveMode, too */
  72.    if( (pSiS->VBFlags & DISPTYPE_DISP1) ||
  73.        ( (pSiS->VBFlags & VB_VIDEOBRIDGE) &&
  74.          ( ((pSiS->VGAEngine == SIS_300_VGA) && (SiS_GetReg1(SiS_Pr->SiS_Part1Port,0x00) & 0xa0) == 0x20) ||
  75.            ((pSiS->VGAEngine == SIS_315_VGA) && (SiS_GetReg1(SiS_Pr->SiS_Part1Port,0x00) & 0x50) == 0x10) ) ) ) {
  76.     SiS_SetPitchCRT1(SiS_Pr, pScrn, BaseAddr);
  77.    }
  78.    if (pSiS->VBFlags & DISPTYPE_DISP2) {
  79.     SiS_SetPitchCRT2(SiS_Pr, pScrn, BaseAddr);
  80.    }
  81. }
  83. void
  84. SiS_SetPitchCRT1(SiS_Private *SiS_Pr, ScrnInfoPtr pScrn, UShort BaseAddr)
  85. {
  86.     SISPtr pSiS = SISPTR(pScrn);
  87.     ULong  HDisplay,temp;
  89.     HDisplay = pSiS->scrnPitch / 8;
  90.     SiS_SetReg1(SiS_Pr->SiS_P3d4, 0x13, (HDisplay & 0xFF));
  91.     temp = (SiS_GetReg1(SiS_Pr->SiS_P3c4, 0x0E) & 0xF0) | (HDisplay>>8);
  92.     SiS_SetReg1(SiS_Pr->SiS_P3c4, 0x0E, temp);
  93. }
  95. void
  96. SiS_SetPitchCRT2(SiS_Private *SiS_Pr, ScrnInfoPtr pScrn, UShort BaseAddr)
  97. {
  98.     SISPtr pSiS = SISPTR(pScrn);
  99.     ULong  HDisplay,temp;
  101.     HDisplay = pSiS->scrnPitch / 8;
  103.     /* Unlock CRT2 */
  104.     if (pSiS->VGAEngine == SIS_315_VGA)
  105.         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x2F, 0xFF, 0x01);
  106.     else
  107.         SiS_SetRegANDOR(SiS_Pr->SiS_Part1Port,0x24, 0xFF, 0x01);
  109.     SiS_SetReg1(SiS_Pr->SiS_Part1Port,0x07, (HDisplay & 0xFF));
  110.     temp = (SiS_GetReg1(SiS_Pr->SiS_Part1Port,0x09) & 0xF0) | ((HDisplay >> 8) & 0xFF);
  111.     SiS_SetReg1(SiS_Pr->SiS_Part1Port,0x09, temp);
  112. }
  113. #endif
  115. /* TW: Checked against 650/301 and 630/301B BIOS */
  116. /* TW: Re-written for 650/301LVx 1.10.6s BIOS */
  117. void
  118. SiS_GetVBType(SiS_Private *SiS_Pr, USHORT BaseAddr,PSIS_HW_DEVICE_INFO HwDeviceExtension)
  119. {
  120.   USHORT flag=0, rev=0, nolcd=0;
  122.   SiS_Pr->SiS_VBType = 0;
  124.   if(SiS_Pr->SiS_IF_DEF_LVDS == 1) return;
  126.   flag = SiS_GetReg1(SiS_Pr->SiS_Part4Port,0x00);
  128.   /* TW: Illegal values not welcome... */
  129.   if(flag > 10) return;
  131.   rev = SiS_GetReg1(SiS_Pr->SiS_Part4Port,0x01);
  133.   if (flag >= 2) {
  134.         SiS_Pr->SiS_VBType = VB_SIS302B;
  135.   } else if (flag == 1) {
  136.         SiS_Pr->SiS_VBType = VB_SIS301;
  137.         if(rev >= 0xB0) {
  138.              SiS_Pr->SiS_VBType = VB_SIS301B;
  139. if(HwDeviceExtension->jChipType >= SIS_315H) {
  140.          nolcd = SiS_GetReg1(SiS_Pr->SiS_Part4Port,0x23);
  141.                     if(!(nolcd & 0x02))
  142.                         SiS_Pr->SiS_VBType |= VB_NoLCD;
  143. }
  144.         }
  145.   }
  146.   if(SiS_Pr->SiS_VBType & (VB_SIS301B | VB_SIS302B)) {
  147.         if(rev >= 0xD0) {
  148.         SiS_Pr->SiS_VBType &= ~(VB_SIS301B | VB_SIS302B);
  149.            SiS_Pr->SiS_VBType |= VB_SIS30xLV;
  150. SiS_Pr->SiS_VBType &= ~(VB_NoLCD);
  151. if(rev >= 0xE0) {
  152.     SiS_Pr->SiS_VBType &= ~(VB_SIS30xLV);
  153.     SiS_Pr->SiS_VBType |= VB_SIS30xNEW;
  154. }
  155.         }
  156.   }
  157. }
  159. /* TW: Checked against 650/301LVx 1.10.6s */
  160. BOOLEAN
  161. SiS_SearchModeID(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT *ModeNo,USHORT *ModeIdIndex)
  162. {
  163.    UCHAR VGAINFO = SiS_Pr->SiS_VGAINFO;
  165.    if(*ModeNo <= 0x13) {
  167.       if((*ModeNo) <= 5) (*ModeNo) |= 1;
  169.       for (*ModeIdIndex=0;;(*ModeIdIndex)++) {
  170.          if (SiS_Pr->SiS_SModeIDTable[*ModeIdIndex].St_ModeID == (*ModeNo)) break;
  171.          if (SiS_Pr->SiS_SModeIDTable[*ModeIdIndex].St_ModeID == 0xFF)   return FALSE;
  172.       }
  174.       if(*ModeNo == 0x07) {
  175.           if(VGAINFO & 0x10) (*ModeIdIndex)++;   /* 400 lines */
  176.           /* else 350 lines */
  177.       }
  178.       if(*ModeNo <= 3) {
  179.          if(!(VGAINFO & 0x80)) (*ModeIdIndex)++;
  180.          if(VGAINFO & 0x10)    (*ModeIdIndex)++; /* 400 lines  */
  181.          /* else 350 lines  */
  182.       }
  183.       /* else 200 lines  */
  185.    } else {
  187.       for (*ModeIdIndex=0;;(*ModeIdIndex)++) {
  188.          if (SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == (*ModeNo)) break;
  189.          if (SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == 0xFF)   return FALSE;
  190.       }
  192.    }
  193.    return TRUE;
  194. }
  196. /* For SiS 300 oem util: Search VBModeID */
  197. BOOLEAN
  198. SiS_SearchVBModeID(SiS_Private *SiS_Pr, UCHAR *ROMAddr, USHORT *ModeNo)
  199. {
  200.    USHORT ModeIdIndex;
  201.    UCHAR VGAINFO = SiS_Pr->SiS_VGAINFO;
  203.    if(*ModeNo <= 5) *ModeNo |= 1;
  205.    for(ModeIdIndex=0; ; ModeIdIndex++) {
  206.        if (SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].ModeID == *ModeNo) break;
  207.        if (SiS_Pr->SiS_VBModeIDTable[ModeIdIndex].ModeID == 0xFF)   return FALSE;
  208.    }
  210.    if(*ModeNo != 0x07) {
  211.         if(*ModeNo > 0x03) return ((BOOLEAN)ModeIdIndex);
  212. if(VGAINFO & 0x80) return ((BOOLEAN)ModeIdIndex);
  213. ModeIdIndex++;
  214.    }
  215.    if(VGAINFO & 0x10) ModeIdIndex++;   /* 400 lines */
  216.                                /* else 350 lines */
  217.    return ((BOOLEAN)ModeIdIndex);
  218. }
  220. /* TW: Checked against 630/301B, 315 1.09 and 650/301LVx 1.10.6s BIOS */
  221. /* TW: Modified */
  222. BOOLEAN
  223. SiS_CheckMemorySize(SiS_Private *SiS_Pr, UCHAR *ROMAddr,PSIS_HW_DEVICE_INFO HwDeviceExtension,
  224.                     USHORT ModeNo,USHORT ModeIdIndex)
  225. {
  226.   USHORT memorysize,modeflag;
  227.   ULONG  temp;
  229.   if (ModeNo<=0x13) {
  230.       modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  231.   } else {
  232.       modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  233.   }
  235.   memorysize = modeflag & MemoryInfoFlag;
  236.   memorysize >>= MemorySizeShift; /* Get required memory size */
  237.   memorysize++;
  239.   temp = GetDRAMSize(SiS_Pr, HwDeviceExtension);        /* Get adapter memory size */
  240.   temp /= (1024*1024);    /* (in MB) */
  242.   if(temp < memorysize) return(FALSE);
  243.   else return(TRUE);
  244. }
  246. UCHAR
  247. SiS_GetModePtr(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex)
  248. {
  249.    UCHAR index;
  251.    if(ModeNo<=0x13) {
  252.       index = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_StTableIndex;
  253.    } else {
  254.       if(SiS_Pr->SiS_ModeType <= 0x02) index=0x1B;    /* 02 -> ModeEGA  */
  255.       else index=0x0F;
  256.    }
  257.    return index;
  258. }
  260. /* TW: Checked against 300, 650/LVDS (1.10.07, 1.10a) and 650/301LV BIOS */
  261. void
  262. SiS_SetSeqRegs(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT StandTableIndex)
  263. {
  264.    UCHAR SRdata;
  265.    USHORT i;
  267.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x00,0x03);            /* Set SR0  */
  269.    SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[0];
  271.    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
  272.        if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
  273.          SRdata |= 0x01;
  274.         }
  275.    }
  276.    if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
  277.      if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
  278.        if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
  279.          if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
  280.            SRdata |= 0x01;         /* 8 dot clock  */
  281.          }
  282.        }
  283.      }
  284.      if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
  285.        if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
  286.          SRdata |= 0x01;           /* 8 dot clock  */
  287.        }
  288.      }
  289.    }
  291.    SRdata |= 0x20;                 /* screen off  */
  293.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x01,SRdata);
  295.    for(i=02;i<=04;i++) {
  296.         SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[i-1];
  297.       SiS_SetReg1(SiS_Pr->SiS_P3c4,i,SRdata);
  298.    }
  299. }
  301. /* Checked against 300, 650/301LVx 1.10.6s and 650/LVDS 1.10.07 BIOS */
  302. void
  303. SiS_SetMiscRegs(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT StandTableIndex)
  304. {
  305.    UCHAR Miscdata;
  307.    Miscdata = SiS_Pr->SiS_StandTable[StandTableIndex].MISC;
  309.    if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
  310.       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) {
  311.         Miscdata |= 0x0C;
  312.       }
  313.     }
  315.    SiS_SetReg3(SiS_Pr->SiS_P3c2,Miscdata);
  316. }
  318. /* Checked against 300, 650/LVDS (1.10.07) and 650/301LVx (1.10.6s) BIOS (630 code still there!) */
  319. void
  320. SiS_SetCRTCRegs(SiS_Private *SiS_Pr, UCHAR *ROMAddr,PSIS_HW_DEVICE_INFO HwDeviceExtension,
  321.                 USHORT StandTableIndex)
  322. {
  323.   UCHAR CRTCdata;
  324.   USHORT i;
  326.   SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f);                       /* Unlock CRTC */
  328.   for(i=0;i<=0x18;i++) {
  329.      CRTCdata=SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i];
  330.      SiS_SetReg1(SiS_Pr->SiS_P3d4,i,CRTCdata);                     /* Set CRTC(3d4) */
  331.   }
  332.   if( ( (HwDeviceExtension->jChipType == SIS_630) ||
  333.         (HwDeviceExtension->jChipType == SIS_730) )  &&
  334.       (HwDeviceExtension->jChipRevision >= 0x30) ) {           /* for 630S0 */
  335.     if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
  336.       if(SiS_Pr->SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
  337.         SiS_SetReg1(SiS_Pr->SiS_P3d4,0x18,0xFE);
  338.       }
  339.     }
  340.   }
  341. }
  343. /* TW: Checked against 300, 650/LVDS (1.10.07), 650/301LVx (1.10.6s) and 630/301B BIOS */
  344. void
  345. SiS_SetATTRegs(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT StandTableIndex,USHORT ModeNo,
  346.                PSIS_HW_DEVICE_INFO HwDeviceExtension)
  347. {
  348.    UCHAR ARdata;
  349.    USHORT i;
  351.    for(i=0;i<=0x13;i++) {
  352.     ARdata = SiS_Pr->SiS_StandTable[StandTableIndex].ATTR[i];
  353. #if 0
  354.     if((i <= 0x0f) || (i == 0x11)) {
  355.         if(ds:489 & 0x08) {
  356.    continue;
  357.         }
  358.     }
  359. #endif
  360.     if(i == 0x13) {
  361.       if(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) {
  362.         if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)  ARdata=0;
  363.       }
  364.       if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
  365.         if(SiS_Pr->SiS_IF_DEF_CH70xx != 0) {
  366.           if(SiS_Pr->SiS_VBInfo & SetCRT2ToTV) {
  367.             if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) ARdata=0;
  368.           }
  369.         }
  370.       }
  371.       if(SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) {
  372.         if(HwDeviceExtension->jChipType >= SIS_315H) {
  373.   /* TW: From 650/LVDS 1.10.07, 1.10a; 650/301LVx 1.10.6s */
  374.   ARdata = 0;
  375. } else {
  376.           if(SiS_Pr->SiS_VBInfo & SetInSlaveMode) {
  377.      ARdata=0;
  378.           }
  379. }
  380.       }
  381.     }
  382.     SiS_GetReg2(SiS_Pr->SiS_P3da);                              /* reset 3da  */
  383.     SiS_SetReg3(SiS_Pr->SiS_P3c0,i);                            /* set index  */
  384.     SiS_SetReg3(SiS_Pr->SiS_P3c0,ARdata);                       /* set data   */
  385.    }
  386.    SiS_GetReg2(SiS_Pr->SiS_P3da);                               /* reset 3da  */
  387.    SiS_SetReg3(SiS_Pr->SiS_P3c0,0x14);                          /* set index  */
  388.    SiS_SetReg3(SiS_Pr->SiS_P3c0,0x00);                          /* set data   */
  390.    SiS_GetReg2(SiS_Pr->SiS_P3da);                               /* Enable Attribute  */
  391.    SiS_SetReg3(SiS_Pr->SiS_P3c0,0x20);
  392. }
  394. /* TW: Checked against 300, 650/LVDS (1.10.07, 1.10a) and 650/301LV BIOS */
  395. void
  396. SiS_SetGRCRegs(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT StandTableIndex)
  397. {
  398.    UCHAR GRdata;
  399.    USHORT i;
  401.    for(i=0;i<=0x08;i++) {
  402.      GRdata = SiS_Pr->SiS_StandTable[StandTableIndex].GRC[i];     /* Get GR from file */
  403.      SiS_SetReg1(SiS_Pr->SiS_P3ce,i,GRdata);                    /* Set GR(3ce) */
  404.    }
  406.    if(SiS_Pr->SiS_ModeType > ModeVGA) {
  407.      SiS_SetRegAND(SiS_Pr->SiS_P3ce,0x05,0xBF); /* 256 color disable */
  408.    }
  409. }
  411. /* TW: Checked against 650/LVDS (1.10.07, 1.10a), 650/301LVx (1.10.6s) and 630/301B BIOS */
  412. void
  413. SiS_ClearExt1Regs(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension)
  414. {
  415.   USHORT i;
  417.   for(i=0x0A;i<=0x0E;i++) SiS_SetReg1(SiS_Pr->SiS_P3c4,i,0x00);      /* Clear SR0A-SR0E */
  419.   /* TW: New from 650/LVDS/301LV BIOSes: */
  420.   if(HwDeviceExtension->jChipType >= SIS_315H) {
  421.      SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x37,0xFE);
  422.   }
  423. }
  425. /* TW: Checked against 300, 650/LVDS (1.10.07) and 650/301LV BIOS */
  426. void
  427. SiS_SetSync(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT RefreshRateTableIndex)
  428. {
  429.   USHORT sync;
  430.   USHORT temp;
  432.   sync = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag >> 8;
  434.   sync &= 0xC0;
  435.   temp = 0x2F | sync;
  436.   SiS_SetReg3(SiS_Pr->SiS_P3c2,temp);                                 /* Set Misc(3c2) */
  437. }
  439. /* TW: Checked against 300, 650/LVDS (1.10.07) and 650/301LVx (1.10.6s) BIOS */
  440. void
  441. SiS_SetCRT1CRTC(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex,
  442.                 USHORT RefreshRateTableIndex,
  443. PSIS_HW_DEVICE_INFO HwDeviceExtension)
  444. {
  445.   UCHAR  index;
  446.   USHORT tempah,i,modeflag,j;
  447. #ifdef SIS315H
  448.   USHORT temp;
  449.   USHORT ResInfo,DisplayType;
  450.   const SiS_LCDACRT1DataStruct *LCDACRT1Ptr = NULL;
  451. #endif
  453.   SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x11,0x7f); /*unlock cr0-7  */
  455.   if(ModeNo<=0x13) {
  456.         modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  457.   } else {
  458.         modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  459.   }
  461.   if((SiS_Pr->SiS_IF_DEF_LVDS == 0) && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)) {
  463. #ifdef SIS315H
  465.      /* LCDA */
  467.      temp = SiS_GetLCDACRT1Ptr(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,
  468.                        RefreshRateTableIndex,&ResInfo,&DisplayType);
  470.      switch(DisplayType) {
  471.       case Panel_800x600       : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT1800x600_1;           break;
  472.       case Panel_1024x768      : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11024x768_1;          break;
  473.       case Panel_1280x1024     : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11280x1024_1;         break;
  474.       case Panel_1400x1050     : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11400x1050_1;         break;
  475.       case Panel_1600x1200     : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11600x1200_1;         break;
  476.       case Panel_800x600 + 16  : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT1800x600_1_H;         break;
  477.       case Panel_1024x768 + 16 : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11024x768_1_H;        break;
  478.       case Panel_1280x1024 + 16: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11280x1024_1_H;       break;
  479.       case Panel_1400x1050 + 16: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11400x1050_1_H;       break;
  480.       case Panel_1600x1200 + 16: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11600x1200_1_H;       break;
  481.       case Panel_800x600 + 32  : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT1800x600_2;           break;
  482.       case Panel_1024x768 + 32 : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11024x768_2;          break;
  483.       case Panel_1280x1024 + 32: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11280x1024_2;         break;
  484.       case Panel_1400x1050 + 32: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11400x1050_2;         break;
  485.       case Panel_1600x1200 + 32: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11600x1200_2;         break;
  486.       case Panel_800x600 + 48  : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT1800x600_2_H;         break;
  487.       case Panel_1024x768 + 48 : LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11024x768_2_H;        break;
  488.       case Panel_1280x1024 + 48: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11280x1024_2_H;       break;
  489.       case Panel_1400x1050 + 48: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11400x1050_2_H;       break;
  490.       case Panel_1600x1200 + 48: LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11600x1200_2_H;       break;
  491.       default:                   LCDACRT1Ptr = SiS_Pr->SiS_LCDACRT11024x768_1;          break;
  492.      }
  494.      tempah = (LCDACRT1Ptr+ResInfo)->CR[0];
  495.      SiS_SetReg1(SiS_Pr->SiS_P3d4,0x00,tempah);
  496.      for(i=0x01,j=1;i<=0x07;i++,j++){
  497.        tempah = (LCDACRT1Ptr+ResInfo)->CR[j];
  498.        SiS_SetReg1(SiS_Pr->SiS_P3d4,i,tempah);
  499.      }
  500.      for(i=0x10,j=8;i<=0x12;i++,j++){
  501.        tempah = (LCDACRT1Ptr+ResInfo)->CR[j];
  502.        SiS_SetReg1(SiS_Pr->SiS_P3d4,i,tempah);
  503.      }
  504.      for(i=0x15,j=11;i<=0x16;i++,j++){
  505.        tempah =(LCDACRT1Ptr+ResInfo)->CR[j];
  506.        SiS_SetReg1(SiS_Pr->SiS_P3d4,i,tempah);
  507.      }
  508.      for(i=0x0A,j=13;i<=0x0C;i++,j++){
  509.        tempah = (LCDACRT1Ptr+ResInfo)->CR[j];
  510.        SiS_SetReg1(SiS_Pr->SiS_P3c4,i,tempah);
  511.      }
  513.      tempah = (LCDACRT1Ptr+ResInfo)->CR[16];
  514.      tempah &= 0x0E0;
  515.      SiS_SetReg1(SiS_Pr->SiS_P3c4,0x0E,tempah);
  517.      tempah = (LCDACRT1Ptr+ResInfo)->CR[16];
  518.      tempah &= 0x01;
  519.      tempah <<= 5;
  520.      if(modeflag & DoubleScanMode)  tempah |= 0x080;
  521.      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,~0x020,tempah);
  523. #endif
  525.   } else {
  527.      /* LVDS, 301, 301B, 301LV, 302LV, ... (non-LCDA) */
  529.      index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC;   /* Get index */
  530.      if(HwDeviceExtension->jChipType < SIS_315H) {
  531.         index &= 0x3F;
  532.      }
  534.      for(i=0,j=0;i<=07;i++,j++) {
  535.        tempah=SiS_Pr->SiS_CRT1Table[index].CR[i];
  536.        SiS_SetReg1(SiS_Pr->SiS_P3d4,j,tempah);
  537.      }
  538.      for(j=0x10;i<=10;i++,j++) {
  539.        tempah=SiS_Pr->SiS_CRT1Table[index].CR[i];
  540.        SiS_SetReg1(SiS_Pr->SiS_P3d4,j,tempah);
  541.      }
  542.      for(j=0x15;i<=12;i++,j++) {
  543.        tempah=SiS_Pr->SiS_CRT1Table[index].CR[i];
  544.        SiS_SetReg1(SiS_Pr->SiS_P3d4,j,tempah);
  545.      }
  546.      for(j=0x0A;i<=15;i++,j++) {
  547.        tempah=SiS_Pr->SiS_CRT1Table[index].CR[i];
  548.        SiS_SetReg1(SiS_Pr->SiS_P3c4,j,tempah);
  549.      }
  551.      tempah = SiS_Pr->SiS_CRT1Table[index].CR[16];
  552.      tempah &= 0xE0;
  553.      SiS_SetReg1(SiS_Pr->SiS_P3c4,0x0E,tempah);
  555.      tempah = SiS_Pr->SiS_CRT1Table[index].CR[16];
  556.      tempah &= 0x01;
  557.      tempah <<= 5;
  558.      if(modeflag & DoubleScanMode)  tempah |= 0x80;
  559.      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x09,0xDF,tempah);
  561.   }
  563.   if(SiS_Pr->SiS_ModeType > ModeVGA) SiS_SetReg1(SiS_Pr->SiS_P3d4,0x14,0x4F);
  564. }
  566. BOOLEAN
  567. SiS_GetLCDACRT1Ptr(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex,
  568.    USHORT RefreshRateTableIndex,USHORT *ResInfo,
  569.    USHORT *DisplayType)
  570.  {
  571.   USHORT tempbx=0,modeflag=0;
  572.   USHORT CRT2CRTC=0;
  574.   if(ModeNo<=0x13) {
  575.    modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  576.    CRT2CRTC = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_CRT2CRTC;
  577.   } else {
  578.    modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  579.    CRT2CRTC = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRT2CRTC;
  580.   }
  582.   tempbx = SiS_Pr->SiS_LCDResInfo;
  584.   if(SiS_Pr->SiS_LCDInfo & LCDNonExpanding) tempbx += 32;
  585.   if(modeflag & HalfDCLK)                   tempbx += 16;
  587.   *ResInfo = CRT2CRTC & 0x3F;
  588.   *DisplayType = tempbx;
  590.   return 1;
  591. }
  593. /* TW: Set offset and pitch - partly overruled by SetPitch() in XF86 */
  594. /* TW: Checked against 650/LVDS (1.10.07), 650/301LV and 315 BIOS */
  595. void
  596. SiS_SetCRT1Offset(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex,
  597.                   USHORT RefreshRateTableIndex,
  598.   PSIS_HW_DEVICE_INFO HwDeviceExtension)
  599. {
  600.    USHORT temp, DisplayUnit, infoflag;
  602.    infoflag = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
  604.    DisplayUnit = SiS_GetOffset(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,
  605.                      RefreshRateTableIndex,HwDeviceExtension);
  607.    temp = (DisplayUnit >> 8) & 0x0f;
  608.    SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0E,0xF0,temp);
  610.    temp = DisplayUnit & 0xFF;
  611.    SiS_SetReg1(SiS_Pr->SiS_P3d4,0x13,temp);
  613.    if(infoflag & InterlaceMode) DisplayUnit >>= 1;
  615.    DisplayUnit <<= 5;
  616.    temp = (DisplayUnit & 0xff00) >> 8;
  617.    if (DisplayUnit & 0xff) temp++;
  618.    temp++;
  619.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x10,temp);
  620. }
  622. /* TW: New from 650/LVDS 1.10.07, 630/301B and 630/LVDS BIOS */
  623. void
  624. SiS_ResetCRT1VCLK(SiS_Private *SiS_Pr, UCHAR *ROMAddr,PSIS_HW_DEVICE_INFO HwDeviceExtension)
  625. {
  626.    USHORT index;
  628.    /* TW: We only need to do this if Panel Link is to be
  629.     *     initialized, thus on 630/LVDS/301B, and 650/LVDS
  630.     */
  631.    if(HwDeviceExtension->jChipType >= SIS_315H) {
  632.        if (SiS_Pr->SiS_IF_DEF_LVDS == 0)  return;
  633.    } else {
  634.        if( (SiS_Pr->SiS_IF_DEF_LVDS == 0) &&
  635.            (!(SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV)) ) {
  636.    return;
  637.       }
  638.    }
  640.    if(HwDeviceExtension->jChipType >= SIS_315H) {
  641.     SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xCF,0x20);
  642.    } else {
  643.     SiS_SetReg1(SiS_Pr->SiS_P3c4,0x31,0x20);
  644.    }
  645.    index = 1;
  646.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[index].SR2B);
  647.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[index].SR2C);
  648.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2D,0x80);
  649.    if(HwDeviceExtension->jChipType >= SIS_315H) {
  650.     SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x31,0xcf,0x10);
  651.    } else {
  652.     SiS_SetReg1(SiS_Pr->SiS_P3c4,0x31,0x10);
  653.    }
  654.    index = 0;
  655.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[index].SR2B);
  656.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[index].SR2C);
  657.    SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2D,0x80);
  658. }
  660. /* TW: Checked against 300, 650/LVDS, 650/301LVx, 315, 630/301B, 630/LVDS BIOS */
  661. void
  662. SiS_SetCRT1VCLK(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex,
  663.                 PSIS_HW_DEVICE_INFO HwDeviceExtension,
  664. USHORT RefreshRateTableIndex)
  665. {
  666.   USHORT  index;
  668.   index = SiS_GetVCLK2Ptr(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,
  669.                   RefreshRateTableIndex,HwDeviceExtension);
  671.   if( (SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV)
  672.                        && (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA) ){
  674.      SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xCF);
  676.      SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VBVCLKData[index].Part4_A);
  677.      SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VBVCLKData[index].Part4_B);
  679.      if(HwDeviceExtension->jChipType >= SIS_315H) {
  680. SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2D,0x01);
  681.     } else {
  682.      SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2D,0x80);
  683.      }
  685.   } else {
  687. if(HwDeviceExtension->jChipType >= SIS_315H) {
  688.     SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x31,0xCF);
  689. } else {
  690.     SiS_SetReg1(SiS_Pr->SiS_P3c4,0x31,0x00);
  691. }
  693.      SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2B,SiS_Pr->SiS_VCLKData[index].SR2B);
  694.      SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2C,SiS_Pr->SiS_VCLKData[index].SR2C);
  696.      if(HwDeviceExtension->jChipType >= SIS_315H) {
  697.     SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2D,0x01);
  698. } else {
  699.            SiS_SetReg1(SiS_Pr->SiS_P3c4,0x2D,0x80);
  700.         }
  701.   }
  702. }
  704. #if 0  /* TW: Not used */
  705. void
  706. SiS_IsLowResolution(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex)
  707. {
  708.   USHORT ModeFlag;
  710.   SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x0F,0x7F);
  712.   if(ModeNo > 0x13) {
  713.     ModeFlag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  714.     if ((ModeFlag & HalfDCLK) && (ModeFlag & DoubleScanMode)) {
  715.       SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x0F,0x80);
  716.       SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x01,0xF7);
  717.     }
  718.   }
  719. }
  720. #endif
  722. /* TW: Checked against 300, 630/LVDS, 650/LVDS and 315 BIOS */
  723. void
  724. SiS_SetCRT1ModeRegs(SiS_Private *SiS_Pr, UCHAR *ROMAddr,PSIS_HW_DEVICE_INFO HwDeviceExtension,
  725.                     USHORT ModeNo,USHORT ModeIdIndex,USHORT RefreshRateTableIndex)
  726. {
  727.   USHORT data,data2,data3;
  728.   USHORT infoflag=0,modeflag;
  729.   USHORT resindex,xres;
  731.   if(ModeNo > 0x13) {
  732.      modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  733.      infoflag = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
  734.   } else {
  735.      modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  736.   }
  738.   SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1F,0x3F);  /* DAC pedestal */
  740.   if(ModeNo > 0x13) data = infoflag;
  741.   else data = 0;
  743.   data2 = 0;
  744.   if(ModeNo > 0x13) {
  745.     if(SiS_Pr->SiS_ModeType > 0x02) {
  746.        data2 |= 0x02;
  747.        data3 = (SiS_Pr->SiS_ModeType - ModeVGA) << 2;
  748.        data2 |= data3;
  749.     }
  750.   }
  751.   if(data & InterlaceMode) data2 |= 0x20;
  752.   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x06,0xC0, data2);
  754.   resindex = SiS_GetResInfo(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex);
  755.   if(ModeNo <= 0x13) {
  756.        xres = SiS_Pr->SiS_StResInfo[resindex].HTotal;
  757.   } else {
  758.        xres = SiS_Pr->SiS_ModeResInfo[resindex].HTotal;
  759.   }
  761.   if(HwDeviceExtension->jChipType != SIS_300) {
  762.      data = 0x0000;
  763.      if(infoflag & InterlaceMode) {
  764.         if(xres == 1024) data = 0x0035;
  765.         else data = 0x0048;
  766.      }
  767.      data2 = data & 0x00FF;
  768.      SiS_SetReg1(SiS_Pr->SiS_P3d4,0x19,data2);
  769.      data2 = (data & 0xFF00) >> 8;
  770.      SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x1a,0xFC,data2);
  771.   }
  773.   if(modeflag & HalfDCLK) {
  774.      SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x01,0x08);
  775.   }
  777.   if(HwDeviceExtension->jChipType == SIS_300) {
  778.      if(modeflag & LineCompareOff) {
  779.         SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x0F,0x08);
  780.      } else {
  781.         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x0F,0xF7);
  782.      }
  783.   } else if(HwDeviceExtension->jChipType < SIS_315H) {
  784.      if(modeflag & LineCompareOff) {
  785.         SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xB7,0x08);
  786.      } else {
  787.         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x0F,0xB7);
  788.      }
  789.      /* 630 BIOS does something for mode 0x12 here */
  790.   } else {
  791.      if(modeflag & LineCompareOff) {
  792.         SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xB7,0x08);
  793.      } else {
  794.         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x0F,0xB7);
  795.      }
  796.   }
  798.   if(HwDeviceExtension->jChipType != SIS_300) {
  799.      if(SiS_Pr->SiS_ModeType == ModeEGA) {
  800.         if(ModeNo > 0x13) {
  801.       SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x0F,0x40);
  802.         }
  803.      }
  804.   }
  806. #ifdef SIS315H
  807.   /* TW: 315 BIOS sets SR17 at this point */
  808.   if(HwDeviceExtension->jChipType == SIS_315PRO) {
  809.       data = SiS_Get310DRAMType(SiS_Pr,ROMAddr,HwDeviceExtension);
  810.       data = SiS_Pr->SiS_SR15[2][data];
  811.       if(SiS_Pr->SiS_ModeType == ModeText) {
  812.           data &= 0xc7;
  813.       } else {
  814.           data2 = SiS_GetOffset(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,
  815.                                 RefreshRateTableIndex,HwDeviceExtension);
  816.   data2 >>= 1;
  817.   if(infoflag & InterlaceMode) data2 >>= 1;
  818.   data3 = SiS_GetColorDepth(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex);
  819.   data3 >>= 1;
  820.   if(data3 == 0) data3++;
  821.   data2 /= data3;
  822.   if(data2 >= 0x50) {
  823.       data &= 0x0f;
  824.       data |= 0x50;
  825.   }
  826.       }
  827.       SiS_SetReg1(SiS_Pr->SiS_P3c4,0x17,data);
  828.   }
  829. #endif
  831.   data = 0x60;
  832.   if(SiS_Pr->SiS_ModeType != ModeText) {
  833.       data ^= 0x60;
  834.       if(SiS_Pr->SiS_ModeType != ModeEGA) {
  835.         data ^= 0xA0;
  836.       }
  837.   }
  838.   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x21,0x1F,data);
  840.   SiS_SetVCLKState(SiS_Pr,ROMAddr,HwDeviceExtension,ModeNo,RefreshRateTableIndex,ModeIdIndex);
  842. #ifdef SIS315H
  843.   if(HwDeviceExtension->jChipType >= SIS_315H) {
  844.     if(SiS_GetReg1(SiS_Pr->SiS_P3d4,0x31) & 0x40) {
  845.         SiS_SetReg1(SiS_Pr->SiS_P3d4,0x52,0x2c);
  846.     } else {
  847.         SiS_SetReg1(SiS_Pr->SiS_P3d4,0x52,0x6c);
  848.     }
  849.   }
  850. #endif
  851. }
  853. /* TW: Checked against 300, 315, 650/LVDS, 650/301LVx, 630/301B and 630/LVDS BIOS */
  854. void
  855. SiS_SetVCLKState(SiS_Private *SiS_Pr, UCHAR *ROMAddr,PSIS_HW_DEVICE_INFO HwDeviceExtension,
  856.                  USHORT ModeNo,USHORT RefreshRateTableIndex,
  857.                  USHORT ModeIdIndex)
  858. {
  859.   USHORT data, data2=0;
  860.   USHORT VCLK, index=0;
  862.   if (ModeNo <= 0x13) VCLK = 0;
  863.   else {
  864.      index = SiS_GetVCLK2Ptr(SiS_Pr,ROMAddr,ModeNo,ModeIdIndex,
  865.                RefreshRateTableIndex,HwDeviceExtension);
  866.      VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
  867.   }
  869.   if(HwDeviceExtension->jChipType < SIS_315H) { /* 300 series */
  871.     data2 = 0x00;
  872.     if(VCLK > 150) data2 |= 0x80;
  873.     SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0x7B,data2);  /* DAC speed */
  875.     data2 = 0x00;
  876.     if(VCLK >= 150) data2 |= 0x08;        /* VCLK > 150 */
  877.     SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xF7,data2);
  879.   } else {  /* 310/325 series */
  881.     data = 0;
  882.     if(VCLK >= 166) data |= 0x0c;          /* TW: Was 200; is 166 in 650 and 315 BIOSes */
  883.     SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x32,0xf3,data);
  885.     if(VCLK >= 166) { /* TW: Was 200, is 166 in 650 and 315 BIOSes */
  886.        SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x1f,0xe7);
  887.     }
  888. #if 0 /* Not done in 315 and 650/301LV/LVDS BIOSes: */
  889.     data = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x1F);    /* DAC pedestal */
  890.     data &= 0xE7;
  891.     if(VCLK<200) data |= 0x10;
  892.     SiS_SetReg1(SiS_Pr->SiS_P3c4,0x1F,data);    /* DAC pedestal */
  893. #endif
  894.   }
  896.   data2 = 0x03;
  897.   if((VCLK >= 135) && (VCLK < 160)) data2 = 0x02;
  898.   if((VCLK >= 160) && (VCLK < 260)) data2 = 0x01;
  899.   if(VCLK >= 260) data2 = 0x00;
  900.   /* disable 24bit palette RAM gamma correction  */
  901.   if(HwDeviceExtension->jChipType == SIS_540) {
  902.      if((VCLK == 203) || (VCLK < 234)) data2 = 0x02;
  903.   }
  904.   if(HwDeviceExtension->jChipType < SIS_315H) {
  905.       SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xFC,data2);   /* DAC speed */
  906.   } else {
  907.       if(HwDeviceExtension->jChipType > SIS_315PRO) {
  908.          /* TW: This "if" is done in 650/LVDS/301LV BIOSes; Not in 315 BIOS */
  909.          if(ModeNo > 0x13) data2 &= 0xfc;
  910.       }
  911.       SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x07,0xF8,data2);   /* DAC speed */
  912.   }
  913. }
  915. /* TW: Checked against 650/301LVx 1.10.6s, 315, 630/301B BIOS */
  916. void
  917. SiS_LoadDAC(SiS_Private *SiS_Pr,PSIS_HW_DEVICE_INFO HwDeviceExtension,
  918.             UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex)
  919. {
  920.    USHORT data,data2;
  921.    USHORT time,i,j,k;
  922.    USHORT m,n,o;
  923.    USHORT si,di,bx,dl;
  924.    USHORT al,ah,dh;
  925.    USHORT DACAddr, DACData, shiftflag;
  926.    const USHORT *table = NULL;
  927. #if 0
  928.    USHORT tempah,tempch,tempcl,tempdh,tempal,tempbx;
  929. #endif
  931.    if (ModeNo<=0x13)
  932.         data = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  933.    else
  934.         data = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  936. #if 0
  937.    if(!(ds:489 & 0x08)) {
  938. #endif
  940. data &= DACInfoFlag;
  941. time = 64;
  942. if(data == 0x00) table = SiS_MDA_DAC;
  943. if(data == 0x08) table = SiS_CGA_DAC;
  944. if(data == 0x10) table = SiS_EGA_DAC;
  945. if(data == 0x18) {
  946.    time = 256;
  947.    table = SiS_VGA_DAC;
  948. }
  949. if(time == 256) j = 16;
  950. else            j = time;
  952. if( ( (HwDeviceExtension->jChipType < SIS_315H) &&         /* 630/301B */
  953.       (SiS_Pr->SiS_VBType & VB_SIS301BLV302BLV) &&
  954.       (SiS_Pr->SiS_VBInfo & SetCRT2ToLCD) )         ||
  955.     (SiS_Pr->SiS_VBInfo & SetCRT2ToLCDA)            ||     /* LCDA */
  956.     (!(SiS_Pr->SiS_SetFlag & ProgrammingCRT2)) ) {         /* Programming CRT1 */
  957.    DACAddr = SiS_Pr->SiS_P3c8;
  958.    DACData = SiS_Pr->SiS_P3c9;
  959.    shiftflag = 0;
  960.    SiS_SetReg3(SiS_Pr->SiS_P3c6,0xFF);
  961. } else {
  962.    shiftflag = 1;
  963.    DACAddr = SiS_Pr->SiS_Part5Port;
  964.    DACData = SiS_Pr->SiS_Part5Port + 1;
  965. }
  967. SiS_SetReg3(DACAddr,0x00);
  969. for(i=0; i<j; i++) {
  970.    data = table[i];
  971.    for(k=0; k<3; k++) {
  972. data2 = 0;
  973. if(data & 0x01) data2 = 0x2A;
  974. if(data & 0x02) data2 += 0x15;
  975. if(shiftflag) data2 <<= 2;
  976. SiS_SetReg3(DACData,data2);
  977. data >>= 2;
  978.    }
  979. }
  981. if(time == 256) {
  982.    for(i = 16; i < 32; i++) {
  983. data = table[i];
  984. if(shiftflag) data <<= 2;
  985. for(k=0; k<3; k++) SiS_SetReg3(DACData,data);
  986.    }
  987.    si = 32;
  988.    for(m = 0; m < 9; m++) {
  989.       di = si;
  990.       bx = si + 4;
  991.       dl = 0;
  992.       for(n = 0; n < 3; n++) {
  993.  for(o = 0; o < 5; o++) {
  994.     dh = table[si];
  995.     ah = table[di];
  996.     al = table[bx];
  997.     si++;
  998.     SiS_WriteDAC(SiS_Pr,DACData,shiftflag,dl,ah,al,dh);
  999.  }
  1000.  si -= 2;
  1001.  for(o = 0; o < 3; o++) {
  1002.     dh = table[bx];
  1003.     ah = table[di];
  1004.     al = table[si];
  1005.     si--;
  1006.     SiS_WriteDAC(SiS_Pr,DACData,shiftflag,dl,ah,al,dh);
  1007.  }
  1008.  dl++;
  1009.       }            /* for n < 3 */
  1010.       si += 5;
  1011.    }               /* for m < 9 */
  1012. }
  1013. #if 0
  1014.     }  /* ds:489 & 0x08 */
  1015. #endif
  1017. #if 0
  1018.     if((!(ds:489 & 0x08)) && (ds:489 & 0x06)) {
  1019.            tempbx = 0;
  1020.    for(i=0; i< 256; i++) {
  1021.                SiS_SetReg3(SiS_Pr->SiS_P3c8-1,tempbx);     /* 7f87 */
  1022.                tempah = SiS_GetReg3(SiS_Pr->SiS_P3c8+1);   /* 7f83 */
  1023.        tempch = SiS_GetReg3(SiS_Pr->SiS_P3c8+1);
  1024.        tempcl = SiS_GetReg3(SiS_Pr->SiS_P3c8+1);
  1025.        tempdh = tempah;
  1026.        tempal = 0x4d * tempdh;           /* 7fb8 */
  1027.        tempbx += tempal;
  1028.        tempal = 0x97 * tempch;
  1029.        tempbx += tempal;
  1030.        tempal = 0x1c * tempcl;
  1031.        tempbx += tempal;
  1032.        if((tempbx & 0x00ff) > 0x80) tempbx += 0x100;
  1033.        tempdh = (tempbx & 0x00ff) >> 8;
  1034.        tempch = tempdh;
  1035.        tempcl = tempdh;
  1036.        SiS_SetReg3(SiS_Pr->SiS_P3c8,(tempbx & 0xff));   /* 7f7c */
  1037.        SiS_SetReg3(SiS_Pr->SiS_P3c8+1,tempdh);          /* 7f92 */
  1038.        SiS_SetReg3(SiS_Pr->SiS_P3c8+1,tempch);
  1039.        SiS_SetReg3(SiS_Pr->SiS_P3c8+1,tempcl);
  1040.            }
  1041.     }
  1042. #endif
  1043. }
  1045. void
  1046. SiS_WriteDAC(SiS_Private *SiS_Pr, USHORT DACData, USHORT shiftflag,
  1047.              USHORT dl, USHORT ah, USHORT al, USHORT dh)
  1048. {
  1049.   USHORT temp;
  1050.   USHORT bh,bl;
  1052.   bh = ah;
  1053.   bl = al;
  1054.   if(dl != 0) {
  1055.     temp = bh;
  1056.     bh = dh;
  1057.     dh = temp;
  1058.     if(dl == 1) {
  1059.        temp = bl;
  1060.        bl = dh;
  1061.        dh = temp;
  1062.     } else {
  1063.        temp = bl;
  1064.        bl = bh;
  1065.        bh = temp;
  1066.     }
  1067.   }
  1068.   if(shiftflag) {
  1069.      dh <<= 2;
  1070.      bh <<= 2;
  1071.      bl <<= 2;
  1072.   }
  1073.   SiS_SetReg3(DACData,(USHORT)dh);
  1074.   SiS_SetReg3(DACData,(USHORT)bh);
  1075.   SiS_SetReg3(DACData,(USHORT)bl);
  1076. }
  1078. ULONG
  1079. GetDRAMSize(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension)
  1080. {
  1081.   ULONG   AdapterMemorySize = 0;
  1082. #ifdef SIS315H
  1083.   USHORT  counter;
  1084. #endif
  1086. #ifdef SIS315H
  1087.   if ((HwDeviceExtension->jChipType == SIS_315H) ||
  1088.       (HwDeviceExtension->jChipType == SIS_315PRO)) {
  1089.      counter = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x14);
  1090. AdapterMemorySize = 1 << ((counter & 0xF0) >> 4);
  1091. counter >>= 2;
  1092. counter &= 0x03;
  1093. if(counter == 0x02) {
  1094. AdapterMemorySize += (AdapterMemorySize / 2);      /* DDR asymetric */
  1095. } else if(counter != 0) {
  1096. AdapterMemorySize <<= 1;                           /* SINGLE_CHANNEL_2_RANK or DUAL_CHANNEL_1_RANK */
  1097. }
  1098. AdapterMemorySize *= (1024*1024);
  1100.   } else if((HwDeviceExtension->jChipType == SIS_550) ||
  1101.             (HwDeviceExtension->jChipType == SIS_640) ||
  1102.             (HwDeviceExtension->jChipType == SIS_740) ||
  1103.             (HwDeviceExtension->jChipType == SIS_650)) {
  1104.        counter = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x14) & 0x3F;
  1105.        counter++;
  1106.        AdapterMemorySize = counter * 4;
  1107.        AdapterMemorySize *= (1024*1024);
  1108.   }
  1109. #endif
  1111. #ifdef SIS300
  1112.   if ((HwDeviceExtension->jChipType==SIS_300) ||
  1113.       (HwDeviceExtension->jChipType==SIS_540) ||
  1114.       (HwDeviceExtension->jChipType==SIS_630) ||
  1115.       (HwDeviceExtension->jChipType==SIS_730)) {
  1116.        AdapterMemorySize = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x14) & 0x3F;
  1117.        AdapterMemorySize++;
  1118.        AdapterMemorySize *= (1024*1024);
  1119.   }
  1120. #endif
  1122.   return AdapterMemorySize;
  1123. }
  1125. #ifndef LINUX_XF86
  1126. void
  1127. SiS_ClearBuffer(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension,USHORT ModeNo)
  1128. {
  1129.   PVOID   VideoMemoryAddress = (PVOID)HwDeviceExtension->pjVideoMemoryAddress;
  1130.   ULONG   AdapterMemorySize  = (ULONG)HwDeviceExtension->ulVideoMemorySize;
  1131.   PUSHORT pBuffer;
  1132.   int i;
  1134.   if (SiS_Pr->SiS_ModeType>=ModeEGA) {
  1135.     if(ModeNo > 0x13) {
  1136.       AdapterMemorySize = GetDRAMSize(SiS_Pr, HwDeviceExtension);
  1137.       SiS_SetMemory(VideoMemoryAddress,AdapterMemorySize,0);
  1138.     } else {
  1139.       pBuffer = VideoMemoryAddress;
  1140.       for(i=0; i<0x4000; i++)
  1141.          pBuffer[i] = 0x0000;
  1142.     }
  1143.   } else {
  1144.     pBuffer = VideoMemoryAddress;
  1145.     if (SiS_Pr->SiS_ModeType < ModeCGA) {
  1146.       for(i=0; i<0x4000; i++)
  1147.          pBuffer[i] = 0x0720;
  1148.     } else {
  1149.       SiS_SetMemory(VideoMemoryAddress,0x8000,0);
  1150.     }
  1151.   }
  1152. }
  1153. #endif
  1155. void
  1156. SiS_DisplayOn(SiS_Private *SiS_Pr)
  1157. {
  1158.    SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x01,0xDF,0x00);
  1159. }
  1161. void
  1162. SiS_DisplayOff(SiS_Private *SiS_Pr)
  1163. {
  1164.    SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x01,0xDF,0x20);
  1165. }
  1168. /* ========================================== */
  1169. /*  SR CRTC GR */
  1170. void
  1171. SiS_SetReg1(USHORT port, USHORT index, USHORT data)
  1172. {
  1173.    OutPortByte(port,index);
  1174.    OutPortByte(port+1,data);
  1175. }
  1177. /* ========================================== */
  1178. /*  AR(3C0) */
  1179. void
  1180. SiS_SetReg2(SiS_Private *SiS_Pr, USHORT port, USHORT index, USHORT data)
  1181. {
  1182.    InPortByte(port+0x3da-0x3c0);
  1183.    OutPortByte(SiS_Pr->SiS_P3c0,index);
  1184.    OutPortByte(SiS_Pr->SiS_P3c0,data);
  1185.    OutPortByte(SiS_Pr->SiS_P3c0,0x20);
  1186. }
  1188. void
  1189. SiS_SetReg3(USHORT port, USHORT data)
  1190. {
  1191.    OutPortByte(port,data);
  1192. }
  1194. void
  1195. SiS_SetReg4(USHORT port, ULONG data)
  1196. {
  1197.    OutPortLong(port,data);
  1198. }
  1200. UCHAR SiS_GetReg1(USHORT port, USHORT index)
  1201. {
  1202.    UCHAR   data;
  1204.    OutPortByte(port,index);
  1205.    data = InPortByte(port+1);
  1207.    return(data);
  1208. }
  1210. UCHAR
  1211. SiS_GetReg2(USHORT port)
  1212. {
  1213.    UCHAR   data;
  1215.    data= InPortByte(port);
  1217.    return(data);
  1218. }
  1220. ULONG
  1221. SiS_GetReg3(USHORT port)
  1222. {
  1223.    ULONG   data;
  1225.    data = InPortLong(port);
  1227.    return(data);
  1228. }
  1230. void
  1231. SiS_ClearDAC(SiS_Private *SiS_Pr, ULONG port)
  1232. {
  1233.    int i;
  1235.    OutPortByte(port, 0);
  1236.    port++;
  1237.    for (i=0; i < (256 * 3); i++) {
  1238.       OutPortByte(port, 0);
  1239.    }
  1241. }
  1243. #if 0  /* TW: Unused */
  1244. void
  1245. SiS_SetInterlace(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT RefreshRateTableIndex)
  1246. {
  1247.   ULONG Temp;
  1248.   USHORT data,Temp2;
  1250.   if (ModeNo<=0x13) return;
  1252.   Temp = (ULONG)SiS_GetReg1(SiS_Pr->SiS_P3d4,0x01);
  1253.   Temp++;
  1254.   Temp <<= 3;
  1256.   if(Temp == 1024) data = 0x0035;
  1257.   else if(Temp == 1280) data = 0x0048;
  1258.   else data = 0x0000;
  1260.   Temp2 = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
  1261.   Temp2 &= InterlaceMode;
  1262.   if(Temp2 == 0) data=0x0000;
  1264.   SiS_SetReg1(SiS_Pr->SiS_P3d4,0x19,data);
  1266.   Temp = (ULONG)SiS_GetReg1(SiS_Pr->SiS_P3d4,0x1A);
  1267.   Temp = (USHORT)(Temp & 0xFC);
  1268.   SiS_SetReg1(SiS_Pr->SiS_P3d4,0x1A,(USHORT)Temp);
  1270.   Temp = (ULONG)SiS_GetReg1(SiS_Pr->SiS_P3c4,0x0f);
  1271.   Temp2 = (USHORT)Temp & 0xBF;
  1272.   if(ModeNo==0x37) Temp2 |= 0x40;
  1273.   SiS_SetReg1(SiS_Pr->SiS_P3d4,0x1A,(USHORT)Temp2);
  1274. }
  1275. #endif
  1277. /* TW: Checked against 650/LVDS (1.10.07), 650/301LVx (1.10.6s) and 315 BIOS */
  1278. #ifdef SIS315H
  1279. void
  1280. SiS_SetCRT1FIFO_310(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,USHORT ModeIdIndex,
  1281.                 PSIS_HW_DEVICE_INFO HwDeviceExtension)
  1282. {
  1283.   USHORT modeflag;
  1285.   SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x3D,0xFE);  /* disable auto-threshold */
  1287.   if(ModeNo > 0x13) {
  1288.     modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  1289.     if( (!(modeflag & DoubleScanMode)) || (!(modeflag & HalfDCLK))) {
  1290.        SiS_SetReg1(SiS_Pr->SiS_P3c4,0x08,0x34);
  1291.        SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x09,0xF0);
  1292.        SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x3D,0x01);
  1293.     } else {
  1294.        SiS_SetReg1(SiS_Pr->SiS_P3c4,0x08,0xAE);
  1295.        SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x09,0xF0);
  1296.     }
  1297.   } else {
  1298.     SiS_SetReg1(SiS_Pr->SiS_P3c4,0x08,0xAE);
  1299.     SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x09,0xF0);
  1300.   }
  1301. }
  1302. #endif
  1304. #ifdef SIS300
  1305. void
  1306. SiS_SetCRT1FIFO_300(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,PSIS_HW_DEVICE_INFO HwDeviceExtension,
  1307.                     USHORT RefreshRateTableIndex)
  1308. {
  1309.   USHORT  ThresholdLow = 0;
  1310.   USHORT  index, VCLK, MCLK, colorth=0;
  1311.   USHORT  tempah, temp;
  1313.   if(ModeNo > 0x13) {
  1315.      index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
  1316.      index &= 0x3F;
  1317.      VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;             /* Get VCLK  */
  1319.      switch (SiS_Pr->SiS_ModeType - ModeEGA) {     /* Get half colordepth */
  1320.         case 0 : colorth = 1; break;
  1321.         case 1 : colorth = 1; break;
  1322.         case 2 : colorth = 2; break;
  1323.         case 3 : colorth = 2; break;
  1324.         case 4 : colorth = 3; break;
  1325.         case 5 : colorth = 4; break;
  1326.      }
  1328.      index = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x3A);
  1329.      index &= 0x07;
  1330.      MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK;           /* Get MCLK  */
  1332.      tempah = SiS_GetReg1(SiS_Pr->SiS_P3d4,0x35);
  1333.      tempah &= 0xc3;
  1334.      SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3c,tempah);
  1336.      do {
  1337.         ThresholdLow = SiS_CalcDelay(SiS_Pr, ROMAddr, VCLK, colorth, MCLK);
  1338.         ThresholdLow++;
  1339.         if(ThresholdLow < 0x13) break;
  1340.         SiS_SetRegAND(SiS_Pr->SiS_P3c4,0x16,0xfc);
  1341.         ThresholdLow = 0x13;
  1342.         tempah = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x16);
  1343.         tempah >>= 6;
  1344.         if(!(tempah)) break;
  1345.         tempah--;
  1346.         tempah <<= 6;
  1347.         SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x16,0x3f,tempah);
  1348.      } while(0);
  1350.   } else ThresholdLow = 2;
  1352.   /* Write CRT/CPU threshold low, CRT/Engine threshold high */
  1353.   temp = (ThresholdLow << 4) | 0x0f;
  1354.   SiS_SetReg1(SiS_Pr->SiS_P3c4,0x08,temp);
  1356.   temp = (ThresholdLow & 0x10) << 1;
  1357.   if(ModeNo > 0x13) temp |= 0x40;
  1358.   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0f,0x9f,temp);
  1360.   /* What is this? */
  1361.   SiS_SetReg1(SiS_Pr->SiS_P3c4,0x3B,0x09);
  1363.   /* Write CRT/CPU threshold high */
  1364.   temp = ThresholdLow + 3;
  1365.   if(temp > 0x0f) temp = 0x0f;
  1366.   SiS_SetReg1(SiS_Pr->SiS_P3c4,0x09,temp);
  1367. }
  1369. USHORT
  1370. SiS_CalcDelay(SiS_Private *SiS_Pr, UCHAR *ROMAddr, USHORT VCLK, USHORT colordepth, USHORT MCLK)
  1371. {
  1372.   USHORT tempax, tempbx;
  1374.   tempbx = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 0);
  1375.   tempax = SiS_DoCalcDelay(SiS_Pr, MCLK, VCLK, colordepth, 1);
  1376.   if(tempax < 4) tempax = 4;
  1377.   tempax -= 4;
  1378.   if(tempbx < tempax) tempbx = tempax;
  1379.   return(tempbx);
  1380. }
  1382. USHORT
  1383. SiS_DoCalcDelay(SiS_Private *SiS_Pr, USHORT MCLK, USHORT VCLK, USHORT colordepth, USHORT key)
  1384. {
  1385.   const UCHAR ThLowA[]   = { 61, 3,52, 5,68, 7,100,11,
  1386.                              43, 3,42, 5,54, 7, 78,11,
  1387.                              34, 3,37, 5,47, 7, 67,11 };
  1389.   const UCHAR ThLowB[]   = { 81, 4,72, 6,88, 8,120,12,
  1390.                              55, 4,54, 6,66, 8, 90,12,
  1391.                              42, 4,45, 6,55, 8, 75,12 };
  1393.   const UCHAR ThTiming[] = {  1, 2, 2, 3, 0, 1,  1, 2 };
  1395.   USHORT tempah, tempal, tempcl, tempbx, temp;
  1396.   ULONG  longtemp;
  1398.   tempah = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x18);
  1399.   tempah &= 0x62;
  1400.   tempah >>= 1;
  1401.   tempal = tempah;
  1402.   tempah >>= 3;
  1403.   tempal |= tempah;
  1404.   tempal &= 0x07;
  1405.   tempcl = ThTiming[tempal];
  1406.   tempbx = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x16);
  1407.   tempbx >>= 6;
  1408.   tempah = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x14);
  1409.   tempah >>= 4;
  1410.   tempah &= 0x0c;
  1411.   tempbx |= tempah;
  1412.   tempbx <<= 1;
  1413.   if(key == 0) {
  1414.      tempal = ThLowA[tempbx + 1];
  1415.      tempal *= tempcl;
  1416.      tempal += ThLowA[tempbx];
  1417.   } else {
  1418.      tempal = ThLowB[tempbx + 1];
  1419.      tempal *= tempcl;
  1420.      tempal += ThLowB[tempbx];
  1421.   }
  1422.   longtemp = tempal * VCLK * colordepth;
  1423.   temp = longtemp % (MCLK * 16);
  1424.   longtemp /= (MCLK * 16);
  1425.   if(temp) longtemp++;
  1426.   return((USHORT)longtemp);
  1427. }
  1429. #if 0  /* TW: Old fragment, unused */
  1430. USHORT
  1431. SiS_CalcDelay(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT key)
  1432. {
  1433.   USHORT data,data2,temp0,temp1;
  1434.   UCHAR   ThLowA[]=   {61,3,52,5,68,7,100,11,
  1435.                        43,3,42,5,54,7, 78,11,
  1436.                        34,3,37,5,47,7, 67,11};
  1438.   UCHAR   ThLowB[]=   {81,4,72,6,88,8,120,12,
  1439.                        55,4,54,6,66,8, 90,12,
  1440.                        42,4,45,6,55,8, 75,12};
  1442.   UCHAR   ThTiming[]= {1,2,2,3,0,1,1,2};
  1444.   data=SiS_GetReg1(SiS_Pr->SiS_P3c4,0x16);
  1445.   data=data>>6;
  1446.   data2=SiS_GetReg1(SiS_Pr->SiS_P3c4,0x14);
  1447.   data2=(data2>>4)&0x0C;
  1448.   data=data|data2;
  1449.   data=data<1;
  1450.   if(key==0) {
  1451.     temp0=(USHORT)ThLowA[data];
  1452.     temp1=(USHORT)ThLowA[data+1];
  1453.   } else {
  1454.     temp0=(USHORT)ThLowB[data];
  1455.     temp1=(USHORT)ThLowB[data+1];
  1456.   }
  1458.   data2=0;
  1459.   data=SiS_GetReg1(SiS_Pr->SiS_P3c4,0x18);
  1460.   if(data&0x02) data2=data2|0x01;
  1461.   if(data&0x20) data2=data2|0x02;
  1462.   if(data&0x40) data2=data2|0x04;
  1464.   data=temp1*ThTiming[data2]+temp0;
  1465.   return(data);
  1466. }
  1467. #endif
  1469. void
  1470. SiS_SetCRT1FIFO_630(SiS_Private *SiS_Pr, UCHAR *ROMAddr,USHORT ModeNo,PSIS_HW_DEVICE_INFO HwDeviceExtension,
  1471.                     USHORT RefreshRateTableIndex)
  1472. {
  1473.   USHORT  i,index,data,VCLK,MCLK,colorth=0;
  1474.   ULONG   B,eax,bl,data2;
  1475.   USHORT  ThresholdLow=0;
  1476.   UCHAR   FQBQData[]= { 0x01,0x21,0x41,0x61,0x81,
  1477.                         0x31,0x51,0x71,0x91,0xb1,
  1478.                         0x00,0x20,0x40,0x60,0x80,
  1479.                         0x30,0x50,0x70,0x90,0xb0,0xFF};
  1481.   i=0;
  1482.   if(ModeNo >= 0x13) {
  1483.     index = SiS_Pr->SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
  1484.     index &= 0x3F;
  1485.     VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;             /* Get VCLK  */
  1487.     index = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x1A);
  1488.     index &= 0x07;
  1489.     MCLK = SiS_Pr->SiS_MCLKData_0[index].CLOCK;           /* Get MCLK  */
  1491.     data2 = SiS_Pr->SiS_ModeType - ModeEGA;   /* Get half colordepth */
  1492.     switch (data2) {
  1493.         case 0 : colorth = 1; break;
  1494.         case 1 : colorth = 1; break;
  1495.         case 2 : colorth = 2; break;
  1496.         case 3 : colorth = 2; break;
  1497.         case 4 : colorth = 3; break;
  1498.         case 5 : colorth = 4; break;
  1499.     }
  1501.     do{
  1502.        B = SiS_CalcDelay2(SiS_Pr, ROMAddr, FQBQData[i]) * VCLK * colorth;
  1503.        bl = B / (MCLK * 16);
  1505.        if (B==bl*16*MCLK) {
  1506.          bl = bl + 1;
  1507.        } else {
  1508.          bl = bl + 2;
  1509.        }
  1511.        if(bl > 0x13) {
  1512.           if(FQBQData[i+1] == 0xFF) {
  1513.              ThresholdLow = 0x13;
  1514.              break;
  1515.           }
  1516.           i++;
  1517.        } else {
  1518.           ThresholdLow = bl;
  1519.           break;
  1520.        }
  1521.     } while(FQBQData[i] != 0xFF);
  1522.   }
  1523.   else {
  1524.     ThresholdLow = 0x02;
  1525.   }
  1527.   /* Write foreground and background queue */
  1528.   data2 = FQBQData[i];
  1529.   data2 = (data2 & 0xf0)>>4;
  1530.   data2 <<= 24;
  1532. #ifndef LINUX_XF86
  1533.   SiS_SetReg4(0xcf8,0x80000050);
  1534.   eax = SiS_GetReg3(0xcfc);
  1535.   eax &= 0xf0ffffff;
  1536.   eax |= data2;
  1537.   SiS_SetReg4(0xcfc,eax);
  1538. #else
  1539.   /* We use pci functions X offers. We use pcitag 0, because
  1540.    * we want to read/write to the host bridge (which is always
  1541.    * 00:00.0 on 630, 730 and 540), not the VGA device.
  1542.    */
  1543.   eax = pciReadLong(0x00000000, 0x50);
  1544.   eax &= 0xf0ffffff;
  1545.   eax |= data2;
  1546.   pciWriteLong(0x00000000, 0x50, eax);
  1547. #endif
  1549.   /* TODO: write GUI grant timer (PCI config 0xA3) */
  1551.   /* Write CRT/CPU threshold low, CRT/Engine threshold high */
  1552.   data = ((ThresholdLow & 0x0f) << 4) | 0x0f;
  1553.   SiS_SetReg1(SiS_Pr->SiS_P3c4,0x08,data);
  1555.   data = (ThresholdLow & 0x10) << 1;
  1556.   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x0F,0xDF,data);
  1558.   /* What is this? */
  1559.   SiS_SetReg1(SiS_Pr->SiS_P3c4,0x3B,0x09);
  1561.   /* Write CRT/CPU threshold high (gap = 3) */
  1562.   data = ThresholdLow + 3;
  1563.   if(data > 0x0f) data = 0x0f;
  1564.   SiS_SetRegANDOR(SiS_Pr->SiS_P3c4,0x09,0x80,data);
  1565. }
  1567. USHORT
  1568. SiS_CalcDelay2(SiS_Private *SiS_Pr, UCHAR *ROMAddr,UCHAR key)
  1569. {
  1570.   USHORT data,index;
  1571.   UCHAR  LatencyFactor[] ={ 97, 88, 86, 79, 77, 00,       /*; 64  bit    BQ=2   */
  1572.                             00, 87, 85, 78, 76, 54,       /*; 64  bit    BQ=1   */
  1573.                             97, 88, 86, 79, 77, 00,       /*; 128 bit    BQ=2   */
  1574.                             00, 79, 77, 70, 68, 48,       /*; 128 bit    BQ=1   */
  1575.                             80, 72, 69, 63, 61, 00,       /*; 64  bit    BQ=2   */
  1576.                             00, 70, 68, 61, 59, 37,       /*; 64  bit    BQ=1   */
  1577.                             86, 77, 75, 68, 66, 00,       /*; 128 bit    BQ=2   */
  1578.                             00, 68, 66, 59, 57, 37};      /*; 128 bit    BQ=1   */
  1580.   index = (key & 0xE0) >> 5;
  1581.   if(key & 0x10) index +=6;
  1582.   if(!(key & 0x01)) index += 24;
  1583.   data = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x14);
  1584.   if(data & 0x0080) index += 12;
  1586.   data = LatencyFactor[index];
  1587.   return(data);
  1588. }
  1589. #endif
  1591. /* =============== Autodetection ================ */
  1592. /*             I N C O M P L E T E                */
  1594. BOOLEAN
  1595. SiS_GetPanelID(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension)
  1596. {
  1597.   const USHORT PanelTypeTable300[16] = {
  1598.       0xc101, 0xc117, 0x0121, 0xc135, 0xc142, 0xc152, 0xc162, 0xc072,
  1599.       0xc181, 0xc192, 0xc1a1, 0xc1b6, 0xc1c2, 0xc0d2, 0xc1e2, 0xc1f2
  1600.   };
  1601.   const USHORT PanelTypeTable31030x[16] = {
  1602.       0xc102, 0xc112, 0x0122, 0xc132, 0xc142, 0xc152, 0xc169, 0xc179,
  1603.       0x0189, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
  1604.   };
  1605.   const USHORT PanelTypeTable310LVDS[16] = {
  1606.       0xc111, 0xc122, 0xc133, 0xc144, 0xc155, 0xc166, 0xc177, 0xc188,
  1607.       0xc199, 0xc0aa, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
  1608.   };
  1609.   USHORT tempax,tempbx,tempah,temp;
  1611.   if(HwDeviceExtension->jChipType < SIS_315H) {
  1613.     tempax = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x18);
  1614.     tempbx = tempax & 0x0F;
  1615.     if(!(tempax & 0x10)){
  1616.       if(SiS_Pr->SiS_IF_DEF_LVDS == 1){
  1617.         tempbx = 0;
  1618.         temp = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x38);
  1619.         if(temp & 0x40) tempbx |= 0x08;
  1620.         if(temp & 0x20) tempbx |= 0x02;
  1621.         if(temp & 0x01) tempbx |= 0x01;
  1622.         temp = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x39);
  1623.         if(temp & 0x80) tempbx |= 0x04;
  1624.       } else {
  1625.         return 0;
  1626.       }
  1627.     }
  1628.     tempbx = PanelTypeTable300[tempbx];
  1629.     tempbx |= LCDSync;
  1630.     temp = tempbx & 0x00FF;
  1631.     SiS_SetReg1(SiS_Pr->SiS_P3d4,0x36,temp);
  1632.     temp = (tempbx & 0xFF00) >> 8;
  1633.     SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x37,~(LCDSyncBit|LCDRGB18Bit),temp);
  1635.   } else {
  1637.     tempax = tempah = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x1a);
  1638.     tempax &= 0x1e;
  1639.     tempax >>= 1;
  1640.     if(SiS_Pr->SiS_IF_DEF_LVDS == 1) {
  1641.        if(tempax == 0) {
  1642.            /* TODO: Include HUGE detection routine
  1643.             (Probably not worth bothering)
  1644.     */
  1645.            return 0;
  1646.        }
  1647.        temp = tempax & 0xff;
  1648.        tempax--;
  1649.        tempbx = PanelTypeTable310LVDS[tempax];
  1650.     } else {
  1651.        tempbx = PanelTypeTable31030x[tempax];
  1652.        temp = tempbx & 0xff;
  1653.     }
  1654.     SiS_SetReg1(SiS_Pr->SiS_P3d4,0x36,temp);
  1655.     tempbx = (tempbx & 0xff00) >> 8;
  1656.     temp = tempbx & 0xc1;
  1657.     SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x37,~(LCDSyncBit|LCDRGB18Bit),temp);
  1658.     if(SiS_Pr->SiS_IF_DEF_LVDS == 0) {
  1659.        temp = tempbx & 0x04;
  1660.        SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x39,0xfb,temp);
  1661.     }
  1663.   }
  1664.   return 1;
  1665. }
  1668. #ifdef LINUXBIOS
  1670. void
  1671. SiS_DetectMonitor(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension,USHORT BaseAddr)
  1672. {
  1673.   UCHAR  DAC_TEST_PARMS[] = {0x0F,0x0F,0x0F};
  1674.   UCHAR  DAC_CLR_PARMS[]  = {0x00,0x00,0x00};
  1675.   USHORT SR1F;
  1677.   SR1F = SiS_GetReg1(SiS_Pr->SiS_P3c4,0x1F); /* backup DAC pedestal */
  1678.   SiS_SetRegOR(SiS_Pr->SiS_P3c4,0x1F,0x04);
  1680.   if(SiS_Pr->SiS_IF_DEF_LVDS == 0) {
  1681.     if(!(SiS_BridgeIsOn(SiS_Pr, BaseAddr))) {
  1682.       SiS_SetReg1(SiS_Pr->SiS_P3d4,0x30,0x41);
  1683.     }
  1684.   }
  1686.   SiSSetMode(SiS_Pr,HwDeviceExtension,0x2E);
  1687.   if(HwDeviceExtension->jChipType > SIS_315PRO) {
  1688.      /* TW: On 650 only - enable CRT1 */
  1689.      SiS_SetRegAND(SiS_Pr->SiS_P3d4,0x63,0xbf);
  1690.   }
  1691.   SiS_SetReg3(SiS_Pr->SiS_P3c6,0xff);
  1692.   SiS_ClearDAC(SiS_Pr, SiS_Pr->SiS_P3c8);
  1693.   SiS_LongWait(SiS_Pr);
  1694.   SiS_LongWait(SiS_Pr);
  1695.   SiS_LongWait(SiS_Pr);
  1696.   SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x32,0xDF,0x00);
  1697.   if(SiS_TestMonitorType(SiS_Pr, DAC_TEST_PARMS[0],DAC_TEST_PARMS[1],DAC_TEST_PARMS[2])) {
  1698.     SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x32,0xDF,0x20);
  1699.   } else if(SiS_TestMonitorType(SiS_Pr, DAC_TEST_PARMS[0],DAC_TEST_PARMS[1],DAC_TEST_PARMS[2])) {
  1700.     SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x32,0xDF,0x20);
  1701.   }
  1702.   SiS_TestMonitorType(SiS_Pr, DAC_CLR_PARMS[0],DAC_CLR_PARMS[1],DAC_CLR_PARMS[2]);
  1704.   SiS_SetReg1(SiS_Pr->SiS_P3c4,0x1F,SR1F);
  1705. }
  1707. USHORT
  1708. SiS_TestMonitorType(SiS_Private *SiS_Pr, UCHAR R_DAC,UCHAR G_DAC,UCHAR B_DAC)
  1709. {
  1710.    USHORT temp,tempbx;
  1712.    tempbx = R_DAC * 0x4d + G_DAC * 0x97 + B_DAC * 0x1c;
  1713.    if((tempbx & 0x00ff) > 0x80) tempbx += 0x100;
  1714.    tempbx = (tempbx & 0xFF00) >> 8;
  1715.    R_DAC = (UCHAR) tempbx;
  1716.    G_DAC = (UCHAR) tempbx;
  1717.    B_DAC = (UCHAR) tempbx;
  1719.    SiS_SetReg3(SiS_Pr->SiS_P3c8,0x00);
  1720.    SiS_SetReg3(SiS_Pr->SiS_P3c9,R_DAC);
  1721.    SiS_SetReg3(SiS_Pr->SiS_P3c9,G_DAC);
  1722.    SiS_SetReg3(SiS_Pr->SiS_P3c9,B_DAC);
  1723.    SiS_LongWait(SiS_Pr);
  1724.    temp=SiS_GetReg2(SiS_Pr->SiS_P3c2);
  1725.    if(temp & 0x10) return(1);
  1726.    else return(0);
  1727. }
  1729. void
  1730. SiS_GetSenseStatus(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension,UCHAR *ROMAddr)
  1731. {
  1732.   USHORT tempax=0,tempbx,tempcx,temp;
  1733.   USHORT P2reg0=0,SenseModeNo=0,OutputSelect=*SiS_Pr->pSiS_OutputSelect;
  1734.   USHORT ModeIdIndex,i;
  1735.   USHORT BaseAddr = (USHORT)HwDeviceExtension->ulIOAddress;
  1737.   if(SiS_Pr->SiS_IF_DEF_LVDS == 1){
  1738.     SiS_GetPanelID(SiS_Pr);
  1739.     temp=LCDSense;
  1740.     temp=temp|SiS_SenseCHTV(SiS_Pr);
  1741.     tempbx=~(LCDSense|AVIDEOSense|SVIDEOSense);
  1742.     SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x32,tempbx,temp);
  1743.   } else {       /* for 301 */
  1744.     if(SiS_Pr->SiS_IF_DEF_HiVision==1) {  /* for HiVision */
  1745.       tempax=SiS_GetReg1(SiS_Pr->SiS_P3c4,0x38);
  1746.       temp=tempax&0x01;
  1747.       tempax=SiS_GetReg1(SiS_Pr->SiS_P3c4,0x3A);
  1748.       temp=temp|(tempax&0x02);
  1749.       SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x32,0xA0,temp);
  1750.     } else {
  1751.       if(SiS_BridgeIsOn(SiS_Pr, BaseAddr)==0) {    /* TW: Inserted "==0" */
  1752.         P2reg0 = SiS_GetReg1(SiS_Pr->SiS_Part2Port,0x00);
  1753.         if(!(SiS_BridgeIsEnable(SiS_Pr, BaseAddr,HwDeviceExtension))) {
  1754.           SenseModeNo=0x2e;
  1755.           temp = SiS_SearchModeID(SiS_Pr, ROMAddr,&SenseModeNo,&ModeIdIndex);
  1756.           SiS_Pr->SiS_SetFlag = 0x00;
  1757.           SiS_Pr->SiS_ModeType = ModeVGA;
  1758.           SiS_Pr->SiS_VBInfo = SetCRT2ToRAMDAC |LoadDACFlag |SetInSlaveMode;
  1759.           SiS_SetCRT2Group301(SiS_Pr, BaseAddr,ROMAddr,SenseModeNo,HwDeviceExtension);
  1760.           for(i=0;i<20;i++) {
  1761.             SiS_LongWait(SiS_Pr);
  1762.           }
  1763.         }
  1764.         SiS_SetReg1(SiS_Pr->SiS_Part2Port,0x00,0x1c);
  1765.         tempax=0;
  1766.         tempbx=*SiS_Pr->pSiS_RGBSenseData;
  1767. if(SiS_Is301B(SiS_Pr, BaseAddr)){
  1768.                 tempbx=*SiS_Pr->pSiS_RGBSenseData2;
  1769.         }
  1770.         tempcx=0x0E08;
  1771.         if(SiS_Sense(SiS_Pr, tempbx,tempcx)){
  1772.           if(SiS_Sense(SiS_Pr, tempbx,tempcx)){
  1773.             tempax=tempax|Monitor2Sense;
  1774.           }
  1775.         }
  1776.         tempbx=*SiS_Pr->pSiS_YCSenseData;
  1777.         if(SiS_Is301B(SiS_Pr, BaseAddr)){
  1778.                tempbx=*SiS_Pr->pSiS_YCSenseData2;
  1779.         }
  1780.         tempcx=0x0604;
  1781.         if(SiS_Sense(SiS_Pr, tempbx,tempcx)){
  1782.           if(SiS_Sense(SiS_Pr,tempbx,tempcx)){
  1783.             tempax=tempax|SVIDEOSense;
  1784.           }
  1785.         }
  1787. if(ROMAddr && SiS_Pr->SiS_UseROM) {
  1788. #ifdef SIS300
  1789.    if((HwDeviceExtension->jChipType==SIS_630)||
  1790.               (HwDeviceExtension->jChipType==SIS_730)) {
  1791. OutputSelect = ROMAddr[0xfe];
  1792.    }
  1793. #endif
  1794. #ifdef SIS315H
  1795.    if(HwDeviceExtension->jChipType >= SIS_315H) {
  1796.         OutputSelect = ROMAddr[0xf3];
  1797.    }
  1798. #endif
  1799.         }
  1800.         if(OutputSelect&BoardTVType){
  1801.           tempbx=*SiS_Pr->pSiS_VideoSenseData;
  1802.           if(SiS_Is301B(SiS_Pr, BaseAddr)){
  1803.              tempbx=*SiS_Pr->pSiS_VideoSenseData2;
  1804.           }
  1805.           tempcx=0x0804;
  1806.           if(SiS_Sense(SiS_Pr, tempbx,tempcx)){
  1807.             if(SiS_Sense(SiS_Pr, tempbx,tempcx)){
  1808.               tempax=tempax|AVIDEOSense;
  1809.             }
  1810.           }
  1811.         } else {
  1812.           if(!(tempax&SVIDEOSense)){
  1813.             tempbx=*SiS_Pr->pSiS_VideoSenseData;
  1814.             if(SiS_Is301B(SiS_Pr, BaseAddr)){
  1815.               tempbx=*SiS_Pr->pSiS_VideoSenseData2;
  1816.             }
  1817.             tempcx=0x0804;
  1818.             if(SiS_Sense(SiS_Pr,tempbx,tempcx)){
  1819.               if(SiS_Sense(SiS_Pr, tempbx,tempcx)){
  1820.                 tempax=tempax|AVIDEOSense;
  1821.               }
  1822.             }
  1823.           }
  1824.         }
  1825.       }
  1827.       if(SiS_SenseLCD(SiS_Pr, HwDeviceExtension)){
  1828.         tempax=tempax|LCDSense;
  1829.       }
  1831.       tempbx=0;
  1832.       tempcx=0;
  1833.       SiS_Sense(SiS_Pr, tempbx,tempcx);
  1835.       if(SiS_Pr->SiS_VBType & (VB_SIS30xLV|VB_SIS30xLVX)){   /* TW: prev. 301LV|302LV */
  1836.          tempax &= 0x00ef;   /* 301lv to disable CRT2*/
  1837.       }
  1838.       SiS_SetRegANDOR(SiS_Pr->SiS_P3d4,0x32,~0xDF,tempax);
  1839.       SiS_SetReg1(SiS_Pr->SiS_Part2Port,0x00,P2reg0);
  1840.       if(!(P2reg0&0x20)) {
  1841.         SiS_Pr->SiS_VBInfo = DisableCRT2Display;
  1842.         SiS_SetCRT2Group301(SiS_Pr,BaseAddr,ROMAddr,SenseModeNo,HwDeviceExtension);
  1843.       }
  1844.     }
  1845.   }
  1846. }
  1848. BOOLEAN
  1849. SiS_Sense(SiS_Private *SiS_Pr, USHORT tempbx,USHORT tempcx)
  1850. {
  1851.   USHORT temp,i,tempch;
  1853.   temp = tempbx & 0xFF;
  1854.   SiS_SetReg1(SiS_Pr->SiS_Part4Port,0x11,temp);
  1855.   temp = (tempbx & 0xFF00) >> 8;
  1856.   temp |= (tempcx & 0x00FF);
  1857.   SiS_SetRegANDOR(SiS_Pr->SiS_Part4Port,0x10,~0x1F,temp);
  1859.   for(i=0; i<10; i++) SiS_LongWait(SiS_Pr);
  1861.   tempch = (tempcx & 0x7F00) >> 8;
  1862.   temp = SiS_GetReg1(SiS_Pr->SiS_Part4Port,0x03);
  1863.   temp ^= 0x0E;
  1864.   temp &= tempch;
  1865.   if(temp>0) return 1;
  1866.   else return 0;
  1867. }
  1869. USHORT
  1870. SiS_SenseLCD(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension)
  1871. {
  1872.   USHORT temp;
  1874.   temp=SiS_GetPanelID(SiS_Pr);
  1875.   if(!temp)  temp=SiS_GetLCDDDCInfo(SiS_Pr, HwDeviceExtension);
  1876.   return(temp);
  1877. }
  1879. BOOLEAN
  1880. SiS_GetLCDDDCInfo(SiS_Private *SiS_Pr, PSIS_HW_DEVICE_INFO HwDeviceExtension)
  1881. {
  1882.   USHORT temp;
  1883.   /*add lcd sense*/
  1884.   if(HwDeviceExtension->ulCRT2LCDType==LCD_UNKNOWN)
  1885.      return 0;
  1886.   else{
  1887.       temp=(USHORT)HwDeviceExtension->ulCRT2LCDType;
  1888.       SiS_SetReg1(SiS_Pr->SiS_P3d4,0x36,temp);
  1889.    return 1;
  1890.   }
  1891. }
  1893. USHORT
  1894. SiS_SenseCHTV(SiS_Private *SiS_Pr)
  1895. {
  1896.   USHORT temp,push0e,status;
  1898.   status=0;
  1899.   push0e = SiS_GetCH700x(SiS_Pr, 0x0e);
  1900.   push0e = (push0e << 8) | 0x0e;
  1901.   SiS_SetCH700x(SiS_Pr, 0x0b0e);
  1902.   SiS_SetCH700x(SiS_Pr, 0x0110);
  1903.   SiS_SetCH700x(SiS_Pr, 0x0010);
  1904.   temp = SiS_GetCH700x(SiS_Pr, 0x10);
  1905.   if(temp & 0x08) status |= SVIDEOSense;
  1906.   if(temp & 0x02) status |= AVIDEOSense;
  1907.   SiS_SetCH700x(SiS_Pr, push0e);
  1908.   return(status);
  1909. }
  1910. #endif /* LINUXBIOS */
  1912. /*  ================ for TC only =================  */
  1914. #ifdef TC
  1916. int
  1917. INT1AReturnCode(union REGS regs)
  1918. {
  1919.   if (regs.x.cflag)
  1920.   {
  1921.     /*printf("Error to find pci device!n"); */
  1922.     return 1;
  1923.   }
  1925.   switch(regs.h.ah)
  1926.   {
  1927.     case 0: return 0;
  1928.             break;
  1929.     case 0x81: printf("Function not supportn");
  1930.                break;
  1931.     case 0x83: printf("bad vendor idn");
  1932.                break;
  1933.     case 0x86: printf("device not foundn");
  1934.                break;
  1935.     case 0x87: printf("bad register numbern");
  1936.                break;
  1937.     case 0x88: printf("set failedn");
  1938.                break;
  1939.     case 0x89: printf("buffer too small");
  1940.                break;
  1941.   }
  1942.   return 1;
  1943. }
  1945. unsigned
  1946. FindPCIIOBase(unsigned index,unsigned deviceid)
  1947. {
  1948.   union REGS regs;
  1950.   regs.h.ah = 0xb1;  /*PCI_FUNCTION_ID */
  1951.   regs.h.al = 0x02;  /*FIND_PCI_DEVICE */
  1952.   regs.x.cx = deviceid;
  1953.   regs.x.dx = 0x1039;
  1954.   regs.x.si = index;  /* find n-th device */
  1956.   int86(0x1A, &regs, &regs);
  1958.   if (INT1AReturnCode(regs)!=0)
  1959.     return 0;
  1961.   /* regs.h.bh *//* bus number */
  1962.   /* regs.h.bl *//* device number */
  1963.   regs.h.ah = 0xb1;  /*PCI_FUNCTION_ID */
  1964.   regs.h.al = 0x09;  /*READ_CONFIG_WORD */
  1965.   regs.x.cx = deviceid;
  1966.   regs.x.dx = 0x1039;
  1967.   regs.x.di = 0x18;  /* register number */
  1968.   int86(0x1A, &regs, &regs);
  1970.   if (INT1AReturnCode(regs)!=0)
  1971.     return 0;
  1972.   return regs.x.cx;
  1973. }
  1976. void
  1977. main(int argc, char *argv[])
  1978. {
  1979.   SIS_HW_DEVICE_INFO  HwDeviceExtension;
  1980.   USHORT temp;
  1981.   USHORT ModeNo;
  1983.   /*HwDeviceExtension.pjVirtualRomBase =(PUCHAR) MK_FP(0xC000,0); */
  1984.   /*HwDeviceExtension.pjVideoMemoryAddress = (PUCHAR)MK_FP(0xA000,0);*/
  1986. #ifdef SIS300  
  1987.   HwDeviceExtension.ulIOAddress = (FindPCIIOBase(0,0x6300)&0xFF80) + 0x30;
  1988.   HwDeviceExtension.jChipType = SIS_630;
  1989. #endif
  1991. #ifdef SIS315H  
  1992. //  HwDeviceExtension.ulIOAddress = (FindPCIIOBase(0,0x5315)&0xFF80) + 0x30;
  1993. //  HwDeviceExtension.jChipType = SIS_550;
  1994.   HwDeviceExtension.ulIOAddress = (FindPCIIOBase(0,0x325)&0xFF80) + 0x30;
  1995.   HwDeviceExtension.jChipType = SIS_315H;
  1996. #endif
  1998.   HwDeviceExtension.ujVBChipID = VB_CHIP_301;
  1999.   strcpy(HwDeviceExtension.szVBIOSVer,"0.84");
  2000.   HwDeviceExtension.bSkipDramSizing = FALSE;
  2001.   HwDeviceExtension.ulVideoMemorySize = 0;
  2002.   if(argc==2) {
  2003.     ModeNo=atoi(argv[1]);
  2004.   }
  2005.   else {
  2006.     ModeNo=0x2e;
  2007.     /*ModeNo=0x37; */ /* 1024x768x 4bpp */
  2008.     /*ModeNo=0x38; *//* 1024x768x 8bpp */
  2009.     /*ModeNo=0x4A; *//* 1024x768x 16bpp */
  2010.     /*ModeNo=0x47;*/ /* 800x600x 16bpp */
  2011.   }
  2012.  /* SiSInit(SiS_Pr, &HwDeviceExtension);*/
  2013.   SiSSetMode(SiS_Pr, &HwDeviceExtension, ModeNo);
  2014. }
  2015. #endif /* TC END */
  2017. /* ================ LINUX XFREE86 ====================== */
  2019. /* Helper functions */
  2021. #ifdef LINUX_XF86
  2022. USHORT
  2023. SiS_CalcModeIndex(ScrnInfoPtr pScrn, DisplayModePtr mode)
  2024. {
  2025.    SISPtr pSiS = SISPTR(pScrn);
  2026.    UShort i = (pSiS->CurrentLayout.bitsPerPixel+7)/8 - 1;
  2027.    UShort ModeIndex = 0;
  2029.    switch(mode->HDisplay)
  2030.    {
  2031.      case 320:
  2032.           if(mode->VDisplay == 480) {
  2033.                 ModeIndex = ModeIndex_320x480[i];
  2034.   }
  2035.           break;
  2036.      case 512:
  2037.           if(mode->VDisplay == 384) {
  2038.              ModeIndex = ModeIndex_512x384[i];
  2039.   }
  2040.           break;
  2041.      case 640:
  2042.           if(mode->VDisplay == 480) {
  2043.              ModeIndex = ModeIndex_640x480[i];
  2044.   }
  2045.           break;
  2046.      case 720:
  2047.           if(mode->VDisplay == 480) {
  2048.                 ModeIndex = ModeIndex_720x480[i];
  2049.           } else if(mode->VDisplay == 576) {
  2050.                 ModeIndex = ModeIndex_720x576[i];
  2051.           }
  2052.           break;
  2053.      case 800:
  2054.   if(mode->VDisplay == 600) {
  2055.              ModeIndex = ModeIndex_800x600[i];
  2056.   } else if(pSiS->VGAEngine == SIS_315_VGA) {
  2057.      if(mode->VDisplay == 480) {
  2058.            ModeIndex = ModeIndex_800x480[i];
  2059.              }
  2060.   }
  2061.           break;
  2062.      case 1024:
  2063.           if(mode->VDisplay == 768) {
  2064.         ModeIndex = ModeIndex_1024x768[i];
  2065.   } else if(pSiS->VGAEngine == SIS_315_VGA) {
  2066.      if(mode->VDisplay == 576) {
  2067.         ModeIndex = ModeIndex_1024x576[i];
  2068.              }
  2069.   } else if(pSiS->VGAEngine == SIS_300_VGA) {
  2070.      if(mode->VDisplay == 600) {
  2071.         ModeIndex = ModeIndex_1024x600[i];
  2072.              }
  2073.   }
  2074.           break;
  2075.      case 1152:
  2076.           if(pSiS->VGAEngine == SIS_300_VGA) {
  2077.      if(mode->VDisplay == 768) {
  2078.         ModeIndex = ModeIndex_1152x768[i];
  2079.              }
  2080.   }
  2081.   break;
  2082.      case 1280:
  2083.           if(mode->VDisplay == 960) {
  2084.              if(pSiS->VGAEngine == SIS_300_VGA) {
  2085.         ModeIndex = ModeIndex_300_1280x960[i];
  2086.              } else {
  2087.                 ModeIndex = ModeIndex_310_1280x960[i];
  2088.              }
  2089.   } else if (mode->VDisplay == 1024) {
  2090.      ModeIndex = ModeIndex_1280x1024[i];
  2091.   } else if(pSiS->VGAEngine == SIS_315_VGA) {
  2092.      if (mode->VDisplay == 768) {
  2093.         ModeIndex = ModeIndex_1280x768[i];
  2094.      } else if (mode->VDisplay == 720) {
  2095.         ModeIndex = ModeIndex_1280x720[i];
  2096.              }
  2097.   }
  2098.           break;
  2099.      case 1400:
  2100.           if(pSiS->VGAEngine == SIS_315_VGA) {
  2101.      if(mode->VDisplay == 1050) {
  2102.         ModeIndex = ModeIndex_1400x1050[i];
  2103.              }
  2104.   }
  2105.           break;
  2106.      case 1600:
  2107.           if(mode->VDisplay == 1200) {
  2108.              ModeIndex = ModeIndex_1600x1200[i];
  2109.   }
  2110.           break;
  2111.      case 1920:
  2112.           if(mode->VDisplay == 1440) {
  2113.              ModeIndex = ModeIndex_1920x1440[i];
  2114.   }
  2115.           break;
  2116.      case 2048:
  2117.           if(pSiS->VGAEngine == SIS_315_VGA) {
  2118.      if(mode->VDisplay == 1536) {
  2119.          ModeIndex = ModeIndex_2048x1536[i];
  2120.              }
  2121.   }
  2122.           break;
  2123.    }
  2125.    return(ModeIndex);
  2126. }
  2128. USHORT
  2129. SiS_CheckCalcModeIndex(ScrnInfoPtr pScrn, DisplayModePtr mode, int VBFlags)
  2130. {
  2131.    SISPtr pSiS = SISPTR(pScrn);
  2132.    UShort i = (pSiS->CurrentLayout.bitsPerPixel+7)/8 - 1;    
  2133.    UShort ModeIndex = 0;
  2135.    if(VBFlags & CRT2_LCD) {
  2137.       if( (mode->HDisplay <= pSiS->LCDwidth) &&
  2138.           (mode->VDisplay <= pSiS->LCDheight) ) {
  2140.         if(VBFlags & VB_LVDS) {         /* LCD on LVDS */
  2142.           switch(mode->HDisplay)
  2143.      {
  2144.   case 512:
  2145. if(mode->VDisplay == 384) {
  2146.    ModeIndex = ModeIndex_512x384[i];
  2147. }
  2148. break;
  2149.   case 640:
  2150. if(mode->VDisplay == 480) {
  2151.    ModeIndex = ModeIndex_640x480[i];
  2152. }
  2153. break;
  2154.   case 800:
  2155. if(mode->VDisplay == 600) {
  2156.    ModeIndex = ModeIndex_800x600[i];
  2157. }
  2158. break;
  2159.   case 1024:
  2160. if(mode->VDisplay == 768) {
  2161.    ModeIndex = ModeIndex_1024x768[i];
  2162. } else if(pSiS->VGAEngine == SIS_300_VGA) {
  2163.    if(mode->VDisplay == 600) {
  2164.       ModeIndex = ModeIndex_1024x600[i];
  2165.    }
  2166. }
  2167. break;
  2168.   case 1152:
  2169. if(pSiS->VGAEngine == SIS_300_VGA) {
  2170.    if(mode->VDisplay == 768) {
  2171. ModeIndex = ModeIndex_1152x768[i];
  2172.    }
  2173. }
  2174. break;
  2175.   case 1280:
  2176. if(mode->VDisplay == 1024) {
  2177.    ModeIndex = ModeIndex_1280x1024[i];
  2178. } else if(pSiS->VGAEngine == SIS_315_VGA) {
  2179.    if(mode->VDisplay == 768) {
  2180.       ModeIndex = ModeIndex_1280x768[i];
  2181.    }
  2182. }
  2183. break;
  2184.   case 1400:
  2185.         if(mode->VDisplay == 1050) {
  2186.    if(pSiS->VGAEngine == SIS_315_VGA) {
  2187.       ModeIndex = ModeIndex_1400x1050[i];
  2188.    }
  2189. }
  2190. break;
  2191.           }
  2193.         } else {                          /* LCD on 301(B) */
  2195.           switch(mode->HDisplay)
  2196.   {
  2197.   case 512:
  2198. if(mode->VDisplay == 384) {
  2199.    ModeIndex = ModeIndex_512x384[i];
  2200. }
  2201. break;
  2202.   case 640:
  2203. if(mode->VDisplay == 480) {
  2204.    ModeIndex = ModeIndex_640x480[i];
  2205. }
  2206. break;
  2207.   case 800:
  2208. if(mode->VDisplay == 600) {
  2209.    ModeIndex = ModeIndex_800x600[i];
  2210. }
  2211. break;
  2212.   case 1024:
  2213. if(mode->VDisplay == 768) {
  2214.    ModeIndex = ModeIndex_1024x768[i];
  2215. } /* else if(pSiS->VGAEngine == SIS_300_VGA) {  --  not supported on 301(B) --
  2216.    if(mode->VDisplay == 600) {
  2217. ModeIndex = ModeIndex_1024x600[i];
  2218.    }
  2219. } */
  2220. break;
  2221.   case 1152:  /* not supported on 301(B) */
  2222. #if 0
  2223. if(pSiS->VGAEngine == SIS_300_VGA) {
  2224.    if(mode->VDisplay == 768) {
  2225. ModeIndex = ModeIndex_1152x768[i];
  2226.    }
  2227. }
  2228. #endif
  2229. break;
  2230.   case 1280:
  2231. if(mode->VDisplay == 960) {
  2232.    if(pSiS->VGAEngine == SIS_300_VGA) {
  2233.       ModeIndex = ModeIndex_300_1280x960[i];
  2234.    } else {
  2235.       ModeIndex = ModeIndex_310_1280x960[i];
  2236.    }
  2237.                 } else if (mode->VDisplay == 1024) {
  2238.              ModeIndex = ModeIndex_1280x1024[i];
  2239.         }
  2240.   case 1600:
  2241. if(mode->VDisplay == 1200) {
  2242.    ModeIndex = ModeIndex_1600x1200[i];
  2243. }
  2244. break;
  2245.   }
  2247.         }
  2249.       }
  2251.    } else if(VBFlags & CRT2_TV) {
  2253.       if(VBFlags & VB_CHRONTEL) { /* TV on Chrontel */
  2255.         switch(mode->HDisplay)
  2256. {
  2257.        case 512:
  2258. if(mode->VDisplay == 384) {
  2259.    ModeIndex = ModeIndex_512x384[i];
  2260. }
  2261. break;
  2262. case 640:
  2263. if(mode->VDisplay == 480) {
  2264.    ModeIndex = ModeIndex_640x480[i];
  2265. }
  2266. break;
  2267. case 800:
  2268. if(mode->VDisplay == 600) {
  2269.    ModeIndex = ModeIndex_800x600[i];
  2270. }
  2271. break;
  2272. case 1024:
  2273. if(mode->VDisplay == 768) {
  2274.    if(pSiS->VGAEngine == SIS_315_VGA) {
  2275.       ModeIndex = ModeIndex_1024x768[i];
  2276.    }
  2277. }
  2278. break;
  2279.         }
  2281.       } else {     /* TV on 301(B) */
  2283.         switch(mode->HDisplay)
  2284. {
  2285.        case 512:
  2286. if(mode->VDisplay == 384) {
  2287.    ModeIndex = ModeIndex_512x384[i];
  2288. }
  2289. break;
  2290. case 640:
  2291. if(mode->VDisplay == 480) {
  2292.    ModeIndex = ModeIndex_640x480[i];
  2293. }
  2294. break;
  2295. case 720:
  2296.                 if(mode->VDisplay == 480) {
  2297.                    ModeIndex = ModeIndex_720x480[i];
  2298.                 } else if(mode->VDisplay == 576) {
  2299.                    ModeIndex = ModeIndex_720x576[i];
  2300.                 }
  2301.                 break;
  2302. case 800:
  2303. if(mode->VDisplay == 600) {
  2304.    ModeIndex = ModeIndex_800x600[i];
  2305. }
  2306. break;
  2307. case 1024:
  2308. if(mode->VDisplay == 768) {
  2309.    if(VBFlags & (VB_301B|VB_302B|VB_30xLV|VB_30xLVX)) {
  2310.       ModeIndex = ModeIndex_1024x768[i];
  2311.    }
  2312. }
  2313. break;
  2314.         }
  2316.       }
  2318.    } else if(VBFlags & CRT2_VGA) { /* CRT2 is VGA2 */
  2320. switch(mode->HDisplay)
  2321. {
  2322. case 512:
  2323. if(mode->VDisplay == 384) {
  2324.     ModeIndex = ModeIndex_512x384[i];
  2325. }
  2326. break;
  2327. case 640:
  2328. if(mode->VDisplay == 480) {
  2329.    ModeIndex = ModeIndex_640x480[i];
  2330. }
  2331. break;
  2332. case 800:
  2333. if(mode->VDisplay == 600) {
  2334.    ModeIndex = ModeIndex_800x600[i];
  2335. } else if(pSiS->VGAEngine == SIS_315_VGA) {
  2336.    if(mode->VDisplay == 480) {
  2337. ModeIndex = ModeIndex_800x480[i];
  2338.    }
  2339. }
  2340. break;
  2341. case 1024:
  2342. if(mode->VDisplay == 768) {
  2343. ModeIndex = ModeIndex_1024x768[i];
  2344. } else if(pSiS->VGAEngine == SIS_315_VGA) {
  2345.    if(mode->VDisplay == 576) {
  2346. ModeIndex = ModeIndex_1024x576[i];
  2347.    }
  2348. }
  2349. break;
  2350. case 1152:
  2351. if(pSiS->VGAEngine == SIS_300_VGA) {
  2352.    if(mode->VDisplay == 768) {
  2353. ModeIndex = ModeIndex_1152x768[i];
  2354.    }
  2355. }
  2356. break;
  2357. case 1280:
  2358. if (mode->VDisplay == 1024) {
  2359.    ModeIndex = ModeIndex_1280x1024[i];
  2360. } else if(pSiS->VGAEngine == SIS_315_VGA) {
  2361.    if (mode->VDisplay == 768) {
  2362. ModeIndex = ModeIndex_1280x768[i];
  2363.    } else if (mode->VDisplay == 720) {
  2364. ModeIndex = ModeIndex_1280x720[i];
  2365.    }
  2366. }
  2367. break;
  2368. case 1400:
  2369. if(pSiS->VGAEngine == SIS_315_VGA) {
  2370.    ModeIndex = ModeIndex_1400x1050[i];
  2371. }
  2372. break;
  2373. }
  2375.    } else { /* CRT1 only, no CRT2 */
  2377.        ModeIndex = SiS_CalcModeIndex(pScrn, mode);
  2379.    }
  2381.    return(ModeIndex);
  2382. }
  2384. #define MODEID_OFF 0x449
  2386. unsigned char
  2387. SiS_GetSetModeID(ScrnInfoPtr pScrn, unsigned char id)
  2388. {
  2389.     return(SiS_GetSetMMIOReg(pScrn, MODEID_OFF, id));
  2390. }
  2392. unsigned char
  2393. SiS_GetSetMMIOReg(ScrnInfoPtr pScrn, USHORT offset, unsigned char value)
  2394. {
  2395.     unsigned char ret;
  2396.     unsigned char *base;
  2397.     SISPtr pSiS = SISPTR(pScrn);
  2398.     BOOLEAN mapped;
  2400.     if(pSiS->IOBase) {
  2401.      base = (unsigned char *)pSiS->IOBase;
  2402. mapped = FALSE;
  2403.     } else {
  2404.         base = xf86MapVidMem(pScrn->scrnIndex, VIDMEM_MMIO, 0, 0x2000);
  2405. if(!base) {
  2406.      xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
  2407.           "(init.c: Could not MMIO area!)n");
  2408.      return 0;
  2409. }
  2410. mapped = TRUE;
  2411.     }
  2413.     ret = *(base + offset);
  2415.     /* value != 0xff means: set register */
  2416.     if (value != 0xff)
  2417. *(base + offset) = value;
  2419.     if(mapped) xf86UnMapVidMem(pScrn->scrnIndex, base, 0x2000);
  2421.     return ret;
  2422. }
  2424. #endif