kernel/drivers/video/fbdev/sis/initextlfb.c

   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 <thomas@winischhofer.net>
  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
 128     SiS_Generic_ConvertCRData(SiS_Pr,
 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
 144     var->vmode = FB_VMODE_NONINTERLACED;
 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