162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * 462306a36Sopenharmony_ci * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200, G400 and G450. 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * (c) 1998-2002 Petr Vandrovec <vandrove@vc.cvut.cz> 762306a36Sopenharmony_ci * 862306a36Sopenharmony_ci * Portions Copyright (c) 2001 Matrox Graphics Inc. 962306a36Sopenharmony_ci * 1062306a36Sopenharmony_ci * Version: 1.65 2002/08/14 1162306a36Sopenharmony_ci * 1262306a36Sopenharmony_ci * See matroxfb_base.c for contributors. 1362306a36Sopenharmony_ci * 1462306a36Sopenharmony_ci */ 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#include "matroxfb_DAC1064.h" 1862306a36Sopenharmony_ci#include "matroxfb_misc.h" 1962306a36Sopenharmony_ci#include "matroxfb_accel.h" 2062306a36Sopenharmony_ci#include "g450_pll.h" 2162306a36Sopenharmony_ci#include <linux/matroxfb.h> 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci#ifdef NEED_DAC1064 2462306a36Sopenharmony_ci#define outDAC1064 matroxfb_DAC_out 2562306a36Sopenharmony_ci#define inDAC1064 matroxfb_DAC_in 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci#define DAC1064_OPT_SCLK_PCI 0x00 2862306a36Sopenharmony_ci#define DAC1064_OPT_SCLK_PLL 0x01 2962306a36Sopenharmony_ci#define DAC1064_OPT_SCLK_EXT 0x02 3062306a36Sopenharmony_ci#define DAC1064_OPT_SCLK_MASK 0x03 3162306a36Sopenharmony_ci#define DAC1064_OPT_GDIV1 0x04 /* maybe it is GDIV2 on G100 ?! */ 3262306a36Sopenharmony_ci#define DAC1064_OPT_GDIV3 0x00 3362306a36Sopenharmony_ci#define DAC1064_OPT_MDIV1 0x08 3462306a36Sopenharmony_ci#define DAC1064_OPT_MDIV2 0x00 3562306a36Sopenharmony_ci#define DAC1064_OPT_RESERVED 0x10 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_cistatic void DAC1064_calcclock(const struct matrox_fb_info *minfo, 3862306a36Sopenharmony_ci unsigned int freq, unsigned int fmax, 3962306a36Sopenharmony_ci unsigned int *in, unsigned int *feed, 4062306a36Sopenharmony_ci unsigned int *post) 4162306a36Sopenharmony_ci{ 4262306a36Sopenharmony_ci unsigned int fvco; 4362306a36Sopenharmony_ci unsigned int p; 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_ci DBG(__func__) 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci /* only for devices older than G450 */ 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci fvco = PLL_calcclock(minfo, freq, fmax, in, feed, &p); 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_ci p = (1 << p) - 1; 5262306a36Sopenharmony_ci if (fvco <= 100000) 5362306a36Sopenharmony_ci ; 5462306a36Sopenharmony_ci else if (fvco <= 140000) 5562306a36Sopenharmony_ci p |= 0x08; 5662306a36Sopenharmony_ci else if (fvco <= 180000) 5762306a36Sopenharmony_ci p |= 0x10; 5862306a36Sopenharmony_ci else 5962306a36Sopenharmony_ci p |= 0x18; 6062306a36Sopenharmony_ci *post = p; 6162306a36Sopenharmony_ci} 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_ci/* they must be in POS order */ 6462306a36Sopenharmony_cistatic const unsigned char MGA1064_DAC_regs[] = { 6562306a36Sopenharmony_ci M1064_XCURADDL, M1064_XCURADDH, M1064_XCURCTRL, 6662306a36Sopenharmony_ci M1064_XCURCOL0RED, M1064_XCURCOL0GREEN, M1064_XCURCOL0BLUE, 6762306a36Sopenharmony_ci M1064_XCURCOL1RED, M1064_XCURCOL1GREEN, M1064_XCURCOL1BLUE, 6862306a36Sopenharmony_ci M1064_XCURCOL2RED, M1064_XCURCOL2GREEN, M1064_XCURCOL2BLUE, 6962306a36Sopenharmony_ci DAC1064_XVREFCTRL, M1064_XMULCTRL, M1064_XPIXCLKCTRL, M1064_XGENCTRL, 7062306a36Sopenharmony_ci M1064_XMISCCTRL, 7162306a36Sopenharmony_ci M1064_XGENIOCTRL, M1064_XGENIODATA, M1064_XZOOMCTRL, M1064_XSENSETEST, 7262306a36Sopenharmony_ci M1064_XCRCBITSEL, 7362306a36Sopenharmony_ci M1064_XCOLKEYMASKL, M1064_XCOLKEYMASKH, M1064_XCOLKEYL, M1064_XCOLKEYH }; 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_cistatic const unsigned char MGA1064_DAC[] = { 7662306a36Sopenharmony_ci 0x00, 0x00, M1064_XCURCTRL_DIS, 7762306a36Sopenharmony_ci 0x00, 0x00, 0x00, /* black */ 7862306a36Sopenharmony_ci 0xFF, 0xFF, 0xFF, /* white */ 7962306a36Sopenharmony_ci 0xFF, 0x00, 0x00, /* red */ 8062306a36Sopenharmony_ci 0x00, 0, 8162306a36Sopenharmony_ci M1064_XPIXCLKCTRL_PLL_UP | M1064_XPIXCLKCTRL_EN | M1064_XPIXCLKCTRL_SRC_PLL, 8262306a36Sopenharmony_ci M1064_XGENCTRL_VS_0 | M1064_XGENCTRL_ALPHA_DIS | M1064_XGENCTRL_BLACK_0IRE | M1064_XGENCTRL_NO_SYNC_ON_GREEN, 8362306a36Sopenharmony_ci M1064_XMISCCTRL_DAC_8BIT, 8462306a36Sopenharmony_ci 0x00, 0x00, M1064_XZOOMCTRL_1, M1064_XSENSETEST_BCOMP | M1064_XSENSETEST_GCOMP | M1064_XSENSETEST_RCOMP | M1064_XSENSETEST_PDOWN, 8562306a36Sopenharmony_ci 0x00, 8662306a36Sopenharmony_ci 0x00, 0x00, 0xFF, 0xFF}; 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_cistatic void DAC1064_setpclk(struct matrox_fb_info *minfo, unsigned long fout) 8962306a36Sopenharmony_ci{ 9062306a36Sopenharmony_ci unsigned int m, n, p; 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci DBG(__func__) 9362306a36Sopenharmony_ci 9462306a36Sopenharmony_ci DAC1064_calcclock(minfo, fout, minfo->max_pixel_clock, &m, &n, &p); 9562306a36Sopenharmony_ci minfo->hw.DACclk[0] = m; 9662306a36Sopenharmony_ci minfo->hw.DACclk[1] = n; 9762306a36Sopenharmony_ci minfo->hw.DACclk[2] = p; 9862306a36Sopenharmony_ci} 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_cistatic void DAC1064_setmclk(struct matrox_fb_info *minfo, int oscinfo, 10162306a36Sopenharmony_ci unsigned long fmem) 10262306a36Sopenharmony_ci{ 10362306a36Sopenharmony_ci u_int32_t mx; 10462306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci DBG(__func__) 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci if (minfo->devflags.noinit) { 10962306a36Sopenharmony_ci /* read MCLK and give up... */ 11062306a36Sopenharmony_ci hw->DACclk[3] = inDAC1064(minfo, DAC1064_XSYSPLLM); 11162306a36Sopenharmony_ci hw->DACclk[4] = inDAC1064(minfo, DAC1064_XSYSPLLN); 11262306a36Sopenharmony_ci hw->DACclk[5] = inDAC1064(minfo, DAC1064_XSYSPLLP); 11362306a36Sopenharmony_ci return; 11462306a36Sopenharmony_ci } 11562306a36Sopenharmony_ci mx = hw->MXoptionReg | 0x00000004; 11662306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, mx); 11762306a36Sopenharmony_ci mx &= ~0x000000BB; 11862306a36Sopenharmony_ci if (oscinfo & DAC1064_OPT_GDIV1) 11962306a36Sopenharmony_ci mx |= 0x00000008; 12062306a36Sopenharmony_ci if (oscinfo & DAC1064_OPT_MDIV1) 12162306a36Sopenharmony_ci mx |= 0x00000010; 12262306a36Sopenharmony_ci if (oscinfo & DAC1064_OPT_RESERVED) 12362306a36Sopenharmony_ci mx |= 0x00000080; 12462306a36Sopenharmony_ci if ((oscinfo & DAC1064_OPT_SCLK_MASK) == DAC1064_OPT_SCLK_PLL) { 12562306a36Sopenharmony_ci /* select PCI clock until we have setup oscilator... */ 12662306a36Sopenharmony_ci int clk; 12762306a36Sopenharmony_ci unsigned int m, n, p; 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_ci /* powerup system PLL, select PCI clock */ 13062306a36Sopenharmony_ci mx |= 0x00000020; 13162306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, mx); 13262306a36Sopenharmony_ci mx &= ~0x00000004; 13362306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, mx); 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_ci /* !!! you must not access device if MCLK is not running !!! 13662306a36Sopenharmony_ci Doing so cause immediate PCI lockup :-( Maybe they should 13762306a36Sopenharmony_ci generate ABORT or I/O (parity...) error and Linux should 13862306a36Sopenharmony_ci recover from this... (kill driver/process). But world is not 13962306a36Sopenharmony_ci perfect... */ 14062306a36Sopenharmony_ci /* (bit 2 of PCI_OPTION_REG must be 0... and bits 0,1 must not 14162306a36Sopenharmony_ci select PLL... because of PLL can be stopped at this time) */ 14262306a36Sopenharmony_ci DAC1064_calcclock(minfo, fmem, minfo->max_pixel_clock, &m, &n, &p); 14362306a36Sopenharmony_ci outDAC1064(minfo, DAC1064_XSYSPLLM, hw->DACclk[3] = m); 14462306a36Sopenharmony_ci outDAC1064(minfo, DAC1064_XSYSPLLN, hw->DACclk[4] = n); 14562306a36Sopenharmony_ci outDAC1064(minfo, DAC1064_XSYSPLLP, hw->DACclk[5] = p); 14662306a36Sopenharmony_ci for (clk = 65536; clk; --clk) { 14762306a36Sopenharmony_ci if (inDAC1064(minfo, DAC1064_XSYSPLLSTAT) & 0x40) 14862306a36Sopenharmony_ci break; 14962306a36Sopenharmony_ci } 15062306a36Sopenharmony_ci if (!clk) 15162306a36Sopenharmony_ci printk(KERN_ERR "matroxfb: aiee, SYSPLL not locked\n"); 15262306a36Sopenharmony_ci /* select PLL */ 15362306a36Sopenharmony_ci mx |= 0x00000005; 15462306a36Sopenharmony_ci } else { 15562306a36Sopenharmony_ci /* select specified system clock source */ 15662306a36Sopenharmony_ci mx |= oscinfo & DAC1064_OPT_SCLK_MASK; 15762306a36Sopenharmony_ci } 15862306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, mx); 15962306a36Sopenharmony_ci mx &= ~0x00000004; 16062306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, mx); 16162306a36Sopenharmony_ci hw->MXoptionReg = mx; 16262306a36Sopenharmony_ci} 16362306a36Sopenharmony_ci 16462306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 16562306a36Sopenharmony_cistatic void g450_set_plls(struct matrox_fb_info *minfo) 16662306a36Sopenharmony_ci{ 16762306a36Sopenharmony_ci u_int32_t c2_ctl; 16862306a36Sopenharmony_ci unsigned int pxc; 16962306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 17062306a36Sopenharmony_ci int pixelmnp; 17162306a36Sopenharmony_ci int videomnp; 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_ci c2_ctl = hw->crtc2.ctl & ~0x4007; /* Clear PLL + enable for CRTC2 */ 17462306a36Sopenharmony_ci c2_ctl |= 0x0001; /* Enable CRTC2 */ 17562306a36Sopenharmony_ci hw->DACreg[POS1064_XPWRCTRL] &= ~0x02; /* Stop VIDEO PLL */ 17662306a36Sopenharmony_ci pixelmnp = minfo->crtc1.mnp; 17762306a36Sopenharmony_ci videomnp = minfo->crtc2.mnp; 17862306a36Sopenharmony_ci if (videomnp < 0) { 17962306a36Sopenharmony_ci c2_ctl &= ~0x0001; /* Disable CRTC2 */ 18062306a36Sopenharmony_ci hw->DACreg[POS1064_XPWRCTRL] &= ~0x10; /* Powerdown CRTC2 */ 18162306a36Sopenharmony_ci } else if (minfo->crtc2.pixclock == minfo->features.pll.ref_freq) { 18262306a36Sopenharmony_ci c2_ctl |= 0x4002; /* Use reference directly */ 18362306a36Sopenharmony_ci } else if (videomnp == pixelmnp) { 18462306a36Sopenharmony_ci c2_ctl |= 0x0004; /* Use pixel PLL */ 18562306a36Sopenharmony_ci } else { 18662306a36Sopenharmony_ci if (0 == ((videomnp ^ pixelmnp) & 0xFFFFFF00)) { 18762306a36Sopenharmony_ci /* PIXEL and VIDEO PLL must not use same frequency. We modify N 18862306a36Sopenharmony_ci of PIXEL PLL in such case because of VIDEO PLL may be source 18962306a36Sopenharmony_ci of TVO clocks, and chroma subcarrier is derived from its 19062306a36Sopenharmony_ci pixel clocks */ 19162306a36Sopenharmony_ci pixelmnp += 0x000100; 19262306a36Sopenharmony_ci } 19362306a36Sopenharmony_ci c2_ctl |= 0x0006; /* Use video PLL */ 19462306a36Sopenharmony_ci hw->DACreg[POS1064_XPWRCTRL] |= 0x02; 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPWRCTRL, hw->DACreg[POS1064_XPWRCTRL]); 19762306a36Sopenharmony_ci matroxfb_g450_setpll_cond(minfo, videomnp, M_VIDEO_PLL); 19862306a36Sopenharmony_ci } 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ci hw->DACreg[POS1064_XPIXCLKCTRL] &= ~M1064_XPIXCLKCTRL_PLL_UP; 20162306a36Sopenharmony_ci if (pixelmnp >= 0) { 20262306a36Sopenharmony_ci hw->DACreg[POS1064_XPIXCLKCTRL] |= M1064_XPIXCLKCTRL_PLL_UP; 20362306a36Sopenharmony_ci 20462306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPIXCLKCTRL, hw->DACreg[POS1064_XPIXCLKCTRL]); 20562306a36Sopenharmony_ci matroxfb_g450_setpll_cond(minfo, pixelmnp, M_PIXEL_PLL_C); 20662306a36Sopenharmony_ci } 20762306a36Sopenharmony_ci if (c2_ctl != hw->crtc2.ctl) { 20862306a36Sopenharmony_ci hw->crtc2.ctl = c2_ctl; 20962306a36Sopenharmony_ci mga_outl(0x3C10, c2_ctl); 21062306a36Sopenharmony_ci } 21162306a36Sopenharmony_ci 21262306a36Sopenharmony_ci pxc = minfo->crtc1.pixclock; 21362306a36Sopenharmony_ci if (pxc == 0 || minfo->outputs[2].src == MATROXFB_SRC_CRTC2) { 21462306a36Sopenharmony_ci pxc = minfo->crtc2.pixclock; 21562306a36Sopenharmony_ci } 21662306a36Sopenharmony_ci if (minfo->chip == MGA_G550) { 21762306a36Sopenharmony_ci if (pxc < 45000) { 21862306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x00; /* 0-50 */ 21962306a36Sopenharmony_ci } else if (pxc < 55000) { 22062306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x08; /* 34-62 */ 22162306a36Sopenharmony_ci } else if (pxc < 70000) { 22262306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x10; /* 42-78 */ 22362306a36Sopenharmony_ci } else if (pxc < 85000) { 22462306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x18; /* 62-92 */ 22562306a36Sopenharmony_ci } else if (pxc < 100000) { 22662306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x20; /* 74-108 */ 22762306a36Sopenharmony_ci } else if (pxc < 115000) { 22862306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x28; /* 94-122 */ 22962306a36Sopenharmony_ci } else if (pxc < 125000) { 23062306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x30; /* 108-132 */ 23162306a36Sopenharmony_ci } else { 23262306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x38; /* 120-168 */ 23362306a36Sopenharmony_ci } 23462306a36Sopenharmony_ci } else { 23562306a36Sopenharmony_ci /* G450 */ 23662306a36Sopenharmony_ci if (pxc < 45000) { 23762306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x00; /* 0-54 */ 23862306a36Sopenharmony_ci } else if (pxc < 65000) { 23962306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x08; /* 38-70 */ 24062306a36Sopenharmony_ci } else if (pxc < 85000) { 24162306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x10; /* 56-96 */ 24262306a36Sopenharmony_ci } else if (pxc < 105000) { 24362306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x18; /* 80-114 */ 24462306a36Sopenharmony_ci } else if (pxc < 135000) { 24562306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x20; /* 102-144 */ 24662306a36Sopenharmony_ci } else if (pxc < 160000) { 24762306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x28; /* 132-166 */ 24862306a36Sopenharmony_ci } else if (pxc < 175000) { 24962306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x30; /* 154-182 */ 25062306a36Sopenharmony_ci } else { 25162306a36Sopenharmony_ci hw->DACreg[POS1064_XPANMODE] = 0x38; /* 170-204 */ 25262306a36Sopenharmony_ci } 25362306a36Sopenharmony_ci } 25462306a36Sopenharmony_ci} 25562306a36Sopenharmony_ci#endif 25662306a36Sopenharmony_ci 25762306a36Sopenharmony_civoid DAC1064_global_init(struct matrox_fb_info *minfo) 25862306a36Sopenharmony_ci{ 25962306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 26062306a36Sopenharmony_ci 26162306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] &= M1064_XMISCCTRL_DAC_WIDTHMASK; 26262306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] |= M1064_XMISCCTRL_LUT_EN; 26362306a36Sopenharmony_ci hw->DACreg[POS1064_XPIXCLKCTRL] = M1064_XPIXCLKCTRL_PLL_UP | M1064_XPIXCLKCTRL_EN | M1064_XPIXCLKCTRL_SRC_PLL; 26462306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 26562306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 26662306a36Sopenharmony_ci hw->DACreg[POS1064_XPWRCTRL] = 0x1F; /* powerup everything */ 26762306a36Sopenharmony_ci hw->DACreg[POS1064_XOUTPUTCONN] = 0x00; /* disable outputs */ 26862306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] |= M1064_XMISCCTRL_DAC_EN; 26962306a36Sopenharmony_ci switch (minfo->outputs[0].src) { 27062306a36Sopenharmony_ci case MATROXFB_SRC_CRTC1: 27162306a36Sopenharmony_ci case MATROXFB_SRC_CRTC2: 27262306a36Sopenharmony_ci hw->DACreg[POS1064_XOUTPUTCONN] |= 0x01; /* enable output; CRTC1/2 selection is in CRTC2 ctl */ 27362306a36Sopenharmony_ci break; 27462306a36Sopenharmony_ci case MATROXFB_SRC_NONE: 27562306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] &= ~M1064_XMISCCTRL_DAC_EN; 27662306a36Sopenharmony_ci break; 27762306a36Sopenharmony_ci } 27862306a36Sopenharmony_ci switch (minfo->outputs[1].src) { 27962306a36Sopenharmony_ci case MATROXFB_SRC_CRTC1: 28062306a36Sopenharmony_ci hw->DACreg[POS1064_XOUTPUTCONN] |= 0x04; 28162306a36Sopenharmony_ci break; 28262306a36Sopenharmony_ci case MATROXFB_SRC_CRTC2: 28362306a36Sopenharmony_ci if (minfo->outputs[1].mode == MATROXFB_OUTPUT_MODE_MONITOR) { 28462306a36Sopenharmony_ci hw->DACreg[POS1064_XOUTPUTCONN] |= 0x08; 28562306a36Sopenharmony_ci } else { 28662306a36Sopenharmony_ci hw->DACreg[POS1064_XOUTPUTCONN] |= 0x0C; 28762306a36Sopenharmony_ci } 28862306a36Sopenharmony_ci break; 28962306a36Sopenharmony_ci case MATROXFB_SRC_NONE: 29062306a36Sopenharmony_ci hw->DACreg[POS1064_XPWRCTRL] &= ~0x01; /* Poweroff DAC2 */ 29162306a36Sopenharmony_ci break; 29262306a36Sopenharmony_ci } 29362306a36Sopenharmony_ci switch (minfo->outputs[2].src) { 29462306a36Sopenharmony_ci case MATROXFB_SRC_CRTC1: 29562306a36Sopenharmony_ci hw->DACreg[POS1064_XOUTPUTCONN] |= 0x20; 29662306a36Sopenharmony_ci break; 29762306a36Sopenharmony_ci case MATROXFB_SRC_CRTC2: 29862306a36Sopenharmony_ci hw->DACreg[POS1064_XOUTPUTCONN] |= 0x40; 29962306a36Sopenharmony_ci break; 30062306a36Sopenharmony_ci case MATROXFB_SRC_NONE: 30162306a36Sopenharmony_ci#if 0 30262306a36Sopenharmony_ci /* HELP! If we boot without DFP connected to DVI, we can 30362306a36Sopenharmony_ci poweroff TMDS. But if we boot with DFP connected, 30462306a36Sopenharmony_ci TMDS generated clocks are used instead of ALL pixclocks 30562306a36Sopenharmony_ci available... If someone knows which register 30662306a36Sopenharmony_ci handles it, please reveal this secret to me... */ 30762306a36Sopenharmony_ci hw->DACreg[POS1064_XPWRCTRL] &= ~0x04; /* Poweroff TMDS */ 30862306a36Sopenharmony_ci#endif 30962306a36Sopenharmony_ci break; 31062306a36Sopenharmony_ci } 31162306a36Sopenharmony_ci /* Now set timming related variables... */ 31262306a36Sopenharmony_ci g450_set_plls(minfo); 31362306a36Sopenharmony_ci } else 31462306a36Sopenharmony_ci#endif 31562306a36Sopenharmony_ci { 31662306a36Sopenharmony_ci if (minfo->outputs[1].src == MATROXFB_SRC_CRTC1) { 31762306a36Sopenharmony_ci hw->DACreg[POS1064_XPIXCLKCTRL] = M1064_XPIXCLKCTRL_PLL_UP | M1064_XPIXCLKCTRL_EN | M1064_XPIXCLKCTRL_SRC_EXT; 31862306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] |= GX00_XMISCCTRL_MFC_MAFC | G400_XMISCCTRL_VDO_MAFC12; 31962306a36Sopenharmony_ci } else if (minfo->outputs[1].src == MATROXFB_SRC_CRTC2) { 32062306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] |= GX00_XMISCCTRL_MFC_MAFC | G400_XMISCCTRL_VDO_C2_MAFC12; 32162306a36Sopenharmony_ci } else if (minfo->outputs[2].src == MATROXFB_SRC_CRTC1) 32262306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] |= GX00_XMISCCTRL_MFC_PANELLINK | G400_XMISCCTRL_VDO_MAFC12; 32362306a36Sopenharmony_ci else 32462306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] |= GX00_XMISCCTRL_MFC_DIS; 32562306a36Sopenharmony_ci 32662306a36Sopenharmony_ci if (minfo->outputs[0].src != MATROXFB_SRC_NONE) 32762306a36Sopenharmony_ci hw->DACreg[POS1064_XMISCCTRL] |= M1064_XMISCCTRL_DAC_EN; 32862306a36Sopenharmony_ci } 32962306a36Sopenharmony_ci} 33062306a36Sopenharmony_ci 33162306a36Sopenharmony_civoid DAC1064_global_restore(struct matrox_fb_info *minfo) 33262306a36Sopenharmony_ci{ 33362306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPIXCLKCTRL, hw->DACreg[POS1064_XPIXCLKCTRL]); 33662306a36Sopenharmony_ci outDAC1064(minfo, M1064_XMISCCTRL, hw->DACreg[POS1064_XMISCCTRL]); 33762306a36Sopenharmony_ci if (minfo->devflags.accelerator == FB_ACCEL_MATROX_MGAG400) { 33862306a36Sopenharmony_ci outDAC1064(minfo, 0x20, 0x04); 33962306a36Sopenharmony_ci outDAC1064(minfo, 0x1F, minfo->devflags.dfp_type); 34062306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 34162306a36Sopenharmony_ci outDAC1064(minfo, M1064_XSYNCCTRL, 0xCC); 34262306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPWRCTRL, hw->DACreg[POS1064_XPWRCTRL]); 34362306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPANMODE, hw->DACreg[POS1064_XPANMODE]); 34462306a36Sopenharmony_ci outDAC1064(minfo, M1064_XOUTPUTCONN, hw->DACreg[POS1064_XOUTPUTCONN]); 34562306a36Sopenharmony_ci } 34662306a36Sopenharmony_ci } 34762306a36Sopenharmony_ci} 34862306a36Sopenharmony_ci 34962306a36Sopenharmony_cistatic int DAC1064_init_1(struct matrox_fb_info *minfo, struct my_timming *m) 35062306a36Sopenharmony_ci{ 35162306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 35262306a36Sopenharmony_ci 35362306a36Sopenharmony_ci DBG(__func__) 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci memcpy(hw->DACreg, MGA1064_DAC, sizeof(MGA1064_DAC_regs)); 35662306a36Sopenharmony_ci switch (minfo->fbcon.var.bits_per_pixel) { 35762306a36Sopenharmony_ci /* case 4: not supported by MGA1064 DAC */ 35862306a36Sopenharmony_ci case 8: 35962306a36Sopenharmony_ci hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_8BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED; 36062306a36Sopenharmony_ci break; 36162306a36Sopenharmony_ci case 16: 36262306a36Sopenharmony_ci if (minfo->fbcon.var.green.length == 5) 36362306a36Sopenharmony_ci hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_15BPP_1BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED; 36462306a36Sopenharmony_ci else 36562306a36Sopenharmony_ci hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_16BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED; 36662306a36Sopenharmony_ci break; 36762306a36Sopenharmony_ci case 24: 36862306a36Sopenharmony_ci hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_24BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED; 36962306a36Sopenharmony_ci break; 37062306a36Sopenharmony_ci case 32: 37162306a36Sopenharmony_ci hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_32BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED; 37262306a36Sopenharmony_ci break; 37362306a36Sopenharmony_ci default: 37462306a36Sopenharmony_ci return 1; /* unsupported depth */ 37562306a36Sopenharmony_ci } 37662306a36Sopenharmony_ci hw->DACreg[POS1064_XVREFCTRL] = minfo->features.DAC1064.xvrefctrl; 37762306a36Sopenharmony_ci hw->DACreg[POS1064_XGENCTRL] &= ~M1064_XGENCTRL_SYNC_ON_GREEN_MASK; 37862306a36Sopenharmony_ci hw->DACreg[POS1064_XGENCTRL] |= (m->sync & FB_SYNC_ON_GREEN)?M1064_XGENCTRL_SYNC_ON_GREEN:M1064_XGENCTRL_NO_SYNC_ON_GREEN; 37962306a36Sopenharmony_ci hw->DACreg[POS1064_XCURADDL] = 0; 38062306a36Sopenharmony_ci hw->DACreg[POS1064_XCURADDH] = 0; 38162306a36Sopenharmony_ci 38262306a36Sopenharmony_ci DAC1064_global_init(minfo); 38362306a36Sopenharmony_ci return 0; 38462306a36Sopenharmony_ci} 38562306a36Sopenharmony_ci 38662306a36Sopenharmony_cistatic int DAC1064_init_2(struct matrox_fb_info *minfo, struct my_timming *m) 38762306a36Sopenharmony_ci{ 38862306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 38962306a36Sopenharmony_ci 39062306a36Sopenharmony_ci DBG(__func__) 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci if (minfo->fbcon.var.bits_per_pixel > 16) { /* 256 entries */ 39362306a36Sopenharmony_ci int i; 39462306a36Sopenharmony_ci 39562306a36Sopenharmony_ci for (i = 0; i < 256; i++) { 39662306a36Sopenharmony_ci hw->DACpal[i * 3 + 0] = i; 39762306a36Sopenharmony_ci hw->DACpal[i * 3 + 1] = i; 39862306a36Sopenharmony_ci hw->DACpal[i * 3 + 2] = i; 39962306a36Sopenharmony_ci } 40062306a36Sopenharmony_ci } else if (minfo->fbcon.var.bits_per_pixel > 8) { 40162306a36Sopenharmony_ci if (minfo->fbcon.var.green.length == 5) { /* 0..31, 128..159 */ 40262306a36Sopenharmony_ci int i; 40362306a36Sopenharmony_ci 40462306a36Sopenharmony_ci for (i = 0; i < 32; i++) { 40562306a36Sopenharmony_ci /* with p15 == 0 */ 40662306a36Sopenharmony_ci hw->DACpal[i * 3 + 0] = i << 3; 40762306a36Sopenharmony_ci hw->DACpal[i * 3 + 1] = i << 3; 40862306a36Sopenharmony_ci hw->DACpal[i * 3 + 2] = i << 3; 40962306a36Sopenharmony_ci /* with p15 == 1 */ 41062306a36Sopenharmony_ci hw->DACpal[(i + 128) * 3 + 0] = i << 3; 41162306a36Sopenharmony_ci hw->DACpal[(i + 128) * 3 + 1] = i << 3; 41262306a36Sopenharmony_ci hw->DACpal[(i + 128) * 3 + 2] = i << 3; 41362306a36Sopenharmony_ci } 41462306a36Sopenharmony_ci } else { 41562306a36Sopenharmony_ci int i; 41662306a36Sopenharmony_ci 41762306a36Sopenharmony_ci for (i = 0; i < 64; i++) { /* 0..63 */ 41862306a36Sopenharmony_ci hw->DACpal[i * 3 + 0] = i << 3; 41962306a36Sopenharmony_ci hw->DACpal[i * 3 + 1] = i << 2; 42062306a36Sopenharmony_ci hw->DACpal[i * 3 + 2] = i << 3; 42162306a36Sopenharmony_ci } 42262306a36Sopenharmony_ci } 42362306a36Sopenharmony_ci } else { 42462306a36Sopenharmony_ci memset(hw->DACpal, 0, 768); 42562306a36Sopenharmony_ci } 42662306a36Sopenharmony_ci return 0; 42762306a36Sopenharmony_ci} 42862306a36Sopenharmony_ci 42962306a36Sopenharmony_cistatic void DAC1064_restore_1(struct matrox_fb_info *minfo) 43062306a36Sopenharmony_ci{ 43162306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 43262306a36Sopenharmony_ci 43362306a36Sopenharmony_ci CRITFLAGS 43462306a36Sopenharmony_ci 43562306a36Sopenharmony_ci DBG(__func__) 43662306a36Sopenharmony_ci 43762306a36Sopenharmony_ci CRITBEGIN 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_ci if ((inDAC1064(minfo, DAC1064_XSYSPLLM) != hw->DACclk[3]) || 44062306a36Sopenharmony_ci (inDAC1064(minfo, DAC1064_XSYSPLLN) != hw->DACclk[4]) || 44162306a36Sopenharmony_ci (inDAC1064(minfo, DAC1064_XSYSPLLP) != hw->DACclk[5])) { 44262306a36Sopenharmony_ci outDAC1064(minfo, DAC1064_XSYSPLLM, hw->DACclk[3]); 44362306a36Sopenharmony_ci outDAC1064(minfo, DAC1064_XSYSPLLN, hw->DACclk[4]); 44462306a36Sopenharmony_ci outDAC1064(minfo, DAC1064_XSYSPLLP, hw->DACclk[5]); 44562306a36Sopenharmony_ci } 44662306a36Sopenharmony_ci { 44762306a36Sopenharmony_ci unsigned int i; 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_ci for (i = 0; i < sizeof(MGA1064_DAC_regs); i++) { 45062306a36Sopenharmony_ci if ((i != POS1064_XPIXCLKCTRL) && (i != POS1064_XMISCCTRL)) 45162306a36Sopenharmony_ci outDAC1064(minfo, MGA1064_DAC_regs[i], hw->DACreg[i]); 45262306a36Sopenharmony_ci } 45362306a36Sopenharmony_ci } 45462306a36Sopenharmony_ci 45562306a36Sopenharmony_ci DAC1064_global_restore(minfo); 45662306a36Sopenharmony_ci 45762306a36Sopenharmony_ci CRITEND 45862306a36Sopenharmony_ci}; 45962306a36Sopenharmony_ci 46062306a36Sopenharmony_cistatic void DAC1064_restore_2(struct matrox_fb_info *minfo) 46162306a36Sopenharmony_ci{ 46262306a36Sopenharmony_ci#ifdef DEBUG 46362306a36Sopenharmony_ci unsigned int i; 46462306a36Sopenharmony_ci#endif 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_ci DBG(__func__) 46762306a36Sopenharmony_ci 46862306a36Sopenharmony_ci#ifdef DEBUG 46962306a36Sopenharmony_ci dprintk(KERN_DEBUG "DAC1064regs "); 47062306a36Sopenharmony_ci for (i = 0; i < sizeof(MGA1064_DAC_regs); i++) { 47162306a36Sopenharmony_ci dprintk("R%02X=%02X ", MGA1064_DAC_regs[i], minfo->hw.DACreg[i]); 47262306a36Sopenharmony_ci if ((i & 0x7) == 0x7) dprintk(KERN_DEBUG "continuing... "); 47362306a36Sopenharmony_ci } 47462306a36Sopenharmony_ci dprintk(KERN_DEBUG "DAC1064clk "); 47562306a36Sopenharmony_ci for (i = 0; i < 6; i++) 47662306a36Sopenharmony_ci dprintk("C%02X=%02X ", i, minfo->hw.DACclk[i]); 47762306a36Sopenharmony_ci dprintk("\n"); 47862306a36Sopenharmony_ci#endif 47962306a36Sopenharmony_ci} 48062306a36Sopenharmony_ci 48162306a36Sopenharmony_cistatic int m1064_compute(void* out, struct my_timming* m) { 48262306a36Sopenharmony_ci#define minfo ((struct matrox_fb_info*)out) 48362306a36Sopenharmony_ci { 48462306a36Sopenharmony_ci int i; 48562306a36Sopenharmony_ci int tmout; 48662306a36Sopenharmony_ci CRITFLAGS 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci DAC1064_setpclk(minfo, m->pixclock); 48962306a36Sopenharmony_ci 49062306a36Sopenharmony_ci CRITBEGIN 49162306a36Sopenharmony_ci 49262306a36Sopenharmony_ci for (i = 0; i < 3; i++) 49362306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPIXPLLCM + i, minfo->hw.DACclk[i]); 49462306a36Sopenharmony_ci for (tmout = 500000; tmout; tmout--) { 49562306a36Sopenharmony_ci if (inDAC1064(minfo, M1064_XPIXPLLSTAT) & 0x40) 49662306a36Sopenharmony_ci break; 49762306a36Sopenharmony_ci udelay(10); 49862306a36Sopenharmony_ci } 49962306a36Sopenharmony_ci 50062306a36Sopenharmony_ci CRITEND 50162306a36Sopenharmony_ci 50262306a36Sopenharmony_ci if (!tmout) 50362306a36Sopenharmony_ci printk(KERN_ERR "matroxfb: Pixel PLL not locked after 5 secs\n"); 50462306a36Sopenharmony_ci } 50562306a36Sopenharmony_ci#undef minfo 50662306a36Sopenharmony_ci return 0; 50762306a36Sopenharmony_ci} 50862306a36Sopenharmony_ci 50962306a36Sopenharmony_cistatic struct matrox_altout m1064 = { 51062306a36Sopenharmony_ci .name = "Primary output", 51162306a36Sopenharmony_ci .compute = m1064_compute, 51262306a36Sopenharmony_ci}; 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 51562306a36Sopenharmony_cistatic int g450_compute(void* out, struct my_timming* m) { 51662306a36Sopenharmony_ci#define minfo ((struct matrox_fb_info*)out) 51762306a36Sopenharmony_ci if (m->mnp < 0) { 51862306a36Sopenharmony_ci m->mnp = matroxfb_g450_setclk(minfo, m->pixclock, (m->crtc == MATROXFB_SRC_CRTC1) ? M_PIXEL_PLL_C : M_VIDEO_PLL); 51962306a36Sopenharmony_ci if (m->mnp >= 0) { 52062306a36Sopenharmony_ci m->pixclock = g450_mnp2f(minfo, m->mnp); 52162306a36Sopenharmony_ci } 52262306a36Sopenharmony_ci } 52362306a36Sopenharmony_ci#undef minfo 52462306a36Sopenharmony_ci return 0; 52562306a36Sopenharmony_ci} 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_cistatic struct matrox_altout g450out = { 52862306a36Sopenharmony_ci .name = "Primary output", 52962306a36Sopenharmony_ci .compute = g450_compute, 53062306a36Sopenharmony_ci}; 53162306a36Sopenharmony_ci#endif 53262306a36Sopenharmony_ci 53362306a36Sopenharmony_ci#endif /* NEED_DAC1064 */ 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_MYSTIQUE 53662306a36Sopenharmony_cistatic int MGA1064_init(struct matrox_fb_info *minfo, struct my_timming *m) 53762306a36Sopenharmony_ci{ 53862306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_ci DBG(__func__) 54162306a36Sopenharmony_ci 54262306a36Sopenharmony_ci if (DAC1064_init_1(minfo, m)) return 1; 54362306a36Sopenharmony_ci if (matroxfb_vgaHWinit(minfo, m)) return 1; 54462306a36Sopenharmony_ci 54562306a36Sopenharmony_ci hw->MiscOutReg = 0xCB; 54662306a36Sopenharmony_ci if (m->sync & FB_SYNC_HOR_HIGH_ACT) 54762306a36Sopenharmony_ci hw->MiscOutReg &= ~0x40; 54862306a36Sopenharmony_ci if (m->sync & FB_SYNC_VERT_HIGH_ACT) 54962306a36Sopenharmony_ci hw->MiscOutReg &= ~0x80; 55062306a36Sopenharmony_ci if (m->sync & FB_SYNC_COMP_HIGH_ACT) /* should be only FB_SYNC_COMP */ 55162306a36Sopenharmony_ci hw->CRTCEXT[3] |= 0x40; 55262306a36Sopenharmony_ci 55362306a36Sopenharmony_ci if (DAC1064_init_2(minfo, m)) return 1; 55462306a36Sopenharmony_ci return 0; 55562306a36Sopenharmony_ci} 55662306a36Sopenharmony_ci#endif 55762306a36Sopenharmony_ci 55862306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 55962306a36Sopenharmony_cistatic int MGAG100_init(struct matrox_fb_info *minfo, struct my_timming *m) 56062306a36Sopenharmony_ci{ 56162306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 56262306a36Sopenharmony_ci 56362306a36Sopenharmony_ci DBG(__func__) 56462306a36Sopenharmony_ci 56562306a36Sopenharmony_ci if (DAC1064_init_1(minfo, m)) return 1; 56662306a36Sopenharmony_ci hw->MXoptionReg &= ~0x2000; 56762306a36Sopenharmony_ci if (matroxfb_vgaHWinit(minfo, m)) return 1; 56862306a36Sopenharmony_ci 56962306a36Sopenharmony_ci hw->MiscOutReg = 0xEF; 57062306a36Sopenharmony_ci if (m->sync & FB_SYNC_HOR_HIGH_ACT) 57162306a36Sopenharmony_ci hw->MiscOutReg &= ~0x40; 57262306a36Sopenharmony_ci if (m->sync & FB_SYNC_VERT_HIGH_ACT) 57362306a36Sopenharmony_ci hw->MiscOutReg &= ~0x80; 57462306a36Sopenharmony_ci if (m->sync & FB_SYNC_COMP_HIGH_ACT) /* should be only FB_SYNC_COMP */ 57562306a36Sopenharmony_ci hw->CRTCEXT[3] |= 0x40; 57662306a36Sopenharmony_ci 57762306a36Sopenharmony_ci if (DAC1064_init_2(minfo, m)) return 1; 57862306a36Sopenharmony_ci return 0; 57962306a36Sopenharmony_ci} 58062306a36Sopenharmony_ci#endif /* G */ 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_MYSTIQUE 58362306a36Sopenharmony_cistatic void MGA1064_ramdac_init(struct matrox_fb_info *minfo) 58462306a36Sopenharmony_ci{ 58562306a36Sopenharmony_ci 58662306a36Sopenharmony_ci DBG(__func__) 58762306a36Sopenharmony_ci 58862306a36Sopenharmony_ci /* minfo->features.DAC1064.vco_freq_min = 120000; */ 58962306a36Sopenharmony_ci minfo->features.pll.vco_freq_min = 62000; 59062306a36Sopenharmony_ci minfo->features.pll.ref_freq = 14318; 59162306a36Sopenharmony_ci minfo->features.pll.feed_div_min = 100; 59262306a36Sopenharmony_ci minfo->features.pll.feed_div_max = 127; 59362306a36Sopenharmony_ci minfo->features.pll.in_div_min = 1; 59462306a36Sopenharmony_ci minfo->features.pll.in_div_max = 31; 59562306a36Sopenharmony_ci minfo->features.pll.post_shift_max = 3; 59662306a36Sopenharmony_ci minfo->features.DAC1064.xvrefctrl = DAC1064_XVREFCTRL_EXTERNAL; 59762306a36Sopenharmony_ci /* maybe cmdline MCLK= ?, doc says gclk=44MHz, mclk=66MHz... it was 55/83 with old values */ 59862306a36Sopenharmony_ci DAC1064_setmclk(minfo, DAC1064_OPT_MDIV2 | DAC1064_OPT_GDIV3 | DAC1064_OPT_SCLK_PLL, 133333); 59962306a36Sopenharmony_ci} 60062306a36Sopenharmony_ci#endif 60162306a36Sopenharmony_ci 60262306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 60362306a36Sopenharmony_ci/* BIOS environ */ 60462306a36Sopenharmony_cistatic int x7AF4 = 0x10; /* flags, maybe 0x10 = SDRAM, 0x00 = SGRAM??? */ 60562306a36Sopenharmony_ci /* G100 wants 0x10, G200 SGRAM does not care... */ 60662306a36Sopenharmony_ci#if 0 60762306a36Sopenharmony_cistatic int def50 = 0; /* reg50, & 0x0F, & 0x3000 (only 0x0000, 0x1000, 0x2000 (0x3000 disallowed and treated as 0) */ 60862306a36Sopenharmony_ci#endif 60962306a36Sopenharmony_ci 61062306a36Sopenharmony_cistatic void MGAG100_progPixClock(const struct matrox_fb_info *minfo, int flags, 61162306a36Sopenharmony_ci int m, int n, int p) 61262306a36Sopenharmony_ci{ 61362306a36Sopenharmony_ci int reg; 61462306a36Sopenharmony_ci int selClk; 61562306a36Sopenharmony_ci int clk; 61662306a36Sopenharmony_ci 61762306a36Sopenharmony_ci DBG(__func__) 61862306a36Sopenharmony_ci 61962306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPIXCLKCTRL, inDAC1064(minfo, M1064_XPIXCLKCTRL) | M1064_XPIXCLKCTRL_DIS | 62062306a36Sopenharmony_ci M1064_XPIXCLKCTRL_PLL_UP); 62162306a36Sopenharmony_ci switch (flags & 3) { 62262306a36Sopenharmony_ci case 0: reg = M1064_XPIXPLLAM; break; 62362306a36Sopenharmony_ci case 1: reg = M1064_XPIXPLLBM; break; 62462306a36Sopenharmony_ci default: reg = M1064_XPIXPLLCM; break; 62562306a36Sopenharmony_ci } 62662306a36Sopenharmony_ci outDAC1064(minfo, reg++, m); 62762306a36Sopenharmony_ci outDAC1064(minfo, reg++, n); 62862306a36Sopenharmony_ci outDAC1064(minfo, reg, p); 62962306a36Sopenharmony_ci selClk = mga_inb(M_MISC_REG_READ) & ~0xC; 63062306a36Sopenharmony_ci /* there should be flags & 0x03 & case 0/1/else */ 63162306a36Sopenharmony_ci /* and we should first select source and after that we should wait for PLL */ 63262306a36Sopenharmony_ci /* and we are waiting for PLL with oscilator disabled... Is it right? */ 63362306a36Sopenharmony_ci switch (flags & 0x03) { 63462306a36Sopenharmony_ci case 0x00: break; 63562306a36Sopenharmony_ci case 0x01: selClk |= 4; break; 63662306a36Sopenharmony_ci default: selClk |= 0x0C; break; 63762306a36Sopenharmony_ci } 63862306a36Sopenharmony_ci mga_outb(M_MISC_REG, selClk); 63962306a36Sopenharmony_ci for (clk = 500000; clk; clk--) { 64062306a36Sopenharmony_ci if (inDAC1064(minfo, M1064_XPIXPLLSTAT) & 0x40) 64162306a36Sopenharmony_ci break; 64262306a36Sopenharmony_ci udelay(10); 64362306a36Sopenharmony_ci } 64462306a36Sopenharmony_ci if (!clk) 64562306a36Sopenharmony_ci printk(KERN_ERR "matroxfb: Pixel PLL%c not locked after usual time\n", (reg-M1064_XPIXPLLAM-2)/4 + 'A'); 64662306a36Sopenharmony_ci selClk = inDAC1064(minfo, M1064_XPIXCLKCTRL) & ~M1064_XPIXCLKCTRL_SRC_MASK; 64762306a36Sopenharmony_ci switch (flags & 0x0C) { 64862306a36Sopenharmony_ci case 0x00: selClk |= M1064_XPIXCLKCTRL_SRC_PCI; break; 64962306a36Sopenharmony_ci case 0x04: selClk |= M1064_XPIXCLKCTRL_SRC_PLL; break; 65062306a36Sopenharmony_ci default: selClk |= M1064_XPIXCLKCTRL_SRC_EXT; break; 65162306a36Sopenharmony_ci } 65262306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPIXCLKCTRL, selClk); 65362306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPIXCLKCTRL, inDAC1064(minfo, M1064_XPIXCLKCTRL) & ~M1064_XPIXCLKCTRL_DIS); 65462306a36Sopenharmony_ci} 65562306a36Sopenharmony_ci 65662306a36Sopenharmony_cistatic void MGAG100_setPixClock(const struct matrox_fb_info *minfo, int flags, 65762306a36Sopenharmony_ci int freq) 65862306a36Sopenharmony_ci{ 65962306a36Sopenharmony_ci unsigned int m, n, p; 66062306a36Sopenharmony_ci 66162306a36Sopenharmony_ci DBG(__func__) 66262306a36Sopenharmony_ci 66362306a36Sopenharmony_ci DAC1064_calcclock(minfo, freq, minfo->max_pixel_clock, &m, &n, &p); 66462306a36Sopenharmony_ci MGAG100_progPixClock(minfo, flags, m, n, p); 66562306a36Sopenharmony_ci} 66662306a36Sopenharmony_ci#endif 66762306a36Sopenharmony_ci 66862306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_MYSTIQUE 66962306a36Sopenharmony_cistatic int MGA1064_preinit(struct matrox_fb_info *minfo) 67062306a36Sopenharmony_ci{ 67162306a36Sopenharmony_ci static const int vxres_mystique[] = { 512, 640, 768, 800, 832, 960, 67262306a36Sopenharmony_ci 1024, 1152, 1280, 1600, 1664, 1920, 67362306a36Sopenharmony_ci 2048, 0}; 67462306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_ci DBG(__func__) 67762306a36Sopenharmony_ci 67862306a36Sopenharmony_ci /* minfo->capable.cfb4 = 0; ... preinitialized by 0 */ 67962306a36Sopenharmony_ci minfo->capable.text = 1; 68062306a36Sopenharmony_ci minfo->capable.vxres = vxres_mystique; 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci minfo->outputs[0].output = &m1064; 68362306a36Sopenharmony_ci minfo->outputs[0].src = minfo->outputs[0].default_src; 68462306a36Sopenharmony_ci minfo->outputs[0].data = minfo; 68562306a36Sopenharmony_ci minfo->outputs[0].mode = MATROXFB_OUTPUT_MODE_MONITOR; 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci if (minfo->devflags.noinit) 68862306a36Sopenharmony_ci return 0; /* do not modify settings */ 68962306a36Sopenharmony_ci hw->MXoptionReg &= 0xC0000100; 69062306a36Sopenharmony_ci hw->MXoptionReg |= 0x00094E20; 69162306a36Sopenharmony_ci if (minfo->devflags.novga) 69262306a36Sopenharmony_ci hw->MXoptionReg &= ~0x00000100; 69362306a36Sopenharmony_ci if (minfo->devflags.nobios) 69462306a36Sopenharmony_ci hw->MXoptionReg &= ~0x40000000; 69562306a36Sopenharmony_ci if (minfo->devflags.nopciretry) 69662306a36Sopenharmony_ci hw->MXoptionReg |= 0x20000000; 69762306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, hw->MXoptionReg); 69862306a36Sopenharmony_ci mga_setr(M_SEQ_INDEX, 0x01, 0x20); 69962306a36Sopenharmony_ci mga_outl(M_CTLWTST, 0x00000000); 70062306a36Sopenharmony_ci udelay(200); 70162306a36Sopenharmony_ci mga_outl(M_MACCESS, 0x00008000); 70262306a36Sopenharmony_ci udelay(100); 70362306a36Sopenharmony_ci mga_outl(M_MACCESS, 0x0000C000); 70462306a36Sopenharmony_ci return 0; 70562306a36Sopenharmony_ci} 70662306a36Sopenharmony_ci 70762306a36Sopenharmony_cistatic void MGA1064_reset(struct matrox_fb_info *minfo) 70862306a36Sopenharmony_ci{ 70962306a36Sopenharmony_ci 71062306a36Sopenharmony_ci DBG(__func__); 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_ci MGA1064_ramdac_init(minfo); 71362306a36Sopenharmony_ci} 71462306a36Sopenharmony_ci#endif 71562306a36Sopenharmony_ci 71662306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 71762306a36Sopenharmony_cistatic void g450_mclk_init(struct matrox_fb_info *minfo) 71862306a36Sopenharmony_ci{ 71962306a36Sopenharmony_ci /* switch all clocks to PCI source */ 72062306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg | 4); 72162306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION3_REG, minfo->values.reg.opt3 & ~0x00300C03); 72262306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg); 72362306a36Sopenharmony_ci 72462306a36Sopenharmony_ci if (((minfo->values.reg.opt3 & 0x000003) == 0x000003) || 72562306a36Sopenharmony_ci ((minfo->values.reg.opt3 & 0x000C00) == 0x000C00) || 72662306a36Sopenharmony_ci ((minfo->values.reg.opt3 & 0x300000) == 0x300000)) { 72762306a36Sopenharmony_ci matroxfb_g450_setclk(minfo, minfo->values.pll.video, M_VIDEO_PLL); 72862306a36Sopenharmony_ci } else { 72962306a36Sopenharmony_ci unsigned long flags; 73062306a36Sopenharmony_ci unsigned int pwr; 73162306a36Sopenharmony_ci 73262306a36Sopenharmony_ci matroxfb_DAC_lock_irqsave(flags); 73362306a36Sopenharmony_ci pwr = inDAC1064(minfo, M1064_XPWRCTRL) & ~0x02; 73462306a36Sopenharmony_ci outDAC1064(minfo, M1064_XPWRCTRL, pwr); 73562306a36Sopenharmony_ci matroxfb_DAC_unlock_irqrestore(flags); 73662306a36Sopenharmony_ci } 73762306a36Sopenharmony_ci matroxfb_g450_setclk(minfo, minfo->values.pll.system, M_SYSTEM_PLL); 73862306a36Sopenharmony_ci 73962306a36Sopenharmony_ci /* switch clocks to their real PLL source(s) */ 74062306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg | 4); 74162306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION3_REG, minfo->values.reg.opt3); 74262306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg); 74362306a36Sopenharmony_ci 74462306a36Sopenharmony_ci} 74562306a36Sopenharmony_ci 74662306a36Sopenharmony_cistatic void g450_memory_init(struct matrox_fb_info *minfo) 74762306a36Sopenharmony_ci{ 74862306a36Sopenharmony_ci /* disable memory refresh */ 74962306a36Sopenharmony_ci minfo->hw.MXoptionReg &= ~0x001F8000; 75062306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg); 75162306a36Sopenharmony_ci 75262306a36Sopenharmony_ci /* set memory interface parameters */ 75362306a36Sopenharmony_ci minfo->hw.MXoptionReg &= ~0x00207E00; 75462306a36Sopenharmony_ci minfo->hw.MXoptionReg |= 0x00207E00 & minfo->values.reg.opt; 75562306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg); 75662306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION2_REG, minfo->values.reg.opt2); 75762306a36Sopenharmony_ci 75862306a36Sopenharmony_ci mga_outl(M_CTLWTST, minfo->values.reg.mctlwtst); 75962306a36Sopenharmony_ci 76062306a36Sopenharmony_ci /* first set up memory interface with disabled memory interface clocks */ 76162306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_MEMMISC_REG, minfo->values.reg.memmisc & ~0x80000000U); 76262306a36Sopenharmony_ci mga_outl(M_MEMRDBK, minfo->values.reg.memrdbk); 76362306a36Sopenharmony_ci mga_outl(M_MACCESS, minfo->values.reg.maccess); 76462306a36Sopenharmony_ci /* start memory clocks */ 76562306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_MEMMISC_REG, minfo->values.reg.memmisc | 0x80000000U); 76662306a36Sopenharmony_ci 76762306a36Sopenharmony_ci udelay(200); 76862306a36Sopenharmony_ci 76962306a36Sopenharmony_ci if (minfo->values.memory.ddr && (!minfo->values.memory.emrswen || !minfo->values.memory.dll)) { 77062306a36Sopenharmony_ci mga_outl(M_MEMRDBK, minfo->values.reg.memrdbk & ~0x1000); 77162306a36Sopenharmony_ci } 77262306a36Sopenharmony_ci mga_outl(M_MACCESS, minfo->values.reg.maccess | 0x8000); 77362306a36Sopenharmony_ci 77462306a36Sopenharmony_ci udelay(200); 77562306a36Sopenharmony_ci 77662306a36Sopenharmony_ci minfo->hw.MXoptionReg |= 0x001F8000 & minfo->values.reg.opt; 77762306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg); 77862306a36Sopenharmony_ci 77962306a36Sopenharmony_ci /* value is written to memory chips only if old != new */ 78062306a36Sopenharmony_ci mga_outl(M_PLNWT, 0); 78162306a36Sopenharmony_ci mga_outl(M_PLNWT, ~0); 78262306a36Sopenharmony_ci 78362306a36Sopenharmony_ci if (minfo->values.reg.mctlwtst != minfo->values.reg.mctlwtst_core) { 78462306a36Sopenharmony_ci mga_outl(M_CTLWTST, minfo->values.reg.mctlwtst_core); 78562306a36Sopenharmony_ci } 78662306a36Sopenharmony_ci 78762306a36Sopenharmony_ci} 78862306a36Sopenharmony_ci 78962306a36Sopenharmony_cistatic void g450_preinit(struct matrox_fb_info *minfo) 79062306a36Sopenharmony_ci{ 79162306a36Sopenharmony_ci u_int32_t c2ctl; 79262306a36Sopenharmony_ci u_int8_t curctl; 79362306a36Sopenharmony_ci u_int8_t c1ctl; 79462306a36Sopenharmony_ci 79562306a36Sopenharmony_ci /* minfo->hw.MXoptionReg = minfo->values.reg.opt; */ 79662306a36Sopenharmony_ci minfo->hw.MXoptionReg &= 0xC0000100; 79762306a36Sopenharmony_ci minfo->hw.MXoptionReg |= 0x00000020; 79862306a36Sopenharmony_ci if (minfo->devflags.novga) 79962306a36Sopenharmony_ci minfo->hw.MXoptionReg &= ~0x00000100; 80062306a36Sopenharmony_ci if (minfo->devflags.nobios) 80162306a36Sopenharmony_ci minfo->hw.MXoptionReg &= ~0x40000000; 80262306a36Sopenharmony_ci if (minfo->devflags.nopciretry) 80362306a36Sopenharmony_ci minfo->hw.MXoptionReg |= 0x20000000; 80462306a36Sopenharmony_ci minfo->hw.MXoptionReg |= minfo->values.reg.opt & 0x03400040; 80562306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, minfo->hw.MXoptionReg); 80662306a36Sopenharmony_ci 80762306a36Sopenharmony_ci /* Init system clocks */ 80862306a36Sopenharmony_ci 80962306a36Sopenharmony_ci /* stop crtc2 */ 81062306a36Sopenharmony_ci c2ctl = mga_inl(M_C2CTL); 81162306a36Sopenharmony_ci mga_outl(M_C2CTL, c2ctl & ~1); 81262306a36Sopenharmony_ci /* stop cursor */ 81362306a36Sopenharmony_ci curctl = inDAC1064(minfo, M1064_XCURCTRL); 81462306a36Sopenharmony_ci outDAC1064(minfo, M1064_XCURCTRL, 0); 81562306a36Sopenharmony_ci /* stop crtc1 */ 81662306a36Sopenharmony_ci c1ctl = mga_readr(M_SEQ_INDEX, 1); 81762306a36Sopenharmony_ci mga_setr(M_SEQ_INDEX, 1, c1ctl | 0x20); 81862306a36Sopenharmony_ci 81962306a36Sopenharmony_ci g450_mclk_init(minfo); 82062306a36Sopenharmony_ci g450_memory_init(minfo); 82162306a36Sopenharmony_ci 82262306a36Sopenharmony_ci /* set legacy VGA clock sources for DOSEmu or VMware... */ 82362306a36Sopenharmony_ci matroxfb_g450_setclk(minfo, 25175, M_PIXEL_PLL_A); 82462306a36Sopenharmony_ci matroxfb_g450_setclk(minfo, 28322, M_PIXEL_PLL_B); 82562306a36Sopenharmony_ci 82662306a36Sopenharmony_ci /* restore crtc1 */ 82762306a36Sopenharmony_ci mga_setr(M_SEQ_INDEX, 1, c1ctl); 82862306a36Sopenharmony_ci 82962306a36Sopenharmony_ci /* restore cursor */ 83062306a36Sopenharmony_ci outDAC1064(minfo, M1064_XCURCTRL, curctl); 83162306a36Sopenharmony_ci 83262306a36Sopenharmony_ci /* restore crtc2 */ 83362306a36Sopenharmony_ci mga_outl(M_C2CTL, c2ctl); 83462306a36Sopenharmony_ci 83562306a36Sopenharmony_ci return; 83662306a36Sopenharmony_ci} 83762306a36Sopenharmony_ci 83862306a36Sopenharmony_cistatic int MGAG100_preinit(struct matrox_fb_info *minfo) 83962306a36Sopenharmony_ci{ 84062306a36Sopenharmony_ci static const int vxres_g100[] = { 512, 640, 768, 800, 832, 960, 84162306a36Sopenharmony_ci 1024, 1152, 1280, 1600, 1664, 1920, 84262306a36Sopenharmony_ci 2048, 0}; 84362306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 84462306a36Sopenharmony_ci 84562306a36Sopenharmony_ci u_int32_t reg50; 84662306a36Sopenharmony_ci#if 0 84762306a36Sopenharmony_ci u_int32_t q; 84862306a36Sopenharmony_ci#endif 84962306a36Sopenharmony_ci 85062306a36Sopenharmony_ci DBG(__func__) 85162306a36Sopenharmony_ci 85262306a36Sopenharmony_ci /* there are some instabilities if in_div > 19 && vco < 61000 */ 85362306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 85462306a36Sopenharmony_ci minfo->features.pll.vco_freq_min = 130000; /* my sample: >118 */ 85562306a36Sopenharmony_ci } else { 85662306a36Sopenharmony_ci minfo->features.pll.vco_freq_min = 62000; 85762306a36Sopenharmony_ci } 85862306a36Sopenharmony_ci if (!minfo->features.pll.ref_freq) { 85962306a36Sopenharmony_ci minfo->features.pll.ref_freq = 27000; 86062306a36Sopenharmony_ci } 86162306a36Sopenharmony_ci minfo->features.pll.feed_div_min = 7; 86262306a36Sopenharmony_ci minfo->features.pll.feed_div_max = 127; 86362306a36Sopenharmony_ci minfo->features.pll.in_div_min = 1; 86462306a36Sopenharmony_ci minfo->features.pll.in_div_max = 31; 86562306a36Sopenharmony_ci minfo->features.pll.post_shift_max = 3; 86662306a36Sopenharmony_ci minfo->features.DAC1064.xvrefctrl = DAC1064_XVREFCTRL_G100_DEFAULT; 86762306a36Sopenharmony_ci /* minfo->capable.cfb4 = 0; ... preinitialized by 0 */ 86862306a36Sopenharmony_ci minfo->capable.text = 1; 86962306a36Sopenharmony_ci minfo->capable.vxres = vxres_g100; 87062306a36Sopenharmony_ci minfo->capable.plnwt = minfo->devflags.accelerator == FB_ACCEL_MATROX_MGAG100 87162306a36Sopenharmony_ci ? minfo->devflags.sgram : 1; 87262306a36Sopenharmony_ci 87362306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 87462306a36Sopenharmony_ci minfo->outputs[0].output = &g450out; 87562306a36Sopenharmony_ci } else { 87662306a36Sopenharmony_ci minfo->outputs[0].output = &m1064; 87762306a36Sopenharmony_ci } 87862306a36Sopenharmony_ci minfo->outputs[0].src = minfo->outputs[0].default_src; 87962306a36Sopenharmony_ci minfo->outputs[0].data = minfo; 88062306a36Sopenharmony_ci minfo->outputs[0].mode = MATROXFB_OUTPUT_MODE_MONITOR; 88162306a36Sopenharmony_ci 88262306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 88362306a36Sopenharmony_ci /* we must do this always, BIOS does not do it for us 88462306a36Sopenharmony_ci and accelerator dies without it */ 88562306a36Sopenharmony_ci mga_outl(0x1C0C, 0); 88662306a36Sopenharmony_ci } 88762306a36Sopenharmony_ci if (minfo->devflags.noinit) 88862306a36Sopenharmony_ci return 0; 88962306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 89062306a36Sopenharmony_ci g450_preinit(minfo); 89162306a36Sopenharmony_ci return 0; 89262306a36Sopenharmony_ci } 89362306a36Sopenharmony_ci hw->MXoptionReg &= 0xC0000100; 89462306a36Sopenharmony_ci hw->MXoptionReg |= 0x00000020; 89562306a36Sopenharmony_ci if (minfo->devflags.novga) 89662306a36Sopenharmony_ci hw->MXoptionReg &= ~0x00000100; 89762306a36Sopenharmony_ci if (minfo->devflags.nobios) 89862306a36Sopenharmony_ci hw->MXoptionReg &= ~0x40000000; 89962306a36Sopenharmony_ci if (minfo->devflags.nopciretry) 90062306a36Sopenharmony_ci hw->MXoptionReg |= 0x20000000; 90162306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, hw->MXoptionReg); 90262306a36Sopenharmony_ci DAC1064_setmclk(minfo, DAC1064_OPT_MDIV2 | DAC1064_OPT_GDIV3 | DAC1064_OPT_SCLK_PCI, 133333); 90362306a36Sopenharmony_ci 90462306a36Sopenharmony_ci if (minfo->devflags.accelerator == FB_ACCEL_MATROX_MGAG100) { 90562306a36Sopenharmony_ci pci_read_config_dword(minfo->pcidev, PCI_OPTION2_REG, ®50); 90662306a36Sopenharmony_ci reg50 &= ~0x3000; 90762306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION2_REG, reg50); 90862306a36Sopenharmony_ci 90962306a36Sopenharmony_ci hw->MXoptionReg |= 0x1080; 91062306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, hw->MXoptionReg); 91162306a36Sopenharmony_ci mga_outl(M_CTLWTST, minfo->values.reg.mctlwtst); 91262306a36Sopenharmony_ci udelay(100); 91362306a36Sopenharmony_ci mga_outb(0x1C05, 0x00); 91462306a36Sopenharmony_ci mga_outb(0x1C05, 0x80); 91562306a36Sopenharmony_ci udelay(100); 91662306a36Sopenharmony_ci mga_outb(0x1C05, 0x40); 91762306a36Sopenharmony_ci mga_outb(0x1C05, 0xC0); 91862306a36Sopenharmony_ci udelay(100); 91962306a36Sopenharmony_ci reg50 &= ~0xFF; 92062306a36Sopenharmony_ci reg50 |= 0x07; 92162306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION2_REG, reg50); 92262306a36Sopenharmony_ci /* it should help with G100 */ 92362306a36Sopenharmony_ci mga_outb(M_GRAPHICS_INDEX, 6); 92462306a36Sopenharmony_ci mga_outb(M_GRAPHICS_DATA, (mga_inb(M_GRAPHICS_DATA) & 3) | 4); 92562306a36Sopenharmony_ci mga_setr(M_EXTVGA_INDEX, 0x03, 0x81); 92662306a36Sopenharmony_ci mga_setr(M_EXTVGA_INDEX, 0x04, 0x00); 92762306a36Sopenharmony_ci mga_writeb(minfo->video.vbase, 0x0000, 0xAA); 92862306a36Sopenharmony_ci mga_writeb(minfo->video.vbase, 0x0800, 0x55); 92962306a36Sopenharmony_ci mga_writeb(minfo->video.vbase, 0x4000, 0x55); 93062306a36Sopenharmony_ci#if 0 93162306a36Sopenharmony_ci if (mga_readb(minfo->video.vbase, 0x0000) != 0xAA) { 93262306a36Sopenharmony_ci hw->MXoptionReg &= ~0x1000; 93362306a36Sopenharmony_ci } 93462306a36Sopenharmony_ci#endif 93562306a36Sopenharmony_ci hw->MXoptionReg |= 0x00078020; 93662306a36Sopenharmony_ci } else if (minfo->devflags.accelerator == FB_ACCEL_MATROX_MGAG200) { 93762306a36Sopenharmony_ci pci_read_config_dword(minfo->pcidev, PCI_OPTION2_REG, ®50); 93862306a36Sopenharmony_ci reg50 &= ~0x3000; 93962306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION2_REG, reg50); 94062306a36Sopenharmony_ci 94162306a36Sopenharmony_ci if (minfo->devflags.memtype == -1) 94262306a36Sopenharmony_ci hw->MXoptionReg |= minfo->values.reg.opt & 0x1C00; 94362306a36Sopenharmony_ci else 94462306a36Sopenharmony_ci hw->MXoptionReg |= (minfo->devflags.memtype & 7) << 10; 94562306a36Sopenharmony_ci if (minfo->devflags.sgram) 94662306a36Sopenharmony_ci hw->MXoptionReg |= 0x4000; 94762306a36Sopenharmony_ci mga_outl(M_CTLWTST, minfo->values.reg.mctlwtst); 94862306a36Sopenharmony_ci mga_outl(M_MEMRDBK, minfo->values.reg.memrdbk); 94962306a36Sopenharmony_ci udelay(200); 95062306a36Sopenharmony_ci mga_outl(M_MACCESS, 0x00000000); 95162306a36Sopenharmony_ci mga_outl(M_MACCESS, 0x00008000); 95262306a36Sopenharmony_ci udelay(100); 95362306a36Sopenharmony_ci mga_outw(M_MEMRDBK, minfo->values.reg.memrdbk); 95462306a36Sopenharmony_ci hw->MXoptionReg |= 0x00078020; 95562306a36Sopenharmony_ci } else { 95662306a36Sopenharmony_ci pci_read_config_dword(minfo->pcidev, PCI_OPTION2_REG, ®50); 95762306a36Sopenharmony_ci reg50 &= ~0x00000100; 95862306a36Sopenharmony_ci reg50 |= 0x00000000; 95962306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION2_REG, reg50); 96062306a36Sopenharmony_ci 96162306a36Sopenharmony_ci if (minfo->devflags.memtype == -1) 96262306a36Sopenharmony_ci hw->MXoptionReg |= minfo->values.reg.opt & 0x1C00; 96362306a36Sopenharmony_ci else 96462306a36Sopenharmony_ci hw->MXoptionReg |= (minfo->devflags.memtype & 7) << 10; 96562306a36Sopenharmony_ci if (minfo->devflags.sgram) 96662306a36Sopenharmony_ci hw->MXoptionReg |= 0x4000; 96762306a36Sopenharmony_ci mga_outl(M_CTLWTST, minfo->values.reg.mctlwtst); 96862306a36Sopenharmony_ci mga_outl(M_MEMRDBK, minfo->values.reg.memrdbk); 96962306a36Sopenharmony_ci udelay(200); 97062306a36Sopenharmony_ci mga_outl(M_MACCESS, 0x00000000); 97162306a36Sopenharmony_ci mga_outl(M_MACCESS, 0x00008000); 97262306a36Sopenharmony_ci udelay(100); 97362306a36Sopenharmony_ci mga_outl(M_MEMRDBK, minfo->values.reg.memrdbk); 97462306a36Sopenharmony_ci hw->MXoptionReg |= 0x00040020; 97562306a36Sopenharmony_ci } 97662306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, hw->MXoptionReg); 97762306a36Sopenharmony_ci return 0; 97862306a36Sopenharmony_ci} 97962306a36Sopenharmony_ci 98062306a36Sopenharmony_cistatic void MGAG100_reset(struct matrox_fb_info *minfo) 98162306a36Sopenharmony_ci{ 98262306a36Sopenharmony_ci u_int8_t b; 98362306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 98462306a36Sopenharmony_ci 98562306a36Sopenharmony_ci DBG(__func__) 98662306a36Sopenharmony_ci 98762306a36Sopenharmony_ci { 98862306a36Sopenharmony_ci#ifdef G100_BROKEN_IBM_82351 98962306a36Sopenharmony_ci u_int32_t d; 99062306a36Sopenharmony_ci 99162306a36Sopenharmony_ci find 1014/22 (IBM/82351); /* if found and bridging Matrox, do some strange stuff */ 99262306a36Sopenharmony_ci pci_read_config_byte(ibm, PCI_SECONDARY_BUS, &b); 99362306a36Sopenharmony_ci if (b == minfo->pcidev->bus->number) { 99462306a36Sopenharmony_ci pci_write_config_byte(ibm, PCI_COMMAND+1, 0); /* disable back-to-back & SERR */ 99562306a36Sopenharmony_ci pci_write_config_byte(ibm, 0x41, 0xF4); /* ??? */ 99662306a36Sopenharmony_ci pci_write_config_byte(ibm, PCI_IO_BASE, 0xF0); /* ??? */ 99762306a36Sopenharmony_ci pci_write_config_byte(ibm, PCI_IO_LIMIT, 0x00); /* ??? */ 99862306a36Sopenharmony_ci } 99962306a36Sopenharmony_ci#endif 100062306a36Sopenharmony_ci if (!minfo->devflags.noinit) { 100162306a36Sopenharmony_ci if (x7AF4 & 8) { 100262306a36Sopenharmony_ci hw->MXoptionReg |= 0x40; /* FIXME... */ 100362306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, hw->MXoptionReg); 100462306a36Sopenharmony_ci } 100562306a36Sopenharmony_ci mga_setr(M_EXTVGA_INDEX, 0x06, 0x00); 100662306a36Sopenharmony_ci } 100762306a36Sopenharmony_ci } 100862306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 100962306a36Sopenharmony_ci /* either leave MCLK as is... or they were set in preinit */ 101062306a36Sopenharmony_ci hw->DACclk[3] = inDAC1064(minfo, DAC1064_XSYSPLLM); 101162306a36Sopenharmony_ci hw->DACclk[4] = inDAC1064(minfo, DAC1064_XSYSPLLN); 101262306a36Sopenharmony_ci hw->DACclk[5] = inDAC1064(minfo, DAC1064_XSYSPLLP); 101362306a36Sopenharmony_ci } else { 101462306a36Sopenharmony_ci DAC1064_setmclk(minfo, DAC1064_OPT_RESERVED | DAC1064_OPT_MDIV2 | DAC1064_OPT_GDIV1 | DAC1064_OPT_SCLK_PLL, 133333); 101562306a36Sopenharmony_ci } 101662306a36Sopenharmony_ci if (minfo->devflags.accelerator == FB_ACCEL_MATROX_MGAG400) { 101762306a36Sopenharmony_ci if (minfo->devflags.dfp_type == -1) { 101862306a36Sopenharmony_ci minfo->devflags.dfp_type = inDAC1064(minfo, 0x1F); 101962306a36Sopenharmony_ci } 102062306a36Sopenharmony_ci } 102162306a36Sopenharmony_ci if (minfo->devflags.noinit) 102262306a36Sopenharmony_ci return; 102362306a36Sopenharmony_ci if (minfo->devflags.g450dac) { 102462306a36Sopenharmony_ci } else { 102562306a36Sopenharmony_ci MGAG100_setPixClock(minfo, 4, 25175); 102662306a36Sopenharmony_ci MGAG100_setPixClock(minfo, 5, 28322); 102762306a36Sopenharmony_ci if (x7AF4 & 0x10) { 102862306a36Sopenharmony_ci b = inDAC1064(minfo, M1064_XGENIODATA) & ~1; 102962306a36Sopenharmony_ci outDAC1064(minfo, M1064_XGENIODATA, b); 103062306a36Sopenharmony_ci b = inDAC1064(minfo, M1064_XGENIOCTRL) | 1; 103162306a36Sopenharmony_ci outDAC1064(minfo, M1064_XGENIOCTRL, b); 103262306a36Sopenharmony_ci } 103362306a36Sopenharmony_ci } 103462306a36Sopenharmony_ci} 103562306a36Sopenharmony_ci#endif 103662306a36Sopenharmony_ci 103762306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_MYSTIQUE 103862306a36Sopenharmony_cistatic void MGA1064_restore(struct matrox_fb_info *minfo) 103962306a36Sopenharmony_ci{ 104062306a36Sopenharmony_ci int i; 104162306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 104262306a36Sopenharmony_ci 104362306a36Sopenharmony_ci CRITFLAGS 104462306a36Sopenharmony_ci 104562306a36Sopenharmony_ci DBG(__func__) 104662306a36Sopenharmony_ci 104762306a36Sopenharmony_ci CRITBEGIN 104862306a36Sopenharmony_ci 104962306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, hw->MXoptionReg); 105062306a36Sopenharmony_ci mga_outb(M_IEN, 0x00); 105162306a36Sopenharmony_ci mga_outb(M_CACHEFLUSH, 0x00); 105262306a36Sopenharmony_ci 105362306a36Sopenharmony_ci CRITEND 105462306a36Sopenharmony_ci 105562306a36Sopenharmony_ci DAC1064_restore_1(minfo); 105662306a36Sopenharmony_ci matroxfb_vgaHWrestore(minfo); 105762306a36Sopenharmony_ci minfo->crtc1.panpos = -1; 105862306a36Sopenharmony_ci for (i = 0; i < 6; i++) 105962306a36Sopenharmony_ci mga_setr(M_EXTVGA_INDEX, i, hw->CRTCEXT[i]); 106062306a36Sopenharmony_ci DAC1064_restore_2(minfo); 106162306a36Sopenharmony_ci} 106262306a36Sopenharmony_ci#endif 106362306a36Sopenharmony_ci 106462306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 106562306a36Sopenharmony_cistatic void MGAG100_restore(struct matrox_fb_info *minfo) 106662306a36Sopenharmony_ci{ 106762306a36Sopenharmony_ci int i; 106862306a36Sopenharmony_ci struct matrox_hw_state *hw = &minfo->hw; 106962306a36Sopenharmony_ci 107062306a36Sopenharmony_ci CRITFLAGS 107162306a36Sopenharmony_ci 107262306a36Sopenharmony_ci DBG(__func__) 107362306a36Sopenharmony_ci 107462306a36Sopenharmony_ci CRITBEGIN 107562306a36Sopenharmony_ci 107662306a36Sopenharmony_ci pci_write_config_dword(minfo->pcidev, PCI_OPTION_REG, hw->MXoptionReg); 107762306a36Sopenharmony_ci CRITEND 107862306a36Sopenharmony_ci 107962306a36Sopenharmony_ci DAC1064_restore_1(minfo); 108062306a36Sopenharmony_ci matroxfb_vgaHWrestore(minfo); 108162306a36Sopenharmony_ci if (minfo->devflags.support32MB) 108262306a36Sopenharmony_ci mga_setr(M_EXTVGA_INDEX, 8, hw->CRTCEXT[8]); 108362306a36Sopenharmony_ci minfo->crtc1.panpos = -1; 108462306a36Sopenharmony_ci for (i = 0; i < 6; i++) 108562306a36Sopenharmony_ci mga_setr(M_EXTVGA_INDEX, i, hw->CRTCEXT[i]); 108662306a36Sopenharmony_ci DAC1064_restore_2(minfo); 108762306a36Sopenharmony_ci} 108862306a36Sopenharmony_ci#endif 108962306a36Sopenharmony_ci 109062306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_MYSTIQUE 109162306a36Sopenharmony_cistruct matrox_switch matrox_mystique = { 109262306a36Sopenharmony_ci .preinit = MGA1064_preinit, 109362306a36Sopenharmony_ci .reset = MGA1064_reset, 109462306a36Sopenharmony_ci .init = MGA1064_init, 109562306a36Sopenharmony_ci .restore = MGA1064_restore, 109662306a36Sopenharmony_ci}; 109762306a36Sopenharmony_ciEXPORT_SYMBOL(matrox_mystique); 109862306a36Sopenharmony_ci#endif 109962306a36Sopenharmony_ci 110062306a36Sopenharmony_ci#ifdef CONFIG_FB_MATROX_G 110162306a36Sopenharmony_cistruct matrox_switch matrox_G100 = { 110262306a36Sopenharmony_ci .preinit = MGAG100_preinit, 110362306a36Sopenharmony_ci .reset = MGAG100_reset, 110462306a36Sopenharmony_ci .init = MGAG100_init, 110562306a36Sopenharmony_ci .restore = MGAG100_restore, 110662306a36Sopenharmony_ci}; 110762306a36Sopenharmony_ciEXPORT_SYMBOL(matrox_G100); 110862306a36Sopenharmony_ci#endif 110962306a36Sopenharmony_ci 111062306a36Sopenharmony_ci#ifdef NEED_DAC1064 111162306a36Sopenharmony_ciEXPORT_SYMBOL(DAC1064_global_init); 111262306a36Sopenharmony_ciEXPORT_SYMBOL(DAC1064_global_restore); 111362306a36Sopenharmony_ci#endif 111462306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 1115