/* * * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200 and G400 * * (c) 1998,1999,2000 Petr Vandrovec * * Version: 1.54 2001/09/09 * * MTRR stuff: 1998 Tom Rini * * Contributors: "menion?" * Betatesting, fixes, ideas * * "Kurt Garloff" * Betatesting, fixes, ideas, videomodes, videomodes timmings * * "Tom Rini" * MTRR stuff, PPC cleanups, betatesting, fixes, ideas * * "Bibek Sahu" * Access device through readb|w|l and write b|w|l * Extensive debugging stuff * * "Daniel Haun" * Testing, hardware cursor fixes * * "Scott Wood" * Fixes * * "Gerd Knorr" * Betatesting * * "Kelly French" * "Fernando Herrera" * Betatesting, bug reporting * * "Pablo Bianucci" * Fixes, ideas, betatesting * * "Inaky Perez Gonzalez" * Fixes, enhandcements, ideas, betatesting * * "Ryuichi Oikawa" * PPC betatesting, PPC support, backward compatibility * * "Paul Womar" * "Owen Waller" * PPC betatesting * * "Thomas Pornin" * Alpha betatesting * * "Pieter van Leuven" * "Ulf Jaenicke-Roessler" * G100 testing * * "H. Peter Arvin" * Ideas * * "Cort Dougan" * CHRP fixes and PReP cleanup * * "Mark Vojkovich" * G400 support * * "David C. Hansen" * Fixes * * (following author is not in any relation with this code, but his code * is included in this driver) * * Based on framebuffer driver for VBE 2.0 compliant graphic boards * (c) 1998 Gerd Knorr * * (following author is not in any relation with this code, but his ideas * were used when writting this driver) * * FreeVBE/AF (Matrox), "Shawn Hargreaves" * */ /* make checkconfig does not check includes for this... */ #include #include "matroxfb_misc.h" #include #include void matroxfb_createcursorshape(WPMINFO struct display* p, int vmode) { unsigned int h; unsigned int cu, cd; h = fontheight(p); if (vmode & FB_VMODE_DOUBLE) h *= 2; cd = h; if (cd >= 10) cd--; switch (ACCESS_FBINFO(cursor.type) = (p->conp->vc_cursor_type & CUR_HWMASK)) { case CUR_NONE: cu = cd; break; case CUR_UNDERLINE: cu = cd - 2; break; case CUR_LOWER_THIRD: cu = (h * 2) / 3; break; case CUR_LOWER_HALF: cu = h / 2; break; case CUR_TWO_THIRDS: cu = h / 3; break; case CUR_BLOCK: default: cu = 0; cd = h; break; } ACCESS_FBINFO(cursor.w) = fontwidth(p); ACCESS_FBINFO(cursor.u) = cu; ACCESS_FBINFO(cursor.d) = cd; } void matroxfb_DAC_out(CPMINFO int reg, int val) { DBG_REG("outDAC"); mga_outb(M_RAMDAC_BASE+M_X_INDEX, reg); mga_outb(M_RAMDAC_BASE+M_X_DATAREG, val); } int matroxfb_DAC_in(CPMINFO int reg) { DBG_REG("inDAC"); mga_outb(M_RAMDAC_BASE+M_X_INDEX, reg); return mga_inb(M_RAMDAC_BASE+M_X_DATAREG); } void matroxfb_var2my(struct fb_var_screeninfo* var, struct my_timming* mt) { unsigned int pixclock = var->pixclock; DBG("var2my") if (!pixclock) pixclock = 10000; /* 10ns = 100MHz */ mt->pixclock = 1000000000 / pixclock; if (mt->pixclock < 1) mt->pixclock = 1; mt->dblscan = var->vmode & FB_VMODE_DOUBLE; mt->interlaced = var->vmode & FB_VMODE_INTERLACED; mt->HDisplay = var->xres; mt->HSyncStart = mt->HDisplay + var->right_margin; mt->HSyncEnd = mt->HSyncStart + var->hsync_len; mt->HTotal = mt->HSyncEnd + var->left_margin; mt->VDisplay = var->yres; mt->VSyncStart = mt->VDisplay + var->lower_margin; mt->VSyncEnd = mt->VSyncStart + var->vsync_len; mt->VTotal = mt->VSyncEnd + var->upper_margin; mt->sync = var->sync; } int matroxfb_PLL_calcclock(const struct matrox_pll_features* pll, unsigned int freq, unsigned int fmax, unsigned int* in, unsigned int* feed, unsigned int* post) { unsigned int bestdiff = ~0; unsigned int bestvco = 0; unsigned int fxtal = pll->ref_freq; unsigned int fwant; unsigned int p; DBG("PLL_calcclock") fwant = freq; #ifdef DEBUG printk(KERN_ERR "post_shift_max: %d\n", pll->post_shift_max); printk(KERN_ERR "ref_freq: %d\n", pll->ref_freq); printk(KERN_ERR "freq: %d\n", freq); printk(KERN_ERR "vco_freq_min: %d\n", pll->vco_freq_min); printk(KERN_ERR "in_div_min: %d\n", pll->in_div_min); printk(KERN_ERR "in_div_max: %d\n", pll->in_div_max); printk(KERN_ERR "feed_div_min: %d\n", pll->feed_div_min); printk(KERN_ERR "feed_div_max: %d\n", pll->feed_div_max); printk(KERN_ERR "fmax: %d\n", fmax); #endif for (p = 1; p <= pll->post_shift_max; p++) { if (fwant * 2 > fmax) break; fwant *= 2; } if (fwant < pll->vco_freq_min) fwant = pll->vco_freq_min; if (fwant > fmax) fwant = fmax; for (; p-- > 0; fwant >>= 1, bestdiff >>= 1) { unsigned int m; if (fwant < pll->vco_freq_min) break; for (m = pll->in_div_min; m <= pll->in_div_max; m++) { unsigned int diff, fvco; unsigned int n; n = (fwant * (m + 1) + (fxtal >> 1)) / fxtal - 1; if (n > pll->feed_div_max) break; if (n < pll->feed_div_min) n = pll->feed_div_min; fvco = (fxtal * (n + 1)) / (m + 1); if (fvco < fwant) diff = fwant - fvco; else diff = fvco - fwant; if (diff < bestdiff) { bestdiff = diff; *post = p; *in = m; *feed = n; bestvco = fvco; } } } dprintk(KERN_ERR "clk: %02X %02X %02X %d %d %d\n", *in, *feed, *post, fxtal, bestvco, fwant); return bestvco; } int matroxfb_vgaHWinit(CPMINFO struct matrox_hw_state* hw, struct my_timming* m, struct display* p) { unsigned int hd, hs, he, hbe, ht; unsigned int vd, vs, ve, vt; unsigned int wd; unsigned int divider; int i; int text = p->type == FB_TYPE_TEXT; int fwidth; if (text) { fwidth = fontwidth(p); if (!fwidth) fwidth = 8; } else fwidth = 8; DBG("vgaHWinit") hw->SEQ[0] = 0x00; if (fwidth == 9) hw->SEQ[1] = 0x00; else hw->SEQ[1] = 0x01; /* or 0x09 */ hw->SEQ[2] = 0x0F; /* bitplanes */ hw->SEQ[3] = 0x00; if (text) hw->SEQ[4] = 0x02; else hw->SEQ[4] = 0x0E; /* CRTC 0..7, 9, 16..19, 21, 22 are reprogrammed by Matrox Millennium code... Hope that by MGA1064 too */ if (m->dblscan) { m->VTotal <<= 1; m->VDisplay <<= 1; m->VSyncStart <<= 1; m->VSyncEnd <<= 1; } if (m->interlaced) { m->VTotal >>= 1; m->VDisplay >>= 1; m->VSyncStart >>= 1; m->VSyncEnd >>= 1; } /* GCTL is ignored when not using 0xA0000 aperture */ hw->GCTL[0] = 0x00; hw->GCTL[1] = 0x00; hw->GCTL[2] = 0x00; hw->GCTL[3] = 0x00; hw->GCTL[4] = 0x00; if (text) { hw->GCTL[5] = 0x10; hw->GCTL[6] = 0x02; } else { hw->GCTL[5] = 0x40; hw->GCTL[6] = 0x05; } hw->GCTL[7] = 0x0F; hw->GCTL[8] = 0xFF; /* Whole ATTR is ignored in PowerGraphics mode */ for (i = 0; i < 16; i++) hw->ATTR[i] = i; if (text) { hw->ATTR[16] = 0x04; } else { hw->ATTR[16] = 0x41; } hw->ATTR[17] = 0xFF; hw->ATTR[18] = 0x0F; if (fwidth == 9) hw->ATTR[19] = 0x08; else hw->ATTR[19] = 0x00; hw->ATTR[20] = 0x00; if (text) { hd = m->HDisplay / fwidth; hs = m->HSyncStart / fwidth; he = m->HSyncEnd / fwidth; ht = m->HTotal / fwidth; divider = 8; } else { hd = m->HDisplay >> 3; hs = m->HSyncStart >> 3; he = m->HSyncEnd >> 3; ht = m->HTotal >> 3; /* standard timmings are in 8pixels, but for interleaved we cannot */ /* do it for 4bpp (because of (4bpp >> 1(interleaved))/4 == 0) */ /* using 16 or more pixels per unit can save us */ divider = ACCESS_FBINFO(curr.final_bppShift); } while (divider & 3) { hd >>= 1; hs >>= 1; he >>= 1; ht >>= 1; divider <<= 1; } divider = divider / 4; /* divider can be from 1 to 8 */ while (divider > 8) { hd <<= 1; hs <<= 1; he <<= 1; ht <<= 1; divider >>= 1; } hd = hd - 1; hs = hs - 1; he = he - 1; ht = ht - 1; vd = m->VDisplay - 1; vs = m->VSyncStart - 1; ve = m->VSyncEnd - 1; vt = m->VTotal - 2; /* G200 cannot work with (ht & 7) == 6 */ if (((ht & 0x07) == 0x06) || ((ht & 0x0F) == 0x04)) ht++; if (text) { hbe = ht - 1; wd = p->var.xres_virtual / (fwidth * 2); } else { hbe = ht; wd = p->var.xres_virtual * ACCESS_FBINFO(curr.final_bppShift) / 64; } hw->CRTCEXT[0] = 0; hw->CRTCEXT[5] = 0; if (m->interlaced) { hw->CRTCEXT[0] = 0x80; hw->CRTCEXT[5] = (hs + he - ht) >> 1; if (!m->dblscan) wd <<= 1; vt &= ~1; } hw->CRTCEXT[0] |= (wd & 0x300) >> 4; hw->CRTCEXT[1] = (((ht - 4) & 0x100) >> 8) | ((hd & 0x100) >> 7) | /* blanking */ ((hs & 0x100) >> 6) | /* sync start */ (hbe & 0x040); /* end hor. blanking */ if (ACCESS_FBINFO(output.ph) & MATROXFB_OUTPUT_CONN_SECONDARY) hw->CRTCEXT[1] |= 0x88; /* enable horizontal and vertical vidrst */ hw->CRTCEXT[2] = ((vt & 0xC00) >> 10) | ((vd & 0x400) >> 8) | /* disp end */ ((vd & 0xC00) >> 7) | /* vblanking start */ ((vs & 0xC00) >> 5); if (text) hw->CRTCEXT[3] = 0x00; else hw->CRTCEXT[3] = (divider - 1) | 0x80; hw->CRTCEXT[4] = 0; hw->CRTC[0] = ht-4; hw->CRTC[1] = hd; hw->CRTC[2] = hd; hw->CRTC[3] = (hbe & 0x1F) | 0x80; hw->CRTC[4] = hs; hw->CRTC[5] = ((hbe & 0x20) << 2) | (he & 0x1F); if (text) hw->CRTC[5] |= 0x60; /* delay sync for 3 clocks (to same picture position on MGA and VGA) */ hw->CRTC[6] = vt & 0xFF; hw->CRTC[7] = ((vt & 0x100) >> 8) | ((vd & 0x100) >> 7) | ((vs & 0x100) >> 6) | ((vd & 0x100) >> 5) | 0x10 | ((vt & 0x200) >> 4) | ((vd & 0x200) >> 3) | ((vs & 0x200) >> 2); hw->CRTC[8] = 0x00; hw->CRTC[9] = ((vd & 0x200) >> 4) | 0x40; if (text) hw->CRTC[9] |= fontheight(p) - 1; if (m->dblscan && !m->interlaced) hw->CRTC[9] |= 0x80; for (i = 10; i < 16; i++) hw->CRTC[i] = 0x00; hw->CRTC[16] = vs /* & 0xFF */; hw->CRTC[17] = (ve & 0x0F) | 0x20; hw->CRTC[18] = vd /* & 0xFF */; hw->CRTC[19] = wd /* & 0xFF */; hw->CRTC[20] = 0x00; hw->CRTC[21] = vd /* & 0xFF */; hw->CRTC[22] = (vt + 1) /* & 0xFF */; if (text) { if (ACCESS_FBINFO(devflags.textmode) == 1) hw->CRTC[23] = 0xC3; else hw->CRTC[23] = 0xA3; if (ACCESS_FBINFO(devflags.textmode) == 4) hw->CRTC[20] = 0x5F; else hw->CRTC[20] = 0x1F; } else hw->CRTC[23] = 0xC3; hw->CRTC[24] = 0xFF; return 0; }; void matroxfb_vgaHWrestore(WPMINFO struct matrox_hw_state* hw, struct matrox_hw_state* oldhw) { int i; CRITFLAGS DBG("vgaHWrestore") dprintk(KERN_INFO "MiscOutReg: %02X\n", hw->MiscOutReg); dprintk(KERN_INFO "SEQ regs: "); for (i = 0; i < 5; i++) dprintk("%02X:", hw->SEQ[i]); dprintk("\n"); dprintk(KERN_INFO "GDC regs: "); for (i = 0; i < 9; i++) dprintk("%02X:", hw->GCTL[i]); dprintk("\n"); dprintk(KERN_INFO "CRTC regs: "); for (i = 0; i < 25; i++) dprintk("%02X:", hw->CRTC[i]); dprintk("\n"); dprintk(KERN_INFO "ATTR regs: "); for (i = 0; i < 21; i++) dprintk("%02X:", hw->ATTR[i]); dprintk("\n"); CRITBEGIN mga_inb(M_ATTR_RESET); mga_outb(M_ATTR_INDEX, 0); mga_outb(M_MISC_REG, hw->MiscOutReg); for (i = 1; i < 5; i++) mga_setr(M_SEQ_INDEX, i, hw->SEQ[i]); mga_setr(M_CRTC_INDEX, 17, hw->CRTC[17] & 0x7F); for (i = 0; i < 25; i++) mga_setr(M_CRTC_INDEX, i, hw->CRTC[i]); for (i = 0; i < 9; i++) mga_setr(M_GRAPHICS_INDEX, i, hw->GCTL[i]); for (i = 0; i < 21; i++) { mga_inb(M_ATTR_RESET); mga_outb(M_ATTR_INDEX, i); mga_outb(M_ATTR_INDEX, hw->ATTR[i]); } mga_outb(M_PALETTE_MASK, 0xFF); mga_outb(M_DAC_REG, 0x00); for (i = 0; i < 768; i++) mga_outb(M_DAC_VAL, hw->DACpal[i]); mga_inb(M_ATTR_RESET); mga_outb(M_ATTR_INDEX, 0x20); CRITEND } void matroxfb_fastfont_init(struct matrox_fb_info* minfo){ unsigned int size; size = ACCESS_FBINFO(fastfont.size); ACCESS_FBINFO(fastfont.size) = 0; if (size) { unsigned int end = ACCESS_FBINFO(video.len_usable); if (size < end) { unsigned int start; start = (end - size) & PAGE_MASK; if (start >= 0x00100000) { ACCESS_FBINFO(video.len_usable) = start; ACCESS_FBINFO(fastfont.mgabase) = start * 8; ACCESS_FBINFO(fastfont.vbase) = ACCESS_FBINFO(video.vbase); vaddr_add(&ACCESS_FBINFO(fastfont.vbase), start); ACCESS_FBINFO(fastfont.size) = end - start; } } } } #ifndef FNTCHARCNT #define FNTCHARCNT(fd) (((int *)(fd))[-3]) #endif int matrox_text_loadfont(WPMINFO struct display* p) { unsigned int fsize; unsigned int width; vaddr_t dst; unsigned int i; u_int8_t* font; CRITFLAGS if (!p || !p->fontdata) return 0; width = fontwidth(p); fsize = p->userfont?FNTCHARCNT(p->fontdata):256; dst = ACCESS_FBINFO(video.vbase); i = 2; font = (u_int8_t*)p->fontdata; CRITBEGIN mga_setr(M_SEQ_INDEX, 0x02, 0x04); while (fsize--) { int l; for (l = 0; l < fontheight(p); l++) { mga_writeb(dst, i, *font++); if (fontwidth(p) > 8) font++; i += ACCESS_FBINFO(devflags.vgastep); } i += (32 - fontheight(p)) * ACCESS_FBINFO(devflags.vgastep); } mga_setr(M_SEQ_INDEX, 0x02, 0x03); CRITEND return 1; } int matroxfb_fastfont_tryset(WPMINFO struct display* p) { unsigned int fsize; unsigned int width; CRITFLAGS if (!p || !p->fontdata) return 0; width = fontwidth(p); if (width > 32) return 0; fsize = (p->userfont?FNTCHARCNT(p->fontdata):256) * fontheight(p); if (((fsize * width + 31) / 32) * 4 > ACCESS_FBINFO(fastfont.size)) return 0; CRITBEGIN mga_outl(M_OPMODE, M_OPMODE_8BPP); if (width <= 8) { if (width == 8) mga_memcpy_toio(ACCESS_FBINFO(fastfont.vbase), 0, p->fontdata, fsize); else { vaddr_t dst; unsigned int i; u_int8_t* font; u_int32_t mask, valid, reg; dst = ACCESS_FBINFO(fastfont.vbase); font = (u_int8_t*)p->fontdata; mask = ~0 << (8 - width); valid = 0; reg = 0; i = 0; while (fsize--) { reg |= (*font++ & mask) << (8 - valid); valid += width; if (valid >= 8) { mga_writeb(dst, i++, reg >> 8); reg = reg << 8; valid -= 8; } } if (valid) mga_writeb(dst, i, reg >> 8); } } else if (width <= 16) { if (width == 16) mga_memcpy_toio(ACCESS_FBINFO(fastfont.vbase), 0, p->fontdata, fsize*2); else { vaddr_t dst; u_int16_t* font; u_int32_t mask, valid, reg; unsigned int i; dst = ACCESS_FBINFO(fastfont.vbase); font = (u_int16_t*)p->fontdata; mask = ~0 << (16 - width); valid = 0; reg = 0; i = 0; while (fsize--) { reg |= (ntohs(*font++) & mask) << (16 - valid); valid += width; if (valid >= 16) { mga_writew(dst, i, htons(reg >> 16)); i += 2; reg = reg << 16; valid -= 16; } } if (valid) mga_writew(dst, i, htons(reg >> 16)); } } else { if (width == 32) mga_memcpy_toio(ACCESS_FBINFO(fastfont.vbase), 0, p->fontdata, fsize*4); else { vaddr_t dst; u_int32_t* font; u_int32_t mask, valid, reg; unsigned int i; dst = ACCESS_FBINFO(fastfont.vbase); font = (u_int32_t*)p->fontdata; mask = ~0 << (32 - width); valid = 0; reg = 0; i = 0; while (fsize--) { reg |= (ntohl(*font) & mask) >> valid; valid += width; if (valid >= 32) { mga_writel(dst, i, htonl(reg)); i += 4; valid -= 32; if (valid) reg = (ntohl(*font) & mask) << (width - valid); else reg = 0; } font++; } if (valid) mga_writel(dst, i, htonl(reg)); } } mga_outl(M_OPMODE, ACCESS_FBINFO(accel.m_opmode)); CRITEND return 1; } EXPORT_SYMBOL(matroxfb_DAC_in); EXPORT_SYMBOL(matroxfb_DAC_out); EXPORT_SYMBOL(matroxfb_var2my); EXPORT_SYMBOL(matroxfb_PLL_calcclock); #ifndef CONFIG_FB_MATROX_MULTIHEAD struct matrox_fb_info matroxfb_global_mxinfo; EXPORT_SYMBOL(matroxfb_global_mxinfo); #endif EXPORT_SYMBOL(matrox_text_loadfont); /* for matroxfb_accel */ EXPORT_SYMBOL(matroxfb_createcursorshape); /* accel, DAC1064, Ti3026 */ EXPORT_SYMBOL(matroxfb_fastfont_tryset); /* accel */ EXPORT_SYMBOL(matroxfb_fastfont_init); /* DAC1064, Ti3026 */ EXPORT_SYMBOL(matroxfb_vgaHWinit); /* DAC1064, Ti3026 */ EXPORT_SYMBOL(matroxfb_vgaHWrestore); /* DAC1064, Ti3026 */ MODULE_AUTHOR("(c) 1999-2001 Petr Vandrovec "); MODULE_DESCRIPTION("Miscellaneous support for Matrox video cards"); MODULE_LICENSE("GPL");