drivers/video/matrox/matroxfb_Ti3026.c

   1 /*
   2  *
   3  * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200 and G400
   4  *
   5  * (c) 1998-2002 Petr Vandrovec <vandrove@vc.cvut.cz>
   6  *
   7  * Portions Copyright (c) 2001 Matrox Graphics Inc.
   8  *
   9  * Version: 1.65 2002/08/14
  10  *
  11  * MTRR stuff: 1998 Tom Rini <trini@kernel.crashing.org>
  12  *
  13  * Contributors: "menion?" <menion@mindless.com>
  14  *                     Betatesting, fixes, ideas
  15  *
  16  *               "Kurt Garloff" <garloff@suse.de>
  17  *                     Betatesting, fixes, ideas, videomodes, videomodes timmings
  18  *
  19  *               "Tom Rini" <trini@kernel.crashing.org>
  20  *                     MTRR stuff, PPC cleanups, betatesting, fixes, ideas
  21  *
  22  *               "Bibek Sahu" <scorpio@dodds.net>
  23  *                     Access device through readb|w|l and write b|w|l
  24  *                     Extensive debugging stuff
  25  *
  26  *               "Daniel Haun" <haund@usa.net>
  27  *                     Testing, hardware cursor fixes
  28  *
  29  *               "Scott Wood" <sawst46+@pitt.edu>
  30  *                     Fixes
  31  *
  32  *               "Gerd Knorr" <kraxel@goldbach.isdn.cs.tu-berlin.de>
  33  *                     Betatesting
  34  *
  35  *               "Kelly French" <targon@hazmat.com>
  36  *               "Fernando Herrera" <fherrera@eurielec.etsit.upm.es>
  37  *                     Betatesting, bug reporting
  38  *
  39  *               "Pablo Bianucci" <pbian@pccp.com.ar>
  40  *                     Fixes, ideas, betatesting
  41  *
  42  *               "Inaky Perez Gonzalez" <inaky@peloncho.fis.ucm.es>
  43  *                     Fixes, enhandcements, ideas, betatesting
  44  *
  45  *               "Ryuichi Oikawa" <roikawa@rr.iiij4u.or.jp>
  46  *                     PPC betatesting, PPC support, backward compatibility
  47  *
  48  *               "Paul Womar" <Paul@pwomar.demon.co.uk>
  49  *               "Owen Waller" <O.Waller@ee.qub.ac.uk>
  50  *                     PPC betatesting
  51  *
  52  *               "Thomas Pornin" <pornin@bolet.ens.fr>
  53  *                     Alpha betatesting
  54  *
  55  *               "Pieter van Leuven" <pvl@iae.nl>
  56  *               "Ulf Jaenicke-Roessler" <ujr@physik.phy.tu-dresden.de>
  57  *                     G100 testing
  58  *
  59  *               "H. Peter Arvin" <hpa@transmeta.com>
  60  *                     Ideas
  61  *
  62  *               "Cort Dougan" <cort@cs.nmt.edu>
  63  *                     CHRP fixes and PReP cleanup
  64  *
  65  *               "Mark Vojkovich" <mvojkovi@ucsd.edu>
  66  *                     G400 support
  67  *
  68  * (following author is not in any relation with this code, but his code
  69  *  is included in this driver)
  70  *
  71  * Based on framebuffer driver for VBE 2.0 compliant graphic boards
  72  *     (c) 1998 Gerd Knorr <kraxel@cs.tu-berlin.de>
  73  *
  74  * (following author is not in any relation with this code, but his ideas
  75  *  were used when writting this driver)
  76  *
  77  *               FreeVBE/AF (Matrox), "Shawn Hargreaves" <shawn@talula.demon.co.uk>
  78  *
  79  */
  80
  81 /* make checkconfig does not verify included files... */
  82 #include <linux/config.h>
  83
  84 #include "matroxfb_Ti3026.h"
  85 #include "matroxfb_misc.h"
  86 #include "matroxfb_accel.h"
  87 #include <linux/matroxfb.h>
  88
  89 #ifdef CONFIG_FB_MATROX_MILLENIUM
  90 #define outTi3026 matroxfb_DAC_out
  91 #define inTi3026 matroxfb_DAC_in
  92
  93 #define TVP3026_INDEX           0x00
  94 #define TVP3026_PALWRADD        0x00
  95 #define TVP3026_PALDATA         0x01
  96 #define TVP3026_PIXRDMSK        0x02
  97 #define TVP3026_PALRDADD        0x03
  98 #define TVP3026_CURCOLWRADD     0x04
  99 #define     TVP3026_CLOVERSCAN          0x00
 100 #define     TVP3026_CLCOLOR0            0x01
 101 #define     TVP3026_CLCOLOR1            0x02
 102 #define     TVP3026_CLCOLOR2            0x03
 103 #define TVP3026_CURCOLDATA      0x05
 104 #define TVP3026_CURCOLRDADD     0x07
 105 #define TVP3026_CURCTRL         0x09
 106 #define TVP3026_X_DATAREG       0x0A
 107 #define TVP3026_CURRAMDATA      0x0B
 108 #define TVP3026_CURPOSXL        0x0C
 109 #define TVP3026_CURPOSXH        0x0D
 110 #define TVP3026_CURPOSYL        0x0E
 111 #define TVP3026_CURPOSYH        0x0F
 112
 113 #define TVP3026_XSILICONREV     0x01
 114 #define TVP3026_XCURCTRL        0x06
 115 #define     TVP3026_XCURCTRL_DIS        0x00    /* transparent, transparent, transparent, transparent */
 116 #define     TVP3026_XCURCTRL_3COLOR     0x01    /* transparent, 0, 1, 2 */
 117 #define     TVP3026_XCURCTRL_XGA        0x02    /* 0, 1, transparent, complement */
 118 #define     TVP3026_XCURCTRL_XWIN       0x03    /* transparent, transparent, 0, 1 */
 119 #define     TVP3026_XCURCTRL_BLANK2048  0x00
 120 #define     TVP3026_XCURCTRL_BLANK4096  0x10
 121 #define     TVP3026_XCURCTRL_INTERLACED 0x20
 122 #define     TVP3026_XCURCTRL_ODD        0x00 /* ext.signal ODD/\EVEN */
 123 #define     TVP3026_XCURCTRL_EVEN       0x40 /* ext.signal EVEN/\ODD */
 124 #define     TVP3026_XCURCTRL_INDIRECT   0x00
 125 #define     TVP3026_XCURCTRL_DIRECT     0x80
 126 #define TVP3026_XLATCHCTRL      0x0F
 127 #define     TVP3026_XLATCHCTRL_1_1      0x06
 128 #define     TVP3026_XLATCHCTRL_2_1      0x07
 129 #define     TVP3026_XLATCHCTRL_4_1      0x06
 130 #define     TVP3026_XLATCHCTRL_8_1      0x06
 131 #define     TVP3026_XLATCHCTRL_16_1     0x06
 132 #define     TVP3026A_XLATCHCTRL_4_3     0x06    /* ??? do not understand... but it works... !!! */
 133 #define     TVP3026A_XLATCHCTRL_8_3     0x07
 134 #define     TVP3026B_XLATCHCTRL_4_3     0x08
 135 #define     TVP3026B_XLATCHCTRL_8_3     0x06    /* ??? do not understand... but it works... !!! */
 136 #define TVP3026_XTRUECOLORCTRL  0x18
 137 #define     TVP3026_XTRUECOLORCTRL_VRAM_SHIFT_ACCEL     0x00
 138 #define     TVP3026_XTRUECOLORCTRL_VRAM_SHIFT_TVP       0x20
 139 #define     TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR          0x80
 140 #define     TVP3026_XTRUECOLORCTRL_TRUECOLOR            0x40 /* paletized */
 141 #define     TVP3026_XTRUECOLORCTRL_DIRECTCOLOR          0x00
 142 #define     TVP3026_XTRUECOLORCTRL_24_ALTERNATE         0x08 /* 5:4/5:2 instead of 4:3/8:3 */
 143 #define     TVP3026_XTRUECOLORCTRL_RGB_888              0x16 /* 4:3/8:3 (or 5:4/5:2) */
 144 #define     TVP3026_XTRUECOLORCTRL_BGR_888              0x17
 145 #define     TVP3026_XTRUECOLORCTRL_ORGB_8888            0x06
 146 #define     TVP3026_XTRUECOLORCTRL_BGRO_8888            0x07
 147 #define     TVP3026_XTRUECOLORCTRL_RGB_565              0x05
 148 #define     TVP3026_XTRUECOLORCTRL_ORGB_1555            0x04
 149 #define     TVP3026_XTRUECOLORCTRL_RGB_664              0x03
 150 #define     TVP3026_XTRUECOLORCTRL_RGBO_4444            0x01
 151 #define TVP3026_XMUXCTRL        0x19
 152 #define     TVP3026_XMUXCTRL_MEMORY_8BIT                        0x01 /* - */
 153 #define     TVP3026_XMUXCTRL_MEMORY_16BIT                       0x02 /* - */
 154 #define     TVP3026_XMUXCTRL_MEMORY_32BIT                       0x03 /* 2MB RAM, 512K * 4 */
 155 #define     TVP3026_XMUXCTRL_MEMORY_64BIT                       0x04 /* >2MB RAM, 512K * 8 & more */
 156 #define     TVP3026_XMUXCTRL_PIXEL_4BIT                         0x40 /* L0,H0,L1,H1... */
 157 #define     TVP3026_XMUXCTRL_PIXEL_4BIT_SWAPPED                 0x60 /* H0,L0,H1,L1... */
 158 #define     TVP3026_XMUXCTRL_PIXEL_8BIT                         0x48
 159 #define     TVP3026_XMUXCTRL_PIXEL_16BIT                        0x50
 160 #define     TVP3026_XMUXCTRL_PIXEL_32BIT                        0x58
 161 #define     TVP3026_XMUXCTRL_VGA                                0x98 /* VGA MEMORY, 8BIT PIXEL */
 162 #define TVP3026_XCLKCTRL        0x1A
 163 #define     TVP3026_XCLKCTRL_DIV1       0x00
 164 #define     TVP3026_XCLKCTRL_DIV2       0x10
 165 #define     TVP3026_XCLKCTRL_DIV4       0x20
 166 #define     TVP3026_XCLKCTRL_DIV8       0x30
 167 #define     TVP3026_XCLKCTRL_DIV16      0x40
 168 #define     TVP3026_XCLKCTRL_DIV32      0x50
 169 #define     TVP3026_XCLKCTRL_DIV64      0x60
 170 #define     TVP3026_XCLKCTRL_CLKSTOPPED 0x70
 171 #define     TVP3026_XCLKCTRL_SRC_CLK0   0x00
 172 #define     TVP3026_XCLKCTRL_SRC_CLK1   0x01
 173 #define     TVP3026_XCLKCTRL_SRC_CLK2   0x02    /* CLK2 is TTL source*/
 174 #define     TVP3026_XCLKCTRL_SRC_NCLK2  0x03    /* not CLK2 is TTL source */
 175 #define     TVP3026_XCLKCTRL_SRC_ECLK2  0x04    /* CLK2 and not CLK2 is ECL source */
 176 #define     TVP3026_XCLKCTRL_SRC_PLL    0x05
 177 #define     TVP3026_XCLKCTRL_SRC_DIS    0x06    /* disable & poweroff internal clock */
 178 #define     TVP3026_XCLKCTRL_SRC_CLK0VGA 0x07
 179 #define TVP3026_XPALETTEPAGE    0x1C
 180 #define TVP3026_XGENCTRL        0x1D
 181 #define     TVP3026_XGENCTRL_HSYNC_POS  0x00
 182 #define     TVP3026_XGENCTRL_HSYNC_NEG  0x01
 183 #define     TVP3026_XGENCTRL_VSYNC_POS  0x00
 184 #define     TVP3026_XGENCTRL_VSYNC_NEG  0x02
 185 #define     TVP3026_XGENCTRL_LITTLE_ENDIAN 0x00
 186 #define     TVP3026_XGENCTRL_BIG_ENDIAN    0x08
 187 #define     TVP3026_XGENCTRL_BLACK_0IRE         0x00
 188 #define     TVP3026_XGENCTRL_BLACK_75IRE        0x10
 189 #define     TVP3026_XGENCTRL_NO_SYNC_ON_GREEN   0x00
 190 #define     TVP3026_XGENCTRL_SYNC_ON_GREEN      0x20
 191 #define     TVP3026_XGENCTRL_OVERSCAN_DIS       0x00
 192 #define     TVP3026_XGENCTRL_OVERSCAN_EN        0x40
 193 #define TVP3026_XMISCCTRL       0x1E
 194 #define     TVP3026_XMISCCTRL_DAC_PUP   0x00
 195 #define     TVP3026_XMISCCTRL_DAC_PDOWN 0x01
 196 #define     TVP3026_XMISCCTRL_DAC_EXT   0x00 /* or 8, bit 3 is ignored */
 197 #define     TVP3026_XMISCCTRL_DAC_6BIT  0x04
 198 #define     TVP3026_XMISCCTRL_DAC_8BIT  0x0C
 199 #define     TVP3026_XMISCCTRL_PSEL_DIS  0x00
 200 #define     TVP3026_XMISCCTRL_PSEL_EN   0x10
 201 #define     TVP3026_XMISCCTRL_PSEL_LOW  0x00 /* PSEL high selects directcolor */
 202 #define     TVP3026_XMISCCTRL_PSEL_HIGH 0x20 /* PSEL high selects truecolor or pseudocolor */
 203 #define TVP3026_XGENIOCTRL      0x2A
 204 #define TVP3026_XGENIODATA      0x2B
 205 #define TVP3026_XPLLADDR        0x2C
 206 #define     TVP3026_XPLLADDR_X(LOOP,MCLK,PIX) (((LOOP)<<4) | ((MCLK)<<2) | (PIX))
 207 #define     TVP3026_XPLLDATA_N          0x00
 208 #define     TVP3026_XPLLDATA_M          0x01
 209 #define     TVP3026_XPLLDATA_P          0x02
 210 #define     TVP3026_XPLLDATA_STAT       0x03
 211 #define TVP3026_XPIXPLLDATA     0x2D
 212 #define TVP3026_XMEMPLLDATA     0x2E
 213 #define TVP3026_XLOOPPLLDATA    0x2F
 214 #define TVP3026_XCOLKEYOVRMIN   0x30
 215 #define TVP3026_XCOLKEYOVRMAX   0x31
 216 #define TVP3026_XCOLKEYREDMIN   0x32
 217 #define TVP3026_XCOLKEYREDMAX   0x33
 218 #define TVP3026_XCOLKEYGREENMIN 0x34
 219 #define TVP3026_XCOLKEYGREENMAX 0x35
 220 #define TVP3026_XCOLKEYBLUEMIN  0x36
 221 #define TVP3026_XCOLKEYBLUEMAX  0x37
 222 #define TVP3026_XCOLKEYCTRL     0x38
 223 #define     TVP3026_XCOLKEYCTRL_OVR_EN  0x01
 224 #define     TVP3026_XCOLKEYCTRL_RED_EN  0x02
 225 #define     TVP3026_XCOLKEYCTRL_GREEN_EN 0x04
 226 #define     TVP3026_XCOLKEYCTRL_BLUE_EN 0x08
 227 #define     TVP3026_XCOLKEYCTRL_NEGATE  0x10
 228 #define     TVP3026_XCOLKEYCTRL_ZOOM1   0x00
 229 #define     TVP3026_XCOLKEYCTRL_ZOOM2   0x20
 230 #define     TVP3026_XCOLKEYCTRL_ZOOM4   0x40
 231 #define     TVP3026_XCOLKEYCTRL_ZOOM8   0x60
 232 #define     TVP3026_XCOLKEYCTRL_ZOOM16  0x80
 233 #define     TVP3026_XCOLKEYCTRL_ZOOM32  0xA0
 234 #define TVP3026_XMEMPLLCTRL     0x39
 235 #define     TVP3026_XMEMPLLCTRL_DIV(X)  (((X)-1)>>1)    /* 2,4,6,8,10,12,14,16, division applied to LOOP PLL after divide by 2^P */
 236 #define     TVP3026_XMEMPLLCTRL_STROBEMKC4      0x08
 237 #define     TVP3026_XMEMPLLCTRL_MCLK_DOTCLOCK   0x00    /* MKC4 */
 238 #define     TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL    0x10    /* MKC4 */
 239 #define     TVP3026_XMEMPLLCTRL_RCLK_PIXPLL     0x00
 240 #define     TVP3026_XMEMPLLCTRL_RCLK_LOOPPLL    0x20
 241 #define     TVP3026_XMEMPLLCTRL_RCLK_DOTDIVN    0x40    /* dot clock divided by loop pclk N prescaler */
 242 #define TVP3026_XSENSETEST      0x3A
 243 #define TVP3026_XTESTMODEDATA   0x3B
 244 #define TVP3026_XCRCREML        0x3C
 245 #define TVP3026_XCRCREMH        0x3D
 246 #define TVP3026_XCRCBITSEL      0x3E
 247 #define TVP3026_XID             0x3F
 248
 249 static const unsigned char DACseq[] =
 250 { TVP3026_XLATCHCTRL, TVP3026_XTRUECOLORCTRL,
 251   TVP3026_XMUXCTRL, TVP3026_XCLKCTRL,
 252   TVP3026_XPALETTEPAGE,
 253   TVP3026_XGENCTRL,
 254   TVP3026_XMISCCTRL,
 255   TVP3026_XGENIOCTRL,
 256   TVP3026_XGENIODATA,
 257   TVP3026_XCOLKEYOVRMIN, TVP3026_XCOLKEYOVRMAX, TVP3026_XCOLKEYREDMIN, TVP3026_XCOLKEYREDMAX,
 258   TVP3026_XCOLKEYGREENMIN, TVP3026_XCOLKEYGREENMAX, TVP3026_XCOLKEYBLUEMIN, TVP3026_XCOLKEYBLUEMAX,
 259   TVP3026_XCOLKEYCTRL,
 260   TVP3026_XMEMPLLCTRL, TVP3026_XSENSETEST, TVP3026_XCURCTRL };
 261
 262 #define POS3026_XLATCHCTRL      0
 263 #define POS3026_XTRUECOLORCTRL  1
 264 #define POS3026_XMUXCTRL        2
 265 #define POS3026_XCLKCTRL        3
 266 #define POS3026_XGENCTRL        5
 267 #define POS3026_XMISCCTRL       6
 268 #define POS3026_XMEMPLLCTRL     18
 269 #define POS3026_XCURCTRL        20
 270
 271 static const unsigned char MGADACbpp32[] =
 272 { TVP3026_XLATCHCTRL_2_1, TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_ORGB_8888,
 273   0x00, TVP3026_XCLKCTRL_DIV1 | TVP3026_XCLKCTRL_SRC_PLL,
 274   0x00,
 275   TVP3026_XGENCTRL_HSYNC_POS | TVP3026_XGENCTRL_VSYNC_POS | TVP3026_XGENCTRL_LITTLE_ENDIAN | TVP3026_XGENCTRL_BLACK_0IRE | TVP3026_XGENCTRL_NO_SYNC_ON_GREEN | TVP3026_XGENCTRL_OVERSCAN_DIS,
 276   TVP3026_XMISCCTRL_DAC_PUP | TVP3026_XMISCCTRL_DAC_8BIT | TVP3026_XMISCCTRL_PSEL_DIS | TVP3026_XMISCCTRL_PSEL_HIGH,
 277   0x00,
 278   0x1E,
 279   0xFF, 0xFF, 0xFF, 0xFF,
 280   0xFF, 0xFF, 0xFF, 0xFF,
 281   TVP3026_XCOLKEYCTRL_ZOOM1,
 282   0x00, 0x00, TVP3026_XCURCTRL_DIS };
 283
 284 static int Ti3026_calcclock(CPMINFO unsigned int freq, unsigned int fmax, int* in, int* feed, int* post) {
 285         unsigned int fvco;
 286         unsigned int lin, lfeed, lpost;
 287
 288         DBG(__FUNCTION__)
 289
 290         fvco = PLL_calcclock(PMINFO freq, fmax, &lin, &lfeed, &lpost);
 291         fvco >>= (*post = lpost);
 292         *in = 64 - lin;
 293         *feed = 64 - lfeed;
 294         return fvco;
 295 }
 296
 297 static int Ti3026_setpclk(WPMINFO int clk) {
 298         unsigned int f_pll;
 299         unsigned int pixfeed, pixin, pixpost;
 300         struct matrox_hw_state* hw = &ACCESS_FBINFO(hw);
 301
 302         DBG(__FUNCTION__)
 303
 304         f_pll = Ti3026_calcclock(PMINFO clk, ACCESS_FBINFO(max_pixel_clock), &pixin, &pixfeed, &pixpost);
 305
 306         hw->DACclk[0] = pixin | 0xC0;
 307         hw->DACclk[1] = pixfeed;
 308         hw->DACclk[2] = pixpost | 0xB0;
 309
 310         {
 311                 unsigned int loopfeed, loopin, looppost, loopdiv, z;
 312                 unsigned int Bpp;
 313
 314                 Bpp = ACCESS_FBINFO(curr.final_bppShift);
 315
 316                 if (ACCESS_FBINFO(fbcon).var.bits_per_pixel == 24) {
 317                         loopfeed = 3;           /* set lm to any possible value */
 318                         loopin = 3 * 32 / Bpp;
 319                 } else {
 320                         loopfeed = 4;
 321                         loopin = 4 * 32 / Bpp;
 322                 }
 323                 z = (110000 * loopin) / (f_pll * loopfeed);
 324                 loopdiv = 0; /* div 2 */
 325                 if (z < 2)
 326                         looppost = 0;
 327                 else if (z < 4)
 328                         looppost = 1;
 329                 else if (z < 8)
 330                         looppost = 2;
 331                 else {
 332                         looppost = 3;
 333                         loopdiv = z/16;
 334                 }
 335                 if (ACCESS_FBINFO(fbcon).var.bits_per_pixel == 24) {
 336                         hw->DACclk[3] = ((65 - loopin) & 0x3F) | 0xC0;
 337                         hw->DACclk[4] = (65 - loopfeed) | 0x80;
 338                         if (ACCESS_FBINFO(accel.ramdac_rev) > 0x20) {
 339                                 if (isInterleave(MINFO))
 340                                         hw->DACreg[POS3026_XLATCHCTRL] = TVP3026B_XLATCHCTRL_8_3;
 341                                 else {
 342                                         hw->DACclk[4] &= ~0xC0;
 343                                         hw->DACreg[POS3026_XLATCHCTRL] = TVP3026B_XLATCHCTRL_4_3;
 344                                 }
 345                         } else {
 346                                 if (isInterleave(MINFO))
 347                                         ;       /* default... */
 348                                 else {
 349                                         hw->DACclk[4] ^= 0xC0;  /* change from 0x80 to 0x40 */
 350                                         hw->DACreg[POS3026_XLATCHCTRL] = TVP3026A_XLATCHCTRL_4_3;
 351                                 }
 352                         }
 353                         hw->DACclk[5] = looppost | 0xF8;
 354                         if (ACCESS_FBINFO(devflags.mga_24bpp_fix))
 355                                 hw->DACclk[5] ^= 0x40;
 356                 } else {
 357                         hw->DACclk[3] = ((65 - loopin) & 0x3F) | 0xC0;
 358                         hw->DACclk[4] = 65 - loopfeed;
 359                         hw->DACclk[5] = looppost | 0xF0;
 360                 }
 361                 hw->DACreg[POS3026_XMEMPLLCTRL] = loopdiv | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL | TVP3026_XMEMPLLCTRL_RCLK_LOOPPLL;
 362         }
 363         return 0;
 364 }
 365
 366 static int Ti3026_init(WPMINFO struct my_timming* m) {
 367         u_int8_t muxctrl = isInterleave(MINFO) ? TVP3026_XMUXCTRL_MEMORY_64BIT : TVP3026_XMUXCTRL_MEMORY_32BIT;
 368         struct matrox_hw_state* hw = &ACCESS_FBINFO(hw);
 369
 370         DBG(__FUNCTION__)
 371
 372         memcpy(hw->DACreg, MGADACbpp32, sizeof(hw->DACreg));
 373         switch (ACCESS_FBINFO(fbcon).var.bits_per_pixel) {
 374                 case 4: hw->DACreg[POS3026_XLATCHCTRL] = TVP3026_XLATCHCTRL_16_1;       /* or _8_1, they are same */
 375                         hw->DACreg[POS3026_XTRUECOLORCTRL] = TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR;
 376                         hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_4BIT;
 377                         hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV8;
 378                         hw->DACreg[POS3026_XMISCCTRL] = TVP3026_XMISCCTRL_DAC_PUP | TVP3026_XMISCCTRL_DAC_8BIT | TVP3026_XMISCCTRL_PSEL_DIS | TVP3026_XMISCCTRL_PSEL_LOW;
 379                         break;
 380                 case 8: hw->DACreg[POS3026_XLATCHCTRL] = TVP3026_XLATCHCTRL_8_1;        /* or _4_1, they are same */
 381                         hw->DACreg[POS3026_XTRUECOLORCTRL] = TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR;
 382                         hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_8BIT;
 383                         hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV4;
 384                         hw->DACreg[POS3026_XMISCCTRL] = TVP3026_XMISCCTRL_DAC_PUP | TVP3026_XMISCCTRL_DAC_8BIT | TVP3026_XMISCCTRL_PSEL_DIS | TVP3026_XMISCCTRL_PSEL_LOW;
 385                         break;
 386                 case 16:
 387                         /* XLATCHCTRL should be _4_1 / _2_1... Why is not? (_2_1 is used everytime) */
 388                         hw->DACreg[POS3026_XTRUECOLORCTRL] = (ACCESS_FBINFO(fbcon).var.green.length == 5)? (TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_ORGB_1555 ) : (TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_RGB_565);
 389                         hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_16BIT;
 390                         hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV2;
 391                         break;
 392                 case 24:
 393                         /* XLATCHCTRL is: for (A) use _4_3 (?_8_3 is same? TBD), for (B) it is set in setpclk */
 394                         hw->DACreg[POS3026_XTRUECOLORCTRL] = TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_RGB_888;
 395                         hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_32BIT;
 396                         hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV4;
 397                         break;
 398                 case 32:
 399                         /* XLATCHCTRL should be _2_1 / _1_1... Why is not? (_2_1 is used everytime) */
 400                         hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_32BIT;
 401                         break;
 402                 default:
 403                         return 1;       /* TODO: failed */
 404         }
 405         if (matroxfb_vgaHWinit(PMINFO m)) return 1;
 406
 407         /* set SYNC */
 408         hw->MiscOutReg = 0xCB;
 409         if (m->sync & FB_SYNC_HOR_HIGH_ACT)
 410                 hw->DACreg[POS3026_XGENCTRL] |= TVP3026_XGENCTRL_HSYNC_NEG;
 411         if (m->sync & FB_SYNC_VERT_HIGH_ACT)
 412                 hw->DACreg[POS3026_XGENCTRL] |= TVP3026_XGENCTRL_VSYNC_NEG;
 413         if (m->sync & FB_SYNC_ON_GREEN)
 414                 hw->DACreg[POS3026_XGENCTRL] |= TVP3026_XGENCTRL_SYNC_ON_GREEN;
 415
 416         /* set DELAY */
 417         if (ACCESS_FBINFO(video.len) < 0x400000)
 418                 hw->CRTCEXT[3] |= 0x08;
 419         else if (ACCESS_FBINFO(video.len) > 0x400000)
 420                 hw->CRTCEXT[3] |= 0x10;
 421
 422         /* set HWCURSOR */
 423         if (m->interlaced) {
 424                 hw->DACreg[POS3026_XCURCTRL] |= TVP3026_XCURCTRL_INTERLACED;
 425         }
 426         if (m->HTotal >= 1536)
 427                 hw->DACreg[POS3026_XCURCTRL] |= TVP3026_XCURCTRL_BLANK4096;
 428
 429         /* set interleaving */
 430         hw->MXoptionReg &= ~0x00001000;
 431         if (isInterleave(MINFO)) hw->MXoptionReg |= 0x00001000;
 432
 433         /* set DAC */
 434         Ti3026_setpclk(PMINFO m->pixclock);
 435         return 0;
 436 }
 437
 438 static void ti3026_setMCLK(WPMINFO int fout){
 439         unsigned int f_pll;
 440         unsigned int pclk_m, pclk_n, pclk_p;
 441         unsigned int mclk_m, mclk_n, mclk_p;
 442         unsigned int rfhcnt, mclk_ctl;
 443         int tmout;
 444
 445         DBG(__FUNCTION__)
 446
 447         f_pll = Ti3026_calcclock(PMINFO fout, ACCESS_FBINFO(max_pixel_clock), &mclk_n, &mclk_m, &mclk_p);
 448
 449         /* save pclk */
 450         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFC);
 451         pclk_n = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
 452         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFD);
 453         pclk_m = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
 454         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFE);
 455         pclk_p = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
 456
 457         /* stop pclk */
 458         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFE);
 459         outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0x00);
 460
 461         /* set pclk to new mclk */
 462         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFC);
 463         outTi3026(PMINFO TVP3026_XPIXPLLDATA, mclk_n | 0xC0);
 464         outTi3026(PMINFO TVP3026_XPIXPLLDATA, mclk_m);
 465         outTi3026(PMINFO TVP3026_XPIXPLLDATA, mclk_p | 0xB0);
 466
 467         /* wait for PLL to lock */
 468         for (tmout = 500000; tmout; tmout--) {
 469                 if (inTi3026(PMINFO TVP3026_XPIXPLLDATA) & 0x40)
 470                         break;
 471                 udelay(10);
 472         };
 473         if (!tmout)
 474                 printk(KERN_ERR "matroxfb: Temporary pixel PLL not locked after 5 secs\n");
 475
 476         /* output pclk on mclk pin */
 477         mclk_ctl = inTi3026(PMINFO TVP3026_XMEMPLLCTRL);
 478         outTi3026(PMINFO TVP3026_XMEMPLLCTRL, mclk_ctl & 0xE7);
 479         outTi3026(PMINFO TVP3026_XMEMPLLCTRL, (mclk_ctl & 0xE7) | TVP3026_XMEMPLLCTRL_STROBEMKC4);
 480
 481         /* stop MCLK */
 482         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFB);
 483         outTi3026(PMINFO TVP3026_XMEMPLLDATA, 0x00);
 484
 485         /* set mclk to new freq */
 486         outTi3026(PMINFO TVP3026_XPLLADDR, 0xF3);
 487         outTi3026(PMINFO TVP3026_XMEMPLLDATA, mclk_n | 0xC0);
 488         outTi3026(PMINFO TVP3026_XMEMPLLDATA, mclk_m);
 489         outTi3026(PMINFO TVP3026_XMEMPLLDATA, mclk_p | 0xB0);
 490
 491         /* wait for PLL to lock */
 492         for (tmout = 500000; tmout; tmout--) {
 493                 if (inTi3026(PMINFO TVP3026_XMEMPLLDATA) & 0x40)
 494                         break;
 495                 udelay(10);
 496         }
 497         if (!tmout)
 498                 printk(KERN_ERR "matroxfb: Memory PLL not locked after 5 secs\n");
 499
 500         f_pll = f_pll * 333 / (10000 << mclk_p);
 501         if (isMilleniumII(MINFO)) {
 502                 rfhcnt = (f_pll - 128) / 256;
 503                 if (rfhcnt > 15)
 504                         rfhcnt = 15;
 505         } else {
 506                 rfhcnt = (f_pll - 64) / 128;
 507                 if (rfhcnt > 15)
 508                         rfhcnt = 0;
 509         }
 510         ACCESS_FBINFO(hw).MXoptionReg = (ACCESS_FBINFO(hw).MXoptionReg & ~0x000F0000) | (rfhcnt << 16);
 511         pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, ACCESS_FBINFO(hw).MXoptionReg);
 512
 513         /* output MCLK to MCLK pin */
 514         outTi3026(PMINFO TVP3026_XMEMPLLCTRL, (mclk_ctl & 0xE7) | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL);
 515         outTi3026(PMINFO TVP3026_XMEMPLLCTRL, (mclk_ctl       ) | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL | TVP3026_XMEMPLLCTRL_STROBEMKC4);
 516
 517         /* stop PCLK */
 518         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFE);
 519         outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0x00);
 520
 521         /* restore pclk */
 522         outTi3026(PMINFO TVP3026_XPLLADDR, 0xFC);
 523         outTi3026(PMINFO TVP3026_XPIXPLLDATA, pclk_n);
 524         outTi3026(PMINFO TVP3026_XPIXPLLDATA, pclk_m);
 525         outTi3026(PMINFO TVP3026_XPIXPLLDATA, pclk_p);
 526
 527         /* wait for PLL to lock */
 528         for (tmout = 500000; tmout; tmout--) {
 529                 if (inTi3026(PMINFO TVP3026_XPIXPLLDATA) & 0x40)
 530                         break;
 531                 udelay(10);
 532         }
 533         if (!tmout)
 534                 printk(KERN_ERR "matroxfb: Pixel PLL not locked after 5 secs\n");
 535 }
 536
 537 static void ti3026_ramdac_init(WPMINFO2) {
 538
 539         DBG(__FUNCTION__)
 540
 541         ACCESS_FBINFO(features.pll.vco_freq_min) = 110000;
 542         ACCESS_FBINFO(features.pll.ref_freq)     = 114545;
 543         ACCESS_FBINFO(features.pll.feed_div_min) = 2;
 544         ACCESS_FBINFO(features.pll.feed_div_max) = 24;
 545         ACCESS_FBINFO(features.pll.in_div_min)   = 2;
 546         ACCESS_FBINFO(features.pll.in_div_max)   = 63;
 547         ACCESS_FBINFO(features.pll.post_shift_max) = 3;
 548         if (ACCESS_FBINFO(devflags.noinit))
 549                 return;
 550         ti3026_setMCLK(PMINFO 60000);
 551 }
 552
 553 static void Ti3026_restore(WPMINFO2) {
 554         int i;
 555         unsigned char progdac[6];
 556         struct matrox_hw_state* hw = &ACCESS_FBINFO(hw);
 557         CRITFLAGS
 558
 559         DBG(__FUNCTION__)
 560
 561 #ifdef DEBUG
 562         dprintk(KERN_INFO "EXTVGA regs: ");
 563         for (i = 0; i < 6; i++)
 564                 dprintk("%02X:", hw->CRTCEXT[i]);
 565         dprintk("\n");
 566 #endif
 567
 568         CRITBEGIN
 569
 570         pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
 571
 572         CRITEND
 573
 574         matroxfb_vgaHWrestore(PMINFO2);
 575
 576         CRITBEGIN
 577
 578         ACCESS_FBINFO(crtc1.panpos) = -1;
 579         for (i = 0; i < 6; i++)
 580                 mga_setr(M_EXTVGA_INDEX, i, hw->CRTCEXT[i]);
 581
 582         for (i = 0; i < 21; i++) {
 583                 outTi3026(PMINFO DACseq[i], hw->DACreg[i]);
 584         }
 585
 586         outTi3026(PMINFO TVP3026_XPLLADDR, 0x00);
 587         progdac[0] = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
 588         progdac[3] = inTi3026(PMINFO TVP3026_XLOOPPLLDATA);
 589         outTi3026(PMINFO TVP3026_XPLLADDR, 0x15);
 590         progdac[1] = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
 591         progdac[4] = inTi3026(PMINFO TVP3026_XLOOPPLLDATA);
 592         outTi3026(PMINFO TVP3026_XPLLADDR, 0x2A);
 593         progdac[2] = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
 594         progdac[5] = inTi3026(PMINFO TVP3026_XLOOPPLLDATA);
 595
 596         CRITEND
 597         if (memcmp(hw->DACclk, progdac, 6)) {
 598                 /* agrhh... setting up PLL is very slow on Millennium... */
 599                 /* Mystique PLL is locked in few ms, but Millennium PLL lock takes about 0.15 s... */
 600                 /* Maybe even we should call schedule() ? */
 601
 602                 CRITBEGIN
 603                 outTi3026(PMINFO TVP3026_XCLKCTRL, hw->DACreg[POS3026_XCLKCTRL]);
 604                 outTi3026(PMINFO TVP3026_XPLLADDR, 0x2A);
 605                 outTi3026(PMINFO TVP3026_XLOOPPLLDATA, 0);
 606                 outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0);
 607
 608                 outTi3026(PMINFO TVP3026_XPLLADDR, 0x00);
 609                 for (i = 0; i < 3; i++)
 610                         outTi3026(PMINFO TVP3026_XPIXPLLDATA, hw->DACclk[i]);
 611                 /* wait for PLL only if PLL clock requested (always for PowerMode, never for VGA) */
 612                 if (hw->MiscOutReg & 0x08) {
 613                         int tmout;
 614                         outTi3026(PMINFO TVP3026_XPLLADDR, 0x3F);
 615                         for (tmout = 500000; tmout; --tmout) {
 616                                 if (inTi3026(PMINFO TVP3026_XPIXPLLDATA) & 0x40)
 617                                         break;
 618                                 udelay(10);
 619                         }
 620
 621                         CRITEND
 622
 623                         if (!tmout)
 624                                 printk(KERN_ERR "matroxfb: Pixel PLL not locked after 5 secs\n");
 625                         else
 626                                 dprintk(KERN_INFO "PixelPLL: %d\n", 500000-tmout);
 627                         CRITBEGIN
 628                 }
 629                 outTi3026(PMINFO TVP3026_XMEMPLLCTRL, hw->DACreg[POS3026_XMEMPLLCTRL]);
 630                 outTi3026(PMINFO TVP3026_XPLLADDR, 0x00);
 631                 for (i = 3; i < 6; i++)
 632                         outTi3026(PMINFO TVP3026_XLOOPPLLDATA, hw->DACclk[i]);
 633                 CRITEND
 634                 if ((hw->MiscOutReg & 0x08) && ((hw->DACclk[5] & 0x80) == 0x80)) {
 635                         int tmout;
 636
 637                         CRITBEGIN
 638                         outTi3026(PMINFO TVP3026_XPLLADDR, 0x3F);
 639                         for (tmout = 500000; tmout; --tmout) {
 640                                 if (inTi3026(PMINFO TVP3026_XLOOPPLLDATA) & 0x40)
 641                                         break;
 642                                 udelay(10);
 643                         }
 644                         CRITEND
 645                         if (!tmout)
 646                                 printk(KERN_ERR "matroxfb: Loop PLL not locked after 5 secs\n");
 647                         else
 648                                 dprintk(KERN_INFO "LoopPLL: %d\n", 500000-tmout);
 649                 }
 650         }
 651
 652 #ifdef DEBUG
 653         dprintk(KERN_DEBUG "3026DACregs ");
 654         for (i = 0; i < 21; i++) {
 655                 dprintk("R%02X=%02X ", DACseq[i], hw->DACreg[i]);
 656                 if ((i & 0x7) == 0x7) dprintk("\n" KERN_DEBUG "continuing... ");
 657         }
 658         dprintk("\n" KERN_DEBUG "DACclk ");
 659         for (i = 0; i < 6; i++)
 660                 dprintk("C%02X=%02X ", i, hw->DACclk[i]);
 661         dprintk("\n");
 662 #endif
 663 }
 664
 665 static void Ti3026_reset(WPMINFO2) {
 666
 667         DBG(__FUNCTION__)
 668
 669         ti3026_ramdac_init(PMINFO2);
 670 }
 671
 672 static struct matrox_altout ti3026_output = {
 673         .name    = "Primary output",
 674 };
 675
 676 static int Ti3026_preinit(WPMINFO2) {
 677         static const int vxres_mill2[] = { 512,        640, 768,  800,  832,  960,
 678                                           1024, 1152, 1280,      1600, 1664, 1920,
 679                                           2048, 0};
 680         static const int vxres_mill1[] = {             640, 768,  800,        960,
 681                                           1024, 1152, 1280,      1600,       1920,
 682                                           2048, 0};
 683         struct matrox_hw_state* hw = &ACCESS_FBINFO(hw);
 684
 685         DBG(__FUNCTION__)
 686
 687         ACCESS_FBINFO(millenium) = 1;
 688         ACCESS_FBINFO(milleniumII) = (ACCESS_FBINFO(pcidev)->device != PCI_DEVICE_ID_MATROX_MIL);
 689         ACCESS_FBINFO(capable.cfb4) = 1;
 690         ACCESS_FBINFO(capable.text) = 1; /* isMilleniumII(MINFO); */
 691         ACCESS_FBINFO(capable.vxres) = isMilleniumII(MINFO)?vxres_mill2:vxres_mill1;
 692
 693         ACCESS_FBINFO(outputs[0]).data = MINFO;
 694         ACCESS_FBINFO(outputs[0]).output = &ti3026_output;
 695         ACCESS_FBINFO(outputs[0]).src = ACCESS_FBINFO(outputs[0]).default_src;
 696         ACCESS_FBINFO(outputs[0]).mode = MATROXFB_OUTPUT_MODE_MONITOR;
 697
 698         if (ACCESS_FBINFO(devflags.noinit))
 699                 return 0;
 700         /* preserve VGA I/O, BIOS and PPC */
 701         hw->MXoptionReg &= 0xC0000100;
 702         hw->MXoptionReg |= 0x002C0000;
 703         if (ACCESS_FBINFO(devflags.novga))
 704                 hw->MXoptionReg &= ~0x00000100;
 705         if (ACCESS_FBINFO(devflags.nobios))
 706                 hw->MXoptionReg &= ~0x40000000;
 707         if (ACCESS_FBINFO(devflags.nopciretry))
 708                 hw->MXoptionReg |=  0x20000000;
 709         pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
 710
 711         ACCESS_FBINFO(accel.ramdac_rev) = inTi3026(PMINFO TVP3026_XSILICONREV);
 712
 713         outTi3026(PMINFO TVP3026_XCLKCTRL, TVP3026_XCLKCTRL_SRC_CLK0VGA | TVP3026_XCLKCTRL_CLKSTOPPED);
 714         outTi3026(PMINFO TVP3026_XTRUECOLORCTRL, TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR);
 715         outTi3026(PMINFO TVP3026_XMUXCTRL, TVP3026_XMUXCTRL_VGA);
 716
 717         outTi3026(PMINFO TVP3026_XPLLADDR, 0x2A);
 718         outTi3026(PMINFO TVP3026_XLOOPPLLDATA, 0x00);
 719         outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0x00);
 720
 721         mga_outb(M_MISC_REG, 0x67);
 722
 723         outTi3026(PMINFO TVP3026_XMEMPLLCTRL, TVP3026_XMEMPLLCTRL_STROBEMKC4 | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL);
 724
 725         mga_outl(M_RESET, 1);
 726         udelay(250);
 727         mga_outl(M_RESET, 0);
 728         udelay(250);
 729         mga_outl(M_MACCESS, 0x00008000);
 730         udelay(10);
 731         return 0;
 732 }
 733
 734 struct matrox_switch matrox_millennium = {
 735         Ti3026_preinit, Ti3026_reset, Ti3026_init, Ti3026_restore
 736 };
 737 EXPORT_SYMBOL(matrox_millennium);
 738 #endif
 739 MODULE_LICENSE("GPL");