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/config.h>
40 #include <linux/module.h>
41 #include <linux/kernel.h>
42 #include <linux/errno.h>
43 #include <linux/poll.h>
44 #include <linux/init.h>
45 #include <linux/slab.h>
46 #include <linux/spinlock.h>
47 #include <linux/kref.h>
51 #ifdef INCL_SISUSB_CON
53 #include "sisusb_init.h"
55 /*********************************************/
56 /* POINTER INITIALIZATION */
57 /*********************************************/
60 SiSUSB_InitPtr(struct SiS_Private *SiS_Pr)
62 SiS_Pr->SiS_ModeResInfo = SiSUSB_ModeResInfo;
63 SiS_Pr->SiS_StandTable = SiSUSB_StandTable;
65 SiS_Pr->SiS_SModeIDTable = SiSUSB_SModeIDTable;
66 SiS_Pr->SiS_EModeIDTable = SiSUSB_EModeIDTable;
67 SiS_Pr->SiS_RefIndex = SiSUSB_RefIndex;
68 SiS_Pr->SiS_CRT1Table = SiSUSB_CRT1Table;
70 SiS_Pr->SiS_VCLKData = SiSUSB_VCLKData;
73 /*********************************************/
74 /* HELPER: Get ModeID */
75 /*********************************************/
79 SiSUSB_GetModeID(int HDisplay, int VDisplay, int Depth)
81 unsigned short ModeIndex = 0;
87 ModeIndex = ModeIndex_320x200[Depth];
88 else if (VDisplay == 240)
89 ModeIndex = ModeIndex_320x240[Depth];
93 ModeIndex = ModeIndex_400x300[Depth];
97 ModeIndex = ModeIndex_512x384[Depth];
101 ModeIndex = ModeIndex_640x480[Depth];
102 else if (VDisplay == 400)
103 ModeIndex = ModeIndex_640x400[Depth];
107 ModeIndex = ModeIndex_720x480[Depth];
108 else if (VDisplay == 576)
109 ModeIndex = ModeIndex_720x576[Depth];
113 ModeIndex = ModeIndex_768x576[Depth];
117 ModeIndex = ModeIndex_800x600[Depth];
118 else if (VDisplay == 480)
119 ModeIndex = ModeIndex_800x480[Depth];
123 ModeIndex = ModeIndex_848x480[Depth];
127 ModeIndex = ModeIndex_856x480[Depth];
131 ModeIndex = ModeIndex_960x540[Depth];
132 else if (VDisplay == 600)
133 ModeIndex = ModeIndex_960x600[Depth];
137 ModeIndex = ModeIndex_1024x576[Depth];
138 else if (VDisplay == 768)
139 ModeIndex = ModeIndex_1024x768[Depth];
143 ModeIndex = ModeIndex_1152x864[Depth];
148 ModeIndex = ModeIndex_1280x720[Depth];
151 ModeIndex = ModeIndex_1280x768[Depth];
154 ModeIndex = ModeIndex_1280x1024[Depth];
163 /*********************************************/
164 /* HELPER: SetReg, GetReg */
165 /*********************************************/
168 SiS_SetReg(struct SiS_Private *SiS_Pr, unsigned long port,
169 unsigned short index, unsigned short data)
171 sisusb_setidxreg(SiS_Pr->sisusb, port, index, data);
175 SiS_SetRegByte(struct SiS_Private *SiS_Pr, unsigned long port,
178 sisusb_setreg(SiS_Pr->sisusb, port, data);
182 SiS_GetReg(struct SiS_Private *SiS_Pr, unsigned long port,
183 unsigned short index)
187 sisusb_getidxreg(SiS_Pr->sisusb, port, index, &data);
193 SiS_GetRegByte(struct SiS_Private *SiS_Pr, unsigned long port)
197 sisusb_getreg(SiS_Pr->sisusb, port, &data);
203 SiS_SetRegANDOR(struct SiS_Private *SiS_Pr, unsigned long port,
204 unsigned short index, unsigned short DataAND,
205 unsigned short DataOR)
207 sisusb_setidxregandor(SiS_Pr->sisusb, port, index, DataAND, DataOR);
211 SiS_SetRegAND(struct SiS_Private *SiS_Pr, unsigned long port,
212 unsigned short index, unsigned short DataAND)
214 sisusb_setidxregand(SiS_Pr->sisusb, port, index, DataAND);
218 SiS_SetRegOR(struct SiS_Private *SiS_Pr,unsigned long port,
219 unsigned short index, unsigned short DataOR)
221 sisusb_setidxregor(SiS_Pr->sisusb, port, index, DataOR);
224 /*********************************************/
225 /* HELPER: DisplayOn, DisplayOff */
226 /*********************************************/
229 SiS_DisplayOn(struct SiS_Private *SiS_Pr)
231 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x01, 0xDF);
234 /*********************************************/
235 /* HELPER: Init Port Addresses */
236 /*********************************************/
239 SiSUSBRegInit(struct SiS_Private *SiS_Pr, unsigned long BaseAddr)
241 SiS_Pr->SiS_P3c4 = BaseAddr + 0x14;
242 SiS_Pr->SiS_P3d4 = BaseAddr + 0x24;
243 SiS_Pr->SiS_P3c0 = BaseAddr + 0x10;
244 SiS_Pr->SiS_P3ce = BaseAddr + 0x1e;
245 SiS_Pr->SiS_P3c2 = BaseAddr + 0x12;
246 SiS_Pr->SiS_P3ca = BaseAddr + 0x1a;
247 SiS_Pr->SiS_P3c6 = BaseAddr + 0x16;
248 SiS_Pr->SiS_P3c7 = BaseAddr + 0x17;
249 SiS_Pr->SiS_P3c8 = BaseAddr + 0x18;
250 SiS_Pr->SiS_P3c9 = BaseAddr + 0x19;
251 SiS_Pr->SiS_P3cb = BaseAddr + 0x1b;
252 SiS_Pr->SiS_P3cc = BaseAddr + 0x1c;
253 SiS_Pr->SiS_P3cd = BaseAddr + 0x1d;
254 SiS_Pr->SiS_P3da = BaseAddr + 0x2a;
255 SiS_Pr->SiS_Part1Port = BaseAddr + SIS_CRT2_PORT_04;
258 /*********************************************/
259 /* HELPER: GetSysFlags */
260 /*********************************************/
263 SiS_GetSysFlags(struct SiS_Private *SiS_Pr)
265 SiS_Pr->SiS_MyCR63 = 0x63;
268 /*********************************************/
269 /* HELPER: Init PCI & Engines */
270 /*********************************************/
273 SiSInitPCIetc(struct SiS_Private *SiS_Pr)
275 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x20, 0xa1);
276 /* - Enable 2D (0x40)
278 * - Enable 3D vertex command fetch (0x10)
279 * - Enable 3D command parser (0x08)
280 * - Enable 3D G/L transformation engine (0x80)
282 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1E, 0xDA);
285 /*********************************************/
286 /* HELPER: SET SEGMENT REGISTERS */
287 /*********************************************/
290 SiS_SetSegRegLower(struct SiS_Private *SiS_Pr, unsigned short value)
295 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb) & 0xf0;
296 temp |= (value >> 4);
297 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb, temp);
298 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd) & 0xf0;
299 temp |= (value & 0x0f);
300 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd, temp);
304 SiS_SetSegRegUpper(struct SiS_Private *SiS_Pr, unsigned short value)
309 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb) & 0x0f;
310 temp |= (value & 0xf0);
311 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cb, temp);
312 temp = SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd) & 0x0f;
313 temp |= (value << 4);
314 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3cd, temp);
318 SiS_SetSegmentReg(struct SiS_Private *SiS_Pr, unsigned short value)
320 SiS_SetSegRegLower(SiS_Pr, value);
321 SiS_SetSegRegUpper(SiS_Pr, value);
325 SiS_ResetSegmentReg(struct SiS_Private *SiS_Pr)
327 SiS_SetSegmentReg(SiS_Pr, 0);
331 SiS_SetSegmentRegOver(struct SiS_Private *SiS_Pr, unsigned short value)
333 unsigned short temp = value >> 8;
337 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1d, temp);
338 SiS_SetSegmentReg(SiS_Pr, value);
342 SiS_ResetSegmentRegOver(struct SiS_Private *SiS_Pr)
344 SiS_SetSegmentRegOver(SiS_Pr, 0);
348 SiS_ResetSegmentRegisters(struct SiS_Private *SiS_Pr)
350 SiS_ResetSegmentReg(SiS_Pr);
351 SiS_ResetSegmentRegOver(SiS_Pr);
354 /*********************************************/
355 /* HELPER: SearchModeID */
356 /*********************************************/
359 SiS_SearchModeID(struct SiS_Private *SiS_Pr, unsigned short *ModeNo,
360 unsigned short *ModeIdIndex)
362 if ((*ModeNo) <= 0x13) {
364 if ((*ModeNo) != 0x03)
371 for(*ModeIdIndex = 0; ;(*ModeIdIndex)++) {
373 if (SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == (*ModeNo))
376 if (SiS_Pr->SiS_EModeIDTable[*ModeIdIndex].Ext_ModeID == 0xFF)
385 /*********************************************/
386 /* HELPER: ENABLE CRT1 */
387 /*********************************************/
390 SiS_HandleCRT1(struct SiS_Private *SiS_Pr)
392 /* Enable CRT1 gating */
393 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3d4, SiS_Pr->SiS_MyCR63, 0xbf);
396 /*********************************************/
397 /* HELPER: GetColorDepth */
398 /*********************************************/
400 static unsigned short
401 SiS_GetColorDepth(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
402 unsigned short ModeIdIndex)
404 static const unsigned short ColorDepth[6] = { 1, 2, 4, 4, 6, 8};
405 unsigned short modeflag;
408 if (ModeNo <= 0x13) {
409 modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
411 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
414 index = (modeflag & ModeTypeMask) - ModeEGA;
415 if (index < 0) index = 0;
416 return ColorDepth[index];
419 /*********************************************/
420 /* HELPER: GetOffset */
421 /*********************************************/
423 static unsigned short
424 SiS_GetOffset(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
425 unsigned short ModeIdIndex, unsigned short rrti)
427 unsigned short xres, temp, colordepth, infoflag;
429 infoflag = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag;
430 xres = SiS_Pr->SiS_RefIndex[rrti].XRes;
432 colordepth = SiS_GetColorDepth(SiS_Pr, ModeNo, ModeIdIndex);
436 if (infoflag & InterlaceMode)
442 temp += (colordepth >> 1);
447 /*********************************************/
449 /*********************************************/
452 SiS_SetSeqRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
454 unsigned char SRdata;
457 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x00, 0x03);
459 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[0] | 0x20;
460 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x01, SRdata);
462 for(i = 2; i <= 4; i++) {
463 SRdata = SiS_Pr->SiS_StandTable[StandTableIndex].SR[i-1];
464 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, i, SRdata);
468 /*********************************************/
470 /*********************************************/
473 SiS_SetMiscRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
475 unsigned char Miscdata = SiS_Pr->SiS_StandTable[StandTableIndex].MISC;
477 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c2, Miscdata);
480 /*********************************************/
482 /*********************************************/
485 SiS_SetCRTCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
487 unsigned char CRTCdata;
490 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3d4, 0x11, 0x7f);
492 for(i = 0; i <= 0x18; i++) {
493 CRTCdata = SiS_Pr->SiS_StandTable[StandTableIndex].CRTC[i];
494 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, i, CRTCdata);
498 /*********************************************/
500 /*********************************************/
503 SiS_SetATTRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
505 unsigned char ARdata;
508 for(i = 0; i <= 0x13; i++) {
509 ARdata = SiS_Pr->SiS_StandTable[StandTableIndex].ATTR[i];
510 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
511 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, i);
512 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, ARdata);
514 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
515 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, 0x14);
516 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, 0x00);
518 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
519 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c0, 0x20);
520 SiS_GetRegByte(SiS_Pr, SiS_Pr->SiS_P3da);
523 /*********************************************/
525 /*********************************************/
528 SiS_SetGRCRegs(struct SiS_Private *SiS_Pr, unsigned short StandTableIndex)
530 unsigned char GRdata;
533 for(i = 0; i <= 0x08; i++) {
534 GRdata = SiS_Pr->SiS_StandTable[StandTableIndex].GRC[i];
535 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3ce, i, GRdata);
538 if (SiS_Pr->SiS_ModeType > ModeVGA) {
539 /* 256 color disable */
540 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3ce, 0x05, 0xBF);
544 /*********************************************/
545 /* CLEAR EXTENDED REGISTERS */
546 /*********************************************/
549 SiS_ClearExt1Regs(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
553 for(i = 0x0A; i <= 0x0E; i++) {
554 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, i, 0x00);
557 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x37, 0xFE);
560 /*********************************************/
562 /*********************************************/
564 static unsigned short
565 SiS_GetRatePtr(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
566 unsigned short ModeIdIndex)
568 unsigned short rrti, i, index, temp;
573 index = SiS_GetReg(SiS_Pr,SiS_Pr->SiS_P3d4, 0x33) & 0x0F;
574 if (index > 0) index--;
576 rrti = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].REFindex;
577 ModeNo = SiS_Pr->SiS_RefIndex[rrti].ModeID;
581 if (SiS_Pr->SiS_RefIndex[rrti + i].ModeID != ModeNo)
584 temp = SiS_Pr->SiS_RefIndex[rrti + i].Ext_InfoFlag & ModeTypeMask;
585 if (temp < SiS_Pr->SiS_ModeType)
590 } while(index != 0xFFFF);
597 /*********************************************/
599 /*********************************************/
602 SiS_SetCRT1Sync(struct SiS_Private *SiS_Pr, unsigned short rrti)
604 unsigned short sync = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag >> 8;
607 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c2, sync);
610 /*********************************************/
612 /*********************************************/
615 SiS_SetCRT1CRTC(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
616 unsigned short ModeIdIndex, unsigned short rrti)
619 unsigned short temp, i, j, modeflag;
621 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3d4,0x11,0x7f);
623 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
625 index = SiS_Pr->SiS_RefIndex[rrti].Ext_CRT1CRTC;
627 for(i = 0,j = 0; i <= 7; i++, j++) {
628 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, j,
629 SiS_Pr->SiS_CRT1Table[index].CR[i]);
631 for(j = 0x10; i <= 10; i++, j++) {
632 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, j,
633 SiS_Pr->SiS_CRT1Table[index].CR[i]);
635 for(j = 0x15; i <= 12; i++, j++) {
636 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, j,
637 SiS_Pr->SiS_CRT1Table[index].CR[i]);
639 for(j = 0x0A; i <= 15; i++, j++) {
640 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, j,
641 SiS_Pr->SiS_CRT1Table[index].CR[i]);
644 temp = SiS_Pr->SiS_CRT1Table[index].CR[16] & 0xE0;
645 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4, 0x0E, temp);
647 temp = ((SiS_Pr->SiS_CRT1Table[index].CR[16]) & 0x01) << 5;
648 if (modeflag & DoubleScanMode) temp |= 0x80;
649 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3d4, 0x09, 0x5F, temp);
651 if (SiS_Pr->SiS_ModeType > ModeVGA)
652 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x14, 0x4F);
655 /*********************************************/
657 /*********************************************/
658 /* (partly overruled by SetPitch() in XF86) */
659 /*********************************************/
662 SiS_SetCRT1Offset(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
663 unsigned short ModeIdIndex, unsigned short rrti)
665 unsigned short du = SiS_GetOffset(SiS_Pr, ModeNo, ModeIdIndex, rrti);
666 unsigned short infoflag = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag;
669 temp = (du >> 8) & 0x0f;
670 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0E, 0xF0, temp);
672 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x13, (du & 0xFF));
674 if (infoflag & InterlaceMode) du >>= 1;
677 temp = (du >> 8) & 0xff;
678 if (du & 0xff) temp++;
680 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x10, temp);
683 /*********************************************/
685 /*********************************************/
688 SiS_SetCRT1VCLK(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
691 unsigned short index = SiS_Pr->SiS_RefIndex[rrti].Ext_CRTVCLK;
692 unsigned short clka = SiS_Pr->SiS_VCLKData[index].SR2B;
693 unsigned short clkb = SiS_Pr->SiS_VCLKData[index].SR2C;
695 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4,0x31,0xCF);
697 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4,0x2B,clka);
698 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4,0x2C,clkb);
699 SiS_SetReg(SiS_Pr,SiS_Pr->SiS_P3c4,0x2D,0x01);
702 /*********************************************/
704 /*********************************************/
707 SiS_SetCRT1FIFO_310(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
710 unsigned short modeflag = SiS_Pr->SiS_EModeIDTable[mi].Ext_ModeFlag;
712 /* disable auto-threshold */
713 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x3D, 0xFE);
715 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x08, 0xAE);
716 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x09, 0xF0);
721 if ((!(modeflag & DoubleScanMode)) || (!(modeflag & HalfDCLK))) {
722 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x08, 0x34);
723 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x3D, 0x01);
727 /*********************************************/
729 /*********************************************/
732 SiS_SetVCLKState(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
735 unsigned short data = 0, VCLK = 0, index = 0;
738 index = SiS_Pr->SiS_RefIndex[rrti].Ext_CRTVCLK;
739 VCLK = SiS_Pr->SiS_VCLKData[index].CLOCK;
742 if (VCLK >= 166) data |= 0x0c;
743 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x32, 0xf3, data);
746 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1f, 0xe7);
752 else if (VCLK >= 160)
754 else if (VCLK >= 135)
757 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x07, 0xF8, data);
761 SiS_SetCRT1ModeRegs(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
762 unsigned short ModeIdIndex, unsigned short rrti)
764 unsigned short data, infoflag = 0, modeflag;
767 modeflag = SiS_Pr->SiS_SModeIDTable[ModeIdIndex].St_ModeFlag;
769 modeflag = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag;
770 infoflag = SiS_Pr->SiS_RefIndex[rrti].Ext_InfoFlag;
774 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x1F, 0x3F);
778 if (SiS_Pr->SiS_ModeType > ModeEGA) {
780 data |= ((SiS_Pr->SiS_ModeType - ModeVGA) << 2);
782 if (infoflag & InterlaceMode) data |= 0x20;
784 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x06, 0xC0, data);
787 if (infoflag & InterlaceMode) {
788 /* data = (Hsync / 8) - ((Htotal / 8) / 2) + 3 */
789 unsigned short hrs = (SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x04) |
790 ((SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0b) & 0xc0) << 2)) - 3;
791 unsigned short hto = (SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x00) |
792 ((SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0b) & 0x03) << 8)) + 5;
793 data = hrs - (hto >> 1) + 3;
795 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x19, (data & 0xFF));
796 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3d4, 0x1a, 0xFC, (data >> 8));
798 if (modeflag & HalfDCLK)
799 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x01, 0x08);
802 if (modeflag & LineCompareOff)
804 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0F, 0xB7, data);
806 if ((SiS_Pr->SiS_ModeType == ModeEGA) && (ModeNo > 0x13))
807 SiS_SetRegOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x0F, 0x40);
809 SiS_SetRegAND(SiS_Pr, SiS_Pr->SiS_P3c4, 0x31, 0xfb);
812 if (SiS_Pr->SiS_ModeType != ModeText) {
814 if (SiS_Pr->SiS_ModeType != ModeEGA)
817 SiS_SetRegANDOR(SiS_Pr, SiS_Pr->SiS_P3c4, 0x21, 0x1F, data);
819 SiS_SetVCLKState(SiS_Pr, ModeNo, rrti);
821 if (SiS_GetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x31) & 0x40)
822 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x52, 0x2c);
824 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x52, 0x6c);
827 /*********************************************/
829 /*********************************************/
832 SiS_WriteDAC(struct SiS_Private *SiS_Pr, unsigned long DACData,
833 unsigned short shiftflag, unsigned short dl, unsigned short ah,
834 unsigned short al, unsigned short dh)
836 unsigned short d1, d2, d3;
840 d1 = dh; d2 = ah; d3 = al;
843 d1 = ah; d2 = al; d3 = dh;
846 d1 = al; d2 = dh; d3 = ah;
848 SiS_SetRegByte(SiS_Pr, DACData, (d1 << shiftflag));
849 SiS_SetRegByte(SiS_Pr, DACData, (d2 << shiftflag));
850 SiS_SetRegByte(SiS_Pr, DACData, (d3 << shiftflag));
854 SiS_LoadDAC(struct SiS_Private *SiS_Pr, unsigned short ModeNo, unsigned short mi)
856 unsigned short data, data2, time, i, j, k, m, n, o;
857 unsigned short si, di, bx, sf;
858 unsigned long DACAddr, DACData;
859 const unsigned char *table = NULL;
862 data = SiS_Pr->SiS_SModeIDTable[mi].St_ModeFlag;
864 data = SiS_Pr->SiS_EModeIDTable[mi].Ext_ModeFlag;
871 else if (data == 0x08)
873 else if (data == 0x10)
881 DACAddr = SiS_Pr->SiS_P3c8;
882 DACData = SiS_Pr->SiS_P3c9;
884 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c6, 0xFF);
886 SiS_SetRegByte(SiS_Pr, DACAddr, 0x00);
888 for(i = 0; i < j; i++) {
890 for(k = 0; k < 3; k++) {
892 if (data & 0x01) data2 += 0x2A;
893 if (data & 0x02) data2 += 0x15;
894 SiS_SetRegByte(SiS_Pr, DACData, (data2 << sf));
900 for(i = 16; i < 32; i++) {
901 data = table[i] << sf;
902 for(k = 0; k < 3; k++)
903 SiS_SetRegByte(SiS_Pr, DACData, data);
906 for(m = 0; m < 9; m++) {
909 for(n = 0; n < 3; n++) {
910 for(o = 0; o < 5; o++) {
911 SiS_WriteDAC(SiS_Pr, DACData, sf, n,
912 table[di], table[bx], table[si]);
916 for(o = 0; o < 3; o++) {
917 SiS_WriteDAC(SiS_Pr, DACData, sf, n,
918 table[di], table[si], table[bx]);
927 /*********************************************/
928 /* SET CRT1 REGISTER GROUP */
929 /*********************************************/
932 SiS_SetCRT1Group(struct SiS_Private *SiS_Pr, unsigned short ModeNo,
933 unsigned short ModeIdIndex)
935 unsigned short StandTableIndex, rrti;
937 SiS_Pr->SiS_CRT1Mode = ModeNo;
944 SiS_ResetSegmentRegisters(SiS_Pr);
945 SiS_SetSeqRegs(SiS_Pr, StandTableIndex);
946 SiS_SetMiscRegs(SiS_Pr, StandTableIndex);
947 SiS_SetCRTCRegs(SiS_Pr, StandTableIndex);
948 SiS_SetATTRegs(SiS_Pr, StandTableIndex);
949 SiS_SetGRCRegs(SiS_Pr, StandTableIndex);
950 SiS_ClearExt1Regs(SiS_Pr, ModeNo);
952 rrti = SiS_GetRatePtr(SiS_Pr, ModeNo, ModeIdIndex);
954 if (rrti != 0xFFFF) {
955 SiS_SetCRT1Sync(SiS_Pr, rrti);
956 SiS_SetCRT1CRTC(SiS_Pr, ModeNo, ModeIdIndex, rrti);
957 SiS_SetCRT1Offset(SiS_Pr, ModeNo, ModeIdIndex, rrti);
958 SiS_SetCRT1VCLK(SiS_Pr, ModeNo, rrti);
961 SiS_SetCRT1FIFO_310(SiS_Pr, ModeNo, ModeIdIndex);
963 SiS_SetCRT1ModeRegs(SiS_Pr, ModeNo, ModeIdIndex, rrti);
965 SiS_LoadDAC(SiS_Pr, ModeNo, ModeIdIndex);
967 SiS_DisplayOn(SiS_Pr);
970 /*********************************************/
972 /*********************************************/
975 SiSUSBSetMode(struct SiS_Private *SiS_Pr, unsigned short ModeNo)
977 unsigned short ModeIdIndex;
978 unsigned long BaseAddr = SiS_Pr->IOAddress;
980 SiSUSB_InitPtr(SiS_Pr);
981 SiSUSBRegInit(SiS_Pr, BaseAddr);
982 SiS_GetSysFlags(SiS_Pr);
984 if (!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex)))
987 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3c4, 0x05, 0x86);
989 SiSInitPCIetc(SiS_Pr);
993 SiS_Pr->SiS_ModeType =
994 SiS_Pr->SiS_EModeIDTable[ModeIdIndex].Ext_ModeFlag & ModeTypeMask;
996 SiS_Pr->SiS_SetFlag = LowModeTests;
998 /* Set mode on CRT1 */
999 SiS_SetCRT1Group(SiS_Pr, ModeNo, ModeIdIndex);
1001 SiS_HandleCRT1(SiS_Pr);
1003 SiS_DisplayOn(SiS_Pr);
1004 SiS_SetRegByte(SiS_Pr, SiS_Pr->SiS_P3c6, 0xFF);
1006 /* Store mode number */
1007 SiS_SetReg(SiS_Pr, SiS_Pr->SiS_P3d4, 0x34, ModeNo);
1013 SiSUSBSetVESAMode(struct SiS_Private *SiS_Pr, unsigned short VModeNo)
1015 unsigned short ModeNo = 0;
1018 SiSUSB_InitPtr(SiS_Pr);
1020 if (VModeNo == 0x03) {
1029 if (SiS_Pr->SiS_EModeIDTable[i].Ext_VESAID == VModeNo) {
1030 ModeNo = SiS_Pr->SiS_EModeIDTable[i].Ext_ModeID;
1034 } while (SiS_Pr->SiS_EModeIDTable[i++].Ext_ModeID != 0xff);
1041 return SiSUSBSetMode(SiS_Pr, ModeNo);
1044 #endif /* INCL_SISUSB_CON */