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, &reg50);
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, &reg50);
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, &reg50);
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