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