| /* |
| * SiS 300/540/630[S]/730[S], |
| * SiS 315[E|PRO]/550/[M]65x/[M]66x[F|M|G]X/[M]74x[GX]/330/[M]76x[GX], |
| * XGI V3XT/V5/V8, Z7 |
| * frame buffer driver for Linux kernels >= 2.4.14 and >=2.6.3 |
| * |
| * Copyright (C) 2001-2005 Thomas Winischhofer, Vienna, Austria. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the named License, |
| * or any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA |
| * |
| * Author: Thomas Winischhofer <thomas@winischhofer.net> |
| * |
| * Author of (practically wiped) code base: |
| * SiS (www.sis.com) |
| * Copyright (C) 1999 Silicon Integrated Systems, Inc. |
| * |
| * See http://www.winischhofer.net/ for more information and updates |
| * |
| * Originally based on the VBE 2.0 compliant graphic boards framebuffer driver, |
| * which is (c) 1998 Gerd Knorr <kraxel@goldbach.in-berlin.de> |
| * |
| */ |
| |
| #include <linux/config.h> |
| #include <linux/version.h> |
| #include <linux/module.h> |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| #include <linux/moduleparam.h> |
| #endif |
| #include <linux/kernel.h> |
| #include <linux/smp_lock.h> |
| #include <linux/spinlock.h> |
| #include <linux/errno.h> |
| #include <linux/string.h> |
| #include <linux/mm.h> |
| #include <linux/tty.h> |
| #include <linux/slab.h> |
| #include <linux/fb.h> |
| #include <linux/selection.h> |
| #include <linux/ioport.h> |
| #include <linux/init.h> |
| #include <linux/pci.h> |
| #include <linux/vmalloc.h> |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| #include <linux/vt_kern.h> |
| #endif |
| #include <linux/capability.h> |
| #include <linux/fs.h> |
| #include <linux/types.h> |
| #include <asm/uaccess.h> |
| #include <asm/io.h> |
| #ifdef CONFIG_MTRR |
| #include <asm/mtrr.h> |
| #endif |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| #include <video/fbcon.h> |
| #include <video/fbcon-cfb8.h> |
| #include <video/fbcon-cfb16.h> |
| #include <video/fbcon-cfb24.h> |
| #include <video/fbcon-cfb32.h> |
| #endif |
| |
| #include "sis.h" |
| #include "sis_main.h" |
| |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,3) |
| #error "This version of sisfb requires at least 2.6.3" |
| #endif |
| #endif |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| #ifdef FBCON_HAS_CFB8 |
| extern struct display_switch fbcon_sis8; |
| #endif |
| #ifdef FBCON_HAS_CFB16 |
| extern struct display_switch fbcon_sis16; |
| #endif |
| #ifdef FBCON_HAS_CFB32 |
| extern struct display_switch fbcon_sis32; |
| #endif |
| #endif |
| |
| static void sisfb_handle_command(struct sis_video_info *ivideo, |
| struct sisfb_cmd *sisfb_command); |
| |
| /* ------------------ Internal helper routines ----------------- */ |
| |
| static void __init |
| sisfb_setdefaultparms(void) |
| { |
| sisfb_off = 0; |
| sisfb_parm_mem = 0; |
| sisfb_accel = -1; |
| sisfb_ypan = -1; |
| sisfb_max = -1; |
| sisfb_userom = -1; |
| sisfb_useoem = -1; |
| #ifdef MODULE |
| /* Module: "None" for 2.4, default mode for 2.5+ */ |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| sisfb_mode_idx = -1; |
| #else |
| sisfb_mode_idx = MODE_INDEX_NONE; |
| #endif |
| #else |
| /* Static: Default mode */ |
| sisfb_mode_idx = -1; |
| #endif |
| sisfb_parm_rate = -1; |
| sisfb_crt1off = 0; |
| sisfb_forcecrt1 = -1; |
| sisfb_crt2type = -1; |
| sisfb_crt2flags = 0; |
| sisfb_pdc = 0xff; |
| sisfb_pdca = 0xff; |
| sisfb_scalelcd = -1; |
| sisfb_specialtiming = CUT_NONE; |
| sisfb_lvdshl = -1; |
| sisfb_dstn = 0; |
| sisfb_fstn = 0; |
| sisfb_tvplug = -1; |
| sisfb_tvstd = -1; |
| sisfb_tvxposoffset = 0; |
| sisfb_tvyposoffset = 0; |
| sisfb_nocrt2rate = 0; |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| sisfb_inverse = 0; |
| sisfb_fontname[0] = 0; |
| #endif |
| #if !defined(__i386__) && !defined(__x86_64__) |
| sisfb_resetcard = 0; |
| sisfb_videoram = 0; |
| #endif |
| } |
| |
| /* ------------- Parameter parsing -------------- */ |
| |
| static void __devinit |
| sisfb_search_vesamode(unsigned int vesamode, BOOLEAN quiet) |
| { |
| int i = 0, j = 0; |
| |
| /* We don't know the hardware specs yet and there is no ivideo */ |
| |
| if(vesamode == 0) { |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| sisfb_mode_idx = MODE_INDEX_NONE; |
| #else |
| if(!quiet) |
| printk(KERN_ERR "sisfb: Invalid mode. Using default.\n"); |
| |
| sisfb_mode_idx = DEFAULT_MODE; |
| #endif |
| return; |
| } |
| |
| vesamode &= 0x1dff; /* Clean VESA mode number from other flags */ |
| |
| while(sisbios_mode[i++].mode_no[0] != 0) { |
| if( (sisbios_mode[i-1].vesa_mode_no_1 == vesamode) || |
| (sisbios_mode[i-1].vesa_mode_no_2 == vesamode) ) { |
| if(sisfb_fstn) { |
| if(sisbios_mode[i-1].mode_no[1] == 0x50 || |
| sisbios_mode[i-1].mode_no[1] == 0x56 || |
| sisbios_mode[i-1].mode_no[1] == 0x53) |
| continue; |
| } else { |
| if(sisbios_mode[i-1].mode_no[1] == 0x5a || |
| sisbios_mode[i-1].mode_no[1] == 0x5b) |
| continue; |
| } |
| sisfb_mode_idx = i - 1; |
| j = 1; |
| break; |
| } |
| } |
| if((!j) && !quiet) |
| printk(KERN_ERR "sisfb: Invalid VESA mode 0x%x'\n", vesamode); |
| } |
| |
| static void __devinit |
| sisfb_search_mode(char *name, BOOLEAN quiet) |
| { |
| unsigned int j = 0, xres = 0, yres = 0, depth = 0, rate = 0; |
| int i = 0; |
| char strbuf[16], strbuf1[20]; |
| char *nameptr = name; |
| |
| /* We don't know the hardware specs yet and there is no ivideo */ |
| |
| if(name == NULL) { |
| if(!quiet) |
| printk(KERN_ERR "sisfb: Internal error, using default mode.\n"); |
| |
| sisfb_mode_idx = DEFAULT_MODE; |
| return; |
| } |
| |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| if(!strnicmp(name, sisbios_mode[MODE_INDEX_NONE].name, strlen(name))) { |
| if(!quiet) |
| printk(KERN_ERR "sisfb: Mode 'none' not supported anymore. Using default.\n"); |
| |
| sisfb_mode_idx = DEFAULT_MODE; |
| return; |
| } |
| #endif |
| if(strlen(name) <= 19) { |
| strcpy(strbuf1, name); |
| for(i = 0; i < strlen(strbuf1); i++) { |
| if(strbuf1[i] < '0' || strbuf1[i] > '9') strbuf1[i] = ' '; |
| } |
| |
| /* This does some fuzzy mode naming detection */ |
| if(sscanf(strbuf1, "%u %u %u %u", &xres, &yres, &depth, &rate) == 4) { |
| if((rate <= 32) || (depth > 32)) { |
| j = rate; rate = depth; depth = j; |
| } |
| sprintf(strbuf, "%ux%ux%u", xres, yres, depth); |
| nameptr = strbuf; |
| sisfb_parm_rate = rate; |
| } else if(sscanf(strbuf1, "%u %u %u", &xres, &yres, &depth) == 3) { |
| sprintf(strbuf, "%ux%ux%u", xres, yres, depth); |
| nameptr = strbuf; |
| } else { |
| xres = 0; |
| if((sscanf(strbuf1, "%u %u", &xres, &yres) == 2) && (xres != 0)) { |
| sprintf(strbuf, "%ux%ux8", xres, yres); |
| nameptr = strbuf; |
| } else { |
| sisfb_search_vesamode(simple_strtoul(name, NULL, 0), quiet); |
| return; |
| } |
| } |
| } |
| |
| i = 0; j = 0; |
| while(sisbios_mode[i].mode_no[0] != 0) { |
| if(!strnicmp(nameptr, sisbios_mode[i++].name, strlen(nameptr))) { |
| if(sisfb_fstn) { |
| if(sisbios_mode[i-1].mode_no[1] == 0x50 || |
| sisbios_mode[i-1].mode_no[1] == 0x56 || |
| sisbios_mode[i-1].mode_no[1] == 0x53) |
| continue; |
| } else { |
| if(sisbios_mode[i-1].mode_no[1] == 0x5a || |
| sisbios_mode[i-1].mode_no[1] == 0x5b) |
| continue; |
| } |
| sisfb_mode_idx = i - 1; |
| j = 1; |
| break; |
| } |
| } |
| |
| if((!j) && !quiet) |
| printk(KERN_ERR "sisfb: Invalid mode '%s'\n", nameptr); |
| } |
| |
| #ifndef MODULE |
| static void __devinit |
| sisfb_get_vga_mode_from_kernel(void) |
| { |
| #if (defined(__i386__) || defined(__x86_64__)) && defined(CONFIG_VIDEO_SELECT) |
| char mymode[32]; |
| int mydepth = screen_info.lfb_depth; |
| |
| if(screen_info.orig_video_isVGA != VIDEO_TYPE_VLFB) return; |
| |
| if( (screen_info.lfb_width >= 320) && (screen_info.lfb_width <= 2048) && |
| (screen_info.lfb_height >= 200) && (screen_info.lfb_height <= 1536) && |
| (mydepth >= 8) && (mydepth <= 32) ) { |
| |
| if(mydepth == 24) mydepth = 32; |
| |
| sprintf(mymode, "%ux%ux%u", screen_info.lfb_width, |
| screen_info.lfb_height, |
| mydepth); |
| |
| printk(KERN_DEBUG |
| "sisfb: Using vga mode %s pre-set by kernel as default\n", |
| mymode); |
| |
| sisfb_search_mode(mymode, TRUE); |
| } |
| #endif |
| return; |
| } |
| #endif |
| |
| static void __init |
| sisfb_search_crt2type(const char *name) |
| { |
| int i = 0; |
| |
| /* We don't know the hardware specs yet and there is no ivideo */ |
| |
| if(name == NULL) return; |
| |
| while(sis_crt2type[i].type_no != -1) { |
| if(!strnicmp(name, sis_crt2type[i].name, strlen(sis_crt2type[i].name))) { |
| sisfb_crt2type = sis_crt2type[i].type_no; |
| sisfb_tvplug = sis_crt2type[i].tvplug_no; |
| sisfb_crt2flags = sis_crt2type[i].flags; |
| break; |
| } |
| i++; |
| } |
| |
| sisfb_dstn = (sisfb_crt2flags & FL_550_DSTN) ? 1 : 0; |
| sisfb_fstn = (sisfb_crt2flags & FL_550_FSTN) ? 1 : 0; |
| |
| if(sisfb_crt2type < 0) |
| printk(KERN_ERR "sisfb: Invalid CRT2 type: %s\n", name); |
| } |
| |
| static void __init |
| sisfb_search_tvstd(const char *name) |
| { |
| int i = 0; |
| |
| /* We don't know the hardware specs yet and there is no ivideo */ |
| |
| if(name == NULL) |
| return; |
| |
| while(sis_tvtype[i].type_no != -1) { |
| if(!strnicmp(name, sis_tvtype[i].name, strlen(sis_tvtype[i].name))) { |
| sisfb_tvstd = sis_tvtype[i].type_no; |
| break; |
| } |
| i++; |
| } |
| } |
| |
| static void __init |
| sisfb_search_specialtiming(const char *name) |
| { |
| int i = 0; |
| BOOLEAN found = FALSE; |
| |
| /* We don't know the hardware specs yet and there is no ivideo */ |
| |
| if(name == NULL) |
| return; |
| |
| if(!strnicmp(name, "none", 4)) { |
| sisfb_specialtiming = CUT_FORCENONE; |
| printk(KERN_DEBUG "sisfb: Special timing disabled\n"); |
| } else { |
| while(mycustomttable[i].chipID != 0) { |
| if(!strnicmp(name,mycustomttable[i].optionName, |
| strlen(mycustomttable[i].optionName))) { |
| sisfb_specialtiming = mycustomttable[i].SpecialID; |
| found = TRUE; |
| printk(KERN_INFO "sisfb: Special timing for %s %s forced (\"%s\")\n", |
| mycustomttable[i].vendorName, |
| mycustomttable[i].cardName, |
| mycustomttable[i].optionName); |
| break; |
| } |
| i++; |
| } |
| if(!found) { |
| printk(KERN_WARNING "sisfb: Invalid SpecialTiming parameter, valid are:"); |
| printk(KERN_WARNING "\t\"none\" (to disable special timings)\n"); |
| i = 0; |
| while(mycustomttable[i].chipID != 0) { |
| printk(KERN_WARNING "\t\"%s\" (for %s %s)\n", |
| mycustomttable[i].optionName, |
| mycustomttable[i].vendorName, |
| mycustomttable[i].cardName); |
| i++; |
| } |
| } |
| } |
| } |
| |
| /* ----------- Various detection routines ----------- */ |
| |
| static void __devinit |
| sisfb_detect_custom_timing(struct sis_video_info *ivideo) |
| { |
| unsigned char *biosver = NULL; |
| unsigned char *biosdate = NULL; |
| BOOLEAN footprint; |
| u32 chksum = 0; |
| int i, j; |
| |
| if(ivideo->SiS_Pr.UseROM) { |
| biosver = ivideo->SiS_Pr.VirtualRomBase + 0x06; |
| biosdate = ivideo->SiS_Pr.VirtualRomBase + 0x2c; |
| for(i = 0; i < 32768; i++) |
| chksum += ivideo->SiS_Pr.VirtualRomBase[i]; |
| } |
| |
| i = 0; |
| do { |
| if( (mycustomttable[i].chipID == ivideo->chip) && |
| ((!strlen(mycustomttable[i].biosversion)) || |
| (ivideo->SiS_Pr.UseROM && |
| (!strncmp(mycustomttable[i].biosversion, biosver, |
| strlen(mycustomttable[i].biosversion))))) && |
| ((!strlen(mycustomttable[i].biosdate)) || |
| (ivideo->SiS_Pr.UseROM && |
| (!strncmp(mycustomttable[i].biosdate, biosdate, |
| strlen(mycustomttable[i].biosdate))))) && |
| ((!mycustomttable[i].bioschksum) || |
| (ivideo->SiS_Pr.UseROM && |
| (mycustomttable[i].bioschksum == chksum))) && |
| (mycustomttable[i].pcisubsysvendor == ivideo->subsysvendor) && |
| (mycustomttable[i].pcisubsyscard == ivideo->subsysdevice) ) { |
| footprint = TRUE; |
| for(j = 0; j < 5; j++) { |
| if(mycustomttable[i].biosFootprintAddr[j]) { |
| if(ivideo->SiS_Pr.UseROM) { |
| if(ivideo->SiS_Pr.VirtualRomBase[mycustomttable[i].biosFootprintAddr[j]] != |
| mycustomttable[i].biosFootprintData[j]) { |
| footprint = FALSE; |
| } |
| } else |
| footprint = FALSE; |
| } |
| } |
| if(footprint) { |
| ivideo->SiS_Pr.SiS_CustomT = mycustomttable[i].SpecialID; |
| printk(KERN_DEBUG "sisfb: Identified [%s %s], special timing applies\n", |
| mycustomttable[i].vendorName, |
| mycustomttable[i].cardName); |
| printk(KERN_DEBUG "sisfb: [specialtiming parameter name: %s]\n", |
| mycustomttable[i].optionName); |
| break; |
| } |
| } |
| i++; |
| } while(mycustomttable[i].chipID); |
| } |
| |
| static BOOLEAN __devinit |
| sisfb_interpret_edid(struct sisfb_monitor *monitor, u8 *buffer) |
| { |
| int i, j, xres, yres, refresh, index; |
| u32 emodes; |
| |
| if(buffer[0] != 0x00 || buffer[1] != 0xff || |
| buffer[2] != 0xff || buffer[3] != 0xff || |
| buffer[4] != 0xff || buffer[5] != 0xff || |
| buffer[6] != 0xff || buffer[7] != 0x00) { |
| printk(KERN_DEBUG "sisfb: Bad EDID header\n"); |
| return FALSE; |
| } |
| |
| if(buffer[0x12] != 0x01) { |
| printk(KERN_INFO "sisfb: EDID version %d not supported\n", |
| buffer[0x12]); |
| return FALSE; |
| } |
| |
| monitor->feature = buffer[0x18]; |
| |
| if(!buffer[0x14] & 0x80) { |
| if(!(buffer[0x14] & 0x08)) { |
| printk(KERN_INFO |
| "sisfb: WARNING: Monitor does not support separate syncs\n"); |
| } |
| } |
| |
| if(buffer[0x13] >= 0x01) { |
| /* EDID V1 rev 1 and 2: Search for monitor descriptor |
| * to extract ranges |
| */ |
| j = 0x36; |
| for(i=0; i<4; i++) { |
| if(buffer[j] == 0x00 && buffer[j + 1] == 0x00 && |
| buffer[j + 2] == 0x00 && buffer[j + 3] == 0xfd && |
| buffer[j + 4] == 0x00) { |
| monitor->hmin = buffer[j + 7]; |
| monitor->hmax = buffer[j + 8]; |
| monitor->vmin = buffer[j + 5]; |
| monitor->vmax = buffer[j + 6]; |
| monitor->dclockmax = buffer[j + 9] * 10 * 1000; |
| monitor->datavalid = TRUE; |
| break; |
| } |
| j += 18; |
| } |
| } |
| |
| if(!monitor->datavalid) { |
| /* Otherwise: Get a range from the list of supported |
| * Estabished Timings. This is not entirely accurate, |
| * because fixed frequency monitors are not supported |
| * that way. |
| */ |
| monitor->hmin = 65535; monitor->hmax = 0; |
| monitor->vmin = 65535; monitor->vmax = 0; |
| monitor->dclockmax = 0; |
| emodes = buffer[0x23] | (buffer[0x24] << 8) | (buffer[0x25] << 16); |
| for(i = 0; i < 13; i++) { |
| if(emodes & sisfb_ddcsmodes[i].mask) { |
| if(monitor->hmin > sisfb_ddcsmodes[i].h) monitor->hmin = sisfb_ddcsmodes[i].h; |
| if(monitor->hmax < sisfb_ddcsmodes[i].h) monitor->hmax = sisfb_ddcsmodes[i].h + 1; |
| if(monitor->vmin > sisfb_ddcsmodes[i].v) monitor->vmin = sisfb_ddcsmodes[i].v; |
| if(monitor->vmax < sisfb_ddcsmodes[i].v) monitor->vmax = sisfb_ddcsmodes[i].v; |
| if(monitor->dclockmax < sisfb_ddcsmodes[i].d) monitor->dclockmax = sisfb_ddcsmodes[i].d; |
| } |
| } |
| index = 0x26; |
| for(i = 0; i < 8; i++) { |
| xres = (buffer[index] + 31) * 8; |
| switch(buffer[index + 1] & 0xc0) { |
| case 0xc0: yres = (xres * 9) / 16; break; |
| case 0x80: yres = (xres * 4) / 5; break; |
| case 0x40: yres = (xres * 3) / 4; break; |
| default: yres = xres; break; |
| } |
| refresh = (buffer[index + 1] & 0x3f) + 60; |
| if((xres >= 640) && (yres >= 480)) { |
| for(j = 0; j < 8; j++) { |
| if((xres == sisfb_ddcfmodes[j].x) && |
| (yres == sisfb_ddcfmodes[j].y) && |
| (refresh == sisfb_ddcfmodes[j].v)) { |
| if(monitor->hmin > sisfb_ddcfmodes[j].h) monitor->hmin = sisfb_ddcfmodes[j].h; |
| if(monitor->hmax < sisfb_ddcfmodes[j].h) monitor->hmax = sisfb_ddcfmodes[j].h + 1; |
| if(monitor->vmin > sisfb_ddcsmodes[j].v) monitor->vmin = sisfb_ddcsmodes[j].v; |
| if(monitor->vmax < sisfb_ddcsmodes[j].v) monitor->vmax = sisfb_ddcsmodes[j].v; |
| if(monitor->dclockmax < sisfb_ddcsmodes[j].d) monitor->dclockmax = sisfb_ddcsmodes[j].d; |
| } |
| } |
| } |
| index += 2; |
| } |
| if((monitor->hmin <= monitor->hmax) && (monitor->vmin <= monitor->vmax)) { |
| monitor->datavalid = TRUE; |
| } |
| } |
| |
| return monitor->datavalid; |
| } |
| |
| static void __devinit |
| sisfb_handle_ddc(struct sis_video_info *ivideo, struct sisfb_monitor *monitor, int crtno) |
| { |
| unsigned short temp, i, realcrtno = crtno; |
| unsigned char buffer[256]; |
| |
| monitor->datavalid = FALSE; |
| |
| if(crtno) { |
| if(ivideo->vbflags & CRT2_LCD) realcrtno = 1; |
| else if(ivideo->vbflags & CRT2_VGA) realcrtno = 2; |
| else return; |
| } |
| |
| if((ivideo->sisfb_crt1off) && (!crtno)) |
| return; |
| |
| temp = SiS_HandleDDC(&ivideo->SiS_Pr, ivideo->vbflags, ivideo->sisvga_engine, |
| realcrtno, 0, &buffer[0], ivideo->vbflags2); |
| if((!temp) || (temp == 0xffff)) { |
| printk(KERN_INFO "sisfb: CRT%d DDC probing failed\n", crtno + 1); |
| return; |
| } else { |
| printk(KERN_INFO "sisfb: CRT%d DDC supported\n", crtno + 1); |
| printk(KERN_INFO "sisfb: CRT%d DDC level: %s%s%s%s\n", |
| crtno + 1, |
| (temp & 0x1a) ? "" : "[none of the supported]", |
| (temp & 0x02) ? "2 " : "", |
| (temp & 0x08) ? "D&P" : "", |
| (temp & 0x10) ? "FPDI-2" : ""); |
| if(temp & 0x02) { |
| i = 3; /* Number of retrys */ |
| do { |
| temp = SiS_HandleDDC(&ivideo->SiS_Pr, ivideo->vbflags, ivideo->sisvga_engine, |
| realcrtno, 1, &buffer[0], ivideo->vbflags2); |
| } while((temp) && i--); |
| if(!temp) { |
| if(sisfb_interpret_edid(monitor, &buffer[0])) { |
| printk(KERN_INFO "sisfb: Monitor range H %d-%dKHz, V %d-%dHz, Max. dotclock %dMHz\n", |
| monitor->hmin, monitor->hmax, monitor->vmin, monitor->vmax, |
| monitor->dclockmax / 1000); |
| } else { |
| printk(KERN_INFO "sisfb: CRT%d DDC EDID corrupt\n", crtno + 1); |
| } |
| } else { |
| printk(KERN_INFO "sisfb: CRT%d DDC reading failed\n", crtno + 1); |
| } |
| } else { |
| printk(KERN_INFO "sisfb: VESA D&P and FPDI-2 not supported yet\n"); |
| } |
| } |
| } |
| |
| /* -------------- Mode validation --------------- */ |
| |
| static BOOLEAN |
| sisfb_verify_rate(struct sis_video_info *ivideo, struct sisfb_monitor *monitor, |
| int mode_idx, int rate_idx, int rate) |
| { |
| int htotal, vtotal; |
| unsigned int dclock, hsync; |
| |
| if(!monitor->datavalid) |
| return TRUE; |
| |
| if(mode_idx < 0) |
| return FALSE; |
| |
| /* Skip for 320x200, 320x240, 640x400 */ |
| switch(sisbios_mode[mode_idx].mode_no[ivideo->mni]) { |
| case 0x59: |
| case 0x41: |
| case 0x4f: |
| case 0x50: |
| case 0x56: |
| case 0x53: |
| case 0x2f: |
| case 0x5d: |
| case 0x5e: |
| return TRUE; |
| #ifdef CONFIG_FB_SIS_315 |
| case 0x5a: |
| case 0x5b: |
| if(ivideo->sisvga_engine == SIS_315_VGA) return TRUE; |
| #endif |
| } |
| |
| if(rate < (monitor->vmin - 1)) |
| return FALSE; |
| if(rate > (monitor->vmax + 1)) |
| return FALSE; |
| |
| if(sisfb_gettotalfrommode(&ivideo->SiS_Pr, |
| sisbios_mode[mode_idx].mode_no[ivideo->mni], |
| &htotal, &vtotal, rate_idx)) { |
| dclock = (htotal * vtotal * rate) / 1000; |
| if(dclock > (monitor->dclockmax + 1000)) |
| return FALSE; |
| hsync = dclock / htotal; |
| if(hsync < (monitor->hmin - 1)) |
| return FALSE; |
| if(hsync > (monitor->hmax + 1)) |
| return FALSE; |
| } else { |
| return FALSE; |
| } |
| return TRUE; |
| } |
| |
| static int |
| sisfb_validate_mode(struct sis_video_info *ivideo, int myindex, u32 vbflags) |
| { |
| u16 xres=0, yres, myres; |
| |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| if(!(sisbios_mode[myindex].chipset & MD_SIS300)) |
| return -1 ; |
| } |
| #endif |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| if(!(sisbios_mode[myindex].chipset & MD_SIS315)) |
| return -1; |
| } |
| #endif |
| |
| myres = sisbios_mode[myindex].yres; |
| |
| switch(vbflags & VB_DISPTYPE_DISP2) { |
| |
| case CRT2_LCD: |
| xres = ivideo->lcdxres; yres = ivideo->lcdyres; |
| |
| if((ivideo->SiS_Pr.SiS_CustomT != CUT_PANEL848) && |
| (ivideo->SiS_Pr.SiS_CustomT != CUT_PANEL856)) { |
| if(sisbios_mode[myindex].xres > xres) |
| return -1; |
| if(myres > yres) |
| return -1; |
| } |
| |
| if(ivideo->sisfb_fstn) { |
| if(sisbios_mode[myindex].xres == 320) { |
| if(myres == 240) { |
| switch(sisbios_mode[myindex].mode_no[1]) { |
| case 0x50: myindex = MODE_FSTN_8; break; |
| case 0x56: myindex = MODE_FSTN_16; break; |
| case 0x53: return -1; |
| } |
| } |
| } |
| } |
| |
| if(SiS_GetModeID_LCD(ivideo->sisvga_engine, vbflags, sisbios_mode[myindex].xres, |
| sisbios_mode[myindex].yres, 0, ivideo->sisfb_fstn, |
| ivideo->SiS_Pr.SiS_CustomT, xres, yres, ivideo->vbflags2) < 0x14) { |
| return -1; |
| } |
| break; |
| |
| case CRT2_TV: |
| if(SiS_GetModeID_TV(ivideo->sisvga_engine, vbflags, sisbios_mode[myindex].xres, |
| sisbios_mode[myindex].yres, 0, ivideo->vbflags2) < 0x14) { |
| return -1; |
| } |
| break; |
| |
| case CRT2_VGA: |
| if(SiS_GetModeID_VGA2(ivideo->sisvga_engine, vbflags, sisbios_mode[myindex].xres, |
| sisbios_mode[myindex].yres, 0, ivideo->vbflags2) < 0x14) { |
| return -1; |
| } |
| break; |
| } |
| |
| return myindex; |
| } |
| |
| static u8 |
| sisfb_search_refresh_rate(struct sis_video_info *ivideo, unsigned int rate, int mode_idx) |
| { |
| int i = 0; |
| u16 xres = sisbios_mode[mode_idx].xres; |
| u16 yres = sisbios_mode[mode_idx].yres; |
| |
| ivideo->rate_idx = 0; |
| while((sisfb_vrate[i].idx != 0) && (sisfb_vrate[i].xres <= xres)) { |
| if((sisfb_vrate[i].xres == xres) && (sisfb_vrate[i].yres == yres)) { |
| if(sisfb_vrate[i].refresh == rate) { |
| ivideo->rate_idx = sisfb_vrate[i].idx; |
| break; |
| } else if(sisfb_vrate[i].refresh > rate) { |
| if((sisfb_vrate[i].refresh - rate) <= 3) { |
| DPRINTK("sisfb: Adjusting rate from %d up to %d\n", |
| rate, sisfb_vrate[i].refresh); |
| ivideo->rate_idx = sisfb_vrate[i].idx; |
| ivideo->refresh_rate = sisfb_vrate[i].refresh; |
| } else if(((rate - sisfb_vrate[i-1].refresh) <= 2) |
| && (sisfb_vrate[i].idx != 1)) { |
| DPRINTK("sisfb: Adjusting rate from %d down to %d\n", |
| rate, sisfb_vrate[i-1].refresh); |
| ivideo->rate_idx = sisfb_vrate[i-1].idx; |
| ivideo->refresh_rate = sisfb_vrate[i-1].refresh; |
| } |
| break; |
| } else if((rate - sisfb_vrate[i].refresh) <= 2) { |
| DPRINTK("sisfb: Adjusting rate from %d down to %d\n", |
| rate, sisfb_vrate[i].refresh); |
| ivideo->rate_idx = sisfb_vrate[i].idx; |
| break; |
| } |
| } |
| i++; |
| } |
| if(ivideo->rate_idx > 0) { |
| return ivideo->rate_idx; |
| } else { |
| printk(KERN_INFO "sisfb: Unsupported rate %d for %dx%d\n", |
| rate, xres, yres); |
| return 0; |
| } |
| } |
| |
| static BOOLEAN |
| sisfb_bridgeisslave(struct sis_video_info *ivideo) |
| { |
| unsigned char P1_00; |
| |
| if(!(ivideo->vbflags2 & VB2_VIDEOBRIDGE)) |
| return FALSE; |
| |
| inSISIDXREG(SISPART1,0x00,P1_00); |
| if( ((ivideo->sisvga_engine == SIS_300_VGA) && (P1_00 & 0xa0) == 0x20) || |
| ((ivideo->sisvga_engine == SIS_315_VGA) && (P1_00 & 0x50) == 0x10) ) { |
| return TRUE; |
| } else { |
| return FALSE; |
| } |
| } |
| |
| static BOOLEAN |
| sisfballowretracecrt1(struct sis_video_info *ivideo) |
| { |
| u8 temp; |
| |
| inSISIDXREG(SISCR,0x17,temp); |
| if(!(temp & 0x80)) |
| return FALSE; |
| |
| inSISIDXREG(SISSR,0x1f,temp); |
| if(temp & 0xc0) |
| return FALSE; |
| |
| return TRUE; |
| } |
| |
| static BOOLEAN |
| sisfbcheckvretracecrt1(struct sis_video_info *ivideo) |
| { |
| if(!sisfballowretracecrt1(ivideo)) |
| return FALSE; |
| |
| if(inSISREG(SISINPSTAT) & 0x08) |
| return TRUE; |
| else |
| return FALSE; |
| } |
| |
| static void |
| sisfbwaitretracecrt1(struct sis_video_info *ivideo) |
| { |
| int watchdog; |
| |
| if(!sisfballowretracecrt1(ivideo)) |
| return; |
| |
| watchdog = 65536; |
| while((!(inSISREG(SISINPSTAT) & 0x08)) && --watchdog); |
| watchdog = 65536; |
| while((inSISREG(SISINPSTAT) & 0x08) && --watchdog); |
| } |
| |
| static BOOLEAN |
| sisfbcheckvretracecrt2(struct sis_video_info *ivideo) |
| { |
| unsigned char temp, reg; |
| |
| switch(ivideo->sisvga_engine) { |
| case SIS_300_VGA: reg = 0x25; break; |
| case SIS_315_VGA: reg = 0x30; break; |
| default: return FALSE; |
| } |
| |
| inSISIDXREG(SISPART1, reg, temp); |
| if(temp & 0x02) |
| return TRUE; |
| else |
| return FALSE; |
| } |
| |
| static BOOLEAN |
| sisfb_CheckVBRetrace(struct sis_video_info *ivideo) |
| { |
| if(ivideo->currentvbflags & VB_DISPTYPE_DISP2) { |
| if(!sisfb_bridgeisslave(ivideo)) { |
| return sisfbcheckvretracecrt2(ivideo); |
| } |
| } |
| return sisfbcheckvretracecrt1(ivideo); |
| } |
| |
| static u32 |
| sisfb_setupvbblankflags(struct sis_video_info *ivideo, u32 *vcount, u32 *hcount) |
| { |
| u8 idx, reg1, reg2, reg3, reg4; |
| u32 ret = 0; |
| |
| (*vcount) = (*hcount) = 0; |
| |
| if((ivideo->currentvbflags & VB_DISPTYPE_DISP2) && (!(sisfb_bridgeisslave(ivideo)))) { |
| |
| ret |= (FB_VBLANK_HAVE_VSYNC | |
| FB_VBLANK_HAVE_HBLANK | |
| FB_VBLANK_HAVE_VBLANK | |
| FB_VBLANK_HAVE_VCOUNT | |
| FB_VBLANK_HAVE_HCOUNT); |
| switch(ivideo->sisvga_engine) { |
| case SIS_300_VGA: idx = 0x25; break; |
| default: |
| case SIS_315_VGA: idx = 0x30; break; |
| } |
| inSISIDXREG(SISPART1,(idx+0),reg1); /* 30 */ |
| inSISIDXREG(SISPART1,(idx+1),reg2); /* 31 */ |
| inSISIDXREG(SISPART1,(idx+2),reg3); /* 32 */ |
| inSISIDXREG(SISPART1,(idx+3),reg4); /* 33 */ |
| if(reg1 & 0x01) ret |= FB_VBLANK_VBLANKING; |
| if(reg1 & 0x02) ret |= FB_VBLANK_VSYNCING; |
| if(reg4 & 0x80) ret |= FB_VBLANK_HBLANKING; |
| (*vcount) = reg3 | ((reg4 & 0x70) << 4); |
| (*hcount) = reg2 | ((reg4 & 0x0f) << 8); |
| |
| } else if(sisfballowretracecrt1(ivideo)) { |
| |
| ret |= (FB_VBLANK_HAVE_VSYNC | |
| FB_VBLANK_HAVE_VBLANK | |
| FB_VBLANK_HAVE_VCOUNT | |
| FB_VBLANK_HAVE_HCOUNT); |
| reg1 = inSISREG(SISINPSTAT); |
| if(reg1 & 0x08) ret |= FB_VBLANK_VSYNCING; |
| if(reg1 & 0x01) ret |= FB_VBLANK_VBLANKING; |
| inSISIDXREG(SISCR,0x20,reg1); |
| inSISIDXREG(SISCR,0x1b,reg1); |
| inSISIDXREG(SISCR,0x1c,reg2); |
| inSISIDXREG(SISCR,0x1d,reg3); |
| (*vcount) = reg2 | ((reg3 & 0x07) << 8); |
| (*hcount) = (reg1 | ((reg3 & 0x10) << 4)) << 3; |
| } |
| |
| return ret; |
| } |
| |
| static int |
| sisfb_myblank(struct sis_video_info *ivideo, int blank) |
| { |
| u8 sr01, sr11, sr1f, cr63=0, p2_0, p1_13; |
| BOOLEAN backlight = TRUE; |
| |
| switch(blank) { |
| case FB_BLANK_UNBLANK: /* on */ |
| sr01 = 0x00; |
| sr11 = 0x00; |
| sr1f = 0x00; |
| cr63 = 0x00; |
| p2_0 = 0x20; |
| p1_13 = 0x00; |
| backlight = TRUE; |
| break; |
| case FB_BLANK_NORMAL: /* blank */ |
| sr01 = 0x20; |
| sr11 = 0x00; |
| sr1f = 0x00; |
| cr63 = 0x00; |
| p2_0 = 0x20; |
| p1_13 = 0x00; |
| backlight = TRUE; |
| break; |
| case FB_BLANK_VSYNC_SUSPEND: /* no vsync */ |
| sr01 = 0x20; |
| sr11 = 0x08; |
| sr1f = 0x80; |
| cr63 = 0x40; |
| p2_0 = 0x40; |
| p1_13 = 0x80; |
| backlight = FALSE; |
| break; |
| case FB_BLANK_HSYNC_SUSPEND: /* no hsync */ |
| sr01 = 0x20; |
| sr11 = 0x08; |
| sr1f = 0x40; |
| cr63 = 0x40; |
| p2_0 = 0x80; |
| p1_13 = 0x40; |
| backlight = FALSE; |
| break; |
| case FB_BLANK_POWERDOWN: /* off */ |
| sr01 = 0x20; |
| sr11 = 0x08; |
| sr1f = 0xc0; |
| cr63 = 0x40; |
| p2_0 = 0xc0; |
| p1_13 = 0xc0; |
| backlight = FALSE; |
| break; |
| default: |
| return 1; |
| } |
| |
| if(ivideo->currentvbflags & VB_DISPTYPE_CRT1) { |
| |
| if( (!ivideo->sisfb_thismonitor.datavalid) || |
| ((ivideo->sisfb_thismonitor.datavalid) && |
| (ivideo->sisfb_thismonitor.feature & 0xe0))) { |
| |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| setSISIDXREG(SISCR, ivideo->SiS_Pr.SiS_MyCR63, 0xbf, cr63); |
| } |
| |
| if(!(sisfb_bridgeisslave(ivideo))) { |
| setSISIDXREG(SISSR, 0x01, ~0x20, sr01); |
| setSISIDXREG(SISSR, 0x1f, 0x3f, sr1f); |
| } |
| } |
| |
| } |
| |
| if(ivideo->currentvbflags & CRT2_LCD) { |
| |
| if(ivideo->vbflags2 & VB2_SISLVDSBRIDGE) { |
| if(backlight) { |
| SiS_SiS30xBLOn(&ivideo->SiS_Pr); |
| } else { |
| SiS_SiS30xBLOff(&ivideo->SiS_Pr); |
| } |
| } else if(ivideo->sisvga_engine == SIS_315_VGA) { |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->vbflags2 & VB2_CHRONTEL) { |
| if(backlight) { |
| SiS_Chrontel701xBLOn(&ivideo->SiS_Pr); |
| } else { |
| SiS_Chrontel701xBLOff(&ivideo->SiS_Pr); |
| } |
| } |
| #endif |
| } |
| |
| if(((ivideo->sisvga_engine == SIS_300_VGA) && |
| (ivideo->vbflags2 & (VB2_301|VB2_30xBDH|VB2_LVDS))) || |
| ((ivideo->sisvga_engine == SIS_315_VGA) && |
| ((ivideo->vbflags2 & (VB2_LVDS | VB2_CHRONTEL)) == VB2_LVDS))) { |
| setSISIDXREG(SISSR, 0x11, ~0x0c, sr11); |
| } |
| |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| if((ivideo->vbflags2 & VB2_30xB) && |
| (!(ivideo->vbflags2 & VB2_30xBDH))) { |
| setSISIDXREG(SISPART1, 0x13, 0x3f, p1_13); |
| } |
| } else if(ivideo->sisvga_engine == SIS_315_VGA) { |
| if((ivideo->vbflags2 & VB2_30xB) && |
| (!(ivideo->vbflags2 & VB2_30xBDH))) { |
| setSISIDXREG(SISPART2, 0x00, 0x1f, p2_0); |
| } |
| } |
| |
| } else if(ivideo->currentvbflags & CRT2_VGA) { |
| |
| if(ivideo->vbflags2 & VB2_30xB) { |
| setSISIDXREG(SISPART2, 0x00, 0x1f, p2_0); |
| } |
| |
| } |
| |
| return 0; |
| } |
| |
| /* ------------- Callbacks from init.c/init301.c -------------- */ |
| |
| #ifdef CONFIG_FB_SIS_300 |
| unsigned int |
| sisfb_read_nbridge_pci_dword(struct SiS_Private *SiS_Pr, int reg) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)SiS_Pr->ivideo; |
| u32 val = 0; |
| |
| pci_read_config_dword(ivideo->nbridge, reg, &val); |
| return (unsigned int)val; |
| } |
| |
| void |
| sisfb_write_nbridge_pci_dword(struct SiS_Private *SiS_Pr, int reg, unsigned int val) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)SiS_Pr->ivideo; |
| |
| pci_write_config_dword(ivideo->nbridge, reg, (u32)val); |
| } |
| |
| unsigned int |
| sisfb_read_lpc_pci_dword(struct SiS_Private *SiS_Pr, int reg) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)SiS_Pr->ivideo; |
| u32 val = 0; |
| |
| if(!ivideo->lpcdev) return 0; |
| |
| pci_read_config_dword(ivideo->lpcdev, reg, &val); |
| return (unsigned int)val; |
| } |
| #endif |
| |
| #ifdef CONFIG_FB_SIS_315 |
| void |
| sisfb_write_nbridge_pci_byte(struct SiS_Private *SiS_Pr, int reg, unsigned char val) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)SiS_Pr->ivideo; |
| |
| pci_write_config_byte(ivideo->nbridge, reg, (u8)val); |
| } |
| |
| unsigned int |
| sisfb_read_mio_pci_word(struct SiS_Private *SiS_Pr, int reg) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)SiS_Pr->ivideo; |
| u16 val = 0; |
| |
| if(!ivideo->lpcdev) return 0; |
| |
| pci_read_config_word(ivideo->lpcdev, reg, &val); |
| return (unsigned int)val; |
| } |
| #endif |
| |
| /* ----------- FBDev related routines for all series ----------- */ |
| |
| static int |
| sisfb_get_cmap_len(const struct fb_var_screeninfo *var) |
| { |
| return (var->bits_per_pixel == 8) ? 256 : 16; |
| } |
| |
| static void |
| sisfb_set_vparms(struct sis_video_info *ivideo) |
| { |
| switch(ivideo->video_bpp) { |
| case 8: |
| ivideo->DstColor = 0x0000; |
| ivideo->SiS310_AccelDepth = 0x00000000; |
| ivideo->video_cmap_len = 256; |
| break; |
| case 16: |
| ivideo->DstColor = 0x8000; |
| ivideo->SiS310_AccelDepth = 0x00010000; |
| ivideo->video_cmap_len = 16; |
| break; |
| case 32: |
| ivideo->DstColor = 0xC000; |
| ivideo->SiS310_AccelDepth = 0x00020000; |
| ivideo->video_cmap_len = 16; |
| break; |
| default: |
| ivideo->video_cmap_len = 16; |
| printk(KERN_ERR "sisfb: Unsupported depth %d", ivideo->video_bpp); |
| ivideo->accel = 0; |
| } |
| } |
| |
| static int |
| sisfb_calc_maxyres(struct sis_video_info *ivideo, struct fb_var_screeninfo *var) |
| { |
| int maxyres = ivideo->sisfb_mem / (var->xres_virtual * (var->bits_per_pixel >> 3)); |
| |
| if(maxyres > 32767) maxyres = 32767; |
| |
| return maxyres; |
| } |
| |
| static void |
| sisfb_calc_pitch(struct sis_video_info *ivideo, struct fb_var_screeninfo *var) |
| { |
| ivideo->video_linelength = var->xres_virtual * (var->bits_per_pixel >> 3); |
| ivideo->scrnpitchCRT1 = ivideo->video_linelength; |
| if(!(ivideo->currentvbflags & CRT1_LCDA)) { |
| if((var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED) { |
| ivideo->scrnpitchCRT1 <<= 1; |
| } |
| } |
| } |
| |
| static void |
| sisfb_set_pitch(struct sis_video_info *ivideo) |
| { |
| BOOLEAN isslavemode = FALSE; |
| unsigned short HDisplay1 = ivideo->scrnpitchCRT1 >> 3; |
| unsigned short HDisplay2 = ivideo->video_linelength >> 3; |
| |
| if(sisfb_bridgeisslave(ivideo)) isslavemode = TRUE; |
| |
| /* We need to set pitch for CRT1 if bridge is in slave mode, too */ |
| if((ivideo->currentvbflags & VB_DISPTYPE_DISP1) || (isslavemode)) { |
| outSISIDXREG(SISCR,0x13,(HDisplay1 & 0xFF)); |
| setSISIDXREG(SISSR,0x0E,0xF0,(HDisplay1 >> 8)); |
| } |
| |
| /* We must not set the pitch for CRT2 if bridge is in slave mode */ |
| if((ivideo->currentvbflags & VB_DISPTYPE_DISP2) && (!isslavemode)) { |
| orSISIDXREG(SISPART1,ivideo->CRT2_write_enable,0x01); |
| outSISIDXREG(SISPART1,0x07,(HDisplay2 & 0xFF)); |
| setSISIDXREG(SISPART1,0x09,0xF0,(HDisplay2 >> 8)); |
| } |
| } |
| |
| static void |
| sisfb_bpp_to_var(struct sis_video_info *ivideo, struct fb_var_screeninfo *var) |
| { |
| ivideo->video_cmap_len = sisfb_get_cmap_len(var); |
| |
| switch(var->bits_per_pixel) { |
| case 8: |
| var->red.offset = var->green.offset = var->blue.offset = 0; |
| var->red.length = var->green.length = var->blue.length = 6; |
| break; |
| case 16: |
| var->red.offset = 11; |
| var->red.length = 5; |
| var->green.offset = 5; |
| var->green.length = 6; |
| var->blue.offset = 0; |
| var->blue.length = 5; |
| var->transp.offset = 0; |
| var->transp.length = 0; |
| break; |
| case 32: |
| var->red.offset = 16; |
| var->red.length = 8; |
| var->green.offset = 8; |
| var->green.length = 8; |
| var->blue.offset = 0; |
| var->blue.length = 8; |
| var->transp.offset = 24; |
| var->transp.length = 8; |
| break; |
| } |
| } |
| |
| static int |
| sisfb_set_mode(struct sis_video_info *ivideo, int clrscrn) |
| { |
| unsigned short modeno = ivideo->mode_no; |
| |
| /* >=2.6.12's fbcon clears the screen anyway */ |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,12) |
| if(!clrscrn) modeno |= 0x80; |
| #else |
| modeno |= 0x80; |
| #endif |
| |
| outSISIDXREG(SISSR, IND_SIS_PASSWORD, SIS_PASSWORD); |
| |
| sisfb_pre_setmode(ivideo); |
| |
| if(SiSSetMode(&ivideo->SiS_Pr, modeno) == 0) { |
| printk(KERN_ERR "sisfb: Setting mode[0x%x] failed\n", ivideo->mode_no); |
| return -EINVAL; |
| } |
| |
| outSISIDXREG(SISSR, IND_SIS_PASSWORD, SIS_PASSWORD); |
| |
| sisfb_post_setmode(ivideo); |
| |
| return 0; |
| } |
| |
| |
| static int |
| sisfb_do_set_var(struct fb_var_screeninfo *var, int isactive, struct fb_info *info) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)info->par; |
| unsigned int htotal = 0, vtotal = 0; |
| unsigned int drate = 0, hrate = 0; |
| int found_mode = 0, ret; |
| int old_mode; |
| u32 pixclock; |
| |
| htotal = var->left_margin + var->xres + var->right_margin + var->hsync_len; |
| |
| vtotal = var->upper_margin + var->lower_margin + var->vsync_len; |
| |
| pixclock = var->pixclock; |
| |
| if((var->vmode & FB_VMODE_MASK) == FB_VMODE_NONINTERLACED) { |
| vtotal += var->yres; |
| vtotal <<= 1; |
| } else if((var->vmode & FB_VMODE_MASK) == FB_VMODE_DOUBLE) { |
| vtotal += var->yres; |
| vtotal <<= 2; |
| } else if((var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED) { |
| vtotal += var->yres; |
| vtotal <<= 1; |
| } else vtotal += var->yres; |
| |
| if(!(htotal) || !(vtotal)) { |
| DPRINTK("sisfb: Invalid 'var' information\n"); |
| return -EINVAL; |
| } |
| |
| if(pixclock && htotal && vtotal) { |
| drate = 1000000000 / pixclock; |
| hrate = (drate * 1000) / htotal; |
| ivideo->refresh_rate = (unsigned int) (hrate * 2 / vtotal); |
| } else { |
| ivideo->refresh_rate = 60; |
| } |
| |
| old_mode = ivideo->sisfb_mode_idx; |
| ivideo->sisfb_mode_idx = 0; |
| |
| while( (sisbios_mode[ivideo->sisfb_mode_idx].mode_no[0] != 0) && |
| (sisbios_mode[ivideo->sisfb_mode_idx].xres <= var->xres) ) { |
| if( (sisbios_mode[ivideo->sisfb_mode_idx].xres == var->xres) && |
| (sisbios_mode[ivideo->sisfb_mode_idx].yres == var->yres) && |
| (sisbios_mode[ivideo->sisfb_mode_idx].bpp == var->bits_per_pixel)) { |
| ivideo->mode_no = sisbios_mode[ivideo->sisfb_mode_idx].mode_no[ivideo->mni]; |
| found_mode = 1; |
| break; |
| } |
| ivideo->sisfb_mode_idx++; |
| } |
| |
| if(found_mode) { |
| ivideo->sisfb_mode_idx = sisfb_validate_mode(ivideo, |
| ivideo->sisfb_mode_idx, ivideo->currentvbflags); |
| ivideo->mode_no = sisbios_mode[ivideo->sisfb_mode_idx].mode_no[ivideo->mni]; |
| } else { |
| ivideo->sisfb_mode_idx = -1; |
| } |
| |
| if(ivideo->sisfb_mode_idx < 0) { |
| printk(KERN_ERR "sisfb: Mode %dx%dx%d not supported\n", var->xres, |
| var->yres, var->bits_per_pixel); |
| ivideo->sisfb_mode_idx = old_mode; |
| return -EINVAL; |
| } |
| |
| if(sisfb_search_refresh_rate(ivideo, ivideo->refresh_rate, ivideo->sisfb_mode_idx) == 0) { |
| ivideo->rate_idx = sisbios_mode[ivideo->sisfb_mode_idx].rate_idx; |
| ivideo->refresh_rate = 60; |
| } |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| if(ivideo->sisfb_thismonitor.datavalid) { |
| if(!sisfb_verify_rate(ivideo, &ivideo->sisfb_thismonitor, ivideo->sisfb_mode_idx, |
| ivideo->rate_idx, ivideo->refresh_rate)) { |
| printk(KERN_INFO "sisfb: WARNING: Refresh rate exceeds monitor specs!\n"); |
| } |
| } |
| #endif |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| if(((var->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) && isactive) { |
| #else |
| if(isactive) { |
| #endif |
| /* If acceleration to be used? Need to know |
| * before pre/post_set_mode() |
| */ |
| ivideo->accel = 0; |
| #if defined(FBINFO_HWACCEL_DISABLED) && defined(FBINFO_HWACCEL_XPAN) |
| #ifdef STUPID_ACCELF_TEXT_SHIT |
| if(var->accel_flags & FB_ACCELF_TEXT) { |
| info->flags &= ~FBINFO_HWACCEL_DISABLED; |
| } else { |
| info->flags |= FBINFO_HWACCEL_DISABLED; |
| } |
| #endif |
| if(!(info->flags & FBINFO_HWACCEL_DISABLED)) ivideo->accel = -1; |
| #else |
| if(var->accel_flags & FB_ACCELF_TEXT) ivideo->accel = -1; |
| #endif |
| |
| if((ret = sisfb_set_mode(ivideo, 1))) { |
| return ret; |
| } |
| |
| ivideo->video_bpp = sisbios_mode[ivideo->sisfb_mode_idx].bpp; |
| ivideo->video_width = sisbios_mode[ivideo->sisfb_mode_idx].xres; |
| ivideo->video_height = sisbios_mode[ivideo->sisfb_mode_idx].yres; |
| |
| sisfb_calc_pitch(ivideo, var); |
| sisfb_set_pitch(ivideo); |
| |
| sisfb_set_vparms(ivideo); |
| |
| ivideo->current_width = ivideo->video_width; |
| ivideo->current_height = ivideo->video_height; |
| ivideo->current_bpp = ivideo->video_bpp; |
| ivideo->current_htotal = htotal; |
| ivideo->current_vtotal = vtotal; |
| ivideo->current_linelength = ivideo->video_linelength; |
| ivideo->current_pixclock = var->pixclock; |
| ivideo->current_refresh_rate = ivideo->refresh_rate; |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| ivideo->sisfb_lastrates[ivideo->mode_no] = ivideo->refresh_rate; |
| #endif |
| } |
| |
| return 0; |
| } |
| |
| static void |
| sisfb_set_base_CRT1(struct sis_video_info *ivideo, unsigned int base) |
| { |
| outSISIDXREG(SISSR, IND_SIS_PASSWORD, SIS_PASSWORD); |
| |
| outSISIDXREG(SISCR, 0x0D, base & 0xFF); |
| outSISIDXREG(SISCR, 0x0C, (base >> 8) & 0xFF); |
| outSISIDXREG(SISSR, 0x0D, (base >> 16) & 0xFF); |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| setSISIDXREG(SISSR, 0x37, 0xFE, (base >> 24) & 0x01); |
| } |
| } |
| |
| static void |
| sisfb_set_base_CRT2(struct sis_video_info *ivideo, unsigned int base) |
| { |
| if(ivideo->currentvbflags & VB_DISPTYPE_DISP2) { |
| orSISIDXREG(SISPART1, ivideo->CRT2_write_enable, 0x01); |
| outSISIDXREG(SISPART1, 0x06, (base & 0xFF)); |
| outSISIDXREG(SISPART1, 0x05, ((base >> 8) & 0xFF)); |
| outSISIDXREG(SISPART1, 0x04, ((base >> 16) & 0xFF)); |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| setSISIDXREG(SISPART1, 0x02, 0x7F, ((base >> 24) & 0x01) << 7); |
| } |
| } |
| } |
| |
| static int |
| sisfb_pan_var(struct sis_video_info *ivideo, struct fb_var_screeninfo *var) |
| { |
| if(var->xoffset > (var->xres_virtual - var->xres)) { |
| return -EINVAL; |
| } |
| if(var->yoffset > (var->yres_virtual - var->yres)) { |
| return -EINVAL; |
| } |
| |
| ivideo->current_base = (var->yoffset * var->xres_virtual) + var->xoffset; |
| |
| /* calculate base bpp dep. */ |
| switch(var->bits_per_pixel) { |
| case 32: |
| break; |
| case 16: |
| ivideo->current_base >>= 1; |
| break; |
| case 8: |
| default: |
| ivideo->current_base >>= 2; |
| break; |
| } |
| |
| ivideo->current_base += (ivideo->video_offset >> 2); |
| |
| sisfb_set_base_CRT1(ivideo, ivideo->current_base); |
| sisfb_set_base_CRT2(ivideo, ivideo->current_base); |
| |
| return 0; |
| } |
| |
| /* ------------ FBDev related routines for 2.4 series ----------- */ |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| |
| #include "sisfb_fbdev_2_4.h" |
| |
| #endif |
| |
| /* ------------ FBDev related routines for 2.6 series ----------- */ |
| |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| |
| static int |
| sisfb_open(struct fb_info *info, int user) |
| { |
| return 0; |
| } |
| |
| static int |
| sisfb_release(struct fb_info *info, int user) |
| { |
| return 0; |
| } |
| |
| static int |
| sisfb_setcolreg(unsigned regno, unsigned red, unsigned green, unsigned blue, |
| unsigned transp, struct fb_info *info) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)info->par; |
| |
| if(regno >= sisfb_get_cmap_len(&info->var)) |
| return 1; |
| |
| switch(info->var.bits_per_pixel) { |
| case 8: |
| outSISREG(SISDACA, regno); |
| outSISREG(SISDACD, (red >> 10)); |
| outSISREG(SISDACD, (green >> 10)); |
| outSISREG(SISDACD, (blue >> 10)); |
| if(ivideo->currentvbflags & VB_DISPTYPE_DISP2) { |
| outSISREG(SISDAC2A, regno); |
| outSISREG(SISDAC2D, (red >> 8)); |
| outSISREG(SISDAC2D, (green >> 8)); |
| outSISREG(SISDAC2D, (blue >> 8)); |
| } |
| break; |
| case 16: |
| ((u32 *)(info->pseudo_palette))[regno] = |
| (red & 0xf800) | |
| ((green & 0xfc00) >> 5) | |
| ((blue & 0xf800) >> 11); |
| break; |
| case 32: |
| red >>= 8; |
| green >>= 8; |
| blue >>= 8; |
| ((u32 *)(info->pseudo_palette))[regno] = |
| (red << 16) | (green << 8) | (blue); |
| break; |
| } |
| return 0; |
| } |
| |
| static int |
| sisfb_set_par(struct fb_info *info) |
| { |
| int err; |
| |
| if((err = sisfb_do_set_var(&info->var, 1, info))) |
| return err; |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,10) |
| sisfb_get_fix(&info->fix, info->currcon, info); |
| #else |
| sisfb_get_fix(&info->fix, -1, info); |
| #endif |
| return 0; |
| } |
| |
| static int |
| sisfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)info->par; |
| unsigned int htotal = 0, vtotal = 0, myrateindex = 0; |
| unsigned int drate = 0, hrate = 0, maxyres; |
| int found_mode = 0; |
| int refresh_rate, search_idx, tidx; |
| BOOLEAN recalc_clock = FALSE; |
| u32 pixclock; |
| |
| htotal = var->left_margin + var->xres + var->right_margin + var->hsync_len; |
| |
| vtotal = var->upper_margin + var->lower_margin + var->vsync_len; |
| |
| pixclock = var->pixclock; |
| |
| if((var->vmode & FB_VMODE_MASK) == FB_VMODE_NONINTERLACED) { |
| vtotal += var->yres; |
| vtotal <<= 1; |
| } else if((var->vmode & FB_VMODE_MASK) == FB_VMODE_DOUBLE) { |
| vtotal += var->yres; |
| vtotal <<= 2; |
| } else if((var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED) { |
| vtotal += var->yres; |
| vtotal <<= 1; |
| } else |
| vtotal += var->yres; |
| |
| if(!(htotal) || !(vtotal)) { |
| SISFAIL("sisfb: no valid timing data"); |
| } |
| |
| search_idx = 0; |
| while( (sisbios_mode[search_idx].mode_no[0] != 0) && |
| (sisbios_mode[search_idx].xres <= var->xres) ) { |
| if( (sisbios_mode[search_idx].xres == var->xres) && |
| (sisbios_mode[search_idx].yres == var->yres) && |
| (sisbios_mode[search_idx].bpp == var->bits_per_pixel)) { |
| if((tidx = sisfb_validate_mode(ivideo, search_idx, |
| ivideo->currentvbflags)) > 0) { |
| found_mode = 1; |
| search_idx = tidx; |
| break; |
| } |
| } |
| search_idx++; |
| } |
| |
| if(!found_mode) { |
| search_idx = 0; |
| while(sisbios_mode[search_idx].mode_no[0] != 0) { |
| if( (var->xres <= sisbios_mode[search_idx].xres) && |
| (var->yres <= sisbios_mode[search_idx].yres) && |
| (var->bits_per_pixel == sisbios_mode[search_idx].bpp) ) { |
| if((tidx = sisfb_validate_mode(ivideo,search_idx, |
| ivideo->currentvbflags)) > 0) { |
| found_mode = 1; |
| search_idx = tidx; |
| break; |
| } |
| } |
| search_idx++; |
| } |
| if(found_mode) { |
| printk(KERN_DEBUG |
| "sisfb: Adapted from %dx%dx%d to %dx%dx%d\n", |
| var->xres, var->yres, var->bits_per_pixel, |
| sisbios_mode[search_idx].xres, |
| sisbios_mode[search_idx].yres, |
| var->bits_per_pixel); |
| var->xres = sisbios_mode[search_idx].xres; |
| var->yres = sisbios_mode[search_idx].yres; |
| } else { |
| printk(KERN_ERR |
| "sisfb: Failed to find supported mode near %dx%dx%d\n", |
| var->xres, var->yres, var->bits_per_pixel); |
| return -EINVAL; |
| } |
| } |
| |
| if( ((ivideo->vbflags2 & VB2_LVDS) || |
| ((ivideo->vbflags2 & VB2_30xBDH) && (ivideo->currentvbflags & CRT2_LCD))) && |
| (var->bits_per_pixel == 8) ) { |
| /* Slave modes on LVDS and 301B-DH */ |
| refresh_rate = 60; |
| recalc_clock = TRUE; |
| } else if( (ivideo->current_htotal == htotal) && |
| (ivideo->current_vtotal == vtotal) && |
| (ivideo->current_pixclock == pixclock) ) { |
| /* x=x & y=y & c=c -> assume depth change */ |
| drate = 1000000000 / pixclock; |
| hrate = (drate * 1000) / htotal; |
| refresh_rate = (unsigned int) (hrate * 2 / vtotal); |
| } else if( ( (ivideo->current_htotal != htotal) || |
| (ivideo->current_vtotal != vtotal) ) && |
| (ivideo->current_pixclock == var->pixclock) ) { |
| /* x!=x | y!=y & c=c -> invalid pixclock */ |
| if(ivideo->sisfb_lastrates[sisbios_mode[search_idx].mode_no[ivideo->mni]]) { |
| refresh_rate = |
| ivideo->sisfb_lastrates[sisbios_mode[search_idx].mode_no[ivideo->mni]]; |
| } else if(ivideo->sisfb_parm_rate != -1) { |
| /* Sic, sisfb_parm_rate - want to know originally desired rate here */ |
| refresh_rate = ivideo->sisfb_parm_rate; |
| } else { |
| refresh_rate = 60; |
| } |
| recalc_clock = TRUE; |
| } else if((pixclock) && (htotal) && (vtotal)) { |
| drate = 1000000000 / pixclock; |
| hrate = (drate * 1000) / htotal; |
| refresh_rate = (unsigned int) (hrate * 2 / vtotal); |
| } else if(ivideo->current_refresh_rate) { |
| refresh_rate = ivideo->current_refresh_rate; |
| recalc_clock = TRUE; |
| } else { |
| refresh_rate = 60; |
| recalc_clock = TRUE; |
| } |
| |
| myrateindex = sisfb_search_refresh_rate(ivideo, refresh_rate, search_idx); |
| |
| /* Eventually recalculate timing and clock */ |
| if(recalc_clock) { |
| if(!myrateindex) myrateindex = sisbios_mode[search_idx].rate_idx; |
| var->pixclock = (u32) (1000000000 / sisfb_mode_rate_to_dclock(&ivideo->SiS_Pr, |
| sisbios_mode[search_idx].mode_no[ivideo->mni], |
| myrateindex)); |
| sisfb_mode_rate_to_ddata(&ivideo->SiS_Pr, |
| sisbios_mode[search_idx].mode_no[ivideo->mni], |
| myrateindex, var); |
| if((var->vmode & FB_VMODE_MASK) == FB_VMODE_DOUBLE) { |
| var->pixclock <<= 1; |
| } |
| } |
| |
| if(ivideo->sisfb_thismonitor.datavalid) { |
| if(!sisfb_verify_rate(ivideo, &ivideo->sisfb_thismonitor, search_idx, |
| myrateindex, refresh_rate)) { |
| printk(KERN_INFO |
| "sisfb: WARNING: Refresh rate exceeds monitor specs!\n"); |
| } |
| } |
| |
| /* Adapt RGB settings */ |
| sisfb_bpp_to_var(ivideo, var); |
| |
| /* Sanity check for offsets */ |
| if(var->xoffset < 0) var->xoffset = 0; |
| if(var->yoffset < 0) var->yoffset = 0; |
| |
| if(var->xres > var->xres_virtual) |
| var->xres_virtual = var->xres; |
| |
| if(ivideo->sisfb_ypan) { |
| maxyres = sisfb_calc_maxyres(ivideo, var); |
| if(ivideo->sisfb_max) { |
| var->yres_virtual = maxyres; |
| } else { |
| if(var->yres_virtual > maxyres) { |
| var->yres_virtual = maxyres; |
| } |
| } |
| if(var->yres_virtual <= var->yres) { |
| var->yres_virtual = var->yres; |
| } |
| } else { |
| if(var->yres != var->yres_virtual) { |
| var->yres_virtual = var->yres; |
| } |
| var->xoffset = 0; |
| var->yoffset = 0; |
| } |
| |
| /* Truncate offsets to maximum if too high */ |
| if(var->xoffset > var->xres_virtual - var->xres) { |
| var->xoffset = var->xres_virtual - var->xres - 1; |
| } |
| |
| if(var->yoffset > var->yres_virtual - var->yres) { |
| var->yoffset = var->yres_virtual - var->yres - 1; |
| } |
| |
| /* Set everything else to 0 */ |
| var->red.msb_right = |
| var->green.msb_right = |
| var->blue.msb_right = |
| var->transp.offset = |
| var->transp.length = |
| var->transp.msb_right = 0; |
| |
| return 0; |
| } |
| |
| static int |
| sisfb_pan_display(struct fb_var_screeninfo *var, struct fb_info* info) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)info->par; |
| int err; |
| |
| if(var->xoffset > (var->xres_virtual - var->xres)) |
| return -EINVAL; |
| |
| if(var->yoffset > (var->yres_virtual - var->yres)) |
| return -EINVAL; |
| |
| if(var->vmode & FB_VMODE_YWRAP) |
| return -EINVAL; |
| |
| if(var->xoffset + info->var.xres > info->var.xres_virtual || |
| var->yoffset + info->var.yres > info->var.yres_virtual) |
| return -EINVAL; |
| |
| if((err = sisfb_pan_var(ivideo, var)) < 0) |
| return err; |
| |
| info->var.xoffset = var->xoffset; |
| info->var.yoffset = var->yoffset; |
| |
| return 0; |
| } |
| |
| static int |
| sisfb_blank(int blank, struct fb_info *info) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)info->par; |
| |
| return sisfb_myblank(ivideo, blank); |
| } |
| |
| #endif |
| |
| /* ----------- FBDev related routines for all series ---------- */ |
| |
| static int |
| sisfb_ioctl(struct inode *inode, struct file *file, |
| unsigned int cmd, unsigned long arg, |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| int con, |
| #endif |
| struct fb_info *info) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)info->par; |
| struct sis_memreq sismemreq; |
| struct fb_vblank sisvbblank; |
| u32 gpu32 = 0; |
| #ifndef __user |
| #define __user |
| #endif |
| u32 __user *argp = (u32 __user *)arg; |
| |
| switch(cmd) { |
| case FBIO_ALLOC: |
| if(!capable(CAP_SYS_RAWIO)) |
| return -EPERM; |
| |
| if(copy_from_user(&sismemreq, (void __user *)arg, sizeof(sismemreq))) |
| return -EFAULT; |
| |
| sis_malloc(&sismemreq); |
| |
| if(copy_to_user((void __user *)arg, &sismemreq, sizeof(sismemreq))) { |
| sis_free((u32)sismemreq.offset); |
| return -EFAULT; |
| } |
| break; |
| |
| case FBIO_FREE: |
| if(!capable(CAP_SYS_RAWIO)) |
| return -EPERM; |
| |
| if(get_user(gpu32, argp)) |
| return -EFAULT; |
| |
| sis_free(gpu32); |
| break; |
| |
| case FBIOGET_VBLANK: |
| sisvbblank.count = 0; |
| sisvbblank.flags = sisfb_setupvbblankflags(ivideo, &sisvbblank.vcount, &sisvbblank.hcount); |
| |
| if(copy_to_user((void __user *)arg, &sisvbblank, sizeof(sisvbblank))) |
| return -EFAULT; |
| |
| break; |
| |
| case SISFB_GET_INFO_SIZE: |
| return put_user(sizeof(struct sisfb_info), argp); |
| |
| case SISFB_GET_INFO_OLD: |
| if(ivideo->warncount++ < 10) |
| printk(KERN_INFO |
| "sisfb: Deprecated ioctl call received - update your application!\n"); |
| case SISFB_GET_INFO: /* For communication with X driver */ |
| ivideo->sisfb_infoblock.sisfb_id = SISFB_ID; |
| ivideo->sisfb_infoblock.sisfb_version = VER_MAJOR; |
| ivideo->sisfb_infoblock.sisfb_revision = VER_MINOR; |
| ivideo->sisfb_infoblock.sisfb_patchlevel = VER_LEVEL; |
| ivideo->sisfb_infoblock.chip_id = ivideo->chip_id; |
| ivideo->sisfb_infoblock.sisfb_pci_vendor = ivideo->chip_vendor; |
| ivideo->sisfb_infoblock.memory = ivideo->video_size / 1024; |
| ivideo->sisfb_infoblock.heapstart = ivideo->heapstart / 1024; |
| if(ivideo->modechanged) { |
| ivideo->sisfb_infoblock.fbvidmode = ivideo->mode_no; |
| } else { |
| ivideo->sisfb_infoblock.fbvidmode = ivideo->modeprechange; |
| } |
| ivideo->sisfb_infoblock.sisfb_caps = ivideo->caps; |
| ivideo->sisfb_infoblock.sisfb_tqlen = ivideo->cmdQueueSize / 1024; |
| ivideo->sisfb_infoblock.sisfb_pcibus = ivideo->pcibus; |
| ivideo->sisfb_infoblock.sisfb_pcislot = ivideo->pcislot; |
| ivideo->sisfb_infoblock.sisfb_pcifunc = ivideo->pcifunc; |
| ivideo->sisfb_infoblock.sisfb_lcdpdc = ivideo->detectedpdc; |
| ivideo->sisfb_infoblock.sisfb_lcdpdca = ivideo->detectedpdca; |
| ivideo->sisfb_infoblock.sisfb_lcda = ivideo->detectedlcda; |
| ivideo->sisfb_infoblock.sisfb_vbflags = ivideo->vbflags; |
| ivideo->sisfb_infoblock.sisfb_currentvbflags = ivideo->currentvbflags; |
| ivideo->sisfb_infoblock.sisfb_scalelcd = ivideo->SiS_Pr.UsePanelScaler; |
| ivideo->sisfb_infoblock.sisfb_specialtiming = ivideo->SiS_Pr.SiS_CustomT; |
| ivideo->sisfb_infoblock.sisfb_haveemi = ivideo->SiS_Pr.HaveEMI ? 1 : 0; |
| ivideo->sisfb_infoblock.sisfb_haveemilcd = ivideo->SiS_Pr.HaveEMILCD ? 1 : 0; |
| ivideo->sisfb_infoblock.sisfb_emi30 = ivideo->SiS_Pr.EMI_30; |
| ivideo->sisfb_infoblock.sisfb_emi31 = ivideo->SiS_Pr.EMI_31; |
| ivideo->sisfb_infoblock.sisfb_emi32 = ivideo->SiS_Pr.EMI_32; |
| ivideo->sisfb_infoblock.sisfb_emi33 = ivideo->SiS_Pr.EMI_33; |
| ivideo->sisfb_infoblock.sisfb_tvxpos = (u16)(ivideo->tvxpos + 32); |
| ivideo->sisfb_infoblock.sisfb_tvypos = (u16)(ivideo->tvypos + 32); |
| ivideo->sisfb_infoblock.sisfb_heapsize = ivideo->sisfb_heap_size / 1024; |
| ivideo->sisfb_infoblock.sisfb_videooffset = ivideo->video_offset; |
| ivideo->sisfb_infoblock.sisfb_curfstn = ivideo->curFSTN; |
| ivideo->sisfb_infoblock.sisfb_curdstn = ivideo->curDSTN; |
| ivideo->sisfb_infoblock.sisfb_vbflags2 = ivideo->vbflags2; |
| ivideo->sisfb_infoblock.sisfb_can_post = ivideo->sisfb_can_post ? 1 : 0; |
| ivideo->sisfb_infoblock.sisfb_card_posted = ivideo->sisfb_card_posted ? 1 : 0; |
| ivideo->sisfb_infoblock.sisfb_was_boot_device = ivideo->sisfb_was_boot_device ? 1 : 0; |
| |
| if(copy_to_user((void __user *)arg, &ivideo->sisfb_infoblock, |
| sizeof(ivideo->sisfb_infoblock))) |
| return -EFAULT; |
| |
| break; |
| |
| case SISFB_GET_VBRSTATUS_OLD: |
| if(ivideo->warncount++ < 10) |
| printk(KERN_INFO |
| "sisfb: Deprecated ioctl call received - update your application!\n"); |
| case SISFB_GET_VBRSTATUS: |
| if(sisfb_CheckVBRetrace(ivideo)) |
| return put_user((u32)1, argp); |
| else |
| return put_user((u32)0, argp); |
| |
| case SISFB_GET_AUTOMAXIMIZE_OLD: |
| if(ivideo->warncount++ < 10) |
| printk(KERN_INFO |
| "sisfb: Deprecated ioctl call received - update your application!\n"); |
| case SISFB_GET_AUTOMAXIMIZE: |
| if(ivideo->sisfb_max) |
| return put_user((u32)1, argp); |
| else |
| return put_user((u32)0, argp); |
| |
| case SISFB_SET_AUTOMAXIMIZE_OLD: |
| if(ivideo->warncount++ < 10) |
| printk(KERN_INFO |
| "sisfb: Deprecated ioctl call received - update your application!\n"); |
| case SISFB_SET_AUTOMAXIMIZE: |
| if(get_user(gpu32, argp)) |
| return -EFAULT; |
| |
| ivideo->sisfb_max = (gpu32) ? 1 : 0; |
| break; |
| |
| case SISFB_SET_TVPOSOFFSET: |
| if(get_user(gpu32, argp)) |
| return -EFAULT; |
| |
| sisfb_set_TVxposoffset(ivideo, ((int)(gpu32 >> 16)) - 32); |
| sisfb_set_TVyposoffset(ivideo, ((int)(gpu32 & 0xffff)) - 32); |
| break; |
| |
| case SISFB_GET_TVPOSOFFSET: |
| return put_user((u32)(((ivideo->tvxpos+32)<<16)|((ivideo->tvypos+32)&0xffff)), |
| argp); |
| |
| case SISFB_COMMAND: |
| if(copy_from_user(&ivideo->sisfb_command, (void __user *)arg, |
| sizeof(struct sisfb_cmd))) |
| return -EFAULT; |
| |
| sisfb_handle_command(ivideo, &ivideo->sisfb_command); |
| |
| if(copy_to_user((void __user *)arg, &ivideo->sisfb_command, |
| sizeof(struct sisfb_cmd))) |
| return -EFAULT; |
| |
| break; |
| |
| case SISFB_SET_LOCK: |
| if(get_user(gpu32, argp)) |
| return -EFAULT; |
| |
| ivideo->sisfblocked = (gpu32) ? 1 : 0; |
| break; |
| |
| default: |
| #ifdef SIS_NEW_CONFIG_COMPAT |
| return -ENOIOCTLCMD; |
| #else |
| return -EINVAL; |
| #endif |
| } |
| return 0; |
| } |
| |
| #ifdef SIS_NEW_CONFIG_COMPAT |
| static long |
| sisfb_compat_ioctl(struct file *f, unsigned int cmd, unsigned long arg, struct fb_info *info) |
| { |
| int ret; |
| |
| lock_kernel(); |
| ret = sisfb_ioctl(NULL, f, cmd, arg, info); |
| unlock_kernel(); |
| return ret; |
| } |
| #endif |
| |
| static int |
| sisfb_get_fix(struct fb_fix_screeninfo *fix, int con, struct fb_info *info) |
| { |
| struct sis_video_info *ivideo = (struct sis_video_info *)info->par; |
| |
| memset(fix, 0, sizeof(struct fb_fix_screeninfo)); |
| |
| strcpy(fix->id, ivideo->myid); |
| |
| fix->smem_start = ivideo->video_base + ivideo->video_offset; |
| fix->smem_len = ivideo->sisfb_mem; |
| fix->type = FB_TYPE_PACKED_PIXELS; |
| fix->type_aux = 0; |
| fix->visual = (ivideo->video_bpp == 8) ? FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR; |
| fix->xpanstep = 1; |
| fix->ypanstep = (ivideo->sisfb_ypan) ? 1 : 0; |
| fix->ywrapstep = 0; |
| fix->line_length = ivideo->video_linelength; |
| fix->mmio_start = ivideo->mmio_base; |
| fix->mmio_len = ivideo->mmio_size; |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| fix->accel = FB_ACCEL_SIS_GLAMOUR; |
| } else if((ivideo->chip == SIS_330) || |
| (ivideo->chip == SIS_760) || |
| (ivideo->chip == SIS_761)) { |
| fix->accel = FB_ACCEL_SIS_XABRE; |
| } else if(ivideo->chip == XGI_20) { |
| fix->accel = FB_ACCEL_XGI_VOLARI_Z; |
| } else if(ivideo->chip >= XGI_40) { |
| fix->accel = FB_ACCEL_XGI_VOLARI_V; |
| } else { |
| fix->accel = FB_ACCEL_SIS_GLAMOUR_2; |
| } |
| |
| return 0; |
| } |
| |
| /* ---------------- fb_ops structures ----------------- */ |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| static struct fb_ops sisfb_ops = { |
| .owner = THIS_MODULE, |
| .fb_get_fix = sisfb_get_fix, |
| .fb_get_var = sisfb_get_var, |
| .fb_set_var = sisfb_set_var, |
| .fb_get_cmap = sisfb_get_cmap, |
| .fb_set_cmap = sisfb_set_cmap, |
| .fb_pan_display = sisfb_pan_display, |
| .fb_ioctl = sisfb_ioctl |
| }; |
| #endif |
| |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| static struct fb_ops sisfb_ops = { |
| .owner = THIS_MODULE, |
| .fb_open = sisfb_open, |
| .fb_release = sisfb_release, |
| .fb_check_var = sisfb_check_var, |
| .fb_set_par = sisfb_set_par, |
| .fb_setcolreg = sisfb_setcolreg, |
| .fb_pan_display = sisfb_pan_display, |
| .fb_blank = sisfb_blank, |
| .fb_fillrect = fbcon_sis_fillrect, |
| .fb_copyarea = fbcon_sis_copyarea, |
| .fb_imageblit = cfb_imageblit, |
| .fb_cursor = soft_cursor, |
| .fb_sync = fbcon_sis_sync, |
| #ifdef SIS_NEW_CONFIG_COMPAT |
| .fb_compat_ioctl= sisfb_compat_ioctl, |
| #endif |
| .fb_ioctl = sisfb_ioctl |
| }; |
| #endif |
| |
| /* ---------------- Chip generation dependent routines ---------------- */ |
| |
| static struct pci_dev * __devinit |
| sisfb_get_northbridge(int basechipid) |
| { |
| struct pci_dev *pdev = NULL; |
| int nbridgenum, nbridgeidx, i; |
| static const unsigned short nbridgeids[] = { |
| PCI_DEVICE_ID_SI_540, /* for SiS 540 VGA */ |
| PCI_DEVICE_ID_SI_630, /* for SiS 630/730 VGA */ |
| PCI_DEVICE_ID_SI_730, |
| PCI_DEVICE_ID_SI_550, /* for SiS 550 VGA */ |
| PCI_DEVICE_ID_SI_650, /* for SiS 650/651/740 VGA */ |
| PCI_DEVICE_ID_SI_651, |
| PCI_DEVICE_ID_SI_740, |
| PCI_DEVICE_ID_SI_661, /* for SiS 661/741/660/760/761 VGA */ |
| PCI_DEVICE_ID_SI_741, |
| PCI_DEVICE_ID_SI_660, |
| PCI_DEVICE_ID_SI_760, |
| PCI_DEVICE_ID_SI_761 |
| }; |
| |
| switch(basechipid) { |
| #ifdef CONFIG_FB_SIS_300 |
| case SIS_540: nbridgeidx = 0; nbridgenum = 1; break; |
| case SIS_630: nbridgeidx = 1; nbridgenum = 2; break; |
| #endif |
| #ifdef CONFIG_FB_SIS_315 |
| case SIS_550: nbridgeidx = 3; nbridgenum = 1; break; |
| case SIS_650: nbridgeidx = 4; nbridgenum = 3; break; |
| case SIS_660: nbridgeidx = 7; nbridgenum = 5; break; |
| #endif |
| default: return NULL; |
| } |
| for(i = 0; i < nbridgenum; i++) { |
| if((pdev = SIS_PCI_GET_DEVICE(PCI_VENDOR_ID_SI, |
| nbridgeids[nbridgeidx+i], NULL))) |
| break; |
| } |
| return pdev; |
| } |
| |
| static int __devinit |
| sisfb_get_dram_size(struct sis_video_info *ivideo) |
| { |
| #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) |
| u8 reg; |
| #endif |
| |
| ivideo->video_size = 0; |
| ivideo->UMAsize = ivideo->LFBsize = 0; |
| |
| switch(ivideo->chip) { |
| #ifdef CONFIG_FB_SIS_300 |
| case SIS_300: |
| inSISIDXREG(SISSR, 0x14, reg); |
| ivideo->video_size = ((reg & 0x3F) + 1) << 20; |
| break; |
| case SIS_540: |
| case SIS_630: |
| case SIS_730: |
| if(!ivideo->nbridge) |
| return -1; |
| pci_read_config_byte(ivideo->nbridge, 0x63, ®); |
| ivideo->video_size = 1 << (((reg & 0x70) >> 4) + 21); |
| break; |
| #endif |
| #ifdef CONFIG_FB_SIS_315 |
| case SIS_315H: |
| case SIS_315PRO: |
| case SIS_315: |
| inSISIDXREG(SISSR, 0x14, reg); |
| ivideo->video_size = (1 << ((reg & 0xf0) >> 4)) << 20; |
| switch((reg >> 2) & 0x03) { |
| case 0x01: |
| case 0x03: |
| ivideo->video_size <<= 1; |
| break; |
| case 0x02: |
| ivideo->video_size += (ivideo->video_size/2); |
| } |
| break; |
| case SIS_330: |
| inSISIDXREG(SISSR, 0x14, reg); |
| ivideo->video_size = (1 << ((reg & 0xf0) >> 4)) << 20; |
| if(reg & 0x0c) ivideo->video_size <<= 1; |
| break; |
| case SIS_550: |
| case SIS_650: |
| case SIS_740: |
| inSISIDXREG(SISSR, 0x14, reg); |
| ivideo->video_size = (((reg & 0x3f) + 1) << 2) << 20; |
| break; |
| case SIS_661: |
| case SIS_741: |
| inSISIDXREG(SISCR, 0x79, reg); |
| ivideo->video_size = (1 << ((reg & 0xf0) >> 4)) << 20; |
| break; |
| case SIS_660: |
| case SIS_760: |
| case SIS_761: |
| inSISIDXREG(SISCR, 0x79, reg); |
| reg = (reg & 0xf0) >> 4; |
| if(reg) { |
| ivideo->video_size = (1 << reg) << 20; |
| ivideo->UMAsize = ivideo->video_size; |
| } |
| inSISIDXREG(SISCR, 0x78, reg); |
| reg &= 0x30; |
| if(reg) { |
| if(reg == 0x10) { |
| ivideo->LFBsize = (32 << 20); |
| } else { |
| ivideo->LFBsize = (64 << 20); |
| } |
| ivideo->video_size += ivideo->LFBsize; |
| } |
| break; |
| case SIS_340: |
| case XGI_20: |
| case XGI_40: |
| inSISIDXREG(SISSR, 0x14, reg); |
| ivideo->video_size = (1 << ((reg & 0xf0) >> 4)) << 20; |
| if(ivideo->chip != XGI_20) { |
| reg = (reg & 0x0c) >> 2; |
| if(ivideo->revision_id == 2) { |
| if(reg & 0x01) reg = 0x02; |
| else reg = 0x00; |
| } |
| if(reg == 0x02) ivideo->video_size <<= 1; |
| else if(reg == 0x03) ivideo->video_size <<= 2; |
| } |
| break; |
| #endif |
| default: |
| return -1; |
| } |
| return 0; |
| } |
| |
| /* -------------- video bridge device detection --------------- */ |
| |
| static void __devinit |
| sisfb_detect_VB_connect(struct sis_video_info *ivideo) |
| { |
| u8 cr32, temp; |
| |
| /* No CRT2 on XGI Z7 */ |
| if(ivideo->chip == XGI_20) { |
| ivideo->sisfb_crt1off = 0; |
| return; |
| } |
| |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| inSISIDXREG(SISSR, 0x17, temp); |
| if((temp & 0x0F) && (ivideo->chip != SIS_300)) { |
| /* PAL/NTSC is stored on SR16 on such machines */ |
| if(!(ivideo->vbflags & (TV_PAL | TV_NTSC | TV_PALM | TV_PALN))) { |
| inSISIDXREG(SISSR, 0x16, temp); |
| if(temp & 0x20) |
| ivideo->vbflags |= TV_PAL; |
| else |
| ivideo->vbflags |= TV_NTSC; |
| } |
| } |
| } |
| #endif |
| |
| inSISIDXREG(SISCR, 0x32, cr32); |
| |
| if(cr32 & SIS_CRT1) { |
| ivideo->sisfb_crt1off = 0; |
| } else { |
| ivideo->sisfb_crt1off = (cr32 & 0xDF) ? 1 : 0; |
| } |
| |
| ivideo->vbflags &= ~(CRT2_TV | CRT2_LCD | CRT2_VGA); |
| |
| if(cr32 & SIS_VB_TV) ivideo->vbflags |= CRT2_TV; |
| if(cr32 & SIS_VB_LCD) ivideo->vbflags |= CRT2_LCD; |
| if(cr32 & SIS_VB_CRT2) ivideo->vbflags |= CRT2_VGA; |
| |
| /* Check given parms for hardware compatibility. |
| * (Cannot do this in the search_xx routines since we don't |
| * know what hardware we are running on then) |
| */ |
| |
| if(ivideo->chip != SIS_550) { |
| ivideo->sisfb_dstn = ivideo->sisfb_fstn = 0; |
| } |
| |
| if(ivideo->sisfb_tvplug != -1) { |
| if( (ivideo->sisvga_engine != SIS_315_VGA) || |
| (!(ivideo->vbflags2 & VB2_SISYPBPRBRIDGE)) ) { |
| if(ivideo->sisfb_tvplug & TV_YPBPR) { |
| ivideo->sisfb_tvplug = -1; |
| printk(KERN_ERR "sisfb: YPbPr not supported\n"); |
| } |
| } |
| } |
| if(ivideo->sisfb_tvplug != -1) { |
| if( (ivideo->sisvga_engine != SIS_315_VGA) || |
| (!(ivideo->vbflags2 & VB2_SISHIVISIONBRIDGE)) ) { |
| if(ivideo->sisfb_tvplug & TV_HIVISION) { |
| ivideo->sisfb_tvplug = -1; |
| printk(KERN_ERR "sisfb: HiVision not supported\n"); |
| } |
| } |
| } |
| if(ivideo->sisfb_tvstd != -1) { |
| if( (!(ivideo->vbflags2 & VB2_SISBRIDGE)) && |
| (!((ivideo->sisvga_engine == SIS_315_VGA) && |
| (ivideo->vbflags2 & VB2_CHRONTEL))) ) { |
| if(ivideo->sisfb_tvstd & (TV_PALN | TV_PALN | TV_NTSCJ)) { |
| ivideo->sisfb_tvstd = -1; |
| printk(KERN_ERR "sisfb: PALM/PALN/NTSCJ not supported\n"); |
| } |
| } |
| } |
| |
| /* Detect/set TV plug & type */ |
| if(ivideo->sisfb_tvplug != -1) { |
| ivideo->vbflags |= ivideo->sisfb_tvplug; |
| } else { |
| if(cr32 & SIS_VB_YPBPR) ivideo->vbflags |= (TV_YPBPR|TV_YPBPR525I); /* default: 480i */ |
| else if(cr32 & SIS_VB_HIVISION) ivideo->vbflags |= TV_HIVISION; |
| else if(cr32 & SIS_VB_SCART) ivideo->vbflags |= TV_SCART; |
| else { |
| if(cr32 & SIS_VB_SVIDEO) ivideo->vbflags |= TV_SVIDEO; |
| if(cr32 & SIS_VB_COMPOSITE) ivideo->vbflags |= TV_AVIDEO; |
| } |
| } |
| |
| if(!(ivideo->vbflags & (TV_YPBPR | TV_HIVISION))) { |
| if(ivideo->sisfb_tvstd != -1) { |
| ivideo->vbflags &= ~(TV_NTSC | TV_PAL | TV_PALM | TV_PALN | TV_NTSCJ); |
| ivideo->vbflags |= ivideo->sisfb_tvstd; |
| } |
| if(ivideo->vbflags & TV_SCART) { |
| ivideo->vbflags &= ~(TV_NTSC | TV_PALM | TV_PALN | TV_NTSCJ); |
| ivideo->vbflags |= TV_PAL; |
| } |
| if(!(ivideo->vbflags & (TV_PAL | TV_NTSC | TV_PALM | TV_PALN | TV_NTSCJ))) { |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| inSISIDXREG(SISSR, 0x38, temp); |
| if(temp & 0x01) ivideo->vbflags |= TV_PAL; |
| else ivideo->vbflags |= TV_NTSC; |
| } else if((ivideo->chip <= SIS_315PRO) || (ivideo->chip >= SIS_330)) { |
| inSISIDXREG(SISSR, 0x38, temp); |
| if(temp & 0x01) ivideo->vbflags |= TV_PAL; |
| else ivideo->vbflags |= TV_NTSC; |
| } else { |
| inSISIDXREG(SISCR, 0x79, temp); |
| if(temp & 0x20) ivideo->vbflags |= TV_PAL; |
| else ivideo->vbflags |= TV_NTSC; |
| } |
| } |
| } |
| |
| /* Copy forceCRT1 option to CRT1off if option is given */ |
| if(ivideo->sisfb_forcecrt1 != -1) { |
| ivideo->sisfb_crt1off = (ivideo->sisfb_forcecrt1) ? 0 : 1; |
| } |
| } |
| |
| /* ------------------ Sensing routines ------------------ */ |
| |
| static BOOLEAN __devinit |
| sisfb_test_DDC1(struct sis_video_info *ivideo) |
| { |
| unsigned short old; |
| int count = 48; |
| |
| old = SiS_ReadDDC1Bit(&ivideo->SiS_Pr); |
| do { |
| if(old != SiS_ReadDDC1Bit(&ivideo->SiS_Pr)) break; |
| } while(count--); |
| return (count == -1) ? FALSE : TRUE; |
| } |
| |
| static void __devinit |
| sisfb_sense_crt1(struct sis_video_info *ivideo) |
| { |
| BOOLEAN mustwait = FALSE; |
| u8 sr1F, cr17; |
| #ifdef CONFIG_FB_SIS_315 |
| u8 cr63=0; |
| #endif |
| u16 temp = 0xffff; |
| int i; |
| |
| inSISIDXREG(SISSR,0x1F,sr1F); |
| orSISIDXREG(SISSR,0x1F,0x04); |
| andSISIDXREG(SISSR,0x1F,0x3F); |
| if(sr1F & 0xc0) mustwait = TRUE; |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| inSISIDXREG(SISCR,ivideo->SiS_Pr.SiS_MyCR63,cr63); |
| cr63 &= 0x40; |
| andSISIDXREG(SISCR,ivideo->SiS_Pr.SiS_MyCR63,0xBF); |
| } |
| #endif |
| |
| inSISIDXREG(SISCR,0x17,cr17); |
| cr17 &= 0x80; |
| if(!cr17) { |
| orSISIDXREG(SISCR,0x17,0x80); |
| mustwait = TRUE; |
| outSISIDXREG(SISSR, 0x00, 0x01); |
| outSISIDXREG(SISSR, 0x00, 0x03); |
| } |
| |
| if(mustwait) { |
| for(i=0; i < 10; i++) sisfbwaitretracecrt1(ivideo); |
| } |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->chip >= SIS_330) { |
| andSISIDXREG(SISCR,0x32,~0x20); |
| if(ivideo->chip >= SIS_340) { |
| outSISIDXREG(SISCR, 0x57, 0x4a); |
| } else { |
| outSISIDXREG(SISCR, 0x57, 0x5f); |
| } |
| orSISIDXREG(SISCR, 0x53, 0x02); |
| while((inSISREG(SISINPSTAT)) & 0x01) break; |
| while(!((inSISREG(SISINPSTAT)) & 0x01)) break; |
| if((inSISREG(SISMISCW)) & 0x10) temp = 1; |
| andSISIDXREG(SISCR, 0x53, 0xfd); |
| andSISIDXREG(SISCR, 0x57, 0x00); |
| } |
| #endif |
| |
| if(temp == 0xffff) { |
| i = 3; |
| do { |
| temp = SiS_HandleDDC(&ivideo->SiS_Pr, ivideo->vbflags, |
| ivideo->sisvga_engine, 0, 0, NULL, ivideo->vbflags2); |
| } while(((temp == 0) || (temp == 0xffff)) && i--); |
| |
| if((temp == 0) || (temp == 0xffff)) { |
| if(sisfb_test_DDC1(ivideo)) temp = 1; |
| } |
| } |
| |
| if((temp) && (temp != 0xffff)) { |
| orSISIDXREG(SISCR,0x32,0x20); |
| } |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| setSISIDXREG(SISCR,ivideo->SiS_Pr.SiS_MyCR63,0xBF,cr63); |
| } |
| #endif |
| |
| setSISIDXREG(SISCR,0x17,0x7F,cr17); |
| |
| outSISIDXREG(SISSR,0x1F,sr1F); |
| } |
| |
| /* Determine and detect attached devices on SiS30x */ |
| static void __devinit |
| SiS_SenseLCD(struct sis_video_info *ivideo) |
| { |
| unsigned char buffer[256]; |
| unsigned short temp, realcrtno, i; |
| u8 reg, cr37 = 0, paneltype = 0; |
| u16 xres, yres; |
| |
| ivideo->SiS_Pr.PanelSelfDetected = FALSE; |
| |
| /* LCD detection only for TMDS bridges */ |
| if(!(ivideo->vbflags2 & VB2_SISTMDSBRIDGE)) |
| return; |
| if(ivideo->vbflags2 & VB2_30xBDH) |
| return; |
| |
| /* If LCD already set up by BIOS, skip it */ |
| inSISIDXREG(SISCR, 0x32, reg); |
| if(reg & 0x08) |
| return; |
| |
| realcrtno = 1; |
| if(ivideo->SiS_Pr.DDCPortMixup) |
| realcrtno = 0; |
| |
| /* Check DDC capabilities */ |
| temp = SiS_HandleDDC(&ivideo->SiS_Pr, ivideo->vbflags, ivideo->sisvga_engine, |
| realcrtno, 0, &buffer[0], ivideo->vbflags2); |
| |
| if((!temp) || (temp == 0xffff) || (!(temp & 0x02))) |
| return; |
| |
| /* Read DDC data */ |
| i = 3; /* Number of retrys */ |
| do { |
| temp = SiS_HandleDDC(&ivideo->SiS_Pr, ivideo->vbflags, |
| ivideo->sisvga_engine, realcrtno, 1, |
| &buffer[0], ivideo->vbflags2); |
| } while((temp) && i--); |
| |
| if(temp) |
| return; |
| |
| /* No digital device */ |
| if(!(buffer[0x14] & 0x80)) |
| return; |
| |
| /* First detailed timing preferred timing? */ |
| if(!(buffer[0x18] & 0x02)) |
| return; |
| |
| xres = buffer[0x38] | ((buffer[0x3a] & 0xf0) << 4); |
| yres = buffer[0x3b] | ((buffer[0x3d] & 0xf0) << 4); |
| |
| switch(xres) { |
| case 1024: |
| if(yres == 768) |
| paneltype = 0x02; |
| break; |
| case 1280: |
| if(yres == 1024) |
| paneltype = 0x03; |
| break; |
| case 1600: |
| if((yres == 1200) && (ivideo->vbflags2 & VB2_30xC)) |
| paneltype = 0x0b; |
| break; |
| } |
| |
| if(!paneltype) |
| return; |
| |
| if(buffer[0x23]) |
| cr37 |= 0x10; |
| |
| if((buffer[0x47] & 0x18) == 0x18) |
| cr37 |= ((((buffer[0x47] & 0x06) ^ 0x06) << 5) | 0x20); |
| else |
| cr37 |= 0xc0; |
| |
| outSISIDXREG(SISCR, 0x36, paneltype); |
| cr37 &= 0xf1; |
| setSISIDXREG(SISCR, 0x37, 0x0c, cr37); |
| orSISIDXREG(SISCR, 0x32, 0x08); |
| |
| ivideo->SiS_Pr.PanelSelfDetected = TRUE; |
| } |
| |
| static int __devinit |
| SISDoSense(struct sis_video_info *ivideo, u16 type, u16 test) |
| { |
| int temp, mytest, result, i, j; |
| |
| for(j = 0; j < 10; j++) { |
| result = 0; |
| for(i = 0; i < 3; i++) { |
| mytest = test; |
| outSISIDXREG(SISPART4,0x11,(type & 0x00ff)); |
| temp = (type >> 8) | (mytest & 0x00ff); |
| setSISIDXREG(SISPART4,0x10,0xe0,temp); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x1500); |
| mytest >>= 8; |
| mytest &= 0x7f; |
| inSISIDXREG(SISPART4,0x03,temp); |
| temp ^= 0x0e; |
| temp &= mytest; |
| if(temp == mytest) result++; |
| #if 1 |
| outSISIDXREG(SISPART4,0x11,0x00); |
| andSISIDXREG(SISPART4,0x10,0xe0); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x1000); |
| #endif |
| } |
| if((result == 0) || (result >= 2)) break; |
| } |
| return result; |
| } |
| |
| static void __devinit |
| SiS_Sense30x(struct sis_video_info *ivideo) |
| { |
| u8 backupP4_0d,backupP2_00,backupP2_4d,backupSR_1e,biosflag=0; |
| u16 svhs=0, svhs_c=0; |
| u16 cvbs=0, cvbs_c=0; |
| u16 vga2=0, vga2_c=0; |
| int myflag, result; |
| char stdstr[] = "sisfb: Detected"; |
| char tvstr[] = "TV connected to"; |
| |
| if(ivideo->vbflags2 & VB2_301) { |
| svhs = 0x00b9; cvbs = 0x00b3; vga2 = 0x00d1; |
| inSISIDXREG(SISPART4,0x01,myflag); |
| if(myflag & 0x04) { |
| svhs = 0x00dd; cvbs = 0x00ee; vga2 = 0x00fd; |
| } |
| } else if(ivideo->vbflags2 & (VB2_301B | VB2_302B)) { |
| svhs = 0x016b; cvbs = 0x0174; vga2 = 0x0190; |
| } else if(ivideo->vbflags2 & (VB2_301LV | VB2_302LV)) { |
| svhs = 0x0200; cvbs = 0x0100; |
| } else if(ivideo->vbflags2 & (VB2_301C | VB2_302ELV | VB2_307T | VB2_307LV)) { |
| svhs = 0x016b; cvbs = 0x0110; vga2 = 0x0190; |
| } else |
| return; |
| |
| vga2_c = 0x0e08; svhs_c = 0x0404; cvbs_c = 0x0804; |
| if(ivideo->vbflags & (VB2_301LV|VB2_302LV|VB2_302ELV|VB2_307LV)) { |
| svhs_c = 0x0408; cvbs_c = 0x0808; |
| } |
| |
| biosflag = 2; |
| if(ivideo->haveXGIROM) { |
| biosflag = ivideo->bios_abase[0x58] & 0x03; |
| } else if(ivideo->newrom) { |
| if(ivideo->bios_abase[0x5d] & 0x04) biosflag |= 0x01; |
| } else if(ivideo->sisvga_engine == SIS_300_VGA) { |
| if(ivideo->bios_abase) { |
| biosflag = ivideo->bios_abase[0xfe] & 0x03; |
| } |
| } |
| |
| if(ivideo->chip == SIS_300) { |
| inSISIDXREG(SISSR,0x3b,myflag); |
| if(!(myflag & 0x01)) vga2 = vga2_c = 0; |
| } |
| |
| if(!(ivideo->vbflags2 & VB2_SISVGA2BRIDGE)) { |
| vga2 = vga2_c = 0; |
| } |
| |
| inSISIDXREG(SISSR,0x1e,backupSR_1e); |
| orSISIDXREG(SISSR,0x1e,0x20); |
| |
| inSISIDXREG(SISPART4,0x0d,backupP4_0d); |
| if(ivideo->vbflags2 & VB2_30xC) { |
| setSISIDXREG(SISPART4,0x0d,~0x07,0x01); |
| } else { |
| orSISIDXREG(SISPART4,0x0d,0x04); |
| } |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x2000); |
| |
| inSISIDXREG(SISPART2,0x00,backupP2_00); |
| outSISIDXREG(SISPART2,0x00,((backupP2_00 | 0x1c) & 0xfc)); |
| |
| inSISIDXREG(SISPART2,0x4d,backupP2_4d); |
| if(ivideo->vbflags2 & VB2_SISYPBPRBRIDGE) { |
| outSISIDXREG(SISPART2,0x4d,(backupP2_4d & ~0x10)); |
| } |
| |
| if(!(ivideo->vbflags2 & VB2_30xCLV)) { |
| SISDoSense(ivideo, 0, 0); |
| } |
| |
| andSISIDXREG(SISCR, 0x32, ~0x14); |
| |
| if(vga2_c || vga2) { |
| if(SISDoSense(ivideo, vga2, vga2_c)) { |
| if(biosflag & 0x01) { |
| printk(KERN_INFO "%s %s SCART output\n", stdstr, tvstr); |
| orSISIDXREG(SISCR, 0x32, 0x04); |
| } else { |
| printk(KERN_INFO "%s secondary VGA connection\n", stdstr); |
| orSISIDXREG(SISCR, 0x32, 0x10); |
| } |
| } |
| } |
| |
| andSISIDXREG(SISCR, 0x32, 0x3f); |
| |
| if(ivideo->vbflags2 & VB2_30xCLV) { |
| orSISIDXREG(SISPART4,0x0d,0x04); |
| } |
| |
| if((ivideo->sisvga_engine == SIS_315_VGA) && (ivideo->vbflags2 & VB2_SISYPBPRBRIDGE)) { |
| outSISIDXREG(SISPART2,0x4d,(backupP2_4d | 0x10)); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x2000); |
| if((result = SISDoSense(ivideo, svhs, 0x0604))) { |
| if((result = SISDoSense(ivideo, cvbs, 0x0804))) { |
| printk(KERN_INFO "%s %s YPbPr component output\n", stdstr, tvstr); |
| orSISIDXREG(SISCR,0x32,0x80); |
| } |
| } |
| outSISIDXREG(SISPART2,0x4d,backupP2_4d); |
| } |
| |
| andSISIDXREG(SISCR, 0x32, ~0x03); |
| |
| if(!(ivideo->vbflags & TV_YPBPR)) { |
| if((result = SISDoSense(ivideo, svhs, svhs_c))) { |
| printk(KERN_INFO "%s %s SVIDEO output\n", stdstr, tvstr); |
| orSISIDXREG(SISCR, 0x32, 0x02); |
| } |
| if((biosflag & 0x02) || (!result)) { |
| if(SISDoSense(ivideo, cvbs, cvbs_c)) { |
| printk(KERN_INFO "%s %s COMPOSITE output\n", stdstr, tvstr); |
| orSISIDXREG(SISCR, 0x32, 0x01); |
| } |
| } |
| } |
| |
| SISDoSense(ivideo, 0, 0); |
| |
| outSISIDXREG(SISPART2,0x00,backupP2_00); |
| outSISIDXREG(SISPART4,0x0d,backupP4_0d); |
| outSISIDXREG(SISSR,0x1e,backupSR_1e); |
| |
| if(ivideo->vbflags2 & VB2_30xCLV) { |
| inSISIDXREG(SISPART2,0x00,biosflag); |
| if(biosflag & 0x20) { |
| for(myflag = 2; myflag > 0; myflag--) { |
| biosflag ^= 0x20; |
| outSISIDXREG(SISPART2,0x00,biosflag); |
| } |
| } |
| } |
| |
| outSISIDXREG(SISPART2,0x00,backupP2_00); |
| } |
| |
| /* Determine and detect attached TV's on Chrontel */ |
| static void __devinit |
| SiS_SenseCh(struct sis_video_info *ivideo) |
| { |
| #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) |
| u8 temp1, temp2; |
| char stdstr[] = "sisfb: Chrontel: Detected TV connected to"; |
| #endif |
| #ifdef CONFIG_FB_SIS_300 |
| unsigned char test[3]; |
| int i; |
| #endif |
| |
| if(ivideo->chip < SIS_315H) { |
| |
| #ifdef CONFIG_FB_SIS_300 |
| ivideo->SiS_Pr.SiS_IF_DEF_CH70xx = 1; /* Chrontel 700x */ |
| SiS_SetChrontelGPIO(&ivideo->SiS_Pr, 0x9c); /* Set general purpose IO for Chrontel communication */ |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 1000); |
| temp1 = SiS_GetCH700x(&ivideo->SiS_Pr, 0x25); |
| /* See Chrontel TB31 for explanation */ |
| temp2 = SiS_GetCH700x(&ivideo->SiS_Pr, 0x0e); |
| if(((temp2 & 0x07) == 0x01) || (temp2 & 0x04)) { |
| SiS_SetCH700x(&ivideo->SiS_Pr, 0x0e, 0x0b); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 300); |
| } |
| temp2 = SiS_GetCH700x(&ivideo->SiS_Pr, 0x25); |
| if(temp2 != temp1) temp1 = temp2; |
| |
| if((temp1 >= 0x22) && (temp1 <= 0x50)) { |
| /* Read power status */ |
| temp1 = SiS_GetCH700x(&ivideo->SiS_Pr, 0x0e); |
| if((temp1 & 0x03) != 0x03) { |
| /* Power all outputs */ |
| SiS_SetCH700x(&ivideo->SiS_Pr, 0x0e,0x0b); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 300); |
| } |
| /* Sense connected TV devices */ |
| for(i = 0; i < 3; i++) { |
| SiS_SetCH700x(&ivideo->SiS_Pr, 0x10, 0x01); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x96); |
| SiS_SetCH700x(&ivideo->SiS_Pr, 0x10, 0x00); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x96); |
| temp1 = SiS_GetCH700x(&ivideo->SiS_Pr, 0x10); |
| if(!(temp1 & 0x08)) test[i] = 0x02; |
| else if(!(temp1 & 0x02)) test[i] = 0x01; |
| else test[i] = 0; |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x96); |
| } |
| |
| if(test[0] == test[1]) temp1 = test[0]; |
| else if(test[0] == test[2]) temp1 = test[0]; |
| else if(test[1] == test[2]) temp1 = test[1]; |
| else { |
| printk(KERN_INFO |
| "sisfb: TV detection unreliable - test results varied\n"); |
| temp1 = test[2]; |
| } |
| if(temp1 == 0x02) { |
| printk(KERN_INFO "%s SVIDEO output\n", stdstr); |
| ivideo->vbflags |= TV_SVIDEO; |
| orSISIDXREG(SISCR, 0x32, 0x02); |
| andSISIDXREG(SISCR, 0x32, ~0x05); |
| } else if (temp1 == 0x01) { |
| printk(KERN_INFO "%s CVBS output\n", stdstr); |
| ivideo->vbflags |= TV_AVIDEO; |
| orSISIDXREG(SISCR, 0x32, 0x01); |
| andSISIDXREG(SISCR, 0x32, ~0x06); |
| } else { |
| SiS_SetCH70xxANDOR(&ivideo->SiS_Pr, 0x0e, 0x01, 0xF8); |
| andSISIDXREG(SISCR, 0x32, ~0x07); |
| } |
| } else if(temp1 == 0) { |
| SiS_SetCH70xxANDOR(&ivideo->SiS_Pr, 0x0e, 0x01, 0xF8); |
| andSISIDXREG(SISCR, 0x32, ~0x07); |
| } |
| /* Set general purpose IO for Chrontel communication */ |
| SiS_SetChrontelGPIO(&ivideo->SiS_Pr, 0x00); |
| #endif |
| |
| } else { |
| |
| #ifdef CONFIG_FB_SIS_315 |
| ivideo->SiS_Pr.SiS_IF_DEF_CH70xx = 2; /* Chrontel 7019 */ |
| temp1 = SiS_GetCH701x(&ivideo->SiS_Pr, 0x49); |
| SiS_SetCH701x(&ivideo->SiS_Pr, 0x49, 0x20); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x96); |
| temp2 = SiS_GetCH701x(&ivideo->SiS_Pr, 0x20); |
| temp2 |= 0x01; |
| SiS_SetCH701x(&ivideo->SiS_Pr, 0x20, temp2); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x96); |
| temp2 ^= 0x01; |
| SiS_SetCH701x(&ivideo->SiS_Pr, 0x20, temp2); |
| SiS_DDC2Delay(&ivideo->SiS_Pr, 0x96); |
| temp2 = SiS_GetCH701x(&ivideo->SiS_Pr, 0x20); |
| SiS_SetCH701x(&ivideo->SiS_Pr, 0x49, temp1); |
| temp1 = 0; |
| if(temp2 & 0x02) temp1 |= 0x01; |
| if(temp2 & 0x10) temp1 |= 0x01; |
| if(temp2 & 0x04) temp1 |= 0x02; |
| if( (temp1 & 0x01) && (temp1 & 0x02) ) temp1 = 0x04; |
| switch(temp1) { |
| case 0x01: |
| printk(KERN_INFO "%s CVBS output\n", stdstr); |
| ivideo->vbflags |= TV_AVIDEO; |
| orSISIDXREG(SISCR, 0x32, 0x01); |
| andSISIDXREG(SISCR, 0x32, ~0x06); |
| break; |
| case 0x02: |
| printk(KERN_INFO "%s SVIDEO output\n", stdstr); |
| ivideo->vbflags |= TV_SVIDEO; |
| orSISIDXREG(SISCR, 0x32, 0x02); |
| andSISIDXREG(SISCR, 0x32, ~0x05); |
| break; |
| case 0x04: |
| printk(KERN_INFO "%s SCART output\n", stdstr); |
| orSISIDXREG(SISCR, 0x32, 0x04); |
| andSISIDXREG(SISCR, 0x32, ~0x03); |
| break; |
| default: |
| andSISIDXREG(SISCR, 0x32, ~0x07); |
| } |
| #endif |
| } |
| } |
| |
| static void __devinit |
| sisfb_get_VB_type(struct sis_video_info *ivideo) |
| { |
| char stdstr[] = "sisfb: Detected"; |
| char bridgestr[] = "video bridge"; |
| u8 vb_chipid; |
| u8 reg; |
| |
| /* No CRT2 on XGI Z7 */ |
| if(ivideo->chip == XGI_20) |
| return; |
| |
| inSISIDXREG(SISPART4, 0x00, vb_chipid); |
| switch(vb_chipid) { |
| case 0x01: |
| inSISIDXREG(SISPART4, 0x01, reg); |
| if(reg < 0xb0) { |
| ivideo->vbflags |= VB_301; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_301; |
| printk(KERN_INFO "%s SiS301 %s\n", stdstr, bridgestr); |
| } else if(reg < 0xc0) { |
| ivideo->vbflags |= VB_301B; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_301B; |
| inSISIDXREG(SISPART4,0x23,reg); |
| if(!(reg & 0x02)) { |
| ivideo->vbflags |= VB_30xBDH; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_30xBDH; |
| printk(KERN_INFO "%s SiS301B-DH %s\n", stdstr, bridgestr); |
| } else { |
| printk(KERN_INFO "%s SiS301B %s\n", stdstr, bridgestr); |
| } |
| } else if(reg < 0xd0) { |
| ivideo->vbflags |= VB_301C; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_301C; |
| printk(KERN_INFO "%s SiS301C %s\n", stdstr, bridgestr); |
| } else if(reg < 0xe0) { |
| ivideo->vbflags |= VB_301LV; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_301LV; |
| printk(KERN_INFO "%s SiS301LV %s\n", stdstr, bridgestr); |
| } else if(reg <= 0xe1) { |
| inSISIDXREG(SISPART4,0x39,reg); |
| if(reg == 0xff) { |
| ivideo->vbflags |= VB_302LV; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_302LV; |
| printk(KERN_INFO "%s SiS302LV %s\n", stdstr, bridgestr); |
| } else { |
| ivideo->vbflags |= VB_301C; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_301C; |
| printk(KERN_INFO "%s SiS301C(P4) %s\n", stdstr, bridgestr); |
| #if 0 |
| ivideo->vbflags |= VB_302ELV; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_302ELV; |
| printk(KERN_INFO "%s SiS302ELV %s\n", stdstr, bridgestr); |
| #endif |
| } |
| } |
| break; |
| case 0x02: |
| ivideo->vbflags |= VB_302B; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_302B; |
| printk(KERN_INFO "%s SiS302B %s\n", stdstr, bridgestr); |
| break; |
| } |
| |
| if((!(ivideo->vbflags2 & VB2_VIDEOBRIDGE)) && (ivideo->chip != SIS_300)) { |
| inSISIDXREG(SISCR, 0x37, reg); |
| reg &= SIS_EXTERNAL_CHIP_MASK; |
| reg >>= 1; |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| #ifdef CONFIG_FB_SIS_300 |
| switch(reg) { |
| case SIS_EXTERNAL_CHIP_LVDS: |
| ivideo->vbflags |= VB_LVDS; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_LVDS; |
| break; |
| case SIS_EXTERNAL_CHIP_TRUMPION: |
| ivideo->vbflags |= (VB_LVDS | VB_TRUMPION); /* Deprecated */ |
| ivideo->vbflags2 |= (VB2_LVDS | VB2_TRUMPION); |
| break; |
| case SIS_EXTERNAL_CHIP_CHRONTEL: |
| ivideo->vbflags |= VB_CHRONTEL; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_CHRONTEL; |
| break; |
| case SIS_EXTERNAL_CHIP_LVDS_CHRONTEL: |
| ivideo->vbflags |= (VB_LVDS | VB_CHRONTEL); /* Deprecated */ |
| ivideo->vbflags2 |= (VB2_LVDS | VB2_CHRONTEL); |
| break; |
| } |
| if(ivideo->vbflags2 & VB2_CHRONTEL) ivideo->chronteltype = 1; |
| #endif |
| } else if(ivideo->chip < SIS_661) { |
| #ifdef CONFIG_FB_SIS_315 |
| switch (reg) { |
| case SIS310_EXTERNAL_CHIP_LVDS: |
| ivideo->vbflags |= VB_LVDS; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_LVDS; |
| break; |
| case SIS310_EXTERNAL_CHIP_LVDS_CHRONTEL: |
| ivideo->vbflags |= (VB_LVDS | VB_CHRONTEL); /* Deprecated */ |
| ivideo->vbflags2 |= (VB2_LVDS | VB2_CHRONTEL); |
| break; |
| } |
| if(ivideo->vbflags2 & VB2_CHRONTEL) ivideo->chronteltype = 2; |
| #endif |
| } else if(ivideo->chip >= SIS_661) { |
| #ifdef CONFIG_FB_SIS_315 |
| inSISIDXREG(SISCR, 0x38, reg); |
| reg >>= 5; |
| switch(reg) { |
| case 0x02: |
| ivideo->vbflags |= VB_LVDS; /* Deprecated */ |
| ivideo->vbflags2 |= VB2_LVDS; |
| break; |
| case 0x03: |
| ivideo->vbflags |= (VB_LVDS | VB_CHRONTEL); /* Deprecated */ |
| ivideo->vbflags2 |= (VB2_LVDS | VB2_CHRONTEL); |
| break; |
| case 0x04: |
| ivideo->vbflags |= (VB_LVDS | VB_CONEXANT); /* Deprecated */ |
| ivideo->vbflags2 |= (VB2_LVDS | VB2_CONEXANT); |
| break; |
| } |
| if(ivideo->vbflags2 & VB2_CHRONTEL) ivideo->chronteltype = 2; |
| #endif |
| } |
| if(ivideo->vbflags2 & VB2_LVDS) { |
| printk(KERN_INFO "%s LVDS transmitter\n", stdstr); |
| } |
| if((ivideo->sisvga_engine == SIS_300_VGA) && (ivideo->vbflags2 & VB2_TRUMPION)) { |
| printk(KERN_INFO "%s Trumpion Zurac LCD scaler\n", stdstr); |
| } |
| if(ivideo->vbflags2 & VB2_CHRONTEL) { |
| printk(KERN_INFO "%s Chrontel TV encoder\n", stdstr); |
| } |
| if((ivideo->chip >= SIS_661) && (ivideo->vbflags2 & VB2_CONEXANT)) { |
| printk(KERN_INFO "%s Conexant external device\n", stdstr); |
| } |
| } |
| |
| if(ivideo->vbflags2 & VB2_SISBRIDGE) { |
| SiS_SenseLCD(ivideo); |
| SiS_Sense30x(ivideo); |
| } else if(ivideo->vbflags2 & VB2_CHRONTEL) { |
| SiS_SenseCh(ivideo); |
| } |
| } |
| |
| /* ---------- Engine initialization routines ------------ */ |
| |
| static void |
| sisfb_engine_init(struct sis_video_info *ivideo) |
| { |
| |
| /* Initialize command queue (we use MMIO only) */ |
| |
| /* BEFORE THIS IS CALLED, THE ENGINES *MUST* BE SYNC'ED */ |
| |
| ivideo->caps &= ~(TURBO_QUEUE_CAP | |
| MMIO_CMD_QUEUE_CAP | |
| VM_CMD_QUEUE_CAP | |
| AGP_CMD_QUEUE_CAP); |
| |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| u32 tqueue_pos; |
| u8 tq_state; |
| |
| tqueue_pos = (ivideo->video_size - ivideo->cmdQueueSize) / (64 * 1024); |
| |
| inSISIDXREG(SISSR, IND_SIS_TURBOQUEUE_SET, tq_state); |
| tq_state |= 0xf0; |
| tq_state &= 0xfc; |
| tq_state |= (u8)(tqueue_pos >> 8); |
| outSISIDXREG(SISSR, IND_SIS_TURBOQUEUE_SET, tq_state); |
| |
| outSISIDXREG(SISSR, IND_SIS_TURBOQUEUE_ADR, (u8)(tqueue_pos & 0xff)); |
| |
| ivideo->caps |= TURBO_QUEUE_CAP; |
| } |
| #endif |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| u32 tempq = 0, templ; |
| u8 temp; |
| |
| if(ivideo->chip == XGI_20) { |
| switch(ivideo->cmdQueueSize) { |
| case (64 * 1024): |
| temp = SIS_CMD_QUEUE_SIZE_Z7_64k; |
| break; |
| case (128 * 1024): |
| default: |
| temp = SIS_CMD_QUEUE_SIZE_Z7_128k; |
| } |
| } else { |
| switch(ivideo->cmdQueueSize) { |
| case (4 * 1024 * 1024): |
| temp = SIS_CMD_QUEUE_SIZE_4M; |
| break; |
| case (2 * 1024 * 1024): |
| temp = SIS_CMD_QUEUE_SIZE_2M; |
| break; |
| case (1 * 1024 * 1024): |
| temp = SIS_CMD_QUEUE_SIZE_1M; |
| break; |
| default: |
| case (512 * 1024): |
| temp = SIS_CMD_QUEUE_SIZE_512k; |
| } |
| } |
| |
| outSISIDXREG(SISSR, IND_SIS_CMDQUEUE_THRESHOLD, COMMAND_QUEUE_THRESHOLD); |
| outSISIDXREG(SISSR, IND_SIS_CMDQUEUE_SET, SIS_CMD_QUEUE_RESET); |
| |
| if((ivideo->chip >= XGI_40) && ivideo->modechanged) { |
| /* Must disable dual pipe on XGI_40. Can't do |
| * this in MMIO mode, because it requires |
| * setting/clearing a bit in the MMIO fire trigger |
| * register. |
| */ |
| if(!((templ = MMIO_IN32(ivideo->mmio_vbase, 0x8240)) & (1 << 10))) { |
| |
| MMIO_OUT32(ivideo->mmio_vbase, Q_WRITE_PTR, 0); |
| |
| outSISIDXREG(SISSR, IND_SIS_CMDQUEUE_SET, (temp | SIS_VRAM_CMDQUEUE_ENABLE)); |
| |
| tempq = MMIO_IN32(ivideo->mmio_vbase, Q_READ_PTR); |
| MMIO_OUT32(ivideo->mmio_vbase, Q_WRITE_PTR, tempq); |
| |
| tempq = (u32)(ivideo->video_size - ivideo->cmdQueueSize); |
| MMIO_OUT32(ivideo->mmio_vbase, Q_BASE_ADDR, tempq); |
| |
| writel(0x16800000 + 0x8240, ivideo->video_vbase + tempq); |
| writel(templ | (1 << 10), ivideo->video_vbase + tempq + 4); |
| writel(0x168F0000, ivideo->video_vbase + tempq + 8); |
| writel(0x168F0000, ivideo->video_vbase + tempq + 12); |
| |
| MMIO_OUT32(ivideo->mmio_vbase, Q_WRITE_PTR, (tempq + 16)); |
| |
| sisfb_syncaccel(ivideo); |
| |
| outSISIDXREG(SISSR, IND_SIS_CMDQUEUE_SET, SIS_CMD_QUEUE_RESET); |
| |
| } |
| } |
| |
| tempq = MMIO_IN32(ivideo->mmio_vbase, MMIO_QUEUE_READPORT); |
| MMIO_OUT32(ivideo->mmio_vbase, MMIO_QUEUE_WRITEPORT, tempq); |
| |
| temp |= (SIS_MMIO_CMD_ENABLE | SIS_CMD_AUTO_CORR); |
| outSISIDXREG(SISSR, IND_SIS_CMDQUEUE_SET, temp); |
| |
| tempq = (u32)(ivideo->video_size - ivideo->cmdQueueSize); |
| MMIO_OUT32(ivideo->mmio_vbase, MMIO_QUEUE_PHYBASE, tempq); |
| |
| ivideo->caps |= MMIO_CMD_QUEUE_CAP; |
| } |
| #endif |
| |
| ivideo->engineok = 1; |
| } |
| |
| static void __devinit |
| sisfb_detect_lcd_type(struct sis_video_info *ivideo) |
| { |
| u8 reg; |
| int i; |
| |
| inSISIDXREG(SISCR, 0x36, reg); |
| reg &= 0x0f; |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| ivideo->CRT2LCDType = sis300paneltype[reg]; |
| } else if(ivideo->chip >= SIS_661) { |
| ivideo->CRT2LCDType = sis661paneltype[reg]; |
| } else { |
| ivideo->CRT2LCDType = sis310paneltype[reg]; |
| if((ivideo->chip == SIS_550) && (sisfb_fstn)) { |
| if((ivideo->CRT2LCDType != LCD_320x240_2) && |
| (ivideo->CRT2LCDType != LCD_320x240_3)) { |
| ivideo->CRT2LCDType = LCD_320x240; |
| } |
| } |
| } |
| |
| if(ivideo->CRT2LCDType == LCD_UNKNOWN) { |
| /* For broken BIOSes: Assume 1024x768, RGB18 */ |
| ivideo->CRT2LCDType = LCD_1024x768; |
| setSISIDXREG(SISCR,0x36,0xf0,0x02); |
| setSISIDXREG(SISCR,0x37,0xee,0x01); |
| printk(KERN_DEBUG "sisfb: Invalid panel ID (%02x), assuming 1024x768, RGB18\n", reg); |
| } |
| |
| for(i = 0; i < SIS_LCD_NUMBER; i++) { |
| if(ivideo->CRT2LCDType == sis_lcd_data[i].lcdtype) { |
| ivideo->lcdxres = sis_lcd_data[i].xres; |
| ivideo->lcdyres = sis_lcd_data[i].yres; |
| ivideo->lcddefmodeidx = sis_lcd_data[i].default_mode_idx; |
| break; |
| } |
| } |
| |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->SiS_Pr.SiS_CustomT == CUT_BARCO1366) { |
| ivideo->lcdxres = 1360; ivideo->lcdyres = 1024; |
| ivideo->lcddefmodeidx = DEFAULT_MODE_1360; |
| } else if(ivideo->SiS_Pr.SiS_CustomT == CUT_PANEL848) { |
| ivideo->lcdxres = 848; ivideo->lcdyres = 480; |
| ivideo->lcddefmodeidx = DEFAULT_MODE_848; |
| } else if(ivideo->SiS_Pr.SiS_CustomT == CUT_PANEL856) { |
| ivideo->lcdxres = 856; ivideo->lcdyres = 480; |
| ivideo->lcddefmodeidx = DEFAULT_MODE_856; |
| } |
| #endif |
| |
| printk(KERN_DEBUG "sisfb: Detected %dx%d flat panel\n", |
| ivideo->lcdxres, ivideo->lcdyres); |
| } |
| |
| static void __devinit |
| sisfb_save_pdc_emi(struct sis_video_info *ivideo) |
| { |
| #ifdef CONFIG_FB_SIS_300 |
| /* Save the current PanelDelayCompensation if the LCD is currently used */ |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| if(ivideo->vbflags2 & (VB2_LVDS | VB2_30xBDH)) { |
| int tmp; |
| inSISIDXREG(SISCR,0x30,tmp); |
| if(tmp & 0x20) { |
| /* Currently on LCD? If yes, read current pdc */ |
| inSISIDXREG(SISPART1,0x13,ivideo->detectedpdc); |
| ivideo->detectedpdc &= 0x3c; |
| if(ivideo->SiS_Pr.PDC == -1) { |
| /* Let option override detection */ |
| ivideo->SiS_Pr.PDC = ivideo->detectedpdc; |
| } |
| printk(KERN_INFO "sisfb: Detected LCD PDC 0x%02x\n", |
| ivideo->detectedpdc); |
| } |
| if((ivideo->SiS_Pr.PDC != -1) && |
| (ivideo->SiS_Pr.PDC != ivideo->detectedpdc)) { |
| printk(KERN_INFO "sisfb: Using LCD PDC 0x%02x\n", |
| ivideo->SiS_Pr.PDC); |
| } |
| } |
| } |
| #endif |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| |
| /* Try to find about LCDA */ |
| if(ivideo->vbflags2 & VB2_SISLCDABRIDGE) { |
| int tmp; |
| inSISIDXREG(SISPART1,0x13,tmp); |
| if(tmp & 0x04) { |
| ivideo->SiS_Pr.SiS_UseLCDA = TRUE; |
| ivideo->detectedlcda = 0x03; |
| } |
| } |
| |
| /* Save PDC */ |
| if(ivideo->vbflags2 & VB2_SISLVDSBRIDGE) { |
| int tmp; |
| inSISIDXREG(SISCR,0x30,tmp); |
| if((tmp & 0x20) || (ivideo->detectedlcda != 0xff)) { |
| /* Currently on LCD? If yes, read current pdc */ |
| u8 pdc; |
| inSISIDXREG(SISPART1,0x2D,pdc); |
| ivideo->detectedpdc = (pdc & 0x0f) << 1; |
| ivideo->detectedpdca = (pdc & 0xf0) >> 3; |
| inSISIDXREG(SISPART1,0x35,pdc); |
| ivideo->detectedpdc |= ((pdc >> 7) & 0x01); |
| inSISIDXREG(SISPART1,0x20,pdc); |
| ivideo->detectedpdca |= ((pdc >> 6) & 0x01); |
| if(ivideo->newrom) { |
| /* New ROM invalidates other PDC resp. */ |
| if(ivideo->detectedlcda != 0xff) { |
| ivideo->detectedpdc = 0xff; |
| } else { |
| ivideo->detectedpdca = 0xff; |
| } |
| } |
| if(ivideo->SiS_Pr.PDC == -1) { |
| if(ivideo->detectedpdc != 0xff) { |
| ivideo->SiS_Pr.PDC = ivideo->detectedpdc; |
| } |
| } |
| if(ivideo->SiS_Pr.PDCA == -1) { |
| if(ivideo->detectedpdca != 0xff) { |
| ivideo->SiS_Pr.PDCA = ivideo->detectedpdca; |
| } |
| } |
| if(ivideo->detectedpdc != 0xff) { |
| printk(KERN_INFO |
| "sisfb: Detected LCD PDC 0x%02x (for LCD=CRT2)\n", |
| ivideo->detectedpdc); |
| } |
| if(ivideo->detectedpdca != 0xff) { |
| printk(KERN_INFO |
| "sisfb: Detected LCD PDC1 0x%02x (for LCD=CRT1)\n", |
| ivideo->detectedpdca); |
| } |
| } |
| |
| /* Save EMI */ |
| if(ivideo->vbflags2 & VB2_SISEMIBRIDGE) { |
| inSISIDXREG(SISPART4,0x30,ivideo->SiS_Pr.EMI_30); |
| inSISIDXREG(SISPART4,0x31,ivideo->SiS_Pr.EMI_31); |
| inSISIDXREG(SISPART4,0x32,ivideo->SiS_Pr.EMI_32); |
| inSISIDXREG(SISPART4,0x33,ivideo->SiS_Pr.EMI_33); |
| ivideo->SiS_Pr.HaveEMI = TRUE; |
| if((tmp & 0x20) || (ivideo->detectedlcda != 0xff)) { |
| ivideo->SiS_Pr.HaveEMILCD = TRUE; |
| } |
| } |
| } |
| |
| /* Let user override detected PDCs (all bridges) */ |
| if(ivideo->vbflags2 & VB2_30xBLV) { |
| if((ivideo->SiS_Pr.PDC != -1) && |
| (ivideo->SiS_Pr.PDC != ivideo->detectedpdc)) { |
| printk(KERN_INFO "sisfb: Using LCD PDC 0x%02x (for LCD=CRT2)\n", |
| ivideo->SiS_Pr.PDC); |
| } |
| if((ivideo->SiS_Pr.PDCA != -1) && |
| (ivideo->SiS_Pr.PDCA != ivideo->detectedpdca)) { |
| printk(KERN_INFO "sisfb: Using LCD PDC1 0x%02x (for LCD=CRT1)\n", |
| ivideo->SiS_Pr.PDCA); |
| } |
| } |
| |
| } |
| #endif |
| } |
| |
| /* -------------------- Memory manager routines ---------------------- */ |
| |
| static u32 __devinit |
| sisfb_getheapstart(struct sis_video_info *ivideo) |
| { |
| u32 ret = ivideo->sisfb_parm_mem * 1024; |
| u32 maxoffs = ivideo->video_size - ivideo->hwcursor_size - ivideo->cmdQueueSize; |
| u32 def; |
| |
| /* Calculate heap start = end of memory for console |
| * |
| * CCCCCCCCDDDDDDDDDDDDDDDDDDDDDDDDDDDDHHHHQQQQQQQQQQ |
| * C = console, D = heap, H = HWCursor, Q = cmd-queue |
| * |
| * On 76x in UMA+LFB mode, the layout is as follows: |
| * DDDDDDDDDDDCCCCCCCCCCCCCCCCCCCCCCCCHHHHQQQQQQQQQQQ |
| * where the heap is the entire UMA area, eventually |
| * into the LFB area if the given mem parameter is |
| * higher than the size of the UMA memory. |
| * |
| * Basically given by "mem" parameter |
| * |
| * maximum = videosize - cmd_queue - hwcursor |
| * (results in a heap of size 0) |
| * default = SiS 300: depends on videosize |
| * SiS 315/330/340/XGI: 32k below max |
| */ |
| |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| if(ivideo->video_size > 0x1000000) { |
| def = 0xc00000; |
| } else if(ivideo->video_size > 0x800000) { |
| def = 0x800000; |
| } else { |
| def = 0x400000; |
| } |
| } else if(ivideo->UMAsize && ivideo->LFBsize) { |
| ret = def = 0; |
| } else { |
| def = maxoffs - 0x8000; |
| } |
| |
| /* Use default for secondary card for now (FIXME) */ |
| if((!ret) || (ret > maxoffs) || (ivideo->cardnumber != 0)) |
| ret = def; |
| |
| return ret; |
| } |
| |
| static u32 __devinit |
| sisfb_getheapsize(struct sis_video_info *ivideo) |
| { |
| u32 max = ivideo->video_size - ivideo->hwcursor_size - ivideo->cmdQueueSize; |
| u32 ret = 0; |
| |
| if(ivideo->UMAsize && ivideo->LFBsize) { |
| if( (!ivideo->sisfb_parm_mem) || |
| ((ivideo->sisfb_parm_mem * 1024) > max) || |
| ((max - (ivideo->sisfb_parm_mem * 1024)) < ivideo->UMAsize) ) { |
| ret = ivideo->UMAsize; |
| max -= ivideo->UMAsize; |
| } else { |
| ret = max - (ivideo->sisfb_parm_mem * 1024); |
| max = ivideo->sisfb_parm_mem * 1024; |
| } |
| ivideo->video_offset = ret; |
| ivideo->sisfb_mem = max; |
| } else { |
| ret = max - ivideo->heapstart; |
| ivideo->sisfb_mem = ivideo->heapstart; |
| } |
| |
| return ret; |
| } |
| |
| static int __devinit |
| sisfb_heap_init(struct sis_video_info *ivideo) |
| { |
| struct SIS_OH *poh; |
| |
| ivideo->video_offset = 0; |
| if(ivideo->sisfb_parm_mem) { |
| if( (ivideo->sisfb_parm_mem < (2 * 1024 * 1024)) || |
| (ivideo->sisfb_parm_mem > ivideo->video_size) ) { |
| ivideo->sisfb_parm_mem = 0; |
| } |
| } |
| |
| ivideo->heapstart = sisfb_getheapstart(ivideo); |
| ivideo->sisfb_heap_size = sisfb_getheapsize(ivideo); |
| |
| ivideo->sisfb_heap_start = ivideo->video_vbase + ivideo->heapstart; |
| ivideo->sisfb_heap_end = ivideo->sisfb_heap_start + ivideo->sisfb_heap_size; |
| |
| printk(KERN_INFO "sisfb: Memory heap starting at %dK, size %dK\n", |
| (int)(ivideo->heapstart / 1024), (int)(ivideo->sisfb_heap_size / 1024)); |
| |
| ivideo->sisfb_heap.vinfo = ivideo; |
| |
| ivideo->sisfb_heap.poha_chain = NULL; |
| ivideo->sisfb_heap.poh_freelist = NULL; |
| |
| poh = sisfb_poh_new_node(&ivideo->sisfb_heap); |
| if(poh == NULL) |
| return 1; |
| |
| poh->poh_next = &ivideo->sisfb_heap.oh_free; |
| poh->poh_prev = &ivideo->sisfb_heap.oh_free; |
| poh->size = ivideo->sisfb_heap_size; |
| poh->offset = ivideo->heapstart; |
| |
| ivideo->sisfb_heap.oh_free.poh_next = poh; |
| ivideo->sisfb_heap.oh_free.poh_prev = poh; |
| ivideo->sisfb_heap.oh_free.size = 0; |
| ivideo->sisfb_heap.max_freesize = poh->size; |
| |
| ivideo->sisfb_heap.oh_used.poh_next = &ivideo->sisfb_heap.oh_used; |
| ivideo->sisfb_heap.oh_used.poh_prev = &ivideo->sisfb_heap.oh_used; |
| ivideo->sisfb_heap.oh_used.size = SENTINEL; |
| |
| if(ivideo->cardnumber == 0) { |
| /* For the first card, make this heap the "global" one |
| * for old DRM (which could handle only one card) |
| */ |
| sisfb_heap = &ivideo->sisfb_heap; |
| } |
| |
| return 0; |
| } |
| |
| static struct SIS_OH * |
| sisfb_poh_new_node(struct SIS_HEAP *memheap) |
| { |
| struct SIS_OHALLOC *poha; |
| struct SIS_OH *poh; |
| unsigned long cOhs; |
| int i; |
| |
| if(memheap->poh_freelist == NULL) { |
| poha = kmalloc(SIS_OH_ALLOC_SIZE, GFP_KERNEL); |
| if(!poha) |
| return NULL; |
| |
| poha->poha_next = memheap->poha_chain; |
| memheap->poha_chain = poha; |
| |
| cOhs = (SIS_OH_ALLOC_SIZE - sizeof(struct SIS_OHALLOC)) / sizeof(struct SIS_OH) + 1; |
| |
| poh = &poha->aoh[0]; |
| for(i = cOhs - 1; i != 0; i--) { |
| poh->poh_next = poh + 1; |
| poh = poh + 1; |
| } |
| |
| poh->poh_next = NULL; |
| memheap->poh_freelist = &poha->aoh[0]; |
| } |
| |
| poh = memheap->poh_freelist; |
| memheap->poh_freelist = poh->poh_next; |
| |
| return poh; |
| } |
| |
| static struct SIS_OH * |
| sisfb_poh_allocate(struct SIS_HEAP *memheap, u32 size) |
| { |
| struct SIS_OH *pohThis; |
| struct SIS_OH *pohRoot; |
| int bAllocated = 0; |
| |
| if(size > memheap->max_freesize) { |
| DPRINTK("sisfb: Can't allocate %dk video memory\n", |
| (unsigned int) size / 1024); |
| return NULL; |
| } |
| |
| pohThis = memheap->oh_free.poh_next; |
| |
| while(pohThis != &memheap->oh_free) { |
| if(size <= pohThis->size) { |
| bAllocated = 1; |
| break; |
| } |
| pohThis = pohThis->poh_next; |
| } |
| |
| if(!bAllocated) { |
| DPRINTK("sisfb: Can't allocate %dk video memory\n", |
| (unsigned int) size / 1024); |
| return NULL; |
| } |
| |
| if(size == pohThis->size) { |
| pohRoot = pohThis; |
| sisfb_delete_node(pohThis); |
| } else { |
| pohRoot = sisfb_poh_new_node(memheap); |
| if(pohRoot == NULL) |
| return NULL; |
| |
| pohRoot->offset = pohThis->offset; |
| pohRoot->size = size; |
| |
| pohThis->offset += size; |
| pohThis->size -= size; |
| } |
| |
| memheap->max_freesize -= size; |
| |
| pohThis = &memheap->oh_used; |
| sisfb_insert_node(pohThis, pohRoot); |
| |
| return pohRoot; |
| } |
| |
| static void |
| sisfb_delete_node(struct SIS_OH *poh) |
| { |
| poh->poh_prev->poh_next = poh->poh_next; |
| poh->poh_next->poh_prev = poh->poh_prev; |
| } |
| |
| static void |
| sisfb_insert_node(struct SIS_OH *pohList, struct SIS_OH *poh) |
| { |
| struct SIS_OH *pohTemp = pohList->poh_next; |
| |
| pohList->poh_next = poh; |
| pohTemp->poh_prev = poh; |
| |
| poh->poh_prev = pohList; |
| poh->poh_next = pohTemp; |
| } |
| |
| static struct SIS_OH * |
| sisfb_poh_free(struct SIS_HEAP *memheap, u32 base) |
| { |
| struct SIS_OH *pohThis; |
| struct SIS_OH *poh_freed; |
| struct SIS_OH *poh_prev; |
| struct SIS_OH *poh_next; |
| u32 ulUpper; |
| u32 ulLower; |
| int foundNode = 0; |
| |
| poh_freed = memheap->oh_used.poh_next; |
| |
| while(poh_freed != &memheap->oh_used) { |
| if(poh_freed->offset == base) { |
| foundNode = 1; |
| break; |
| } |
| |
| poh_freed = poh_freed->poh_next; |
| } |
| |
| if(!foundNode) |
| return NULL; |
| |
| memheap->max_freesize += poh_freed->size; |
| |
| poh_prev = poh_next = NULL; |
| ulUpper = poh_freed->offset + poh_freed->size; |
| ulLower = poh_freed->offset; |
| |
| pohThis = memheap->oh_free.poh_next; |
| |
| while(pohThis != &memheap->oh_free) { |
| if(pohThis->offset == ulUpper) { |
| poh_next = pohThis; |
| } else if((pohThis->offset + pohThis->size) == ulLower) { |
| poh_prev = pohThis; |
| } |
| pohThis = pohThis->poh_next; |
| } |
| |
| sisfb_delete_node(poh_freed); |
| |
| if(poh_prev && poh_next) { |
| poh_prev->size += (poh_freed->size + poh_next->size); |
| sisfb_delete_node(poh_next); |
| sisfb_free_node(memheap, poh_freed); |
| sisfb_free_node(memheap, poh_next); |
| return poh_prev; |
| } |
| |
| if(poh_prev) { |
| poh_prev->size += poh_freed->size; |
| sisfb_free_node(memheap, poh_freed); |
| return poh_prev; |
| } |
| |
| if(poh_next) { |
| poh_next->size += poh_freed->size; |
| poh_next->offset = poh_freed->offset; |
| sisfb_free_node(memheap, poh_freed); |
| return poh_next; |
| } |
| |
| sisfb_insert_node(&memheap->oh_free, poh_freed); |
| |
| return poh_freed; |
| } |
| |
| static void |
| sisfb_free_node(struct SIS_HEAP *memheap, struct SIS_OH *poh) |
| { |
| if(poh == NULL) |
| return; |
| |
| poh->poh_next = memheap->poh_freelist; |
| memheap->poh_freelist = poh; |
| } |
| |
| static void |
| sis_int_malloc(struct sis_video_info *ivideo, struct sis_memreq *req) |
| { |
| struct SIS_OH *poh = NULL; |
| |
| if((ivideo) && (ivideo->sisfb_id == SISFB_ID) && (!ivideo->havenoheap)) |
| poh = sisfb_poh_allocate(&ivideo->sisfb_heap, (u32)req->size); |
| |
| if(poh == NULL) { |
| req->offset = req->size = 0; |
| DPRINTK("sisfb: Video RAM allocation failed\n"); |
| } else { |
| req->offset = poh->offset; |
| req->size = poh->size; |
| DPRINTK("sisfb: Video RAM allocation succeeded: 0x%lx\n", |
| (poh->offset + ivideo->video_vbase)); |
| } |
| } |
| |
| void |
| sis_malloc(struct sis_memreq *req) |
| { |
| struct sis_video_info *ivideo = sisfb_heap->vinfo; |
| |
| if(&ivideo->sisfb_heap == sisfb_heap) |
| sis_int_malloc(ivideo, req); |
| else |
| req->offset = req->size = 0; |
| } |
| |
| void |
| sis_malloc_new(struct pci_dev *pdev, struct sis_memreq *req) |
| { |
| struct sis_video_info *ivideo = pci_get_drvdata(pdev); |
| |
| sis_int_malloc(ivideo, req); |
| } |
| |
| /* sis_free: u32 because "base" is offset inside video ram, can never be >4GB */ |
| |
| static void |
| sis_int_free(struct sis_video_info *ivideo, u32 base) |
| { |
| struct SIS_OH *poh; |
| |
| if((!ivideo) || (ivideo->sisfb_id != SISFB_ID) || (ivideo->havenoheap)) |
| return; |
| |
| poh = sisfb_poh_free(&ivideo->sisfb_heap, base); |
| |
| if(poh == NULL) { |
| DPRINTK("sisfb: sisfb_poh_free() failed at base 0x%x\n", |
| (unsigned int) base); |
| } |
| } |
| |
| void |
| sis_free(u32 base) |
| { |
| struct sis_video_info *ivideo = sisfb_heap->vinfo; |
| |
| sis_int_free(ivideo, base); |
| } |
| |
| void |
| sis_free_new(struct pci_dev *pdev, u32 base) |
| { |
| struct sis_video_info *ivideo = pci_get_drvdata(pdev); |
| |
| sis_int_free(ivideo, base); |
| } |
| |
| /* --------------------- SetMode routines ------------------------- */ |
| |
| static void |
| sisfb_check_engine_and_sync(struct sis_video_info *ivideo) |
| { |
| u8 cr30, cr31; |
| |
| /* Check if MMIO and engines are enabled, |
| * and sync in case they are. Can't use |
| * ivideo->accel here, as this might have |
| * been changed before this is called. |
| */ |
| inSISIDXREG(SISSR, IND_SIS_PCI_ADDRESS_SET, cr30); |
| inSISIDXREG(SISSR, IND_SIS_MODULE_ENABLE, cr31); |
| /* MMIO and 2D/3D engine enabled? */ |
| if((cr30 & SIS_MEM_MAP_IO_ENABLE) && (cr31 & 0x42)) { |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| /* Don't care about TurboQueue. It's |
| * enough to know that the engines |
| * are enabled |
| */ |
| sisfb_syncaccel(ivideo); |
| } |
| #endif |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| /* Check that any queue mode is |
| * enabled, and that the queue |
| * is not in the state of "reset" |
| */ |
| inSISIDXREG(SISSR, 0x26, cr30); |
| if((cr30 & 0xe0) && (!(cr30 & 0x01))) { |
| sisfb_syncaccel(ivideo); |
| } |
| } |
| #endif |
| } |
| } |
| |
| static void |
| sisfb_pre_setmode(struct sis_video_info *ivideo) |
| { |
| u8 cr30 = 0, cr31 = 0, cr33 = 0, cr35 = 0, cr38 = 0; |
| int tvregnum = 0; |
| |
| ivideo->currentvbflags &= (VB_VIDEOBRIDGE | VB_DISPTYPE_DISP2); |
| |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| |
| inSISIDXREG(SISCR, 0x31, cr31); |
| cr31 &= ~0x60; |
| cr31 |= 0x04; |
| |
| cr33 = ivideo->rate_idx & 0x0F; |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| if(ivideo->chip >= SIS_661) { |
| inSISIDXREG(SISCR, 0x38, cr38); |
| cr38 &= ~0x07; /* Clear LCDA/DualEdge and YPbPr bits */ |
| } else { |
| tvregnum = 0x38; |
| inSISIDXREG(SISCR, tvregnum, cr38); |
| cr38 &= ~0x3b; /* Clear LCDA/DualEdge and YPbPr bits */ |
| } |
| } |
| #endif |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| tvregnum = 0x35; |
| inSISIDXREG(SISCR, tvregnum, cr38); |
| } |
| #endif |
| |
| SiS_SetEnableDstn(&ivideo->SiS_Pr, FALSE); |
| SiS_SetEnableFstn(&ivideo->SiS_Pr, FALSE); |
| ivideo->curFSTN = ivideo->curDSTN = 0; |
| |
| switch(ivideo->currentvbflags & VB_DISPTYPE_DISP2) { |
| |
| case CRT2_TV: |
| cr38 &= ~0xc0; /* Clear PAL-M / PAL-N bits */ |
| if((ivideo->vbflags & TV_YPBPR) && (ivideo->vbflags2 & VB2_SISYPBPRBRIDGE)) { |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->chip >= SIS_661) { |
| cr38 |= 0x04; |
| if(ivideo->vbflags & TV_YPBPR525P) cr35 |= 0x20; |
| else if(ivideo->vbflags & TV_YPBPR750P) cr35 |= 0x40; |
| else if(ivideo->vbflags & TV_YPBPR1080I) cr35 |= 0x60; |
| cr30 |= SIS_SIMULTANEOUS_VIEW_ENABLE; |
| cr35 &= ~0x01; |
| ivideo->currentvbflags |= (TV_YPBPR | (ivideo->vbflags & TV_YPBPRALL)); |
| } else if(ivideo->sisvga_engine == SIS_315_VGA) { |
| cr30 |= (0x80 | SIS_SIMULTANEOUS_VIEW_ENABLE); |
| cr38 |= 0x08; |
| if(ivideo->vbflags & TV_YPBPR525P) cr38 |= 0x10; |
| else if(ivideo->vbflags & TV_YPBPR750P) cr38 |= 0x20; |
| else if(ivideo->vbflags & TV_YPBPR1080I) cr38 |= 0x30; |
| cr31 &= ~0x01; |
| ivideo->currentvbflags |= (TV_YPBPR | (ivideo->vbflags & TV_YPBPRALL)); |
| } |
| #endif |
| } else if((ivideo->vbflags & TV_HIVISION) && |
| (ivideo->vbflags2 & VB2_SISHIVISIONBRIDGE)) { |
| if(ivideo->chip >= SIS_661) { |
| cr38 |= 0x04; |
| cr35 |= 0x60; |
| } else { |
| cr30 |= 0x80; |
| } |
| cr30 |= SIS_SIMULTANEOUS_VIEW_ENABLE; |
| cr31 |= 0x01; |
| cr35 |= 0x01; |
| ivideo->currentvbflags |= TV_HIVISION; |
| } else if(ivideo->vbflags & TV_SCART) { |
| cr30 = (SIS_VB_OUTPUT_SCART | SIS_SIMULTANEOUS_VIEW_ENABLE); |
| cr31 |= 0x01; |
| cr35 |= 0x01; |
| ivideo->currentvbflags |= TV_SCART; |
| } else { |
| if(ivideo->vbflags & TV_SVIDEO) { |
| cr30 = (SIS_VB_OUTPUT_SVIDEO | SIS_SIMULTANEOUS_VIEW_ENABLE); |
| ivideo->currentvbflags |= TV_SVIDEO; |
| } |
| if(ivideo->vbflags & TV_AVIDEO) { |
| cr30 = (SIS_VB_OUTPUT_COMPOSITE | SIS_SIMULTANEOUS_VIEW_ENABLE); |
| ivideo->currentvbflags |= TV_AVIDEO; |
| } |
| } |
| cr31 |= SIS_DRIVER_MODE; |
| |
| if(ivideo->vbflags & (TV_AVIDEO | TV_SVIDEO)) { |
| if(ivideo->vbflags & TV_PAL) { |
| cr31 |= 0x01; cr35 |= 0x01; |
| ivideo->currentvbflags |= TV_PAL; |
| if(ivideo->vbflags & TV_PALM) { |
| cr38 |= 0x40; cr35 |= 0x04; |
| ivideo->currentvbflags |= TV_PALM; |
| } else if(ivideo->vbflags & TV_PALN) { |
| cr38 |= 0x80; cr35 |= 0x08; |
| ivideo->currentvbflags |= TV_PALN; |
| } |
| } else { |
| cr31 &= ~0x01; cr35 &= ~0x01; |
| ivideo->currentvbflags |= TV_NTSC; |
| if(ivideo->vbflags & TV_NTSCJ) { |
| cr38 |= 0x40; cr35 |= 0x02; |
| ivideo->currentvbflags |= TV_NTSCJ; |
| } |
| } |
| } |
| break; |
| |
| case CRT2_LCD: |
| cr30 = (SIS_VB_OUTPUT_LCD | SIS_SIMULTANEOUS_VIEW_ENABLE); |
| cr31 |= SIS_DRIVER_MODE; |
| SiS_SetEnableDstn(&ivideo->SiS_Pr, ivideo->sisfb_dstn); |
| SiS_SetEnableFstn(&ivideo->SiS_Pr, ivideo->sisfb_fstn); |
| ivideo->curFSTN = ivideo->sisfb_fstn; |
| ivideo->curDSTN = ivideo->sisfb_dstn; |
| break; |
| |
| case CRT2_VGA: |
| cr30 = (SIS_VB_OUTPUT_CRT2 | SIS_SIMULTANEOUS_VIEW_ENABLE); |
| cr31 |= SIS_DRIVER_MODE; |
| if(ivideo->sisfb_nocrt2rate) { |
| cr33 |= (sisbios_mode[ivideo->sisfb_mode_idx].rate_idx << 4); |
| } else { |
| cr33 |= ((ivideo->rate_idx & 0x0F) << 4); |
| } |
| break; |
| |
| default: /* disable CRT2 */ |
| cr30 = 0x00; |
| cr31 |= (SIS_DRIVER_MODE | SIS_VB_OUTPUT_DISABLE); |
| } |
| |
| outSISIDXREG(SISCR, 0x30, cr30); |
| outSISIDXREG(SISCR, 0x33, cr33); |
| |
| if(ivideo->chip >= SIS_661) { |
| #ifdef CONFIG_FB_SIS_315 |
| cr31 &= ~0x01; /* Clear PAL flag (now in CR35) */ |
| setSISIDXREG(SISCR, 0x35, ~0x10, cr35); /* Leave overscan bit alone */ |
| cr38 &= 0x07; /* Use only LCDA and HiVision/YPbPr bits */ |
| setSISIDXREG(SISCR, 0x38, 0xf8, cr38); |
| #endif |
| } else if(ivideo->chip != SIS_300) { |
| outSISIDXREG(SISCR, tvregnum, cr38); |
| } |
| outSISIDXREG(SISCR, 0x31, cr31); |
| |
| ivideo->SiS_Pr.SiS_UseOEM = ivideo->sisfb_useoem; |
| |
| sisfb_check_engine_and_sync(ivideo); |
| } |
| |
| /* Fix SR11 for 661 and later */ |
| #ifdef CONFIG_FB_SIS_315 |
| static void |
| sisfb_fixup_SR11(struct sis_video_info *ivideo) |
| { |
| u8 tmpreg; |
| |
| if(ivideo->chip >= SIS_661) { |
| inSISIDXREG(SISSR,0x11,tmpreg); |
| if(tmpreg & 0x20) { |
| inSISIDXREG(SISSR,0x3e,tmpreg); |
| tmpreg = (tmpreg + 1) & 0xff; |
| outSISIDXREG(SISSR,0x3e,tmpreg); |
| inSISIDXREG(SISSR,0x11,tmpreg); |
| } |
| if(tmpreg & 0xf0) { |
| andSISIDXREG(SISSR,0x11,0x0f); |
| } |
| } |
| } |
| #endif |
| |
| static void |
| sisfb_set_TVxposoffset(struct sis_video_info *ivideo, int val) |
| { |
| if(val > 32) val = 32; |
| if(val < -32) val = -32; |
| ivideo->tvxpos = val; |
| |
| if(ivideo->sisfblocked) return; |
| if(!ivideo->modechanged) return; |
| |
| if(ivideo->currentvbflags & CRT2_TV) { |
| |
| if(ivideo->vbflags2 & VB2_CHRONTEL) { |
| |
| int x = ivideo->tvx; |
| |
| switch(ivideo->chronteltype) { |
| case 1: |
| x += val; |
| if(x < 0) x = 0; |
| outSISIDXREG(SISSR,0x05,0x86); |
| SiS_SetCH700x(&ivideo->SiS_Pr, 0x0a, (x & 0xff)); |
| SiS_SetCH70xxANDOR(&ivideo->SiS_Pr, 0x08, ((x & 0x0100) >> 7), 0xFD); |
| break; |
| case 2: |
| /* Not supported by hardware */ |
| break; |
| } |
| |
| } else if(ivideo->vbflags2 & VB2_SISBRIDGE) { |
| |
| u8 p2_1f,p2_20,p2_2b,p2_42,p2_43; |
| unsigned short temp; |
| |
| p2_1f = ivideo->p2_1f; |
| p2_20 = ivideo->p2_20; |
| p2_2b = ivideo->p2_2b; |
| p2_42 = ivideo->p2_42; |
| p2_43 = ivideo->p2_43; |
| |
| temp = p2_1f | ((p2_20 & 0xf0) << 4); |
| temp += (val * 2); |
| p2_1f = temp & 0xff; |
| p2_20 = (temp & 0xf00) >> 4; |
| p2_2b = ((p2_2b & 0x0f) + (val * 2)) & 0x0f; |
| temp = p2_43 | ((p2_42 & 0xf0) << 4); |
| temp += (val * 2); |
| p2_43 = temp & 0xff; |
| p2_42 = (temp & 0xf00) >> 4; |
| outSISIDXREG(SISPART2,0x1f,p2_1f); |
| setSISIDXREG(SISPART2,0x20,0x0F,p2_20); |
| setSISIDXREG(SISPART2,0x2b,0xF0,p2_2b); |
| setSISIDXREG(SISPART2,0x42,0x0F,p2_42); |
| outSISIDXREG(SISPART2,0x43,p2_43); |
| } |
| } |
| } |
| |
| static void |
| sisfb_set_TVyposoffset(struct sis_video_info *ivideo, int val) |
| { |
| if(val > 32) val = 32; |
| if(val < -32) val = -32; |
| ivideo->tvypos = val; |
| |
| if(ivideo->sisfblocked) return; |
| if(!ivideo->modechanged) return; |
| |
| if(ivideo->currentvbflags & CRT2_TV) { |
| |
| if(ivideo->vbflags2 & VB2_CHRONTEL) { |
| |
| int y = ivideo->tvy; |
| |
| switch(ivideo->chronteltype) { |
| case 1: |
| y -= val; |
| if(y < 0) y = 0; |
| outSISIDXREG(SISSR,0x05,0x86); |
| SiS_SetCH700x(&ivideo->SiS_Pr, 0x0b, (y & 0xff)); |
| SiS_SetCH70xxANDOR(&ivideo->SiS_Pr, 0x08, ((y & 0x0100) >> 8), 0xFE); |
| break; |
| case 2: |
| /* Not supported by hardware */ |
| break; |
| } |
| |
| } else if(ivideo->vbflags2 & VB2_SISBRIDGE) { |
| |
| char p2_01, p2_02; |
| val /= 2; |
| p2_01 = ivideo->p2_01; |
| p2_02 = ivideo->p2_02; |
| |
| p2_01 += val; |
| p2_02 += val; |
| if(!(ivideo->currentvbflags & (TV_HIVISION | TV_YPBPR))) { |
| while((p2_01 <= 0) || (p2_02 <= 0)) { |
| p2_01 += 2; |
| p2_02 += 2; |
| } |
| } |
| outSISIDXREG(SISPART2,0x01,p2_01); |
| outSISIDXREG(SISPART2,0x02,p2_02); |
| } |
| } |
| } |
| |
| static void |
| sisfb_post_setmode(struct sis_video_info *ivideo) |
| { |
| BOOLEAN crt1isoff = FALSE; |
| BOOLEAN doit = TRUE; |
| #if defined(CONFIG_FB_SIS_300) || defined(CONFIG_FB_SIS_315) |
| u8 reg; |
| #endif |
| #ifdef CONFIG_FB_SIS_315 |
| u8 reg1; |
| #endif |
| |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| |
| #ifdef CONFIG_FB_SIS_315 |
| sisfb_fixup_SR11(ivideo); |
| #endif |
| |
| /* Now we actually HAVE changed the display mode */ |
| ivideo->modechanged = 1; |
| |
| /* We can't switch off CRT1 if bridge is in slave mode */ |
| if(ivideo->vbflags2 & VB2_VIDEOBRIDGE) { |
| if(sisfb_bridgeisslave(ivideo)) doit = FALSE; |
| } else |
| ivideo->sisfb_crt1off = 0; |
| |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| if((ivideo->sisfb_crt1off) && (doit)) { |
| crt1isoff = TRUE; |
| reg = 0x00; |
| } else { |
| crt1isoff = FALSE; |
| reg = 0x80; |
| } |
| setSISIDXREG(SISCR, 0x17, 0x7f, reg); |
| } |
| #endif |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| if((ivideo->sisfb_crt1off) && (doit)) { |
| crt1isoff = TRUE; |
| reg = 0x40; |
| reg1 = 0xc0; |
| } else { |
| crt1isoff = FALSE; |
| reg = 0x00; |
| reg1 = 0x00; |
| } |
| setSISIDXREG(SISCR, ivideo->SiS_Pr.SiS_MyCR63, ~0x40, reg); |
| setSISIDXREG(SISSR, 0x1f, ~0xc0, reg1); |
| } |
| #endif |
| |
| if(crt1isoff) { |
| ivideo->currentvbflags &= ~VB_DISPTYPE_CRT1; |
| ivideo->currentvbflags |= VB_SINGLE_MODE; |
| } else { |
| ivideo->currentvbflags |= VB_DISPTYPE_CRT1; |
| if(ivideo->currentvbflags & VB_DISPTYPE_CRT2) { |
| ivideo->currentvbflags |= VB_MIRROR_MODE; |
| } else { |
| ivideo->currentvbflags |= VB_SINGLE_MODE; |
| } |
| } |
| |
| andSISIDXREG(SISSR, IND_SIS_RAMDAC_CONTROL, ~0x04); |
| |
| if(ivideo->currentvbflags & CRT2_TV) { |
| if(ivideo->vbflags2 & VB2_SISBRIDGE) { |
| inSISIDXREG(SISPART2,0x1f,ivideo->p2_1f); |
| inSISIDXREG(SISPART2,0x20,ivideo->p2_20); |
| inSISIDXREG(SISPART2,0x2b,ivideo->p2_2b); |
| inSISIDXREG(SISPART2,0x42,ivideo->p2_42); |
| inSISIDXREG(SISPART2,0x43,ivideo->p2_43); |
| inSISIDXREG(SISPART2,0x01,ivideo->p2_01); |
| inSISIDXREG(SISPART2,0x02,ivideo->p2_02); |
| } else if(ivideo->vbflags2 & VB2_CHRONTEL) { |
| if(ivideo->chronteltype == 1) { |
| ivideo->tvx = SiS_GetCH700x(&ivideo->SiS_Pr, 0x0a); |
| ivideo->tvx |= (((SiS_GetCH700x(&ivideo->SiS_Pr, 0x08) & 0x02) >> 1) << 8); |
| ivideo->tvy = SiS_GetCH700x(&ivideo->SiS_Pr, 0x0b); |
| ivideo->tvy |= ((SiS_GetCH700x(&ivideo->SiS_Pr, 0x08) & 0x01) << 8); |
| } |
| } |
| } |
| |
| if(ivideo->tvxpos) { |
| sisfb_set_TVxposoffset(ivideo, ivideo->tvxpos); |
| } |
| if(ivideo->tvypos) { |
| sisfb_set_TVyposoffset(ivideo, ivideo->tvypos); |
| } |
| |
| /* Eventually sync engines */ |
| sisfb_check_engine_and_sync(ivideo); |
| |
| /* (Re-)Initialize chip engines */ |
| if(ivideo->accel) { |
| sisfb_engine_init(ivideo); |
| } else { |
| ivideo->engineok = 0; |
| } |
| } |
| |
| static int |
| sisfb_reset_mode(struct sis_video_info *ivideo) |
| { |
| if(sisfb_set_mode(ivideo, 0)) |
| return 1; |
| |
| sisfb_set_pitch(ivideo); |
| sisfb_set_base_CRT1(ivideo, ivideo->current_base); |
| sisfb_set_base_CRT2(ivideo, ivideo->current_base); |
| |
| return 0; |
| } |
| |
| static void |
| sisfb_handle_command(struct sis_video_info *ivideo, struct sisfb_cmd *sisfb_command) |
| { |
| int mycrt1off; |
| |
| switch(sisfb_command->sisfb_cmd) { |
| case SISFB_CMD_GETVBFLAGS: |
| if(!ivideo->modechanged) { |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_EARLY; |
| } else { |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_OK; |
| sisfb_command->sisfb_result[1] = ivideo->currentvbflags; |
| sisfb_command->sisfb_result[2] = ivideo->vbflags2; |
| } |
| break; |
| case SISFB_CMD_SWITCHCRT1: |
| /* arg[0]: 0 = off, 1 = on, 99 = query */ |
| if(!ivideo->modechanged) { |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_EARLY; |
| } else if(sisfb_command->sisfb_arg[0] == 99) { |
| /* Query */ |
| sisfb_command->sisfb_result[1] = ivideo->sisfb_crt1off ? 0 : 1; |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_OK; |
| } else if(ivideo->sisfblocked) { |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_LOCKED; |
| } else if((!(ivideo->currentvbflags & CRT2_ENABLE)) && |
| (sisfb_command->sisfb_arg[0] == 0)) { |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_NOCRT2; |
| } else { |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_OK; |
| mycrt1off = sisfb_command->sisfb_arg[0] ? 0 : 1; |
| if( ((ivideo->currentvbflags & VB_DISPTYPE_CRT1) && mycrt1off) || |
| ((!(ivideo->currentvbflags & VB_DISPTYPE_CRT1)) && !mycrt1off) ) { |
| ivideo->sisfb_crt1off = mycrt1off; |
| if(sisfb_reset_mode(ivideo)) { |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_OTHER; |
| } |
| } |
| sisfb_command->sisfb_result[1] = ivideo->sisfb_crt1off ? 0 : 1; |
| } |
| break; |
| /* more to come */ |
| default: |
| sisfb_command->sisfb_result[0] = SISFB_CMD_ERR_UNKNOWN; |
| printk(KERN_ERR "sisfb: Unknown command 0x%x\n", |
| sisfb_command->sisfb_cmd); |
| } |
| } |
| |
| #ifndef MODULE |
| SISINITSTATIC int __init |
| sisfb_setup(char *options) |
| { |
| char *this_opt; |
| |
| sisfb_setdefaultparms(); |
| |
| if(!options || !(*options)) |
| return 0; |
| |
| while((this_opt = strsep(&options, ",")) != NULL) { |
| |
| if(!(*this_opt)) continue; |
| |
| if(!strnicmp(this_opt, "off", 3)) { |
| sisfb_off = 1; |
| } else if(!strnicmp(this_opt, "forcecrt2type:", 14)) { |
| /* Need to check crt2 type first for fstn/dstn */ |
| sisfb_search_crt2type(this_opt + 14); |
| } else if(!strnicmp(this_opt, "tvmode:",7)) { |
| sisfb_search_tvstd(this_opt + 7); |
| } else if(!strnicmp(this_opt, "tvstandard:",11)) { |
| sisfb_search_tvstd(this_opt + 11); |
| } else if(!strnicmp(this_opt, "mode:", 5)) { |
| sisfb_search_mode(this_opt + 5, FALSE); |
| } else if(!strnicmp(this_opt, "vesa:", 5)) { |
| sisfb_search_vesamode(simple_strtoul(this_opt + 5, NULL, 0), FALSE); |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| } else if(!strnicmp(this_opt, "inverse", 7)) { |
| sisfb_inverse = 1; |
| /* fb_invert_cmaps(); */ |
| } else if(!strnicmp(this_opt, "font:", 5)) { |
| if(strlen(this_opt + 5) < 40) { |
| strncpy(sisfb_fontname, this_opt + 5, sizeof(sisfb_fontname) - 1); |
| sisfb_fontname[sizeof(sisfb_fontname) - 1] = '\0'; |
| } |
| #endif |
| } else if(!strnicmp(this_opt, "rate:", 5)) { |
| sisfb_parm_rate = simple_strtoul(this_opt + 5, NULL, 0); |
| } else if(!strnicmp(this_opt, "forcecrt1:", 10)) { |
| sisfb_forcecrt1 = (int)simple_strtoul(this_opt + 10, NULL, 0); |
| } else if(!strnicmp(this_opt, "mem:",4)) { |
| sisfb_parm_mem = simple_strtoul(this_opt + 4, NULL, 0); |
| } else if(!strnicmp(this_opt, "pdc:", 4)) { |
| sisfb_pdc = simple_strtoul(this_opt + 4, NULL, 0); |
| } else if(!strnicmp(this_opt, "pdc1:", 5)) { |
| sisfb_pdca = simple_strtoul(this_opt + 5, NULL, 0); |
| } else if(!strnicmp(this_opt, "noaccel", 7)) { |
| sisfb_accel = 0; |
| } else if(!strnicmp(this_opt, "accel", 5)) { |
| sisfb_accel = -1; |
| } else if(!strnicmp(this_opt, "noypan", 6)) { |
| sisfb_ypan = 0; |
| } else if(!strnicmp(this_opt, "ypan", 4)) { |
| sisfb_ypan = -1; |
| } else if(!strnicmp(this_opt, "nomax", 5)) { |
| sisfb_max = 0; |
| } else if(!strnicmp(this_opt, "max", 3)) { |
| sisfb_max = -1; |
| } else if(!strnicmp(this_opt, "userom:", 7)) { |
| sisfb_userom = (int)simple_strtoul(this_opt + 7, NULL, 0); |
| } else if(!strnicmp(this_opt, "useoem:", 7)) { |
| sisfb_useoem = (int)simple_strtoul(this_opt + 7, NULL, 0); |
| } else if(!strnicmp(this_opt, "nocrt2rate", 10)) { |
| sisfb_nocrt2rate = 1; |
| } else if(!strnicmp(this_opt, "scalelcd:", 9)) { |
| unsigned long temp = 2; |
| temp = simple_strtoul(this_opt + 9, NULL, 0); |
| if((temp == 0) || (temp == 1)) { |
| sisfb_scalelcd = temp ^ 1; |
| } |
| } else if(!strnicmp(this_opt, "tvxposoffset:", 13)) { |
| int temp = 0; |
| temp = (int)simple_strtol(this_opt + 13, NULL, 0); |
| if((temp >= -32) && (temp <= 32)) { |
| sisfb_tvxposoffset = temp; |
| } |
| } else if(!strnicmp(this_opt, "tvyposoffset:", 13)) { |
| int temp = 0; |
| temp = (int)simple_strtol(this_opt + 13, NULL, 0); |
| if((temp >= -32) && (temp <= 32)) { |
| sisfb_tvyposoffset = temp; |
| } |
| } else if(!strnicmp(this_opt, "specialtiming:", 14)) { |
| sisfb_search_specialtiming(this_opt + 14); |
| } else if(!strnicmp(this_opt, "lvdshl:", 7)) { |
| int temp = 4; |
| temp = simple_strtoul(this_opt + 7, NULL, 0); |
| if((temp >= 0) && (temp <= 3)) { |
| sisfb_lvdshl = temp; |
| } |
| } else if(this_opt[0] >= '0' && this_opt[0] <= '9') { |
| sisfb_search_mode(this_opt, TRUE); |
| #if !defined(__i386__) && !defined(__x86_64__) |
| } else if(!strnicmp(this_opt, "resetcard", 9)) { |
| sisfb_resetcard = 1; |
| } else if(!strnicmp(this_opt, "videoram:", 9)) { |
| sisfb_videoram = simple_strtoul(this_opt + 9, NULL, 0); |
| #endif |
| } else { |
| printk(KERN_INFO "sisfb: Invalid option %s\n", this_opt); |
| } |
| |
| } |
| |
| return 0; |
| } |
| #endif |
| |
| static int __devinit |
| sisfb_check_rom(SIS_IOTYPE1 *rom_base, struct sis_video_info *ivideo) |
| { |
| SIS_IOTYPE1 *rom; |
| int romptr; |
| |
| if((readb(rom_base) != 0x55) || (readb(rom_base + 1) != 0xaa)) |
| return 0; |
| |
| romptr = (readb(rom_base + 0x18) | (readb(rom_base + 0x19) << 8)); |
| if(romptr > (0x10000 - 8)) |
| return 0; |
| |
| rom = rom_base + romptr; |
| |
| if((readb(rom) != 'P') || (readb(rom + 1) != 'C') || |
| (readb(rom + 2) != 'I') || (readb(rom + 3) != 'R')) |
| return 0; |
| |
| if((readb(rom + 4) | (readb(rom + 5) << 8)) != ivideo->chip_vendor) |
| return 0; |
| |
| if((readb(rom + 6) | (readb(rom + 7) << 8)) != ivideo->chip_id) |
| return 0; |
| |
| return 1; |
| } |
| |
| static unsigned char * __devinit |
| sisfb_find_rom(struct pci_dev *pdev) |
| { |
| struct sis_video_info *ivideo = pci_get_drvdata(pdev); |
| SIS_IOTYPE1 *rom_base; |
| unsigned char *myrombase = NULL; |
| u32 temp; |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,11) |
| size_t romsize; |
| |
| /* First, try the official pci ROM functions (except |
| * on integrated chipsets which have no ROM). |
| */ |
| |
| if(!ivideo->nbridge) { |
| |
| if((rom_base = pci_map_rom(pdev, &romsize))) { |
| |
| if(sisfb_check_rom(rom_base, ivideo)) { |
| |
| if((myrombase = vmalloc(65536))) { |
| |
| /* Work around bug in pci/rom.c: Folks forgot to check |
| * whether the size retrieved from the BIOS image eventually |
| * is larger than the mapped size |
| */ |
| if(pci_resource_len(pdev, PCI_ROM_RESOURCE) < romsize) |
| romsize = pci_resource_len(pdev, PCI_ROM_RESOURCE); |
| |
| memcpy_fromio(myrombase, rom_base, |
| (romsize > 65536) ? 65536 : romsize); |
| } |
| } |
| pci_unmap_rom(pdev, rom_base); |
| } |
| } |
| |
| if(myrombase) return myrombase; |
| #endif |
| |
| /* Otherwise do it the conventional way. */ |
| |
| #if defined(__i386__) || defined(__x86_64__) |
| |
| for(temp = 0x000c0000; temp < 0x000f0000; temp += 0x00001000) { |
| |
| rom_base = ioremap(temp, 65536); |
| if(!rom_base) |
| continue; |
| |
| if(!sisfb_check_rom(rom_base, ivideo)) { |
| iounmap(rom_base); |
| continue; |
| } |
| |
| if((myrombase = vmalloc(65536))) |
| memcpy_fromio(myrombase, rom_base, 65536); |
| |
| iounmap(rom_base); |
| break; |
| |
| } |
| |
| #else |
| |
| pci_read_config_dword(pdev, PCI_ROM_ADDRESS, &temp); |
| pci_write_config_dword(pdev, PCI_ROM_ADDRESS, |
| (ivideo->video_base & PCI_ROM_ADDRESS_MASK) | PCI_ROM_ADDRESS_ENABLE); |
| |
| rom_base = ioremap(ivideo->video_base, 65536); |
| if(rom_base) { |
| if(sisfb_check_rom(rom_base, ivideo)) { |
| if((myrombase = vmalloc(65536))) |
| memcpy_fromio(myrombase, rom_base, 65536); |
| } |
| iounmap(rom_base); |
| } |
| |
| pci_write_config_dword(pdev, PCI_ROM_ADDRESS, temp); |
| |
| #endif |
| |
| return myrombase; |
| } |
| |
| static void __devinit |
| sisfb_post_map_vram(struct sis_video_info *ivideo, unsigned int *mapsize, |
| unsigned int min) |
| { |
| ivideo->video_vbase = ioremap(ivideo->video_base, (*mapsize)); |
| |
| if(!ivideo->video_vbase) { |
| printk(KERN_ERR |
| "sisfb: Unable to map maximum video RAM for size detection\n"); |
| (*mapsize) >>= 1; |
| while((!(ivideo->video_vbase = ioremap(ivideo->video_base, (*mapsize))))) { |
| (*mapsize) >>= 1; |
| if((*mapsize) < (min << 20)) |
| break; |
| } |
| if(ivideo->video_vbase) { |
| printk(KERN_ERR |
| "sisfb: Video RAM size detection limited to %dMB\n", |
| (int)((*mapsize) >> 20)); |
| } |
| } |
| } |
| |
| #ifdef CONFIG_FB_SIS_300 |
| static int __devinit |
| sisfb_post_300_buswidth(struct sis_video_info *ivideo) |
| { |
| SIS_IOTYPE1 *FBAddress = ivideo->video_vbase; |
| unsigned short temp; |
| unsigned char reg; |
| int i, j; |
| |
| andSISIDXREG(SISSR, 0x15, 0xFB); |
| orSISIDXREG(SISSR, 0x15, 0x04); |
| outSISIDXREG(SISSR, 0x13, 0x00); |
| outSISIDXREG(SISSR, 0x14, 0xBF); |
| |
| for(i = 0; i < 2; i++) { |
| temp = 0x1234; |
| for(j = 0; j < 4; j++) { |
| writew(temp, FBAddress); |
| if(readw(FBAddress) == temp) |
| break; |
| orSISIDXREG(SISSR, 0x3c, 0x01); |
| inSISIDXREG(SISSR, 0x05, reg); |
| inSISIDXREG(SISSR, 0x05, reg); |
| andSISIDXREG(SISSR, 0x3c, 0xfe); |
| inSISIDXREG(SISSR, 0x05, reg); |
| inSISIDXREG(SISSR, 0x05, reg); |
| temp++; |
| } |
| } |
| |
| writel(0x01234567L, FBAddress); |
| writel(0x456789ABL, (FBAddress + 4)); |
| writel(0x89ABCDEFL, (FBAddress + 8)); |
| writel(0xCDEF0123L, (FBAddress + 12)); |
| |
| inSISIDXREG(SISSR, 0x3b, reg); |
| if(reg & 0x01) { |
| if(readl((FBAddress + 12)) == 0xCDEF0123L) |
| return 4; /* Channel A 128bit */ |
| } |
| |
| if(readl((FBAddress + 4)) == 0x456789ABL) |
| return 2; /* Channel B 64bit */ |
| |
| return 1; /* 32bit */ |
| } |
| |
| static int __devinit |
| sisfb_post_300_rwtest(struct sis_video_info *ivideo, int iteration, int buswidth, |
| int PseudoRankCapacity, int PseudoAdrPinCount, |
| unsigned int mapsize) |
| { |
| SIS_IOTYPE1 *FBAddr = ivideo->video_vbase; |
| unsigned short sr14; |
| unsigned int k, RankCapacity, PageCapacity, BankNumHigh, BankNumMid; |
| unsigned int PhysicalAdrOtherPage, PhysicalAdrHigh, PhysicalAdrHalfPage; |
| static const unsigned short SiS_DRAMType[17][5] = { |
| {0x0C,0x0A,0x02,0x40,0x39}, |
| {0x0D,0x0A,0x01,0x40,0x48}, |
| {0x0C,0x09,0x02,0x20,0x35}, |
| {0x0D,0x09,0x01,0x20,0x44}, |
| {0x0C,0x08,0x02,0x10,0x31}, |
| {0x0D,0x08,0x01,0x10,0x40}, |
| {0x0C,0x0A,0x01,0x20,0x34}, |
| {0x0C,0x09,0x01,0x08,0x32}, |
| {0x0B,0x08,0x02,0x08,0x21}, |
| {0x0C,0x08,0x01,0x08,0x30}, |
| {0x0A,0x08,0x02,0x04,0x11}, |
| {0x0B,0x0A,0x01,0x10,0x28}, |
| {0x09,0x08,0x02,0x02,0x01}, |
| {0x0B,0x09,0x01,0x08,0x24}, |
| {0x0B,0x08,0x01,0x04,0x20}, |
| {0x0A,0x08,0x01,0x02,0x10}, |
| {0x09,0x08,0x01,0x01,0x00} |
| }; |
| |
| for(k = 0; k <= 16; k++) { |
| |
| RankCapacity = buswidth * SiS_DRAMType[k][3]; |
| |
| if(RankCapacity != PseudoRankCapacity) |
| continue; |
| |
| if((SiS_DRAMType[k][2] + SiS_DRAMType[k][0]) > PseudoAdrPinCount) |
| continue; |
| |
| BankNumHigh = RankCapacity * 16 * iteration - 1; |
| if(iteration == 3) { /* Rank No */ |
| BankNumMid = RankCapacity * 16 - 1; |
| } else { |
| BankNumMid = RankCapacity * 16 * iteration / 2 - 1; |
| } |
| |
| PageCapacity = (1 << SiS_DRAMType[k][1]) * buswidth * 4; |
| PhysicalAdrHigh = BankNumHigh; |
| PhysicalAdrHalfPage = (PageCapacity / 2 + PhysicalAdrHigh) % PageCapacity; |
| PhysicalAdrOtherPage = PageCapacity * SiS_DRAMType[k][2] + PhysicalAdrHigh; |
| |
| andSISIDXREG(SISSR, 0x15, 0xFB); /* Test */ |
| orSISIDXREG(SISSR, 0x15, 0x04); /* Test */ |
| sr14 = (SiS_DRAMType[k][3] * buswidth) - 1; |
| if(buswidth == 4) sr14 |= 0x80; |
| else if(buswidth == 2) sr14 |= 0x40; |
| outSISIDXREG(SISSR, 0x13, SiS_DRAMType[k][4]); |
| outSISIDXREG(SISSR, 0x14, sr14); |
| |
| BankNumHigh <<= 16; |
| BankNumMid <<= 16; |
| |
| if((BankNumHigh + PhysicalAdrHigh >= mapsize) || |
| (BankNumMid + PhysicalAdrHigh >= mapsize) || |
| (BankNumHigh + PhysicalAdrHalfPage >= mapsize) || |
| (BankNumHigh + PhysicalAdrOtherPage >= mapsize)) |
| continue; |
| |
| /* Write data */ |
| writew(((unsigned short)PhysicalAdrHigh), |
| (FBAddr + BankNumHigh + PhysicalAdrHigh)); |
| writew(((unsigned short)BankNumMid), |
| (FBAddr + BankNumMid + PhysicalAdrHigh)); |
| writew(((unsigned short)PhysicalAdrHalfPage), |
| (FBAddr + BankNumHigh + PhysicalAdrHalfPage)); |
| writew(((unsigned short)PhysicalAdrOtherPage), |
| (FBAddr + BankNumHigh + PhysicalAdrOtherPage)); |
| |
| /* Read data */ |
| if(readw(FBAddr + BankNumHigh + PhysicalAdrHigh) == PhysicalAdrHigh) |
| return 1; |
| } |
| |
| return 0; |
| } |
| |
| static void __devinit |
| sisfb_post_300_ramsize(struct pci_dev *pdev, unsigned int mapsize) |
| { |
| struct sis_video_info *ivideo = pci_get_drvdata(pdev); |
| int i, j, buswidth; |
| int PseudoRankCapacity, PseudoAdrPinCount; |
| |
| buswidth = sisfb_post_300_buswidth(ivideo); |
| |
| for(i = 6; i >= 0; i--) { |
| PseudoRankCapacity = 1 << i; |
| for(j = 4; j >= 1; j--) { |
| PseudoAdrPinCount = 15 - j; |
| if((PseudoRankCapacity * j) <= 64) { |
| if(sisfb_post_300_rwtest(ivideo, |
| j, |
| buswidth, |
| PseudoRankCapacity, |
| PseudoAdrPinCount, |
| mapsize)) |
| return; |
| } |
| } |
| } |
| } |
| |
| static void __devinit |
| sisfb_post_sis300(struct pci_dev *pdev) |
| { |
| struct sis_video_info *ivideo = pci_get_drvdata(pdev); |
| unsigned char *bios = ivideo->SiS_Pr.VirtualRomBase; |
| u8 reg, v1, v2, v3, v4, v5, v6, v7, v8; |
| u16 index, rindex, memtype = 0; |
| unsigned int mapsize; |
| |
| if(!ivideo->SiS_Pr.UseROM) |
| bios = NULL; |
| |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| |
| if(bios) { |
| if(bios[0x52] & 0x80) { |
| memtype = bios[0x52]; |
| } else { |
| inSISIDXREG(SISSR, 0x3a, memtype); |
| } |
| memtype &= 0x07; |
| } |
| |
| v3 = 0x80; v6 = 0x80; |
| if(ivideo->revision_id <= 0x13) { |
| v1 = 0x44; v2 = 0x42; |
| v4 = 0x44; v5 = 0x42; |
| } else { |
| v1 = 0x68; v2 = 0x43; /* Assume 125Mhz MCLK */ |
| v4 = 0x68; v5 = 0x43; /* Assume 125Mhz ECLK */ |
| if(bios) { |
| index = memtype * 5; |
| rindex = index + 0x54; |
| v1 = bios[rindex++]; |
| v2 = bios[rindex++]; |
| v3 = bios[rindex++]; |
| rindex = index + 0x7c; |
| v4 = bios[rindex++]; |
| v5 = bios[rindex++]; |
| v6 = bios[rindex++]; |
| } |
| } |
| outSISIDXREG(SISSR, 0x28, v1); |
| outSISIDXREG(SISSR, 0x29, v2); |
| outSISIDXREG(SISSR, 0x2a, v3); |
| outSISIDXREG(SISSR, 0x2e, v4); |
| outSISIDXREG(SISSR, 0x2f, v5); |
| outSISIDXREG(SISSR, 0x30, v6); |
| |
| v1 = 0x10; |
| if(bios) |
| v1 = bios[0xa4]; |
| outSISIDXREG(SISSR, 0x07, v1); /* DAC speed */ |
| |
| outSISIDXREG(SISSR, 0x11, 0x0f); /* DDC, power save */ |
| |
| v1 = 0x01; v2 = 0x43; v3 = 0x1e; v4 = 0x2a; |
| v5 = 0x06; v6 = 0x00; v7 = 0x00; v8 = 0x00; |
| if(bios) { |
| memtype += 0xa5; |
| v1 = bios[memtype]; |
| v2 = bios[memtype + 8]; |
| v3 = bios[memtype + 16]; |
| v4 = bios[memtype + 24]; |
| v5 = bios[memtype + 32]; |
| v6 = bios[memtype + 40]; |
| v7 = bios[memtype + 48]; |
| v8 = bios[memtype + 56]; |
| } |
| if(ivideo->revision_id >= 0x80) |
| v3 &= 0xfd; |
| outSISIDXREG(SISSR, 0x15, v1); /* Ram type (assuming 0, BIOS 0xa5 step 8) */ |
| outSISIDXREG(SISSR, 0x16, v2); |
| outSISIDXREG(SISSR, 0x17, v3); |
| outSISIDXREG(SISSR, 0x18, v4); |
| outSISIDXREG(SISSR, 0x19, v5); |
| outSISIDXREG(SISSR, 0x1a, v6); |
| outSISIDXREG(SISSR, 0x1b, v7); |
| outSISIDXREG(SISSR, 0x1c, v8); /* ---- */ |
| andSISIDXREG(SISSR, 0x15 ,0xfb); |
| orSISIDXREG(SISSR, 0x15, 0x04); |
| if(bios) { |
| if(bios[0x53] & 0x02) { |
| orSISIDXREG(SISSR, 0x19, 0x20); |
| } |
| } |
| v1 = 0x04; /* DAC pedestal (BIOS 0xe5) */ |
| if(ivideo->revision_id >= 0x80) |
| v1 |= 0x01; |
| outSISIDXREG(SISSR, 0x1f, v1); |
| outSISIDXREG(SISSR, 0x20, 0xa4); /* linear & relocated io & disable a0000 */ |
| v1 = 0xf6; v2 = 0x0d; v3 = 0x00; |
| if(bios) { |
| v1 = bios[0xe8]; |
| v2 = bios[0xe9]; |
| v3 = bios[0xea]; |
| } |
| outSISIDXREG(SISSR, 0x23, v1); |
| outSISIDXREG(SISSR, 0x24, v2); |
| outSISIDXREG(SISSR, 0x25, v3); |
| outSISIDXREG(SISSR, 0x21, 0x84); |
| outSISIDXREG(SISSR, 0x22, 0x00); |
| outSISIDXREG(SISCR, 0x37, 0x00); |
| orSISIDXREG(SISPART1, 0x24, 0x01); /* unlock crt2 */ |
| outSISIDXREG(SISPART1, 0x00, 0x00); |
| v1 = 0x40; v2 = 0x11; |
| if(bios) { |
| v1 = bios[0xec]; |
| v2 = bios[0xeb]; |
| } |
| outSISIDXREG(SISPART1, 0x02, v1); |
| |
| if(ivideo->revision_id >= 0x80) |
| v2 &= ~0x01; |
| |
| inSISIDXREG(SISPART4, 0x00, reg); |
| if((reg == 1) || (reg == 2)) { |
| outSISIDXREG(SISCR, 0x37, 0x02); |
| outSISIDXREG(SISPART2, 0x00, 0x1c); |
| v4 = 0x00; v5 = 0x00; v6 = 0x10; |
| if(ivideo->SiS_Pr.UseROM) { |
| v4 = bios[0xf5]; |
| v5 = bios[0xf6]; |
| v6 = bios[0xf7]; |
| } |
| outSISIDXREG(SISPART4, 0x0d, v4); |
| outSISIDXREG(SISPART4, 0x0e, v5); |
| outSISIDXREG(SISPART4, 0x10, v6); |
| outSISIDXREG(SISPART4, 0x0f, 0x3f); |
| inSISIDXREG(SISPART4, 0x01, reg); |
| if(reg >= 0xb0) { |
| inSISIDXREG(SISPART4, 0x23, reg); |
| reg &= 0x20; |
| reg <<= 1; |
| outSISIDXREG(SISPART4, 0x23, reg); |
| } |
| } else { |
| v2 &= ~0x10; |
| } |
| outSISIDXREG(SISSR, 0x32, v2); |
| |
| andSISIDXREG(SISPART1, 0x24, 0xfe); /* Lock CRT2 */ |
| |
| inSISIDXREG(SISSR, 0x16, reg); |
| reg &= 0xc3; |
| outSISIDXREG(SISCR, 0x35, reg); |
| outSISIDXREG(SISCR, 0x83, 0x00); |
| #if !defined(__i386__) && !defined(__x86_64__) |
| if(sisfb_videoram) { |
| outSISIDXREG(SISSR, 0x13, 0x28); /* ? */ |
| reg = ((sisfb_videoram >> 10) - 1) | 0x40; |
| outSISIDXREG(SISSR, 0x14, reg); |
| } else { |
| #endif |
| /* Need to map max FB size for finding out about RAM size */ |
| mapsize = 64 << 20; |
| sisfb_post_map_vram(ivideo, &mapsize, 4); |
| |
| if(ivideo->video_vbase) { |
| sisfb_post_300_ramsize(pdev, mapsize); |
| iounmap(ivideo->video_vbase); |
| } else { |
| printk(KERN_DEBUG |
| "sisfb: Failed to map memory for size detection, assuming 8MB\n"); |
| outSISIDXREG(SISSR, 0x13, 0x28); /* ? */ |
| outSISIDXREG(SISSR, 0x14, 0x47); /* 8MB, 64bit default */ |
| } |
| #if !defined(__i386__) && !defined(__x86_64__) |
| } |
| #endif |
| if(bios) { |
| v1 = bios[0xe6]; |
| v2 = bios[0xe7]; |
| } else { |
| inSISIDXREG(SISSR, 0x3a, reg); |
| if((reg & 0x30) == 0x30) { |
| v1 = 0x04; /* PCI */ |
| v2 = 0x92; |
| } else { |
| v1 = 0x14; /* AGP */ |
| v2 = 0xb2; |
| } |
| } |
| outSISIDXREG(SISSR, 0x21, v1); |
| outSISIDXREG(SISSR, 0x22, v2); |
| |
| /* Sense CRT1 */ |
| sisfb_sense_crt1(ivideo); |
| |
| /* Set default mode, don't clear screen */ |
| ivideo->SiS_Pr.SiS_UseOEM = FALSE; |
| SiS_SetEnableDstn(&ivideo->SiS_Pr, FALSE); |
| SiS_SetEnableFstn(&ivideo->SiS_Pr, FALSE); |
| ivideo->curFSTN = ivideo->curDSTN = 0; |
| ivideo->SiS_Pr.VideoMemorySize = 8 << 20; |
| SiSSetMode(&ivideo->SiS_Pr, 0x2e | 0x80); |
| |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| |
| /* Display off */ |
| orSISIDXREG(SISSR, 0x01, 0x20); |
| |
| /* Save mode number in CR34 */ |
| outSISIDXREG(SISCR, 0x34, 0x2e); |
| |
| /* Let everyone know what the current mode is */ |
| ivideo->modeprechange = 0x2e; |
| } |
| #endif |
| |
| #ifdef CONFIG_FB_SIS_315 |
| #if 0 |
| static void __devinit |
| sisfb_post_sis315330(struct pci_dev *pdev) |
| { |
| /* TODO */ |
| } |
| #endif |
| |
| static void __devinit |
| sisfb_post_xgi_delay(struct sis_video_info *ivideo, int delay) |
| { |
| unsigned int i; |
| u8 reg; |
| |
| for(i = 0; i <= (delay * 10 * 36); i++) { |
| inSISIDXREG(SISSR, 0x05, reg); |
| reg++; |
| } |
| } |
| |
| static int __devinit |
| sisfb_find_host_bridge(struct sis_video_info *ivideo, struct pci_dev *mypdev, |
| unsigned short pcivendor) |
| { |
| struct pci_dev *pdev = NULL; |
| unsigned short temp; |
| int ret = 0; |
| |
| while((pdev = SIS_PCI_GET_CLASS(PCI_CLASS_BRIDGE_HOST, pdev))) { |
| temp = pdev->vendor; |
| SIS_PCI_PUT_DEVICE(pdev); |
| if(temp == pcivendor) { |
| ret = 1; |
| break; |
| } |
| } |
| |
| return ret; |
| } |
| |
| static int __devinit |
| sisfb_post_xgi_rwtest(struct sis_video_info *ivideo, int starta, |
| unsigned int enda, unsigned int mapsize) |
| { |
| unsigned int pos; |
| int i; |
| |
| writel(0, ivideo->video_vbase); |
| |
| for(i = starta; i <= enda; i++) { |
| pos = 1 << i; |
| if(pos < mapsize) |
| writel(pos, ivideo->video_vbase + pos); |
| } |
| |
| sisfb_post_xgi_delay(ivideo, 150); |
| |
| if(readl(ivideo->video_vbase) != 0) |
| return 0; |
| |
| for(i = starta; i <= enda; i++) { |
| pos = 1 << i; |
| if(pos < mapsize) { |
| if(readl(ivideo->video_vbase + pos) != pos) |
| return 0; |
| } else |
| return 0; |
| } |
| |
| return 1; |
| } |
| |
| static void __devinit |
| sisfb_post_xgi_ramsize(struct sis_video_info *ivideo) |
| { |
| unsigned int buswidth, ranksize, channelab, mapsize; |
| int i, j, k, l; |
| u8 reg, sr14; |
| static const u8 dramsr13[12 * 5] = { |
| 0x02, 0x0e, 0x0b, 0x80, 0x5d, |
| 0x02, 0x0e, 0x0a, 0x40, 0x59, |
| 0x02, 0x0d, 0x0b, 0x40, 0x4d, |
| 0x02, 0x0e, 0x09, 0x20, 0x55, |
| 0x02, 0x0d, 0x0a, 0x20, 0x49, |
| 0x02, 0x0c, 0x0b, 0x20, 0x3d, |
| 0x02, 0x0e, 0x08, 0x10, 0x51, |
| 0x02, 0x0d, 0x09, 0x10, 0x45, |
| 0x02, 0x0c, 0x0a, 0x10, 0x39, |
| 0x02, 0x0d, 0x08, 0x08, 0x41, |
| 0x02, 0x0c, 0x09, 0x08, 0x35, |
| 0x02, 0x0c, 0x08, 0x04, 0x31 |
| }; |
| static const u8 dramsr13_4[4 * 5] = { |
| 0x02, 0x0d, 0x09, 0x40, 0x45, |
| 0x02, 0x0c, 0x09, 0x20, 0x35, |
| 0x02, 0x0c, 0x08, 0x10, 0x31, |
| 0x02, 0x0b, 0x08, 0x08, 0x21 |
| }; |
| |
| /* Enable linear mode, disable 0xa0000 address decoding */ |
| /* We disable a0000 address decoding, because |
| * - if running on x86, if the card is disabled, it means |
| * that another card is in the system. We don't want |
| * to interphere with that primary card's textmode. |
| * - if running on non-x86, there usually is no VGA window |
| * at a0000. |
| */ |
| orSISIDXREG(SISSR, 0x20, (0x80 | 0x04)); |
| |
| /* Need to map max FB size for finding out about RAM size */ |
| mapsize = 256 << 20; |
| sisfb_post_map_vram(ivideo, &mapsize, 32); |
| |
| if(!ivideo->video_vbase) { |
| printk(KERN_ERR "sisfb: Unable to detect RAM size. Setting default.\n"); |
| outSISIDXREG(SISSR, 0x13, 0x35); |
| outSISIDXREG(SISSR, 0x14, 0x41); |
| /* TODO */ |
| return; |
| } |
| |
| /* Non-interleaving */ |
| outSISIDXREG(SISSR, 0x15, 0x00); |
| /* No tiling */ |
| outSISIDXREG(SISSR, 0x1c, 0x00); |
| |
| if(ivideo->chip == XGI_20) { |
| |
| channelab = 1; |
| inSISIDXREG(SISCR, 0x97, reg); |
| if(!(reg & 0x01)) { /* Single 32/16 */ |
| buswidth = 32; |
| outSISIDXREG(SISSR, 0x13, 0xb1); |
| outSISIDXREG(SISSR, 0x14, 0x52); |
| sisfb_post_xgi_delay(ivideo, 1); |
| sr14 = 0x02; |
| if(sisfb_post_xgi_rwtest(ivideo, 23, 24, mapsize)) |
| goto bail_out; |
| |
| outSISIDXREG(SISSR, 0x13, 0x31); |
| outSISIDXREG(SISSR, 0x14, 0x42); |
| sisfb_post_xgi_delay(ivideo, 1); |
| if(sisfb_post_xgi_rwtest(ivideo, 23, 23, mapsize)) |
| goto bail_out; |
| |
| buswidth = 16; |
| outSISIDXREG(SISSR, 0x13, 0xb1); |
| outSISIDXREG(SISSR, 0x14, 0x41); |
| sisfb_post_xgi_delay(ivideo, 1); |
| sr14 = 0x01; |
| if(sisfb_post_xgi_rwtest(ivideo, 22, 23, mapsize)) |
| goto bail_out; |
| else |
| outSISIDXREG(SISSR, 0x13, 0x31); |
| } else { /* Dual 16/8 */ |
| buswidth = 16; |
| outSISIDXREG(SISSR, 0x13, 0xb1); |
| outSISIDXREG(SISSR, 0x14, 0x41); |
| sisfb_post_xgi_delay(ivideo, 1); |
| sr14 = 0x01; |
| if(sisfb_post_xgi_rwtest(ivideo, 22, 23, mapsize)) |
| goto bail_out; |
| |
| outSISIDXREG(SISSR, 0x13, 0x31); |
| outSISIDXREG(SISSR, 0x14, 0x31); |
| sisfb_post_xgi_delay(ivideo, 1); |
| if(sisfb_post_xgi_rwtest(ivideo, 22, 22, mapsize)) |
| goto bail_out; |
| |
| buswidth = 8; |
| outSISIDXREG(SISSR, 0x13, 0xb1); |
| outSISIDXREG(SISSR, 0x14, 0x30); |
| sisfb_post_xgi_delay(ivideo, 1); |
| sr14 = 0x00; |
| if(sisfb_post_xgi_rwtest(ivideo, 21, 22, mapsize)) |
| goto bail_out; |
| else |
| outSISIDXREG(SISSR, 0x13, 0x31); |
| } |
| |
| } else { /* XGI_40 */ |
| |
| inSISIDXREG(SISCR, 0x97, reg); |
| if(!(reg & 0x10)) { |
| inSISIDXREG(SISSR, 0x39, reg); |
| reg >>= 1; |
| } |
| |
| if(reg & 0x01) { /* DDRII */ |
| buswidth = 32; |
| if(ivideo->revision_id == 2) { |
| channelab = 2; |
| outSISIDXREG(SISSR, 0x13, 0xa1); |
| outSISIDXREG(SISSR, 0x14, 0x44); |
| sr14 = 0x04; |
| sisfb_post_xgi_delay(ivideo, 1); |
| if(sisfb_post_xgi_rwtest(ivideo, 23, 24, mapsize)) |
| goto bail_out; |
| |
| outSISIDXREG(SISSR, 0x13, 0x21); |
| outSISIDXREG(SISSR, 0x14, 0x34); |
| if(sisfb_post_xgi_rwtest(ivideo, 22, 23, mapsize)) |
| goto bail_out; |
| |
| channelab = 1; |
| outSISIDXREG(SISSR, 0x13, 0xa1); |
| outSISIDXREG(SISSR, 0x14, 0x40); |
| sr14 = 0x00; |
| if(sisfb_post_xgi_rwtest(ivideo, 22, 23, mapsize)) |
| goto bail_out; |
| |
| outSISIDXREG(SISSR, 0x13, 0x21); |
| outSISIDXREG(SISSR, 0x14, 0x30); |
| } else { |
| channelab = 3; |
| outSISIDXREG(SISSR, 0x13, 0xa1); |
| outSISIDXREG(SISSR, 0x14, 0x4c); |
| sr14 = 0x0c; |
| sisfb_post_xgi_delay(ivideo, 1); |
| if(sisfb_post_xgi_rwtest(ivideo, 23, 25, mapsize)) |
| goto bail_out; |
| |
| channelab = 2; |
| outSISIDXREG(SISSR, 0x14, 0x48); |
| sisfb_post_xgi_delay(ivideo, 1); |
| sr14 = 0x08; |
| if(sisfb_post_xgi_rwtest(ivideo, 23, 24, mapsize)) |
| goto bail_out; |
| |
| outSISIDXREG(SISSR, 0x13, 0x21); |
| outSISIDXREG(SISSR, 0x14, 0x3c); |
| sr14 = 0x0c; |
| |
| if(sisfb_post_xgi_rwtest(ivideo, 23, 24, mapsize)) { |
| channelab = 3; |
| } else { |
| channelab = 2; |
| outSISIDXREG(SISSR, 0x14, 0x38); |
| sr14 = 0x08; |
| } |
| } |
| sisfb_post_xgi_delay(ivideo, 1); |
| |
| } else { /* DDR */ |
| |
| buswidth = 64; |
| if(ivideo->revision_id == 2) { |
| channelab = 1; |
| outSISIDXREG(SISSR, 0x13, 0xa1); |
| outSISIDXREG(SISSR, 0x14, 0x52); |
| sisfb_post_xgi_delay(ivideo, 1); |
| sr14 = 0x02; |
| if(sisfb_post_xgi_rwtest(ivideo, 23, 24, mapsize)) |
| goto bail_out; |
| |
| outSISIDXREG(SISSR, 0x13, 0x21); |
| outSISIDXREG(SISSR, 0x14, 0x42); |
| } else { |
| channelab = 2; |
| outSISIDXREG(SISSR, 0x13, 0xa1); |
| outSISIDXREG(SISSR, 0x14, 0x5a); |
| sisfb_post_xgi_delay(ivideo, 1); |
| sr14 = 0x0a; |
| if(sisfb_post_xgi_rwtest(ivideo, 24, 25, mapsize)) |
| goto bail_out; |
| |
| outSISIDXREG(SISSR, 0x13, 0x21); |
| outSISIDXREG(SISSR, 0x14, 0x4a); |
| } |
| sisfb_post_xgi_delay(ivideo, 1); |
| |
| } |
| } |
| |
| bail_out: |
| setSISIDXREG(SISSR, 0x14, 0xf0, sr14); |
| sisfb_post_xgi_delay(ivideo, 1); |
| |
| j = (ivideo->chip == XGI_20) ? 5 : 9; |
| k = (ivideo->chip == XGI_20) ? 12 : 4; |
| |
| for(i = 0; i < k; i++) { |
| |
| reg = (ivideo->chip == XGI_20) ? |
| dramsr13[(i * 5) + 4] : dramsr13_4[(i * 5) + 4]; |
| setSISIDXREG(SISSR, 0x13, 0x80, reg); |
| sisfb_post_xgi_delay(ivideo, 50); |
| |
| ranksize = (ivideo->chip == XGI_20) ? |
| dramsr13[(i * 5) + 3] : dramsr13_4[(i * 5) + 3]; |
| |
| inSISIDXREG(SISSR, 0x13, reg); |
| if(reg & 0x80) ranksize <<= 1; |
| |
| if(ivideo->chip == XGI_20) { |
| if(buswidth == 16) ranksize <<= 1; |
| else if(buswidth == 32) ranksize <<= 2; |
| } else { |
| if(buswidth == 64) ranksize <<= 1; |
| } |
| |
| reg = 0; |
| l = channelab; |
| if(l == 3) l = 4; |
| if((ranksize * l) <= 256) { |
| while((ranksize >>= 1)) reg += 0x10; |
| } |
| |
| if(!reg) continue; |
| |
| setSISIDXREG(SISSR, 0x14, 0x0f, (reg & 0xf0)); |
| sisfb_post_xgi_delay(ivideo, 1); |
| |
| if(sisfb_post_xgi_rwtest(ivideo, j, ((reg >> 4) + channelab - 2 + 20), mapsize)) |
| break; |
| } |
| |
| iounmap(ivideo->video_vbase); |
| } |
| |
| static void __devinit |
| sisfb_post_xgi_setclocks(struct sis_video_info *ivideo, u8 regb) |
| { |
| u8 v1, v2, v3; |
| int index; |
| static const u8 cs90[8 * 3] = { |
| 0x16, 0x01, 0x01, |
| 0x3e, 0x03, 0x01, |
| 0x7c, 0x08, 0x01, |
| 0x79, 0x06, 0x01, |
| 0x29, 0x01, 0x81, |
| 0x5c, 0x23, 0x01, |
| 0x5c, 0x23, 0x01, |
| 0x5c, 0x23, 0x01 |
| }; |
| static const u8 csb8[8 * 3] = { |
| 0x5c, 0x23, 0x01, |
| 0x29, 0x01, 0x01, |
| 0x7c, 0x08, 0x01, |
| 0x79, 0x06, 0x01, |
| 0x29, 0x01, 0x81, |
| 0x5c, 0x23, 0x01, |
| 0x5c, 0x23, 0x01, |
| 0x5c, 0x23, 0x01 |
| }; |
| |
| regb = 0; /* ! */ |
| |
| index = regb * 3; |
| v1 = cs90[index]; v2 = cs90[index + 1]; v3 = cs90[index + 2]; |
| if(ivideo->haveXGIROM) { |
| v1 = ivideo->bios_abase[0x90 + index]; |
| v2 = ivideo->bios_abase[0x90 + index + 1]; |
| v3 = ivideo->bios_abase[0x90 + index + 2]; |
| } |
| outSISIDXREG(SISSR, 0x28, v1); |
| outSISIDXREG(SISSR, 0x29, v2); |
| outSISIDXREG(SISSR, 0x2a, v3); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| index = regb * 3; |
| v1 = csb8[index]; v2 = csb8[index + 1]; v3 = csb8[index + 2]; |
| if(ivideo->haveXGIROM) { |
| v1 = ivideo->bios_abase[0xb8 + index]; |
| v2 = ivideo->bios_abase[0xb8 + index + 1]; |
| v3 = ivideo->bios_abase[0xb8 + index + 2]; |
| } |
| outSISIDXREG(SISSR, 0x2e, v1); |
| outSISIDXREG(SISSR, 0x2f, v2); |
| outSISIDXREG(SISSR, 0x30, v3); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| } |
| |
| static int __devinit |
| sisfb_post_xgi(struct pci_dev *pdev) |
| { |
| struct sis_video_info *ivideo = pci_get_drvdata(pdev); |
| unsigned char *bios = ivideo->bios_abase; |
| struct pci_dev *mypdev = NULL; |
| const u8 *ptr, *ptr2; |
| u8 v1, v2, v3, v4, v5, reg, ramtype; |
| u32 rega, regb, regd; |
| int i, j, k, index; |
| static const u8 cs78[3] = { 0xf6, 0x0d, 0x00 }; |
| static const u8 cs76[2] = { 0xa3, 0xfb }; |
| static const u8 cs7b[3] = { 0xc0, 0x11, 0x00 }; |
| static const u8 cs158[8] = { |
| 0x88, 0xaa, 0x48, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs160[8] = { |
| 0x44, 0x77, 0x77, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs168[8] = { |
| 0x48, 0x78, 0x88, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs128[3 * 8] = { |
| 0x90, 0x28, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x77, 0x44, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x77, 0x44, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs148[2 * 8] = { |
| 0x55, 0x55, 0x55, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs31a[8 * 4] = { |
| 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, |
| 0xaa, 0xaa, 0xaa, 0xaa, 0x00, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs33a[8 * 4] = { |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs45a[8 * 2] = { |
| 0x00, 0x00, 0xa0, 0x00, 0xa0, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs170[7 * 8] = { |
| 0x54, 0x32, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x54, 0x43, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x0a, 0x05, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x44, 0x34, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x10, 0x0a, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x11, 0x0c, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x05, 0x05, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs1a8[3 * 8] = { |
| 0xf0, 0xf0, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x05, 0x02, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| static const u8 cs100[2 * 8] = { |
| 0xc4, 0x04, 0x84, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0xc4, 0x04, 0x84, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| |
| /* VGA enable */ |
| reg = inSISREG(SISVGAENABLE) | 0x01; |
| outSISREG(SISVGAENABLE, reg); |
| |
| /* Misc */ |
| reg = inSISREG(SISMISCR) | 0x01; |
| outSISREG(SISMISCW, reg); |
| |
| /* Unlock SR */ |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| inSISIDXREG(SISSR, 0x05, reg); |
| if(reg != 0xa1) |
| return 0; |
| |
| /* Clear some regs */ |
| for(i = 0; i < 0x22; i++) { |
| if(0x06 + i == 0x20) continue; |
| outSISIDXREG(SISSR, 0x06 + i, 0x00); |
| } |
| for(i = 0; i < 0x0b; i++) { |
| outSISIDXREG(SISSR, 0x31 + i, 0x00); |
| } |
| for(i = 0; i < 0x10; i++) { |
| outSISIDXREG(SISCR, 0x30 + i, 0x00); |
| } |
| |
| ptr = cs78; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x78]; |
| } |
| for(i = 0; i < 3; i++) { |
| outSISIDXREG(SISSR, 0x23 + i, ptr[i]); |
| } |
| |
| ptr = cs76; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x76]; |
| } |
| for(i = 0; i < 2; i++) { |
| outSISIDXREG(SISSR, 0x21 + i, ptr[i]); |
| } |
| |
| v1 = 0x18; v2 = 0x00; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0x74]; |
| v2 = bios[0x75]; |
| } |
| outSISIDXREG(SISSR, 0x07, v1); |
| outSISIDXREG(SISSR, 0x11, 0x0f); |
| outSISIDXREG(SISSR, 0x1f, v2); |
| /* PCI linear mode, RelIO enabled, A0000 decoding disabled */ |
| outSISIDXREG(SISSR, 0x20, 0x80 | 0x20 | 0x04); |
| outSISIDXREG(SISSR, 0x27, 0x74); |
| |
| ptr = cs7b; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x7b]; |
| } |
| for(i = 0; i < 3; i++) { |
| outSISIDXREG(SISSR, 0x31 + i, ptr[i]); |
| } |
| |
| if(ivideo->chip == XGI_40) { |
| if(ivideo->revision_id == 2) { |
| setSISIDXREG(SISSR, 0x3b, 0x3f, 0xc0); |
| } |
| outSISIDXREG(SISCR, 0x7d, 0xfe); |
| outSISIDXREG(SISCR, 0x7e, 0x0f); |
| } |
| if(ivideo->revision_id == 0) { /* 40 *and* 20? */ |
| andSISIDXREG(SISCR, 0x58, 0xd7); |
| inSISIDXREG(SISCR, 0xcb, reg); |
| if(reg & 0x20) { |
| setSISIDXREG(SISCR, 0x58, 0xd7, (reg & 0x10) ? 0x08 : 0x20); /* =0x28 Z7 ? */ |
| } |
| } |
| |
| reg = (ivideo->chip == XGI_40) ? 0x20 : 0x00; |
| setSISIDXREG(SISCR, 0x38, 0x1f, reg); |
| |
| if(ivideo->chip == XGI_20) { |
| outSISIDXREG(SISSR, 0x36, 0x70); |
| } else { |
| outSISIDXREG(SISVID, 0x00, 0x86); |
| outSISIDXREG(SISVID, 0x32, 0x00); |
| outSISIDXREG(SISVID, 0x30, 0x00); |
| outSISIDXREG(SISVID, 0x32, 0x01); |
| outSISIDXREG(SISVID, 0x30, 0x00); |
| andSISIDXREG(SISVID, 0x2f, 0xdf); |
| andSISIDXREG(SISCAP, 0x00, 0x3f); |
| |
| outSISIDXREG(SISPART1, 0x2f, 0x01); |
| outSISIDXREG(SISPART1, 0x00, 0x00); |
| outSISIDXREG(SISPART1, 0x02, bios[0x7e]); |
| outSISIDXREG(SISPART1, 0x2e, 0x08); |
| andSISIDXREG(SISPART1, 0x35, 0x7f); |
| andSISIDXREG(SISPART1, 0x50, 0xfe); |
| |
| inSISIDXREG(SISPART4, 0x00, reg); |
| if(reg == 1 || reg == 2) { |
| outSISIDXREG(SISPART2, 0x00, 0x1c); |
| outSISIDXREG(SISPART4, 0x0d, bios[0x7f]); |
| outSISIDXREG(SISPART4, 0x0e, bios[0x80]); |
| outSISIDXREG(SISPART4, 0x10, bios[0x81]); |
| andSISIDXREG(SISPART4, 0x0f, 0x3f); |
| |
| inSISIDXREG(SISPART4, 0x01, reg); |
| if((reg & 0xf0) >= 0xb0) { |
| inSISIDXREG(SISPART4, 0x23, reg); |
| if(reg & 0x20) reg |= 0x40; |
| outSISIDXREG(SISPART4, 0x23, reg); |
| reg = (reg & 0x20) ? 0x02 : 0x00; |
| setSISIDXREG(SISPART1, 0x1e, 0xfd, reg); |
| } |
| } |
| |
| v1 = bios[0x77]; |
| |
| inSISIDXREG(SISSR, 0x3b, reg); |
| if(reg & 0x02) { |
| inSISIDXREG(SISSR, 0x3a, reg); |
| v2 = (reg & 0x30) >> 3; |
| if(!(v2 & 0x04)) v2 ^= 0x02; |
| inSISIDXREG(SISSR, 0x39, reg); |
| if(reg & 0x80) v2 |= 0x80; |
| v2 |= 0x01; |
| |
| if((mypdev = SIS_PCI_GET_DEVICE(PCI_VENDOR_ID_SI, 0x0730, NULL))) { |
| SIS_PCI_PUT_DEVICE(mypdev); |
| if(((v2 & 0x06) == 2) || ((v2 & 0x06) == 4)) |
| v2 &= 0xf9; |
| v2 |= 0x08; |
| v1 &= 0xfe; |
| } else { |
| mypdev = SIS_PCI_GET_DEVICE(PCI_VENDOR_ID_SI, 0x0735, NULL); |
| if(!mypdev) |
| mypdev = SIS_PCI_GET_DEVICE(PCI_VENDOR_ID_SI, 0x0645, NULL); |
| if(!mypdev) |
| mypdev = SIS_PCI_GET_DEVICE(PCI_VENDOR_ID_SI, 0x0650, NULL); |
| if(mypdev) { |
| pci_read_config_dword(mypdev, 0x94, ®d); |
| regd &= 0xfffffeff; |
| pci_write_config_dword(mypdev, 0x94, regd); |
| v1 &= 0xfe; |
| SIS_PCI_PUT_DEVICE(mypdev); |
| } else if(sisfb_find_host_bridge(ivideo, pdev, PCI_VENDOR_ID_SI)) { |
| v1 &= 0xfe; |
| } else if(sisfb_find_host_bridge(ivideo, pdev, 0x1106) || |
| sisfb_find_host_bridge(ivideo, pdev, 0x1022) || |
| sisfb_find_host_bridge(ivideo, pdev, 0x700e) || |
| sisfb_find_host_bridge(ivideo, pdev, 0x10de)) { |
| if((v2 & 0x06) == 4) |
| v2 ^= 0x06; |
| v2 |= 0x08; |
| } |
| } |
| setSISIDXREG(SISCR, 0x5f, 0xf0, v2); |
| } |
| outSISIDXREG(SISSR, 0x22, v1); |
| |
| if(ivideo->revision_id == 2) { |
| inSISIDXREG(SISSR, 0x3b, v1); |
| inSISIDXREG(SISSR, 0x3a, v2); |
| regd = bios[0x90 + 3] | (bios[0x90 + 4] << 8); |
| if( (!(v1 & 0x02)) && (v2 & 0x30) && (regd < 0xcf) ) |
| setSISIDXREG(SISCR, 0x5f, 0xf1, 0x01); |
| |
| if((mypdev = SIS_PCI_GET_DEVICE(0x10de, 0x01e0, NULL))) { |
| /* TODO: set CR5f &0xf1 | 0x01 for version 6570 |
| * of nforce 2 ROM |
| */ |
| if(0) |
| setSISIDXREG(SISCR, 0x5f, 0xf1, 0x01); |
| SIS_PCI_PUT_DEVICE(mypdev); |
| } |
| } |
| |
| v1 = 0x30; |
| inSISIDXREG(SISSR, 0x3b, reg); |
| inSISIDXREG(SISCR, 0x5f, v2); |
| if((!(reg & 0x02)) && (v2 & 0x0e)) |
| v1 |= 0x08; |
| outSISIDXREG(SISSR, 0x27, v1); |
| |
| if(bios[0x64] & 0x01) { |
| setSISIDXREG(SISCR, 0x5f, 0xf0, bios[0x64]); |
| } |
| |
| v1 = bios[0x4f7]; |
| pci_read_config_dword(pdev, 0x50, ®d); |
| regd = (regd >> 20) & 0x0f; |
| if(regd == 1) { |
| v1 &= 0xfc; |
| orSISIDXREG(SISCR, 0x5f, 0x08); |
| } |
| outSISIDXREG(SISCR, 0x48, v1); |
| |
| setSISIDXREG(SISCR, 0x47, 0x04, bios[0x4f6] & 0xfb); |
| setSISIDXREG(SISCR, 0x49, 0xf0, bios[0x4f8] & 0x0f); |
| setSISIDXREG(SISCR, 0x4a, 0x60, bios[0x4f9] & 0x9f); |
| setSISIDXREG(SISCR, 0x4b, 0x08, bios[0x4fa] & 0xf7); |
| setSISIDXREG(SISCR, 0x4c, 0x80, bios[0x4fb] & 0x7f); |
| outSISIDXREG(SISCR, 0x70, bios[0x4fc]); |
| setSISIDXREG(SISCR, 0x71, 0xf0, bios[0x4fd] & 0x0f); |
| outSISIDXREG(SISCR, 0x74, 0xd0); |
| setSISIDXREG(SISCR, 0x74, 0xcf, bios[0x4fe] & 0x30); |
| setSISIDXREG(SISCR, 0x75, 0xe0, bios[0x4ff] & 0x1f); |
| setSISIDXREG(SISCR, 0x76, 0xe0, bios[0x500] & 0x1f); |
| v1 = bios[0x501]; |
| if((mypdev = SIS_PCI_GET_DEVICE(0x8086, 0x2530, NULL))) { |
| v1 = 0xf0; |
| SIS_PCI_PUT_DEVICE(mypdev); |
| } |
| outSISIDXREG(SISCR, 0x77, v1); |
| } |
| |
| /* RAM type */ |
| |
| regb = 0; /* ! */ |
| |
| v1 = 0xff; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0x140 + regb]; |
| } |
| outSISIDXREG(SISCR, 0x6d, v1); |
| |
| ptr = cs128; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x128]; |
| } |
| for(i = 0, j = 0; i < 3; i++, j += 8) { |
| outSISIDXREG(SISCR, 0x68 + i, ptr[j + regb]); |
| } |
| |
| ptr = cs31a; |
| ptr2 = cs33a; |
| if(ivideo->haveXGIROM) { |
| index = (ivideo->chip == XGI_20) ? 0x31a : 0x3a6; |
| ptr = (const u8 *)&bios[index]; |
| ptr2 = (const u8 *)&bios[index + 0x20]; |
| } |
| for(i = 0; i < 2; i++) { |
| if(i == 0) { |
| regd = le32_to_cpu(((u32 *)ptr)[regb]); |
| rega = 0x6b; |
| } else { |
| regd = le32_to_cpu(((u32 *)ptr2)[regb]); |
| rega = 0x6e; |
| } |
| reg = 0x00; |
| for(j = 0; j < 16; j++) { |
| reg &= 0xf3; |
| if(regd & 0x01) reg |= 0x04; |
| if(regd & 0x02) reg |= 0x08; |
| regd >>= 2; |
| outSISIDXREG(SISCR, rega, reg); |
| inSISIDXREG(SISCR, rega, reg); |
| inSISIDXREG(SISCR, rega, reg); |
| reg += 0x10; |
| } |
| } |
| |
| andSISIDXREG(SISCR, 0x6e, 0xfc); |
| |
| ptr = NULL; |
| if(ivideo->haveXGIROM) { |
| index = (ivideo->chip == XGI_20) ? 0x35a : 0x3e6; |
| ptr = (const u8 *)&bios[index]; |
| } |
| for(i = 0; i < 4; i++) { |
| setSISIDXREG(SISCR, 0x6e, 0xfc, i); |
| reg = 0x00; |
| for(j = 0; j < 2; j++) { |
| regd = 0; |
| if(ptr) { |
| regd = le32_to_cpu(((u32 *)ptr)[regb * 8]); |
| ptr += 4; |
| } |
| /* reg = 0x00; */ |
| for(k = 0; k < 16; k++) { |
| reg &= 0xfc; |
| if(regd & 0x01) reg |= 0x01; |
| if(regd & 0x02) reg |= 0x02; |
| regd >>= 2; |
| outSISIDXREG(SISCR, 0x6f, reg); |
| inSISIDXREG(SISCR, 0x6f, reg); |
| inSISIDXREG(SISCR, 0x6f, reg); |
| reg += 0x08; |
| } |
| } |
| } |
| |
| ptr = cs148; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x148]; |
| } |
| for(i = 0, j = 0; i < 2; i++, j += 8) { |
| outSISIDXREG(SISCR, 0x80 + i, ptr[j + regb]); |
| } |
| |
| andSISIDXREG(SISCR, 0x89, 0x8f); |
| |
| ptr = cs45a; |
| if(ivideo->haveXGIROM) { |
| index = (ivideo->chip == XGI_20) ? 0x45a : 0x4e6; |
| ptr = (const u8 *)&bios[index]; |
| } |
| regd = le16_to_cpu(((const u16 *)ptr)[regb]); |
| reg = 0x80; |
| for(i = 0; i < 5; i++) { |
| reg &= 0xfc; |
| if(regd & 0x01) reg |= 0x01; |
| if(regd & 0x02) reg |= 0x02; |
| regd >>= 2; |
| outSISIDXREG(SISCR, 0x89, reg); |
| inSISIDXREG(SISCR, 0x89, reg); |
| inSISIDXREG(SISCR, 0x89, reg); |
| reg += 0x10; |
| } |
| |
| v1 = 0xb5; v2 = 0x20; v3 = 0xf0; v4 = 0x13; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0x118 + regb]; |
| v2 = bios[0xf8 + regb]; |
| v3 = bios[0x120 + regb]; |
| v4 = bios[0x1ca]; |
| } |
| outSISIDXREG(SISCR, 0x45, v1 & 0x0f); |
| outSISIDXREG(SISCR, 0x99, (v1 >> 4) & 0x07); |
| orSISIDXREG(SISCR, 0x40, v1 & 0x80); |
| outSISIDXREG(SISCR, 0x41, v2); |
| |
| ptr = cs170; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x170]; |
| } |
| for(i = 0, j = 0; i < 7; i++, j += 8) { |
| outSISIDXREG(SISCR, 0x90 + i, ptr[j + regb]); |
| } |
| |
| outSISIDXREG(SISCR, 0x59, v3); |
| |
| ptr = cs1a8; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x1a8]; |
| } |
| for(i = 0, j = 0; i < 3; i++, j += 8) { |
| outSISIDXREG(SISCR, 0xc3 + i, ptr[j + regb]); |
| } |
| |
| ptr = cs100; |
| if(ivideo->haveXGIROM) { |
| ptr = (const u8 *)&bios[0x100]; |
| } |
| for(i = 0, j = 0; i < 2; i++, j += 8) { |
| outSISIDXREG(SISCR, 0x8a + i, ptr[j + regb]); |
| } |
| |
| outSISIDXREG(SISCR, 0xcf, v4); |
| |
| outSISIDXREG(SISCR, 0x83, 0x09); |
| outSISIDXREG(SISCR, 0x87, 0x00); |
| |
| if(ivideo->chip == XGI_40) { |
| if( (ivideo->revision_id == 1) || |
| (ivideo->revision_id == 2) ) { |
| outSISIDXREG(SISCR, 0x8c, 0x87); |
| } |
| } |
| |
| outSISIDXREG(SISSR, 0x17, 0x00); |
| outSISIDXREG(SISSR, 0x1a, 0x87); |
| |
| if(ivideo->chip == XGI_20) { |
| outSISIDXREG(SISSR, 0x15, 0x00); |
| outSISIDXREG(SISSR, 0x1c, 0x00); |
| } |
| |
| ramtype = 0x00; v1 = 0x10; |
| if(ivideo->haveXGIROM) { |
| ramtype = bios[0x62]; |
| v1 = bios[0x1d2]; |
| } |
| if(!(ramtype & 0x80)) { |
| if(ivideo->chip == XGI_20) { |
| outSISIDXREG(SISCR, 0x97, v1); |
| inSISIDXREG(SISCR, 0x97, reg); |
| if(reg & 0x10) { |
| ramtype = (reg & 0x01) << 1; |
| } |
| } else { |
| inSISIDXREG(SISSR, 0x39, reg); |
| ramtype = reg & 0x02; |
| if(!(ramtype)) { |
| inSISIDXREG(SISSR, 0x3a, reg); |
| ramtype = (reg >> 1) & 0x01; |
| } |
| } |
| } |
| ramtype &= 0x07; |
| |
| regb = 0; /* ! */ |
| |
| switch(ramtype) { |
| case 0: |
| sisfb_post_xgi_setclocks(ivideo, regb); |
| if((ivideo->chip == XGI_20) || |
| (ivideo->revision_id == 1) || |
| (ivideo->revision_id == 2)) { |
| v1 = cs158[regb]; v2 = cs160[regb]; v3 = cs168[regb]; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[regb + 0x158]; |
| v2 = bios[regb + 0x160]; |
| v3 = bios[regb + 0x168]; |
| } |
| outSISIDXREG(SISCR, 0x82, v1); |
| outSISIDXREG(SISCR, 0x85, v2); |
| outSISIDXREG(SISCR, 0x86, v3); |
| } else { |
| outSISIDXREG(SISCR, 0x82, 0x88); |
| outSISIDXREG(SISCR, 0x86, 0x00); |
| inSISIDXREG(SISCR, 0x86, reg); |
| outSISIDXREG(SISCR, 0x86, 0x88); |
| inSISIDXREG(SISCR, 0x86, reg); |
| outSISIDXREG(SISCR, 0x86, bios[regb + 0x168]); |
| outSISIDXREG(SISCR, 0x82, 0x77); |
| outSISIDXREG(SISCR, 0x85, 0x00); |
| inSISIDXREG(SISCR, 0x85, reg); |
| outSISIDXREG(SISCR, 0x85, 0x88); |
| inSISIDXREG(SISCR, 0x85, reg); |
| outSISIDXREG(SISCR, 0x85, bios[regb + 0x160]); |
| outSISIDXREG(SISCR, 0x82, bios[regb + 0x158]); |
| } |
| if(ivideo->chip == XGI_40) { |
| outSISIDXREG(SISCR, 0x97, 0x00); |
| } |
| outSISIDXREG(SISCR, 0x98, 0x01); |
| outSISIDXREG(SISCR, 0x9a, 0x02); |
| |
| outSISIDXREG(SISSR, 0x18, 0x01); |
| if((ivideo->chip == XGI_20) || |
| (ivideo->revision_id == 2)) { |
| outSISIDXREG(SISSR, 0x19, 0x40); |
| } else { |
| outSISIDXREG(SISSR, 0x19, 0x20); |
| } |
| outSISIDXREG(SISSR, 0x16, 0x00); |
| outSISIDXREG(SISSR, 0x16, 0x80); |
| if((ivideo->chip == XGI_20) || (bios[0x1cb] != 0x0c)) { |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| outSISIDXREG(SISSR, 0x18, 0x00); |
| if((ivideo->chip == XGI_20) || |
| (ivideo->revision_id == 2)) { |
| outSISIDXREG(SISSR, 0x19, 0x40); |
| } else { |
| outSISIDXREG(SISSR, 0x19, 0x20); |
| } |
| } else if((ivideo->chip == XGI_40) && (bios[0x1cb] == 0x0c)) { |
| /* outSISIDXREG(SISSR, 0x16, 0x0c); */ /* ? */ |
| } |
| outSISIDXREG(SISSR, 0x16, 0x00); |
| outSISIDXREG(SISSR, 0x16, 0x80); |
| sisfb_post_xgi_delay(ivideo, 4); |
| v1 = 0x31; v2 = 0x03; v3 = 0x83; v4 = 0x03; v5 = 0x83; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0xf0]; |
| index = (ivideo->chip == XGI_20) ? 0x4b2 : 0x53e; |
| v2 = bios[index]; |
| v3 = bios[index + 1]; |
| v4 = bios[index + 2]; |
| v5 = bios[index + 3]; |
| } |
| outSISIDXREG(SISSR, 0x18, v1); |
| outSISIDXREG(SISSR, 0x19, ((ivideo->chip == XGI_20) ? 0x02 : 0x01)); |
| outSISIDXREG(SISSR, 0x16, v2); |
| outSISIDXREG(SISSR, 0x16, v3); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| outSISIDXREG(SISSR, 0x1b, 0x03); |
| sisfb_post_xgi_delay(ivideo, 0x22); |
| outSISIDXREG(SISSR, 0x18, v1); |
| outSISIDXREG(SISSR, 0x19, 0x00); |
| outSISIDXREG(SISSR, 0x16, v4); |
| outSISIDXREG(SISSR, 0x16, v5); |
| outSISIDXREG(SISSR, 0x1b, 0x00); |
| break; |
| case 1: |
| outSISIDXREG(SISCR, 0x82, 0x77); |
| outSISIDXREG(SISCR, 0x86, 0x00); |
| inSISIDXREG(SISCR, 0x86, reg); |
| outSISIDXREG(SISCR, 0x86, 0x88); |
| inSISIDXREG(SISCR, 0x86, reg); |
| v1 = cs168[regb]; v2 = cs160[regb]; v3 = cs158[regb]; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[regb + 0x168]; |
| v2 = bios[regb + 0x160]; |
| v3 = bios[regb + 0x158]; |
| } |
| outSISIDXREG(SISCR, 0x86, v1); |
| outSISIDXREG(SISCR, 0x82, 0x77); |
| outSISIDXREG(SISCR, 0x85, 0x00); |
| inSISIDXREG(SISCR, 0x85, reg); |
| outSISIDXREG(SISCR, 0x85, 0x88); |
| inSISIDXREG(SISCR, 0x85, reg); |
| outSISIDXREG(SISCR, 0x85, v2); |
| outSISIDXREG(SISCR, 0x82, v3); |
| outSISIDXREG(SISCR, 0x98, 0x01); |
| outSISIDXREG(SISCR, 0x9a, 0x02); |
| |
| outSISIDXREG(SISSR, 0x28, 0x64); |
| outSISIDXREG(SISSR, 0x29, 0x63); |
| sisfb_post_xgi_delay(ivideo, 15); |
| outSISIDXREG(SISSR, 0x18, 0x00); |
| outSISIDXREG(SISSR, 0x19, 0x20); |
| outSISIDXREG(SISSR, 0x16, 0x00); |
| outSISIDXREG(SISSR, 0x16, 0x80); |
| outSISIDXREG(SISSR, 0x18, 0xc5); |
| outSISIDXREG(SISSR, 0x19, 0x23); |
| outSISIDXREG(SISSR, 0x16, 0x00); |
| outSISIDXREG(SISSR, 0x16, 0x80); |
| sisfb_post_xgi_delay(ivideo, 1); |
| outSISIDXREG(SISCR, 0x97,0x11); |
| sisfb_post_xgi_setclocks(ivideo, regb); |
| sisfb_post_xgi_delay(ivideo, 0x46); |
| outSISIDXREG(SISSR, 0x18, 0xc5); |
| outSISIDXREG(SISSR, 0x19, 0x23); |
| outSISIDXREG(SISSR, 0x16, 0x00); |
| outSISIDXREG(SISSR, 0x16, 0x80); |
| sisfb_post_xgi_delay(ivideo, 1); |
| outSISIDXREG(SISSR, 0x1b, 0x04); |
| sisfb_post_xgi_delay(ivideo, 1); |
| outSISIDXREG(SISSR, 0x1b, 0x00); |
| sisfb_post_xgi_delay(ivideo, 1); |
| v1 = 0x31; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0xf0]; |
| } |
| outSISIDXREG(SISSR, 0x18, v1); |
| outSISIDXREG(SISSR, 0x19, 0x06); |
| outSISIDXREG(SISSR, 0x16, 0x04); |
| outSISIDXREG(SISSR, 0x16, 0x84); |
| sisfb_post_xgi_delay(ivideo, 1); |
| break; |
| default: |
| sisfb_post_xgi_setclocks(ivideo, regb); |
| if((ivideo->chip == XGI_40) && |
| ((ivideo->revision_id == 1) || |
| (ivideo->revision_id == 2))) { |
| outSISIDXREG(SISCR, 0x82, bios[regb + 0x158]); |
| outSISIDXREG(SISCR, 0x85, bios[regb + 0x160]); |
| outSISIDXREG(SISCR, 0x86, bios[regb + 0x168]); |
| } else { |
| outSISIDXREG(SISCR, 0x82, 0x88); |
| outSISIDXREG(SISCR, 0x86, 0x00); |
| inSISIDXREG(SISCR, 0x86, reg); |
| outSISIDXREG(SISCR, 0x86, 0x88); |
| outSISIDXREG(SISCR, 0x82, 0x77); |
| outSISIDXREG(SISCR, 0x85, 0x00); |
| inSISIDXREG(SISCR, 0x85, reg); |
| outSISIDXREG(SISCR, 0x85, 0x88); |
| inSISIDXREG(SISCR, 0x85, reg); |
| v1 = cs160[regb]; v2 = cs158[regb]; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[regb + 0x160]; |
| v2 = bios[regb + 0x158]; |
| } |
| outSISIDXREG(SISCR, 0x85, v1); |
| outSISIDXREG(SISCR, 0x82, v2); |
| } |
| if(ivideo->chip == XGI_40) { |
| outSISIDXREG(SISCR, 0x97, 0x11); |
| } |
| if((ivideo->chip == XGI_40) && (ivideo->revision_id == 2)) { |
| outSISIDXREG(SISCR, 0x98, 0x01); |
| } else { |
| outSISIDXREG(SISCR, 0x98, 0x03); |
| } |
| outSISIDXREG(SISCR, 0x9a, 0x02); |
| |
| if(ivideo->chip == XGI_40) { |
| outSISIDXREG(SISSR, 0x18, 0x01); |
| } else { |
| outSISIDXREG(SISSR, 0x18, 0x00); |
| } |
| outSISIDXREG(SISSR, 0x19, 0x40); |
| outSISIDXREG(SISSR, 0x16, 0x00); |
| outSISIDXREG(SISSR, 0x16, 0x80); |
| if((ivideo->chip == XGI_40) && (bios[0x1cb] != 0x0c)) { |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| outSISIDXREG(SISSR, 0x18, 0x00); |
| outSISIDXREG(SISSR, 0x19, 0x40); |
| outSISIDXREG(SISSR, 0x16, 0x00); |
| outSISIDXREG(SISSR, 0x16, 0x80); |
| } |
| sisfb_post_xgi_delay(ivideo, 4); |
| v1 = 0x31; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0xf0]; |
| } |
| outSISIDXREG(SISSR, 0x18, v1); |
| outSISIDXREG(SISSR, 0x19, 0x01); |
| if(ivideo->chip == XGI_40) { |
| outSISIDXREG(SISSR, 0x16, bios[0x53e]); |
| outSISIDXREG(SISSR, 0x16, bios[0x53f]); |
| } else { |
| outSISIDXREG(SISSR, 0x16, 0x05); |
| outSISIDXREG(SISSR, 0x16, 0x85); |
| } |
| sisfb_post_xgi_delay(ivideo, 0x43); |
| if(ivideo->chip == XGI_40) { |
| outSISIDXREG(SISSR, 0x1b, 0x01); |
| } else { |
| outSISIDXREG(SISSR, 0x1b, 0x03); |
| } |
| sisfb_post_xgi_delay(ivideo, 0x22); |
| outSISIDXREG(SISSR, 0x18, v1); |
| outSISIDXREG(SISSR, 0x19, 0x00); |
| if(ivideo->chip == XGI_40) { |
| outSISIDXREG(SISSR, 0x16, bios[0x540]); |
| outSISIDXREG(SISSR, 0x16, bios[0x541]); |
| } else { |
| outSISIDXREG(SISSR, 0x16, 0x05); |
| outSISIDXREG(SISSR, 0x16, 0x85); |
| } |
| outSISIDXREG(SISSR, 0x1b, 0x00); |
| } |
| |
| regb = 0; /* ! */ |
| v1 = 0x03; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0x110 + regb]; |
| } |
| outSISIDXREG(SISSR, 0x1b, v1); |
| |
| /* RAM size */ |
| v1 = 0x00; v2 = 0x00; |
| if(ivideo->haveXGIROM) { |
| v1 = bios[0x62]; |
| v2 = bios[0x63]; |
| } |
| regb = 0; /* ! */ |
| regd = 1 << regb; |
| if((v1 & 0x40) && (v2 & regd) && ivideo->haveXGIROM) { |
| |
| outSISIDXREG(SISSR, 0x13, bios[regb + 0xe0]); |
| outSISIDXREG(SISSR, 0x14, bios[regb + 0xe0 + 8]); |
| |
| } else { |
| |
| /* Set default mode, don't clear screen */ |
| ivideo->SiS_Pr.SiS_UseOEM = FALSE; |
| SiS_SetEnableDstn(&ivideo->SiS_Pr, FALSE); |
| SiS_SetEnableFstn(&ivideo->SiS_Pr, FALSE); |
| ivideo->curFSTN = ivideo->curDSTN = 0; |
| ivideo->SiS_Pr.VideoMemorySize = 8 << 20; |
| SiSSetMode(&ivideo->SiS_Pr, 0x2e | 0x80); |
| |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| |
| /* Disable read-cache */ |
| andSISIDXREG(SISSR, 0x21, 0xdf); |
| sisfb_post_xgi_ramsize(ivideo); |
| /* Enable read-cache */ |
| orSISIDXREG(SISSR, 0x21, 0x20); |
| |
| } |
| |
| #if 0 |
| printk(KERN_DEBUG "-----------------\n"); |
| for(i = 0; i < 0xff; i++) { |
| inSISIDXREG(SISCR, i, reg); |
| printk(KERN_DEBUG "CR%02x(%x) = 0x%02x\n", i, SISCR, reg); |
| } |
| for(i = 0; i < 0x40; i++) { |
| inSISIDXREG(SISSR, i, reg); |
| printk(KERN_DEBUG "SR%02x(%x) = 0x%02x\n", i, SISSR, reg); |
| } |
| printk(KERN_DEBUG "-----------------\n"); |
| #endif |
| |
| /* Sense CRT1 */ |
| if(ivideo->chip == XGI_20) { |
| orSISIDXREG(SISCR, 0x32, 0x20); |
| } else { |
| inSISIDXREG(SISPART4, 0x00, reg); |
| if((reg == 1) || (reg == 2)) { |
| sisfb_sense_crt1(ivideo); |
| } else { |
| orSISIDXREG(SISCR, 0x32, 0x20); |
| } |
| } |
| |
| /* Set default mode, don't clear screen */ |
| ivideo->SiS_Pr.SiS_UseOEM = FALSE; |
| SiS_SetEnableDstn(&ivideo->SiS_Pr, FALSE); |
| SiS_SetEnableFstn(&ivideo->SiS_Pr, FALSE); |
| ivideo->curFSTN = ivideo->curDSTN = 0; |
| SiSSetMode(&ivideo->SiS_Pr, 0x2e | 0x80); |
| |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| |
| /* Display off */ |
| orSISIDXREG(SISSR, 0x01, 0x20); |
| |
| /* Save mode number in CR34 */ |
| outSISIDXREG(SISCR, 0x34, 0x2e); |
| |
| /* Let everyone know what the current mode is */ |
| ivideo->modeprechange = 0x2e; |
| |
| if(ivideo->chip == XGI_40) { |
| inSISIDXREG(SISCR, 0xca, reg); |
| inSISIDXREG(SISCR, 0xcc, v1); |
| if((reg & 0x10) && (!(v1 & 0x04))) { |
| printk(KERN_ERR |
| "sisfb: Please connect power to the card.\n"); |
| return 0; |
| } |
| } |
| |
| return 1; |
| } |
| #endif |
| |
| static int __devinit |
| sisfb_probe(struct pci_dev *pdev, const struct pci_device_id *ent) |
| { |
| struct sisfb_chip_info *chipinfo = &sisfb_chip_info[ent->driver_data]; |
| struct sis_video_info *ivideo = NULL; |
| struct fb_info *sis_fb_info = NULL; |
| u16 reg16; |
| u8 reg; |
| int i, ret; |
| |
| if(sisfb_off) |
| return -ENXIO; |
| |
| #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,3)) |
| sis_fb_info = framebuffer_alloc(sizeof(*ivideo), &pdev->dev); |
| if(!sis_fb_info) |
| return -ENOMEM; |
| #else |
| sis_fb_info = kmalloc(sizeof(*sis_fb_info) + sizeof(*ivideo), GFP_KERNEL); |
| if(!sis_fb_info) |
| return -ENOMEM; |
| memset(sis_fb_info, 0, sizeof(*sis_fb_info) + sizeof(*ivideo)); |
| sis_fb_info->par = ((char *)sis_fb_info + sizeof(*sis_fb_info)); |
| #endif |
| |
| ivideo = (struct sis_video_info *)sis_fb_info->par; |
| ivideo->memyselfandi = sis_fb_info; |
| |
| ivideo->sisfb_id = SISFB_ID; |
| |
| if(card_list == NULL) { |
| ivideo->cardnumber = 0; |
| } else { |
| struct sis_video_info *countvideo = card_list; |
| ivideo->cardnumber = 1; |
| while((countvideo = countvideo->next) != 0) |
| ivideo->cardnumber++; |
| } |
| |
| strncpy(ivideo->myid, chipinfo->chip_name, 30); |
| |
| ivideo->warncount = 0; |
| ivideo->chip_id = pdev->device; |
| ivideo->chip_vendor = pdev->vendor; |
| pci_read_config_byte(pdev, PCI_REVISION_ID, &ivideo->revision_id); |
| ivideo->SiS_Pr.ChipRevision = ivideo->revision_id; |
| pci_read_config_word(pdev, PCI_COMMAND, ®16); |
| ivideo->sisvga_enabled = reg16 & 0x01; |
| ivideo->pcibus = pdev->bus->number; |
| ivideo->pcislot = PCI_SLOT(pdev->devfn); |
| ivideo->pcifunc = PCI_FUNC(pdev->devfn); |
| ivideo->subsysvendor = pdev->subsystem_vendor; |
| ivideo->subsysdevice = pdev->subsystem_device; |
| #ifdef SIS_OLD_CONFIG_COMPAT |
| ivideo->ioctl32registered = 0; |
| #endif |
| |
| #ifndef MODULE |
| if(sisfb_mode_idx == -1) { |
| sisfb_get_vga_mode_from_kernel(); |
| } |
| #endif |
| |
| ivideo->chip = chipinfo->chip; |
| ivideo->sisvga_engine = chipinfo->vgaengine; |
| ivideo->hwcursor_size = chipinfo->hwcursor_size; |
| ivideo->CRT2_write_enable = chipinfo->CRT2_write_enable; |
| ivideo->mni = chipinfo->mni; |
| |
| ivideo->detectedpdc = 0xff; |
| ivideo->detectedpdca = 0xff; |
| ivideo->detectedlcda = 0xff; |
| |
| ivideo->sisfb_thismonitor.datavalid = FALSE; |
| |
| ivideo->current_base = 0; |
| |
| ivideo->engineok = 0; |
| |
| ivideo->sisfb_was_boot_device = 0; |
| #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)) |
| if(pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW) { |
| if(ivideo->sisvga_enabled) |
| ivideo->sisfb_was_boot_device = 1; |
| else { |
| printk(KERN_DEBUG "sisfb: PCI device is disabled, " |
| "but marked as boot video device ???\n"); |
| printk(KERN_DEBUG "sisfb: I will not accept this " |
| "as the primary VGA device\n"); |
| } |
| } |
| #endif |
| |
| ivideo->sisfb_parm_mem = sisfb_parm_mem; |
| ivideo->sisfb_accel = sisfb_accel; |
| ivideo->sisfb_ypan = sisfb_ypan; |
| ivideo->sisfb_max = sisfb_max; |
| ivideo->sisfb_userom = sisfb_userom; |
| ivideo->sisfb_useoem = sisfb_useoem; |
| ivideo->sisfb_mode_idx = sisfb_mode_idx; |
| ivideo->sisfb_parm_rate = sisfb_parm_rate; |
| ivideo->sisfb_crt1off = sisfb_crt1off; |
| ivideo->sisfb_forcecrt1 = sisfb_forcecrt1; |
| ivideo->sisfb_crt2type = sisfb_crt2type; |
| ivideo->sisfb_crt2flags = sisfb_crt2flags; |
| /* pdc(a), scalelcd, special timing, lvdshl handled below */ |
| ivideo->sisfb_dstn = sisfb_dstn; |
| ivideo->sisfb_fstn = sisfb_fstn; |
| ivideo->sisfb_tvplug = sisfb_tvplug; |
| ivideo->sisfb_tvstd = sisfb_tvstd; |
| ivideo->tvxpos = sisfb_tvxposoffset; |
| ivideo->tvypos = sisfb_tvyposoffset; |
| ivideo->sisfb_nocrt2rate = sisfb_nocrt2rate; |
| #if LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,0) |
| ivideo->sisfb_inverse = sisfb_inverse; |
| #endif |
| |
| ivideo->refresh_rate = 0; |
| if(ivideo->sisfb_parm_rate != -1) { |
| ivideo->refresh_rate = ivideo->sisfb_parm_rate; |
| } |
| |
| ivideo->SiS_Pr.UsePanelScaler = sisfb_scalelcd; |
| ivideo->SiS_Pr.CenterScreen = -1; |
| ivideo->SiS_Pr.SiS_CustomT = sisfb_specialtiming; |
| ivideo->SiS_Pr.LVDSHL = sisfb_lvdshl; |
| |
| ivideo->SiS_Pr.SiS_Backup70xx = 0xff; |
| ivideo->SiS_Pr.SiS_CHOverScan = -1; |
| ivideo->SiS_Pr.SiS_ChSW = FALSE; |
| ivideo->SiS_Pr.SiS_UseLCDA = FALSE; |
| ivideo->SiS_Pr.HaveEMI = FALSE; |
| ivideo->SiS_Pr.HaveEMILCD = FALSE; |
| ivideo->SiS_Pr.OverruleEMI = FALSE; |
| ivideo->SiS_Pr.SiS_SensibleSR11 = FALSE; |
| ivideo->SiS_Pr.SiS_MyCR63 = 0x63; |
| ivideo->SiS_Pr.PDC = -1; |
| ivideo->SiS_Pr.PDCA = -1; |
| ivideo->SiS_Pr.DDCPortMixup = FALSE; |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->chip >= SIS_330) { |
| ivideo->SiS_Pr.SiS_MyCR63 = 0x53; |
| if(ivideo->chip >= SIS_661) { |
| ivideo->SiS_Pr.SiS_SensibleSR11 = TRUE; |
| } |
| } |
| #endif |
| |
| memcpy(&ivideo->default_var, &my_default_var, sizeof(my_default_var)); |
| |
| pci_set_drvdata(pdev, ivideo); |
| |
| /* Patch special cases */ |
| if((ivideo->nbridge = sisfb_get_northbridge(ivideo->chip))) { |
| switch(ivideo->nbridge->device) { |
| #ifdef CONFIG_FB_SIS_300 |
| case PCI_DEVICE_ID_SI_730: |
| ivideo->chip = SIS_730; |
| strcpy(ivideo->myid, "SiS 730"); |
| break; |
| #endif |
| #ifdef CONFIG_FB_SIS_315 |
| case PCI_DEVICE_ID_SI_651: |
| /* ivideo->chip is ok */ |
| strcpy(ivideo->myid, "SiS 651"); |
| break; |
| case PCI_DEVICE_ID_SI_740: |
| ivideo->chip = SIS_740; |
| strcpy(ivideo->myid, "SiS 740"); |
| break; |
| case PCI_DEVICE_ID_SI_661: |
| ivideo->chip = SIS_661; |
| strcpy(ivideo->myid, "SiS 661"); |
| break; |
| case PCI_DEVICE_ID_SI_741: |
| ivideo->chip = SIS_741; |
| strcpy(ivideo->myid, "SiS 741"); |
| break; |
| case PCI_DEVICE_ID_SI_760: |
| ivideo->chip = SIS_760; |
| strcpy(ivideo->myid, "SiS 760"); |
| break; |
| case PCI_DEVICE_ID_SI_761: |
| ivideo->chip = SIS_761; |
| strcpy(ivideo->myid, "SiS 761"); |
| break; |
| #endif |
| default: |
| break; |
| } |
| } |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| strcpy(sis_fb_info->modename, ivideo->myid); |
| #endif |
| |
| ivideo->SiS_Pr.ChipType = ivideo->chip; |
| |
| ivideo->SiS_Pr.ivideo = (void *)ivideo; |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if((ivideo->SiS_Pr.ChipType == SIS_315PRO) || |
| (ivideo->SiS_Pr.ChipType == SIS_315)) { |
| ivideo->SiS_Pr.ChipType = SIS_315H; |
| } |
| #endif |
| |
| if(!ivideo->sisvga_enabled) { |
| if(pci_enable_device(pdev)) { |
| if(ivideo->nbridge) SIS_PCI_PUT_DEVICE(ivideo->nbridge); |
| pci_set_drvdata(pdev, NULL); |
| kfree(sis_fb_info); |
| return -EIO; |
| } |
| } |
| |
| ivideo->video_base = pci_resource_start(pdev, 0); |
| ivideo->mmio_base = pci_resource_start(pdev, 1); |
| ivideo->mmio_size = pci_resource_len(pdev, 1); |
| ivideo->SiS_Pr.RelIO = pci_resource_start(pdev, 2) + 0x30; |
| ivideo->SiS_Pr.IOAddress = ivideo->vga_base = ivideo->SiS_Pr.RelIO; |
| |
| SiSRegInit(&ivideo->SiS_Pr, ivideo->SiS_Pr.IOAddress); |
| |
| #ifdef CONFIG_FB_SIS_300 |
| /* Find PCI systems for Chrontel/GPIO communication setup */ |
| if(ivideo->chip == SIS_630) { |
| i = 0; |
| do { |
| if(mychswtable[i].subsysVendor == ivideo->subsysvendor && |
| mychswtable[i].subsysCard == ivideo->subsysdevice) { |
| ivideo->SiS_Pr.SiS_ChSW = TRUE; |
| printk(KERN_DEBUG "sisfb: Identified [%s %s] " |
| "requiring Chrontel/GPIO setup\n", |
| mychswtable[i].vendorName, |
| mychswtable[i].cardName); |
| ivideo->lpcdev = SIS_PCI_GET_DEVICE(PCI_VENDOR_ID_SI, 0x0008, NULL); |
| break; |
| } |
| i++; |
| } while(mychswtable[i].subsysVendor != 0); |
| } |
| #endif |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if((ivideo->chip == SIS_760) && (ivideo->nbridge)) { |
| ivideo->lpcdev = SIS_PCI_GET_SLOT(ivideo->nbridge->bus, (2 << 3)); |
| } |
| #endif |
| |
| outSISIDXREG(SISSR, 0x05, 0x86); |
| |
| if( (!ivideo->sisvga_enabled) |
| #if !defined(__i386__) && !defined(__x86_64__) |
| || (sisfb_resetcard) |
| #endif |
| ) { |
| for(i = 0x30; i <= 0x3f; i++) { |
| outSISIDXREG(SISCR, i, 0x00); |
| } |
| } |
| |
| /* Find out about current video mode */ |
| ivideo->modeprechange = 0x03; |
| inSISIDXREG(SISCR, 0x34, reg); |
| if(reg & 0x7f) { |
| ivideo->modeprechange = reg & 0x7f; |
| } else if(ivideo->sisvga_enabled) { |
| #if defined(__i386__) || defined(__x86_64__) |
| unsigned char SIS_IOTYPE2 *tt = ioremap(0x400, 0x100); |
| if(tt) { |
| ivideo->modeprechange = readb(tt + 0x49); |
| iounmap(tt); |
| } |
| #endif |
| } |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| #ifdef MODULE |
| if((reg & 0x80) && (reg != 0xff)) { |
| if((sisbios_mode[ivideo->sisfb_mode_idx].mode_no[ivideo->mni]) |
| != 0xFF) { |
| printk(KERN_INFO "sisfb: Cannot initialize display mode, " |
| "X server is active\n"); |
| ret = -EBUSY; |
| goto error_4; |
| } |
| } |
| #endif |
| #endif |
| |
| /* Search and copy ROM image */ |
| ivideo->bios_abase = NULL; |
| ivideo->SiS_Pr.VirtualRomBase = NULL; |
| ivideo->SiS_Pr.UseROM = FALSE; |
| ivideo->haveXGIROM = ivideo->SiS_Pr.SiS_XGIROM = FALSE; |
| if(ivideo->sisfb_userom) { |
| ivideo->SiS_Pr.VirtualRomBase = sisfb_find_rom(pdev); |
| ivideo->bios_abase = ivideo->SiS_Pr.VirtualRomBase; |
| ivideo->SiS_Pr.UseROM = (ivideo->SiS_Pr.VirtualRomBase) ? TRUE : FALSE; |
| printk(KERN_INFO "sisfb: Video ROM %sfound\n", |
| ivideo->SiS_Pr.UseROM ? "" : "not "); |
| if((ivideo->SiS_Pr.UseROM) && (ivideo->chip >= XGI_20)) { |
| ivideo->SiS_Pr.UseROM = FALSE; |
| ivideo->haveXGIROM = ivideo->SiS_Pr.SiS_XGIROM = TRUE; |
| if( (ivideo->revision_id == 2) && |
| (!(ivideo->bios_abase[0x1d1] & 0x01)) ) { |
| ivideo->SiS_Pr.DDCPortMixup = TRUE; |
| } |
| } |
| } else { |
| printk(KERN_INFO "sisfb: Video ROM usage disabled\n"); |
| } |
| |
| /* Find systems for special custom timing */ |
| if(ivideo->SiS_Pr.SiS_CustomT == CUT_NONE) { |
| sisfb_detect_custom_timing(ivideo); |
| } |
| |
| /* POST card in case this has not been done by the BIOS */ |
| if( (!ivideo->sisvga_enabled) |
| #if !defined(__i386__) && !defined(__x86_64__) |
| || (sisfb_resetcard) |
| #endif |
| ) { |
| #ifdef CONFIG_FB_SIS_300 |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| if(ivideo->chip == SIS_300) { |
| sisfb_post_sis300(pdev); |
| ivideo->sisfb_can_post = 1; |
| } |
| } |
| #endif |
| |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| int result = 1; |
| /* if((ivideo->chip == SIS_315H) || |
| (ivideo->chip == SIS_315) || |
| (ivideo->chip == SIS_315PRO) || |
| (ivideo->chip == SIS_330)) { |
| sisfb_post_sis315330(pdev); |
| } else */ if(ivideo->chip == XGI_20) { |
| result = sisfb_post_xgi(pdev); |
| ivideo->sisfb_can_post = 1; |
| } else if((ivideo->chip == XGI_40) && ivideo->haveXGIROM) { |
| result = sisfb_post_xgi(pdev); |
| ivideo->sisfb_can_post = 1; |
| } else { |
| printk(KERN_INFO "sisfb: Card is not " |
| "POSTed and sisfb can't do this either.\n"); |
| } |
| if(!result) { |
| printk(KERN_ERR "sisfb: Failed to POST card\n"); |
| ret = -ENODEV; |
| goto error_3; |
| } |
| } |
| #endif |
| } |
| |
| ivideo->sisfb_card_posted = 1; |
| |
| /* Find out about RAM size */ |
| if(sisfb_get_dram_size(ivideo)) { |
| printk(KERN_INFO "sisfb: Fatal error: Unable to determine VRAM size.\n"); |
| ret = -ENODEV; |
| goto error_3; |
| } |
| |
| |
| /* Enable PCI addressing and MMIO */ |
| if((ivideo->sisfb_mode_idx < 0) || |
| ((sisbios_mode[ivideo->sisfb_mode_idx].mode_no[ivideo->mni]) != 0xFF)) { |
| /* Enable PCI_LINEAR_ADDRESSING and MMIO_ENABLE */ |
| orSISIDXREG(SISSR, IND_SIS_PCI_ADDRESS_SET, (SIS_PCI_ADDR_ENABLE | SIS_MEM_MAP_IO_ENABLE)); |
| /* Enable 2D accelerator engine */ |
| orSISIDXREG(SISSR, IND_SIS_MODULE_ENABLE, SIS_ENABLE_2D); |
| } |
| |
| if(sisfb_pdc != 0xff) { |
| if(ivideo->sisvga_engine == SIS_300_VGA) |
| sisfb_pdc &= 0x3c; |
| else |
| sisfb_pdc &= 0x1f; |
| ivideo->SiS_Pr.PDC = sisfb_pdc; |
| } |
| #ifdef CONFIG_FB_SIS_315 |
| if(ivideo->sisvga_engine == SIS_315_VGA) { |
| if(sisfb_pdca != 0xff) |
| ivideo->SiS_Pr.PDCA = sisfb_pdca & 0x1f; |
| } |
| #endif |
| |
| if(!request_mem_region(ivideo->video_base, ivideo->video_size, "sisfb FB")) { |
| printk(KERN_ERR "sisfb: Fatal error: Unable to reserve %dMB framebuffer memory\n", |
| (int)(ivideo->video_size >> 20)); |
| printk(KERN_ERR "sisfb: Is there another framebuffer driver active?\n"); |
| ret = -ENODEV; |
| goto error_3; |
| } |
| |
| if(!request_mem_region(ivideo->mmio_base, ivideo->mmio_size, "sisfb MMIO")) { |
| printk(KERN_ERR "sisfb: Fatal error: Unable to reserve MMIO region\n"); |
| ret = -ENODEV; |
| goto error_2; |
| } |
| |
| ivideo->video_vbase = ioremap(ivideo->video_base, ivideo->video_size); |
| ivideo->SiS_Pr.VideoMemoryAddress = ivideo->video_vbase; |
| if(!ivideo->video_vbase) { |
| printk(KERN_ERR "sisfb: Fatal error: Unable to map framebuffer memory\n"); |
| ret = -ENODEV; |
| goto error_1; |
| } |
| |
| ivideo->mmio_vbase = ioremap(ivideo->mmio_base, ivideo->mmio_size); |
| if(!ivideo->mmio_vbase) { |
| printk(KERN_ERR "sisfb: Fatal error: Unable to map MMIO region\n"); |
| ret = -ENODEV; |
| error_0: iounmap(ivideo->video_vbase); |
| error_1: release_mem_region(ivideo->video_base, ivideo->video_size); |
| error_2: release_mem_region(ivideo->mmio_base, ivideo->mmio_size); |
| error_3: vfree(ivideo->bios_abase); |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| error_4: |
| #endif |
| if(ivideo->lpcdev) |
| SIS_PCI_PUT_DEVICE(ivideo->lpcdev); |
| if(ivideo->nbridge) |
| SIS_PCI_PUT_DEVICE(ivideo->nbridge); |
| pci_set_drvdata(pdev, NULL); |
| if(!ivideo->sisvga_enabled) |
| pci_disable_device(pdev); |
| kfree(sis_fb_info); |
| return ret; |
| } |
| |
| printk(KERN_INFO "sisfb: Video RAM at 0x%lx, mapped to 0x%lx, size %ldk\n", |
| ivideo->video_base, (unsigned long)ivideo->video_vbase, ivideo->video_size / 1024); |
| |
| if(ivideo->video_offset) { |
| printk(KERN_INFO "sisfb: Viewport offset %ldk\n", |
| ivideo->video_offset / 1024); |
| } |
| |
| printk(KERN_INFO "sisfb: MMIO at 0x%lx, mapped to 0x%lx, size %ldk\n", |
| ivideo->mmio_base, (unsigned long)ivideo->mmio_vbase, ivideo->mmio_size / 1024); |
| |
| |
| /* Determine the size of the command queue */ |
| if(ivideo->sisvga_engine == SIS_300_VGA) { |
| ivideo->cmdQueueSize = TURBO_QUEUE_AREA_SIZE; |
| } else { |
| if(ivideo->chip == XGI_20) { |
| ivideo->cmdQueueSize = COMMAND_QUEUE_AREA_SIZE_Z7; |
| } else { |
| ivideo->cmdQueueSize = COMMAND_QUEUE_AREA_SIZE; |
| } |
| } |
| |
| /* Engines are no longer initialized here; this is |
| * now done after the first mode-switch (if the |
| * submitted var has its acceleration flags set). |
| */ |
| |
| /* Calculate the base of the (unused) hw cursor */ |
| ivideo->hwcursor_vbase = ivideo->video_vbase |
| + ivideo->video_size |
| - ivideo->cmdQueueSize |
| - ivideo->hwcursor_size; |
| ivideo->caps |= HW_CURSOR_CAP; |
| |
| /* Initialize offscreen memory manager */ |
| if((ivideo->havenoheap = sisfb_heap_init(ivideo))) { |
| printk(KERN_WARNING "sisfb: Failed to initialize offscreen memory heap\n"); |
| } |
| |
| /* Used for clearing the screen only, therefore respect our mem limit */ |
| ivideo->SiS_Pr.VideoMemoryAddress += ivideo->video_offset; |
| ivideo->SiS_Pr.VideoMemorySize = ivideo->sisfb_mem; |
| |
| ivideo->mtrr = -1; |
| |
| ivideo->vbflags = 0; |
| ivideo->lcddefmodeidx = DEFAULT_LCDMODE; |
| ivideo->tvdefmodeidx = DEFAULT_TVMODE; |
| ivideo->defmodeidx = DEFAULT_MODE; |
| |
| ivideo->newrom = 0; |
| if(ivideo->chip < XGI_20) { |
| if(ivideo->bios_abase) { |
| ivideo->newrom = SiSDetermineROMLayout661(&ivideo->SiS_Pr); |
| } |
| } |
| |
| if((ivideo->sisfb_mode_idx < 0) || |
| ((sisbios_mode[ivideo->sisfb_mode_idx].mode_no[ivideo->mni]) != 0xFF)) { |
| |
| sisfb_sense_crt1(ivideo); |
| |
| sisfb_get_VB_type(ivideo); |
| |
| if(ivideo->vbflags2 & VB2_VIDEOBRIDGE) { |
| sisfb_detect_VB_connect(ivideo); |
| } |
| |
| ivideo->currentvbflags = ivideo->vbflags & (VB_VIDEOBRIDGE | TV_STANDARD); |
| |
| /* Decide on which CRT2 device to use */ |
| if(ivideo->vbflags2 & VB2_VIDEOBRIDGE) { |
| if(ivideo->sisfb_crt2type != -1) { |
| if((ivideo->sisfb_crt2type == CRT2_LCD) && |
| (ivideo->vbflags & CRT2_LCD)) { |
| ivideo->currentvbflags |= CRT2_LCD; |
| } else if(ivideo->sisfb_crt2type != CRT2_LCD) { |
| ivideo->currentvbflags |= ivideo->sisfb_crt2type; |
| } |
| } else { |
| /* Chrontel 700x TV detection often unreliable, therefore |
| * use a different default order on such machines |
| */ |
| if((ivideo->sisvga_engine == SIS_300_VGA) && |
| (ivideo->vbflags2 & VB2_CHRONTEL)) { |
| if(ivideo->vbflags & CRT2_LCD) |
| ivideo->currentvbflags |= CRT2_LCD; |
| else if(ivideo->vbflags & CRT2_TV) |
| ivideo->currentvbflags |= CRT2_TV; |
| else if(ivideo->vbflags & CRT2_VGA) |
| ivideo->currentvbflags |= CRT2_VGA; |
| } else { |
| if(ivideo->vbflags & CRT2_TV) |
| ivideo->currentvbflags |= CRT2_TV; |
| else if(ivideo->vbflags & CRT2_LCD) |
| ivideo->currentvbflags |= CRT2_LCD; |
| else if(ivideo->vbflags & CRT2_VGA) |
| ivideo->currentvbflags |= CRT2_VGA; |
| } |
| } |
| } |
| |
| if(ivideo->vbflags & CRT2_LCD) { |
| sisfb_detect_lcd_type(ivideo); |
| } |
| |
| sisfb_save_pdc_emi(ivideo); |
| |
| if(!ivideo->sisfb_crt1off) { |
| sisfb_handle_ddc(ivideo, &ivideo->sisfb_thismonitor, 0); |
| } else { |
| if((ivideo->vbflags2 & VB2_SISTMDSBRIDGE) && |
| (ivideo->vbflags & (CRT2_VGA | CRT2_LCD))) { |
| sisfb_handle_ddc(ivideo, &ivideo->sisfb_thismonitor, 1); |
| } |
| } |
| |
| if(ivideo->sisfb_mode_idx >= 0) { |
| int bu = ivideo->sisfb_mode_idx; |
| ivideo->sisfb_mode_idx = sisfb_validate_mode(ivideo, |
| ivideo->sisfb_mode_idx, ivideo->currentvbflags); |
| if(bu != ivideo->sisfb_mode_idx) { |
| printk(KERN_ERR "Mode %dx%dx%d failed validation\n", |
| sisbios_mode[bu].xres, |
| sisbios_mode[bu].yres, |
| sisbios_mode[bu].bpp); |
| } |
| } |
| |
| if(ivideo->sisfb_mode_idx < 0) { |
| switch(ivideo->currentvbflags & VB_DISPTYPE_DISP2) { |
| case CRT2_LCD: |
| ivideo->sisfb_mode_idx = ivideo->lcddefmodeidx; |
| break; |
| case CRT2_TV: |
| ivideo->sisfb_mode_idx = ivideo->tvdefmodeidx; |
| break; |
| default: |
| ivideo->sisfb_mode_idx = ivideo->defmodeidx; |
| break; |
| } |
| } |
| |
| ivideo->mode_no = sisbios_mode[ivideo->sisfb_mode_idx].mode_no[ivideo->mni]; |
| |
| if(ivideo->refresh_rate != 0) { |
| sisfb_search_refresh_rate(ivideo, ivideo->refresh_rate, |
| ivideo->sisfb_mode_idx); |
| } |
| |
| if(ivideo->rate_idx == 0) { |
| ivideo->rate_idx = sisbios_mode[ivideo->sisfb_mode_idx].rate_idx; |
| ivideo->refresh_rate = 60; |
| } |
| |
| if(ivideo->sisfb_thismonitor.datavalid) { |
| if(!sisfb_verify_rate(ivideo, &ivideo->sisfb_thismonitor, |
| ivideo->sisfb_mode_idx, |
| ivideo->rate_idx, |
| ivideo->refresh_rate)) { |
| printk(KERN_INFO "sisfb: WARNING: Refresh rate " |
| "exceeds monitor specs!\n"); |
| } |
| } |
| |
| ivideo->video_bpp = sisbios_mode[ivideo->sisfb_mode_idx].bpp; |
| ivideo->video_width = sisbios_mode[ivideo->sisfb_mode_idx].xres; |
| ivideo->video_height = sisbios_mode[ivideo->sisfb_mode_idx].yres; |
| |
| sisfb_set_vparms(ivideo); |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| |
| /* ---------------- For 2.4: Now switch the mode ------------------ */ |
| |
| printk(KERN_INFO "sisfb: Setting mode %dx%dx%d (%dHz)\n", |
| ivideo->video_width, ivideo->video_height, ivideo->video_bpp, |
| ivideo->refresh_rate); |
| |
| /* Determine whether or not acceleration is to be |
| * used. Need to know before pre/post_set_mode() |
| */ |
| ivideo->accel = 0; |
| ivideo->default_var.accel_flags &= ~FB_ACCELF_TEXT; |
| if(ivideo->sisfb_accel) { |
| ivideo->accel = -1; |
| ivideo->default_var.accel_flags |= FB_ACCELF_TEXT; |
| } |
| |
| /* Now switch the mode */ |
| sisfb_pre_setmode(ivideo); |
| |
| if(SiSSetMode(&ivideo->SiS_Pr, ivideo->mode_no) == 0) { |
| printk(KERN_ERR "sisfb: Fatal error: Setting mode[0x%x] failed\n", |
| ivideo->mode_no); |
| ret = -EINVAL; |
| iounmap(ivideo->mmio_vbase); |
| goto error_0; |
| } |
| |
| outSISIDXREG(SISSR, IND_SIS_PASSWORD, SIS_PASSWORD); |
| |
| sisfb_post_setmode(ivideo); |
| |
| /* Maximize regardless of sisfb_max at startup */ |
| ivideo->default_var.yres_virtual = 32767; |
| |
| /* Force reset of x virtual in crtc_to_var */ |
| ivideo->default_var.xres_virtual = 0; |
| |
| /* Copy mode timing to var */ |
| sisfb_crtc_to_var(ivideo, &ivideo->default_var); |
| |
| /* Find out about screen pitch */ |
| sisfb_calc_pitch(ivideo, &ivideo->default_var); |
| sisfb_set_pitch(ivideo); |
| |
| /* Init the accelerator (does nothing currently) */ |
| sisfb_initaccel(ivideo); |
| |
| /* Init some fbinfo entries */ |
| sis_fb_info->node = -1; |
| sis_fb_info->flags = FBINFO_FLAG_DEFAULT; |
| sis_fb_info->fbops = &sisfb_ops; |
| sis_fb_info->disp = &ivideo->sis_disp; |
| sis_fb_info->blank = &sisfb_blank; |
| sis_fb_info->switch_con = &sisfb_switch; |
| sis_fb_info->updatevar = &sisfb_update_var; |
| sis_fb_info->changevar = NULL; |
| strcpy(sis_fb_info->fontname, sisfb_fontname); |
| |
| sisfb_set_disp(-1, &ivideo->default_var, sis_fb_info); |
| |
| #else /* --------- For 2.6: Setup a somewhat sane default var ------------ */ |
| |
| printk(KERN_INFO "sisfb: Default mode is %dx%dx%d (%dHz)\n", |
| ivideo->video_width, ivideo->video_height, ivideo->video_bpp, |
| ivideo->refresh_rate); |
| |
| /* Set up the default var according to chosen default display mode */ |
| ivideo->default_var.xres = ivideo->default_var.xres_virtual = ivideo->video_width; |
| ivideo->default_var.yres = ivideo->default_var.yres_virtual = ivideo->video_height; |
| ivideo->default_var.bits_per_pixel = ivideo->video_bpp; |
| |
| sisfb_bpp_to_var(ivideo, &ivideo->default_var); |
| |
| ivideo->default_var.pixclock = (u32) (1000000000 / |
| sisfb_mode_rate_to_dclock(&ivideo->SiS_Pr, ivideo->mode_no, ivideo->rate_idx)); |
| |
| if(sisfb_mode_rate_to_ddata(&ivideo->SiS_Pr, ivideo->mode_no, |
| ivideo->rate_idx, &ivideo->default_var)) { |
| if((ivideo->default_var.vmode & FB_VMODE_MASK) == FB_VMODE_DOUBLE) { |
| ivideo->default_var.pixclock <<= 1; |
| } |
| } |
| |
| if(ivideo->sisfb_ypan) { |
| /* Maximize regardless of sisfb_max at startup */ |
| ivideo->default_var.yres_virtual = |
| sisfb_calc_maxyres(ivideo, &ivideo->default_var); |
| if(ivideo->default_var.yres_virtual < ivideo->default_var.yres) { |
| ivideo->default_var.yres_virtual = ivideo->default_var.yres; |
| } |
| } |
| |
| sisfb_calc_pitch(ivideo, &ivideo->default_var); |
| |
| ivideo->accel = 0; |
| if(ivideo->sisfb_accel) { |
| ivideo->accel = -1; |
| #ifdef STUPID_ACCELF_TEXT_SHIT |
| ivideo->default_var.accel_flags |= FB_ACCELF_TEXT; |
| #endif |
| } |
| sisfb_initaccel(ivideo); |
| |
| #if defined(FBINFO_HWACCEL_DISABLED) && defined(FBINFO_HWACCEL_XPAN) |
| sis_fb_info->flags = FBINFO_DEFAULT | |
| FBINFO_HWACCEL_YPAN | |
| FBINFO_HWACCEL_XPAN | |
| FBINFO_HWACCEL_COPYAREA | |
| FBINFO_HWACCEL_FILLRECT | |
| ((ivideo->accel) ? 0 : FBINFO_HWACCEL_DISABLED); |
| #else |
| sis_fb_info->flags = FBINFO_FLAG_DEFAULT; |
| #endif |
| sis_fb_info->var = ivideo->default_var; |
| sis_fb_info->fix = ivideo->sisfb_fix; |
| sis_fb_info->screen_base = ivideo->video_vbase + ivideo->video_offset; |
| sis_fb_info->fbops = &sisfb_ops; |
| |
| sisfb_get_fix(&sis_fb_info->fix, -1, sis_fb_info); |
| sis_fb_info->pseudo_palette = ivideo->pseudo_palette; |
| |
| fb_alloc_cmap(&sis_fb_info->cmap, 256 , 0); |
| #endif /* 2.6 */ |
| |
| printk(KERN_DEBUG "sisfb: Initial vbflags 0x%x\n", (int)ivideo->vbflags); |
| |
| #ifdef CONFIG_MTRR |
| ivideo->mtrr = mtrr_add(ivideo->video_base, ivideo->video_size, |
| MTRR_TYPE_WRCOMB, 1); |
| if(ivideo->mtrr < 0) { |
| printk(KERN_DEBUG "sisfb: Failed to add MTRRs\n"); |
| } |
| #endif |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| vc_resize_con(1, 1, 0); |
| #endif |
| |
| if(register_framebuffer(sis_fb_info) < 0) { |
| printk(KERN_ERR "sisfb: Fatal error: Failed to register framebuffer\n"); |
| ret = -EINVAL; |
| iounmap(ivideo->mmio_vbase); |
| goto error_0; |
| } |
| |
| ivideo->registered = 1; |
| |
| /* Enlist us */ |
| ivideo->next = card_list; |
| card_list = ivideo; |
| |
| #ifdef SIS_OLD_CONFIG_COMPAT |
| { |
| int ret; |
| /* Our ioctls are all "32/64bit compatible" */ |
| ret = register_ioctl32_conversion(FBIO_ALLOC, NULL); |
| ret |= register_ioctl32_conversion(FBIO_FREE, NULL); |
| ret |= register_ioctl32_conversion(FBIOGET_VBLANK, NULL); |
| ret |= register_ioctl32_conversion(SISFB_GET_INFO_SIZE, NULL); |
| ret |= register_ioctl32_conversion(SISFB_GET_INFO, NULL); |
| ret |= register_ioctl32_conversion(SISFB_GET_TVPOSOFFSET, NULL); |
| ret |= register_ioctl32_conversion(SISFB_SET_TVPOSOFFSET, NULL); |
| ret |= register_ioctl32_conversion(SISFB_SET_LOCK, NULL); |
| ret |= register_ioctl32_conversion(SISFB_GET_VBRSTATUS, NULL); |
| ret |= register_ioctl32_conversion(SISFB_GET_AUTOMAXIMIZE, NULL); |
| ret |= register_ioctl32_conversion(SISFB_SET_AUTOMAXIMIZE, NULL); |
| ret |= register_ioctl32_conversion(SISFB_COMMAND, NULL); |
| if(ret) |
| printk(KERN_ERR |
| "sisfb: Error registering ioctl32 translations\n"); |
| else |
| ivideo->ioctl32registered = 1; |
| } |
| #endif |
| |
| printk(KERN_INFO "sisfb: 2D acceleration is %s, y-panning %s\n", |
| ivideo->sisfb_accel ? "enabled" : "disabled", |
| ivideo->sisfb_ypan ? |
| (ivideo->sisfb_max ? "enabled (auto-max)" : |
| "enabled (no auto-max)") : |
| "disabled"); |
| |
| |
| printk(KERN_INFO "fb%d: %s frame buffer device version %d.%d.%d\n", |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| GET_FB_IDX(sis_fb_info->node), |
| #else |
| sis_fb_info->node, |
| #endif |
| ivideo->myid, VER_MAJOR, VER_MINOR, VER_LEVEL); |
| |
| printk(KERN_INFO "sisfb: Copyright (C) 2001-2005 Thomas Winischhofer\n"); |
| |
| } /* if mode = "none" */ |
| |
| return 0; |
| } |
| |
| /*****************************************************/ |
| /* PCI DEVICE HANDLING */ |
| /*****************************************************/ |
| |
| static void __devexit sisfb_remove(struct pci_dev *pdev) |
| { |
| struct sis_video_info *ivideo = pci_get_drvdata(pdev); |
| struct fb_info *sis_fb_info = ivideo->memyselfandi; |
| int registered = ivideo->registered; |
| int modechanged = ivideo->modechanged; |
| |
| #ifdef SIS_OLD_CONFIG_COMPAT |
| if(ivideo->ioctl32registered) { |
| int ret; |
| ret = unregister_ioctl32_conversion(FBIO_ALLOC); |
| ret |= unregister_ioctl32_conversion(FBIO_FREE); |
| ret |= unregister_ioctl32_conversion(FBIOGET_VBLANK); |
| ret |= unregister_ioctl32_conversion(SISFB_GET_INFO_SIZE); |
| ret |= unregister_ioctl32_conversion(SISFB_GET_INFO); |
| ret |= unregister_ioctl32_conversion(SISFB_GET_TVPOSOFFSET); |
| ret |= unregister_ioctl32_conversion(SISFB_SET_TVPOSOFFSET); |
| ret |= unregister_ioctl32_conversion(SISFB_SET_LOCK); |
| ret |= unregister_ioctl32_conversion(SISFB_GET_VBRSTATUS); |
| ret |= unregister_ioctl32_conversion(SISFB_GET_AUTOMAXIMIZE); |
| ret |= unregister_ioctl32_conversion(SISFB_SET_AUTOMAXIMIZE); |
| ret |= unregister_ioctl32_conversion(SISFB_COMMAND); |
| if(ret) |
| printk(KERN_ERR |
| "sisfb: Error unregistering ioctl32 translations\n"); |
| } |
| #endif |
| |
| /* Unmap */ |
| iounmap(ivideo->mmio_vbase); |
| iounmap(ivideo->video_vbase); |
| |
| /* Release mem regions */ |
| release_mem_region(ivideo->video_base, ivideo->video_size); |
| release_mem_region(ivideo->mmio_base, ivideo->mmio_size); |
| |
| vfree(ivideo->bios_abase); |
| |
| if(ivideo->lpcdev) |
| SIS_PCI_PUT_DEVICE(ivideo->lpcdev); |
| |
| if(ivideo->nbridge) |
| SIS_PCI_PUT_DEVICE(ivideo->nbridge); |
| |
| #ifdef CONFIG_MTRR |
| /* Release MTRR region */ |
| if(ivideo->mtrr >= 0) |
| mtrr_del(ivideo->mtrr, ivideo->video_base, ivideo->video_size); |
| #endif |
| |
| pci_set_drvdata(pdev, NULL); |
| |
| /* If device was disabled when starting, disable |
| * it when quitting. |
| */ |
| if(!ivideo->sisvga_enabled) |
| pci_disable_device(pdev); |
| |
| /* Unregister the framebuffer */ |
| if(ivideo->registered) { |
| unregister_framebuffer(sis_fb_info); |
| #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,3)) |
| framebuffer_release(sis_fb_info); |
| #else |
| kfree(sis_fb_info); |
| #endif |
| } |
| |
| /* OK, our ivideo is gone for good from here. */ |
| |
| /* TODO: Restore the initial mode |
| * This sounds easy but is as good as impossible |
| * on many machines with SiS chip and video bridge |
| * since text modes are always set up differently |
| * from machine to machine. Depends on the type |
| * of integration between chipset and bridge. |
| */ |
| if(registered && modechanged) |
| printk(KERN_INFO |
| "sisfb: Restoring of text mode not supported yet\n"); |
| }; |
| |
| static struct pci_driver sisfb_driver = { |
| .name = "sisfb", |
| .id_table = sisfb_pci_table, |
| .probe = sisfb_probe, |
| .remove = __devexit_p(sisfb_remove) |
| }; |
| |
| SISINITSTATIC int __init sisfb_init(void) |
| { |
| #if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,8) |
| #ifndef MODULE |
| char *options = NULL; |
| |
| if(fb_get_options("sisfb", &options)) |
| return -ENODEV; |
| |
| sisfb_setup(options); |
| #endif |
| #endif |
| return pci_register_driver(&sisfb_driver); |
| } |
| |
| #if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,8) |
| #ifndef MODULE |
| module_init(sisfb_init); |
| #endif |
| #endif |
| |
| /*****************************************************/ |
| /* MODULE */ |
| /*****************************************************/ |
| |
| #ifdef MODULE |
| |
| static char *mode = NULL; |
| static int vesa = -1; |
| static unsigned int rate = 0; |
| static unsigned int crt1off = 1; |
| static unsigned int mem = 0; |
| static char *forcecrt2type = NULL; |
| static int forcecrt1 = -1; |
| static int pdc = -1; |
| static int pdc1 = -1; |
| static int noaccel = -1; |
| static int noypan = -1; |
| static int nomax = -1; |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| static int inverse = 0; |
| #endif |
| static int userom = -1; |
| static int useoem = -1; |
| static char *tvstandard = NULL; |
| static int nocrt2rate = 0; |
| static int scalelcd = -1; |
| static char *specialtiming = NULL; |
| static int lvdshl = -1; |
| static int tvxposoffset = 0, tvyposoffset = 0; |
| #if !defined(__i386__) && !defined(__x86_64__) |
| static int resetcard = 0; |
| static int videoram = 0; |
| #endif |
| |
| static int __init sisfb_init_module(void) |
| { |
| sisfb_setdefaultparms(); |
| |
| if(rate) |
| sisfb_parm_rate = rate; |
| |
| if((scalelcd == 0) || (scalelcd == 1)) |
| sisfb_scalelcd = scalelcd ^ 1; |
| |
| /* Need to check crt2 type first for fstn/dstn */ |
| |
| if(forcecrt2type) |
| sisfb_search_crt2type(forcecrt2type); |
| |
| if(tvstandard) |
| sisfb_search_tvstd(tvstandard); |
| |
| if(mode) |
| sisfb_search_mode(mode, FALSE); |
| else if(vesa != -1) |
| sisfb_search_vesamode(vesa, FALSE); |
| |
| sisfb_crt1off = (crt1off == 0) ? 1 : 0; |
| |
| sisfb_forcecrt1 = forcecrt1; |
| if(forcecrt1 == 1) |
| sisfb_crt1off = 0; |
| else if(forcecrt1 == 0) |
| sisfb_crt1off = 1; |
| |
| if(noaccel == 1) |
| sisfb_accel = 0; |
| else if(noaccel == 0) |
| sisfb_accel = 1; |
| |
| if(noypan == 1) |
| sisfb_ypan = 0; |
| else if(noypan == 0) |
| sisfb_ypan = 1; |
| |
| if(nomax == 1) |
| sisfb_max = 0; |
| else if(nomax == 0) |
| sisfb_max = 1; |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| if(inverse) sisfb_inverse = 1; |
| #endif |
| |
| if(mem) |
| sisfb_parm_mem = mem; |
| |
| if(userom != -1) |
| sisfb_userom = userom; |
| |
| if(useoem != -1) |
| sisfb_useoem = useoem; |
| |
| if(pdc != -1) |
| sisfb_pdc = (pdc & 0x7f); |
| |
| if(pdc1 != -1) |
| sisfb_pdca = (pdc1 & 0x1f); |
| |
| sisfb_nocrt2rate = nocrt2rate; |
| |
| if(specialtiming) |
| sisfb_search_specialtiming(specialtiming); |
| |
| if((lvdshl >= 0) && (lvdshl <= 3)) |
| sisfb_lvdshl = lvdshl; |
| |
| sisfb_tvxposoffset = tvxposoffset; |
| sisfb_tvyposoffset = tvyposoffset; |
| |
| #if !defined(__i386__) && !defined(__x86_64__) |
| sisfb_resetcard = (resetcard) ? 1 : 0; |
| if(videoram) |
| sisfb_videoram = videoram; |
| #endif |
| |
| return sisfb_init(); |
| } |
| |
| static void __exit sisfb_remove_module(void) |
| { |
| pci_unregister_driver(&sisfb_driver); |
| printk(KERN_DEBUG "sisfb: Module unloaded\n"); |
| } |
| |
| module_init(sisfb_init_module); |
| module_exit(sisfb_remove_module); |
| |
| MODULE_DESCRIPTION("SiS 300/540/630/730/315/55x/65x/661/74x/330/76x/34x, XGI V3XT/V5/V8/Z7 framebuffer device driver"); |
| MODULE_LICENSE("GPL"); |
| MODULE_AUTHOR("Thomas Winischhofer <thomas@winischhofer.net>, Others"); |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| MODULE_PARM(mem, "i"); |
| MODULE_PARM(noaccel, "i"); |
| MODULE_PARM(noypan, "i"); |
| MODULE_PARM(nomax, "i"); |
| MODULE_PARM(userom, "i"); |
| MODULE_PARM(useoem, "i"); |
| MODULE_PARM(mode, "s"); |
| MODULE_PARM(vesa, "i"); |
| MODULE_PARM(rate, "i"); |
| MODULE_PARM(forcecrt1, "i"); |
| MODULE_PARM(forcecrt2type, "s"); |
| MODULE_PARM(scalelcd, "i"); |
| MODULE_PARM(pdc, "i"); |
| MODULE_PARM(pdc1, "i"); |
| MODULE_PARM(specialtiming, "s"); |
| MODULE_PARM(lvdshl, "i"); |
| MODULE_PARM(tvstandard, "s"); |
| MODULE_PARM(tvxposoffset, "i"); |
| MODULE_PARM(tvyposoffset, "i"); |
| MODULE_PARM(nocrt2rate, "i"); |
| MODULE_PARM(inverse, "i"); |
| #if !defined(__i386__) && !defined(__x86_64__) |
| MODULE_PARM(resetcard, "i"); |
| MODULE_PARM(videoram, "i"); |
| #endif |
| #endif |
| |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| module_param(mem, int, 0); |
| module_param(noaccel, int, 0); |
| module_param(noypan, int, 0); |
| module_param(nomax, int, 0); |
| module_param(userom, int, 0); |
| module_param(useoem, int, 0); |
| module_param(mode, charp, 0); |
| module_param(vesa, int, 0); |
| module_param(rate, int, 0); |
| module_param(forcecrt1, int, 0); |
| module_param(forcecrt2type, charp, 0); |
| module_param(scalelcd, int, 0); |
| module_param(pdc, int, 0); |
| module_param(pdc1, int, 0); |
| module_param(specialtiming, charp, 0); |
| module_param(lvdshl, int, 0); |
| module_param(tvstandard, charp, 0); |
| module_param(tvxposoffset, int, 0); |
| module_param(tvyposoffset, int, 0); |
| module_param(nocrt2rate, int, 0); |
| #if !defined(__i386__) && !defined(__x86_64__) |
| module_param(resetcard, int, 0); |
| module_param(videoram, int, 0); |
| #endif |
| #endif |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| MODULE_PARM_DESC(mem, |
| "\nDetermines the beginning of the video memory heap in KB. This heap is used\n" |
| "for video RAM management for eg. DRM/DRI. On 300 series, the default depends\n" |
| "on the amount of video RAM available. If 8MB of video RAM or less is available,\n" |
| "the heap starts at 4096KB, if between 8 and 16MB are available at 8192KB,\n" |
| "otherwise at 12288KB. On 315/330/340 series, the heap size is 32KB by default.\n" |
| "The value is to be specified without 'KB' and must match the MaxXFBMem setting\n" |
| "for XFree86 4.x/X.org 6.7 and later.\n"); |
| #else |
| MODULE_PARM_DESC(mem, |
| "\nDetermines the beginning of the video memory heap in KB. This heap is used\n" |
| "for video RAM management for eg. DRM/DRI. On 300 series, the default depends\n" |
| "on the amount of video RAM available. If 8MB of video RAM or less is available,\n" |
| "the heap starts at 4096KB, if between 8 and 16MB are available at 8192KB,\n" |
| "otherwise at 12288KB. On 315/330/340 series, the heap size is 32KB by default.\n" |
| "The value is to be specified without 'KB'.\n"); |
| #endif |
| |
| MODULE_PARM_DESC(noaccel, |
| "\nIf set to anything other than 0, 2D acceleration will be disabled.\n" |
| "(default: 0)\n"); |
| |
| MODULE_PARM_DESC(noypan, |
| "\nIf set to anything other than 0, y-panning will be disabled and scrolling\n" |
| "will be performed by redrawing the screen. (default: 0)\n"); |
| |
| MODULE_PARM_DESC(nomax, |
| "\nIf y-panning is enabled, sisfb will by default use the entire available video\n" |
| "memory for the virtual screen in order to optimize scrolling performance. If\n" |
| "this is set to anything other than 0, sisfb will not do this and thereby \n" |
| "enable the user to positively specify a virtual Y size of the screen using\n" |
| "fbset. (default: 0)\n"); |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| MODULE_PARM_DESC(mode, |
| "\nSelects the desired display mode in the format [X]x[Y]x[Depth], eg.\n" |
| "1024x768x16. Other formats supported include XxY-Depth and\n" |
| "XxY-Depth@Rate. If the parameter is only one (decimal or hexadecimal)\n" |
| "number, it will be interpreted as a VESA mode number. (default: none if\n" |
| "sisfb is a module; this leaves the console untouched and the driver will\n" |
| "only do the video memory management for eg. DRM/DRI; 800x600x8 if sisfb\n" |
| "is in the kernel)\n"); |
| MODULE_PARM_DESC(vesa, |
| "\nSelects the desired display mode by VESA defined mode number, eg. 0x117\n" |
| "(default: 0x0000 if sisfb is a module; this leaves the console untouched\n" |
| "and the driver will only do the video memory management for eg. DRM/DRI;\n" |
| "0x0103 if sisfb is in the kernel)\n"); |
| #endif |
| |
| #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0) |
| MODULE_PARM_DESC(mode, |
| "\nSelects the desired default display mode in the format XxYxDepth,\n" |
| "eg. 1024x768x16. Other formats supported include XxY-Depth and\n" |
| "XxY-Depth@Rate. If the parameter is only one (decimal or hexadecimal)\n" |
| "number, it will be interpreted as a VESA mode number. (default: 800x600x8)\n"); |
| |
| MODULE_PARM_DESC(vesa, |
| "\nSelects the desired default display mode by VESA defined mode number, eg.\n" |
| "0x117 (default: 0x0103)\n"); |
| #endif |
| |
| MODULE_PARM_DESC(rate, |
| "\nSelects the desired vertical refresh rate for CRT1 (external VGA) in Hz.\n" |
| "If the mode is specified in the format XxY-Depth@Rate, this parameter\n" |
| "will be ignored (default: 60)\n"); |
| |
| MODULE_PARM_DESC(forcecrt1, |
| "\nNormally, the driver autodetects whether or not CRT1 (external VGA) is \n" |
| "connected. With this option, the detection can be overridden (1=CRT1 ON,\n" |
| "0=CRT1 OFF) (default: [autodetected])\n"); |
| |
| MODULE_PARM_DESC(forcecrt2type, |
| "\nIf this option is omitted, the driver autodetects CRT2 output devices, such as\n" |
| "LCD, TV or secondary VGA. With this option, this autodetection can be\n" |
| "overridden. Possible parameters are LCD, TV, VGA or NONE. NONE disables CRT2.\n" |
| "On systems with a SiS video bridge, parameters SVIDEO, COMPOSITE or SCART can\n" |
| "be used instead of TV to override the TV detection. Furthermore, on systems\n" |
| "with a SiS video bridge, SVIDEO+COMPOSITE, HIVISION, YPBPR480I, YPBPR480P,\n" |
| "YPBPR720P and YPBPR1080I are understood. However, whether or not these work\n" |
| "depends on the very hardware in use. (default: [autodetected])\n"); |
| |
| MODULE_PARM_DESC(scalelcd, |
| "\nSetting this to 1 will force the driver to scale the LCD image to the panel's\n" |
| "native resolution. Setting it to 0 will disable scaling; LVDS panels will\n" |
| "show black bars around the image, TMDS panels will probably do the scaling\n" |
| "themselves. Default: 1 on LVDS panels, 0 on TMDS panels\n"); |
| |
| MODULE_PARM_DESC(pdc, |
| "\nThis is for manually selecting the LCD panel delay compensation. The driver\n" |
| "should detect this correctly in most cases; however, sometimes this is not\n" |
| "possible. If you see 'small waves' on the LCD, try setting this to 4, 32 or 24\n" |
| "on a 300 series chipset; 6 on other chipsets. If the problem persists, try\n" |
| "other values (on 300 series: between 4 and 60 in steps of 4; otherwise: any\n" |
| "value from 0 to 31). (default: autodetected, if LCD is active during start)\n"); |
| |
| #ifdef CONFIG_FB_SIS_315 |
| MODULE_PARM_DESC(pdc1, |
| "\nThis is same as pdc, but for LCD-via CRT1. Hence, this is for the 315/330/340\n" |
| "series only. (default: autodetected if LCD is in LCD-via-CRT1 mode during\n" |
| "startup) - Note: currently, this has no effect because LCD-via-CRT1 is not\n" |
| "implemented yet.\n"); |
| #endif |
| |
| MODULE_PARM_DESC(specialtiming, |
| "\nPlease refer to documentation for more information on this option.\n"); |
| |
| MODULE_PARM_DESC(lvdshl, |
| "\nPlease refer to documentation for more information on this option.\n"); |
| |
| MODULE_PARM_DESC(tvstandard, |
| "\nThis allows overriding the BIOS default for the TV standard. Valid choices are\n" |
| "pal, ntsc, palm and paln. (default: [auto; pal or ntsc only])\n"); |
| |
| MODULE_PARM_DESC(tvxposoffset, |
| "\nRelocate TV output horizontally. Possible parameters: -32 through 32.\n" |
| "Default: 0\n"); |
| |
| MODULE_PARM_DESC(tvyposoffset, |
| "\nRelocate TV output vertically. Possible parameters: -32 through 32.\n" |
| "Default: 0\n"); |
| |
| MODULE_PARM_DESC(nocrt2rate, |
| "\nSetting this to 1 will force the driver to use the default refresh rate for\n" |
| "CRT2 if CRT2 type is VGA. (default: 0, use same rate as CRT1)\n"); |
| |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) |
| MODULE_PARM_DESC(inverse, |
| "\nSetting this to anything but 0 should invert the display colors, but this\n" |
| "does not seem to work. (default: 0)\n"); |
| #endif |
| |
| #if !defined(__i386__) && !defined(__x86_64__) |
| #ifdef CONFIG_FB_SIS_300 |
| MODULE_PARM_DESC(resetcard, |
| "\nSet this to 1 in order to reset (POST) the card on non-x86 machines where\n" |
| "the BIOS did not POST the card (only supported for SiS 300/305 and XGI cards\n" |
| "currently). Default: 0\n"); |
| |
| MODULE_PARM_DESC(videoram, |
| "\nSet this to the amount of video RAM (in kilobyte) the card has. Required on\n" |
| "some non-x86 architectures where the memory auto detection fails. Only\n" |
| "relevant if resetcard is set, too. SiS300/305 only. Default: [auto-detect]\n"); |
| #endif |
| #endif |
| |
| #endif /* /MODULE */ |
| |
| /* _GPL only for new symbols. */ |
| EXPORT_SYMBOL(sis_malloc); |
| EXPORT_SYMBOL(sis_free); |
| EXPORT_SYMBOL_GPL(sis_malloc_new); |
| EXPORT_SYMBOL_GPL(sis_free_new); |
| |
| |
| |