2 * sisusb - usb kernel driver for SiS315(E) based USB2VGA dongles
4 * Display mode initializing code
6 * Copyright (C) 2001-2005 by Thomas Winischhofer, Vienna, Austria
8 * If distributed as part of the Linux kernel, this code is licensed under the
11 * Otherwise, the following license terms apply:
13 * * Redistribution and use in source and binary forms, with or without
14 * * modification, are permitted provided that the following conditions
16 * * 1) Redistributions of source code must retain the above copyright
17 * * notice, this list of conditions and the following disclaimer.
18 * * 2) Redistributions in binary form must reproduce the above copyright
19 * * notice, this list of conditions and the following disclaimer in the
20 * * documentation and/or other materials provided with the distribution.
21 * * 3) The name of the author may not be used to endorse or promote products
22 * * derived from this software without specific prior written permission.
24 * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
25 * * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
26 * * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
27 * * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
28 * * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
29 * * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
30 * * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
31 * * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
32 * * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
33 * * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
35 * Author: Thomas Winischhofer <thomas@winischhofer.net>
39 #include <linux/module.h>
40 #include <linux/kernel.h>
41 #include <linux/errno.h>
42 #include <linux/poll.h>
43 #include <linux/init.h>
44 #include <linux/slab.h>
45 #include <linux/spinlock.h>
46 #include <linux/kref.h>
50 #ifdef INCL_SISUSB_CON
52 #include "sisusb_init.h"
54 /*********************************************/
55 /* POINTER INITIALIZATION */
56 /*********************************************/
59 SiSUSB_InitPtr(struct SiS_Private *SiS_Pr)
61 SiS_Pr->SiS_ModeResInfo = SiSUSB_ModeResInfo;
62 SiS_Pr->SiS_StandTable = SiSUSB_StandTable;
64 SiS_Pr->SiS_SModeIDTable = SiSUSB_SModeIDTable;
65 SiS_Pr->SiS_EModeIDTable = SiSUSB_EModeIDTable;
66 SiS_Pr->SiS_RefIndex = SiSUSB_RefIndex;
67 SiS_Pr->SiS_CRT1Table = SiSUSB_CRT1Table;
69 SiS_Pr->SiS_VCLKData = SiSUSB_VCLKData;
72 /*********************************************/
73 /* HELPER: SetReg, GetReg */
74 /*********************************************/
77 SiS_SetReg(struct SiS_Private *SiS_Pr, unsigned long port,
78 unsigned short index, unsigned short data)
80 sisusb_setidxreg(SiS_Pr->sisusb, port, index, data);
84 SiS_SetRegByte(struct SiS_Private *SiS_Pr, unsigned long port,
87 sisusb_setreg(SiS_Pr->sisusb, port, data);
91 SiS_GetReg(struct SiS_Private *SiS_Pr, unsigned long port,
96 sisusb_getidxreg(SiS_Pr->sisusb, port, index, &data);
102 SiS_GetRegByte(struct SiS_Private *SiS_Pr, unsigned long port)
106 sisusb_getreg(SiS_Pr->sisusb, port, &data);
112 SiS_SetRegANDOR(struct SiS_Private *SiS_Pr, unsigned long port,
113 unsigned short index, unsigned short DataAND,
114 unsigned short DataOR)
116 sisusb_setidxregandor(SiS_Pr->sisusb, port, index, DataAND, DataOR);
120 SiS_SetRegAND(struct SiS_Private *SiS_Pr, unsigned long port,
121 unsigned short index, unsigned short DataAND)
123 sisusb_setidxregand(SiS_Pr->sisusb, port, index, DataAND);
127 SiS_SetRegOR(struct SiS_Private *SiS_Pr,unsigned long port,
128 unsigned short index, unsigned short DataOR)
130 sisusb_setidxregor(SiS_Pr->sisusb, port, index, DataOR);
133 /*********************************************/
134 /* HELPER: DisplayOn, DisplayOff */
135 /*********************************************/
138 SiS_DisplayOn(struct SiS_Private *SiS_Pr)
140 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x01, 0xDF);
143 /*********************************************/
144 /* HELPER: Init Port Addresses */
145 /*********************************************/
148 SiSUSBRegInit(struct SiS_Private *SiS_Pr, unsigned long BaseAddr)
150 SiS_Pr->SiS_P3c4 = BaseAddr + 0x14;
151 SiS_Pr->SiS_P3d4 = BaseAddr + 0x24;
152 SiS_Pr->SiS_P3c0 = BaseAddr + 0x10;
153 SiS_Pr->SiS_P3ce = BaseAddr + 0x1e;
154 SiS_Pr->SiS_P3c2 = BaseAddr + 0x12;
155 SiS_Pr->SiS_P3ca = BaseAddr + 0x1a;
156 SiS_Pr->SiS_P3c6 = BaseAddr + 0x16;
157 SiS_Pr->SiS_P3c7 = BaseAddr + 0x17;
158 SiS_Pr->SiS_P3c8 = BaseAddr + 0x18;
159 SiS_Pr->SiS_P3c9 = BaseAddr + 0x19;
160 SiS_Pr->SiS_P3cb = BaseAddr + 0x1b;
161 SiS_Pr->SiS_P3cc = BaseAddr + 0x1c;
162 SiS_Pr->SiS_P3cd = BaseAddr + 0x1d;
163 SiS_Pr->SiS_P3da = BaseAddr + 0x2a;
164 SiS_Pr->SiS_Part1Port = BaseAddr + SIS_CRT2_PORT_04;
167 /*********************************************/
168 /* HELPER: GetSysFlags */
169 /*********************************************/
172 SiS_GetSysFlags(struct SiS_Private *SiS_Pr)
174 SiS_Pr->SiS_MyCR63 = 0x63;
177 /*********************************************/
178 /* HELPER: Init PCI & Engines */
179 /*********************************************/
182 SiSInitPCIetc(struct SiS_Private *SiS_Pr)
184 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x20, 0xa1);
185 /* - Enable 2D (0x40)
187 * - Enable 3D vertex command fetch (0x10)
188 * - Enable 3D command parser (0x08)
189 * - Enable 3D G/L transformation engine (0x80)
191 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1E, 0xDA);
194 /*********************************************/
195 /* HELPER: SET SEGMENT REGISTERS */
196 /*********************************************/
199 SiS_SetSegRegLower(struct SiS_Private *SiS_Pr, unsigned short value)
204 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb) & 0xf0;
205 temp |= (value >> 4);
206 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb, temp);
207 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd) & 0xf0;
208 temp |= (value & 0x0f);
209 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd, temp);
213 SiS_SetSegRegUpper(struct SiS_Private *SiS_Pr, unsigned short value)
218 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb) & 0x0f;
219 temp |= (value & 0xf0);
220 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb, temp);
221 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd) & 0x0f;
222 temp |= (value << 4);
223 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd, temp);
227 SiS_SetSegmentReg(struct SiS_Private *SiS_Pr, unsigned short value)
229 SiS_SetSegRegLower(SiS_Pr, value);
230 SiS_SetSegRegUpper(SiS_Pr, value);
234 SiS_ResetSegmentReg(struct SiS_Private *SiS_Pr)
236 SiS_SetSegmentReg(SiS_Pr, 0);
240 SiS_SetSegmentRegOver(struct SiS_Private *SiS_Pr, unsigned short value)
242 unsigned short temp = value >> 8;
246 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1d, temp);
247 SiS_SetSegmentReg(SiS_Pr, value);
251 SiS_ResetSegmentRegOver(struct SiS_Private *SiS_Pr)
253 SiS_SetSegmentRegOver(SiS_Pr, 0);
257 SiS_ResetSegmentRegisters(struct SiS_Private *SiS_Pr)
259 SiS_ResetSegmentReg(SiS_Pr);
260 SiS_ResetSegmentRegOver(SiS_Pr);
263 /*********************************************/
264 /* HELPER: SearchModeID */
265 /*********************************************/
268 SiS_SearchModeID(struct SiS_Private *SiS_Pr, unsigned short *ModeNo,
269 unsigned short *ModeIdIndex)
271 if ((*ModeNo) <= 0x13) {
273 if ((*ModeNo) != 0x03)
280 for(*ModeIdIndex = 0; ;(*ModeIdIndex)++) {
282 if (SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == (*ModeNo))
285 if (SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == 0xFF)
294 /*********************************************/
295 /* HELPER: ENABLE CRT1 */
296 /*********************************************/
299 SiS_HandleCRT1(struct SiS_Private *SiS_Pr)
301 /* Enable CRT1 gating */
302 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3d4, SiS_Pr->SiS_MyCR63, 0xbf);
305 /*********************************************/
306 /* HELPER: GetColorDepth */
307 /*********************************************/
309 static unsigned short
310 SiS_GetColorDepth(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
311 unsigned short ModeIdIndex)
313 static const unsigned short ColorDepth[6] = { 1, 2, 4, 4, 6, 8};
314 unsigned short modeflag;
317 if (ModeNo <= 0x13) {
318 modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
320 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
323 index = (modeflag & ModeTypeMask) - ModeEGA;
324 if (index < 0) index = 0;
325 return ColorDepth[index];
328 /*********************************************/
329 /* HELPER: GetOffset */
330 /*********************************************/
332 static unsigned short
333 SiS_GetOffset(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
334 unsigned short ModeIdIndex, unsigned short rrti)
336 unsigned short xres, temp, colordepth, infoflag;
338 infoflag = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag;
339 xres = SiS_Pr->SiS_RefIndex[rrti].XRes;
341 colordepth = SiS_GetColorDepth(SiS_Pr, ModeNo, ModeIdIndex);
345 if (infoflag & InterlaceMode)
351 temp += (colordepth >> 1);
356 /*********************************************/
358 /*********************************************/
361 SiS_SetSeqRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
363 unsigned char SRdata;
366 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x00, 0x03);
368 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[0] | 0x20;
369 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x01, SRdata);
371 for(i = 2; i <= 4; i++) {
372 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[i-1];
373 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, i, SRdata);
377 /*********************************************/
379 /*********************************************/
382 SiS_SetMiscRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
384 unsigned char Miscdata = SiS_Pr->SiS_StandTable[StandTableIndex].MISC;
386 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c2, Miscdata);
389 /*********************************************/
391 /*********************************************/
394 SiS_SetCRTCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
396 unsigned char CRTCdata;
399 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3d4, 0x11, 0x7f);
401 for(i = 0; i <= 0x18; i++) {
402 CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i];
403 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, i, CRTCdata);
407 /*********************************************/
409 /*********************************************/
412 SiS_SetATTRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
414 unsigned char ARdata;
417 for(i = 0; i <= 0x13; i++) {
418 ARdata = SiS_Pr->SiS_StandTable[StandTableIndex].ATTR[i];
419 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
420 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, i);
421 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, ARdata);
423 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
424 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, 0x14);
425 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, 0x00);
427 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
428 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, 0x20);
429 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
432 /*********************************************/
434 /*********************************************/
437 SiS_SetGRCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
439 unsigned char GRdata;
442 for(i = 0; i <= 0x08; i++) {
443 GRdata = SiS_Pr->SiS_StandTable[StandTableIndex].GRC[i];
444 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3ce, i, GRdata);
447 if (SiS_Pr->SiS_ModeType > ModeVGA) {
448 /* 256 color disable */
449 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3ce, 0x05, 0xBF);
453 /*********************************************/
454 /* CLEAR EXTENDED REGISTERS */
455 /*********************************************/
458 SiS_ClearExt1Regs(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
462 for(i = 0x0A; i <= 0x0E; i++) {
463 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, i, 0x00);
466 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x37, 0xFE);
469 /*********************************************/
471 /*********************************************/
473 static unsigned short
474 SiS_GetRatePtr(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
475 unsigned short ModeIdIndex)
477 unsigned short rrti, i, index, temp;
482 index = SiS_GetReg(SiS_Pr,SiS_Pr->SiS_P3d4, 0x33) & 0x0F;
483 if (index > 0) index--;
485 rrti = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].REFindex;
486 ModeNo = SiS_Pr->SiS_RefIndex[rrti].ModeID;
490 if (SiS_Pr->SiS_RefIndex[rrti + i].ModeID != ModeNo)
493 temp = SiS_Pr->SiS_RefIndex[rrti + i].Ext_InfoFlag & ModeTypeMask;
494 if (temp < SiS_Pr->SiS_ModeType)
499 } while(index != 0xFFFF);
506 /*********************************************/
508 /*********************************************/
511 SiS_SetCRT1Sync(struct SiS_Private *SiS_Pr, unsigned short rrti)
513 unsigned short sync = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag >> 8;
516 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c2, sync);
519 /*********************************************/
521 /*********************************************/
524 SiS_SetCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
525 unsigned short ModeIdIndex, unsigned short rrti)
528 unsigned short temp, i, j, modeflag;
530 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3d4,0x11,0x7f);
532 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
534 index = SiS_Pr->SiS_RefIndex[rrti].Ext_CRT1CRTC;
536 for(i = 0,j = 0; i <= 7; i++, j++) {
537 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, j,
538 SiS_Pr->SiS_CRT1Table[index].CR[i]);
540 for(j = 0x10; i <= 10; i++, j++) {
541 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, j,
542 SiS_Pr->SiS_CRT1Table[index].CR[i]);
544 for(j = 0x15; i <= 12; i++, j++) {
545 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, j,
546 SiS_Pr->SiS_CRT1Table[index].CR[i]);
548 for(j = 0x0A; i <= 15; i++, j++) {
549 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, j,
550 SiS_Pr->SiS_CRT1Table[index].CR[i]);
553 temp = SiS_Pr->SiS_CRT1Table[index].CR[16] & 0xE0;
554 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4, 0x0E, temp);
556 temp = ((SiS_Pr->SiS_CRT1Table[index].CR[16]) & 0x01) << 5;
557 if (modeflag & DoubleScanMode) temp |= 0x80;
558 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3d4, 0x09, 0x5F, temp);
560 if (SiS_Pr->SiS_ModeType > ModeVGA)
561 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x14, 0x4F);
564 /*********************************************/
566 /*********************************************/
567 /* (partly overruled by SetPitch() in XF86) */
568 /*********************************************/
571 SiS_SetCRT1Offset(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
572 unsigned short ModeIdIndex, unsigned short rrti)
574 unsigned short du = SiS_GetOffset(SiS_Pr, ModeNo, ModeIdIndex, rrti);
575 unsigned short infoflag = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag;
578 temp = (du >> 8) & 0x0f;
579 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0E, 0xF0, temp);
581 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x13, (du & 0xFF));
583 if (infoflag & InterlaceMode) du >>= 1;
586 temp = (du >> 8) & 0xff;
587 if (du & 0xff) temp++;
589 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x10, temp);
592 /*********************************************/
594 /*********************************************/
597 SiS_SetCRT1VCLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
600 unsigned short index = SiS_Pr->SiS_RefIndex[rrti].Ext_CRTVCLK;
601 unsigned short clka = SiS_Pr->SiS_VCLKData[index].SR2B;
602 unsigned short clkb = SiS_Pr->SiS_VCLKData[index].SR2C;
604 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4,0x31,0xCF);
606 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4,0x2B,clka);
607 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4,0x2C,clkb);
608 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4,0x2D,0x01);
611 /*********************************************/
613 /*********************************************/
616 SiS_SetCRT1FIFO_310(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
619 unsigned short modeflag = SiS_Pr->SiS_EModeIDTable[mi].Ext_ModeFlag;
621 /* disable auto-threshold */
622 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x3D, 0xFE);
624 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x08, 0xAE);
625 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x09, 0xF0);
630 if ((!(modeflag & DoubleScanMode)) || (!(modeflag & HalfDCLK))) {
631 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x08, 0x34);
632 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x3D, 0x01);
636 /*********************************************/
638 /*********************************************/
641 SiS_SetVCLKState(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
644 unsigned short data = 0, VCLK = 0, index = 0;
647 index = SiS_Pr->SiS_RefIndex[rrti].Ext_CRTVCLK;
648 VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
651 if (VCLK >= 166) data |= 0x0c;
652 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x32, 0xf3, data);
655 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1f, 0xe7);
661 else if (VCLK >= 160)
663 else if (VCLK >= 135)
666 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x07, 0xF8, data);
670 SiS_SetCRT1ModeRegs(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
671 unsigned short ModeIdIndex, unsigned short rrti)
673 unsigned short data, infoflag = 0, modeflag;
676 modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
678 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
679 infoflag = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag;
683 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1F, 0x3F);
687 if (SiS_Pr->SiS_ModeType > ModeEGA) {
689 data |= ((SiS_Pr->SiS_ModeType - ModeVGA) << 2);
691 if (infoflag & InterlaceMode) data |= 0x20;
693 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x06, 0xC0, data);
696 if (infoflag & InterlaceMode) {
697 /* data = (Hsync / 8) - ((Htotal / 8) / 2) + 3 */
698 unsigned short hrs = (SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x04) |
699 ((SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0b) & 0xc0) << 2)) - 3;
700 unsigned short hto = (SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x00) |
701 ((SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0b) & 0x03) << 8)) + 5;
702 data = hrs - (hto >> 1) + 3;
704 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x19, (data & 0xFF));
705 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3d4, 0x1a, 0xFC, (data >> 8));
707 if (modeflag & HalfDCLK)
708 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x01, 0x08);
711 if (modeflag & LineCompareOff)
713 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0F, 0xB7, data);
715 if ((SiS_Pr->SiS_ModeType == ModeEGA) && (ModeNo > 0x13))
716 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0F, 0x40);
718 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x31, 0xfb);
721 if (SiS_Pr->SiS_ModeType != ModeText) {
723 if (SiS_Pr->SiS_ModeType != ModeEGA)
726 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x21, 0x1F, data);
728 SiS_SetVCLKState(SiS_Pr, ModeNo, rrti);
730 if (SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x31) & 0x40)
731 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x52, 0x2c);
733 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x52, 0x6c);
736 /*********************************************/
738 /*********************************************/
741 SiS_WriteDAC(struct SiS_Private *SiS_Pr, unsigned long DACData,
742 unsigned short shiftflag, unsigned short dl, unsigned short ah,
743 unsigned short al, unsigned short dh)
745 unsigned short d1, d2, d3;
749 d1 = dh; d2 = ah; d3 = al;
752 d1 = ah; d2 = al; d3 = dh;
755 d1 = al; d2 = dh; d3 = ah;
757 SiS_SetRegByte(SiS_Pr, DACData, (d1 << shiftflag));
758 SiS_SetRegByte(SiS_Pr, DACData, (d2 << shiftflag));
759 SiS_SetRegByte(SiS_Pr, DACData, (d3 << shiftflag));
763 SiS_LoadDAC(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short mi)
765 unsigned short data, data2, time, i, j, k, m, n, o;
766 unsigned short si, di, bx, sf;
767 unsigned long DACAddr, DACData;
768 const unsigned char *table = NULL;
771 data = SiS_Pr->SiS_SModeIDTable[mi].St_ModeFlag;
773 data = SiS_Pr->SiS_EModeIDTable[mi].Ext_ModeFlag;
780 else if (data == 0x08)
782 else if (data == 0x10)
790 DACAddr = SiS_Pr->SiS_P3c8;
791 DACData = SiS_Pr->SiS_P3c9;
793 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c6, 0xFF);
795 SiS_SetRegByte(SiS_Pr, DACAddr, 0x00);
797 for(i = 0; i < j; i++) {
799 for(k = 0; k < 3; k++) {
801 if (data & 0x01) data2 += 0x2A;
802 if (data & 0x02) data2 += 0x15;
803 SiS_SetRegByte(SiS_Pr, DACData, (data2 << sf));
809 for(i = 16; i < 32; i++) {
810 data = table[i] << sf;
811 for(k = 0; k < 3; k++)
812 SiS_SetRegByte(SiS_Pr, DACData, data);
815 for(m = 0; m < 9; m++) {
818 for(n = 0; n < 3; n++) {
819 for(o = 0; o < 5; o++) {
820 SiS_WriteDAC(SiS_Pr, DACData, sf, n,
821 table[di], table[bx], table[si]);
825 for(o = 0; o < 3; o++) {
826 SiS_WriteDAC(SiS_Pr, DACData, sf, n,
827 table[di], table[si], table[bx]);
836 /*********************************************/
837 /* SET CRT1 REGISTER GROUP */
838 /*********************************************/
841 SiS_SetCRT1Group(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
842 unsigned short ModeIdIndex)
844 unsigned short StandTableIndex, rrti;
846 SiS_Pr->SiS_CRT1Mode = ModeNo;
853 SiS_ResetSegmentRegisters(SiS_Pr);
854 SiS_SetSeqRegs(SiS_Pr, StandTableIndex);
855 SiS_SetMiscRegs(SiS_Pr, StandTableIndex);
856 SiS_SetCRTCRegs(SiS_Pr, StandTableIndex);
857 SiS_SetATTRegs(SiS_Pr, StandTableIndex);
858 SiS_SetGRCRegs(SiS_Pr, StandTableIndex);
859 SiS_ClearExt1Regs(SiS_Pr, ModeNo);
861 rrti = SiS_GetRatePtr(SiS_Pr, ModeNo, ModeIdIndex);
863 if (rrti != 0xFFFF) {
864 SiS_SetCRT1Sync(SiS_Pr, rrti);
865 SiS_SetCRT1CRTC(SiS_Pr, ModeNo, ModeIdIndex, rrti);
866 SiS_SetCRT1Offset(SiS_Pr, ModeNo, ModeIdIndex, rrti);
867 SiS_SetCRT1VCLK(SiS_Pr, ModeNo, rrti);
870 SiS_SetCRT1FIFO_310(SiS_Pr, ModeNo, ModeIdIndex);
872 SiS_SetCRT1ModeRegs(SiS_Pr, ModeNo, ModeIdIndex, rrti);
874 SiS_LoadDAC(SiS_Pr, ModeNo, ModeIdIndex);
876 SiS_DisplayOn(SiS_Pr);
879 /*********************************************/
881 /*********************************************/
884 SiSUSBSetMode(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
886 unsigned short ModeIdIndex;
887 unsigned long BaseAddr = SiS_Pr->IOAddress;
889 SiSUSB_InitPtr(SiS_Pr);
890 SiSUSBRegInit(SiS_Pr, BaseAddr);
891 SiS_GetSysFlags(SiS_Pr);
893 if (!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex)))
896 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x05, 0x86);
898 SiSInitPCIetc(SiS_Pr);
902 SiS_Pr->SiS_ModeType =
903 SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag & ModeTypeMask;
905 SiS_Pr->SiS_SetFlag = LowModeTests;
907 /* Set mode on CRT1 */
908 SiS_SetCRT1Group(SiS_Pr, ModeNo, ModeIdIndex);
910 SiS_HandleCRT1(SiS_Pr);
912 SiS_DisplayOn(SiS_Pr);
913 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c6, 0xFF);
915 /* Store mode number */
916 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x34, ModeNo);
922 SiSUSBSetVESAMode(struct SiS_Private *SiS_Pr, unsigned short VModeNo)
924 unsigned short ModeNo = 0;
927 SiSUSB_InitPtr(SiS_Pr);
929 if (VModeNo == 0x03) {
938 if (SiS_Pr->SiS_EModeIDTable[i].Ext_VESAID == VModeNo) {
939 ModeNo = SiS_Pr->SiS_EModeIDTable[i].Ext_ModeID;
943 } while (SiS_Pr->SiS_EModeIDTable[i++].Ext_ModeID != 0xff);
950 return SiSUSBSetMode(SiS_Pr, ModeNo);
953 #endif /* INCL_SISUSB_CON */