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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
init.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：100k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

init.c：源码内容
  1. /* Function: Support NT X.0  MM function  */
  2. /* Version : V 0.80      [ynlai] 04/12/98 */
  4. #include "init.h"
  5. #ifdef CONFIG_FB_SIS_300
  6. #include "300vtbl.h"
  7. #endif
  8. #ifdef CONFIG_FB_SIS_315
  9. #include "310vtbl.h"
  10. #endif
  12. BOOLEAN SiSInit (PSIS_HW_DEVICE_INFO HwDeviceExtension);
  13. BOOLEAN SiSSetMode (PSIS_HW_DEVICE_INFO HwDeviceExtension, USHORT ModeNo);
  15. #if defined(ALLOC_PRAGMA)
  16. #pragma alloc_text(PAGE,SiSSetMode)
  17. #pragma alloc_text(PAGE,SiSInit)
  18. #endif
  20. void SiS_SetReg1 (USHORT, USHORT, USHORT);
  21. void SiS_SetReg2 (USHORT, USHORT, USHORT);
  22. void SiS_SetReg3 (USHORT, USHORT);
  23. void SiS_SetReg4 (USHORT, ULONG);
  24. UCHAR SiS_GetReg1 (USHORT, USHORT);
  25. UCHAR SiS_GetReg2 (USHORT);
  26. ULONG SiS_GetReg3 (USHORT);
  27. void SiS_ClearDAC (ULONG);
  29. #ifdef CONFIG_FB_SIS_300
  30. void
  31. InitTo300Pointer (void)
  32. {
  33. SiS_SModeIDTable = (SiS_StStruct *) SiS300_SModeIDTable;
  34. SiS_VBModeIDTable = (SiS_VBModeStruct *) SiS300_VBModeIDTable; /*add for 300 oem util */
  35. SiS_StandTable = (SiS_StandTableStruct *) SiS300_StandTable;
  36. SiS_EModeIDTable = (SiS_ExtStruct *) SiS300_EModeIDTable;
  37. SiS_RefIndex = (SiS_Ext2Struct *) SiS300_RefIndex;
  38. SiS_CRT1Table = (SiS_CRT1TableStruct *) SiS300_CRT1Table;
  39. SiS_MCLKData = (SiS_MCLKDataStruct *) SiS300_MCLKData;
  40. SiS_ECLKData = (SiS_ECLKDataStruct *) SiS300_ECLKData;
  41. SiS_VCLKData = (SiS_VCLKDataStruct *) SiS300_VCLKData;
  42. SiS_VBVCLKData = (SiS_VBVCLKDataStruct *) SiS300_VCLKData;
  43. SiS_ScreenOffset = SiS300_ScreenOffset;
  44. SiS_StResInfo = (SiS_StResInfoStruct *) SiS300_StResInfo;
  45. SiS_ModeResInfo = (SiS_ModeResInfoStruct *) SiS300_ModeResInfo;
  47. pSiS_OutputSelect = &SiS300_OutputSelect;
  48. pSiS_SoftSetting = &SiS300_SoftSetting;
  49. pSiS_SR07 = &SiS300_SR07;
  50. SiS_SR15 = SiS300_SR15;
  51. SiS_CR40 = SiS300_CR40;
  52. SiS_CR49 = SiS300_CR49;
  53. pSiS_SR1F = &SiS300_SR1F;
  54. pSiS_SR21 = &SiS300_SR21;
  55. pSiS_SR22 = &SiS300_SR22;
  56. pSiS_SR23 = &SiS300_SR23;
  57. pSiS_SR24 = &SiS300_SR24;
  58. SiS_SR25 = SiS300_SR25;
  59. pSiS_SR31 = &SiS300_SR31;
  60. pSiS_SR32 = &SiS300_SR32;
  61. pSiS_SR33 = &SiS300_SR33;
  62. pSiS_CRT2Data_1_2 = &SiS300_CRT2Data_1_2;
  63. pSiS_CRT2Data_4_D = &SiS300_CRT2Data_4_D;
  64. pSiS_CRT2Data_4_E = &SiS300_CRT2Data_4_E;
  65. pSiS_CRT2Data_4_10 = &SiS300_CRT2Data_4_10;
  66. pSiS_RGBSenseData = &SiS300_RGBSenseData;
  67. pSiS_VideoSenseData = &SiS300_VideoSenseData;
  68. pSiS_YCSenseData = &SiS300_YCSenseData;
  69. pSiS_RGBSenseData2 = &SiS300_RGBSenseData2;
  70. pSiS_VideoSenseData2 = &SiS300_VideoSenseData2;
  71. pSiS_YCSenseData2 = &SiS300_YCSenseData2;
  73. SiS_NTSCPhase = SiS300_NTSCPhase;
  74. SiS_PALPhase = SiS300_PALPhase;
  75. SiS_NTSCPhase2 = SiS300_NTSCPhase2;
  76. SiS_PALPhase2 = SiS300_PALPhase2;
  77. SiS_PALMPhase = SiS300_PALMPhase; /*add for PALMN */
  78. SiS_PALNPhase = SiS300_PALNPhase;
  80. SiS_StLCD1024x768Data = (SiS_LCDDataStruct *) SiS300_StLCD1024x768Data;
  81. SiS_ExtLCD1024x768Data =
  82.     (SiS_LCDDataStruct *) SiS300_ExtLCD1024x768Data;
  83. SiS_St2LCD1024x768Data =
  84.     (SiS_LCDDataStruct *) SiS300_St2LCD1024x768Data;
  85. SiS_StLCD1280x1024Data =
  86.     (SiS_LCDDataStruct *) SiS300_StLCD1280x1024Data;
  87. SiS_ExtLCD1280x1024Data =
  88.     (SiS_LCDDataStruct *) SiS300_ExtLCD1280x1024Data;
  89. SiS_St2LCD1280x1024Data =
  90.     (SiS_LCDDataStruct *) SiS300_St2LCD1280x1024Data;
  91. SiS_NoScaleData = (SiS_LCDDataStruct *) SiS300_NoScaleData;
  92. SiS_LCD1280x960Data = (SiS_LCDDataStruct *) SiS300_LCD1280x960Data;
  93. SiS_StPALData = (SiS_TVDataStruct *) SiS300_StPALData;
  94. SiS_ExtPALData = (SiS_TVDataStruct *) SiS300_ExtPALData;
  95. SiS_StNTSCData = (SiS_TVDataStruct *) SiS300_StNTSCData;
  96. SiS_ExtNTSCData = (SiS_TVDataStruct *) SiS300_ExtNTSCData;
  97. SiS_St1HiTVData = (SiS_TVDataStruct *) SiS300_St1HiTVData;
  98. SiS_St2HiTVData = (SiS_TVDataStruct *) SiS300_St2HiTVData;
  99. SiS_ExtHiTVData = (SiS_TVDataStruct *) SiS300_ExtHiTVData;
  100. SiS_NTSCTiming = SiS300_NTSCTiming;
  101. SiS_PALTiming = SiS300_PALTiming;
  102. SiS_HiTVSt1Timing = SiS300_HiTVSt1Timing;
  103. SiS_HiTVSt2Timing = SiS300_HiTVSt2Timing;
  104. SiS_HiTVTextTiming = SiS300_HiTVTextTiming;
  105. SiS_HiTVGroup3Data = SiS300_HiTVGroup3Data;
  106. SiS_HiTVGroup3Simu = SiS300_HiTVGroup3Simu;
  107. SiS_HiTVGroup3Text = SiS300_HiTVGroup3Text;
  109. SiS_PanelDelayTbl = (SiS_PanelDelayTblStruct *) SiS300_PanelDelayTbl;
  110. SiS_LVDS800x600Data_1 = (SiS_LVDSDataStruct *) SiS300_LVDS800x600Data_1;
  111. SiS_LVDS800x600Data_2 = (SiS_LVDSDataStruct *) SiS300_LVDS800x600Data_2;
  112. SiS_LVDS1024x768Data_1 =
  113.     (SiS_LVDSDataStruct *) SiS300_LVDS1024x768Data_1;
  114. SiS_LVDS1024x768Data_2 =
  115.     (SiS_LVDSDataStruct *) SiS300_LVDS1024x768Data_2;
  116. SiS_LVDS1280x1024Data_1 =
  117.     (SiS_LVDSDataStruct *) SiS300_LVDS1280x1024Data_1;
  118. SiS_LVDS1280x1024Data_2 =
  119.     (SiS_LVDSDataStruct *) SiS300_LVDS1280x1024Data_2;
  120. SiS_LVDS640x480Data_1 = (SiS_LVDSDataStruct *) SiS300_LVDS640x480Data_1;
  121. SiS_CHTVUNTSCData = (SiS_LVDSDataStruct *) SiS300_CHTVUNTSCData;
  122. SiS_CHTVONTSCData = (SiS_LVDSDataStruct *) SiS300_CHTVONTSCData;
  123. SiS_CHTVUPALData = (SiS_LVDSDataStruct *) SiS300_CHTVUPALData;
  124. SiS_CHTVOPALData = (SiS_LVDSDataStruct *) SiS300_CHTVOPALData;
  125. SiS_PanelType00_1 = (SiS_LVDSDesStruct *) SiS300_PanelType00_1;
  126. SiS_PanelType01_1 = (SiS_LVDSDesStruct *) SiS300_PanelType01_1;
  127. SiS_PanelType02_1 = (SiS_LVDSDesStruct *) SiS300_PanelType02_1;
  128. SiS_PanelType03_1 = (SiS_LVDSDesStruct *) SiS300_PanelType03_1;
  129. SiS_PanelType04_1 = (SiS_LVDSDesStruct *) SiS300_PanelType04_1;
  130. SiS_PanelType05_1 = (SiS_LVDSDesStruct *) SiS300_PanelType05_1;
  131. SiS_PanelType06_1 = (SiS_LVDSDesStruct *) SiS300_PanelType06_1;
  132. SiS_PanelType07_1 = (SiS_LVDSDesStruct *) SiS300_PanelType07_1;
  133. SiS_PanelType08_1 = (SiS_LVDSDesStruct *) SiS300_PanelType08_1;
  134. SiS_PanelType09_1 = (SiS_LVDSDesStruct *) SiS300_PanelType09_1;
  135. SiS_PanelType0a_1 = (SiS_LVDSDesStruct *) SiS300_PanelType0a_1;
  136. SiS_PanelType0b_1 = (SiS_LVDSDesStruct *) SiS300_PanelType0b_1;
  137. SiS_PanelType0c_1 = (SiS_LVDSDesStruct *) SiS300_PanelType0c_1;
  138. SiS_PanelType0d_1 = (SiS_LVDSDesStruct *) SiS300_PanelType0d_1;
  139. SiS_PanelType0e_1 = (SiS_LVDSDesStruct *) SiS300_PanelType0e_1;
  140. SiS_PanelType0f_1 = (SiS_LVDSDesStruct *) SiS300_PanelType0f_1;
  141. SiS_PanelType00_2 = (SiS_LVDSDesStruct *) SiS300_PanelType00_2;
  142. SiS_PanelType01_2 = (SiS_LVDSDesStruct *) SiS300_PanelType01_2;
  143. SiS_PanelType02_2 = (SiS_LVDSDesStruct *) SiS300_PanelType02_2;
  144. SiS_PanelType03_2 = (SiS_LVDSDesStruct *) SiS300_PanelType03_2;
  145. SiS_PanelType04_2 = (SiS_LVDSDesStruct *) SiS300_PanelType04_2;
  146. SiS_PanelType05_2 = (SiS_LVDSDesStruct *) SiS300_PanelType05_2;
  147. SiS_PanelType06_2 = (SiS_LVDSDesStruct *) SiS300_PanelType06_2;
  148. SiS_PanelType07_2 = (SiS_LVDSDesStruct *) SiS300_PanelType07_2;
  149. SiS_PanelType08_2 = (SiS_LVDSDesStruct *) SiS300_PanelType08_2;
  150. SiS_PanelType09_2 = (SiS_LVDSDesStruct *) SiS300_PanelType09_2;
  151. SiS_PanelType0a_2 = (SiS_LVDSDesStruct *) SiS300_PanelType0a_2;
  152. SiS_PanelType0b_2 = (SiS_LVDSDesStruct *) SiS300_PanelType0b_2;
  153. SiS_PanelType0c_2 = (SiS_LVDSDesStruct *) SiS300_PanelType0c_2;
  154. SiS_PanelType0d_2 = (SiS_LVDSDesStruct *) SiS300_PanelType0d_2;
  155. SiS_PanelType0e_2 = (SiS_LVDSDesStruct *) SiS300_PanelType0e_2;
  156. SiS_PanelType0f_2 = (SiS_LVDSDesStruct *) SiS300_PanelType0f_2;
  157. SiS_CHTVUNTSCDesData = (SiS_LVDSDesStruct *) SiS300_CHTVUNTSCDesData;
  158. SiS_CHTVONTSCDesData = (SiS_LVDSDesStruct *) SiS300_CHTVONTSCDesData;
  159. SiS_CHTVUPALDesData = (SiS_LVDSDesStruct *) SiS300_CHTVUPALDesData;
  160. SiS_CHTVOPALDesData = (SiS_LVDSDesStruct *) SiS300_CHTVOPALDesData;
  161. SiS_LVDSCRT1800x600_1 =
  162.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT1800x600_1;
  163. SiS_LVDSCRT11024x768_1 =
  164.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11024x768_1;
  165. SiS_LVDSCRT11280x1024_1 =
  166.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11280x1024_1;
  167. SiS_LVDSCRT1800x600_1_H =
  168.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT1800x600_1_H;
  169. SiS_LVDSCRT11024x768_1_H =
  170.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11024x768_1_H;
  171. SiS_LVDSCRT11280x1024_1_H =
  172.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11280x1024_1_H;
  173. SiS_LVDSCRT1800x600_2 =
  174.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT1800x600_2;
  175. SiS_LVDSCRT11024x768_2 =
  176.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11024x768_2;
  177. SiS_LVDSCRT11280x1024_2 =
  178.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11280x1024_2;
  179. SiS_LVDSCRT1800x600_2_H =
  180.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT1800x600_2_H;
  181. SiS_LVDSCRT11024x768_2_H =
  182.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11024x768_2_H;
  183. SiS_LVDSCRT11280x1024_2_H =
  184.     (SiS_LVDSCRT1DataStruct *) SiS300_LVDSCRT11280x1024_2_H;
  185. SiS_CHTVCRT1UNTSC = (SiS_LVDSCRT1DataStruct *) SiS300_CHTVCRT1UNTSC;
  186. SiS_CHTVCRT1ONTSC = (SiS_LVDSCRT1DataStruct *) SiS300_CHTVCRT1ONTSC;
  187. SiS_CHTVCRT1UPAL = (SiS_LVDSCRT1DataStruct *) SiS300_CHTVCRT1UPAL;
  188. SiS_CHTVCRT1OPAL = (SiS_LVDSCRT1DataStruct *) SiS300_CHTVCRT1OPAL;
  189. SiS_CHTVReg_UNTSC = (SiS_CHTVRegDataStruct *) SiS300_CHTVReg_UNTSC;
  190. SiS_CHTVReg_ONTSC = (SiS_CHTVRegDataStruct *) SiS300_CHTVReg_ONTSC;
  191. SiS_CHTVReg_UPAL = (SiS_CHTVRegDataStruct *) SiS300_CHTVReg_UPAL;
  192. SiS_CHTVReg_OPAL = (SiS_CHTVRegDataStruct *) SiS300_CHTVReg_OPAL;
  193. SiS_CHTVVCLKUNTSC = SiS300_CHTVVCLKUNTSC;
  194. SiS_CHTVVCLKONTSC = SiS300_CHTVVCLKONTSC;
  195. SiS_CHTVVCLKUPAL = SiS300_CHTVVCLKUPAL;
  196. SiS_CHTVVCLKOPAL = SiS300_CHTVVCLKOPAL;
  197. /* 300 customization related */
  198. }
  199. #endif
  201. #ifdef CONFIG_FB_SIS_315
  202. void
  203. InitTo310Pointer (void)
  204. {
  205. SiS_SModeIDTable = (SiS_StStruct *) SiS310_SModeIDTable;
  206. SiS_StandTable = (SiS_StandTableStruct *) SiS310_StandTable;
  207. SiS_EModeIDTable = (SiS_ExtStruct *) SiS310_EModeIDTable;
  208. SiS_RefIndex = (SiS_Ext2Struct *) SiS310_RefIndex;
  209. SiS_CRT1Table = (SiS_CRT1TableStruct *) SiS310_CRT1Table;
  210. SiS_MCLKData = (SiS_MCLKDataStruct *) SiS310_MCLKData;
  211. SiS_ECLKData = (SiS_ECLKDataStruct *) SiS310_ECLKData;
  212. SiS_VCLKData = (SiS_VCLKDataStruct *) SiS310_VCLKData;
  213. SiS_VBVCLKData = (SiS_VBVCLKDataStruct *) SiS310_VBVCLKData;
  214. SiS_ScreenOffset = SiS310_ScreenOffset;
  215. SiS_StResInfo = (SiS_StResInfoStruct *) SiS310_StResInfo;
  216. SiS_ModeResInfo = (SiS_ModeResInfoStruct *) SiS310_ModeResInfo;
  218. pSiS_OutputSelect = &SiS310_OutputSelect;
  219. pSiS_SoftSetting = &SiS310_SoftSetting;
  220. pSiS_SR07 = &SiS310_SR07;
  221. SiS_SR15 = SiS310_SR15;
  222. SiS_CR40 = SiS310_CR40;
  223. SiS_CR49 = SiS310_CR49;
  224. pSiS_SR1F = &SiS310_SR1F;
  225. pSiS_SR21 = &SiS310_SR21;
  226. pSiS_SR22 = &SiS310_SR22;
  227. pSiS_SR23 = &SiS310_SR23;
  228. pSiS_SR24 = &SiS310_SR24;
  229. SiS_SR25 = SiS310_SR25;
  230. pSiS_SR31 = &SiS310_SR31;
  231. pSiS_SR32 = &SiS310_SR32;
  232. pSiS_SR33 = &SiS310_SR33;
  233. pSiS_CRT2Data_1_2 = &SiS310_CRT2Data_1_2;
  234. pSiS_CRT2Data_4_D = &SiS310_CRT2Data_4_D;
  235. pSiS_CRT2Data_4_E = &SiS310_CRT2Data_4_E;
  236. pSiS_CRT2Data_4_10 = &SiS310_CRT2Data_4_10;
  237. pSiS_RGBSenseData = &SiS310_RGBSenseData;
  238. pSiS_VideoSenseData = &SiS310_VideoSenseData;
  239. pSiS_YCSenseData = &SiS310_YCSenseData;
  240. pSiS_RGBSenseData2 = &SiS310_RGBSenseData2;
  241. pSiS_VideoSenseData2 = &SiS310_VideoSenseData2;
  242. pSiS_YCSenseData2 = &SiS310_YCSenseData2;
  243. SiS_NTSCPhase = SiS310_NTSCPhase;
  244. SiS_PALPhase = SiS310_PALPhase;
  245. SiS_NTSCPhase2 = SiS310_NTSCPhase2;
  246. SiS_PALPhase2 = SiS310_PALPhase2;
  247. SiS_PALMPhase = SiS310_PALMPhase; /*add for PALMN */
  248. SiS_PALNPhase = SiS310_PALNPhase;
  250. SiS_StLCD1024x768Data = (SiS_LCDDataStruct *) SiS310_StLCD1024x768Data;
  251. SiS_ExtLCD1024x768Data =
  252.     (SiS_LCDDataStruct *) SiS310_ExtLCD1024x768Data;
  253. SiS_St2LCD1024x768Data =
  254.     (SiS_LCDDataStruct *) SiS310_St2LCD1024x768Data;
  255. SiS_StLCD1280x1024Data =
  256.     (SiS_LCDDataStruct *) SiS310_StLCD1280x1024Data;
  257. SiS_ExtLCD1280x1024Data =
  258.     (SiS_LCDDataStruct *) SiS310_ExtLCD1280x1024Data;
  259. SiS_St2LCD1280x1024Data =
  260.     (SiS_LCDDataStruct *) SiS310_St2LCD1280x1024Data;
  261. SiS_NoScaleData = (SiS_LCDDataStruct *) SiS310_NoScaleData;
  262. SiS_LCD1280x960Data = (SiS_LCDDataStruct *) SiS310_LCD1280x960Data;
  263. SiS_StPALData = (SiS_TVDataStruct *) SiS310_StPALData;
  264. SiS_ExtPALData = (SiS_TVDataStruct *) SiS310_ExtPALData;
  265. SiS_StNTSCData = (SiS_TVDataStruct *) SiS310_StNTSCData;
  266. SiS_ExtNTSCData = (SiS_TVDataStruct *) SiS310_ExtNTSCData;
  267. SiS_St1HiTVData = (SiS_TVDataStruct *) SiS310_St1HiTVData;
  268. SiS_St2HiTVData = (SiS_TVDataStruct *) SiS310_St2HiTVData;
  269. SiS_ExtHiTVData = (SiS_TVDataStruct *) SiS310_ExtHiTVData;
  270. SiS_NTSCTiming = SiS310_NTSCTiming;
  271. SiS_PALTiming = SiS310_PALTiming;
  272. SiS_HiTVSt1Timing = SiS310_HiTVSt1Timing;
  273. SiS_HiTVSt2Timing = SiS310_HiTVSt2Timing;
  274. SiS_HiTVTextTiming = SiS310_HiTVTextTiming;
  275. SiS_HiTVGroup3Data = SiS310_HiTVGroup3Data;
  276. SiS_HiTVGroup3Simu = SiS310_HiTVGroup3Simu;
  277. SiS_HiTVGroup3Text = SiS310_HiTVGroup3Text;
  279. SiS_PanelDelayTbl = (SiS_PanelDelayTblStruct *) SiS310_PanelDelayTbl;
  280. SiS_LVDS800x600Data_1 = (SiS_LVDSDataStruct *) SiS310_LVDS800x600Data_1;
  281. SiS_LVDS800x600Data_2 = (SiS_LVDSDataStruct *) SiS310_LVDS800x600Data_2;
  282. SiS_LVDS1024x768Data_1 =
  283.     (SiS_LVDSDataStruct *) SiS310_LVDS1024x768Data_1;
  284. SiS_LVDS1024x768Data_2 =
  285.     (SiS_LVDSDataStruct *) SiS310_LVDS1024x768Data_2;
  286. SiS_LVDS1280x1024Data_1 =
  287.     (SiS_LVDSDataStruct *) SiS310_LVDS1280x1024Data_1;
  288. SiS_LVDS1280x1024Data_2 =
  289.     (SiS_LVDSDataStruct *) SiS310_LVDS1280x1024Data_2;
  290. SiS_LVDS640x480Data_1 = (SiS_LVDSDataStruct *) SiS310_LVDS640x480Data_1;
  291. SiS_CHTVUNTSCData = (SiS_LVDSDataStruct *) SiS310_CHTVUNTSCData;
  292. SiS_CHTVONTSCData = (SiS_LVDSDataStruct *) SiS310_CHTVONTSCData;
  293. SiS_CHTVUPALData = (SiS_LVDSDataStruct *) SiS310_CHTVUPALData;
  294. SiS_CHTVOPALData = (SiS_LVDSDataStruct *) SiS310_CHTVOPALData;
  295. SiS_PanelType00_1 = (SiS_LVDSDesStruct *) SiS310_PanelType00_1;
  296. SiS_PanelType01_1 = (SiS_LVDSDesStruct *) SiS310_PanelType01_1;
  297. SiS_PanelType02_1 = (SiS_LVDSDesStruct *) SiS310_PanelType02_1;
  298. SiS_PanelType03_1 = (SiS_LVDSDesStruct *) SiS310_PanelType03_1;
  299. SiS_PanelType04_1 = (SiS_LVDSDesStruct *) SiS310_PanelType04_1;
  300. SiS_PanelType05_1 = (SiS_LVDSDesStruct *) SiS310_PanelType05_1;
  301. SiS_PanelType06_1 = (SiS_LVDSDesStruct *) SiS310_PanelType06_1;
  302. SiS_PanelType07_1 = (SiS_LVDSDesStruct *) SiS310_PanelType07_1;
  303. SiS_PanelType08_1 = (SiS_LVDSDesStruct *) SiS310_PanelType08_1;
  304. SiS_PanelType09_1 = (SiS_LVDSDesStruct *) SiS310_PanelType09_1;
  305. SiS_PanelType0a_1 = (SiS_LVDSDesStruct *) SiS310_PanelType0a_1;
  306. SiS_PanelType0b_1 = (SiS_LVDSDesStruct *) SiS310_PanelType0b_1;
  307. SiS_PanelType0c_1 = (SiS_LVDSDesStruct *) SiS310_PanelType0c_1;
  308. SiS_PanelType0d_1 = (SiS_LVDSDesStruct *) SiS310_PanelType0d_1;
  309. SiS_PanelType0e_1 = (SiS_LVDSDesStruct *) SiS310_PanelType0e_1;
  310. SiS_PanelType0f_1 = (SiS_LVDSDesStruct *) SiS310_PanelType0f_1;
  311. SiS_PanelType00_2 = (SiS_LVDSDesStruct *) SiS310_PanelType00_2;
  312. SiS_PanelType01_2 = (SiS_LVDSDesStruct *) SiS310_PanelType01_2;
  313. SiS_PanelType02_2 = (SiS_LVDSDesStruct *) SiS310_PanelType02_2;
  314. SiS_PanelType03_2 = (SiS_LVDSDesStruct *) SiS310_PanelType03_2;
  315. SiS_PanelType04_2 = (SiS_LVDSDesStruct *) SiS310_PanelType04_2;
  316. SiS_PanelType05_2 = (SiS_LVDSDesStruct *) SiS310_PanelType05_2;
  317. SiS_PanelType06_2 = (SiS_LVDSDesStruct *) SiS310_PanelType06_2;
  318. SiS_PanelType07_2 = (SiS_LVDSDesStruct *) SiS310_PanelType07_2;
  319. SiS_PanelType08_2 = (SiS_LVDSDesStruct *) SiS310_PanelType08_2;
  320. SiS_PanelType09_2 = (SiS_LVDSDesStruct *) SiS310_PanelType09_2;
  321. SiS_PanelType0a_2 = (SiS_LVDSDesStruct *) SiS310_PanelType0a_2;
  322. SiS_PanelType0b_2 = (SiS_LVDSDesStruct *) SiS310_PanelType0b_2;
  323. SiS_PanelType0c_2 = (SiS_LVDSDesStruct *) SiS310_PanelType0c_2;
  324. SiS_PanelType0d_2 = (SiS_LVDSDesStruct *) SiS310_PanelType0d_2;
  325. SiS_PanelType0e_2 = (SiS_LVDSDesStruct *) SiS310_PanelType0e_2;
  326. SiS_PanelType0f_2 = (SiS_LVDSDesStruct *) SiS310_PanelType0f_2;
  327. /*301b */
  328. LVDS1024x768Des_1 = (SiS_LVDSDesStruct *) SiS310_PanelType1076_1;
  329. LVDS1280x1024Des_1 = (SiS_LVDSDesStruct *) SiS310_PanelType1210_1;
  330. LVDS1280x960Des_1 = (SiS_LVDSDesStruct *) SiS310_PanelType1296_1;
  331. LVDS1024x768Des_2 = (SiS_LVDSDesStruct *) SiS310_PanelType1076_2;
  332. LVDS1280x1024Des_2 = (SiS_LVDSDesStruct *) SiS310_PanelType1210_2;
  333. LVDS1280x960Des_2 = (SiS_LVDSDesStruct *) SiS310_PanelType1296_2;
  334. /*end 301b */
  336. SiS_CHTVUNTSCDesData = (SiS_LVDSDesStruct *) SiS310_CHTVUNTSCDesData;
  337. SiS_CHTVONTSCDesData = (SiS_LVDSDesStruct *) SiS310_CHTVONTSCDesData;
  338. SiS_CHTVUPALDesData = (SiS_LVDSDesStruct *) SiS310_CHTVUPALDesData;
  339. SiS_CHTVOPALDesData = (SiS_LVDSDesStruct *) SiS310_CHTVOPALDesData;
  340. SiS_LVDSCRT1800x600_1 =
  341.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT1800x600_1;
  342. SiS_LVDSCRT11024x768_1 =
  343.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11024x768_1;
  344. SiS_LVDSCRT11280x1024_1 =
  345.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11280x1024_1;
  346. SiS_LVDSCRT1800x600_1_H =
  347.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT1800x600_1_H;
  348. SiS_LVDSCRT11024x768_1_H =
  349.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11024x768_1_H;
  350. SiS_LVDSCRT11280x1024_1_H =
  351.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11280x1024_1_H;
  352. SiS_LVDSCRT1800x600_2 =
  353.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT1800x600_2;
  354. SiS_LVDSCRT11024x768_2 =
  355.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11024x768_2;
  356. SiS_LVDSCRT11280x1024_2 =
  357.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11280x1024_2;
  358. SiS_LVDSCRT1800x600_2_H =
  359.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT1800x600_2_H;
  360. SiS_LVDSCRT11024x768_2_H =
  361.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11024x768_2_H;
  362. SiS_LVDSCRT11280x1024_2_H =
  363.     (SiS_LVDSCRT1DataStruct *) SiS310_LVDSCRT11280x1024_2_H;
  364. SiS_CHTVCRT1UNTSC = (SiS_LVDSCRT1DataStruct *) SiS310_CHTVCRT1UNTSC;
  365. SiS_CHTVCRT1ONTSC = (SiS_LVDSCRT1DataStruct *) SiS310_CHTVCRT1ONTSC;
  366. SiS_CHTVCRT1UPAL = (SiS_LVDSCRT1DataStruct *) SiS310_CHTVCRT1UPAL;
  367. SiS_CHTVCRT1OPAL = (SiS_LVDSCRT1DataStruct *) SiS310_CHTVCRT1OPAL;
  368. SiS_CHTVReg_UNTSC = (SiS_CHTVRegDataStruct *) SiS310_CHTVReg_UNTSC;
  369. SiS_CHTVReg_ONTSC = (SiS_CHTVRegDataStruct *) SiS310_CHTVReg_ONTSC;
  370. SiS_CHTVReg_UPAL = (SiS_CHTVRegDataStruct *) SiS310_CHTVReg_UPAL;
  371. SiS_CHTVReg_OPAL = (SiS_CHTVRegDataStruct *) SiS310_CHTVReg_OPAL;
  372. /*add for LCDA */
  373. SiS_LCDACRT1800x600_1 =
  374.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT1800x600_1;
  375. SiS_LCDACRT11024x768_1 =
  376.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11024x768_1;
  377. SiS_LCDACRT11280x1024_1 =
  378.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11280x1024_1;
  379. SiS_LCDACRT1800x600_1_H =
  380.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT1800x600_1_H;
  381. SiS_LCDACRT11024x768_1_H =
  382.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11024x768_1_H;
  383. SiS_LCDACRT11280x1024_1_H =
  384.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11280x1024_1_H;
  385. SiS_LCDACRT1800x600_2 =
  386.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT1800x600_2;
  387. SiS_LCDACRT11024x768_2 =
  388.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11024x768_2;
  389. SiS_LCDACRT11280x1024_2 =
  390.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11280x1024_2;
  391. SiS_LCDACRT1800x600_2_H =
  392.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT1800x600_2_H;
  393. SiS_LCDACRT11024x768_2_H =
  394.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11024x768_2_H;
  395. SiS_LCDACRT11280x1024_2_H =
  396.     (SiS_LCDACRT1DataStruct *) SiS310_LCDACRT11280x1024_2_H;
  397. /*end for 301b */
  399. SiS_CHTVVCLKUNTSC = SiS310_CHTVVCLKUNTSC;
  400. SiS_CHTVVCLKONTSC = SiS310_CHTVVCLKONTSC;
  401. SiS_CHTVVCLKUPAL = SiS310_CHTVVCLKUPAL;
  402. SiS_CHTVVCLKOPAL = SiS310_CHTVVCLKOPAL;
  403. /* 310 customization related */
  405. }
  406. #endif
  408. BOOLEAN
  409. SiSInit (PSIS_HW_DEVICE_INFO HwDeviceExtension)
  410. {
  411. ULONG ROMAddr = (ULONG) HwDeviceExtension->pjVirtualRomBase;
  412. ULONG FBAddr = (ULONG) HwDeviceExtension->pjVideoMemoryAddress;
  413. USHORT BaseAddr = (USHORT) HwDeviceExtension->ulIOAddress;
  414. UCHAR i, temp = 0;
  415. UCHAR SR11, temp1;
  416. ULONG base;
  417. UCHAR SR12 = 0, SR13 = 0, SR14 = 0, SR16 = 0, SR17 = 0, SR18 = 0, SR19 =
  418.     0, SR1A = 0;
  419. #ifdef CONFIG_FB_SIS_315
  420. /* ULONG   j, k;   */
  421. UCHAR CR39 = 0, CR3A = 0, CR3B = 0, CR3C = 0, CR3D = 0, CR3E = 0, CR3F =
  422.     0;
  423. UCHAR CR79 = 0, CR7A = 0, CR7B = 0, CR7C = 0;
  424. PSIS_DSReg pSR;
  425. ULONG Temp;
  426. #endif
  427. UCHAR VBIOSVersion[5];
  429. /* if(ROMAddr==0)   return (FALSE);*/
  430. if (FBAddr == 0)
  431. return (FALSE);
  432. if (BaseAddr == 0)
  433. return (FALSE);
  435. SiS_SetReg3 ((USHORT) (BaseAddr + 0x12), 0x67); /* 3c2 <- 67 ,ynlai */
  436. #ifdef CONFIG_FB_SIS_315
  437. /*if(HwDeviceExtension->jChipType > SIS_315H) */
  438. if (HwDeviceExtension->jChipType > SIS_315PRO) {
  439. if (!HwDeviceExtension->bIntegratedMMEnabled)
  440. return (FALSE); /* alan  */
  441. }
  442. #endif
  444. SiS_MemoryCopy (VBIOSVersion, HwDeviceExtension->szVBIOSVer, 4);
  446. VBIOSVersion[4] = 0x0;
  447. /* 09/07/99 modify by domao */
  449. #ifdef CONFIG_FB_SIS_315
  450. if ((HwDeviceExtension->jChipType == SIS_315H) ||
  451.     (HwDeviceExtension->jChipType == SIS_315PRO) ||
  452.     (HwDeviceExtension->jChipType == SIS_550) || /* 05/02/01 ynlai for 550 */
  453.     (HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  454.     (HwDeviceExtension->jChipType == SIS_740)) /* 09/03/01 chiawen for 650 */
  455. InitTo310Pointer ();
  456. #endif
  458. #ifdef CONFIG_FB_SIS_300
  459. if ((HwDeviceExtension->jChipType == SIS_540) ||
  460.     (HwDeviceExtension->jChipType == SIS_630) ||
  461.     (HwDeviceExtension->jChipType == SIS_730) ||
  462.     (HwDeviceExtension->jChipType == SIS_300))
  463. InitTo300Pointer ();
  464. #endif
  466. SiS_P3c4 = BaseAddr + 0x14;
  467. SiS_P3d4 = BaseAddr + 0x24;
  468. SiS_P3c0 = BaseAddr + 0x10;
  469. SiS_P3ce = BaseAddr + 0x1e;
  470. SiS_P3c2 = BaseAddr + 0x12;
  471. SiS_P3ca = BaseAddr + 0x1a;
  472. SiS_P3c6 = BaseAddr + 0x16;
  473. SiS_P3c7 = BaseAddr + 0x17;
  474. SiS_P3c8 = BaseAddr + 0x18;
  475. SiS_P3c9 = BaseAddr + 0x19;
  476. SiS_P3da = BaseAddr + 0x2A;
  477. SiS_Part1Port = BaseAddr + SIS_CRT2_PORT_04;
  478. SiS_Part2Port = BaseAddr + SIS_CRT2_PORT_10;
  479. SiS_Part3Port = BaseAddr + SIS_CRT2_PORT_12;
  480. SiS_Part4Port = BaseAddr + SIS_CRT2_PORT_14;
  481. SiS_Part5Port = BaseAddr + SIS_CRT2_PORT_14 + 2;
  482. SiS_Set_LVDS_TRUMPION (HwDeviceExtension); /*2/29/00 by Mars Wen for LVDS and Trumpion  */
  484. SiS_SetReg1 (SiS_P3c4, 0x05, 0x86); /* 1.Openkey  */
  486. #ifdef LINUX_KERNEL
  487. #ifdef CONFIG_FB_SIS_300 /* add to set SR14 */
  488. if ((HwDeviceExtension->jChipType == SIS_540) ||
  489.     (HwDeviceExtension->jChipType == SIS_630) ||
  490.     (HwDeviceExtension->jChipType == SIS_730)) {
  491. base = 0x80000060;
  492. OutPortLong (base, 0xcf8);
  493. temp1 = InPortLong (0xcfc);
  494. temp1 = temp1 >> (16 + 8 + 4);
  495. temp1 = temp1 & (0x07);
  496. temp1 = temp1 + 1;
  497. temp1 = 1 << temp1;
  498. SR14 = temp1 - 1;
  499. base = 0x80000064;
  500. OutPortLong (base, 0xcf8);
  501. temp1 = InPortLong (0xcfc);
  502. temp1 = temp1 & (0x00000020);
  503. if (temp1)
  504. SR14 = (0x10000000) | SR14;
  505. else
  506. SR14 = (0x01000000) | SR14;
  507. }
  508. #endif
  510. #ifdef CONFIG_FB_SIS_315 /* add to set SR14 */
  511. if ((HwDeviceExtension->jChipType == SIS_550)) {
  512. base = 0x80000060;
  513. OutPortLong (base, 0xcf8);
  514. temp1 = InPortLong (0xcfc);
  515. temp1 = temp1 >> (16 + 8 + 4);
  516. temp1 = temp1 & (0x07);
  517. temp1 = temp1 + 1;
  518. temp1 = 1 << temp1;
  519. SR14 = temp1 - 1;
  520. base = 0x80000064;
  521. OutPortLong (base, 0xcf8);
  522. temp1 = InPortLong (0xcfc);
  523. temp1 = temp1 & (0x00000020);
  524. if (temp1)
  525. SR14 = (0x10000000) | SR14;
  526. else
  527. SR14 = (0x01000000) | SR14;
  528. }
  530. if ((HwDeviceExtension->jChipType == SIS_640)
  531.     || (HwDeviceExtension->jChipType == SIS_740)) {
  532. base = 0x80000064;
  533. OutPortLong (base, 0xcf8);
  534. temp1 = InPortLong (0xcfc);
  535. temp1 = temp >> 4;
  536. temp1 = temp1 & (0x07);
  537. if (temp1 > 2) {
  538. temp = temp1;
  539. switch (temp) {
  540. case 3:
  541. temp1 = 0x07;
  542. break;
  543. case 4:
  544. temp1 = 0x0F;
  545. break;
  546. case 5:
  547. temp1 = 0x1F;
  548. break;
  549. case 6:
  550. temp1 = 0x05;
  551. break;
  552. case 7:
  553. temp1 = 0x17;
  554. break;
  555. case 8:
  556. break;
  557. case 9:
  558. break;
  559. }
  560. }
  561. SR14 = temp1;
  562. base = 0x8000007C;
  563. OutPortLong (base, 0xcf8);
  564. temp1 = InPortLong (0xcfc);
  565. temp1 = temp1 & (0x00000020);
  566. if (temp1)
  567. SR14 = (0x10000000) | SR14;
  568. }
  569. #endif
  571. #endif
  573. #ifdef CONFIG_FB_SIS_300
  574. if ((HwDeviceExtension->jChipType == SIS_540) ||
  575.     (HwDeviceExtension->jChipType == SIS_630) ||
  576.     (HwDeviceExtension->jChipType == SIS_730)) {
  577. SR12 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x12);
  578. SR13 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x13);
  579. SR14 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x14);
  580. SR16 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x16);
  581. SR17 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x17);
  582. SR18 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x18);
  583. SR19 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x19);
  584. SR1A = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x1A);
  585. } else {
  586. SR13 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x13);
  587. SR14 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x14);
  588. }
  589. #endif
  590. #ifdef CONFIG_FB_SIS_315
  591. if ((HwDeviceExtension->jChipType == SIS_550)) {
  592. CR39 = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x39);
  593. CR3A = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x3A);
  594. CR3B = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x3B);
  595. CR3C = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x3C);
  596. CR3D = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x3D);
  597. CR3E = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x3E);
  598. CR3F = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x3F);
  599. CR79 = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x79);
  600. CR7A = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x7A);
  601. CR7B = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x7B);
  602. CR7C = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x7C);
  603. } else if ((HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  604.    (HwDeviceExtension->jChipType == SIS_740)) {
  605. SR12 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x12);
  606. SR13 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x13);
  607. SR14 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x14);
  608. SR16 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x16);
  609. SR17 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x17);
  610. SR18 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x18);
  611. SR19 = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x19);
  612. SR1A = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x1A);
  613. }
  614. #endif
  615. /* ResetExtReg begin */
  616. for (i = 0x06; i < 0x20; i++)
  617. SiS_SetReg1 (SiS_P3c4, i, 0); /* 2.Reset Extended register */
  618. for (i = 0x21; i <= 0x27; i++)
  619. SiS_SetReg1 (SiS_P3c4, i, 0); /*   Reset Extended register */
  620. for (i = 0x31; i <= 0x3D; i++)
  621. SiS_SetReg1 (SiS_P3c4, i, 0);
  623. #ifdef CONFIG_FB_SIS_300H
  624. for (i = 0x38; i <= 0x3F; i++)
  625. SiS_SetReg1 (SiS_P3d4, i, 0);
  626. #endif
  628. #ifdef CONFIG_FB_SIS_315
  629. for (i = 0x37; i <= 0x3F; i++)
  630. SiS_SetReg1 (SiS_P3d4, i, 0);
  631. for (i = 0x79; i <= 0x7C; i++)
  632. SiS_SetReg1 (SiS_P3d4, i, 0);
  633. #endif
  634. /* ResetExtReg end */
  635. #ifdef CONFIG_FB_SIS_300
  636. if ((HwDeviceExtension->jChipType == SIS_540) ||
  637.     (HwDeviceExtension->jChipType == SIS_630) ||
  638.     (HwDeviceExtension->jChipType == SIS_730)) {
  639. SiS_SetReg1 (SiS_P3c4, 0x12, SR12);
  640. SiS_SetReg1 (SiS_P3c4, 0x13, SR13);
  641. SiS_SetReg1 (SiS_P3c4, 0x14, SR14);
  642. SiS_SetReg1 (SiS_P3c4, 0x16, SR16);
  643. SiS_SetReg1 (SiS_P3c4, 0x17, SR17);
  644. SiS_SetReg1 (SiS_P3c4, 0x18, SR18);
  645. SiS_SetReg1 (SiS_P3c4, 0x19, SR19);
  646. SiS_SetReg1 (SiS_P3c4, 0x1A, SR1A);
  647. }
  648. #endif
  649. #ifdef CONFIG_FB_SIS_315
  650. if ((HwDeviceExtension->jChipType == SIS_550)) {
  651. SiS_SetReg1 (SiS_P3d4, 0x39, CR39);
  652. SiS_SetReg1 (SiS_P3d4, 0x3A, CR3A);
  653. SiS_SetReg1 (SiS_P3d4, 0x3B, CR3B);
  654. SiS_SetReg1 (SiS_P3d4, 0x3C, CR3C);
  655. SiS_SetReg1 (SiS_P3d4, 0x3D, CR3D);
  656. SiS_SetReg1 (SiS_P3d4, 0x3E, CR3E);
  657. SiS_SetReg1 (SiS_P3d4, 0x3F, CR3F);
  658. SiS_SetReg1 (SiS_P3d4, 0x79, CR79);
  659. SiS_SetReg1 (SiS_P3d4, 0x7A, CR7A);
  660. SiS_SetReg1 (SiS_P3d4, 0x7B, CR7B);
  661. SiS_SetReg1 (SiS_P3d4, 0x7C, CR7C);
  662. } else if ((HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  663.    (HwDeviceExtension->jChipType == SIS_740)) {
  664. SiS_SetReg1 (SiS_P3c4, 0x12, SR12);
  665. SiS_SetReg1 (SiS_P3c4, 0x13, SR13);
  666. SiS_SetReg1 (SiS_P3c4, 0x14, SR14);
  667. SiS_SetReg1 (SiS_P3c4, 0x16, SR16);
  668. SiS_SetReg1 (SiS_P3c4, 0x17, SR17);
  669. SiS_SetReg1 (SiS_P3c4, 0x18, SR18);
  670. SiS_SetReg1 (SiS_P3c4, 0x19, SR19);
  671. SiS_SetReg1 (SiS_P3c4, 0x1A, SR1A);
  672. }
  673. #endif
  675. /* detect ExtChip Type */
  676. SiS_Set_LVDS_TRUMPION (HwDeviceExtension); /*2/29/00 by Mars Wen for LVDS and Trumpion  */
  678. #ifdef CONFIG_FB_SIS_300
  679. if ((HwDeviceExtension->jChipType == SIS_540) ||
  680.     (HwDeviceExtension->jChipType == SIS_630) ||
  681.     (HwDeviceExtension->jChipType == SIS_730)) {
  682. temp = (UCHAR) SR1A;
  683. } else
  684. #endif
  685. {
  686. if ((*pSiS_SoftSetting & SoftDRAMType) == 0) {
  687. temp = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x3A);
  688. }
  689. }
  691. SiS_RAMType = temp & 0x03;
  692. SiS_SetMemoryClock (ROMAddr);
  694. /* SetDefExt1Regs  begin */
  695. SiS_SetReg1 (SiS_P3c4, 0x07, *pSiS_SR07);
  696. if ((HwDeviceExtension->jChipType != SIS_540) &&
  697.     (HwDeviceExtension->jChipType != SIS_630) &&
  698.     (HwDeviceExtension->jChipType != SIS_730)) {
  699. for (i = 0x15; i < 0x1C; i++) {
  700. SiS_SetReg1 (SiS_P3c4, i,
  701.      SiS_SR15[i - 0x15][SiS_RAMType]);
  702. }
  703. }
  704. #ifdef CONFIG_FB_SIS_315
  705. if ((HwDeviceExtension->jChipType == SIS_315H) ||
  706.     (HwDeviceExtension->jChipType == SIS_315PRO)) {
  707. for (i = 0x40; i <= 0x44; i++) {
  708. SiS_SetReg1 (SiS_P3d4, i,
  709.      SiS_CR40[i - 0x40][SiS_RAMType]);
  710. }
  711. SiS_SetReg1 (SiS_P3d4, 0x48, 0x23);
  712. SiS_SetReg1 (SiS_P3d4, 0x49, SiS_CR49[0]);
  713. /* /SiS_SetReg1(SiS_P3c4,0x25,SiS_SR25[0]);  */
  714. }
  715. #endif
  717. SiS_SetReg1 (SiS_P3c4, 0x1F, *pSiS_SR1F);
  718. /*SiS_SetReg1(SiS_P3c4,0x20,0x20); */
  719. SiS_SetReg1 (SiS_P3c4, 0x20, 0xA0); /* alan, 2001/6/26 Frame buffer can read/write */
  720. SiS_SetReg1 (SiS_P3c4, 0x23, *pSiS_SR23);
  721. SiS_SetReg1 (SiS_P3c4, 0x24, *pSiS_SR24);
  722. SiS_SetReg1 (SiS_P3c4, 0x25, SiS_SR25[0]);
  723. #ifdef CONFIG_FB_SIS_300
  724. if (HwDeviceExtension->jChipType == SIS_300) {
  725. SiS_SetReg1 (SiS_P3c4, 0x21, 0x84);
  726. SiS_SetReg1 (SiS_P3c4, 0x22, 0x00);
  727. }
  728. #endif
  729. SR11 = 0x0F;
  730. SiS_SetReg1 (SiS_P3c4, 0x11, SR11);
  732. SiS_UnLockCRT2 (HwDeviceExtension, BaseAddr);
  733. SiS_SetReg1 (SiS_Part1Port, 0x00, 0x00);
  734. SiS_SetReg1 (SiS_Part1Port, 0x02, *pSiS_CRT2Data_1_2);
  735. #ifdef CONFIG_FB_SIS_315 /* 05/02/01 ynlai  for sis550 */
  736. if ((HwDeviceExtension->jChipType == SIS_315H) ||
  737.     (HwDeviceExtension->jChipType == SIS_315PRO) ||
  738.     (HwDeviceExtension->jChipType == SIS_550) ||
  739.     (HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  740.     (HwDeviceExtension->jChipType == SIS_740))
  741. /* 09/03/01 chiawen for 650 */
  742. SiS_SetReg1 (SiS_Part1Port, 0x2E, 0x08); /* use VB */
  743. #endif
  745. temp = *pSiS_SR32;
  746. if (SiS_BridgeIsOn (BaseAddr)) {
  747. temp = temp & 0xEF;
  748. }
  749. SiS_SetReg1 (SiS_P3c4, 0x32, temp);
  751. #ifdef CONFIG_FB_SIS_315
  752. if ((HwDeviceExtension->jChipType == SIS_315H) ||
  753.     (HwDeviceExtension->jChipType == SIS_315PRO)) {
  754. HwDeviceExtension->pQueryVGAConfigSpace (HwDeviceExtension,
  755.  0x50, 0, &Temp); /* Get */
  757. Temp >>= 20;
  758. Temp &= 0xF;
  759. if (Temp != 1) {
  760. SiS_SetReg1 (SiS_P3c4, 0x25, SiS_SR25[1]);
  761. SiS_SetReg1 (SiS_P3d4, 0x49, SiS_CR49[1]);
  762. }
  764. SiS_SetReg1 (SiS_P3c4, 0x27, 0x1F);
  766. SiS_SetReg1 (SiS_P3c4, 0x31, *pSiS_SR31);
  767. SiS_SetReg1 (SiS_P3c4, 0x32, *pSiS_SR32);
  768. SiS_SetReg1 (SiS_P3c4, 0x33, *pSiS_SR33);
  769. }
  770. #endif
  772. if (SiS_BridgeIsOn (BaseAddr) == 1) {
  773. if (SiS_IF_DEF_LVDS == 0) {
  774. SiS_SetReg1 (SiS_Part2Port, 0x00, 0x1C);
  775. SiS_SetReg1 (SiS_Part4Port, 0x0D, *pSiS_CRT2Data_4_D);
  776. SiS_SetReg1 (SiS_Part4Port, 0x0E, *pSiS_CRT2Data_4_E);
  777. SiS_SetReg1 (SiS_Part4Port, 0x10, *pSiS_CRT2Data_4_10);
  778. SiS_SetReg1 (SiS_Part4Port, 0x0F, 0x3F);
  779. }
  780. SiS_LockCRT2 (HwDeviceExtension, BaseAddr);
  781. }
  782. SiS_SetReg1 (SiS_P3d4, 0x83, 0x00);
  783. /*   SetDefExt1Regs end */
  785. #ifdef CONFIG_FB_SIS_315
  786. if ((HwDeviceExtension->jChipType == SIS_315H) ||
  787.     (HwDeviceExtension->jChipType == SIS_315PRO)
  788.     ) { /* 05/02/01 ynlai */
  789. /* For SiS 300,310 Chip  */
  790. if (HwDeviceExtension->bSkipDramSizing == TRUE) {
  791. SiS_SetDRAMModeRegister (ROMAddr);
  792. pSR = HwDeviceExtension->pSR;
  793. if (pSR != NULL) {
  794. while (pSR->jIdx != 0xFF) {
  795. SiS_SetReg1 (SiS_P3c4, pSR->jIdx,
  796.      pSR->jVal);
  797. pSR++;
  798. }
  799. }
  800. } else
  801. SiS_SetDRAMSize_310 (HwDeviceExtension);
  802. }
  803. #endif
  804. #ifdef CONFIG_FB_SIS_315
  805. if ((HwDeviceExtension->jChipType == SIS_550)) { /* 05/02/01 ynlai For SiS 550 */
  806. /* SetDRAMConfig begin */
  807. /*     SiS_SetReg1(SiS_P3c4,0x12,SR12);
  808.        SiS_SetReg1(SiS_P3c4,0x13,SR13);
  809.        SiS_SetReg1(SiS_P3c4,0x14,SR14);
  810.        SiS_SetReg1(SiS_P3c4,0x16,SR16);
  811.        SiS_SetReg1(SiS_P3c4,0x17,SR17);
  812.        SiS_SetReg1(SiS_P3c4,0x18,SR18);
  813.        SiS_SetReg1(SiS_P3c4,0x19,SR19);
  814.        SiS_SetReg1(SiS_P3c4,0x1A,SR1A);   */
  815. /* SetDRAMConfig end */
  816. }
  817. #endif
  818. #ifdef CONFIG_FB_SIS_300
  819. if (HwDeviceExtension->jChipType == SIS_300) { /* For SiS 300 Chip  */
  820. if (HwDeviceExtension->bSkipDramSizing == TRUE) {
  821. /*       SiS_SetDRAMModeRegister(ROMAddr);
  822.          temp = (HwDeviceExtension->pSR)->jVal;
  823.          SiS_SetReg1(SiS_P3c4,0x13,temp);
  824.          temp = (HwDeviceExtension->pSR)->jVal;
  825.          SiS_SetReg1(SiS_P3c4,0x14,temp);   */
  826. } else {
  827. #ifdef TC
  828. SiS_SetReg1 (SiS_P3c4, 0x13, SR13);
  829. SiS_SetReg1 (SiS_P3c4, 0x14, SR14);
  830. SiS_SetRegANDOR (SiS_P3c4, 0x15, 0xFF, 0x04);
  831. #else
  832. SiS_SetDRAMSize_300 (HwDeviceExtension);
  833. SiS_SetDRAMSize_300 (HwDeviceExtension);
  834. #endif
  835. }
  836. }
  837. if ((HwDeviceExtension->jChipType == SIS_540) || /* For SiS 630/540/730 Chip  */
  838.     (HwDeviceExtension->jChipType == SIS_630) ||
  839.     (HwDeviceExtension->jChipType == SIS_730)) {
  840. /* SetDRAMConfig begin */
  841. /*     SiS_SetReg1(SiS_P3c4,0x12,SR12);
  842.        SiS_SetReg1(SiS_P3c4,0x13,SR13);
  843.        SiS_SetReg1(SiS_P3c4,0x14,SR14);
  844.        SiS_SetReg1(SiS_P3c4,0x16,SR16);
  845.        SiS_SetReg1(SiS_P3c4,0x17,SR17);
  846.        SiS_SetReg1(SiS_P3c4,0x18,SR18);
  847.        SiS_SetReg1(SiS_P3c4,0x19,SR19);
  848.        SiS_SetReg1(SiS_P3c4,0x1A,SR1A);    */
  849. /* SetDRAMConfig end */
  850. }
  851. /* SetDRAMSize end */
  852. #endif
  854. /*   SetDefExt2Regs begin  */
  855. /* AGP=1;
  856.    temp=(UCHAR)SiS_GetReg1(SiS_P3c4,0x3A);
  857.    temp=temp&0x30;
  858.    if(temp==0x30) AGP=0;
  859.    if(AGP==0) *pSiS_SR21=*pSiS_SR21&0xEF;
  860.    SiS_SetReg1(SiS_P3c4,0x21,*pSiS_SR21);
  861.    if(AGP==1) *pSiS_SR22=*pSiS_SR22&0x20;
  862.    SiS_SetReg1(SiS_P3c4,0x22,*pSiS_SR22);  */
  864. SiS_SetReg1 (SiS_P3c4, 0x21, *pSiS_SR21);
  865. SiS_SetReg1 (SiS_P3c4, 0x22, *pSiS_SR22);
  866. /*   SetDefExt2Regs end  */
  868. /* SiS_SetReg3(SiS_P3c6,0xff);
  869.    SiS_ClearDAC(SiS_P3c8);        [ynlai] 05/22/01            */
  871. SiS_DetectMonitor (HwDeviceExtension, BaseAddr);
  872. SiS_GetSenseStatus (HwDeviceExtension, ROMAddr); /* sense CRT2 */
  874. return (TRUE);
  875. }
  877. void
  878. SiS_Set_LVDS_TRUMPION (PSIS_HW_DEVICE_INFO HwDeviceExtension)
  879. {
  880. USHORT temp;
  882. #ifdef CONFIG_FB_SIS_300
  883. if ((HwDeviceExtension->jChipType == SIS_540) ||
  884.     (HwDeviceExtension->jChipType == SIS_630) ||
  885.     (HwDeviceExtension->jChipType == SIS_730)) {
  886. temp = (UCHAR) SiS_GetReg1 (SiS_P3c4, 0x1A);
  887. temp = (temp & 0xE0) >> 4;
  888. SiS_SetRegANDOR (SiS_P3d4, 0x37, 0xF1, temp);
  889. temp = temp >> 1;
  890. if ((temp == 0) || (temp == 1)) { /* for 301 */
  891. SiS_IF_DEF_LVDS = 0;
  892. SiS_IF_DEF_CH7005 = 0;
  893. SiS_IF_DEF_TRUMPION = 0;
  894. }
  895. if ((temp >= 2) && (temp <= 5)) {
  896. SiS_IF_DEF_LVDS = 1;
  897. }
  898. if (temp == 3)
  899. SiS_IF_DEF_TRUMPION = 1;
  900. if ((temp == 4) || (temp == 5))
  901. SiS_IF_DEF_CH7005 = 1;
  902. } else {
  903. SiS_IF_DEF_LVDS = 0;
  904. SiS_IF_DEF_TRUMPION = 0;
  905. SiS_IF_DEF_CH7005 = 0;
  906. }
  907. #else
  908. if ((HwDeviceExtension->jChipType == SIS_550) ||
  909.     (HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  910.     (HwDeviceExtension->jChipType == SIS_740))
  911.  { /* 09/03/01 chiawen for 650 */
  912. SiS_IF_DEF_LVDS = 0;
  913. SiS_IF_DEF_TRUMPION = 0;
  914. SiS_IF_DEF_CH7005 = 0;
  915. }
  916. #endif
  917. }
  919. /* ===============  for 300 dram sizing begin  =============== */
  920. #ifdef CONFIG_FB_SIS_300
  921. void
  922. SiS_SetDRAMSize_300 (PSIS_HW_DEVICE_INFO HwDeviceExtension)
  923. {
  924. /*ULONG   ROMAddr  = (ULONG)HwDeviceExtension->pjVirtualRomBase; */
  925. ULONG FBAddr = (ULONG) HwDeviceExtension->pjVideoMemoryAddress;
  926. /*USHORT  BaseAddr = (USHORT)HwDeviceExtension->ulIOAddress; */
  927. USHORT SR13, SR14 = 0, buswidth, Done;
  928. SHORT i, j, k;
  929. USHORT data, TotalCapacity, PhysicalAdrOtherPage = 0;
  930. ULONG Addr;
  931. UCHAR temp;
  933. int PseudoRankCapacity, PseudoTotalCapacity, PseudoAdrPinCount;
  934. int RankCapacity, AdrPinCount, BankNumHigh, BankNumMid, MB2Bank;
  935. /*int PageCapacity,PhysicalAdrHigh,PhysicalAdrHalfPage,PhysicalAdrAnotherPage; */
  936. int PageCapacity, PhysicalAdrHigh, PhysicalAdrHalfPage;
  938. SiSSetMode (HwDeviceExtension, 0x2e);
  939. data = SiS_GetReg1 (SiS_P3c4, 0x1);
  940. data = data | 0x20;
  941. SiS_SetReg1 (SiS_P3c4, 0x01, data); /* Turn OFF Display  */
  943. SiS_SetReg1 (SiS_P3c4, 0x13, 0x00);
  944. SiS_SetReg1 (SiS_P3c4, 0x14, 0xBF);
  945. buswidth = SiS_ChkBUSWidth_300 (FBAddr);
  947. MB2Bank = 16;
  948. Done = 0;
  949. for (i = 6; i >= 0; i--) {
  950. if (Done == 1)
  951. break;
  952. PseudoRankCapacity = 1 << i;
  953. for (j = 4; j >= 1; j--) {
  954. if (Done == 1)
  955. break;
  956. PseudoTotalCapacity = PseudoRankCapacity * j;
  957. PseudoAdrPinCount = 15 - j;
  958. if (PseudoTotalCapacity <= 64) {
  959. for (k = 0; k <= 16; k++) {
  960. if (Done == 1)
  961. break;
  962. RankCapacity =
  963.     buswidth * SiS_DRAMType[k][3];
  964. AdrPinCount =
  965.     SiS_DRAMType[k][2] +
  966.     SiS_DRAMType[k][0];
  967. if (RankCapacity == PseudoRankCapacity)
  968. if (AdrPinCount <=
  969.     PseudoAdrPinCount) {
  970. if (j == 3) { /* Rank No */
  971. BankNumHigh =
  972.     RankCapacity
  973.     * MB2Bank *
  974.     3 - 1;
  975. BankNumMid =
  976.     RankCapacity
  977.     * MB2Bank *
  978.     1 - 1;
  979. } else {
  980. BankNumHigh =
  981.     RankCapacity
  982.     * MB2Bank *
  983.     j - 1;
  984. BankNumMid =
  985.     RankCapacity
  986.     * MB2Bank *
  987.     j / 2 - 1;
  988. }
  989. PageCapacity =
  990.     (1 <<
  991.      SiS_DRAMType[k][1])
  992.     * buswidth * 4;
  993. PhysicalAdrHigh =
  994.     BankNumHigh;
  995. PhysicalAdrHalfPage =
  996.     (PageCapacity / 2 +
  997.      PhysicalAdrHigh) %
  998.     PageCapacity;
  999. PhysicalAdrOtherPage =
  1000.     PageCapacity *
  1001.     SiS_DRAMType[k][2] +
  1002.     PhysicalAdrHigh;
  1003. /* Write data */
  1004. /*Test */
  1005. temp =
  1006.     (UCHAR)
  1007.     SiS_GetReg1
  1008.     (SiS_P3c4, 0x15);
  1009. SiS_SetReg1 (SiS_P3c4,
  1010.      0x15,
  1011.      (USHORT)
  1012.      (temp &
  1013.       0xFB));
  1015. temp =
  1016.     (UCHAR)
  1017.     SiS_GetReg1
  1018.     (SiS_P3c4, 0x15);
  1019. SiS_SetReg1 (SiS_P3c4,
  1020.      0x15,
  1021.      (USHORT)
  1022.      (temp |
  1023.       0x04));
  1024. /*Test */
  1025. TotalCapacity =
  1026.     SiS_DRAMType[k][3] *
  1027.     buswidth;
  1028. SR13 =
  1029.     SiS_DRAMType[k][4];
  1030. if (buswidth == 4)
  1031. SR14 =
  1032.     (TotalCapacity
  1033.      -
  1034.      1) | 0x80;
  1035. if (buswidth == 2)
  1036. SR14 =
  1037.     (TotalCapacity
  1038.      -
  1039.      1) | 0x40;
  1040. if (buswidth == 1)
  1041. SR14 =
  1042.     (TotalCapacity
  1043.      -
  1044.      1) | 0x00;
  1045. SiS_SetReg1 (SiS_P3c4,
  1046.      0x13,
  1047.      SR13);
  1048. SiS_SetReg1 (SiS_P3c4,
  1049.      0x14,
  1050.      SR14);
  1052. Addr =
  1053.     FBAddr +
  1054.     (BankNumHigh) * 64 *
  1055.     1024 +
  1056.     PhysicalAdrHigh;
  1057. *((USHORT *) (Addr)) =
  1058.     (USHORT)
  1059.     PhysicalAdrHigh;
  1060. Addr =
  1061.     FBAddr +
  1062.     (BankNumMid) * 64 *
  1063.     1024 +
  1064.     PhysicalAdrHigh;
  1065. *((USHORT *) (Addr)) =
  1066.     (USHORT) BankNumMid;
  1067. Addr =
  1068.     FBAddr +
  1069.     (BankNumHigh) * 64 *
  1070.     1024 +
  1071.     PhysicalAdrHalfPage;
  1072. *((USHORT *) (Addr)) =
  1073.     (USHORT)
  1074.     PhysicalAdrHalfPage;
  1075. Addr =
  1076.     FBAddr +
  1077.     (BankNumHigh) * 64 *
  1078.     1024 +
  1079.     PhysicalAdrOtherPage;
  1080. *((USHORT *) (Addr)) =
  1081.     PhysicalAdrOtherPage;
  1083. /* Read data */
  1084. Addr =
  1085.     FBAddr +
  1086.     (BankNumHigh) * 64 *
  1087.     1024 +
  1088.     PhysicalAdrHigh;
  1089. data =
  1090.     *((USHORT *)
  1091.       (Addr));
  1092. if (data ==
  1093.     PhysicalAdrHigh)
  1094.     Done = 1;
  1095. } /* if struct */
  1096. } /* for loop (k) */
  1097. } /* if struct */
  1098. } /* for loop (j) */
  1099. } /* for loop (i) */
  1100. }
  1102. USHORT
  1103. SiS_ChkBUSWidth_300 (ULONG FBAddress)
  1104. {
  1105. /*USHORT  data; */
  1106. PULONG pVideoMemory;
  1108. pVideoMemory = (PULONG) FBAddress;
  1110. pVideoMemory[0] = 0x01234567L;
  1111. pVideoMemory[1] = 0x456789ABL;
  1112. pVideoMemory[2] = 0x89ABCDEFL;
  1113. pVideoMemory[3] = 0xCDEF0123L;
  1114. if (pVideoMemory[3] == 0xCDEF0123L) { /*ChannelA128Bit */
  1115. return (4);
  1116. }
  1117. if (pVideoMemory[1] == 0x456789ABL) { /*ChannelB64Bit */
  1118. return (2);
  1119. }
  1120. return (1);
  1121. }
  1122. #endif
  1124. /* ===============  for 300 dram sizing end    =============== */
  1126. /* ============== alan ====================== */
  1127. #ifdef CONFIG_FB_SIS_315
  1128. UCHAR
  1129. SiS_Get310DRAMType (ULONG ROMAddr)
  1130. {
  1131. UCHAR data;
  1133. /* 
  1134.    index=SiS_GetReg1(SiS_P3c4,0x1A);
  1135.    index=index&07;
  1136.  */
  1137. if (*pSiS_SoftSetting & SoftDRAMType)
  1138. data = *pSiS_SoftSetting & 0x03;
  1139. else
  1140. data = SiS_GetReg1 (SiS_P3c4, 0x3a) & 0x03;
  1142. return data;
  1143. }
  1145. void
  1146. SiS_Delay15us (ULONG ulMicrsoSec)
  1147. {
  1148. }
  1150. void
  1151. SiS_SDR_MRS (void)
  1152. {
  1153. USHORT data;
  1155. data = SiS_GetReg1 (SiS_P3c4, 0x16);
  1156. data = data & 0x3F; /*/ SR16 D7=0,D6=0 */
  1157. SiS_SetReg1 (SiS_P3c4, 0x16, data); /*/ enable mode register set(MRS) low */
  1158. SiS_Delay15us (0x100);
  1159. data = data | 0x80; /*/ SR16 D7=1,D6=0 */
  1160. SiS_SetReg1 (SiS_P3c4, 0x16, data); /*/ enable mode register set(MRS) high */
  1161. SiS_Delay15us (0x100);
  1162. }
  1164. void
  1165. SiS_DDR_MRS (void)
  1166. {
  1167. USHORT data;
  1169. /* SR16 <- 1F,DF,2F,AF */
  1171. /* enable DLL of DDR SD/SGRAM , SR16 D4=1 */
  1172. data = SiS_GetReg1 (SiS_P3c4, 0x16);
  1173. data &= 0x0F;
  1174. data |= 0x10;
  1175. SiS_SetReg1 (SiS_P3c4, 0x16, data);
  1177. if (!(SiS_SR15[1][SiS_RAMType] & 0x10)) {
  1178. data &= 0x0F;
  1179. }
  1180. /* SR16 D7=1,D6=1 */
  1181. data |= 0xC0;
  1182. SiS_SetReg1 (SiS_P3c4, 0x16, data);
  1184. /* SR16 D7=1,D6=0,D5=1,D4=0 */
  1185. data &= 0x0F;
  1186. data |= 0x20;
  1187. SiS_SetReg1 (SiS_P3c4, 0x16, data);
  1188. if (!(SiS_SR15[1][SiS_RAMType] & 0x10)) {
  1189. data &= 0x0F;
  1190. }
  1191. /* SR16 D7=1 */
  1192. data |= 0x80;
  1193. SiS_SetReg1 (SiS_P3c4, 0x16, data);
  1194. }
  1196. void
  1197. SiS_SetDRAMModeRegister (ULONG ROMAddr)
  1198. {
  1200. if (SiS_Get310DRAMType (ROMAddr) < 2) {
  1201. SiS_SDR_MRS ();
  1202. } else {
  1203. /* SR16 <- 0F,CF,0F,8F */
  1204. SiS_DDR_MRS ();
  1205. }
  1206. }
  1208. void
  1209. SiS_DisableRefresh (void)
  1210. {
  1211. USHORT data;
  1213. data = SiS_GetReg1 (SiS_P3c4, 0x17);
  1214. data &= 0xF8;
  1215. SiS_SetReg1 (SiS_P3c4, 0x17, data);
  1217. data = SiS_GetReg1 (SiS_P3c4, 0x19);
  1218. data |= 0x03;
  1219. SiS_SetReg1 (SiS_P3c4, 0x19, data);
  1221. }
  1223. void
  1224. SiS_EnableRefresh (ULONG ROMAddr)
  1225. {
  1227. SiS_SetReg1 (SiS_P3c4, 0x17, SiS_SR15[2][SiS_RAMType]); /* SR17 */
  1229. SiS_SetReg1 (SiS_P3c4, 0x19, SiS_SR15[4][SiS_RAMType]); /* SR19 */
  1231. }
  1233. void
  1234. SiS_DisableChannelInterleaving (int index, USHORT SiS_DDRDRAM_TYPE[][5])
  1235. {
  1236. USHORT data;
  1238. data = SiS_GetReg1 (SiS_P3c4, 0x15);
  1239. data &= 0x1F;
  1240. switch (SiS_DDRDRAM_TYPE[index][3]) {
  1241. case 64:
  1242. data |= 0;
  1243. break;
  1244. case 32:
  1245. data |= 0x20;
  1246. break;
  1247. case 16:
  1248. data |= 0x40;
  1249. break;
  1250. case 4:
  1251. data |= 0x60;
  1252. break;
  1253. }
  1254. SiS_SetReg1 (SiS_P3c4, 0x15, data);
  1256. }
  1258. void
  1259. SiS_SetDRAMSizingType (int index, USHORT DRAMTYPE_TABLE[][5])
  1260. {
  1261. USHORT data;
  1263. data = DRAMTYPE_TABLE[index][4];
  1264. SiS_SetReg1 (SiS_P3c4, 0x13, data);
  1266. /* should delay 50 ns */
  1268. }
  1270. void
  1271. SiS_CheckBusWidth_310 (ULONG ROMAddress, ULONG FBAddress)
  1272. {
  1273. USHORT data;
  1274. PULONG volatile pVideoMemory;
  1276. pVideoMemory = (PULONG) FBAddress;
  1277. if (SiS_Get310DRAMType (ROMAddress) < 2) {
  1279. SiS_SetReg1 (SiS_P3c4, 0x13, 0x00);
  1280. SiS_SetReg1 (SiS_P3c4, 0x14, 0x12);
  1281. /* should delay */
  1282. SiS_SDR_MRS ();
  1284. SiS_ChannelAB = 0;
  1285. SiS_DataBusWidth = 128;
  1286. pVideoMemory[0] = 0x01234567L;
  1287. pVideoMemory[1] = 0x456789ABL;
  1288. pVideoMemory[2] = 0x89ABCDEFL;
  1289. pVideoMemory[3] = 0xCDEF0123L;
  1290. pVideoMemory[4] = 0x55555555L;
  1291. pVideoMemory[5] = 0x55555555L;
  1292. pVideoMemory[6] = 0xFFFFFFFFL;
  1293. pVideoMemory[7] = 0xFFFFFFFFL;
  1294. if ((pVideoMemory[3] != 0xCDEF0123L)
  1295.     || (pVideoMemory[2] != 0x89ABCDEFL)) {
  1296. /*ChannelA64Bit */
  1297. SiS_DataBusWidth = 64;
  1298. SiS_ChannelAB = 0;
  1299. data = SiS_GetReg1 (SiS_P3c4, 0x14);
  1300. SiS_SetReg1 (SiS_P3c4, 0x14, (USHORT) (data & 0xFD));
  1301. }
  1303. if ((pVideoMemory[1] != 0x456789ABL)
  1304.     || (pVideoMemory[0] != 0x01234567L)) {
  1305. /*ChannelB64Bit */
  1306. SiS_DataBusWidth = 64;
  1307. SiS_ChannelAB = 1;
  1308. data = SiS_GetReg1 (SiS_P3c4, 0x14);
  1309. SiS_SetReg1 (SiS_P3c4, 0x14,
  1310.      (USHORT) ((data & 0xFD) | 0x01));
  1311. }
  1312. return;
  1314. } else {
  1315. /* DDR Dual channel */
  1316. SiS_SetReg1 (SiS_P3c4, 0x13, 0x00);
  1317. SiS_SetReg1 (SiS_P3c4, 0x14, 0x02); /* Channel A, 64bit */
  1318. /* should delay */
  1319. SiS_DDR_MRS ();
  1321. SiS_ChannelAB = 0;
  1322. SiS_DataBusWidth = 64;
  1323. pVideoMemory[0] = 0x01234567L;
  1324. pVideoMemory[1] = 0x456789ABL;
  1325. pVideoMemory[2] = 0x89ABCDEFL;
  1326. pVideoMemory[3] = 0xCDEF0123L;
  1327. pVideoMemory[4] = 0x55555555L;
  1328. pVideoMemory[5] = 0x55555555L;
  1329. pVideoMemory[6] = 0xAAAAAAAAL;
  1330. pVideoMemory[7] = 0xAAAAAAAAL;
  1332. if (pVideoMemory[1] == 0x456789ABL) {
  1333. if (pVideoMemory[0] == 0x01234567L) {
  1334. /* Channel A 64bit */
  1335. return;
  1336. }
  1337. } else {
  1338. if (pVideoMemory[0] == 0x01234567L) {
  1339. /* Channel A 32bit */
  1340. SiS_DataBusWidth = 32;
  1341. SiS_SetReg1 (SiS_P3c4, 0x14, 0x00);
  1342. return;
  1343. }
  1345. }
  1347. SiS_SetReg1 (SiS_P3c4, 0x14, 0x03); /* Channel B, 64bit */
  1348. SiS_DDR_MRS ();
  1350. SiS_ChannelAB = 1;
  1351. SiS_DataBusWidth = 64;
  1352. pVideoMemory[0] = 0x01234567L;
  1353. pVideoMemory[1] = 0x456789ABL;
  1354. pVideoMemory[2] = 0x89ABCDEFL;
  1355. pVideoMemory[3] = 0xCDEF0123L;
  1356. pVideoMemory[4] = 0x55555555L;
  1357. pVideoMemory[5] = 0x55555555L;
  1358. pVideoMemory[6] = 0xAAAAAAAAL;
  1359. pVideoMemory[7] = 0xAAAAAAAAL;
  1360. if (pVideoMemory[1] == 0x456789ABL) {
  1361. /* Channel B 64 */
  1362. if (pVideoMemory[0] == 0x01234567L) {
  1363. /* Channel B 64bit */
  1364. return;
  1365. } else {
  1366. /* error */
  1367. }
  1368. } else {
  1369. if (pVideoMemory[0] == 0x01234567L) {
  1370. /* Channel B 32 */
  1371. SiS_DataBusWidth = 32;
  1372. SiS_SetReg1 (SiS_P3c4, 0x14, 0x01);
  1373. } else {
  1374. /* error */
  1375. }
  1376. }
  1377. }
  1378. }
  1380. int
  1381. SiS_SetRank (int index, UCHAR RankNo, UCHAR SiS_ChannelAB,
  1382.      USHORT DRAMTYPE_TABLE[][5])
  1383. {
  1384. USHORT data;
  1385. int RankSize;
  1387. if ((RankNo == 2) && (DRAMTYPE_TABLE[index][0] == 2))
  1388. return 0;
  1390. RankSize = DRAMTYPE_TABLE[index][3] / 2 * SiS_DataBusWidth / 32;
  1392. if (RankNo * RankSize <= 128) {
  1393. data = 0;
  1394. while ((RankSize >>= 1) > 0) {
  1395. data += 0x10;
  1396. }
  1397. data |= (RankNo - 1) << 2;
  1398. data |= (SiS_DataBusWidth / 64) & 2;
  1399. data |= SiS_ChannelAB;
  1400. SiS_SetReg1 (SiS_P3c4, 0x14, data);
  1401. /* should delay */
  1402. SiS_SDR_MRS ();
  1403. return 1;
  1404. } else
  1405. return 0;
  1407. }
  1409. int
  1410. SiS_SetDDRChannel (int index, UCHAR ChannelNo, UCHAR SiS_ChannelAB,
  1411.    USHORT DRAMTYPE_TABLE[][5])
  1412. {
  1413. USHORT data;
  1414. int RankSize;
  1416. RankSize = DRAMTYPE_TABLE[index][3] / 2 * SiS_DataBusWidth / 32;
  1417. /* RankSize = DRAMTYPE_TABLE[index][3]; */
  1418. if (ChannelNo * RankSize <= 128) {
  1419. data = 0;
  1420. while ((RankSize >>= 1) > 0) {
  1421. data += 0x10;
  1422. }
  1423. if (ChannelNo == 2)
  1424. data |= 0x0C;
  1426. data |= (SiS_DataBusWidth / 32) & 2;
  1427. data |= SiS_ChannelAB;
  1428. SiS_SetReg1 (SiS_P3c4, 0x14, data);
  1429. /* should delay */
  1430. SiS_DDR_MRS ();
  1431. return 1;
  1432. } else
  1433. return 0;
  1435. }
  1437. int
  1438. SiS_CheckColumn (int index, USHORT DRAMTYPE_TABLE[][5], ULONG FBAddress)
  1439. {
  1440. int i;
  1441. ULONG Increment, Position;
  1443. /*Increment = 1<<(DRAMTYPE_TABLE[index][2] + SiS_DataBusWidth / 64 + 1); */
  1444. Increment = 1 << (10 + SiS_DataBusWidth / 64);
  1446. for (i = 0, Position = 0; i < 2; i++) {
  1447. *((PULONG) (FBAddress + Position)) = Position;
  1448. Position += Increment;
  1449. }
  1451. for (i = 0, Position = 0; i < 2; i++) {
  1452. /*    if (FBAddress[Position]!=Position) */
  1453. if ((*(PULONG) (FBAddress + Position)) != Position)
  1454. return 0;
  1455. Position += Increment;
  1456. }
  1457. return 1;
  1458. }
  1460. int
  1461. SiS_CheckBanks (int index, USHORT DRAMTYPE_TABLE[][5], ULONG FBAddress)
  1462. {
  1463. int i;
  1464. ULONG Increment, Position;
  1465. Increment = 1 << (DRAMTYPE_TABLE[index][2] + SiS_DataBusWidth / 64 + 2);
  1467. for (i = 0, Position = 0; i < 4; i++) {
  1468. /*    FBAddress[Position]=Position; */
  1469. *((PULONG) (FBAddress + Position)) = Position;
  1470. Position += Increment;
  1471. }
  1473. for (i = 0, Position = 0; i < 4; i++) {
  1474. /*    if (FBAddress[Position]!=Position) */
  1475. if ((*(PULONG) (FBAddress + Position)) != Position)
  1476. return 0;
  1477. Position += Increment;
  1478. }
  1479. return 1;
  1480. }
  1482. int
  1483. SiS_CheckRank (int RankNo, int index, USHORT DRAMTYPE_TABLE[][5],
  1484.        ULONG FBAddress)
  1485. {
  1486. int i;
  1487. ULONG Increment, Position;
  1488. Increment = 1 << (DRAMTYPE_TABLE[index][2] + DRAMTYPE_TABLE[index][1] +
  1489.   DRAMTYPE_TABLE[index][0] + SiS_DataBusWidth / 64 +
  1490.   RankNo);
  1492. for (i = 0, Position = 0; i < 2; i++) {
  1493. /*    FBAddress[Position]=Position; */
  1494. *((PULONG) (FBAddress + Position)) = Position;
  1495. /* *((PULONG)(FBAddress))=Position; */
  1496. Position += Increment;
  1497. }
  1499. for (i = 0, Position = 0; i < 2; i++) {
  1500. /*    if (FBAddress[Position]!=Position) */
  1501. if ((*(PULONG) (FBAddress + Position)) != Position)
  1502. /*if ( (*(PULONG) (FBAddress )) !=Position) */
  1503. return 0;
  1504. Position += Increment;
  1505. }
  1506. return 1;
  1508. }
  1510. int
  1511. SiS_CheckDDRRank (int RankNo, int index, USHORT DRAMTYPE_TABLE[][5],
  1512.   ULONG FBAddress)
  1513. {
  1514. ULONG Increment, Position;
  1515. USHORT data;
  1517. Increment = 1 << (DRAMTYPE_TABLE[index][2] + DRAMTYPE_TABLE[index][1] +
  1518.   DRAMTYPE_TABLE[index][0] + SiS_DataBusWidth / 64 +
  1519.   RankNo);
  1521. Increment += Increment / 2;
  1523. Position = 0;
  1524. *((PULONG) (FBAddress + Position + 0)) = 0x01234567;
  1525. *((PULONG) (FBAddress + Position + 1)) = 0x456789AB;
  1526. *((PULONG) (FBAddress + Position + 2)) = 0x55555555;
  1527. *((PULONG) (FBAddress + Position + 3)) = 0x55555555;
  1528. *((PULONG) (FBAddress + Position + 4)) = 0xAAAAAAAA;
  1529. *((PULONG) (FBAddress + Position + 5)) = 0xAAAAAAAA;
  1531. if ((*(PULONG) (FBAddress + 1)) == 0x456789AB)
  1532. return 1;
  1534. if ((*(PULONG) (FBAddress + 0)) == 0x01234567)
  1535. return 0;
  1537. data = SiS_GetReg1 (SiS_P3c4, 0x14);
  1538. data &= 0xF3;
  1539. data |= 0x08;
  1540. SiS_SetReg1 (SiS_P3c4, 0x14, data);
  1541. data = SiS_GetReg1 (SiS_P3c4, 0x15);
  1542. data += 0x20;
  1543. SiS_SetReg1 (SiS_P3c4, 0x15, data);
  1545. return 1;
  1547. }
  1549. int
  1550. SiS_CheckRanks (int RankNo, int index, USHORT DRAMTYPE_TABLE[][5],
  1551. ULONG FBAddress)
  1552. {
  1553. int r;
  1555. for (r = RankNo; r >= 1; r--) {
  1556. if (!SiS_CheckRank (r, index, DRAMTYPE_TABLE, FBAddress))
  1557. return 0;
  1558. }
  1559. if (!SiS_CheckBanks (index, DRAMTYPE_TABLE, FBAddress))
  1560. return 0;
  1562. if (!SiS_CheckColumn (index, DRAMTYPE_TABLE, FBAddress))
  1563. return 0;
  1564. return 1;
  1566. }
  1568. int
  1569. SiS_CheckDDRRanks (int RankNo, int index, USHORT DRAMTYPE_TABLE[][5],
  1570.    ULONG FBAddress)
  1571. {
  1572. int r;
  1574. for (r = RankNo; r >= 1; r--) {
  1575. if (!SiS_CheckDDRRank (r, index, DRAMTYPE_TABLE, FBAddress))
  1576. return 0;
  1577. }
  1578. if (!SiS_CheckBanks (index, DRAMTYPE_TABLE, FBAddress))
  1579. return 0;
  1581. if (!SiS_CheckColumn (index, DRAMTYPE_TABLE, FBAddress))
  1582. return 0;
  1583. return 1;
  1585. }
  1587. int
  1588. SiS_SDRSizing (ULONG FBAddress)
  1589. {
  1590. int i;
  1591. UCHAR j;
  1593. for (i = 0; i < 13; i++) {
  1594. SiS_SetDRAMSizingType (i, SiS_SDRDRAM_TYPE);
  1595. for (j = 2; j > 0; j--) {
  1597. if (!SiS_SetRank
  1598.     (i, (UCHAR) j, SiS_ChannelAB,
  1599.      SiS_SDRDRAM_TYPE)) continue;
  1600. else {
  1601. if (SiS_CheckRanks
  1602.     (j, i, SiS_SDRDRAM_TYPE,
  1603.      FBAddress)) return 1;
  1604. }
  1605. }
  1606. }
  1607. return 0;
  1608. }
  1610. int
  1611. SiS_DDRSizing (ULONG FBAddress)
  1612. {
  1614. int i;
  1615. UCHAR j;
  1617. for (i = 0; i < 4; i++) {
  1618. SiS_SetDRAMSizingType (i, SiS_DDRDRAM_TYPE);
  1619. SiS_DisableChannelInterleaving (i, SiS_DDRDRAM_TYPE);
  1620. for (j = 2; j > 0; j--) {
  1621. SiS_SetDDRChannel (i, j, SiS_ChannelAB,
  1622.    SiS_DDRDRAM_TYPE);
  1623. if (!SiS_SetRank
  1624.     (i, (UCHAR) j, SiS_ChannelAB,
  1625.      SiS_DDRDRAM_TYPE)) continue;
  1626. else {
  1627. if (SiS_CheckDDRRanks
  1628.     (j, i, SiS_DDRDRAM_TYPE,
  1629.      FBAddress)) return 1;
  1630. }
  1631. }
  1632. }
  1633. return 0;
  1634. }
  1636. /*
  1638.  check if read cache pointer is correct
  1640. */
  1641. void
  1642. SiS_VerifyMclk (ULONG FBAddr)
  1643. {
  1644. PUCHAR pVideoMemory = (PUCHAR) FBAddr;
  1645. UCHAR i, j;
  1646. USHORT Temp, SR21;
  1648. pVideoMemory[0] = 0xaa; /* alan */
  1649. pVideoMemory[16] = 0x55; /* note: PCI read cache is off */
  1651. if ((pVideoMemory[0] != 0xaa) || (pVideoMemory[16] != 0x55)) {
  1652. for (i = 0, j = 16; i < 2; i++, j += 16) {
  1653. SR21 = SiS_GetReg1 (SiS_P3c4, 0x21);
  1654. Temp = SR21 & 0xFB; /* disable PCI post write buffer empty gating */
  1655. SiS_SetReg1 (SiS_P3c4, 0x21, Temp);
  1657. Temp = SiS_GetReg1 (SiS_P3c4, 0x3C);
  1658. Temp = Temp | 0x01; /*MCLK reset */
  1659. SiS_SetReg1 (SiS_P3c4, 0x3C, Temp);
  1660. Temp = SiS_GetReg1 (SiS_P3c4, 0x3C);
  1661. Temp = Temp & 0xFE; /* MCLK normal operation */
  1662. SiS_SetReg1 (SiS_P3c4, 0x3C, Temp);
  1663. SiS_SetReg1 (SiS_P3c4, 0x21, SR21);
  1665. pVideoMemory[16 + j] = j;
  1666. if (pVideoMemory[16 + j] == j) {
  1667. pVideoMemory[j] = j;
  1668. break;
  1669. }
  1670. }
  1671. }
  1673. }
  1675. int
  1676. Is315E (void)
  1677. {
  1678. USHORT data;
  1680. data = SiS_GetReg1 (SiS_P3d4, 0x5F);
  1681. if (data & 0x10)
  1682. return 1;
  1683. else
  1684. return 0;
  1685. }
  1687. void
  1688. SiS_SetDRAMSize_310 (PSIS_HW_DEVICE_INFO HwDeviceExtension)
  1689. {
  1690. ULONG ROMAddr = (ULONG) HwDeviceExtension->pjVirtualRomBase;
  1691. ULONG FBAddr = (ULONG) HwDeviceExtension->pjVideoMemoryAddress;
  1692. /*USHORT  BaseAddr = (USHORT)HwDeviceExtension->ulIOAddress; */
  1693. USHORT data;
  1695. #ifdef SIS301
  1696. /*SiS_SetReg1(SiS_P3d4,0x30,0x40);   */
  1697. #endif
  1698. #ifdef SIS302
  1699. SiS_SetReg1 (SiS_P3d4, 0x30, 0x4D); /* alan,should change value */
  1700. SiS_SetReg1 (SiS_P3d4, 0x31, 0xc0); /* alan,should change value */
  1701. SiS_SetReg1 (SiS_P3d4, 0x34, 0x3F); /* alan,should change value */
  1702. #endif
  1704. SiSSetMode (HwDeviceExtension, 0x2e);
  1706. data = SiS_GetReg1 (SiS_P3c4, 0x21);
  1707. SiS_SetReg1 (SiS_P3c4, 0x21, (USHORT) (data & 0xDF)); /* disable read cache */
  1709. data = SiS_GetReg1 (SiS_P3c4, 0x1);
  1710. data = data | 0x20;
  1711. SiS_SetReg1 (SiS_P3c4, 0x01, data); /* Turn OFF Display */
  1713. data = SiS_GetReg1 (SiS_P3c4, 0x16);
  1714. SiS_SetReg1 (SiS_P3c4, 0x16, (USHORT) (data | 0x0F)); /* assume lowest speed DRAM */
  1716. SiS_SetDRAMModeRegister (ROMAddr);
  1717. SiS_DisableRefresh ();
  1718. SiS_CheckBusWidth_310 (ROMAddr, FBAddr);
  1720. SiS_VerifyMclk (FBAddr); /* alan 2000/7/3 */
  1722. if (SiS_Get310DRAMType (ROMAddr) < 2) {
  1723. SiS_SDRSizing (FBAddr);
  1724. } else {
  1725. SiS_DDRSizing (FBAddr);
  1726. }
  1728. if (Is315E ()) {
  1729. data = SiS_GetReg1 (SiS_P3c4, 0x14);
  1730. if ((data & 0x0C) == 0x0C) { /* dual channel */
  1731. if ((data & 0xF0) > 0x40)
  1732. data = (data & 0x0F) | 0x40;
  1733. } else { /* single channel */
  1735. if ((data & 0xF0) > 0x50)
  1736. data = (data & 0x0F) | 0x50;
  1737. }
  1739. }
  1741. SiS_SetReg1 (SiS_P3c4, 0x16, SiS_SR15[1][SiS_RAMType]); /* restore SR16 */
  1743. SiS_EnableRefresh (ROMAddr);
  1744. data = SiS_GetReg1 (SiS_P3c4, 0x21);
  1745. SiS_SetReg1 (SiS_P3c4, 0x21, (USHORT) (data | 0x20)); /* enable read cache */
  1747. }
  1748. #endif
  1750. void
  1751. SiS_SetMemoryClock (ULONG ROMAddr)
  1752. {
  1753. SiS_SetReg1 (SiS_P3c4, 0x28, SiS_MCLKData[SiS_RAMType].SR28);
  1754. SiS_SetReg1 (SiS_P3c4, 0x29, SiS_MCLKData[SiS_RAMType].SR29);
  1755. SiS_SetReg1 (SiS_P3c4, 0x2A, SiS_MCLKData[SiS_RAMType].SR2A);
  1756. SiS_SetReg1 (SiS_P3c4, 0x2E, SiS_ECLKData[SiS_RAMType].SR2E);
  1757. SiS_SetReg1 (SiS_P3c4, 0x2F, SiS_ECLKData[SiS_RAMType].SR2F);
  1758. SiS_SetReg1 (SiS_P3c4, 0x30, SiS_ECLKData[SiS_RAMType].SR30);
  1760. #ifdef CONFIG_FB_SIS_315
  1761. if (Is315E ()) {
  1762. SiS_SetReg1 (SiS_P3c4, 0x28, 0x3B); /* 143 */
  1763. SiS_SetReg1 (SiS_P3c4, 0x29, 0x22);
  1764. SiS_SetReg1 (SiS_P3c4, 0x2E, 0x3B); /* 143 */
  1765. SiS_SetReg1 (SiS_P3c4, 0x2F, 0x22);
  1766. }
  1767. #endif
  1769. }
  1771. /*
  1772. =========================================
  1773.  ======== SiS SetMode Function  ==========
  1774. =========================================
  1775. */
  1776. BOOLEAN
  1777. SiSSetMode (PSIS_HW_DEVICE_INFO HwDeviceExtension, USHORT ModeNo)
  1778. {
  1779. ULONG temp;
  1780. USHORT ModeIdIndex, KeepLockReg;
  1781. ULONG ROMAddr = (ULONG) HwDeviceExtension->pjVirtualRomBase;
  1782. /*ULONG   FBAddr   = (ULONG)HwDeviceExtension->pjVideoMemoryAddress; */
  1783. USHORT BaseAddr = (USHORT) HwDeviceExtension->ulIOAddress;
  1785. #ifdef CONFIG_FB_SIS_315
  1786. if ((HwDeviceExtension->jChipType == SIS_315H) || /* 05/02/01 ynlai for sis550 */
  1787.     (HwDeviceExtension->jChipType == SIS_315PRO) ||
  1788.     (HwDeviceExtension->jChipType == SIS_550) ||
  1789.     (HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  1790.     (HwDeviceExtension->jChipType == SIS_740)) /* 09/03/01 chiawen for 650 */
  1791. InitTo310Pointer ();
  1792. #endif
  1794. #ifdef CONFIG_FB_SIS_300
  1795. if ((HwDeviceExtension->jChipType == SIS_540) ||
  1796.     (HwDeviceExtension->jChipType == SIS_630) ||
  1797.     (HwDeviceExtension->jChipType == SIS_730) ||
  1798.     (HwDeviceExtension->jChipType == SIS_300))
  1799. InitTo300Pointer ();
  1800. #endif
  1802. SiS_P3c4 = BaseAddr + 0x14;
  1803. SiS_P3d4 = BaseAddr + 0x24;
  1804. SiS_P3c0 = BaseAddr + 0x10;
  1805. SiS_P3ce = BaseAddr + 0x1e;
  1806. SiS_P3c2 = BaseAddr + 0x12;
  1807. SiS_P3ca = BaseAddr + 0x1a;
  1808. SiS_P3c6 = BaseAddr + 0x16;
  1809. SiS_P3c7 = BaseAddr + 0x17;
  1810. SiS_P3c8 = BaseAddr + 0x18;
  1811. SiS_P3c9 = BaseAddr + 0x19;
  1812. SiS_P3da = BaseAddr + 0x2A;
  1813. SiS_Part1Port = BaseAddr + SIS_CRT2_PORT_04;
  1814. SiS_Part2Port = BaseAddr + SIS_CRT2_PORT_10;
  1815. SiS_Part3Port = BaseAddr + SIS_CRT2_PORT_12;
  1816. SiS_Part4Port = BaseAddr + SIS_CRT2_PORT_14;
  1817. SiS_Part5Port = BaseAddr + SIS_CRT2_PORT_14 + 2;
  1819. SiS_IF_DEF_LVDS = 0;
  1820. SiS_IF_DEF_CH7005 = 0;
  1821. SiS_IF_DEF_HiVision = 0;
  1822. SiS_IF_DEF_DSTN = 0; /*for 550 dstn */
  1823. if ((HwDeviceExtension->jChipType == SIS_540) ||
  1824.     (HwDeviceExtension->jChipType == SIS_630) ||
  1825.     (HwDeviceExtension->jChipType == SIS_730) ||
  1826.     (HwDeviceExtension->jChipType == SIS_550) ||
  1827.     (HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  1828.     (HwDeviceExtension->jChipType == SIS_740)) { /* 09/03/01 chiawen for 650 */
  1829. temp = SiS_GetReg1 (SiS_P3d4, 0x37);
  1830. temp = (temp & 0x0E) >> 1;
  1831. if ((temp == 0) || (temp == 1)) { /* for 301 */
  1832. SiS_IF_DEF_LVDS = 0;
  1833. SiS_IF_DEF_CH7005 = 0;
  1834. SiS_IF_DEF_TRUMPION = 0;
  1835. }
  1836. if ((temp >= 2) && (temp <= 5)) {
  1837. SiS_IF_DEF_LVDS = 1;
  1838. }
  1839. if (temp == 3)
  1840. SiS_IF_DEF_TRUMPION = 1;
  1841. if ((temp == 4) || (temp == 5))
  1842. SiS_IF_DEF_CH7005 = 1;
  1843. } else {
  1844. SiS_IF_DEF_LVDS = 0;
  1845. SiS_IF_DEF_TRUMPION = 0;
  1846. SiS_IF_DEF_CH7005 = 0;
  1847. }
  1849. if (ModeNo & 0x80) {
  1850. ModeNo = ModeNo & 0x7F;
  1851. flag_clearbuffer = 0;
  1852. } else {
  1853. flag_clearbuffer = 1;
  1854. }
  1856. SiS_PresetScratchregister (SiS_P3d4, HwDeviceExtension); /*add for CRT2  */
  1857. KeepLockReg = SiS_GetReg1 (SiS_P3c4, 0x05);
  1858. SiS_SetReg1 (SiS_P3c4, 0x05, 0x86); /* 1.Openkey */
  1859. temp = SiS_SearchModeID (ROMAddr, ModeNo, &ModeIdIndex); /* 2.Get ModeID Table  */
  1860. if (temp == 0)
  1861. return (0);
  1862. /*301b */
  1863. SiS_GetVBType (BaseAddr);
  1864. /*end 301b */
  1865. SiS_GetVBInfo301 (BaseAddr, ROMAddr, ModeNo, ModeIdIndex, HwDeviceExtension); /*add for CRT2 */
  1866. SiS_GetLCDResInfo301 (ROMAddr, SiS_P3d4, ModeNo, ModeIdIndex); /*add for CRT2 */
  1868. temp = SiS_CheckMemorySize (ROMAddr, HwDeviceExtension, ModeNo, ModeIdIndex); /*3.Check memory size */
  1869. if (temp == 0)
  1870. return (0);
  1871. if (SiS_VBInfo & (SetSimuScanMode | SetCRT2ToLCDA)) { /*301b */
  1872. SiS_SetCRT1Group (ROMAddr, HwDeviceExtension, ModeNo,
  1873.   ModeIdIndex);
  1874. } else {
  1875. if (!(SiS_VBInfo & SwitchToCRT2)) {
  1876. SiS_SetCRT1Group (ROMAddr, HwDeviceExtension, ModeNo,
  1877.   ModeIdIndex);
  1878. }
  1879. }
  1881. if (SiS_VBInfo & (SetSimuScanMode | SwitchToCRT2 | SetCRT2ToLCDA)) { /*301b */
  1882. switch (HwDeviceExtension->ujVBChipID) {
  1883. /*karl*/
  1884. case VB_CHIP_301:
  1885. case VB_CHIP_301B:
  1886. SiS_SetCRT2Group301 (BaseAddr, ROMAddr, ModeNo, HwDeviceExtension); /*add for CRT2 */
  1887. break;
  1888. case VB_CHIP_302:
  1889. SiS_SetCRT2Group301 (BaseAddr, ROMAddr, ModeNo,
  1890.      HwDeviceExtension);
  1891. break;
  1892. case VB_CHIP_303:
  1893. /*        SetCRT2Group302(BaseAddr,ROMAddr,ModeNo, HwDeviceExtension);                       add for CRT2   */
  1894. break;
  1895. case VB_CHIP_UNKNOWN: /*add for lvds ch7005 */
  1896. temp = SiS_GetReg1 (SiS_P3d4, 0x37);
  1897. if (temp &
  1898.     (ExtChipLVDS | ExtChipTrumpion | ExtChipCH7005)) {
  1899. SiS_SetCRT2Group301 (BaseAddr, ROMAddr, ModeNo,
  1900.      HwDeviceExtension);
  1901. }
  1902. break;
  1903. }
  1904. }
  1905. if (KeepLockReg == 0xA1)
  1906. SiS_SetReg1 (SiS_P3c4, 0x05, 0x86); /* 05/02/01 ynlai */
  1907. else
  1908. SiS_SetReg1 (SiS_P3c4, 0x05, 0x00);
  1909. return TRUE;
  1910. }
  1912. void
  1913. SiS_SetCRT1Group (ULONG ROMAddr, PSIS_HW_DEVICE_INFO HwDeviceExtension,
  1914.   USHORT ModeNo, USHORT ModeIdIndex)
  1915. {
  1916. USHORT StandTableIndex, RefreshRateTableIndex;
  1917. USHORT temp;
  1919. /*SiS_SetReg1(SiS_P3d4,0x34,ModeNo); */
  1920. SiS_CRT1Mode = ModeNo;
  1921. /* set CR34->CRT1 ModeNofor CRT2 FIFO */
  1922. StandTableIndex = SiS_GetModePtr (ROMAddr, ModeNo, ModeIdIndex); /* 4.GetModePtr  */
  1923. SiS_SetSeqRegs (ROMAddr, StandTableIndex); /* 5.SetSeqRegs  */
  1924. SiS_SetMiscRegs (ROMAddr, StandTableIndex); /* 6.SetMiscRegs */
  1925. SiS_SetCRTCRegs (ROMAddr, HwDeviceExtension, StandTableIndex); /* 7.SetCRTCRegs */
  1926. SiS_SetATTRegs (ROMAddr, StandTableIndex); /* 8.SetATTRegs  */
  1927. SiS_SetGRCRegs (ROMAddr, StandTableIndex); /* 9.SetGRCRegs  */
  1928. SiS_ClearExt1Regs (); /* 10.Clear Ext1Regs */
  1929. temp = ~ProgrammingCRT2; /*       11.GetRatePtr  */
  1930. SiS_SetFlag = SiS_SetFlag & temp;
  1931. SiS_SelectCRT2Rate = 0;
  1932. /*301b */
  1933. if ((SiS_VBType & VB_SIS301B) || (SiS_VBType & VB_SIS302B)) {
  1934. if (SiS_VBInfo & SetCRT2ToLCDA) {
  1935. SiS_SetFlag = SiS_SetFlag | ProgrammingCRT2;
  1936. /*   SiS_SelectCRT2Rate=4; */
  1937. }
  1938. }
  1939. /*end 301b */
  1941. RefreshRateTableIndex = SiS_GetRatePtrCRT2 (ROMAddr, ModeNo, ModeIdIndex); /* 11.GetRatePtr */
  1943. /*301b */
  1944. if ((SiS_VBType & VB_SIS301B) || (SiS_VBType & VB_SIS302B)) {
  1945. if (!(SiS_VBInfo & SetCRT2ToLCDA)) {
  1946. SiS_SetFlag = SiS_SetFlag & (~ProgrammingCRT2);
  1947. }
  1948. }
  1949. /*end 301b */
  1951. if (RefreshRateTableIndex != 0xFFFF) {
  1952. SiS_SetSync (ROMAddr, RefreshRateTableIndex); /* 12.SetSync */
  1953. SiS_SetCRT1CRTC (ROMAddr, ModeNo, ModeIdIndex, RefreshRateTableIndex); /* 13.SetCRT1CRTC  */
  1954. SiS_SetCRT1Offset (ROMAddr, ModeNo, ModeIdIndex,
  1955.    RefreshRateTableIndex, HwDeviceExtension); /* 14.SetCRT1Offset */
  1956. SiS_SetCRT1VCLK (ROMAddr, ModeNo, ModeIdIndex,
  1957.  HwDeviceExtension, RefreshRateTableIndex); /* 15.SetCRT1VCLK  */
  1958. }
  1959. #ifdef CONFIG_FB_SIS_300
  1960. if ((HwDeviceExtension->jChipType == SIS_630) ||
  1961.     (HwDeviceExtension->jChipType == SIS_540)) {
  1962. SiS_SetCRT1FIFO2 (ROMAddr, ModeNo, HwDeviceExtension,
  1963.   RefreshRateTableIndex);
  1964. }
  1965. #endif
  1966. #ifdef CONFIG_FB_SIS_315
  1967. if (HwDeviceExtension->jChipType >= SIS_315H) {
  1968. SiS_SetCRT1FIFO (ROMAddr, ModeNo, HwDeviceExtension);
  1969. }
  1970. #endif
  1971. SiS_SetCRT1ModeRegs (ROMAddr, HwDeviceExtension, ModeNo, ModeIdIndex,
  1972.      RefreshRateTableIndex);
  1973. SiS_SetVCLKState (ROMAddr, HwDeviceExtension, ModeNo,
  1974.   RefreshRateTableIndex);
  1975. #ifdef CONFIG_FB_SIS_315
  1976. if (HwDeviceExtension->jChipType > SIS_315H)
  1977. SiS_SetInterlace (ROMAddr, ModeNo, RefreshRateTableIndex);
  1978. #endif
  1979. SiS_LoadDAC (ROMAddr, ModeNo, ModeIdIndex);
  1980. if (flag_clearbuffer)
  1981. SiS_ClearBuffer (HwDeviceExtension, ModeNo);
  1983. if (!(SiS_VBInfo & (SetSimuScanMode | SwitchToCRT2 | SetCRT2ToLCDA))) { /*301b */
  1984. SiS_LongWait ();
  1985. SiS_DisplayOn ();
  1986. }
  1987. }
  1989. void
  1990. SiS_GetVBType (USHORT BaseAddr)
  1991. {
  1992. USHORT flag;
  1994. flag = SiS_GetReg1 (SiS_Part4Port, 0x00);
  1995. if (flag >= 2)
  1996. SiS_VBType = VB_SIS302B;
  1997. else {
  1998. flag = SiS_GetReg1 (SiS_Part4Port, 0x01);
  1999. if (flag >= 0xB0)
  2000. SiS_VBType = VB_SIS301B;
  2001. else
  2002. SiS_VBType = VB_SIS301;
  2004. flag = SiS_GetReg1 (SiS_Part4Port, 0x23); /*301dlvds */
  2005. if (!(flag & 0x02))
  2006. SiS_VBType = SiS_VBType | VB_NoLCD;
  2007. }
  2009. }
  2011. /* win2000 MM adapter not support standard mode  */
  2012. BOOLEAN
  2013. SiS_SearchModeID (ULONG ROMAddr, USHORT ModeNo, USHORT * ModeIdIndex)
  2014. {
  2015. PUCHAR VGA_INFO = "x11";
  2017. if (ModeNo <= 5)
  2018. ModeNo |= 1;
  2019. if (ModeNo <= 0x13) {
  2020. /* for (*ModeIdIndex=0;*ModeIdIndex<sizeof(SiS_SModeIDTable)/sizeof(SiS_StStruct);(*ModeIdIndex)++) */
  2021. for (*ModeIdIndex = 0;; (*ModeIdIndex)++) {
  2022. if (SiS_SModeIDTable[*ModeIdIndex].St_ModeID == ModeNo)
  2023. break;
  2024. if (SiS_SModeIDTable[*ModeIdIndex].St_ModeID == 0xFF)
  2025. return FALSE;
  2026. }
  2028. #ifdef TC
  2029. VGA_INFO = (PUCHAR) MK_FP (0, 0x489);
  2030. #endif
  2031. if (ModeNo == 0x07) {
  2032. if ((*VGA_INFO & 0x10) != 0)
  2033. (*ModeIdIndex)++; /* 400 lines */
  2034. /* else 350 lines */
  2035. }
  2036. if (ModeNo <= 3) {
  2037. if ((*VGA_INFO & 0x80) == 0) {
  2038. (*ModeIdIndex)++;
  2039. if ((*VGA_INFO & 0x10) != 0)
  2040. (*ModeIdIndex)++;; /* 400 lines  */
  2041. /* else 350 lines  */
  2042. }
  2043. /* else 200 lines  */
  2044. }
  2045. } else {
  2046. /* for (*ModeIdIndex=0;*ModeIdIndex<sizeof(SiS_EModeIDTable)/sizeof(SiS_ExtStruct);(*ModeIdIndex)++) */
  2047. for (*ModeIdIndex = 0;; (*ModeIdIndex)++) {
  2048. if (SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == ModeNo)
  2049. break;
  2050. if (SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == 0xFF)
  2051. return FALSE;
  2052. }
  2053. }
  2054. return TRUE;
  2055. }
  2057. /*add for 300 oem util for search VBModeID*/
  2058. BOOLEAN
  2059. SiS_SearchVBModeID (ULONG ROMAddr, USHORT ModeNo)
  2060. {
  2061. USHORT ModeIdIndex;
  2063. // PUCHAR VGA_INFO;
  2065. if (ModeNo <= 5)
  2066. ModeNo |= 1;
  2067. /* for (ModeIdIndex=0;ModeIdIndex<sizeof(SiS_SModeIDTable)/sizeof(SiS_StStruct);(*ModeIdIndex)++) */
  2068. for (ModeIdIndex = 0;; (ModeIdIndex)++) {
  2069. if (SiS_VBModeIDTable[ModeIdIndex].ModeID == ModeNo)
  2070. break;
  2071. if (SiS_VBModeIDTable[ModeIdIndex].ModeID == 0xFF)
  2072. return FALSE;
  2073. }
  2074. #ifdef TC
  2075. VGA_INFO = (PUCHAR) MK_FP (0, 0x489);
  2076. if (ModeNo == 0x07) {
  2077. if ((*VGA_INFO & 0x10) != 0)
  2078. (ModeIdIndex)++; /* 400 lines */
  2079. /* else 350 lines */
  2080. }
  2081. if (ModeNo <= 3) {
  2082. if ((*VGA_INFO & 0x80) == 0) {
  2083. (ModeIdIndex)++;
  2084. if ((*VGA_INFO & 0x10) != 0)
  2085. (ModeIdIndex)++;; /* 400 lines  */
  2086. /* else 350 lines  */
  2087. }
  2088. /* else 200 lines  */
  2089. }
  2090. #endif
  2091. return ((BOOLEAN) ModeIdIndex);
  2092. }
  2094. /*end*/
  2096. /* win2000 MM adapter not support standard mode!  */
  2098. BOOLEAN
  2099. SiS_CheckMemorySize (ULONG ROMAddr, PSIS_HW_DEVICE_INFO HwDeviceExtension,
  2100.      USHORT ModeNo, USHORT ModeIdIndex)
  2101. {
  2102. USHORT memorysize;
  2103. USHORT modeflag;
  2104. USHORT temp;
  2106. if (ModeNo <= 0x13) {
  2107. modeflag = SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  2108. } else {
  2109. modeflag = SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  2110. }
  2112. /*  ModeType=modeflag&ModeInfoFlag;                           Get mode type  */
  2114. memorysize = modeflag & MemoryInfoFlag;
  2115. memorysize = memorysize > MemorySizeShift;
  2116. memorysize++; /* Get memory size */
  2118. temp = SiS_GetReg1 (SiS_P3c4, 0x14); /* Get DRAM Size    */
  2119. if ((HwDeviceExtension->jChipType == SIS_315H) ||
  2120.     (HwDeviceExtension->jChipType == SIS_315PRO)) {
  2121. temp = 1 << ((temp & 0x0F0) >> 4);
  2122. if ((temp & 0x0c) == 0x08) { /* DDR asymetric */
  2123. temp += temp / 2;
  2124. } else {
  2125. if ((temp & 0x0c) != 0) {
  2126. temp <<= 1;
  2127. }
  2128. }
  2129. } else { /* 300, 540 , 630 */
  2131. temp = temp & 0x3F;
  2132. temp++;
  2133. /*  temp=1 << ((temp&0x0F0)>>4); */
  2134. }
  2136. if ((HwDeviceExtension->jChipType == SIS_550) || /* 05/02/01 ynlai for sis550 */
  2137.     (HwDeviceExtension->jChipType == SIS_640) || /* 08/20/01 chiawen for 640/740 */
  2138.     (HwDeviceExtension->jChipType == SIS_740)) { /* 09/03/01 chiawen for 650 */
  2139. return (TRUE);
  2140. }
  2142. if (temp < memorysize)
  2143. return (FALSE);
  2144. else
  2145. return (TRUE);
  2146. }
  2148. UCHAR
  2149. SiS_GetModePtr (ULONG ROMAddr, USHORT ModeNo, USHORT ModeIdIndex)
  2150. {
  2151. UCHAR index;
  2153. if (ModeNo <= 0x13) {
  2154. index = SiS_SModeIDTable[ModeIdIndex].St_StTableIndex;
  2155. } else {
  2156. if (SiS_ModeType <= 0x02)
  2157. index = 0x1B; /* 02 -> ModeEGA  */
  2158. else
  2159. index = 0x0F;
  2160. }
  2162. return index; /* Get SiS_StandTable index  */
  2163. }
  2165. void
  2166. SiS_SetSeqRegs (ULONG ROMAddr, USHORT StandTableIndex)
  2167. {
  2168. UCHAR SRdata;
  2169. USHORT i;
  2171. SiS_SetReg1 (SiS_P3c4, 0x00, 0x03); /* Set SR0  */
  2172. SRdata = SiS_StandTable[StandTableIndex].SR[0];
  2173. /*301b */
  2174. if ((SiS_VBType & VB_SIS301B) || (SiS_VBType & VB_SIS302B)) {
  2175. if (SiS_VBInfo & SetCRT2ToLCDA) {
  2176. SRdata = SRdata | 0x01;
  2177. }
  2178. }
  2180. /*end 301b */
  2182. if (SiS_IF_DEF_LVDS == 1) {
  2183. if (SiS_IF_DEF_CH7005 == 1) {
  2184. if (SiS_VBInfo & SetCRT2ToTV) {
  2185. if (SiS_VBInfo & SetInSlaveMode) {
  2186. SRdata = SRdata | 0x01; /* 8 dot clock  */
  2187. }
  2188. }
  2189. }
  2190. if (SiS_VBInfo & SetCRT2ToLCD) {
  2191. if (SiS_VBInfo & SetInSlaveMode) {
  2192. SRdata = SRdata | 0x01; /* 8 dot clock  */
  2193. }
  2194. }
  2195. }
  2197. SRdata = SRdata | 0x20; /* screen off  */
  2198. SiS_SetReg1 (SiS_P3c4, 0x01, SRdata); /* Set SR1 */
  2199. for (i = 02; i <= 04; i++) {
  2200. SRdata = SiS_StandTable[StandTableIndex].SR[i - 1]; /* Get SR2,3,4 from file */
  2201. SiS_SetReg1 (SiS_P3c4, i, SRdata); /* Set SR2 3 4 */
  2202. }
  2203. }
  2205. void
  2206. SiS_SetMiscRegs (ULONG ROMAddr, USHORT StandTableIndex)
  2207. {
  2208. UCHAR Miscdata;
  2210. Miscdata = SiS_StandTable[StandTableIndex].MISC; /* Get Misc from file */
  2211. /*301b */
  2212. if ((SiS_VBType & VB_SIS301B) || (SiS_VBType & VB_SIS302B)) {
  2213. if (SiS_VBInfo & SetCRT2ToLCDA) {
  2214. Miscdata = Miscdata | 0x0C;
  2215. }
  2216. }
  2217. /*end 301b */
  2218. SiS_SetReg3 (SiS_P3c2, Miscdata); /* Set Misc(3c2) */
  2219. }
  2221. void
  2222. SiS_SetCRTCRegs (ULONG ROMAddr, PSIS_HW_DEVICE_INFO HwDeviceExtension,
  2223.  USHORT StandTableIndex)
  2224. {
  2225. UCHAR CRTCdata;
  2226. USHORT i;
  2228. CRTCdata = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x11);
  2229. CRTCdata = CRTCdata & 0x7f;
  2230. SiS_SetReg1 (SiS_P3d4, 0x11, CRTCdata); /* Unlock CRTC */
  2232. for (i = 0; i <= 0x18; i++) {
  2233. CRTCdata = SiS_StandTable[StandTableIndex].CRTC[i]; /* Get CRTC from file */
  2234. SiS_SetReg1 (SiS_P3d4, i, CRTCdata); /* Set CRTC(3d4) */
  2235. }
  2236. if ((HwDeviceExtension->jChipType == SIS_630) &&
  2237.     (HwDeviceExtension->jChipRevision == 0x30)) { /* for 630S0 */
  2238. if (SiS_VBInfo & SetInSlaveMode) {
  2239. if (SiS_VBInfo & (SetCRT2ToLCD | SetCRT2ToTV)) {
  2240. SiS_SetReg1 (SiS_P3d4, 0x18, 0xFE);
  2241. }
  2242. }
  2243. }
  2244. }
  2246. void
  2247. SiS_SetATTRegs (ULONG ROMAddr, USHORT StandTableIndex)
  2248. {
  2249. UCHAR ARdata;
  2250. USHORT i;
  2252. for (i = 0; i <= 0x13; i++) {
  2253. ARdata = SiS_StandTable[StandTableIndex].ATTR[i]; /* Get AR for file  */
  2254. /*301b */
  2255. if ((SiS_VBType & VB_SIS301B) || (SiS_VBType & VB_SIS302B)) {
  2256. if (SiS_VBInfo & SetCRT2ToLCDA) {
  2257. if (i == 0x13) {
  2258. ARdata = 0;
  2259. }
  2260. }
  2261. }
  2262. /*end 301b */
  2263. if (SiS_IF_DEF_LVDS == 1) { /*for LVDS  */
  2264. if (SiS_IF_DEF_CH7005 == 1) {
  2265. if (SiS_VBInfo & SetCRT2ToTV) {
  2266. if (SiS_VBInfo & SetInSlaveMode) {
  2267. if (i == 0x13) {
  2268. ARdata = 0;
  2269. }
  2270. }
  2271. }
  2272. }
  2273. if (SiS_VBInfo & SetCRT2ToLCD) {
  2274. if (SiS_VBInfo & SetInSlaveMode) {
  2275. if (SiS_LCDInfo & LCDNonExpanding) {
  2276. if (i == 0x13) {
  2277. ARdata = 0;
  2278. }
  2279. }
  2280. }
  2281. }
  2282. }
  2283. SiS_GetReg2 (SiS_P3da); /* reset 3da  */
  2284. SiS_SetReg3 (SiS_P3c0, i); /* set index  */
  2285. SiS_SetReg3 (SiS_P3c0, ARdata); /* set data   */
  2286. }
  2287. SiS_GetReg2 (SiS_P3da); /* reset 3da  */
  2288. SiS_SetReg3 (SiS_P3c0, 0x14); /* set index  */
  2289. SiS_SetReg3 (SiS_P3c0, 0x00); /* set data   */
  2291. SiS_GetReg2 (SiS_P3da); /* Enable Attribute  */
  2292. SiS_SetReg3 (SiS_P3c0, 0x20);
  2293. }
  2295. void
  2296. SiS_SetGRCRegs (ULONG ROMAddr, USHORT StandTableIndex)
  2297. {
  2298. UCHAR GRdata;
  2299. USHORT i;
  2301. for (i = 0; i <= 0x08; i++) {
  2302. GRdata = SiS_StandTable[StandTableIndex].GRC[i]; /* Get GR from file */
  2303. SiS_SetReg1 (SiS_P3ce, i, GRdata); /* Set GR(3ce) */
  2304. }
  2306. if (SiS_ModeType > ModeVGA) {
  2307. GRdata = (UCHAR) SiS_GetReg1 (SiS_P3ce, 0x05);
  2308. GRdata = GRdata & 0xBF; /* 256 color disable */
  2309. SiS_SetReg1 (SiS_P3ce, 0x05, GRdata);
  2310. }
  2311. }
  2313. void
  2314. SiS_ClearExt1Regs ()
  2315. {
  2316. USHORT i;
  2318. for (i = 0x0A; i <= 0x0E; i++)
  2319. SiS_SetReg1 (SiS_P3c4, i, 0x00); /* Clear SR0A-SR0E */
  2320. }
  2322. void
  2323. SiS_SetSync (ULONG ROMAddr, USHORT RefreshRateTableIndex)
  2324. {
  2325. USHORT sync;
  2326. USHORT temp;
  2328. sync = SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag >> 8; /* di+0x00 */
  2330. sync = sync & 0xC0;
  2331. temp = 0x2F;
  2332. temp = temp | sync;
  2333. SiS_SetReg3 (SiS_P3c2, temp); /* Set Misc(3c2) */
  2334. }
  2336. void
  2337. SiS_SetCRT1CRTC (ULONG ROMAddr, USHORT ModeNo, USHORT ModeIdIndex,
  2338.  USHORT RefreshRateTableIndex)
  2339. {
  2340. UCHAR index;
  2341. UCHAR data;
  2342. USHORT temp, tempah, i, modeflag, j;
  2343. USHORT ResInfo, DisplayType;
  2344. SiS_LCDACRT1DataStruct *LCDACRT1Ptr = NULL;
  2345. if ((SiS_VBType & VB_SIS302B) && (SiS_VBInfo & SetCRT2ToLCDA)) {
  2346. /*add crt1ptr */
  2347. if (ModeNo <= 0x13) {
  2348. modeflag = SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; /* si+St_ResInfo */
  2349. } else {
  2350. modeflag = SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag; /* si+Ext_ResInfo */
  2351. }
  2352. temp =
  2353.     SiS_GetLCDACRT1Ptr (ROMAddr, ModeNo, ModeIdIndex,
  2354. RefreshRateTableIndex, &ResInfo,
  2355. &DisplayType);
  2357. switch (DisplayType) {
  2358. case 0:
  2359. LCDACRT1Ptr = SiS_LCDACRT1800x600_1;
  2360. break;
  2361. case 1:
  2362. LCDACRT1Ptr = SiS_LCDACRT11024x768_1;
  2363. break;
  2364. case 2:
  2365. LCDACRT1Ptr = SiS_LCDACRT11280x1024_1;
  2366. break;
  2367. case 3:
  2368. LCDACRT1Ptr = SiS_LCDACRT1800x600_1_H;
  2369. break;
  2370. case 4:
  2371. LCDACRT1Ptr = SiS_LCDACRT11024x768_1_H;
  2372. break;
  2373. case 5:
  2374. LCDACRT1Ptr = SiS_LCDACRT11280x1024_1_H;
  2375. break;
  2376. case 6:
  2377. LCDACRT1Ptr = SiS_LCDACRT1800x600_2;
  2378. break;
  2379. case 7:
  2380. LCDACRT1Ptr = SiS_LCDACRT11024x768_2;
  2381. break;
  2382. case 8:
  2383. LCDACRT1Ptr = SiS_LCDACRT11280x1024_2;
  2384. break;
  2385. case 9:
  2386. LCDACRT1Ptr = SiS_LCDACRT1800x600_2_H;
  2387. break;
  2388. case 10:
  2389. LCDACRT1Ptr = SiS_LCDACRT11024x768_2_H;
  2390. break;
  2391. case 11:
  2392. LCDACRT1Ptr = SiS_LCDACRT11280x1024_2_H;
  2393. break;
  2394. /*case 12: LCDACRT1Ptr = SiS_CHTVCRT1UNTSC;               break;
  2395.    case 13: LCDACRT1Ptr = SiS_CHTVCRT1ONTSC;               break;
  2396.    case 14: LCDACRT1Ptr = SiS_CHTVCRT1UPAL;                break;
  2397.    case 15: LCDACRT1Ptr = SiS_CHTVCRT1OPAL;                break; */
  2398. }
  2400. tempah = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x11); /*unlock cr0-7  */
  2401. tempah = tempah & 0x7F;
  2402. SiS_SetReg1 (SiS_P3d4, 0x11, tempah);
  2403. tempah = (LCDACRT1Ptr + ResInfo)->CR[0];
  2404. SiS_SetReg1 (SiS_P3d4, 0x0, tempah);
  2405. for (i = 0x01, j = 1; i <= 0x07; i++, j++) {
  2406. tempah = (LCDACRT1Ptr + ResInfo)->CR[j];
  2407. SiS_SetReg1 (SiS_P3d4, i, tempah);
  2408. }
  2409. /* for(i=0x06,j=5;i<=0x07;i++,j++){
  2410.    tempah = (LCDACRT1Ptr+ResInfo)->CR[j];
  2411.     SiS_SetReg1(SiS_P3d4,i,tempah);
  2412.   }*/
  2413. for (i = 0x10, j = 8; i <= 0x12; i++, j++) {
  2414. tempah = (LCDACRT1Ptr + ResInfo)->CR[j];
  2415. SiS_SetReg1 (SiS_P3d4, i, tempah);
  2416. }
  2417. for (i = 0x15, j = 11; i <= 0x16; i++, j++) {
  2418. tempah = (LCDACRT1Ptr + ResInfo)->CR[j];
  2419. SiS_SetReg1 (SiS_P3d4, i, tempah);
  2420. }
  2422. for (i = 0x0A, j = 13; i <= 0x0C; i++, j++) {
  2423. tempah = (LCDACRT1Ptr + ResInfo)->CR[j];
  2424. SiS_SetReg1 (SiS_P3c4, i, tempah);
  2425. }
  2427. tempah = (LCDACRT1Ptr + ResInfo)->CR[16];
  2428. tempah = tempah & 0x0E0;
  2429. SiS_SetReg1 (SiS_P3c4, 0x0E, tempah);
  2431. tempah = (LCDACRT1Ptr + ResInfo)->CR[16];
  2432. tempah = tempah & 0x01;
  2433. tempah = tempah << 5;
  2434. if (modeflag & DoubleScanMode) {
  2435. tempah = tempah | 0x080;
  2436. }
  2437. SiS_SetRegANDOR (SiS_P3d4, 0x09, ~0x020, tempah);
  2438. if (SiS_ModeType > 0x03)
  2439. SiS_SetReg1 (SiS_P3d4, 0x14, 0x4F);
  2440. /*end 301b*/
  2441. } else {
  2442. index = SiS_RefIndex[RefreshRateTableIndex].Ext_CRT1CRTC; /* Get index */
  2443. index = index & 0x3F;
  2445. data = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x11);
  2446. data = data & 0x7F;
  2447. SiS_SetReg1 (SiS_P3d4, 0x11, data); /* Unlock CRTC */
  2449. for (i = 0, j = 0; i <= 07; i++, j++) {
  2450. data = SiS_CRT1Table[index].CR[i];
  2451. SiS_SetReg1 (SiS_P3d4, j, data);
  2452. }
  2453. for (j = 0x10; i <= 10; i++, j++) {
  2454. data = SiS_CRT1Table[index].CR[i];
  2455. SiS_SetReg1 (SiS_P3d4, j, data);
  2456. }
  2457. for (j = 0x15; i <= 12; i++, j++) {
  2458. data = SiS_CRT1Table[index].CR[i];
  2459. SiS_SetReg1 (SiS_P3d4, j, data);
  2460. }
  2461. for (j = 0x0A; i <= 15; i++, j++) {
  2462. data = SiS_CRT1Table[index].CR[i];
  2463. SiS_SetReg1 (SiS_P3c4, j, data);
  2464. }
  2466. data = SiS_CRT1Table[index].CR[16];
  2467. data = data & 0xE0;
  2468. SiS_SetReg1 (SiS_P3c4, 0x0E, data);
  2470. data = (UCHAR) SiS_GetReg1 (SiS_P3d4, 0x09);
  2471. data = data & 0xDF; /* clear CR9 D[5] */
  2472. i = SiS_CRT1Table[index].CR[16];
  2473. i = i & 0x01;
  2474. i = i << 5;
  2475. data = data | i;
  2477. if (ModeNo <= 0x13)
  2478. i = SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  2479. else
  2480. i = SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  2482. i = i & DoubleScanMode;
  2483. if (i)
  2484. data = data | 0x80;
  2485. SiS_SetReg1 (SiS_P3d4, 0x09, data);
  2487. if (SiS_ModeType > 0x03)
  2488. SiS_SetReg1 (SiS_P3d4, 0x14, 0x4F);
  2489. }
  2490. }
  2491. void
  2492. SiS_SetCRT1Offset (ULONG ROMAddr, USHORT ModeNo, USHORT ModeIdIndex,
  2493.    USHORT RefreshRateTableIndex,
  2494.    PSIS_HW_DEVICE_INFO HwDeviceExtension)
  2495. {
  2496. USHORT temp, ah, al;
  2497. USHORT temp2, i;
  2498. USHORT DisplayUnit;
  2500. /* Alan */
  2501. temp = SiS_EModeIDTable[ModeIdIndex].Ext_ModeInfo;
  2502. if (HwDeviceExtension->jChipType >= SIS_315H) {
  2503. temp = temp >> 8; /* sis310 *//* index */
  2504. } else {
  2505. temp = temp >> 4; /* sis300 *//* index */
  2506. }
  2507. temp = SiS_ScreenOffset[temp];
  2508. if ((ModeNo >= 0x7C) && (ModeNo <= 0x7E)) {
  2509. temp = 0x6B;
  2510. temp2 = ModeNo - 0x7C;
  2511. } else {
  2512. temp2 = SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
  2513. temp2 = temp2 & InterlaceMode;
  2514. if (temp2)
  2515. temp = temp << 1;
  2516. temp2 = SiS_ModeType - ModeEGA;
  2517. }
  2518. switch (temp2) {
  2519. case 0:
  2520. temp2 = 1;
  2521. break;
  2522. case 1:
  2523. temp2 = 2;
  2524. break;
  2525. case 2:
  2526. temp2 = 4;
  2527. break;
  2528. case 3:
  2529. temp2 = 4;
  2530. break;
  2531. case 4:
  2532. temp2 = 6;
  2533. break;
  2534. case 5:
  2535. temp2 = 8;
  2536. break;
  2537. }
  2538. temp = temp * temp2;
  2539. DisplayUnit = temp;
  2541. temp2 = temp;
  2542. temp = temp >> 8; /* ah */
  2543. temp = temp & 0x0F;
  2544. i = SiS_GetReg1 (SiS_P3c4, 0x0E);
  2545. i = i & 0xF0;
  2546. i = i | temp;
  2547. SiS_SetReg1 (SiS_P3c4, 0x0E, i);
  2549. temp = (UCHAR) temp2;
  2550. temp = temp & 0xFF; /* al */
  2551. SiS_SetReg1 (SiS_P3d4, 0x13, temp);
  2553. temp2 = SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
  2554. temp2 = temp2 & InterlaceMode;
  2555. if (temp2)
  2556. DisplayUnit >>= 1;
  2558. DisplayUnit = DisplayUnit << 5;
  2559. ah = (DisplayUnit & 0xff00) >> 8;
  2560. al = DisplayUnit & 0x00ff;
  2561. if (al == 0)
  2562. ah = ah + 1;
  2563. else
  2564. ah = ah + 2;
  2565. SiS_SetReg1 (SiS_P3c4, 0x10, ah);
  2566. }
  2568. void
  2569. SiS_SetCRT1VCLK (ULONG ROMAddr, USHORT ModeNo, USHORT ModeIdIndex,
  2570.  PSIS_HW_DEVICE_INFO HwDeviceExtension,
  2571.  USHORT RefreshRateTableIndex)
  2572. {
  2573. UCHAR index, data;
  2574. USHORT vclkindex;
  2575. if (SiS_IF_DEF_LVDS == 1) {
  2576. vclkindex =
  2577.     SiS_GetVCLK2Ptr (ROMAddr, ModeNo, ModeIdIndex,
  2578.      RefreshRateTableIndex, HwDeviceExtension);
  2579. data = SiS_GetReg1 (SiS_P3c4, 0x31) & 0xCF;
  2580. SiS_SetReg1 (SiS_P3c4, 0x31, data);
  2582. data = SiS_VCLKData[vclkindex].SR2B;
  2583. SiS_SetReg1 (SiS_P3c4, 0x2B, data);
  2584. data = SiS_VCLKData[vclkindex].SR2C;
  2585. SiS_SetReg1 (SiS_P3c4, 0x2C, data);
  2587. if (HwDeviceExtension->jChipType < SIS_315H)
  2588. SiS_SetReg1 (SiS_P3c4, 0x2D, 0x80);
  2589. else
  2590. SiS_SetReg1 (SiS_P3c4, 0x2D, 0x01);
  2592. }
  2593. else
  2594.     if (((SiS_VBType & VB_SIS301B) || (SiS_VBType & VB_SIS302B))
  2595. && (SiS_VBInfo & SetCRT2ToLCDA) && (SiS_IF_DEF_LVDS == 0)) {
  2596. vclkindex =
  2597.     SiS_GetVCLK2Ptr (ROMAddr, ModeNo, ModeIdIndex,
  2598.      RefreshRateTableIndex, HwDeviceExtension);
  2599. data = SiS_GetReg1 (SiS_P3c4, 0x31) & 0xCF;
  2600. SiS_SetReg1 (SiS_P3c4, 0x31, data);
  2602. data = SiS_VBVCLKData[vclkindex].Part4_A;
  2603. SiS_SetReg1 (SiS_P3c4, 0x2B, data);
  2604. data = SiS_VBVCLKData[vclkindex].Part4_B;
  2605. SiS_SetReg1 (SiS_P3c4, 0x2C, data);
  2607. if (HwDeviceExtension->jChipType < SIS_315H)
  2608. SiS_SetReg1 (SiS_P3c4, 0x2D, 0x80); /* for300 series */
  2609. else
  2610. SiS_SetReg1 (SiS_P3c4, 0x2D, 0x01);
  2612. } else {
  2613. index = SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
  2614. /*if(HwDeviceExtension->jChipType < SIS_315H) { */
  2615. index = index & 0x3F;
  2616. /*} */
  2617. data = SiS_GetReg1 (SiS_P3c4, 0x31) & 0xCF;
  2618. /*SiS_SetReg1(SiS_P3c4,0x31,0x00); *//* for300 */
  2619. SiS_SetReg1 (SiS_P3c4, 0x31, data);
  2620. SiS_SetReg1 (SiS_P3c4, 0x2B, SiS_VCLKData[index].SR2B);
  2621. SiS_SetReg1 (SiS_P3c4, 0x2C, SiS_VCLKData[index].SR2C);
  2622. if (HwDeviceExtension->jChipType < SIS_315H)
  2623. SiS_SetReg1 (SiS_P3c4, 0x2D, 0x80); /* for300 series */
  2624. else
  2625. SiS_SetReg1 (SiS_P3c4, 0x2D, 0x01); /* for310 series */
  2626. }
  2627. }
  2628. void
  2629. SiS_IsLowResolution (ULONG ROMAddr, USHORT ModeNo, USHORT ModeIdIndex)
  2630. {
  2631. USHORT data;
  2632. USHORT ModeFlag;
  2634. data = SiS_GetReg1 (SiS_P3c4, 0x0F);
  2635. data = data & 0x7F;
  2636. SiS_SetReg1 (SiS_P3c4, 0x0F, data);
  2638. if (ModeNo > 0x13) {
  2639. ModeFlag = SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  2640. if ((ModeFlag & HalfDCLK) && (ModeFlag & DoubleScanMode)) {
  2641. data = SiS_GetReg1 (SiS_P3c4, 0x0F);
  2642. data = data | 0x80;
  2643. SiS_SetReg1 (SiS_P3c4, 0x0F, data);
  2644. data = SiS_GetReg1 (SiS_P3c4, 0x01);
  2645. data = data & 0xF7;
  2646. SiS_SetReg1 (SiS_P3c4, 0x01, data);
  2647. }
  2648. }
  2649. }
  2651. void
  2652. SiS_SetCRT1ModeRegs (ULONG ROMAddr, PSIS_HW_DEVICE_INFO HwDeviceExtension,
  2653.      USHORT ModeNo, USHORT ModeIdIndex,
  2654.      USHORT RefreshRateTableIndex)
  2655. {
  2656. USHORT data, data2, data3;
  2657. USHORT infoflag = 0, modeflag;
  2658. USHORT resindex, xres;
  2660. if (ModeNo > 0x13) {
  2661. modeflag = SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  2662. infoflag = SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
  2663. } else {
  2664. modeflag = SiS_SModeIDTable[ModeIdIndex].St_ModeFlag; /* si+St_ModeFlag */
  2665. }
  2666. SiS_SetRegANDOR (SiS_P3c4, 0x1F, 0x3F, 0x00);
  2667. if (ModeNo > 0x13)
  2668. data = infoflag;
  2669. else
  2670. data = 0;
  2671. data2 = 0;
  2672. if (ModeNo > 0x13) {
  2673. if (SiS_ModeType > 0x02) {
  2674. data2 = data2 | 0x02;
  2675. data3 = SiS_ModeType - ModeVGA;
  2676. data3 = data3 << 2;
  2677. data2 = data2 | data3;
  2678. }
  2679. }
  2680. data = data & InterlaceMode;
  2681. if (data)
  2682. data2 = data2 | 0x20;
  2683. SiS_SetReg1 (SiS_P3c4, 0x06, data2);
  2684. if ((HwDeviceExtension->jChipType == SIS_630) ||
  2685.     (HwDeviceExtension->jChipType == SIS_540) ||
  2686.     (HwDeviceExtension->jChipType == SIS_730)) {
  2687. resindex = SiS_GetResInfo (ROMAddr, ModeNo, ModeIdIndex);
  2688. if (ModeNo <= 0x13) {
  2689. xres = SiS_StResInfo[resindex].HTotal;
  2690. } else {
  2691. xres = SiS_ModeResInfo[resindex].HTotal; /* xres->ax */
  2692. }
  2693. data = 0x0000;
  2694. if (infoflag & InterlaceMode) {
  2695. if (xres == 1024)
  2696. data = 0x0035;
  2697. if (xres == 1280)
  2698. data = 0x0048;
  2699. }
  2700. data2 = data & 0x00FF;
  2701. SiS_SetRegANDOR (SiS_P3d4, 0x19, 0xFF, data2);
  2702. data2 = (data & 0xFF00) >> 8;
  2703. SiS_SetRegANDOR (SiS_P3d4, 0x19, 0xFC, data2);
  2704. }
  2705. if (modeflag & HalfDCLK) {
  2706. SiS_SetRegANDOR (SiS_P3c4, 0x01, 0xFF, 0x01);
  2707. }
  2709. if ((HwDeviceExtension->jChipType == SIS_630) ||
  2710.     (HwDeviceExtension->jChipType == SIS_540) ||
  2711.     (HwDeviceExtension->jChipType == SIS_730)) {
  2712. } else {
  2713. if (modeflag & LineCompareOff) {
  2714. SiS_SetRegANDOR (SiS_P3c4, 0x0F, 0xF7, 0x08);
  2715. } else {
  2716. SiS_SetRegANDOR (SiS_P3c4, 0x0F, 0xF7, 0x00);
  2717. }
  2718. }
  2720. data = 0x60;
  2721. if (SiS_ModeType != ModeText) {
  2722. data = data ^ 0x60;
  2723. if (SiS_ModeType != ModeEGA) {
  2724. data = data ^ 0xA0;
  2725. }
  2726. }
  2727. SiS_SetRegANDOR (SiS_P3c4, 0x21, 0x1F, data);
  2728. }
  2730. void
  2731. SiS_SetVCLKState (ULONG ROMAddr, PSIS_HW_DEVICE_INFO HwDeviceExtension,
  2732.   USHORT ModeNo, USHORT RefreshRateTableIndex)
  2733. {
  2734. USHORT data, data2 = 0;
  2735. USHORT VCLK;
  2736. UCHAR index;
  2738. if (ModeNo <= 0x13)
  2739. VCLK = 0;
  2740. else {
  2741. index = SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
  2742. /*if(HwDeviceExtension->jChipType < SIS_315H) { */
  2743. index = index & 0x3F;
  2744. /*} */
  2745. VCLK = SiS_VCLKData[index].CLOCK;
  2746. }
  2748. if (HwDeviceExtension->jChipType < SIS_315H) {
  2749. data2 = 0x00;
  2750. if (VCLK > 150)
  2751. data2 = data2 | 0x80;
  2752. SiS_SetRegANDOR (SiS_P3c4, 0x07, 0x7B, data2);
  2754. data2 = 0x00;
  2755. if (VCLK >= 150)
  2756. data2 = data2 | 0x08; /* VCLK > 150 */
  2757. SiS_SetRegANDOR (SiS_P3c4, 0x32, 0xF7, data2);
  2758. } else { /* 310 series */
  2760. data = SiS_GetReg1 (SiS_P3c4, 0x32);
  2761. data = data & 0xf3;
  2762. if (VCLK >= 200)
  2763. data = data | 0x0c; /* VCLK > 200 */
  2764. SiS_SetReg1 (SiS_P3c4, 0x32, data);
  2765. data = SiS_GetReg1 (SiS_P3c4, 0x1F);
  2766. data &= 0xE7;
  2767. if (VCLK < 200)
  2768. data |= 0x10;
  2769. SiS_SetReg1 (SiS_P3c4, 0x1F, data);
  2770. }
  2772. if ((VCLK >= 0) && (VCLK < 135))
  2773. data2 = 0x03;
  2774. if ((VCLK >= 135) && (VCLK < 160))
  2775. data2 = 0x02;
  2776. if ((VCLK >= 160) && (VCLK < 260))
  2777. data2 = 0x01;
  2778. if (VCLK > 260)
  2779. data2 = 0x00;
  2780. /* disable 24bit palette RAM gamma correction  */
  2782. if (HwDeviceExtension->jChipType == SIS_540) {
  2783. if ((VCLK == 203) || (VCLK < 234))
  2784. data2 = 0x02;
  2785. }
  2786. SiS_SetRegANDOR (SiS_P3c4, 0x07, 0xFC, data2);
  2787. }
  2789. void
  2790. SiS_LoadDAC (ULONG ROMAddr, USHORT ModeNo, USHORT ModeIdIndex)
  2791. {
  2792. USHORT data, data2;
  2793. USHORT time, i, j, k;
  2794. USHORT m, n, o;
  2795. USHORT si, di, bx, dl;
  2796. USHORT al, ah, dh;
  2797. USHORT *table = NULL;
  2799. if (ModeNo <= 0x13)
  2800. data = SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
  2801. else
  2802. data = SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
  2804. data = data & DACInfoFlag;
  2805. time = 64;
  2806. if (data == 0x00)
  2807. table = SiS_MDA_DAC;
  2808. if (data == 0x08)
  2809. table = SiS_CGA_DAC;
  2810. if (data == 0x10)
  2811. table = SiS_EGA_DAC;
  2812. if (data == 0x18) {
  2813. time = 256;
  2814. table = SiS_VGA_DAC;
  2815. }
  2816. if (time == 256)
  2817. j = 16;
  2818. else
  2819. j = time;
  2821. SiS_SetReg3 (SiS_P3c6, 0xFF);
  2822. SiS_SetReg3 (SiS_P3c8, 0x00);
  2824. for (i = 0; i < j; i++) {
  2825. data = table[i];
  2826. for (k = 0; k < 3; k++) {
  2827. data2 = 0;
  2828. if (data & 0x01)
  2829. data2 = 0x2A;
  2830. if (data & 0x02)
  2831. data2 = data2 + 0x15;
  2832. SiS_SetReg3 (SiS_P3c9, data2);
  2833. data = data >> 2;
  2834. }
  2835. }
  2837. if (time == 256) {
  2838. for (i = 16; i < 32; i++) {
  2839. data = table[i];
  2840. for (k = 0; k < 3; k++)
  2841. SiS_SetReg3 (SiS_P3c9, data);
  2842. }
  2843. si = 32;
  2844. for (m = 0; m < 9; m++) {
  2845. di = si;
  2846. bx = si + 0x04;
  2847. dl = 0;
  2848. for (n = 0; n < 3; n++) {
  2849. for (o = 0; o < 5; o++) {
  2850. dh = table[si];
  2851. ah = table[di];
  2852. al = table[bx];
  2853. si++;
  2854. SiS_WriteDAC (dl, ah, al, dh);
  2855. } /* for 5 */
  2856. si = si - 2;
  2857. for (o = 0; o < 3; o++) {
  2858. dh = table[bx];
  2859. ah = table[di];
  2860. al = table[si];
  2861. si--;
  2862. SiS_WriteDAC (dl, ah, al, dh);
  2863. } /* for 3 */
  2864. dl++;
  2865. } /* for 3 */
  2866. si = si + 5;
  2867. } /* for 9 */
  2868. }
  2869. }
  2871. void
  2872. SiS_WriteDAC (USHORT dl, USHORT ah, USHORT al, USHORT dh)
  2873. {
  2874. USHORT temp;
  2875. USHORT bh, bl;
  2877. bh = ah;
  2878. bl = al;
  2879. if (dl != 0) {
  2880. temp = bh;
  2881. bh = dh;
  2882. dh = temp;
  2883. if (dl == 1) {
  2884. temp = bl;
  2885. bl = dh;
  2886. dh = temp;
  2887. } else {
  2888. temp = bl;
  2889. bl = bh;
  2890. bh = temp;
  2891. }
  2892. }
  2893. SiS_SetReg3 (SiS_P3c9, (USHORT) dh);
  2894. SiS_SetReg3 (SiS_P3c9, (USHORT) bh);
  2895. SiS_SetReg3 (SiS_P3c9, (USHORT) bl);
  2896. }
  2898. void
  2899. SiS_ClearBuffer (PSIS_HW_DEVICE_INFO HwDeviceExtension, USHORT ModeNo)
  2900. {
  2901. PVOID VideoMemoryAddress =
  2902.     (PVOID) HwDeviceExtension->pjVideoMemoryAddress;
  2903. ULONG AdapterMemorySize = (ULONG) HwDeviceExtension->ulVideoMemorySize;
  2904. PUSHORT pBuffer;
  2905. int i;
  2907. if (SiS_ModeType >= ModeEGA) {
  2908. if (ModeNo > 0x13) {
  2909. SiS_SetMemory (VideoMemoryAddress, AdapterMemorySize,
  2910.        0);
  2911. } else {
  2912. pBuffer = VideoMemoryAddress;
  2913. for (i = 0; i < 0x4000; i++)
  2914. pBuffer[i] = 0x0000;
  2915. }
  2916. } else {
  2917. pBuffer = VideoMemoryAddress;
  2918. if (SiS_ModeType == ModeCGA) {
  2919. for (i = 0; i < 0x4000; i++)
  2920. pBuffer[i] = 0x0720;
  2921. } else {
  2922. for (i = 0; i < 0x4000; i++)
  2923. pBuffer[i] = 0x0000;
  2924. }
  2925. }
  2926. }
  2928. void
  2929. SiS_DisplayOn (void)
  2930. {
  2932. SiS_SetRegANDOR (SiS_P3c4, 0x01, 0xDF, 0x00);
  2933. }
  2935. void
  2936. SiS_DisplayOff (void)
  2937. {
  2939. SiS_SetRegANDOR (SiS_P3c4, 0x01, 0xDF, 0x20);
  2940. }
  2942. /* ========================================== */
  2943. /*  SR CRTC GR */
  2944. void
  2945. SiS_SetReg1 (USHORT port, USHORT index, USHORT data)
  2946. {
  2947. OutPortByte (port, index);
  2948. OutPortByte (port + 1, data);
  2950. /*
  2951.    _asm
  2952.    {
  2953.    mov      dx, port                      
  2954.    mov      ax, index                     
  2955.    mov      bx, data                      
  2956.    out      dx, al
  2957.    mov      ax, bx
  2958.    inc      dx
  2959.    out      dx, al
  2960.    }
  2961.  */
  2963. }
  2965. /* ========================================== */
  2966. /*  AR(3C0) */
  2967. void
  2968. SiS_SetReg2 (USHORT port, USHORT index, USHORT data)
  2969. {
  2971. InPortByte (port + 0x3da - 0x3c0);
  2972. OutPortByte (SiS_P3c0, index);
  2973. OutPortByte (SiS_P3c0, data);
  2974. OutPortByte (SiS_P3c0, 0x20);
  2976. /*
  2977.    _asm
  2978.    {
  2979.    mov      dx, port                      
  2980.    mov      cx, index                     
  2981.    mov      bx, data                      
  2983.    add      dx, 3dah-3c0h
  2984.    in       al, dx
  2986.    mov      ax, cx
  2987.    mov      dx, 3c0h
  2988.    out      dx, al
  2989.    mov      ax, bx
  2990.    out      dx, al
  2992.    mov      ax, 20h
  2993.    out      dx, al
  2994.    }
  2995.  */
  2997. }
  2999. /* ========================================== */
  3000. void
  3001. SiS_SetReg3 (USHORT port, USHORT data)
  3002. {
  3004. OutPortByte (port, data);
  3006. /*
  3007.    _asm
  3008.    {
  3009.    mov      dx, port                      
  3010.    mov      ax, data                      
  3011.    out      dx, al
  3013.    }
  3014.  */
  3016. }
  3018. /* ========================================== */
  3019. void
  3020. SiS_SetReg4 (USHORT port, ULONG data)
  3021. {
  3023. OutPortLong (port, data);
  3025. /*
  3026.    _asm
  3027.    {
  3028.    mov      dx, port                      ;; port
  3029.    mov      eax, data                      ;; data
  3030.    out      dx, eax
  3032.    }
  3033.  */
  3034. }
  3036. /* ========================================= */
  3037. UCHAR SiS_GetReg1 (USHORT port, USHORT index)
  3038. {
  3039. UCHAR data;
  3041. OutPortByte (port, index);
  3042. data = InPortByte (port + 1);
  3044. /*
  3045.    _asm
  3046.    {
  3047.    mov      dx, port                      ;; port
  3048.    mov      ax, index                     ;; index
  3050.    out      dx, al
  3051.    mov      ax, bx
  3052.    inc      dx
  3053.    xor      eax, eax
  3054.    in       al, dx
  3055.    mov      data, al
  3056.    }
  3057.  */
  3058. return (data);
  3059. }
  3061. /* ========================================== */
  3062. UCHAR SiS_GetReg2 (USHORT port)
  3063. {
  3064. UCHAR data;
  3066. data = InPortByte (port);
  3068. /*
  3069.    _asm
  3070.    {
  3071.    mov      dx, port                      ;; port
  3072.    xor      eax, eax
  3073.    in       al, dx
  3074.    mov      data, al
  3075.    }
  3076.  */
  3077. return (data);
  3078. }
  3080. /* ========================================== */
  3081. ULONG SiS_GetReg3 (USHORT port)
  3082. {
  3083. ULONG data;
  3085. data = InPortLong (port);
  3087. /*
  3088.    _asm
  3089.    {
  3090.    mov      dx, port                      ;; port
  3091.    xor      eax, eax
  3092.    in       eax, dx
  3093.    mov      data, eax
  3094.    }
  3095.  */
  3096. return (data);
  3097. }
  3099. /* ========================================== */
  3100. void
  3101. SiS_ClearDAC (ULONG port)
  3102. {
  3103. int i;
  3105. OutPortByte (port, 0);
  3106. port++;
  3107. for (i = 0; i < 256 * 3; i++) {
  3108. OutPortByte (port, 0);
  3109. }
  3111. }
  3113. /*========================================== */
  3115. void
  3116. SiS_SetInterlace (ULONG ROMAddr, USHORT ModeNo, USHORT RefreshRateTableIndex)
  3117. {
  3118. ULONG Temp;
  3119. USHORT data, Temp2;
  3121. Temp = (ULONG) SiS_GetReg1 (SiS_P3d4, 0x01);
  3122. Temp++;
  3123. Temp = Temp * 8;
  3125. if (Temp == 1024)
  3126. data = 0x0035;
  3127. else if (Temp == 1280)
  3128. data = 0x0048;
  3129. else
  3130. data = 0x0000;
  3132. Temp2 = SiS_RefIndex[RefreshRateTableIndex].Ext_InfoFlag;
  3133. Temp2 &= InterlaceMode;
  3134. if (Temp2 == 0)
  3135. data = 0x0000;
  3137. SiS_SetReg1 (SiS_P3d4, 0x19, data);
  3139. Temp = (ULONG) SiS_GetReg1 (SiS_P3d4, 0x1A);
  3140. Temp2 = (USHORT) (Temp & 0xFC);
  3141. SiS_SetReg1 (SiS_P3d4, 0x1A, (USHORT) Temp);
  3143. Temp = (ULONG) SiS_GetReg1 (SiS_P3c4, 0x0f);
  3144. Temp2 = (USHORT) Temp & 0xBF;
  3145. if (ModeNo == 0x37)
  3146. Temp2 = Temp2 | 0x40;
  3147. SiS_SetReg1 (SiS_P3d4, 0x1A, (USHORT) Temp2);
  3148. }
  3150. void
  3151. SiS_SetCRT1FIFO (ULONG ROMAddr, USHORT ModeNo,
  3152.  PSIS_HW_DEVICE_INFO HwDeviceExtension)
  3153. {
  3155. USHORT data;
  3157. data = SiS_GetReg1 (SiS_P3c4, 0x3D);
  3158. data &= 0xfe;
  3159. SiS_SetReg1 (SiS_P3c4, 0x3D, data); /* diable auto-threshold */
  3160. if (ModeNo > 0x13) {
  3161. SiS_SetReg1 (SiS_P3c4, 0x08, 0x34);
  3162. data = SiS_GetReg1 (SiS_P3c4, 0x09);
  3163. data &= 0xF0;
  3164. SiS_SetReg1 (SiS_P3c4, 0x09, data);
  3166. data = SiS_GetReg1 (SiS_P3c4, 0x3D);
  3167. data |= 0x01;
  3168. SiS_SetReg1 (SiS_P3c4, 0x3D, data);
  3169. } else {
  3170. SiS_SetReg1 (SiS_P3c4, 0x08, 0xAE);
  3171. data = SiS_GetReg1 (SiS_P3c4, 0x09);
  3172. data &= 0xF0;
  3173. SiS_SetReg1 (SiS_P3c4, 0x09, data);
  3174. }
  3176. }
  3178. USHORT
  3179. SiS_CalcDelay (ULONG ROMAddr, USHORT key)
  3180. {
  3181. USHORT data, data2, temp0, temp1;
  3182. UCHAR ThLowA[] = { 61, 3, 52, 5, 68, 7, 100, 11,
  3183. 43, 3, 42, 5, 54, 7, 78, 11,
  3184. 34, 3, 37, 5, 47, 7, 67, 11
  3185. };
  3186. UCHAR ThLowB[] = { 81, 4, 72, 6, 88, 8, 120, 12,
  3187. 55, 4, 54, 6, 66, 8, 90, 12,
  3188. 42, 4, 45, 6, 55, 8, 75, 12
  3189. };
  3190. UCHAR ThTiming[] = { 1, 2, 2, 3, 0, 1, 1, 2 };
  3192. data = SiS_GetReg1 (SiS_P3c4, 0x16);
  3193. data = data >> 6;
  3194. data2 = SiS_GetReg1 (SiS_P3c4, 0x14);
  3195. data2 = (data2 >> 4) & 0x0C;
  3196. data = data | data2;
  3197. data = data < 1;
  3198. if (key == 0) {
  3199. temp0 = (USHORT) ThLowA[data];
  3200. temp1 = (USHORT) ThLowA[data + 1];
  3201. } else {
  3202. temp0 = (USHORT) ThLowB[data];
  3203. temp1 = (USHORT) ThLowB[data + 1];
  3204. }
  3206. data2 = 0;
  3207. data = SiS_GetReg1 (SiS_P3c4, 0x18);
  3208. if (data & 0x02)
  3209. data2 = data2 | 0x01;
  3210. if (data & 0x20)
  3211. data2 = data2 | 0x02;
  3212. if (data & 0x40)
  3213. data2 = data2 | 0x04;
  3215. data = temp1 * ThTiming[data2] + temp0;
  3216. return (data);
  3217. }
  3219. void
  3220. SiS_SetCRT1FIFO2 (ULONG ROMAddr, USHORT ModeNo,
  3221.   PSIS_HW_DEVICE_INFO HwDeviceExtension,
  3222.   USHORT RefreshRateTableIndex)
  3223. {
  3224. USHORT i, index, data, VCLK, data2, MCLK, colorth = 0;
  3225. USHORT ah, bl, B;
  3226. ULONG eax;
  3227. USHORT ThresholdLow = 0;
  3228. UCHAR FQBQData[] = { 0x01, 0x21, 0x41, 0x61, 0x81,
  3229. 0x31, 0x51, 0x71, 0x91, 0xb1,
  3230. 0x00, 0x20, 0x40, 0x60, 0x80,
  3231. 0x30, 0x50, 0x70, 0x90, 0xb0, 0xFF
  3232. };
  3234. if (ModeNo >= 0x13) {
  3235. index = SiS_RefIndex[RefreshRateTableIndex].Ext_CRTVCLK;
  3236. if (HwDeviceExtension->jChipType < SIS_315H) { /* for300 serial */
  3237. index = index & 0x3F;
  3238. }
  3239. VCLK = SiS_VCLKData[index].CLOCK; /* Get VCLK  */
  3240. index = SiS_GetReg1 (SiS_P3c4, 0x1A);
  3241. index = index & 07;
  3242. MCLK = SiS_MCLKData[index].CLOCK; /* Get MCLK  */
  3243. data2 = SiS_ModeType - 0x02;
  3244. switch (data2) {
  3245. case 0:
  3246. colorth = 1;
  3247. break;
  3248. case 1:
  3249. colorth = 2;
  3250. break;
  3251. case 2:
  3252. colorth = 4;
  3253. break;
  3254. case 3:
  3255. colorth = 4;
  3256. break;
  3257. case 4:
  3258. colorth = 6;
  3259. break;
  3260. case 5:
  3261. colorth = 8;
  3262. break;
  3263. }
  3265. i = 0;
  3266. do {
  3267. B =
  3268.     (SiS_CalcDelay2 (ROMAddr, FQBQData[i]) * VCLK *
  3269.      colorth);
  3270. bl = B / (16 * MCLK);
  3271. if (B == bl * 16 * MCLK) {
  3272. bl = bl + 1;
  3273. } else {
  3274. bl = bl + 1;
  3275. }
  3277. if (bl > 0x13) {
  3278. if (FQBQData[i + 1] == 0xFF) {
  3279. ThresholdLow = 0x13;
  3280. break;
  3281. }
  3282. i++;
  3283. } else {
  3284. ThresholdLow = bl;
  3285. break;
  3286. }
  3287. } while (FQBQData[i] != 0xFF);
  3288. } else {
  3289. ThresholdLow = 0x02;
  3290. }
  3292. data2 = FQBQData[i];
  3293. data2 = (data2 & 0xf0) >> 4;
  3294. data2 = data2 << 24;
  3296. SiS_SetReg4 (0xcf8, 0x80000050);
  3297. eax = SiS_GetReg3 (0xcfc);
  3298. eax = eax & 0x0f0ffffff;
  3299. eax = eax | data2;
  3300. SiS_SetReg4 (0xcfc, eax);
  3302. ah = ThresholdLow;
  3303. ah = ah << 4;
  3304. ah = ah | 0x0f;
  3305. SiS_SetReg1 (SiS_P3c4, 0x08, ah);
  3307. data = ThresholdLow;
  3308. data = data & 0x10;
  3309. data = data << 1;
  3310. SiS_SetRegANDOR (SiS_P3c4, 0x0F, 0xDF, data);
  3311. SiS_SetReg1 (SiS_P3c4, 0x3B, 0x09);
  3313. data = ThresholdLow + 3;
  3314. if (data > 0x0f)
  3315. data = 0x0f;
  3316. SiS_SetRegANDOR (SiS_P3c4, 0x09, 0x80, data);
  3317. }
  3319. USHORT
  3320. SiS_CalcDelay2 (ULONG ROMAddr, UCHAR key)
  3321. {
  3322. USHORT data, index;
  3323. UCHAR LatencyFactor[] = { 97, 88, 86, 79, 77, 00, /*; 64  bit    BQ=2   */
  3324. 00, 87, 85, 78, 76, 54, /*; 64  bit    BQ=1   */
  3325. 97, 88, 86, 79, 77, 00, /*; 128 bit    BQ=2   */
  3326. 00, 79, 77, 70, 68, 48, /*; 128 bit    BQ=1   */
  3327. 80, 72, 69, 63, 61, 00, /*; 64  bit    BQ=2   */
  3328. 00, 70, 68, 61, 59, 37, /*; 64  bit    BQ=1   */
  3329. 86, 77, 75, 68, 66, 00, /*; 128 bit    BQ=2   */
  3330. 00, 68, 66, 59, 57, 37
  3331. }; /*; 128 bit    BQ=1   */
  3333. index = (key & 0xE0) >> 5;
  3334. if (key & 0x10)
  3335. index = index + 6;
  3336. if (!(key & 0x01))
  3337. index = index + 24;
  3338. data = SiS_GetReg1 (SiS_P3c4, 0x14);
  3339. if (data & 0x0080)
  3340. index = index + 12;
  3342. data = LatencyFactor[index];
  3343. return (data);
  3344. }
  3346. void
  3347. SiS_CRT2AutoThreshold (USHORT BaseAddr)
  3348. {
  3349. USHORT temp1;
  3350. USHORT Part1Port;
  3351. Part1Port = BaseAddr + SIS_CRT2_PORT_04;
  3352. temp1 = SiS_GetReg1 (SiS_Part1Port, 0x1);
  3353. temp1 |= 0x40;
  3354. SiS_SetReg1 (SiS_Part1Port, 0x1, temp1);
  3355. }
  3357. /* =============  ynlai ============== */
  3358. void
  3359. SiS_DetectMonitor (PSIS_HW_DEVICE_INFO HwDeviceExtension, USHORT BaseAddr)
  3360. {
  3361. UCHAR DAC_TEST_PARMS[] = { 0x0F, 0x0F, 0x0F };
  3362. UCHAR DAC_CLR_PARMS[] = { 0x00, 0x00, 0x00 };
  3363. USHORT SR1F;
  3365. SR1F = SiS_GetReg1 (SiS_P3c4, 0x1F);
  3366. SiS_SetRegANDOR (SiS_P3c4, 0x1F, 0xFF, 0x04);
  3367. if (SiS_IF_DEF_LVDS == 0) {
  3368. if (SiS_BridgeIsOn (BaseAddr)) {
  3369. SiS_SetReg1 (SiS_P3d4, 0x30, 0x41);
  3370. }
  3371. }
  3372. SiSSetMode (HwDeviceExtension, 0x03); /* InitMode */
  3373. SiS_SetReg3 (SiS_P3c6, 0xff);
  3374. SiS_ClearDAC (SiS_P3c8);
  3375. SiS_LongWait ();
  3376. SiS_LongWait ();
  3377. SiS_SetRegANDOR (SiS_P3d4, 0x32, 0xDF, 0x00);
  3378. if (SiS_TestMonitorType
  3379.     (DAC_TEST_PARMS[0], DAC_TEST_PARMS[1], DAC_TEST_PARMS[2])) {
  3380. SiS_SetRegANDOR (SiS_P3d4, 0x32, 0xDF, 0x20);
  3381. }
  3382. if (SiS_TestMonitorType
  3383.     (DAC_TEST_PARMS[0], DAC_TEST_PARMS[1], DAC_TEST_PARMS[2])) {
  3384. SiS_SetRegANDOR (SiS_P3d4, 0x32, 0xDF, 0x20);
  3385. }
  3386. SiS_TestMonitorType (DAC_CLR_PARMS[0], DAC_CLR_PARMS[1],
  3387.      DAC_CLR_PARMS[2]);
  3388. SiS_SetReg1 (SiS_P3c4, 0x1F, SR1F);
  3389. }
  3391. USHORT
  3392. SiS_TestMonitorType (UCHAR R_DAC, UCHAR G_DAC, UCHAR B_DAC)
  3393. {
  3394. USHORT temp, tempbx;
  3396. tempbx = R_DAC * 0x4d + G_DAC * 0x97 + B_DAC * 0x1c;
  3397. if (tempbx > 0x80)
  3398. tempbx = tempbx + 0x100;
  3399. tempbx = (tempbx & 0xFF00) >> 8;
  3400. R_DAC = (UCHAR) tempbx;
  3401. G_DAC = (UCHAR) tempbx;
  3402. B_DAC = (UCHAR) tempbx;
  3404. SiS_SetReg3 (SiS_P3c8, 0x00);
  3405. SiS_SetReg3 (SiS_P3c9, R_DAC);
  3406. SiS_SetReg3 (SiS_P3c9, G_DAC);
  3407. SiS_SetReg3 (SiS_P3c9, B_DAC);
  3408. SiS_LongWait ();
  3409. temp = SiS_GetReg2 (SiS_P3c2);
  3410. if (temp & 0x10)
  3411. return (1);
  3412. else
  3413. return (0);
  3414. }
  3416. /* ---- test ----- */
  3417. void
  3418. SiS_GetSenseStatus (PSIS_HW_DEVICE_INFO HwDeviceExtension, ULONG ROMAddr)
  3419. {
  3420. USHORT tempax = 0, tempbx, tempcx, temp;
  3421. USHORT P2reg0 = 0, SenseModeNo = 0, OutputSelect = *pSiS_OutputSelect;
  3422. USHORT ModeIdIndex, i;
  3423. USHORT BaseAddr = (USHORT) HwDeviceExtension->ulIOAddress;
  3425. if (SiS_IF_DEF_LVDS == 1) {
  3426. SiS_GetPanelID ();
  3427. temp = LCDSense;
  3428. temp = temp | SiS_SenseCHTV ();
  3429. tempbx = ~(LCDSense | AVIDEOSense | SVIDEOSense);
  3430. SiS_SetRegANDOR (SiS_P3d4, 0x32, tempbx, temp);
  3431. } else { /* for 301 */
  3432. if (SiS_IF_DEF_HiVision == 1) { /* for HiVision */
  3433. tempax = SiS_GetReg1 (SiS_P3c4, 0x38);
  3434. temp = tempax & 0x01;
  3435. tempax = SiS_GetReg1 (SiS_P3c4, 0x3A);
  3436. temp = temp | (tempax & 0x02);
  3437. SiS_SetRegANDOR (SiS_P3d4, 0x32, 0xA0, temp);
  3438. } else {
  3439. if (SiS_BridgeIsOn (BaseAddr)) {
  3440. P2reg0 = SiS_GetReg1 (SiS_Part2Port, 0x00);
  3441. if (!SiS_BridgeIsEnable
  3442.     (BaseAddr, HwDeviceExtension)) {
  3443. SenseModeNo = 0x2e;
  3444. temp =
  3445.     SiS_SearchModeID (ROMAddr,
  3446.       SenseModeNo,
  3447.       &ModeIdIndex);
  3448. SiS_SetFlag = 0x00;
  3449. SiS_ModeType = ModeVGA;
  3450. SiS_VBInfo =
  3451.     SetCRT2ToRAMDAC | LoadDACFlag |
  3452.     SetInSlaveMode;
  3453. SiS_SetCRT2Group301 (BaseAddr, ROMAddr,
  3454.      SenseModeNo,
  3455.      HwDeviceExtension);
  3456. for (i = 0; i < 20; i++) {
  3457. SiS_LongWait ();
  3458. }
  3459. }
  3460. SiS_SetReg1 (SiS_Part2Port, 0x00, 0x1c);
  3461. tempax = 0;
  3462. tempbx = *pSiS_RGBSenseData;
  3463. /*301b */
  3464. if (!(SiS_Is301B (BaseAddr))) {
  3465. tempbx = *pSiS_RGBSenseData2;
  3466. }
  3467. /*end 301b */
  3468. tempcx = 0x0E08;
  3469. if (SiS_Sense (SiS_Part4Port, tempbx, tempcx)) {
  3470. if (SiS_Sense
  3471.     (SiS_Part4Port, tempbx, tempcx)) {
  3472. tempax = tempax | Monitor2Sense;
  3473. }
  3474. }
  3476. tempbx = *pSiS_YCSenseData;
  3477. /*301b */
  3478. if (!(SiS_Is301B (BaseAddr))) {
  3479. tempbx = *pSiS_YCSenseData2;
  3480. }
  3481. /*301b */
  3482. tempcx = 0x0604;
  3483. if (SiS_Sense (SiS_Part4Port, tempbx, tempcx)) {
  3484. if (SiS_Sense
  3485.     (SiS_Part4Port, tempbx, tempcx)) {
  3486. tempax = tempax | SVIDEOSense;
  3487. }
  3488. }
  3490. if (OutputSelect & BoardTVType) {
  3491. tempbx = *pSiS_VideoSenseData;
  3492. /*301b */
  3493. if (!(SiS_Is301B (BaseAddr))) {
  3494. tempbx = *pSiS_VideoSenseData2;
  3495. }
  3496. /*end 301b */
  3497. tempcx = 0x0804;
  3498. if (SiS_Sense
  3499.     (SiS_Part4Port, tempbx, tempcx)) {
  3500. if (SiS_Sense
  3501.     (SiS_Part4Port, tempbx,
  3502.      tempcx)) {
  3503. tempax =
  3504.     tempax |
  3505.     AVIDEOSense;
  3506. }
  3507. }
  3508. } else {
  3509. if (!(tempax & SVIDEOSense)) {
  3510. tempbx = *pSiS_VideoSenseData;
  3511. /*301b */
  3512. if (!(SiS_Is301B (BaseAddr))) {
  3513. tempbx =
  3514.     *pSiS_VideoSenseData2;
  3515. }
  3516. /*end 301b */
  3517. tempcx = 0x0804;
  3518. if (SiS_Sense
  3519.     (SiS_Part4Port, tempbx,
  3520.      tempcx)) {
  3521. if (SiS_Sense
  3522.     (SiS_Part4Port,
  3523.      tempbx, tempcx)) {
  3524. tempax =
  3525.     tempax |
  3526.     AVIDEOSense;
  3527. }
  3528. }
  3529. }
  3530. }
  3531. }
  3533. if (SiS_SenseLCD (HwDeviceExtension)) {
  3534. tempax = tempax | LCDSense;
  3535. }
  3537. tempbx = 0;
  3538. tempcx = 0;
  3539. SiS_Sense (SiS_Part4Port, tempbx, tempcx);
  3541. SiS_SetRegANDOR (SiS_P3d4, 0x32, ~0xDF, tempax);
  3542. SiS_SetReg1 (SiS_Part2Port, 0x00, P2reg0);
  3543. if (!(P2reg0 & 0x20)) {
  3544. SiS_VBInfo = DisableCRT2Display;
  3545. SiS_SetCRT2Group301 (BaseAddr, ROMAddr,
  3546.      SenseModeNo,
  3547.      HwDeviceExtension);
  3548. }
  3549. }
  3550. }
  3551. }
  3553. BOOLEAN
  3554. SiS_Sense (USHORT Part4Port, USHORT tempbx, USHORT tempcx)
  3555. {
  3556. USHORT temp, i, tempch;
  3558. temp = tempbx & 0xFF;
  3559. SiS_SetReg1 (SiS_Part4Port, 0x11, temp);
  3560. temp = (tempbx & 0xFF00) >> 8;
  3561. temp = temp | (tempcx & 0x00FF);
  3562. SiS_SetRegANDOR (SiS_Part4Port, 0x10, ~0x1F, temp);
  3564. for (i = 0; i < 10; i++)
  3565. SiS_LongWait ();
  3567. tempch = (tempcx & 0x7F00) >> 8; /*   ynlai [05/22/2001]  */
  3568. temp = SiS_GetReg1 (SiS_Part4Port, 0x03);
  3569. temp = temp ^ (0x0E);
  3570. temp = temp & tempch; /*   ynlai [05/22/2001]  */
  3571. if (temp > 0)
  3572. return 1;
  3573. else
  3574. return 0;
  3575. }
  3577. USHORT
  3578. SiS_SenseLCD (PSIS_HW_DEVICE_INFO HwDeviceExtension)
  3579. {
  3580. /*  USHORT SoftSetting; */
  3581. USHORT temp;
  3583. temp = SiS_GetPanelID ();
  3584. if (!temp)
  3585. temp = SiS_GetLCDDDCInfo (HwDeviceExtension);
  3586. return (temp);
  3587. }
  3589. BOOLEAN
  3590. SiS_GetLCDDDCInfo (PSIS_HW_DEVICE_INFO HwDeviceExtension)
  3591. {
  3592. USHORT temp;
  3593. //add lcd sense
  3594. if (HwDeviceExtension->ulCRT2LCDType == LCD_UNKNOWN)
  3595. return 0;
  3596. else {
  3597. temp = (USHORT) HwDeviceExtension->ulCRT2LCDType;
  3598. SiS_SetReg1 (SiS_P3d4, 0x36, temp);
  3599. return 1;
  3600. }
  3601. }
  3603. BOOLEAN
  3604. SiS_GetPanelID (void)
  3605. {
  3606. USHORT PanelTypeTable[16] =
  3607.     { SyncNN | PanelRGB18Bit | Panel800x600 | _PanelType00,
  3608. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType01,
  3609. SyncPP | PanelRGB18Bit | Panel800x600 | _PanelType02,
  3610. SyncNN | PanelRGB18Bit | Panel640x480 | _PanelType03,
  3611. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType04,
  3612. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType05,
  3613. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType06,
  3614. SyncNN | PanelRGB24Bit | Panel1024x768 | _PanelType07,
  3615. SyncNN | PanelRGB18Bit | Panel800x600 | _PanelType08,
  3616. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType09,
  3617. SyncNN | PanelRGB18Bit | Panel800x600 | _PanelType0A,
  3618. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType0B,
  3619. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType0C,
  3620. SyncNN | PanelRGB24Bit | Panel1024x768 | _PanelType0D,
  3621. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType0E,
  3622. SyncNN | PanelRGB18Bit | Panel1024x768 | _PanelType0F
  3623. };
  3624. USHORT tempax, tempbx, temp;
  3625. /*  USHORT return_flag; */
  3627. tempax = SiS_GetReg1 (SiS_P3c4, 0x18);
  3628. tempbx = tempax & 0x0F;
  3629. if (!(tempax & 0x10)) {
  3630. if (SiS_IF_DEF_LVDS == 1) {
  3631. tempbx = 0;
  3632. temp = SiS_GetReg1 (SiS_P3c4, 0x38);
  3633. if (temp & 0x40)
  3634. tempbx = tempbx | 0x08;
  3635. if (temp & 0x20)
  3636. tempbx = tempbx | 0x02;
  3637. if (temp & 0x01)
  3638. tempbx = tempbx | 0x01;
  3639. temp = SiS_GetReg1 (SiS_P3c4, 0x39);
  3640. if (temp & 0x80)
  3641. tempbx = tempbx | 0x04;
  3642. } else {
  3643. return 0;
  3644. }
  3645. }
  3647. tempbx = tempbx << 1;
  3648. tempbx = PanelTypeTable[tempbx];
  3649. tempbx = tempbx | LCDSync;
  3650. temp = tempbx & 0x00FF;
  3651. SiS_SetReg1 (SiS_P3d4, 0x36, temp);
  3652. temp = (tempbx & 0xFF00) >> 8;
  3653. SiS_SetRegANDOR (SiS_P3d4, 0x37, ~(LCDSyncBit | LCDRGB18Bit), temp);
  3654. return 1;
  3655. }
  3657. USHORT
  3658. SiS_SenseCHTV (void)
  3659. {
  3660. USHORT temp, push0e, status;
  3662. status = 0;
  3663. push0e = SiS_GetCH7005 (0x0e);
  3664. push0e = (push0e << 8) | 0x0e;
  3665. SiS_SetCH7005 (0x0b0e);
  3666. SiS_SetCH7005 (0x0110);
  3667. SiS_SetCH7005 (0x0010);
  3668. temp = SiS_GetCH7005 (0x10);
  3669. if (temp & 0x08)
  3670. status = status | SVIDEOSense;
  3671. if (temp & 0x02)
  3672. status = status | AVIDEOSense;
  3673. SiS_SetCH7005 (push0e);
  3674. return (status);
  3675. }
  3677. /*  ==========================================  */
  3678. #ifdef TC
  3680. int
  3681. INT1AReturnCode (union REGS regs)
  3682. {
  3683. if (regs.x.cflag) {
  3684. /*printf("Error to find pci device!n"); */
  3685. return 1;
  3686. }
  3688. switch (regs.h.ah) {
  3689. case 0:
  3690. return 0;
  3691. break;
  3692. case 0x81:
  3693. printf ("Function not supportn");
  3694. break;
  3695. case 0x83:
  3696. printf ("bad vendor idn");
  3697. break;
  3698. case 0x86:
  3699. printf ("device not foundn");
  3700. break;
  3701. case 0x87:
  3702. printf ("bad register numbern");
  3703. break;
  3704. case 0x88:
  3705. printf ("set failedn");
  3706. break;
  3707. case 0x89:
  3708. printf ("buffer too small");
  3709. break;
  3710. }
  3711. return 1;
  3712. }
  3714. unsigned
  3715. FindPCIIOBase (unsigned index, unsigned deviceid)
  3716. {
  3717. union REGS regs;
  3719. regs.h.ah = 0xb1; /*PCI_FUNCTION_ID */
  3720. regs.h.al = 0x02; /*FIND_PCI_DEVICE */
  3721. regs.x.cx = deviceid;
  3722. regs.x.dx = 0x1039;
  3723. regs.x.si = index; /* find n-th device */
  3725. int86 (0x1A, &regs, &regs);
  3727. if (INT1AReturnCode (regs) != 0)
  3728. return 0;
  3730. /* regs.h.bh *//* bus number */
  3731. /* regs.h.bl *//* device number */
  3732. regs.h.ah = 0xb1; /*PCI_FUNCTION_ID */
  3733. regs.h.al = 0x09; /*READ_CONFIG_WORD */
  3734. regs.x.cx = deviceid;
  3735. regs.x.dx = 0x1039;
  3736. regs.x.di = 0x18; /* register number */
  3737. int86 (0x1A, &regs, &regs);
  3739. if (INT1AReturnCode (regs) != 0)
  3740. return 0;
  3741. return regs.x.cx;
  3742. }
  3744. void
  3745. main (int argc, char *argv[])
  3746. /* void main() */
  3747. {
  3748. SIS_HW_DEVICE_INFO HwDeviceExtension;
  3749. USHORT temp;
  3750. USHORT ModeNo;
  3752. /*HwDeviceExtension.pjVirtualRomBase =(PUCHAR) MK_FP(0xC000,0); */
  3753. /*HwDeviceExtension.pjVideoMemoryAddress = (PUCHAR)MK_FP(0xA000,0); */
  3754. #ifdef CONFIG_FB_SIS_300
  3755. HwDeviceExtension.ulIOAddress =
  3756.     (FindPCIIOBase (0, 0x6300) & 0xFF80) + 0x30;
  3757. HwDeviceExtension.jChipType = SIS_630;
  3758. #endif
  3760. #ifdef CONFIG_FB_SIS_315
  3761. //  HwDeviceExtension.ulIOAddress = (FindPCIIOBase(0,0x5315)&0xFF80) + 0x30;
  3762. //  HwDeviceExtension.jChipType = SIS_550;
  3763. HwDeviceExtension.ulIOAddress =
  3764.     (FindPCIIOBase (0, 0x325) & 0xFF80) + 0x30;
  3765. HwDeviceExtension.jChipType = SIS_315H;
  3766. #endif
  3767. HwDeviceExtension.ujVBChipID = VB_CHIP_301;
  3768. strcpy (HwDeviceExtension.szVBIOSVer, "0.84");
  3769. HwDeviceExtension.bSkipDramSizing = FALSE;
  3770. HwDeviceExtension.ulVideoMemorySize = 0;
  3771. if (argc == 2) {
  3772. ModeNo = atoi (argv[1]);
  3773. } else {
  3774. ModeNo = 0x2e;
  3775. /*ModeNo=0x37;  1024x768x 4bpp */
  3776. /*ModeNo=0x38;  1024x768x 8bpp */
  3777. /*ModeNo=0x4A;  1024x768x 16bpp */
  3778. /*ModeNo=0x47;  800x600x 16bpp */
  3779. }
  3780. // SiSInit(&HwDeviceExtension);
  3781. SiSSetMode (&HwDeviceExtension, ModeNo);
  3783. }
  3784. #endif