Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
initextlfb.c
Go to the documentation of this file.
1 /*
2  * SiS 300/540/630[S]/730[S]
3  * SiS 315[E|PRO]/550/[M]65x/[M]66x[F|M|G]X/[M]74x[GX]/330/[M]76x[GX]
4  * XGI V3XT/V5/V8, Z7
5  * frame buffer driver for Linux kernels >= 2.4.14 and >=2.6.3
6  *
7  * Linux kernel specific extensions to init.c/init301.c
8  *
9  * Copyright (C) 2001-2005 Thomas Winischhofer, Vienna, Austria.
10  *
11  * This program is free software; you can redistribute it and/or modify
12  * it under the terms of the GNU General Public License as published by
13  * the Free Software Foundation; either version 2 of the named License,
14  * or any later version.
15  *
16  * This program is distributed in the hope that it will be useful,
17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19  * GNU General Public License for more details.
20  *
21  * You should have received a copy of the GNU General Public License
22  * along with this program; if not, write to the Free Software
23  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
24  *
25  * Author: Thomas Winischhofer <[email protected]>
26  */
27 
28 #include "initdef.h"
29 #include "vgatypes.h"
30 #include "vstruct.h"
31 
32 #include <linux/types.h>
33 #include <linux/fb.h>
34 
35 int sisfb_mode_rate_to_dclock(struct SiS_Private *SiS_Pr,
36  unsigned char modeno, unsigned char rateindex);
37 int sisfb_mode_rate_to_ddata(struct SiS_Private *SiS_Pr, unsigned char modeno,
38  unsigned char rateindex, struct fb_var_screeninfo *var);
39 bool sisfb_gettotalfrommode(struct SiS_Private *SiS_Pr, unsigned char modeno,
40  int *htotal, int *vtotal, unsigned char rateindex);
41 
42 extern bool SiSInitPtr(struct SiS_Private *SiS_Pr);
43 extern bool SiS_SearchModeID(struct SiS_Private *SiS_Pr, unsigned short *ModeNo,
44  unsigned short *ModeIdIndex);
45 extern void SiS_Generic_ConvertCRData(struct SiS_Private *SiS_Pr, unsigned char *crdata,
46  int xres, int yres, struct fb_var_screeninfo *var, bool writeres);
47 
48 int
49 sisfb_mode_rate_to_dclock(struct SiS_Private *SiS_Pr, unsigned char modeno,
50  unsigned char rateindex)
51 {
52  unsigned short ModeNo = modeno;
53  unsigned short ModeIdIndex = 0, ClockIndex = 0;
54  unsigned short RRTI = 0;
55  int Clock;
56 
57  if(!SiSInitPtr(SiS_Pr)) return 65000;
58 
59  if(rateindex > 0) rateindex--;
60 
61 #ifdef CONFIG_FB_SIS_315
62  switch(ModeNo) {
63  case 0x5a: ModeNo = 0x50; break;
64  case 0x5b: ModeNo = 0x56;
65  }
66 #endif
67 
68  if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) {
69  printk(KERN_ERR "Could not find mode %x\n", ModeNo);
70  return 65000;
71  }
72 
73  RRTI = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].REFindex;
74 
75  if(SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag & HaveWideTiming) {
76  if(SiS_Pr->SiS_UseWide == 1) {
77  /* Wide screen: Ignore rateindex */
78  ClockIndex = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRTVCLK_WIDE;
79  } else {
80  RRTI += rateindex;
81  ClockIndex = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRTVCLK_NORM;
82  }
83  } else {
84  RRTI += rateindex;
85  ClockIndex = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRTVCLK;
86  }
87 
88  Clock = SiS_Pr->SiS_VCLKData[ClockIndex].CLOCK * 1000;
89 
90  return Clock;
91 }
92 
93 int
94 sisfb_mode_rate_to_ddata(struct SiS_Private *SiS_Pr, unsigned char modeno,
95  unsigned char rateindex, struct fb_var_screeninfo *var)
96 {
97  unsigned short ModeNo = modeno;
98  unsigned short ModeIdIndex = 0, index = 0, RRTI = 0;
99  int j;
100 
101  if(!SiSInitPtr(SiS_Pr)) return 0;
102 
103  if(rateindex > 0) rateindex--;
104 
105 #ifdef CONFIG_FB_SIS_315
106  switch(ModeNo) {
107  case 0x5a: ModeNo = 0x50; break;
108  case 0x5b: ModeNo = 0x56;
109  }
110 #endif
111 
112  if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) return 0;
113 
114  RRTI = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].REFindex;
115  if(SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag & HaveWideTiming) {
116  if(SiS_Pr->SiS_UseWide == 1) {
117  /* Wide screen: Ignore rateindex */
118  index = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRT1CRTC_WIDE;
119  } else {
120  RRTI += rateindex;
121  index = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRT1CRTC_NORM;
122  }
123  } else {
124  RRTI += rateindex;
125  index = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRT1CRTC;
126  }
127 
129  (unsigned char *)&SiS_Pr->SiS_CRT1Table[index].CR[0],
130  SiS_Pr->SiS_RefIndex[RRTI].XRes,
131  SiS_Pr->SiS_RefIndex[RRTI].YRes,
132  var, false);
133 
134  if(SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag & 0x8000)
135  var->sync &= ~FB_SYNC_VERT_HIGH_ACT;
136  else
137  var->sync |= FB_SYNC_VERT_HIGH_ACT;
138 
139  if(SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag & 0x4000)
140  var->sync &= ~FB_SYNC_HOR_HIGH_ACT;
141  else
142  var->sync |= FB_SYNC_HOR_HIGH_ACT;
143 
145  if(SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag & 0x0080)
146  var->vmode = FB_VMODE_INTERLACED;
147  else {
148  j = 0;
149  while(SiS_Pr->SiS_EModeIDTable[j].Ext_ModeID != 0xff) {
150  if(SiS_Pr->SiS_EModeIDTable[j].Ext_ModeID ==
151  SiS_Pr->SiS_RefIndex[RRTI].ModeID) {
152  if(SiS_Pr->SiS_EModeIDTable[j].Ext_ModeFlag & DoubleScanMode) {
153  var->vmode = FB_VMODE_DOUBLE;
154  }
155  break;
156  }
157  j++;
158  }
159  }
160 
161  if((var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED) {
162 #if 0 /* Do this? */
163  var->upper_margin <<= 1;
164  var->lower_margin <<= 1;
165  var->vsync_len <<= 1;
166 #endif
167  } else if((var->vmode & FB_VMODE_MASK) == FB_VMODE_DOUBLE) {
168  var->upper_margin >>= 1;
169  var->lower_margin >>= 1;
170  var->vsync_len >>= 1;
171  }
172 
173  return 1;
174 }
175 
176 bool
177 sisfb_gettotalfrommode(struct SiS_Private *SiS_Pr, unsigned char modeno, int *htotal,
178  int *vtotal, unsigned char rateindex)
179 {
180  unsigned short ModeNo = modeno;
181  unsigned short ModeIdIndex = 0, CRT1Index = 0;
182  unsigned short RRTI = 0;
183  unsigned char sr_data, cr_data, cr_data2;
184 
185  if(!SiSInitPtr(SiS_Pr)) return false;
186 
187  if(rateindex > 0) rateindex--;
188 
189 #ifdef CONFIG_FB_SIS_315
190  switch(ModeNo) {
191  case 0x5a: ModeNo = 0x50; break;
192  case 0x5b: ModeNo = 0x56;
193  }
194 #endif
195 
196  if(!(SiS_SearchModeID(SiS_Pr, &ModeNo, &ModeIdIndex))) return false;
197 
198  RRTI = SiS_Pr->SiS_EModeIDTable[ModeIdIndex].REFindex;
199  if(SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag & HaveWideTiming) {
200  if(SiS_Pr->SiS_UseWide == 1) {
201  /* Wide screen: Ignore rateindex */
202  CRT1Index = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRT1CRTC_WIDE;
203  } else {
204  RRTI += rateindex;
205  CRT1Index = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRT1CRTC_NORM;
206  }
207  } else {
208  RRTI += rateindex;
209  CRT1Index = SiS_Pr->SiS_RefIndex[RRTI].Ext_CRT1CRTC;
210  }
211 
212  sr_data = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[14];
213  cr_data = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[0];
214  *htotal = (((cr_data & 0xff) | ((unsigned short) (sr_data & 0x03) << 8)) + 5) * 8;
215 
216  sr_data = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[13];
217  cr_data = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[6];
218  cr_data2 = SiS_Pr->SiS_CRT1Table[CRT1Index].CR[7];
219  *vtotal = ((cr_data & 0xFF) |
220  ((unsigned short)(cr_data2 & 0x01) << 8) |
221  ((unsigned short)(cr_data2 & 0x20) << 4) |
222  ((unsigned short)(sr_data & 0x01) << 10)) + 2;
223 
224  if(SiS_Pr->SiS_RefIndex[RRTI].Ext_InfoFlag & InterlaceMode)
225  *vtotal *= 2;
226 
227  return true;
228 }
229 
230 
231