Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 1 | #include <linux/io.h> |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 2 | #include <linux/types.h> |
| 3 | #include "XGIfb.h" |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 4 | |
| 5 | #include "vb_def.h" |
| 6 | #include "vgatypes.h" |
| 7 | #include "vb_struct.h" |
| 8 | #include "vb_util.h" |
| 9 | #include "vb_setmode.h" |
| 10 | #include "vb_ext.h" |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 11 | |
| 12 | /************************************************************** |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 13 | *********************** Dynamic Sense ************************ |
| 14 | *************************************************************/ |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 15 | |
Randy Dunlap | 8922967 | 2010-08-10 08:46:44 -0700 | [diff] [blame] | 16 | static unsigned char XGINew_Is301B(struct vb_device_info *pVBInfo) |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 17 | { |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 18 | unsigned short flag; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 19 | |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 20 | flag = xgifb_reg_get(pVBInfo->Part4Port, 0x01); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 21 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 22 | if (flag > 0x0B0) |
| 23 | return 0; /* 301b */ |
| 24 | else |
| 25 | return 1; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 26 | } |
| 27 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 28 | static unsigned char XGINew_Sense(unsigned short tempbx, |
| 29 | unsigned short tempcx, |
| 30 | struct vb_device_info *pVBInfo) |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 31 | { |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 32 | unsigned short temp, i, tempch; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 33 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 34 | temp = tempbx & 0xFF; |
Aaro Koskinen | 8104e32 | 2011-03-13 12:26:22 +0200 | [diff] [blame] | 35 | xgifb_reg_set(pVBInfo->Part4Port, 0x11, temp); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 36 | temp = (tempbx & 0xFF00) >> 8; |
| 37 | temp |= (tempcx & 0x00FF); |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 38 | xgifb_reg_and_or(pVBInfo->Part4Port, 0x10, ~0x1F, temp); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 39 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 40 | for (i = 0; i < 10; i++) |
| 41 | XGI_LongWait(pVBInfo); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 42 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 43 | tempch = (tempcx & 0x7F00) >> 8; |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 44 | temp = xgifb_reg_get(pVBInfo->Part4Port, 0x03); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 45 | temp = temp ^ (0x0E); |
| 46 | temp &= tempch; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 47 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 48 | if (temp > 0) |
| 49 | return 1; |
| 50 | else |
| 51 | return 0; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 52 | } |
| 53 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 54 | static unsigned char |
| 55 | XGINew_GetLCDDDCInfo(struct xgi_hw_device_info *HwDeviceExtension, |
| 56 | struct vb_device_info *pVBInfo) |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 57 | { |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 58 | unsigned short temp; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 59 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 60 | /* add lcd sense */ |
| 61 | if (HwDeviceExtension->ulCRT2LCDType == LCD_UNKNOWN) { |
| 62 | return 0; |
| 63 | } else { |
| 64 | temp = (unsigned short) HwDeviceExtension->ulCRT2LCDType; |
| 65 | switch (HwDeviceExtension->ulCRT2LCDType) { |
| 66 | case LCD_INVALID: |
| 67 | case LCD_800x600: |
| 68 | case LCD_1024x768: |
| 69 | case LCD_1280x1024: |
| 70 | break; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 71 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 72 | case LCD_640x480: |
| 73 | case LCD_1024x600: |
| 74 | case LCD_1152x864: |
| 75 | case LCD_1280x960: |
| 76 | case LCD_1152x768: |
| 77 | temp = 0; |
| 78 | break; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 79 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 80 | case LCD_1400x1050: |
| 81 | case LCD_1280x768: |
| 82 | case LCD_1600x1200: |
| 83 | break; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 84 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 85 | case LCD_1920x1440: |
| 86 | case LCD_2048x1536: |
| 87 | temp = 0; |
| 88 | break; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 89 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 90 | default: |
| 91 | break; |
| 92 | } |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 93 | xgifb_reg_and_or(pVBInfo->P3d4, 0x36, 0xF0, temp); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 94 | return 1; |
| 95 | } |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 96 | } |
| 97 | |
Aaro Koskinen | 3d5375f | 2011-03-08 22:16:17 +0200 | [diff] [blame] | 98 | static unsigned char XGINew_GetPanelID(struct vb_device_info *pVBInfo) |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 99 | { |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 100 | unsigned short PanelTypeTable[16] = { SyncNN | PanelRGB18Bit |
| 101 | | Panel800x600 | _PanelType00, SyncNN | PanelRGB18Bit |
| 102 | | Panel1024x768 | _PanelType01, SyncNN | PanelRGB18Bit |
| 103 | | Panel800x600 | _PanelType02, SyncNN | PanelRGB18Bit |
| 104 | | Panel640x480 | _PanelType03, SyncNN | PanelRGB18Bit |
| 105 | | Panel1024x768 | _PanelType04, SyncNN | PanelRGB18Bit |
| 106 | | Panel1024x768 | _PanelType05, SyncNN | PanelRGB18Bit |
| 107 | | Panel1024x768 | _PanelType06, SyncNN | PanelRGB24Bit |
| 108 | | Panel1024x768 | _PanelType07, SyncNN | PanelRGB18Bit |
| 109 | | Panel800x600 | _PanelType08, SyncNN | PanelRGB18Bit |
| 110 | | Panel1024x768 | _PanelType09, SyncNN | PanelRGB18Bit |
| 111 | | Panel800x600 | _PanelType0A, SyncNN | PanelRGB18Bit |
| 112 | | Panel1024x768 | _PanelType0B, SyncNN | PanelRGB18Bit |
| 113 | | Panel1024x768 | _PanelType0C, SyncNN | PanelRGB24Bit |
| 114 | | Panel1024x768 | _PanelType0D, SyncNN | PanelRGB18Bit |
| 115 | | Panel1024x768 | _PanelType0E, SyncNN | PanelRGB18Bit |
| 116 | | Panel1024x768 | _PanelType0F }; |
| 117 | unsigned short tempax, tempbx, temp; |
| 118 | /* unsigned short return_flag; */ |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 119 | |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 120 | tempax = xgifb_reg_get(pVBInfo->P3c4, 0x1A); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 121 | tempbx = tempax & 0x1E; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 122 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 123 | if (tempax == 0) |
| 124 | return 0; |
| 125 | else { |
| 126 | /* |
| 127 | if (!(tempax & 0x10)) { |
| 128 | if (pVBInfo->IF_DEF_LVDS == 1) { |
| 129 | tempbx = 0; |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 130 | temp = xgifb_reg_get(pVBInfo->P3c4, 0x38); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 131 | if (temp & 0x40) |
| 132 | tempbx |= 0x08; |
| 133 | if (temp & 0x20) |
| 134 | tempbx |= 0x02; |
| 135 | if (temp & 0x01) |
| 136 | tempbx |= 0x01; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 137 | |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 138 | temp = xgifb_reg_get(pVBInfo->P3c4, 0x39); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 139 | if (temp & 0x80) |
| 140 | tempbx |= 0x04; |
| 141 | } else { |
| 142 | return(0); |
| 143 | } |
| 144 | } |
| 145 | */ |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 146 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 147 | tempbx = tempbx >> 1; |
| 148 | temp = tempbx & 0x00F; |
Aaro Koskinen | 8104e32 | 2011-03-13 12:26:22 +0200 | [diff] [blame] | 149 | xgifb_reg_set(pVBInfo->P3d4, 0x36, temp); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 150 | tempbx--; |
| 151 | tempbx = PanelTypeTable[tempbx]; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 152 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 153 | temp = (tempbx & 0xFF00) >> 8; |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 154 | xgifb_reg_and_or(pVBInfo->P3d4, 0x37, ~(LCDSyncBit |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 155 | | LCDRGB18Bit), temp); |
| 156 | return 1; |
| 157 | } |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 158 | } |
| 159 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 160 | static unsigned char |
| 161 | XGINew_BridgeIsEnable(struct xgi_hw_device_info *HwDeviceExtension, |
| 162 | struct vb_device_info *pVBInfo) |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 163 | { |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 164 | unsigned short flag; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 165 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 166 | if (XGI_BridgeIsOn(pVBInfo) == 0) { |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 167 | flag = xgifb_reg_get(pVBInfo->Part1Port, 0x0); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 168 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 169 | if (flag & 0x050) |
| 170 | return 1; |
| 171 | else |
| 172 | return 0; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 173 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 174 | } |
| 175 | return 0; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 176 | } |
| 177 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 178 | static unsigned char |
| 179 | XGINew_SenseHiTV(struct xgi_hw_device_info *HwDeviceExtension, |
| 180 | struct vb_device_info *pVBInfo) |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 181 | { |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 182 | unsigned short tempbx, tempcx, temp, i, tempch; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 183 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 184 | tempbx = *pVBInfo->pYCSenseData2; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 185 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 186 | tempcx = 0x0604; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 187 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 188 | temp = tempbx & 0xFF; |
Aaro Koskinen | 8104e32 | 2011-03-13 12:26:22 +0200 | [diff] [blame] | 189 | xgifb_reg_set(pVBInfo->Part4Port, 0x11, temp); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 190 | temp = (tempbx & 0xFF00) >> 8; |
| 191 | temp |= (tempcx & 0x00FF); |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 192 | xgifb_reg_and_or(pVBInfo->Part4Port, 0x10, ~0x1F, temp); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 193 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 194 | for (i = 0; i < 10; i++) |
| 195 | XGI_LongWait(pVBInfo); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 196 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 197 | tempch = (tempcx & 0xFF00) >> 8; |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 198 | temp = xgifb_reg_get(pVBInfo->Part4Port, 0x03); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 199 | temp = temp ^ (0x0E); |
| 200 | temp &= tempch; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 201 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 202 | if (temp != tempch) |
| 203 | return 0; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 204 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 205 | tempbx = *pVBInfo->pVideoSenseData2; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 206 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 207 | tempcx = 0x0804; |
| 208 | temp = tempbx & 0xFF; |
Aaro Koskinen | 8104e32 | 2011-03-13 12:26:22 +0200 | [diff] [blame] | 209 | xgifb_reg_set(pVBInfo->Part4Port, 0x11, temp); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 210 | temp = (tempbx & 0xFF00) >> 8; |
| 211 | temp |= (tempcx & 0x00FF); |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 212 | xgifb_reg_and_or(pVBInfo->Part4Port, 0x10, ~0x1F, temp); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 213 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 214 | for (i = 0; i < 10; i++) |
| 215 | XGI_LongWait(pVBInfo); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 216 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 217 | tempch = (tempcx & 0xFF00) >> 8; |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 218 | temp = xgifb_reg_get(pVBInfo->Part4Port, 0x03); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 219 | temp = temp ^ (0x0E); |
| 220 | temp &= tempch; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 221 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 222 | if (temp != tempch) { |
| 223 | return 0; |
| 224 | } else { |
| 225 | tempbx = 0x3FF; |
| 226 | tempcx = 0x0804; |
| 227 | temp = tempbx & 0xFF; |
Aaro Koskinen | 8104e32 | 2011-03-13 12:26:22 +0200 | [diff] [blame] | 228 | xgifb_reg_set(pVBInfo->Part4Port, 0x11, temp); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 229 | temp = (tempbx & 0xFF00) >> 8; |
| 230 | temp |= (tempcx & 0x00FF); |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 231 | xgifb_reg_and_or(pVBInfo->Part4Port, 0x10, ~0x1F, temp); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 232 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 233 | for (i = 0; i < 10; i++) |
| 234 | XGI_LongWait(pVBInfo); |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 235 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 236 | tempch = (tempcx & 0xFF00) >> 8; |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 237 | temp = xgifb_reg_get(pVBInfo->Part4Port, 0x03); |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 238 | temp = temp ^ (0x0E); |
| 239 | temp &= tempch; |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 240 | |
Prashant P. Shah | 914a402 | 2010-09-01 21:37:35 +0530 | [diff] [blame] | 241 | if (temp != tempch) |
| 242 | return 1; |
| 243 | else |
| 244 | return 0; |
| 245 | } |
apatard@mandriva.com | d7636e0 | 2010-05-19 10:44:14 +0200 | [diff] [blame] | 246 | } |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 247 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 248 | void XGI_GetSenseStatus(struct xgi_hw_device_info *HwDeviceExtension, |
| 249 | struct vb_device_info *pVBInfo) |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 250 | { |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 251 | unsigned short tempax = 0, tempbx, tempcx, temp, |
| 252 | P2reg0 = 0, SenseModeNo = 0, |
| 253 | OutputSelect = *pVBInfo->pOutputSelect, |
| 254 | ModeIdIndex, i; |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 255 | pVBInfo->BaseAddr = (unsigned long) HwDeviceExtension->pjIOAddress; |
| 256 | |
| 257 | if (pVBInfo->IF_DEF_LVDS == 1) { |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 258 | /* ynlai 02/27/2002 */ |
| 259 | tempax = xgifb_reg_get(pVBInfo->P3c4, 0x1A); |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 260 | tempbx = xgifb_reg_get(pVBInfo->P3c4, 0x1B); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 261 | tempax = ((tempax & 0xFE) >> 1) | (tempbx << 8); |
| 262 | if (tempax == 0x00) { /* Get Panel id from DDC */ |
| 263 | temp = XGINew_GetLCDDDCInfo(HwDeviceExtension, pVBInfo); |
| 264 | if (temp == 1) { /* LCD connect */ |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 265 | /* set CR39 bit0="1" */ |
| 266 | xgifb_reg_and_or(pVBInfo->P3d4, |
| 267 | 0x39, 0xFF, 0x01); |
| 268 | /* clean CR37 bit4="0" */ |
| 269 | xgifb_reg_and_or(pVBInfo->P3d4, |
| 270 | 0x37, 0xEF, 0x00); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 271 | temp = LCDSense; |
| 272 | } else { /* LCD don't connect */ |
| 273 | temp = 0; |
| 274 | } |
| 275 | } else { |
| 276 | XGINew_GetPanelID(pVBInfo); |
| 277 | temp = LCDSense; |
| 278 | } |
| 279 | |
| 280 | tempbx = ~(LCDSense | AVIDEOSense | SVIDEOSense); |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 281 | xgifb_reg_and_or(pVBInfo->P3d4, 0x32, tempbx, temp); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 282 | } else { /* for 301 */ |
| 283 | if (pVBInfo->VBInfo & SetCRT2ToHiVisionTV) { /* for HiVision */ |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 284 | tempax = xgifb_reg_get(pVBInfo->P3c4, 0x38); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 285 | temp = tempax & 0x01; |
Aaro Koskinen | 58839b0 | 2011-03-13 12:26:23 +0200 | [diff] [blame] | 286 | tempax = xgifb_reg_get(pVBInfo->P3c4, 0x3A); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 287 | temp = temp | (tempax & 0x02); |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 288 | xgifb_reg_and_or(pVBInfo->P3d4, 0x32, 0xA0, temp); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 289 | } else { |
| 290 | if (XGI_BridgeIsOn(pVBInfo)) { |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 291 | P2reg0 = xgifb_reg_get(pVBInfo->Part2Port, |
| 292 | 0x00); |
| 293 | if (!XGINew_BridgeIsEnable(HwDeviceExtension, |
| 294 | pVBInfo)) { |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 295 | SenseModeNo = 0x2e; |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 296 | /* xgifb_reg_set(pVBInfo->P3d4, 0x30, 0x41); |
| 297 | * XGISetModeNew(HwDeviceExtension, 0x2e); |
| 298 | * // ynlai InitMode */ |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 299 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 300 | temp = XGI_SearchModeID(SenseModeNo, |
| 301 | &ModeIdIndex, |
| 302 | pVBInfo); |
| 303 | XGI_GetVGAType(HwDeviceExtension, |
| 304 | pVBInfo); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 305 | XGI_GetVBType(pVBInfo); |
| 306 | pVBInfo->SetFlag = 0x00; |
| 307 | pVBInfo->ModeType = ModeVGA; |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 308 | pVBInfo->VBInfo = SetCRT2ToRAMDAC | |
| 309 | LoadDACFlag | |
| 310 | SetInSlaveMode; |
| 311 | XGI_GetLCDInfo(0x2e, |
| 312 | ModeIdIndex, |
| 313 | pVBInfo); |
| 314 | XGI_GetTVInfo(0x2e, |
| 315 | ModeIdIndex, |
| 316 | pVBInfo); |
| 317 | XGI_EnableBridge(HwDeviceExtension, |
| 318 | pVBInfo); |
| 319 | XGI_SetCRT2Group301(SenseModeNo, |
| 320 | HwDeviceExtension, |
| 321 | pVBInfo); |
| 322 | XGI_SetCRT2ModeRegs(0x2e, |
| 323 | HwDeviceExtension, |
| 324 | pVBInfo); |
| 325 | /* XGI_DisableBridge(HwDeviceExtension, |
| 326 | * pVBInfo ) ; */ |
| 327 | /* Display Off 0212 */ |
| 328 | xgifb_reg_and_or(pVBInfo->P3c4, |
| 329 | 0x01, |
| 330 | 0xDF, |
| 331 | 0x20); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 332 | for (i = 0; i < 20; i++) |
| 333 | XGI_LongWait(pVBInfo); |
| 334 | } |
Aaro Koskinen | 8104e32 | 2011-03-13 12:26:22 +0200 | [diff] [blame] | 335 | xgifb_reg_set(pVBInfo->Part2Port, 0x00, 0x1c); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 336 | tempax = 0; |
| 337 | tempbx = *pVBInfo->pRGBSenseData; |
| 338 | |
| 339 | if (!(XGINew_Is301B(pVBInfo))) |
| 340 | tempbx = *pVBInfo->pRGBSenseData2; |
| 341 | |
| 342 | tempcx = 0x0E08; |
| 343 | if (XGINew_Sense(tempbx, tempcx, pVBInfo)) { |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 344 | if (XGINew_Sense(tempbx, |
| 345 | tempcx, |
| 346 | pVBInfo)) |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 347 | tempax |= Monitor2Sense; |
| 348 | } |
| 349 | |
| 350 | if (pVBInfo->VBType & VB_XGI301C) |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 351 | xgifb_reg_or(pVBInfo->Part4Port, |
| 352 | 0x0d, |
| 353 | 0x04); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 354 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 355 | /* add by kuku for Multi-adapter sense HiTV */ |
| 356 | if (XGINew_SenseHiTV(HwDeviceExtension, |
| 357 | pVBInfo)) { |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 358 | tempax |= HiTVSense; |
| 359 | if ((pVBInfo->VBType & VB_XGI301C)) |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 360 | tempax ^= (HiTVSense | |
| 361 | YPbPrSense); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 362 | } |
| 363 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 364 | /* start */ |
| 365 | if (!(tempax & (HiTVSense | YPbPrSense))) { |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 366 | tempbx = *pVBInfo->pYCSenseData; |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 367 | if (!(XGINew_Is301B(pVBInfo))) |
| 368 | tempbx = *pVBInfo->pYCSenseData2; |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 369 | tempcx = 0x0604; |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 370 | if (XGINew_Sense(tempbx, |
| 371 | tempcx, |
| 372 | pVBInfo)) { |
| 373 | if (XGINew_Sense(tempbx, |
| 374 | tempcx, |
| 375 | pVBInfo)) |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 376 | tempax |= SVIDEOSense; |
| 377 | } |
| 378 | |
| 379 | if (OutputSelect & BoardTVType) { |
| 380 | tempbx = *pVBInfo->pVideoSenseData; |
| 381 | |
| 382 | if (!(XGINew_Is301B(pVBInfo))) |
| 383 | tempbx = *pVBInfo->pVideoSenseData2; |
| 384 | |
| 385 | tempcx = 0x0804; |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 386 | if (XGINew_Sense(tempbx, |
| 387 | tempcx, |
| 388 | pVBInfo)) { |
| 389 | if (XGINew_Sense(tempbx, |
| 390 | tempcx, |
| 391 | pVBInfo)) |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 392 | tempax |= AVIDEOSense; |
| 393 | } |
| 394 | } else { |
| 395 | if (!(tempax & SVIDEOSense)) { |
| 396 | tempbx = *pVBInfo->pVideoSenseData; |
| 397 | |
| 398 | if (!(XGINew_Is301B(pVBInfo))) |
| 399 | tempbx = *pVBInfo->pVideoSenseData2; |
| 400 | |
| 401 | tempcx = 0x0804; |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 402 | if (XGINew_Sense(tempbx, |
| 403 | tempcx, |
| 404 | pVBInfo)) { |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 405 | if (XGINew_Sense(tempbx, tempcx, pVBInfo)) |
| 406 | tempax |= AVIDEOSense; |
| 407 | } |
| 408 | } |
| 409 | } |
| 410 | } |
| 411 | } /* end */ |
| 412 | if (!(tempax & Monitor2Sense)) { |
| 413 | if (XGINew_SenseLCD(HwDeviceExtension, pVBInfo)) |
| 414 | tempax |= LCDSense; |
| 415 | } |
| 416 | tempbx = 0; |
| 417 | tempcx = 0; |
| 418 | XGINew_Sense(tempbx, tempcx, pVBInfo); |
| 419 | |
Aaro Koskinen | ec9e5d3 | 2011-03-13 12:26:25 +0200 | [diff] [blame] | 420 | xgifb_reg_and_or(pVBInfo->P3d4, 0x32, ~0xDF, tempax); |
Aaro Koskinen | 8104e32 | 2011-03-13 12:26:22 +0200 | [diff] [blame] | 421 | xgifb_reg_set(pVBInfo->Part2Port, 0x00, P2reg0); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 422 | |
| 423 | if (!(P2reg0 & 0x20)) { |
| 424 | pVBInfo->VBInfo = DisableCRT2Display; |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 425 | /* XGI_SetCRT2Group301(SenseModeNo, |
| 426 | * HwDeviceExtension, |
| 427 | * pVBInfo); */ |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 428 | } |
| 429 | } |
| 430 | } |
| 431 | XGI_DisableBridge(HwDeviceExtension, pVBInfo); /* shampoo 0226 */ |
| 432 | |
| 433 | } |
| 434 | |
Kenji Toyama | 6622995 | 2011-04-23 08:27:48 +0800 | [diff] [blame] | 435 | unsigned short XGINew_SenseLCD(struct xgi_hw_device_info *HwDeviceExtension, |
| 436 | struct vb_device_info *pVBInfo) |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 437 | { |
| 438 | /* unsigned short SoftSetting ; */ |
| 439 | unsigned short temp; |
| 440 | |
Aaro Koskinen | 0658733 | 2011-03-13 12:26:10 +0200 | [diff] [blame] | 441 | temp = XGINew_GetLCDDDCInfo(HwDeviceExtension, pVBInfo); |
Aaro Koskinen | 3f8214c | 2011-03-13 12:26:05 +0200 | [diff] [blame] | 442 | |
| 443 | return temp; |
| 444 | } |