1*f7018c21STomi Valkeinen /* 2*f7018c21STomi Valkeinen * 3*f7018c21STomi Valkeinen * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200 and G400 4*f7018c21STomi Valkeinen * 5*f7018c21STomi Valkeinen * (c) 1998-2002 Petr Vandrovec <vandrove@vc.cvut.cz> 6*f7018c21STomi Valkeinen * 7*f7018c21STomi Valkeinen * Portions Copyright (c) 2001 Matrox Graphics Inc. 8*f7018c21STomi Valkeinen * 9*f7018c21STomi Valkeinen * Version: 1.65 2002/08/14 10*f7018c21STomi Valkeinen * 11*f7018c21STomi Valkeinen * MTRR stuff: 1998 Tom Rini <trini@kernel.crashing.org> 12*f7018c21STomi Valkeinen * 13*f7018c21STomi Valkeinen * Contributors: "menion?" <menion@mindless.com> 14*f7018c21STomi Valkeinen * Betatesting, fixes, ideas 15*f7018c21STomi Valkeinen * 16*f7018c21STomi Valkeinen * "Kurt Garloff" <garloff@suse.de> 17*f7018c21STomi Valkeinen * Betatesting, fixes, ideas, videomodes, videomodes timmings 18*f7018c21STomi Valkeinen * 19*f7018c21STomi Valkeinen * "Tom Rini" <trini@kernel.crashing.org> 20*f7018c21STomi Valkeinen * MTRR stuff, PPC cleanups, betatesting, fixes, ideas 21*f7018c21STomi Valkeinen * 22*f7018c21STomi Valkeinen * "Bibek Sahu" <scorpio@dodds.net> 23*f7018c21STomi Valkeinen * Access device through readb|w|l and write b|w|l 24*f7018c21STomi Valkeinen * Extensive debugging stuff 25*f7018c21STomi Valkeinen * 26*f7018c21STomi Valkeinen * "Daniel Haun" <haund@usa.net> 27*f7018c21STomi Valkeinen * Testing, hardware cursor fixes 28*f7018c21STomi Valkeinen * 29*f7018c21STomi Valkeinen * "Scott Wood" <sawst46+@pitt.edu> 30*f7018c21STomi Valkeinen * Fixes 31*f7018c21STomi Valkeinen * 32*f7018c21STomi Valkeinen * "Gerd Knorr" <kraxel@goldbach.isdn.cs.tu-berlin.de> 33*f7018c21STomi Valkeinen * Betatesting 34*f7018c21STomi Valkeinen * 35*f7018c21STomi Valkeinen * "Kelly French" <targon@hazmat.com> 36*f7018c21STomi Valkeinen * "Fernando Herrera" <fherrera@eurielec.etsit.upm.es> 37*f7018c21STomi Valkeinen * Betatesting, bug reporting 38*f7018c21STomi Valkeinen * 39*f7018c21STomi Valkeinen * "Pablo Bianucci" <pbian@pccp.com.ar> 40*f7018c21STomi Valkeinen * Fixes, ideas, betatesting 41*f7018c21STomi Valkeinen * 42*f7018c21STomi Valkeinen * "Inaky Perez Gonzalez" <inaky@peloncho.fis.ucm.es> 43*f7018c21STomi Valkeinen * Fixes, enhandcements, ideas, betatesting 44*f7018c21STomi Valkeinen * 45*f7018c21STomi Valkeinen * "Ryuichi Oikawa" <roikawa@rr.iiij4u.or.jp> 46*f7018c21STomi Valkeinen * PPC betatesting, PPC support, backward compatibility 47*f7018c21STomi Valkeinen * 48*f7018c21STomi Valkeinen * "Paul Womar" <Paul@pwomar.demon.co.uk> 49*f7018c21STomi Valkeinen * "Owen Waller" <O.Waller@ee.qub.ac.uk> 50*f7018c21STomi Valkeinen * PPC betatesting 51*f7018c21STomi Valkeinen * 52*f7018c21STomi Valkeinen * "Thomas Pornin" <pornin@bolet.ens.fr> 53*f7018c21STomi Valkeinen * Alpha betatesting 54*f7018c21STomi Valkeinen * 55*f7018c21STomi Valkeinen * "Pieter van Leuven" <pvl@iae.nl> 56*f7018c21STomi Valkeinen * "Ulf Jaenicke-Roessler" <ujr@physik.phy.tu-dresden.de> 57*f7018c21STomi Valkeinen * G100 testing 58*f7018c21STomi Valkeinen * 59*f7018c21STomi Valkeinen * "H. Peter Arvin" <hpa@transmeta.com> 60*f7018c21STomi Valkeinen * Ideas 61*f7018c21STomi Valkeinen * 62*f7018c21STomi Valkeinen * "Cort Dougan" <cort@cs.nmt.edu> 63*f7018c21STomi Valkeinen * CHRP fixes and PReP cleanup 64*f7018c21STomi Valkeinen * 65*f7018c21STomi Valkeinen * "Mark Vojkovich" <mvojkovi@ucsd.edu> 66*f7018c21STomi Valkeinen * G400 support 67*f7018c21STomi Valkeinen * 68*f7018c21STomi Valkeinen * "David C. Hansen" <haveblue@us.ibm.com> 69*f7018c21STomi Valkeinen * Fixes 70*f7018c21STomi Valkeinen * 71*f7018c21STomi Valkeinen * "Ian Romanick" <idr@us.ibm.com> 72*f7018c21STomi Valkeinen * Find PInS data in BIOS on PowerPC systems. 73*f7018c21STomi Valkeinen * 74*f7018c21STomi Valkeinen * (following author is not in any relation with this code, but his code 75*f7018c21STomi Valkeinen * is included in this driver) 76*f7018c21STomi Valkeinen * 77*f7018c21STomi Valkeinen * Based on framebuffer driver for VBE 2.0 compliant graphic boards 78*f7018c21STomi Valkeinen * (c) 1998 Gerd Knorr <kraxel@cs.tu-berlin.de> 79*f7018c21STomi Valkeinen * 80*f7018c21STomi Valkeinen * (following author is not in any relation with this code, but his ideas 81*f7018c21STomi Valkeinen * were used when writing this driver) 82*f7018c21STomi Valkeinen * 83*f7018c21STomi Valkeinen * FreeVBE/AF (Matrox), "Shawn Hargreaves" <shawn@talula.demon.co.uk> 84*f7018c21STomi Valkeinen * 85*f7018c21STomi Valkeinen */ 86*f7018c21STomi Valkeinen 87*f7018c21STomi Valkeinen 88*f7018c21STomi Valkeinen #include "matroxfb_misc.h" 89*f7018c21STomi Valkeinen #include <linux/interrupt.h> 90*f7018c21STomi Valkeinen #include <linux/matroxfb.h> 91*f7018c21STomi Valkeinen 92*f7018c21STomi Valkeinen void matroxfb_DAC_out(const struct matrox_fb_info *minfo, int reg, int val) 93*f7018c21STomi Valkeinen { 94*f7018c21STomi Valkeinen DBG_REG(__func__) 95*f7018c21STomi Valkeinen mga_outb(M_RAMDAC_BASE+M_X_INDEX, reg); 96*f7018c21STomi Valkeinen mga_outb(M_RAMDAC_BASE+M_X_DATAREG, val); 97*f7018c21STomi Valkeinen } 98*f7018c21STomi Valkeinen 99*f7018c21STomi Valkeinen int matroxfb_DAC_in(const struct matrox_fb_info *minfo, int reg) 100*f7018c21STomi Valkeinen { 101*f7018c21STomi Valkeinen DBG_REG(__func__) 102*f7018c21STomi Valkeinen mga_outb(M_RAMDAC_BASE+M_X_INDEX, reg); 103*f7018c21STomi Valkeinen return mga_inb(M_RAMDAC_BASE+M_X_DATAREG); 104*f7018c21STomi Valkeinen } 105*f7018c21STomi Valkeinen 106*f7018c21STomi Valkeinen void matroxfb_var2my(struct fb_var_screeninfo* var, struct my_timming* mt) { 107*f7018c21STomi Valkeinen unsigned int pixclock = var->pixclock; 108*f7018c21STomi Valkeinen 109*f7018c21STomi Valkeinen DBG(__func__) 110*f7018c21STomi Valkeinen 111*f7018c21STomi Valkeinen if (!pixclock) pixclock = 10000; /* 10ns = 100MHz */ 112*f7018c21STomi Valkeinen mt->pixclock = 1000000000 / pixclock; 113*f7018c21STomi Valkeinen if (mt->pixclock < 1) mt->pixclock = 1; 114*f7018c21STomi Valkeinen mt->mnp = -1; 115*f7018c21STomi Valkeinen mt->dblscan = var->vmode & FB_VMODE_DOUBLE; 116*f7018c21STomi Valkeinen mt->interlaced = var->vmode & FB_VMODE_INTERLACED; 117*f7018c21STomi Valkeinen mt->HDisplay = var->xres; 118*f7018c21STomi Valkeinen mt->HSyncStart = mt->HDisplay + var->right_margin; 119*f7018c21STomi Valkeinen mt->HSyncEnd = mt->HSyncStart + var->hsync_len; 120*f7018c21STomi Valkeinen mt->HTotal = mt->HSyncEnd + var->left_margin; 121*f7018c21STomi Valkeinen mt->VDisplay = var->yres; 122*f7018c21STomi Valkeinen mt->VSyncStart = mt->VDisplay + var->lower_margin; 123*f7018c21STomi Valkeinen mt->VSyncEnd = mt->VSyncStart + var->vsync_len; 124*f7018c21STomi Valkeinen mt->VTotal = mt->VSyncEnd + var->upper_margin; 125*f7018c21STomi Valkeinen mt->sync = var->sync; 126*f7018c21STomi Valkeinen } 127*f7018c21STomi Valkeinen 128*f7018c21STomi Valkeinen int matroxfb_PLL_calcclock(const struct matrox_pll_features* pll, unsigned int freq, unsigned int fmax, 129*f7018c21STomi Valkeinen unsigned int* in, unsigned int* feed, unsigned int* post) { 130*f7018c21STomi Valkeinen unsigned int bestdiff = ~0; 131*f7018c21STomi Valkeinen unsigned int bestvco = 0; 132*f7018c21STomi Valkeinen unsigned int fxtal = pll->ref_freq; 133*f7018c21STomi Valkeinen unsigned int fwant; 134*f7018c21STomi Valkeinen unsigned int p; 135*f7018c21STomi Valkeinen 136*f7018c21STomi Valkeinen DBG(__func__) 137*f7018c21STomi Valkeinen 138*f7018c21STomi Valkeinen fwant = freq; 139*f7018c21STomi Valkeinen 140*f7018c21STomi Valkeinen #ifdef DEBUG 141*f7018c21STomi Valkeinen printk(KERN_ERR "post_shift_max: %d\n", pll->post_shift_max); 142*f7018c21STomi Valkeinen printk(KERN_ERR "ref_freq: %d\n", pll->ref_freq); 143*f7018c21STomi Valkeinen printk(KERN_ERR "freq: %d\n", freq); 144*f7018c21STomi Valkeinen printk(KERN_ERR "vco_freq_min: %d\n", pll->vco_freq_min); 145*f7018c21STomi Valkeinen printk(KERN_ERR "in_div_min: %d\n", pll->in_div_min); 146*f7018c21STomi Valkeinen printk(KERN_ERR "in_div_max: %d\n", pll->in_div_max); 147*f7018c21STomi Valkeinen printk(KERN_ERR "feed_div_min: %d\n", pll->feed_div_min); 148*f7018c21STomi Valkeinen printk(KERN_ERR "feed_div_max: %d\n", pll->feed_div_max); 149*f7018c21STomi Valkeinen printk(KERN_ERR "fmax: %d\n", fmax); 150*f7018c21STomi Valkeinen #endif 151*f7018c21STomi Valkeinen for (p = 1; p <= pll->post_shift_max; p++) { 152*f7018c21STomi Valkeinen if (fwant * 2 > fmax) 153*f7018c21STomi Valkeinen break; 154*f7018c21STomi Valkeinen fwant *= 2; 155*f7018c21STomi Valkeinen } 156*f7018c21STomi Valkeinen if (fwant < pll->vco_freq_min) fwant = pll->vco_freq_min; 157*f7018c21STomi Valkeinen if (fwant > fmax) fwant = fmax; 158*f7018c21STomi Valkeinen for (; p-- > 0; fwant >>= 1, bestdiff >>= 1) { 159*f7018c21STomi Valkeinen unsigned int m; 160*f7018c21STomi Valkeinen 161*f7018c21STomi Valkeinen if (fwant < pll->vco_freq_min) break; 162*f7018c21STomi Valkeinen for (m = pll->in_div_min; m <= pll->in_div_max; m++) { 163*f7018c21STomi Valkeinen unsigned int diff, fvco; 164*f7018c21STomi Valkeinen unsigned int n; 165*f7018c21STomi Valkeinen 166*f7018c21STomi Valkeinen n = (fwant * (m + 1) + (fxtal >> 1)) / fxtal - 1; 167*f7018c21STomi Valkeinen if (n > pll->feed_div_max) 168*f7018c21STomi Valkeinen break; 169*f7018c21STomi Valkeinen if (n < pll->feed_div_min) 170*f7018c21STomi Valkeinen n = pll->feed_div_min; 171*f7018c21STomi Valkeinen fvco = (fxtal * (n + 1)) / (m + 1); 172*f7018c21STomi Valkeinen if (fvco < fwant) 173*f7018c21STomi Valkeinen diff = fwant - fvco; 174*f7018c21STomi Valkeinen else 175*f7018c21STomi Valkeinen diff = fvco - fwant; 176*f7018c21STomi Valkeinen if (diff < bestdiff) { 177*f7018c21STomi Valkeinen bestdiff = diff; 178*f7018c21STomi Valkeinen *post = p; 179*f7018c21STomi Valkeinen *in = m; 180*f7018c21STomi Valkeinen *feed = n; 181*f7018c21STomi Valkeinen bestvco = fvco; 182*f7018c21STomi Valkeinen } 183*f7018c21STomi Valkeinen } 184*f7018c21STomi Valkeinen } 185*f7018c21STomi Valkeinen dprintk(KERN_ERR "clk: %02X %02X %02X %d %d %d\n", *in, *feed, *post, fxtal, bestvco, fwant); 186*f7018c21STomi Valkeinen return bestvco; 187*f7018c21STomi Valkeinen } 188*f7018c21STomi Valkeinen 189*f7018c21STomi Valkeinen int matroxfb_vgaHWinit(struct matrox_fb_info *minfo, struct my_timming *m) 190*f7018c21STomi Valkeinen { 191*f7018c21STomi Valkeinen unsigned int hd, hs, he, hbe, ht; 192*f7018c21STomi Valkeinen unsigned int vd, vs, ve, vt, lc; 193*f7018c21STomi Valkeinen unsigned int wd; 194*f7018c21STomi Valkeinen unsigned int divider; 195*f7018c21STomi Valkeinen int i; 196*f7018c21STomi Valkeinen struct matrox_hw_state * const hw = &minfo->hw; 197*f7018c21STomi Valkeinen 198*f7018c21STomi Valkeinen DBG(__func__) 199*f7018c21STomi Valkeinen 200*f7018c21STomi Valkeinen hw->SEQ[0] = 0x00; 201*f7018c21STomi Valkeinen hw->SEQ[1] = 0x01; /* or 0x09 */ 202*f7018c21STomi Valkeinen hw->SEQ[2] = 0x0F; /* bitplanes */ 203*f7018c21STomi Valkeinen hw->SEQ[3] = 0x00; 204*f7018c21STomi Valkeinen hw->SEQ[4] = 0x0E; 205*f7018c21STomi Valkeinen /* CRTC 0..7, 9, 16..19, 21, 22 are reprogrammed by Matrox Millennium code... Hope that by MGA1064 too */ 206*f7018c21STomi Valkeinen if (m->dblscan) { 207*f7018c21STomi Valkeinen m->VTotal <<= 1; 208*f7018c21STomi Valkeinen m->VDisplay <<= 1; 209*f7018c21STomi Valkeinen m->VSyncStart <<= 1; 210*f7018c21STomi Valkeinen m->VSyncEnd <<= 1; 211*f7018c21STomi Valkeinen } 212*f7018c21STomi Valkeinen if (m->interlaced) { 213*f7018c21STomi Valkeinen m->VTotal >>= 1; 214*f7018c21STomi Valkeinen m->VDisplay >>= 1; 215*f7018c21STomi Valkeinen m->VSyncStart >>= 1; 216*f7018c21STomi Valkeinen m->VSyncEnd >>= 1; 217*f7018c21STomi Valkeinen } 218*f7018c21STomi Valkeinen 219*f7018c21STomi Valkeinen /* GCTL is ignored when not using 0xA0000 aperture */ 220*f7018c21STomi Valkeinen hw->GCTL[0] = 0x00; 221*f7018c21STomi Valkeinen hw->GCTL[1] = 0x00; 222*f7018c21STomi Valkeinen hw->GCTL[2] = 0x00; 223*f7018c21STomi Valkeinen hw->GCTL[3] = 0x00; 224*f7018c21STomi Valkeinen hw->GCTL[4] = 0x00; 225*f7018c21STomi Valkeinen hw->GCTL[5] = 0x40; 226*f7018c21STomi Valkeinen hw->GCTL[6] = 0x05; 227*f7018c21STomi Valkeinen hw->GCTL[7] = 0x0F; 228*f7018c21STomi Valkeinen hw->GCTL[8] = 0xFF; 229*f7018c21STomi Valkeinen 230*f7018c21STomi Valkeinen /* Whole ATTR is ignored in PowerGraphics mode */ 231*f7018c21STomi Valkeinen for (i = 0; i < 16; i++) 232*f7018c21STomi Valkeinen hw->ATTR[i] = i; 233*f7018c21STomi Valkeinen hw->ATTR[16] = 0x41; 234*f7018c21STomi Valkeinen hw->ATTR[17] = 0xFF; 235*f7018c21STomi Valkeinen hw->ATTR[18] = 0x0F; 236*f7018c21STomi Valkeinen hw->ATTR[19] = 0x00; 237*f7018c21STomi Valkeinen hw->ATTR[20] = 0x00; 238*f7018c21STomi Valkeinen 239*f7018c21STomi Valkeinen hd = m->HDisplay >> 3; 240*f7018c21STomi Valkeinen hs = m->HSyncStart >> 3; 241*f7018c21STomi Valkeinen he = m->HSyncEnd >> 3; 242*f7018c21STomi Valkeinen ht = m->HTotal >> 3; 243*f7018c21STomi Valkeinen /* standard timmings are in 8pixels, but for interleaved we cannot */ 244*f7018c21STomi Valkeinen /* do it for 4bpp (because of (4bpp >> 1(interleaved))/4 == 0) */ 245*f7018c21STomi Valkeinen /* using 16 or more pixels per unit can save us */ 246*f7018c21STomi Valkeinen divider = minfo->curr.final_bppShift; 247*f7018c21STomi Valkeinen while (divider & 3) { 248*f7018c21STomi Valkeinen hd >>= 1; 249*f7018c21STomi Valkeinen hs >>= 1; 250*f7018c21STomi Valkeinen he >>= 1; 251*f7018c21STomi Valkeinen ht >>= 1; 252*f7018c21STomi Valkeinen divider <<= 1; 253*f7018c21STomi Valkeinen } 254*f7018c21STomi Valkeinen divider = divider / 4; 255*f7018c21STomi Valkeinen /* divider can be from 1 to 8 */ 256*f7018c21STomi Valkeinen while (divider > 8) { 257*f7018c21STomi Valkeinen hd <<= 1; 258*f7018c21STomi Valkeinen hs <<= 1; 259*f7018c21STomi Valkeinen he <<= 1; 260*f7018c21STomi Valkeinen ht <<= 1; 261*f7018c21STomi Valkeinen divider >>= 1; 262*f7018c21STomi Valkeinen } 263*f7018c21STomi Valkeinen hd = hd - 1; 264*f7018c21STomi Valkeinen hs = hs - 1; 265*f7018c21STomi Valkeinen he = he - 1; 266*f7018c21STomi Valkeinen ht = ht - 1; 267*f7018c21STomi Valkeinen vd = m->VDisplay - 1; 268*f7018c21STomi Valkeinen vs = m->VSyncStart - 1; 269*f7018c21STomi Valkeinen ve = m->VSyncEnd - 1; 270*f7018c21STomi Valkeinen vt = m->VTotal - 2; 271*f7018c21STomi Valkeinen lc = vd; 272*f7018c21STomi Valkeinen /* G200 cannot work with (ht & 7) == 6 */ 273*f7018c21STomi Valkeinen if (((ht & 0x07) == 0x06) || ((ht & 0x0F) == 0x04)) 274*f7018c21STomi Valkeinen ht++; 275*f7018c21STomi Valkeinen hbe = ht; 276*f7018c21STomi Valkeinen wd = minfo->fbcon.var.xres_virtual * minfo->curr.final_bppShift / 64; 277*f7018c21STomi Valkeinen 278*f7018c21STomi Valkeinen hw->CRTCEXT[0] = 0; 279*f7018c21STomi Valkeinen hw->CRTCEXT[5] = 0; 280*f7018c21STomi Valkeinen if (m->interlaced) { 281*f7018c21STomi Valkeinen hw->CRTCEXT[0] = 0x80; 282*f7018c21STomi Valkeinen hw->CRTCEXT[5] = (hs + he - ht) >> 1; 283*f7018c21STomi Valkeinen if (!m->dblscan) 284*f7018c21STomi Valkeinen wd <<= 1; 285*f7018c21STomi Valkeinen vt &= ~1; 286*f7018c21STomi Valkeinen } 287*f7018c21STomi Valkeinen hw->CRTCEXT[0] |= (wd & 0x300) >> 4; 288*f7018c21STomi Valkeinen hw->CRTCEXT[1] = (((ht - 4) & 0x100) >> 8) | 289*f7018c21STomi Valkeinen ((hd & 0x100) >> 7) | /* blanking */ 290*f7018c21STomi Valkeinen ((hs & 0x100) >> 6) | /* sync start */ 291*f7018c21STomi Valkeinen (hbe & 0x040); /* end hor. blanking */ 292*f7018c21STomi Valkeinen /* FIXME: Enable vidrst only on G400, and only if TV-out is used */ 293*f7018c21STomi Valkeinen if (minfo->outputs[1].src == MATROXFB_SRC_CRTC1) 294*f7018c21STomi Valkeinen hw->CRTCEXT[1] |= 0x88; /* enable horizontal and vertical vidrst */ 295*f7018c21STomi Valkeinen hw->CRTCEXT[2] = ((vt & 0xC00) >> 10) | 296*f7018c21STomi Valkeinen ((vd & 0x400) >> 8) | /* disp end */ 297*f7018c21STomi Valkeinen ((vd & 0xC00) >> 7) | /* vblanking start */ 298*f7018c21STomi Valkeinen ((vs & 0xC00) >> 5) | 299*f7018c21STomi Valkeinen ((lc & 0x400) >> 3); 300*f7018c21STomi Valkeinen hw->CRTCEXT[3] = (divider - 1) | 0x80; 301*f7018c21STomi Valkeinen hw->CRTCEXT[4] = 0; 302*f7018c21STomi Valkeinen 303*f7018c21STomi Valkeinen hw->CRTC[0] = ht-4; 304*f7018c21STomi Valkeinen hw->CRTC[1] = hd; 305*f7018c21STomi Valkeinen hw->CRTC[2] = hd; 306*f7018c21STomi Valkeinen hw->CRTC[3] = (hbe & 0x1F) | 0x80; 307*f7018c21STomi Valkeinen hw->CRTC[4] = hs; 308*f7018c21STomi Valkeinen hw->CRTC[5] = ((hbe & 0x20) << 2) | (he & 0x1F); 309*f7018c21STomi Valkeinen hw->CRTC[6] = vt & 0xFF; 310*f7018c21STomi Valkeinen hw->CRTC[7] = ((vt & 0x100) >> 8) | 311*f7018c21STomi Valkeinen ((vd & 0x100) >> 7) | 312*f7018c21STomi Valkeinen ((vs & 0x100) >> 6) | 313*f7018c21STomi Valkeinen ((vd & 0x100) >> 5) | 314*f7018c21STomi Valkeinen ((lc & 0x100) >> 4) | 315*f7018c21STomi Valkeinen ((vt & 0x200) >> 4) | 316*f7018c21STomi Valkeinen ((vd & 0x200) >> 3) | 317*f7018c21STomi Valkeinen ((vs & 0x200) >> 2); 318*f7018c21STomi Valkeinen hw->CRTC[8] = 0x00; 319*f7018c21STomi Valkeinen hw->CRTC[9] = ((vd & 0x200) >> 4) | 320*f7018c21STomi Valkeinen ((lc & 0x200) >> 3); 321*f7018c21STomi Valkeinen if (m->dblscan && !m->interlaced) 322*f7018c21STomi Valkeinen hw->CRTC[9] |= 0x80; 323*f7018c21STomi Valkeinen for (i = 10; i < 16; i++) 324*f7018c21STomi Valkeinen hw->CRTC[i] = 0x00; 325*f7018c21STomi Valkeinen hw->CRTC[16] = vs /* & 0xFF */; 326*f7018c21STomi Valkeinen hw->CRTC[17] = (ve & 0x0F) | 0x20; 327*f7018c21STomi Valkeinen hw->CRTC[18] = vd /* & 0xFF */; 328*f7018c21STomi Valkeinen hw->CRTC[19] = wd /* & 0xFF */; 329*f7018c21STomi Valkeinen hw->CRTC[20] = 0x00; 330*f7018c21STomi Valkeinen hw->CRTC[21] = vd /* & 0xFF */; 331*f7018c21STomi Valkeinen hw->CRTC[22] = (vt + 1) /* & 0xFF */; 332*f7018c21STomi Valkeinen hw->CRTC[23] = 0xC3; 333*f7018c21STomi Valkeinen hw->CRTC[24] = lc; 334*f7018c21STomi Valkeinen return 0; 335*f7018c21STomi Valkeinen }; 336*f7018c21STomi Valkeinen 337*f7018c21STomi Valkeinen void matroxfb_vgaHWrestore(struct matrox_fb_info *minfo) 338*f7018c21STomi Valkeinen { 339*f7018c21STomi Valkeinen int i; 340*f7018c21STomi Valkeinen struct matrox_hw_state * const hw = &minfo->hw; 341*f7018c21STomi Valkeinen CRITFLAGS 342*f7018c21STomi Valkeinen 343*f7018c21STomi Valkeinen DBG(__func__) 344*f7018c21STomi Valkeinen 345*f7018c21STomi Valkeinen dprintk(KERN_INFO "MiscOutReg: %02X\n", hw->MiscOutReg); 346*f7018c21STomi Valkeinen dprintk(KERN_INFO "SEQ regs: "); 347*f7018c21STomi Valkeinen for (i = 0; i < 5; i++) 348*f7018c21STomi Valkeinen dprintk("%02X:", hw->SEQ[i]); 349*f7018c21STomi Valkeinen dprintk("\n"); 350*f7018c21STomi Valkeinen dprintk(KERN_INFO "GDC regs: "); 351*f7018c21STomi Valkeinen for (i = 0; i < 9; i++) 352*f7018c21STomi Valkeinen dprintk("%02X:", hw->GCTL[i]); 353*f7018c21STomi Valkeinen dprintk("\n"); 354*f7018c21STomi Valkeinen dprintk(KERN_INFO "CRTC regs: "); 355*f7018c21STomi Valkeinen for (i = 0; i < 25; i++) 356*f7018c21STomi Valkeinen dprintk("%02X:", hw->CRTC[i]); 357*f7018c21STomi Valkeinen dprintk("\n"); 358*f7018c21STomi Valkeinen dprintk(KERN_INFO "ATTR regs: "); 359*f7018c21STomi Valkeinen for (i = 0; i < 21; i++) 360*f7018c21STomi Valkeinen dprintk("%02X:", hw->ATTR[i]); 361*f7018c21STomi Valkeinen dprintk("\n"); 362*f7018c21STomi Valkeinen 363*f7018c21STomi Valkeinen CRITBEGIN 364*f7018c21STomi Valkeinen 365*f7018c21STomi Valkeinen mga_inb(M_ATTR_RESET); 366*f7018c21STomi Valkeinen mga_outb(M_ATTR_INDEX, 0); 367*f7018c21STomi Valkeinen mga_outb(M_MISC_REG, hw->MiscOutReg); 368*f7018c21STomi Valkeinen for (i = 1; i < 5; i++) 369*f7018c21STomi Valkeinen mga_setr(M_SEQ_INDEX, i, hw->SEQ[i]); 370*f7018c21STomi Valkeinen mga_setr(M_CRTC_INDEX, 17, hw->CRTC[17] & 0x7F); 371*f7018c21STomi Valkeinen for (i = 0; i < 25; i++) 372*f7018c21STomi Valkeinen mga_setr(M_CRTC_INDEX, i, hw->CRTC[i]); 373*f7018c21STomi Valkeinen for (i = 0; i < 9; i++) 374*f7018c21STomi Valkeinen mga_setr(M_GRAPHICS_INDEX, i, hw->GCTL[i]); 375*f7018c21STomi Valkeinen for (i = 0; i < 21; i++) { 376*f7018c21STomi Valkeinen mga_inb(M_ATTR_RESET); 377*f7018c21STomi Valkeinen mga_outb(M_ATTR_INDEX, i); 378*f7018c21STomi Valkeinen mga_outb(M_ATTR_INDEX, hw->ATTR[i]); 379*f7018c21STomi Valkeinen } 380*f7018c21STomi Valkeinen mga_outb(M_PALETTE_MASK, 0xFF); 381*f7018c21STomi Valkeinen mga_outb(M_DAC_REG, 0x00); 382*f7018c21STomi Valkeinen for (i = 0; i < 768; i++) 383*f7018c21STomi Valkeinen mga_outb(M_DAC_VAL, hw->DACpal[i]); 384*f7018c21STomi Valkeinen mga_inb(M_ATTR_RESET); 385*f7018c21STomi Valkeinen mga_outb(M_ATTR_INDEX, 0x20); 386*f7018c21STomi Valkeinen 387*f7018c21STomi Valkeinen CRITEND 388*f7018c21STomi Valkeinen } 389*f7018c21STomi Valkeinen 390*f7018c21STomi Valkeinen static void get_pins(unsigned char __iomem* pins, struct matrox_bios* bd) { 391*f7018c21STomi Valkeinen unsigned int b0 = readb(pins); 392*f7018c21STomi Valkeinen 393*f7018c21STomi Valkeinen if (b0 == 0x2E && readb(pins+1) == 0x41) { 394*f7018c21STomi Valkeinen unsigned int pins_len = readb(pins+2); 395*f7018c21STomi Valkeinen unsigned int i; 396*f7018c21STomi Valkeinen unsigned char cksum; 397*f7018c21STomi Valkeinen unsigned char* dst = bd->pins; 398*f7018c21STomi Valkeinen 399*f7018c21STomi Valkeinen if (pins_len < 3 || pins_len > 128) { 400*f7018c21STomi Valkeinen return; 401*f7018c21STomi Valkeinen } 402*f7018c21STomi Valkeinen *dst++ = 0x2E; 403*f7018c21STomi Valkeinen *dst++ = 0x41; 404*f7018c21STomi Valkeinen *dst++ = pins_len; 405*f7018c21STomi Valkeinen cksum = 0x2E + 0x41 + pins_len; 406*f7018c21STomi Valkeinen for (i = 3; i < pins_len; i++) { 407*f7018c21STomi Valkeinen cksum += *dst++ = readb(pins+i); 408*f7018c21STomi Valkeinen } 409*f7018c21STomi Valkeinen if (cksum) { 410*f7018c21STomi Valkeinen return; 411*f7018c21STomi Valkeinen } 412*f7018c21STomi Valkeinen bd->pins_len = pins_len; 413*f7018c21STomi Valkeinen } else if (b0 == 0x40 && readb(pins+1) == 0x00) { 414*f7018c21STomi Valkeinen unsigned int i; 415*f7018c21STomi Valkeinen unsigned char* dst = bd->pins; 416*f7018c21STomi Valkeinen 417*f7018c21STomi Valkeinen *dst++ = 0x40; 418*f7018c21STomi Valkeinen *dst++ = 0; 419*f7018c21STomi Valkeinen for (i = 2; i < 0x40; i++) { 420*f7018c21STomi Valkeinen *dst++ = readb(pins+i); 421*f7018c21STomi Valkeinen } 422*f7018c21STomi Valkeinen bd->pins_len = 0x40; 423*f7018c21STomi Valkeinen } 424*f7018c21STomi Valkeinen } 425*f7018c21STomi Valkeinen 426*f7018c21STomi Valkeinen static void get_bios_version(unsigned char __iomem * vbios, struct matrox_bios* bd) { 427*f7018c21STomi Valkeinen unsigned int pcir_offset; 428*f7018c21STomi Valkeinen 429*f7018c21STomi Valkeinen pcir_offset = readb(vbios + 24) | (readb(vbios + 25) << 8); 430*f7018c21STomi Valkeinen if (pcir_offset >= 26 && pcir_offset < 0xFFE0 && 431*f7018c21STomi Valkeinen readb(vbios + pcir_offset ) == 'P' && 432*f7018c21STomi Valkeinen readb(vbios + pcir_offset + 1) == 'C' && 433*f7018c21STomi Valkeinen readb(vbios + pcir_offset + 2) == 'I' && 434*f7018c21STomi Valkeinen readb(vbios + pcir_offset + 3) == 'R') { 435*f7018c21STomi Valkeinen unsigned char h; 436*f7018c21STomi Valkeinen 437*f7018c21STomi Valkeinen h = readb(vbios + pcir_offset + 0x12); 438*f7018c21STomi Valkeinen bd->version.vMaj = (h >> 4) & 0xF; 439*f7018c21STomi Valkeinen bd->version.vMin = h & 0xF; 440*f7018c21STomi Valkeinen bd->version.vRev = readb(vbios + pcir_offset + 0x13); 441*f7018c21STomi Valkeinen } else { 442*f7018c21STomi Valkeinen unsigned char h; 443*f7018c21STomi Valkeinen 444*f7018c21STomi Valkeinen h = readb(vbios + 5); 445*f7018c21STomi Valkeinen bd->version.vMaj = (h >> 4) & 0xF; 446*f7018c21STomi Valkeinen bd->version.vMin = h & 0xF; 447*f7018c21STomi Valkeinen bd->version.vRev = 0; 448*f7018c21STomi Valkeinen } 449*f7018c21STomi Valkeinen } 450*f7018c21STomi Valkeinen 451*f7018c21STomi Valkeinen static void get_bios_output(unsigned char __iomem* vbios, struct matrox_bios* bd) { 452*f7018c21STomi Valkeinen unsigned char b; 453*f7018c21STomi Valkeinen 454*f7018c21STomi Valkeinen b = readb(vbios + 0x7FF1); 455*f7018c21STomi Valkeinen if (b == 0xFF) { 456*f7018c21STomi Valkeinen b = 0; 457*f7018c21STomi Valkeinen } 458*f7018c21STomi Valkeinen bd->output.state = b; 459*f7018c21STomi Valkeinen } 460*f7018c21STomi Valkeinen 461*f7018c21STomi Valkeinen static void get_bios_tvout(unsigned char __iomem* vbios, struct matrox_bios* bd) { 462*f7018c21STomi Valkeinen unsigned int i; 463*f7018c21STomi Valkeinen 464*f7018c21STomi Valkeinen /* Check for 'IBM .*(V....TVO' string - it means TVO BIOS */ 465*f7018c21STomi Valkeinen bd->output.tvout = 0; 466*f7018c21STomi Valkeinen if (readb(vbios + 0x1D) != 'I' || 467*f7018c21STomi Valkeinen readb(vbios + 0x1E) != 'B' || 468*f7018c21STomi Valkeinen readb(vbios + 0x1F) != 'M' || 469*f7018c21STomi Valkeinen readb(vbios + 0x20) != ' ') { 470*f7018c21STomi Valkeinen return; 471*f7018c21STomi Valkeinen } 472*f7018c21STomi Valkeinen for (i = 0x2D; i < 0x2D + 128; i++) { 473*f7018c21STomi Valkeinen unsigned char b = readb(vbios + i); 474*f7018c21STomi Valkeinen 475*f7018c21STomi Valkeinen if (b == '(' && readb(vbios + i + 1) == 'V') { 476*f7018c21STomi Valkeinen if (readb(vbios + i + 6) == 'T' && 477*f7018c21STomi Valkeinen readb(vbios + i + 7) == 'V' && 478*f7018c21STomi Valkeinen readb(vbios + i + 8) == 'O') { 479*f7018c21STomi Valkeinen bd->output.tvout = 1; 480*f7018c21STomi Valkeinen } 481*f7018c21STomi Valkeinen return; 482*f7018c21STomi Valkeinen } 483*f7018c21STomi Valkeinen if (b == 0) 484*f7018c21STomi Valkeinen break; 485*f7018c21STomi Valkeinen } 486*f7018c21STomi Valkeinen } 487*f7018c21STomi Valkeinen 488*f7018c21STomi Valkeinen static void parse_bios(unsigned char __iomem* vbios, struct matrox_bios* bd) { 489*f7018c21STomi Valkeinen unsigned int pins_offset; 490*f7018c21STomi Valkeinen 491*f7018c21STomi Valkeinen if (readb(vbios) != 0x55 || readb(vbios + 1) != 0xAA) { 492*f7018c21STomi Valkeinen return; 493*f7018c21STomi Valkeinen } 494*f7018c21STomi Valkeinen bd->bios_valid = 1; 495*f7018c21STomi Valkeinen get_bios_version(vbios, bd); 496*f7018c21STomi Valkeinen get_bios_output(vbios, bd); 497*f7018c21STomi Valkeinen get_bios_tvout(vbios, bd); 498*f7018c21STomi Valkeinen #if defined(__powerpc__) 499*f7018c21STomi Valkeinen /* On PowerPC cards, the PInS offset isn't stored at the end of the 500*f7018c21STomi Valkeinen * BIOS image. Instead, you must search the entire BIOS image for 501*f7018c21STomi Valkeinen * the magic PInS signature. 502*f7018c21STomi Valkeinen * 503*f7018c21STomi Valkeinen * This actually applies to all OpenFirmware base cards. Since these 504*f7018c21STomi Valkeinen * cards could be put in a MIPS or SPARC system, should the condition 505*f7018c21STomi Valkeinen * be something different? 506*f7018c21STomi Valkeinen */ 507*f7018c21STomi Valkeinen for ( pins_offset = 0 ; pins_offset <= 0xFF80 ; pins_offset++ ) { 508*f7018c21STomi Valkeinen unsigned char header[3]; 509*f7018c21STomi Valkeinen 510*f7018c21STomi Valkeinen header[0] = readb(vbios + pins_offset); 511*f7018c21STomi Valkeinen header[1] = readb(vbios + pins_offset + 1); 512*f7018c21STomi Valkeinen header[2] = readb(vbios + pins_offset + 2); 513*f7018c21STomi Valkeinen if ( (header[0] == 0x2E) && (header[1] == 0x41) 514*f7018c21STomi Valkeinen && ((header[2] == 0x40) || (header[2] == 0x80)) ) { 515*f7018c21STomi Valkeinen printk(KERN_INFO "PInS data found at offset %u\n", 516*f7018c21STomi Valkeinen pins_offset); 517*f7018c21STomi Valkeinen get_pins(vbios + pins_offset, bd); 518*f7018c21STomi Valkeinen break; 519*f7018c21STomi Valkeinen } 520*f7018c21STomi Valkeinen } 521*f7018c21STomi Valkeinen #else 522*f7018c21STomi Valkeinen pins_offset = readb(vbios + 0x7FFC) | (readb(vbios + 0x7FFD) << 8); 523*f7018c21STomi Valkeinen if (pins_offset <= 0xFF80) { 524*f7018c21STomi Valkeinen get_pins(vbios + pins_offset, bd); 525*f7018c21STomi Valkeinen } 526*f7018c21STomi Valkeinen #endif 527*f7018c21STomi Valkeinen } 528*f7018c21STomi Valkeinen 529*f7018c21STomi Valkeinen static int parse_pins1(struct matrox_fb_info *minfo, 530*f7018c21STomi Valkeinen const struct matrox_bios *bd) 531*f7018c21STomi Valkeinen { 532*f7018c21STomi Valkeinen unsigned int maxdac; 533*f7018c21STomi Valkeinen 534*f7018c21STomi Valkeinen switch (bd->pins[22]) { 535*f7018c21STomi Valkeinen case 0: maxdac = 175000; break; 536*f7018c21STomi Valkeinen case 1: maxdac = 220000; break; 537*f7018c21STomi Valkeinen default: maxdac = 240000; break; 538*f7018c21STomi Valkeinen } 539*f7018c21STomi Valkeinen if (get_unaligned_le16(bd->pins + 24)) { 540*f7018c21STomi Valkeinen maxdac = get_unaligned_le16(bd->pins + 24) * 10; 541*f7018c21STomi Valkeinen } 542*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = maxdac; 543*f7018c21STomi Valkeinen minfo->values.pll.system = get_unaligned_le16(bd->pins + 28) ? 544*f7018c21STomi Valkeinen get_unaligned_le16(bd->pins + 28) * 10 : 50000; 545*f7018c21STomi Valkeinen /* ignore 4MB, 8MB, module clocks */ 546*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = 14318; 547*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = 0x00030101; 548*f7018c21STomi Valkeinen return 0; 549*f7018c21STomi Valkeinen } 550*f7018c21STomi Valkeinen 551*f7018c21STomi Valkeinen static void default_pins1(struct matrox_fb_info *minfo) 552*f7018c21STomi Valkeinen { 553*f7018c21STomi Valkeinen /* Millennium */ 554*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = 220000; 555*f7018c21STomi Valkeinen minfo->values.pll.system = 50000; 556*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = 14318; 557*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = 0x00030101; 558*f7018c21STomi Valkeinen } 559*f7018c21STomi Valkeinen 560*f7018c21STomi Valkeinen static int parse_pins2(struct matrox_fb_info *minfo, 561*f7018c21STomi Valkeinen const struct matrox_bios *bd) 562*f7018c21STomi Valkeinen { 563*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = 564*f7018c21STomi Valkeinen minfo->limits.system.vcomax = (bd->pins[41] == 0xFF) ? 230000 : ((bd->pins[41] + 100) * 1000); 565*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = ((bd->pins[51] & 0x01) ? 0x00000001 : 0) | 566*f7018c21STomi Valkeinen ((bd->pins[51] & 0x02) ? 0x00000100 : 0) | 567*f7018c21STomi Valkeinen ((bd->pins[51] & 0x04) ? 0x00010000 : 0) | 568*f7018c21STomi Valkeinen ((bd->pins[51] & 0x08) ? 0x00020000 : 0); 569*f7018c21STomi Valkeinen minfo->values.pll.system = (bd->pins[43] == 0xFF) ? 50000 : ((bd->pins[43] + 100) * 1000); 570*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = 14318; 571*f7018c21STomi Valkeinen return 0; 572*f7018c21STomi Valkeinen } 573*f7018c21STomi Valkeinen 574*f7018c21STomi Valkeinen static void default_pins2(struct matrox_fb_info *minfo) 575*f7018c21STomi Valkeinen { 576*f7018c21STomi Valkeinen /* Millennium II, Mystique */ 577*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = 578*f7018c21STomi Valkeinen minfo->limits.system.vcomax = 230000; 579*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = 0x00030101; 580*f7018c21STomi Valkeinen minfo->values.pll.system = 50000; 581*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = 14318; 582*f7018c21STomi Valkeinen } 583*f7018c21STomi Valkeinen 584*f7018c21STomi Valkeinen static int parse_pins3(struct matrox_fb_info *minfo, 585*f7018c21STomi Valkeinen const struct matrox_bios *bd) 586*f7018c21STomi Valkeinen { 587*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = 588*f7018c21STomi Valkeinen minfo->limits.system.vcomax = (bd->pins[36] == 0xFF) ? 230000 : ((bd->pins[36] + 100) * 1000); 589*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = get_unaligned_le32(bd->pins + 48) == 0xFFFFFFFF ? 590*f7018c21STomi Valkeinen 0x01250A21 : get_unaligned_le32(bd->pins + 48); 591*f7018c21STomi Valkeinen /* memory config */ 592*f7018c21STomi Valkeinen minfo->values.reg.memrdbk = ((bd->pins[57] << 21) & 0x1E000000) | 593*f7018c21STomi Valkeinen ((bd->pins[57] << 22) & 0x00C00000) | 594*f7018c21STomi Valkeinen ((bd->pins[56] << 1) & 0x000001E0) | 595*f7018c21STomi Valkeinen ( bd->pins[56] & 0x0000000F); 596*f7018c21STomi Valkeinen minfo->values.reg.opt = (bd->pins[54] & 7) << 10; 597*f7018c21STomi Valkeinen minfo->values.reg.opt2 = bd->pins[58] << 12; 598*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = (bd->pins[52] & 0x20) ? 14318 : 27000; 599*f7018c21STomi Valkeinen return 0; 600*f7018c21STomi Valkeinen } 601*f7018c21STomi Valkeinen 602*f7018c21STomi Valkeinen static void default_pins3(struct matrox_fb_info *minfo) 603*f7018c21STomi Valkeinen { 604*f7018c21STomi Valkeinen /* G100, G200 */ 605*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = 606*f7018c21STomi Valkeinen minfo->limits.system.vcomax = 230000; 607*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = 0x01250A21; 608*f7018c21STomi Valkeinen minfo->values.reg.memrdbk = 0x00000000; 609*f7018c21STomi Valkeinen minfo->values.reg.opt = 0x00000C00; 610*f7018c21STomi Valkeinen minfo->values.reg.opt2 = 0x00000000; 611*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = 27000; 612*f7018c21STomi Valkeinen } 613*f7018c21STomi Valkeinen 614*f7018c21STomi Valkeinen static int parse_pins4(struct matrox_fb_info *minfo, 615*f7018c21STomi Valkeinen const struct matrox_bios *bd) 616*f7018c21STomi Valkeinen { 617*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = (bd->pins[ 39] == 0xFF) ? 230000 : bd->pins[ 39] * 4000; 618*f7018c21STomi Valkeinen minfo->limits.system.vcomax = (bd->pins[ 38] == 0xFF) ? minfo->limits.pixel.vcomax : bd->pins[ 38] * 4000; 619*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = get_unaligned_le32(bd->pins + 71); 620*f7018c21STomi Valkeinen minfo->values.reg.memrdbk = ((bd->pins[87] << 21) & 0x1E000000) | 621*f7018c21STomi Valkeinen ((bd->pins[87] << 22) & 0x00C00000) | 622*f7018c21STomi Valkeinen ((bd->pins[86] << 1) & 0x000001E0) | 623*f7018c21STomi Valkeinen ( bd->pins[86] & 0x0000000F); 624*f7018c21STomi Valkeinen minfo->values.reg.opt = ((bd->pins[53] << 15) & 0x00400000) | 625*f7018c21STomi Valkeinen ((bd->pins[53] << 22) & 0x10000000) | 626*f7018c21STomi Valkeinen ((bd->pins[53] << 7) & 0x00001C00); 627*f7018c21STomi Valkeinen minfo->values.reg.opt3 = get_unaligned_le32(bd->pins + 67); 628*f7018c21STomi Valkeinen minfo->values.pll.system = (bd->pins[ 65] == 0xFF) ? 200000 : bd->pins[ 65] * 4000; 629*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = (bd->pins[ 92] & 0x01) ? 14318 : 27000; 630*f7018c21STomi Valkeinen return 0; 631*f7018c21STomi Valkeinen } 632*f7018c21STomi Valkeinen 633*f7018c21STomi Valkeinen static void default_pins4(struct matrox_fb_info *minfo) 634*f7018c21STomi Valkeinen { 635*f7018c21STomi Valkeinen /* G400 */ 636*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = 637*f7018c21STomi Valkeinen minfo->limits.system.vcomax = 252000; 638*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = 0x04A450A1; 639*f7018c21STomi Valkeinen minfo->values.reg.memrdbk = 0x000000E7; 640*f7018c21STomi Valkeinen minfo->values.reg.opt = 0x10000400; 641*f7018c21STomi Valkeinen minfo->values.reg.opt3 = 0x0190A419; 642*f7018c21STomi Valkeinen minfo->values.pll.system = 200000; 643*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = 27000; 644*f7018c21STomi Valkeinen } 645*f7018c21STomi Valkeinen 646*f7018c21STomi Valkeinen static int parse_pins5(struct matrox_fb_info *minfo, 647*f7018c21STomi Valkeinen const struct matrox_bios *bd) 648*f7018c21STomi Valkeinen { 649*f7018c21STomi Valkeinen unsigned int mult; 650*f7018c21STomi Valkeinen 651*f7018c21STomi Valkeinen mult = bd->pins[4]?8000:6000; 652*f7018c21STomi Valkeinen 653*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = (bd->pins[ 38] == 0xFF) ? 600000 : bd->pins[ 38] * mult; 654*f7018c21STomi Valkeinen minfo->limits.system.vcomax = (bd->pins[ 36] == 0xFF) ? minfo->limits.pixel.vcomax : bd->pins[ 36] * mult; 655*f7018c21STomi Valkeinen minfo->limits.video.vcomax = (bd->pins[ 37] == 0xFF) ? minfo->limits.system.vcomax : bd->pins[ 37] * mult; 656*f7018c21STomi Valkeinen minfo->limits.pixel.vcomin = (bd->pins[123] == 0xFF) ? 256000 : bd->pins[123] * mult; 657*f7018c21STomi Valkeinen minfo->limits.system.vcomin = (bd->pins[121] == 0xFF) ? minfo->limits.pixel.vcomin : bd->pins[121] * mult; 658*f7018c21STomi Valkeinen minfo->limits.video.vcomin = (bd->pins[122] == 0xFF) ? minfo->limits.system.vcomin : bd->pins[122] * mult; 659*f7018c21STomi Valkeinen minfo->values.pll.system = 660*f7018c21STomi Valkeinen minfo->values.pll.video = (bd->pins[ 92] == 0xFF) ? 284000 : bd->pins[ 92] * 4000; 661*f7018c21STomi Valkeinen minfo->values.reg.opt = get_unaligned_le32(bd->pins + 48); 662*f7018c21STomi Valkeinen minfo->values.reg.opt2 = get_unaligned_le32(bd->pins + 52); 663*f7018c21STomi Valkeinen minfo->values.reg.opt3 = get_unaligned_le32(bd->pins + 94); 664*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = get_unaligned_le32(bd->pins + 98); 665*f7018c21STomi Valkeinen minfo->values.reg.memmisc = get_unaligned_le32(bd->pins + 102); 666*f7018c21STomi Valkeinen minfo->values.reg.memrdbk = get_unaligned_le32(bd->pins + 106); 667*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = (bd->pins[110] & 0x01) ? 14318 : 27000; 668*f7018c21STomi Valkeinen minfo->values.memory.ddr = (bd->pins[114] & 0x60) == 0x20; 669*f7018c21STomi Valkeinen minfo->values.memory.dll = (bd->pins[115] & 0x02) != 0; 670*f7018c21STomi Valkeinen minfo->values.memory.emrswen = (bd->pins[115] & 0x01) != 0; 671*f7018c21STomi Valkeinen minfo->values.reg.maccess = minfo->values.memory.emrswen ? 0x00004000 : 0x00000000; 672*f7018c21STomi Valkeinen if (bd->pins[115] & 4) { 673*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst_core = minfo->values.reg.mctlwtst; 674*f7018c21STomi Valkeinen } else { 675*f7018c21STomi Valkeinen u_int32_t wtst_xlat[] = { 0, 1, 5, 6, 7, 5, 2, 3 }; 676*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst_core = (minfo->values.reg.mctlwtst & ~7) | 677*f7018c21STomi Valkeinen wtst_xlat[minfo->values.reg.mctlwtst & 7]; 678*f7018c21STomi Valkeinen } 679*f7018c21STomi Valkeinen minfo->max_pixel_clock_panellink = bd->pins[47] * 4000; 680*f7018c21STomi Valkeinen return 0; 681*f7018c21STomi Valkeinen } 682*f7018c21STomi Valkeinen 683*f7018c21STomi Valkeinen static void default_pins5(struct matrox_fb_info *minfo) 684*f7018c21STomi Valkeinen { 685*f7018c21STomi Valkeinen /* Mine 16MB G450 with SDRAM DDR */ 686*f7018c21STomi Valkeinen minfo->limits.pixel.vcomax = 687*f7018c21STomi Valkeinen minfo->limits.system.vcomax = 688*f7018c21STomi Valkeinen minfo->limits.video.vcomax = 600000; 689*f7018c21STomi Valkeinen minfo->limits.pixel.vcomin = 690*f7018c21STomi Valkeinen minfo->limits.system.vcomin = 691*f7018c21STomi Valkeinen minfo->limits.video.vcomin = 256000; 692*f7018c21STomi Valkeinen minfo->values.pll.system = 693*f7018c21STomi Valkeinen minfo->values.pll.video = 284000; 694*f7018c21STomi Valkeinen minfo->values.reg.opt = 0x404A1160; 695*f7018c21STomi Valkeinen minfo->values.reg.opt2 = 0x0000AC00; 696*f7018c21STomi Valkeinen minfo->values.reg.opt3 = 0x0090A409; 697*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst_core = 698*f7018c21STomi Valkeinen minfo->values.reg.mctlwtst = 0x0C81462B; 699*f7018c21STomi Valkeinen minfo->values.reg.memmisc = 0x80000004; 700*f7018c21STomi Valkeinen minfo->values.reg.memrdbk = 0x01001103; 701*f7018c21STomi Valkeinen minfo->features.pll.ref_freq = 27000; 702*f7018c21STomi Valkeinen minfo->values.memory.ddr = 1; 703*f7018c21STomi Valkeinen minfo->values.memory.dll = 1; 704*f7018c21STomi Valkeinen minfo->values.memory.emrswen = 1; 705*f7018c21STomi Valkeinen minfo->values.reg.maccess = 0x00004000; 706*f7018c21STomi Valkeinen } 707*f7018c21STomi Valkeinen 708*f7018c21STomi Valkeinen static int matroxfb_set_limits(struct matrox_fb_info *minfo, 709*f7018c21STomi Valkeinen const struct matrox_bios *bd) 710*f7018c21STomi Valkeinen { 711*f7018c21STomi Valkeinen unsigned int pins_version; 712*f7018c21STomi Valkeinen static const unsigned int pinslen[] = { 64, 64, 64, 128, 128 }; 713*f7018c21STomi Valkeinen 714*f7018c21STomi Valkeinen switch (minfo->chip) { 715*f7018c21STomi Valkeinen case MGA_2064: default_pins1(minfo); break; 716*f7018c21STomi Valkeinen case MGA_2164: 717*f7018c21STomi Valkeinen case MGA_1064: 718*f7018c21STomi Valkeinen case MGA_1164: default_pins2(minfo); break; 719*f7018c21STomi Valkeinen case MGA_G100: 720*f7018c21STomi Valkeinen case MGA_G200: default_pins3(minfo); break; 721*f7018c21STomi Valkeinen case MGA_G400: default_pins4(minfo); break; 722*f7018c21STomi Valkeinen case MGA_G450: 723*f7018c21STomi Valkeinen case MGA_G550: default_pins5(minfo); break; 724*f7018c21STomi Valkeinen } 725*f7018c21STomi Valkeinen if (!bd->bios_valid) { 726*f7018c21STomi Valkeinen printk(KERN_INFO "matroxfb: Your Matrox device does not have BIOS\n"); 727*f7018c21STomi Valkeinen return -1; 728*f7018c21STomi Valkeinen } 729*f7018c21STomi Valkeinen if (bd->pins_len < 64) { 730*f7018c21STomi Valkeinen printk(KERN_INFO "matroxfb: BIOS on your Matrox device does not contain powerup info\n"); 731*f7018c21STomi Valkeinen return -1; 732*f7018c21STomi Valkeinen } 733*f7018c21STomi Valkeinen if (bd->pins[0] == 0x2E && bd->pins[1] == 0x41) { 734*f7018c21STomi Valkeinen pins_version = bd->pins[5]; 735*f7018c21STomi Valkeinen if (pins_version < 2 || pins_version > 5) { 736*f7018c21STomi Valkeinen printk(KERN_INFO "matroxfb: Unknown version (%u) of powerup info\n", pins_version); 737*f7018c21STomi Valkeinen return -1; 738*f7018c21STomi Valkeinen } 739*f7018c21STomi Valkeinen } else { 740*f7018c21STomi Valkeinen pins_version = 1; 741*f7018c21STomi Valkeinen } 742*f7018c21STomi Valkeinen if (bd->pins_len != pinslen[pins_version - 1]) { 743*f7018c21STomi Valkeinen printk(KERN_INFO "matroxfb: Invalid powerup info\n"); 744*f7018c21STomi Valkeinen return -1; 745*f7018c21STomi Valkeinen } 746*f7018c21STomi Valkeinen switch (pins_version) { 747*f7018c21STomi Valkeinen case 1: 748*f7018c21STomi Valkeinen return parse_pins1(minfo, bd); 749*f7018c21STomi Valkeinen case 2: 750*f7018c21STomi Valkeinen return parse_pins2(minfo, bd); 751*f7018c21STomi Valkeinen case 3: 752*f7018c21STomi Valkeinen return parse_pins3(minfo, bd); 753*f7018c21STomi Valkeinen case 4: 754*f7018c21STomi Valkeinen return parse_pins4(minfo, bd); 755*f7018c21STomi Valkeinen case 5: 756*f7018c21STomi Valkeinen return parse_pins5(minfo, bd); 757*f7018c21STomi Valkeinen default: 758*f7018c21STomi Valkeinen printk(KERN_DEBUG "matroxfb: Powerup info version %u is not yet supported\n", pins_version); 759*f7018c21STomi Valkeinen return -1; 760*f7018c21STomi Valkeinen } 761*f7018c21STomi Valkeinen } 762*f7018c21STomi Valkeinen 763*f7018c21STomi Valkeinen void matroxfb_read_pins(struct matrox_fb_info *minfo) 764*f7018c21STomi Valkeinen { 765*f7018c21STomi Valkeinen u32 opt; 766*f7018c21STomi Valkeinen u32 biosbase; 767*f7018c21STomi Valkeinen u32 fbbase; 768*f7018c21STomi Valkeinen struct pci_dev *pdev = minfo->pcidev; 769*f7018c21STomi Valkeinen 770*f7018c21STomi Valkeinen memset(&minfo->bios, 0, sizeof(minfo->bios)); 771*f7018c21STomi Valkeinen pci_read_config_dword(pdev, PCI_OPTION_REG, &opt); 772*f7018c21STomi Valkeinen pci_write_config_dword(pdev, PCI_OPTION_REG, opt | PCI_OPTION_ENABLE_ROM); 773*f7018c21STomi Valkeinen pci_read_config_dword(pdev, PCI_ROM_ADDRESS, &biosbase); 774*f7018c21STomi Valkeinen pci_read_config_dword(pdev, minfo->devflags.fbResource, &fbbase); 775*f7018c21STomi Valkeinen pci_write_config_dword(pdev, PCI_ROM_ADDRESS, (fbbase & PCI_ROM_ADDRESS_MASK) | PCI_ROM_ADDRESS_ENABLE); 776*f7018c21STomi Valkeinen parse_bios(vaddr_va(minfo->video.vbase), &minfo->bios); 777*f7018c21STomi Valkeinen pci_write_config_dword(pdev, PCI_ROM_ADDRESS, biosbase); 778*f7018c21STomi Valkeinen pci_write_config_dword(pdev, PCI_OPTION_REG, opt); 779*f7018c21STomi Valkeinen #ifdef CONFIG_X86 780*f7018c21STomi Valkeinen if (!minfo->bios.bios_valid) { 781*f7018c21STomi Valkeinen unsigned char __iomem* b; 782*f7018c21STomi Valkeinen 783*f7018c21STomi Valkeinen b = ioremap(0x000C0000, 65536); 784*f7018c21STomi Valkeinen if (!b) { 785*f7018c21STomi Valkeinen printk(KERN_INFO "matroxfb: Unable to map legacy BIOS\n"); 786*f7018c21STomi Valkeinen } else { 787*f7018c21STomi Valkeinen unsigned int ven = readb(b+0x64+0) | (readb(b+0x64+1) << 8); 788*f7018c21STomi Valkeinen unsigned int dev = readb(b+0x64+2) | (readb(b+0x64+3) << 8); 789*f7018c21STomi Valkeinen 790*f7018c21STomi Valkeinen if (ven != pdev->vendor || dev != pdev->device) { 791*f7018c21STomi Valkeinen printk(KERN_INFO "matroxfb: Legacy BIOS is for %04X:%04X, while this device is %04X:%04X\n", 792*f7018c21STomi Valkeinen ven, dev, pdev->vendor, pdev->device); 793*f7018c21STomi Valkeinen } else { 794*f7018c21STomi Valkeinen parse_bios(b, &minfo->bios); 795*f7018c21STomi Valkeinen } 796*f7018c21STomi Valkeinen iounmap(b); 797*f7018c21STomi Valkeinen } 798*f7018c21STomi Valkeinen } 799*f7018c21STomi Valkeinen #endif 800*f7018c21STomi Valkeinen matroxfb_set_limits(minfo, &minfo->bios); 801*f7018c21STomi Valkeinen printk(KERN_INFO "PInS memtype = %u\n", 802*f7018c21STomi Valkeinen (minfo->values.reg.opt & 0x1C00) >> 10); 803*f7018c21STomi Valkeinen } 804*f7018c21STomi Valkeinen 805*f7018c21STomi Valkeinen EXPORT_SYMBOL(matroxfb_DAC_in); 806*f7018c21STomi Valkeinen EXPORT_SYMBOL(matroxfb_DAC_out); 807*f7018c21STomi Valkeinen EXPORT_SYMBOL(matroxfb_var2my); 808*f7018c21STomi Valkeinen EXPORT_SYMBOL(matroxfb_PLL_calcclock); 809*f7018c21STomi Valkeinen EXPORT_SYMBOL(matroxfb_vgaHWinit); /* DAC1064, Ti3026 */ 810*f7018c21STomi Valkeinen EXPORT_SYMBOL(matroxfb_vgaHWrestore); /* DAC1064, Ti3026 */ 811*f7018c21STomi Valkeinen EXPORT_SYMBOL(matroxfb_read_pins); 812*f7018c21STomi Valkeinen 813*f7018c21STomi Valkeinen MODULE_AUTHOR("(c) 1999-2002 Petr Vandrovec <vandrove@vc.cvut.cz>"); 814*f7018c21STomi Valkeinen MODULE_DESCRIPTION("Miscellaneous support for Matrox video cards"); 815*f7018c21STomi Valkeinen MODULE_LICENSE("GPL"); 816