patch-2.3.48 linux/drivers/video/matroxfb.c
Next file: linux/drivers/video/vgacon.c
Previous file: linux/drivers/video/matrox/matroxfb_misc.h
Back to the patch index
Back to the overall index
- Lines: 6108
- Date:
Wed Dec 31 16:00:00 1969
- Orig file:
v2.3.47/linux/drivers/video/matroxfb.c
- Orig date:
Wed Feb 16 17:03:52 2000
diff -u --recursive --new-file v2.3.47/linux/drivers/video/matroxfb.c linux/drivers/video/matroxfb.c
@@ -1,6107 +0,0 @@
-/*
- *
- * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200 and G400
- *
- * (c) 1998,1999 Petr Vandrovec <vandrove@vc.cvut.cz>
- *
- * Version: 1.19 1999/08/05
- *
- * MTRR stuff: 1998 Tom Rini <tmrini@ntplx.net>
- *
- * Contributors: "menion?" <menion@mindless.com>
- * Betatesting, fixes, ideas
- *
- * "Kurt Garloff" <garloff@kg1.ping.de>
- * Betatesting, fixes, ideas, videomodes, videomodes timmings
- *
- * "Tom Rini" <trini@disparity.net>
- * MTRR stuff, PPC cleanups, betatesting, fixes, ideas
- *
- * "Bibek Sahu" <scorpio@dodds.net>
- * Access device through readb|w|l and write b|w|l
- * Extensive debugging stuff
- *
- * "Daniel Haun" <haund@usa.net>
- * Testing, hardware cursor fixes
- *
- * "Scott Wood" <sawst46+@pitt.edu>
- * Fixes
- *
- * "Gerd Knorr" <kraxel@goldbach.isdn.cs.tu-berlin.de>
- * Betatesting
- *
- * "Kelly French" <targon@hazmat.com>
- * "Fernando Herrera" <fherrera@eurielec.etsit.upm.es>
- * Betatesting, bug reporting
- *
- * "Pablo Bianucci" <pbian@pccp.com.ar>
- * Fixes, ideas, betatesting
- *
- * "Inaky Perez Gonzalez" <inaky@peloncho.fis.ucm.es>
- * Fixes, enhandcements, ideas, betatesting
- *
- * "Ryuichi Oikawa" <roikawa@rr.iiij4u.or.jp>
- * PPC betatesting, PPC support, backward compatibility
- *
- * "Paul Womar" <Paul@pwomar.demon.co.uk>
- * "Owen Waller" <O.Waller@ee.qub.ac.uk>
- * PPC betatesting
- *
- * "Thomas Pornin" <pornin@bolet.ens.fr>
- * Alpha betatesting
- *
- * "Pieter van Leuven" <pvl@iae.nl>
- * "Ulf Jaenicke-Roessler" <ujr@physik.phy.tu-dresden.de>
- * G100 testing
- *
- * "H. Peter Arvin" <hpa@transmeta.com>
- * Ideas
- *
- * "Cort Dougan" <cort@cs.nmt.edu>
- * CHRP fixes and PReP cleanup
- *
- * "Mark Vojkovich" <mvojkovi@ucsd.edu>
- * G400 support
- *
- * (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 <kraxel@cs.tu-berlin.de>
- *
- * (following author is not in any relation with this code, but his ideas
- * were used when writting this driver)
- *
- * FreeVBE/AF (Matrox), "Shawn Hargreaves" <shawn@talula.demon.co.uk>
- *
- */
-
-/* general, but fairly heavy, debugging */
-#undef MATROXFB_DEBUG
-
-/* heavy debugging: */
-/* -- logs putc[s], so everytime a char is displayed, it's logged */
-#undef MATROXFB_DEBUG_HEAVY
-
-/* This one _could_ cause infinite loops */
-/* It _does_ cause lots and lots of messages during idle loops */
-#undef MATROXFB_DEBUG_LOOP
-
-/* Debug register calls, too? */
-#undef MATROXFB_DEBUG_REG
-
-#include <linux/config.h>
-#include <linux/module.h>
-#include <linux/kernel.h>
-#include <linux/errno.h>
-#include <linux/string.h>
-#include <linux/mm.h>
-#include <linux/tty.h>
-#include <linux/malloc.h>
-#include <linux/delay.h>
-#include <linux/fb.h>
-#include <linux/console.h>
-#include <linux/selection.h>
-#include <linux/ioport.h>
-#include <linux/init.h>
-#include <linux/timer.h>
-#include <linux/pci.h>
-#include <linux/spinlock.h>
-
-#include <asm/io.h>
-#include <asm/unaligned.h>
-#ifdef CONFIG_MTRR
-#include <asm/mtrr.h>
-#endif
-
-#include <video/fbcon.h>
-#include <video/fbcon-cfb4.h>
-#include <video/fbcon-cfb8.h>
-#include <video/fbcon-cfb16.h>
-#include <video/fbcon-cfb24.h>
-#include <video/fbcon-cfb32.h>
-
-#if defined(CONFIG_FB_OF)
-#if defined(CONFIG_FB_COMPAT_XPMAC)
-#include <asm/vc_ioctl.h>
-#endif
-#include <asm/prom.h>
-#include <asm/pci-bridge.h>
-#include <video/macmodes.h>
-#endif
-
-/* always compile support for 32MB... It cost almost nothing */
-#define CONFIG_FB_MATROX_32MB
-
-#define FBCON_HAS_VGATEXT
-
-#ifdef MATROXFB_DEBUG
-
-#define DEBUG
-#define DBG(x) printk(KERN_DEBUG "matroxfb: %s\n", (x));
-
-#ifdef MATROXFB_DEBUG_HEAVY
-#define DBG_HEAVY(x) DBG(x)
-#else /* MATROXFB_DEBUG_HEAVY */
-#define DBG_HEAVY(x) /* DBG_HEAVY */
-#endif /* MATROXFB_DEBUG_HEAVY */
-
-#ifdef MATROXFB_DEBUG_LOOP
-#define DBG_LOOP(x) DBG(x)
-#else /* MATROXFB_DEBUG_LOOP */
-#define DBG_LOOP(x) /* DBG_LOOP */
-#endif /* MATROXFB_DEBUG_LOOP */
-
-#ifdef MATROXFB_DEBUG_REG
-#define DBG_REG(x) DBG(x)
-#else /* MATROXFB_DEBUG_REG */
-#define DBG_REG(x) /* DBG_REG */
-#endif /* MATROXFB_DEBUG_REG */
-
-#else /* MATROXFB_DEBUG */
-
-#define DBG(x) /* DBG */
-#define DBG_HEAVY(x) /* DBG_HEAVY */
-#define DBG_REG(x) /* DBG_REG */
-#define DBG_LOOP(x) /* DBG_LOOP */
-
-#endif /* MATROXFB_DEBUG */
-
-#ifndef __i386__
-#ifndef ioremap_nocache
-#define ioremap_nocache(X,Y) ioremap(X,Y)
-#endif
-#endif
-
-#if defined(__alpha__) || defined(__m68k__)
-#define READx_WORKS
-#define MEMCPYTOIO_WORKS
-#else
-#define READx_FAILS
-/* recheck __ppc__, maybe that __ppc__ needs MEMCPYTOIO_WRITEL */
-/* I benchmarked PII/350MHz with G200... MEMCPY, MEMCPYTOIO and WRITEL are on same speed ( <2% diff) */
-/* so that means that G200 speed (or AGP speed?) is our limit... I do not have benchmark to test, how */
-/* much of PCI bandwidth is used during transfers... */
-#if defined(__i386__)
-#define MEMCPYTOIO_MEMCPY
-#else
-#define MEMCPYTOIO_WRITEL
-#endif
-#endif
-
-#ifdef __sparc__
-#error "Sorry, I have no idea how to do this on sparc... There is mapioaddr... With bus_type parameter..."
-#endif
-
-#if defined(__m68k__)
-#define MAP_BUSTOVIRT
-#else
-#define MAP_IOREMAP
-#endif
-
-#ifdef DEBUG
-#define dprintk(X...) printk(X)
-#else
-#define dprintk(X...)
-#endif
-
-#ifndef PCI_SS_VENDOR_ID_SIEMENS_NIXDORF
-#define PCI_SS_VENDOR_ID_SIEMENS_NIXDORF 0x110A
-#endif
-#ifndef PCI_SS_VENDOR_ID_MATROX
-#define PCI_SS_VENDOR_ID_MATROX PCI_VENDOR_ID_MATROX
-#endif
-#ifndef PCI_DEVICE_ID_MATROX_G200_PCI
-#define PCI_DEVICE_ID_MATROX_G200_PCI 0x0520
-#endif
-#ifndef PCI_DEVICE_ID_MATROX_G200_AGP
-#define PCI_DEVICE_ID_MATROX_G200_AGP 0x0521
-#endif
-#ifndef PCI_DEVICE_ID_MATROX_G100
-#define PCI_DEVICE_ID_MATROX_G100 0x1000
-#endif
-#ifndef PCI_DEVICE_ID_MATROX_G100_AGP
-#define PCI_DEVICE_ID_MATROX_G100_AGP 0x1001
-#endif
-#ifndef PCI_DEVICE_ID_MATROX_G400_AGP
-#define PCI_DEVICE_ID_MATROX_G400_AGP 0x0525
-#endif
-
-#ifndef PCI_SS_ID_MATROX_PRODUCTIVA_G100_AGP
-#define PCI_SS_ID_MATROX_GENERIC 0xFF00
-#define PCI_SS_ID_MATROX_PRODUCTIVA_G100_AGP 0xFF01
-#define PCI_SS_ID_MATROX_MYSTIQUE_G200_AGP 0xFF02
-#define PCI_SS_ID_MATROX_MILLENIUM_G200_AGP 0xFF03
-#define PCI_SS_ID_MATROX_MARVEL_G200_AGP 0xFF04
-#define PCI_SS_ID_MATROX_MGA_G100_PCI 0xFF05
-#define PCI_SS_ID_MATROX_MGA_G100_AGP 0x1001
-#define PCI_SS_ID_SIEMENS_MGA_G100_AGP 0x001E /* 30 */
-#define PCI_SS_ID_SIEMENS_MGA_G200_AGP 0x0032 /* 50 */
-#endif
-
-#define MX_VISUAL_TRUECOLOR FB_VISUAL_DIRECTCOLOR
-#define MX_VISUAL_DIRECTCOLOR FB_VISUAL_TRUECOLOR
-#define MX_VISUAL_PSEUDOCOLOR FB_VISUAL_PSEUDOCOLOR
-
-#define CNVT_TOHW(val,width) ((((val)<<(width))+0x7FFF-(val))>>16)
-
-/* G100, G200 and Mystique have (almost) same DAC */
-#undef NEED_DAC1064
-#if defined(CONFIG_FB_MATROX_MYSTIQUE) || defined(CONFIG_FB_MATROX_G100)
-#define NEED_DAC1064 1
-#endif
-
-typedef struct {
- u_int8_t* vaddr;
-} vaddr_t;
-
-#ifdef READx_WORKS
-static inline unsigned int mga_readb(vaddr_t va, unsigned int offs) {
- return readb(va.vaddr + offs);
-}
-
-static inline unsigned int mga_readw(vaddr_t va, unsigned int offs) {
- return readw(va.vaddr + offs);
-}
-
-static inline u_int32_t mga_readl(vaddr_t va, unsigned int offs) {
- return readl(va.vaddr + offs);
-}
-
-static inline void mga_writeb(vaddr_t va, unsigned int offs, u_int8_t value) {
- writeb(value, va.vaddr + offs);
-}
-
-static inline void mga_writew(vaddr_t va, unsigned int offs, u_int16_t value) {
- writew(value, va.vaddr + offs);
-}
-
-static inline void mga_writel(vaddr_t va, unsigned int offs, u_int32_t value) {
- writel(value, va.vaddr + offs);
-}
-#else
-static inline unsigned int mga_readb(vaddr_t va, unsigned int offs) {
- return *(volatile u_int8_t*)(va.vaddr + offs);
-}
-
-static inline unsigned int mga_readw(vaddr_t va, unsigned int offs) {
- return *(volatile u_int16_t*)(va.vaddr + offs);
-}
-
-static inline u_int32_t mga_readl(vaddr_t va, unsigned int offs) {
- return *(volatile u_int32_t*)(va.vaddr + offs);
-}
-
-static inline void mga_writeb(vaddr_t va, unsigned int offs, u_int8_t value) {
- *(volatile u_int8_t*)(va.vaddr + offs) = value;
-}
-
-static inline void mga_writew(vaddr_t va, unsigned int offs, u_int16_t value) {
- *(volatile u_int16_t*)(va.vaddr + offs) = value;
-}
-
-static inline void mga_writel(vaddr_t va, unsigned int offs, u_int32_t value) {
- *(volatile u_int32_t*)(va.vaddr + offs) = value;
-}
-#endif
-
-static inline void mga_memcpy_toio(vaddr_t va, unsigned int offs, const void* src, int len) {
-#ifdef MEMCPYTOIO_WORKS
- memcpy_toio(va.vaddr + offs, src, len);
-#elif defined(MEMCPYTOIO_WRITEL)
-#define srcd ((const u_int32_t*)src)
- if (offs & 3) {
- while (len >= 4) {
- mga_writel(va, offs, get_unaligned(srcd++));
- offs += 4;
- len -= 4;
- }
- } else {
- while (len >= 4) {
- mga_writel(va, offs, *srcd++);
- offs += 4;
- len -= 4;
- }
- }
-#undef srcd
- if (len) {
- u_int32_t tmp;
-
- memcpy(&tmp, src, len);
- mga_writel(va, offs, tmp);
- }
-#elif defined(MEMCPYTOIO_MEMCPY)
- memcpy(va.vaddr + offs, src, len);
-#else
-#error "Sorry, do not know how to write block of data to device"
-#endif
-}
-
-static inline void vaddr_add(vaddr_t* va, unsigned long offs) {
- va->vaddr += offs;
-}
-
-static inline void* vaddr_va(vaddr_t va) {
- return va.vaddr;
-}
-
-#define MGA_IOREMAP_NORMAL 0
-#define MGA_IOREMAP_NOCACHE 1
-
-#define MGA_IOREMAP_FB MGA_IOREMAP_NOCACHE
-#define MGA_IOREMAP_MMIO MGA_IOREMAP_NOCACHE
-static inline int mga_ioremap(unsigned long phys, unsigned long size, int flags, vaddr_t* virt) {
-#ifdef MAP_IOREMAP
- if (flags & MGA_IOREMAP_NOCACHE)
- virt->vaddr = ioremap_nocache(phys, size);
- else
- virt->vaddr = ioremap(phys, size);
-#else
-#ifdef MAP_BUSTOVIRT
- virt->vaddr = bus_to_virt(phys);
-#else
-#error "Your architecture does not have neither ioremap nor bus_to_virt... Giving up"
-#endif
-#endif
- return (virt->vaddr == 0); /* 0, !0... 0, error_code in future */
-}
-
-static inline void mga_iounmap(vaddr_t va) {
-#ifdef MAP_IOREMAP
- iounmap(va.vaddr);
-#endif
-}
-
-struct matroxfb_par
-{
- unsigned int final_bppShift;
- unsigned int cmap_len;
- struct {
- unsigned int bytes;
- unsigned int pixels;
- unsigned int chunks;
- } ydstorg;
- void (*putc)(u_int32_t, u_int32_t, struct display*, int, int, int);
- void (*putcs)(u_int32_t, u_int32_t, struct display*, const unsigned short*, int, int, int);
-};
-
-struct my_timming {
- unsigned int pixclock;
- unsigned int HDisplay;
- unsigned int HSyncStart;
- unsigned int HSyncEnd;
- unsigned int HTotal;
- unsigned int VDisplay;
- unsigned int VSyncStart;
- unsigned int VSyncEnd;
- unsigned int VTotal;
- unsigned int sync;
- int dblscan;
- int interlaced;
-};
-
-struct matrox_fb_info;
-
-#define MATROX_2MB_WITH_4MB_ADDON
-
-struct matrox_pll_features {
- unsigned int vco_freq_min;
- unsigned int ref_freq;
- unsigned int feed_div_min;
- unsigned int feed_div_max;
- unsigned int in_div_min;
- unsigned int in_div_max;
- unsigned int post_shift_max;
-};
-
-struct matrox_DAC1064_features {
- u_int8_t xvrefctrl;
- unsigned int cursorimage;
-};
-
-struct matrox_accel_features {
- int has_cacheflush;
-};
-
-/* current hardware status */
-struct matrox_hw_state {
- u_int32_t MXoptionReg;
- unsigned char DACclk[6];
- unsigned char DACreg[64];
- unsigned char MiscOutReg;
- unsigned char DACpal[768];
- unsigned char CRTC[25];
- unsigned char CRTCEXT[9];
- unsigned char SEQ[5];
- /* unused for MGA mode, but who knows... */
- unsigned char GCTL[9];
- /* unused for MGA mode, but who knows... */
- unsigned char ATTR[21];
-};
-
-struct matrox_accel_data {
-#ifdef CONFIG_FB_MATROX_MILLENIUM
- unsigned char ramdac_rev;
-#endif
- u_int32_t m_dwg_rect;
- u_int32_t m_opmode;
-};
-
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
-#define ACCESS_FBINFO2(info, x) (info->x)
-#define ACCESS_FBINFO(x) ACCESS_FBINFO2(minfo,x)
-
-#define MINFO minfo
-
-#define WPMINFO struct matrox_fb_info* minfo,
-#define CPMINFO const struct matrox_fb_info* minfo,
-#define PMINFO minfo,
-
-static inline struct matrox_fb_info* mxinfo(const struct display* p) {
- return (struct matrox_fb_info*)p->fb_info;
-}
-
-#define PMXINFO(p) mxinfo(p),
-#define MINFO_FROM(x) struct matrox_fb_info* minfo = x
-#define MINFO_FROM_DISP(x) MINFO_FROM(mxinfo(x))
-
-#else
-
-struct matrox_fb_info global_mxinfo;
-struct display global_disp;
-
-#define ACCESS_FBINFO(x) (global_mxinfo.x)
-#define ACCESS_FBINFO2(info, x) (global_mxinfo.x)
-
-#define MINFO (&global_mxinfo)
-
-#define WPMINFO
-#define CPMINFO
-#define PMINFO
-
-#if 0
-static inline struct matrox_fb_info* mxinfo(const struct display* p) {
- return &global_mxinfo;
-}
-#endif
-
-#define PMXINFO(p)
-#define MINFO_FROM(x)
-#define MINFO_FROM_DISP(x)
-
-#endif
-
-struct matrox_switch {
- int (*preinit)(WPMINFO struct matrox_hw_state*);
- void (*reset)(WPMINFO struct matrox_hw_state*);
- int (*init)(CPMINFO struct matrox_hw_state*, struct my_timming*, struct display*);
- void (*restore)(WPMINFO struct matrox_hw_state*, struct matrox_hw_state*, struct display*);
-};
-
-struct matrox_fb_info {
- /* fb_info must be first */
- struct fb_info fbcon;
-
- struct matrox_fb_info* next_fb;
-
- struct matroxfb_par curr;
- struct matrox_hw_state hw1;
- struct matrox_hw_state hw2;
- struct matrox_hw_state* newhw;
- struct matrox_hw_state* currenthw;
-
- struct matrox_accel_data accel;
-
- struct pci_dev* pcidev;
-
- struct {
- unsigned long base; /* physical */
- vaddr_t vbase; /* CPU view */
- unsigned int len;
- unsigned int len_usable;
- } video;
-
- struct {
- unsigned long base; /* physical */
- vaddr_t vbase; /* CPU view */
- unsigned int len;
- } mmio;
-
- unsigned int max_pixel_clock;
-
- struct matrox_switch* hw_switch;
- int currcon;
- struct display* currcon_display;
-
- struct {
- struct matrox_pll_features pll;
- struct matrox_DAC1064_features DAC1064;
- struct matrox_accel_features accel;
- } features;
- struct {
- spinlock_t DAC;
- } lock;
-
- int interleave;
- int millenium;
- int milleniumII;
- struct {
- int cfb4;
- const int* vxres;
- int cross4MB;
- int text;
- int plnwt;
- } capable;
- struct {
- unsigned int size;
- unsigned int mgabase;
- vaddr_t vbase;
- } fastfont;
-#ifdef CONFIG_MTRR
- struct {
- int vram;
- int vram_valid;
- } mtrr;
-#endif
- struct {
- int precise_width;
- int mga_24bpp_fix;
- int novga;
- int nobios;
- int nopciretry;
- int noinit;
- int inverse;
- int hwcursor;
- int blink;
- int sgram;
-#ifdef CONFIG_FB_MATROX_32MB
- int support32MB;
-#endif
-
- int accelerator;
- int text_type_aux;
- int video64bits;
- unsigned int vgastep;
- unsigned int textmode;
- unsigned int textstep;
- unsigned int textvram; /* character cells */
- unsigned int ydstorg; /* offset in bytes from video start to usable memory */
- /* 0 except for 6MB Millenium */
- } devflags;
- struct display_switch dispsw;
- struct {
- int x;
- int y;
- unsigned int w;
- unsigned int u;
- unsigned int d;
- unsigned int type;
- int state;
- int redraw;
- struct timer_list timer;
- } cursor;
-#if defined(FBCON_HAS_CFB16) || defined(FBCON_HAS_CFB24) || defined(FBCON_HAS_CFB32)
- union {
-#ifdef FBCON_HAS_CFB16
- u_int16_t cfb16[16];
-#endif
-#ifdef FBCON_HAS_CFB24
- u_int32_t cfb24[16];
-#endif
-#ifdef FBCON_HAS_CFB32
- u_int32_t cfb32[16];
-#endif
- } cmap;
-#endif
- struct { unsigned red, green, blue, transp; } palette[256];
-#if defined(CONFIG_FB_OF) && defined(CONFIG_FB_COMPAT_XPMAC)
- char matrox_name[32];
-#endif
-};
-
-#if defined(CONFIG_FB_OF)
-unsigned char nvram_read_byte(int);
-int matrox_of_init(struct device_node *dp);
-static int default_vmode = VMODE_NVRAM;
-static int default_cmode = CMODE_NVRAM;
-#endif
-
-#define curr_ydstorg(x) ACCESS_FBINFO2(x, curr.ydstorg.pixels)
-
-#define PCI_OPTION_REG 0x40
-#define PCI_MGA_INDEX 0x44
-#define PCI_MGA_DATA 0x48
-
-#define M_DWGCTL 0x1C00
-#define M_MACCESS 0x1C04
-#define M_CTLWTST 0x1C08
-
-#define M_PLNWT 0x1C1C
-
-#define M_BCOL 0x1C20
-#define M_FCOL 0x1C24
-
-#define M_SGN 0x1C58
-#define M_LEN 0x1C5C
-#define M_AR0 0x1C60
-#define M_AR1 0x1C64
-#define M_AR2 0x1C68
-#define M_AR3 0x1C6C
-#define M_AR4 0x1C70
-#define M_AR5 0x1C74
-#define M_AR6 0x1C78
-
-#define M_CXBNDRY 0x1C80
-#define M_FXBNDRY 0x1C84
-#define M_YDSTLEN 0x1C88
-#define M_PITCH 0x1C8C
-#define M_YDST 0x1C90
-#define M_YDSTORG 0x1C94
-#define M_YTOP 0x1C98
-#define M_YBOT 0x1C9C
-
-/* mystique only */
-#define M_CACHEFLUSH 0x1FFF
-
-#define M_EXEC 0x0100
-
-#define M_DWG_TRAP 0x04
-#define M_DWG_BITBLT 0x08
-#define M_DWG_ILOAD 0x09
-
-#define M_DWG_LINEAR 0x0080
-#define M_DWG_SOLID 0x0800
-#define M_DWG_ARZERO 0x1000
-#define M_DWG_SGNZERO 0x2000
-#define M_DWG_SHIFTZERO 0x4000
-
-#define M_DWG_REPLACE 0x000C0000
-#define M_DWG_REPLACE2 (M_DWG_REPLACE | 0x40)
-#define M_DWG_XOR 0x00060010
-
-#define M_DWG_BFCOL 0x04000000
-#define M_DWG_BMONOWF 0x08000000
-
-#define M_DWG_TRANSC 0x40000000
-
-#define M_FIFOSTATUS 0x1E10
-#define M_STATUS 0x1E14
-
-#define M_IEN 0x1E1C
-
-#define M_VCOUNT 0x1E20
-
-#define M_RESET 0x1E40
-
-#define M_AGP2PLL 0x1E4C
-
-#define M_OPMODE 0x1E54
-#define M_OPMODE_DMA_GEN_WRITE 0x00
-#define M_OPMODE_DMA_BLIT 0x04
-#define M_OPMODE_DMA_VECTOR_WRITE 0x08
-#define M_OPMODE_DMA_LE 0x0000 /* little endian - no transformation */
-#define M_OPMODE_DMA_BE_8BPP 0x0000
-#define M_OPMODE_DMA_BE_16BPP 0x0100
-#define M_OPMODE_DMA_BE_32BPP 0x0200
-#define M_OPMODE_DIR_LE 0x000000 /* little endian - no transformation */
-#define M_OPMODE_DIR_BE_8BPP 0x000000
-#define M_OPMODE_DIR_BE_16BPP 0x010000
-#define M_OPMODE_DIR_BE_32BPP 0x020000
-
-#define M_ATTR_INDEX 0x1FC0
-#define M_ATTR_DATA 0x1FC1
-
-#define M_MISC_REG 0x1FC2
-#define M_3C2_RD 0x1FC2
-
-#define M_SEQ_INDEX 0x1FC4
-#define M_SEQ_DATA 0x1FC5
-
-#define M_MISC_REG_READ 0x1FCC
-
-#define M_GRAPHICS_INDEX 0x1FCE
-#define M_GRAPHICS_DATA 0x1FCF
-
-#define M_CRTC_INDEX 0x1FD4
-
-#define M_ATTR_RESET 0x1FDA
-#define M_3DA_WR 0x1FDA
-
-#define M_EXTVGA_INDEX 0x1FDE
-#define M_EXTVGA_DATA 0x1FDF
-
-/* G200 only */
-#define M_SRCORG 0x2CB4
-
-#define M_RAMDAC_BASE 0x3C00
-
-/* fortunately, same on TVP3026 and MGA1064 */
-#define M_DAC_REG (M_RAMDAC_BASE+0)
-#define M_DAC_VAL (M_RAMDAC_BASE+1)
-#define M_PALETTE_MASK (M_RAMDAC_BASE+2)
-
-#define M_X_INDEX 0x00
-#define M_X_DATAREG 0x0A
-
-#define DAC_XGENIOCTRL 0x2A
-#define DAC_XGENIODATA 0x2B
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-#define TVP3026_INDEX 0x00
-#define TVP3026_PALWRADD 0x00
-#define TVP3026_PALDATA 0x01
-#define TVP3026_PIXRDMSK 0x02
-#define TVP3026_PALRDADD 0x03
-#define TVP3026_CURCOLWRADD 0x04
-#define TVP3026_CLOVERSCAN 0x00
-#define TVP3026_CLCOLOR0 0x01
-#define TVP3026_CLCOLOR1 0x02
-#define TVP3026_CLCOLOR2 0x03
-#define TVP3026_CURCOLDATA 0x05
-#define TVP3026_CURCOLRDADD 0x07
-#define TVP3026_CURCTRL 0x09
-#define TVP3026_X_DATAREG 0x0A
-#define TVP3026_CURRAMDATA 0x0B
-#define TVP3026_CURPOSXL 0x0C
-#define TVP3026_CURPOSXH 0x0D
-#define TVP3026_CURPOSYL 0x0E
-#define TVP3026_CURPOSYH 0x0F
-
-#define TVP3026_XSILICONREV 0x01
-#define TVP3026_XCURCTRL 0x06
-#define TVP3026_XCURCTRL_DIS 0x00 /* transparent, transparent, transparent, transparent */
-#define TVP3026_XCURCTRL_3COLOR 0x01 /* transparent, 0, 1, 2 */
-#define TVP3026_XCURCTRL_XGA 0x02 /* 0, 1, transparent, complement */
-#define TVP3026_XCURCTRL_XWIN 0x03 /* transparent, transparent, 0, 1 */
-#define TVP3026_XCURCTRL_BLANK2048 0x00
-#define TVP3026_XCURCTRL_BLANK4096 0x10
-#define TVP3026_XCURCTRL_INTERLACED 0x20
-#define TVP3026_XCURCTRL_ODD 0x00 /* ext.signal ODD/\EVEN */
-#define TVP3026_XCURCTRL_EVEN 0x40 /* ext.signal EVEN/\ODD */
-#define TVP3026_XCURCTRL_INDIRECT 0x00
-#define TVP3026_XCURCTRL_DIRECT 0x80
-#define TVP3026_XLATCHCTRL 0x0F
-#define TVP3026_XLATCHCTRL_1_1 0x06
-#define TVP3026_XLATCHCTRL_2_1 0x07
-#define TVP3026_XLATCHCTRL_4_1 0x06
-#define TVP3026_XLATCHCTRL_8_1 0x06
-#define TVP3026_XLATCHCTRL_16_1 0x06
-#define TVP3026A_XLATCHCTRL_4_3 0x06 /* ??? do not understand... but it works... !!! */
-#define TVP3026A_XLATCHCTRL_8_3 0x07
-#define TVP3026B_XLATCHCTRL_4_3 0x08
-#define TVP3026B_XLATCHCTRL_8_3 0x06 /* ??? do not understand... but it works... !!! */
-#define TVP3026_XTRUECOLORCTRL 0x18
-#define TVP3026_XTRUECOLORCTRL_VRAM_SHIFT_ACCEL 0x00
-#define TVP3026_XTRUECOLORCTRL_VRAM_SHIFT_TVP 0x20
-#define TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR 0x80
-#define TVP3026_XTRUECOLORCTRL_TRUECOLOR 0x40 /* paletized */
-#define TVP3026_XTRUECOLORCTRL_DIRECTCOLOR 0x00
-#define TVP3026_XTRUECOLORCTRL_24_ALTERNATE 0x08 /* 5:4/5:2 instead of 4:3/8:3 */
-#define TVP3026_XTRUECOLORCTRL_RGB_888 0x16 /* 4:3/8:3 (or 5:4/5:2) */
-#define TVP3026_XTRUECOLORCTRL_BGR_888 0x17
-#define TVP3026_XTRUECOLORCTRL_ORGB_8888 0x06
-#define TVP3026_XTRUECOLORCTRL_BGRO_8888 0x07
-#define TVP3026_XTRUECOLORCTRL_RGB_565 0x05
-#define TVP3026_XTRUECOLORCTRL_ORGB_1555 0x04
-#define TVP3026_XTRUECOLORCTRL_RGB_664 0x03
-#define TVP3026_XTRUECOLORCTRL_RGBO_4444 0x01
-#define TVP3026_XMUXCTRL 0x19
-#define TVP3026_XMUXCTRL_MEMORY_8BIT 0x01 /* - */
-#define TVP3026_XMUXCTRL_MEMORY_16BIT 0x02 /* - */
-#define TVP3026_XMUXCTRL_MEMORY_32BIT 0x03 /* 2MB RAM, 512K * 4 */
-#define TVP3026_XMUXCTRL_MEMORY_64BIT 0x04 /* >2MB RAM, 512K * 8 & more */
-#define TVP3026_XMUXCTRL_PIXEL_4BIT 0x40 /* L0,H0,L1,H1... */
-#define TVP3026_XMUXCTRL_PIXEL_4BIT_SWAPPED 0x60 /* H0,L0,H1,L1... */
-#define TVP3026_XMUXCTRL_PIXEL_8BIT 0x48
-#define TVP3026_XMUXCTRL_PIXEL_16BIT 0x50
-#define TVP3026_XMUXCTRL_PIXEL_32BIT 0x58
-#define TVP3026_XMUXCTRL_VGA 0x98 /* VGA MEMORY, 8BIT PIXEL */
-#define TVP3026_XCLKCTRL 0x1A
-#define TVP3026_XCLKCTRL_DIV1 0x00
-#define TVP3026_XCLKCTRL_DIV2 0x10
-#define TVP3026_XCLKCTRL_DIV4 0x20
-#define TVP3026_XCLKCTRL_DIV8 0x30
-#define TVP3026_XCLKCTRL_DIV16 0x40
-#define TVP3026_XCLKCTRL_DIV32 0x50
-#define TVP3026_XCLKCTRL_DIV64 0x60
-#define TVP3026_XCLKCTRL_CLKSTOPPED 0x70
-#define TVP3026_XCLKCTRL_SRC_CLK0 0x00
-#define TVP3026_XCLKCTRL_SRC_CLK1 0x01
-#define TVP3026_XCLKCTRL_SRC_CLK2 0x02 /* CLK2 is TTL source*/
-#define TVP3026_XCLKCTRL_SRC_NCLK2 0x03 /* not CLK2 is TTL source */
-#define TVP3026_XCLKCTRL_SRC_ECLK2 0x04 /* CLK2 and not CLK2 is ECL source */
-#define TVP3026_XCLKCTRL_SRC_PLL 0x05
-#define TVP3026_XCLKCTRL_SRC_DIS 0x06 /* disable & poweroff internal clock */
-#define TVP3026_XCLKCTRL_SRC_CLK0VGA 0x07
-#define TVP3026_XPALETTEPAGE 0x1C
-#define TVP3026_XGENCTRL 0x1D
-#define TVP3026_XGENCTRL_HSYNC_POS 0x00
-#define TVP3026_XGENCTRL_HSYNC_NEG 0x01
-#define TVP3026_XGENCTRL_VSYNC_POS 0x00
-#define TVP3026_XGENCTRL_VSYNC_NEG 0x02
-#define TVP3026_XGENCTRL_LITTLE_ENDIAN 0x00
-#define TVP3026_XGENCTRL_BIG_ENDIAN 0x08
-#define TVP3026_XGENCTRL_BLACK_0IRE 0x00
-#define TVP3026_XGENCTRL_BLACK_75IRE 0x10
-#define TVP3026_XGENCTRL_NO_SYNC_ON_GREEN 0x00
-#define TVP3026_XGENCTRL_SYNC_ON_GREEN 0x20
-#define TVP3026_XGENCTRL_OVERSCAN_DIS 0x00
-#define TVP3026_XGENCTRL_OVERSCAN_EN 0x40
-#define TVP3026_XMISCCTRL 0x1E
-#define TVP3026_XMISCCTRL_DAC_PUP 0x00
-#define TVP3026_XMISCCTRL_DAC_PDOWN 0x01
-#define TVP3026_XMISCCTRL_DAC_EXT 0x00 /* or 8, bit 3 is ignored */
-#define TVP3026_XMISCCTRL_DAC_6BIT 0x04
-#define TVP3026_XMISCCTRL_DAC_8BIT 0x0C
-#define TVP3026_XMISCCTRL_PSEL_DIS 0x00
-#define TVP3026_XMISCCTRL_PSEL_EN 0x10
-#define TVP3026_XMISCCTRL_PSEL_LOW 0x00 /* PSEL high selects directcolor */
-#define TVP3026_XMISCCTRL_PSEL_HIGH 0x20 /* PSEL high selects truecolor or pseudocolor */
-#define TVP3026_XGENIOCTRL 0x2A
-#define TVP3026_XGENIODATA 0x2B
-#define TVP3026_XPLLADDR 0x2C
-#define TVP3026_XPLLADDR_X(LOOP,MCLK,PIX) (((LOOP)<<4) | ((MCLK)<<2) | (PIX))
-#define TVP3026_XPLLDATA_N 0x00
-#define TVP3026_XPLLDATA_M 0x01
-#define TVP3026_XPLLDATA_P 0x02
-#define TVP3026_XPLLDATA_STAT 0x03
-#define TVP3026_XPIXPLLDATA 0x2D
-#define TVP3026_XMEMPLLDATA 0x2E
-#define TVP3026_XLOOPPLLDATA 0x2F
-#define TVP3026_XCOLKEYOVRMIN 0x30
-#define TVP3026_XCOLKEYOVRMAX 0x31
-#define TVP3026_XCOLKEYREDMIN 0x32
-#define TVP3026_XCOLKEYREDMAX 0x33
-#define TVP3026_XCOLKEYGREENMIN 0x34
-#define TVP3026_XCOLKEYGREENMAX 0x35
-#define TVP3026_XCOLKEYBLUEMIN 0x36
-#define TVP3026_XCOLKEYBLUEMAX 0x37
-#define TVP3026_XCOLKEYCTRL 0x38
-#define TVP3026_XCOLKEYCTRL_OVR_EN 0x01
-#define TVP3026_XCOLKEYCTRL_RED_EN 0x02
-#define TVP3026_XCOLKEYCTRL_GREEN_EN 0x04
-#define TVP3026_XCOLKEYCTRL_BLUE_EN 0x08
-#define TVP3026_XCOLKEYCTRL_NEGATE 0x10
-#define TVP3026_XCOLKEYCTRL_ZOOM1 0x00
-#define TVP3026_XCOLKEYCTRL_ZOOM2 0x20
-#define TVP3026_XCOLKEYCTRL_ZOOM4 0x40
-#define TVP3026_XCOLKEYCTRL_ZOOM8 0x60
-#define TVP3026_XCOLKEYCTRL_ZOOM16 0x80
-#define TVP3026_XCOLKEYCTRL_ZOOM32 0xA0
-#define TVP3026_XMEMPLLCTRL 0x39
-#define TVP3026_XMEMPLLCTRL_DIV(X) (((X)-1)>>1) /* 2,4,6,8,10,12,14,16, division applied to LOOP PLL after divide by 2^P */
-#define TVP3026_XMEMPLLCTRL_STROBEMKC4 0x08
-#define TVP3026_XMEMPLLCTRL_MCLK_DOTCLOCK 0x00 /* MKC4 */
-#define TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL 0x10 /* MKC4 */
-#define TVP3026_XMEMPLLCTRL_RCLK_PIXPLL 0x00
-#define TVP3026_XMEMPLLCTRL_RCLK_LOOPPLL 0x20
-#define TVP3026_XMEMPLLCTRL_RCLK_DOTDIVN 0x40 /* dot clock divided by loop pclk N prescaler */
-#define TVP3026_XSENSETEST 0x3A
-#define TVP3026_XTESTMODEDATA 0x3B
-#define TVP3026_XCRCREML 0x3C
-#define TVP3026_XCRCREMH 0x3D
-#define TVP3026_XCRCBITSEL 0x3E
-#define TVP3026_XID 0x3F
-
-#endif
-
-#ifdef NEED_DAC1064
-
-#define DAC1064_OPT_SCLK_PCI 0x00
-#define DAC1064_OPT_SCLK_PLL 0x01
-#define DAC1064_OPT_SCLK_EXT 0x02
-#define DAC1064_OPT_SCLK_MASK 0x03
-#define DAC1064_OPT_GDIV1 0x04 /* maybe it is GDIV2 on G100 ?! */
-#define DAC1064_OPT_GDIV3 0x00
-#define DAC1064_OPT_MDIV1 0x08
-#define DAC1064_OPT_MDIV2 0x00
-#define DAC1064_OPT_RESERVED 0x10
-
-#define M1064_INDEX 0x00
-#define M1064_PALWRADD 0x00
-#define M1064_PALDATA 0x01
-#define M1064_PIXRDMSK 0x02
-#define M1064_PALRDADD 0x03
-#define M1064_X_DATAREG 0x0A
-#define M1064_CURPOSXL 0x0C /* can be accessed as DWORD */
-#define M1064_CURPOSXH 0x0D
-#define M1064_CURPOSYL 0x0E
-#define M1064_CURPOSYH 0x0F
-
-#define M1064_XCURADDL 0x04
-#define M1064_XCURADDH 0x05
-#define M1064_XCURCTRL 0x06
-#define M1064_XCURCTRL_DIS 0x00 /* transparent, transparent, transparent, transparent */
-#define M1064_XCURCTRL_3COLOR 0x01 /* transparent, 0, 1, 2 */
-#define M1064_XCURCTRL_XGA 0x02 /* 0, 1, transparent, complement */
-#define M1064_XCURCTRL_XWIN 0x03 /* transparent, transparent, 0, 1 */
-#define M1064_XCURCOL0RED 0x08
-#define M1064_XCURCOL0GREEN 0x09
-#define M1064_XCURCOL0BLUE 0x0A
-#define M1064_XCURCOL1RED 0x0C
-#define M1064_XCURCOL1GREEN 0x0D
-#define M1064_XCURCOL1BLUE 0x0E
-#define M1064_XCURCOL2RED 0x10
-#define M1064_XCURCOL2GREEN 0x11
-#define M1064_XCURCOL2BLUE 0x12
-#define DAC1064_XVREFCTRL 0x18
-#define DAC1064_XVREFCTRL_INTERNAL 0x3F
-#define DAC1064_XVREFCTRL_EXTERNAL 0x00
-#define DAC1064_XVREFCTRL_G100_DEFAULT 0x03
-#define M1064_XMULCTRL 0x19
-#define M1064_XMULCTRL_DEPTH_8BPP 0x00 /* 8 bpp paletized */
-#define M1064_XMULCTRL_DEPTH_15BPP_1BPP 0x01 /* 15 bpp paletized + 1 bpp overlay */
-#define M1064_XMULCTRL_DEPTH_16BPP 0x02 /* 16 bpp paletized */
-#define M1064_XMULCTRL_DEPTH_24BPP 0x03 /* 24 bpp paletized */
-#define M1064_XMULCTRL_DEPTH_24BPP_8BPP 0x04 /* 24 bpp direct + 8 bpp overlay paletized */
-#define M1064_XMULCTRL_2G8V16 0x05 /* 15 bpp video direct, half xres, 8bpp paletized */
-#define M1064_XMULCTRL_G16V16 0x06 /* 15 bpp video, 15bpp graphics, one of them paletized */
-#define M1064_XMULCTRL_DEPTH_32BPP 0x07 /* 24 bpp paletized + 8 bpp unused */
-#define M1064_XMULCTRL_GRAPHICS_PALETIZED 0x00
-#define M1064_XMULCTRL_VIDEO_PALETIZED 0x08
-#define M1064_XPIXCLKCTRL 0x1A
-#define M1064_XPIXCLKCTRL_SRC_PCI 0x00
-#define M1064_XPIXCLKCTRL_SRC_PLL 0x01
-#define M1064_XPIXCLKCTRL_SRC_EXT 0x02
-#define M1064_XPIXCLKCTRL_SRC_MASK 0x03
-#define M1064_XPIXCLKCTRL_EN 0x00
-#define M1064_XPIXCLKCTRL_DIS 0x04
-#define M1064_XPIXCLKCTRL_PLL_DOWN 0x00
-#define M1064_XPIXCLKCTRL_PLL_UP 0x08
-#define M1064_XGENCTRL 0x1D
-#define M1064_XGENCTRL_VS_0 0x00
-#define M1064_XGENCTRL_VS_1 0x01
-#define M1064_XGENCTRL_ALPHA_DIS 0x00
-#define M1064_XGENCTRL_ALPHA_EN 0x02
-#define M1064_XGENCTRL_BLACK_0IRE 0x00
-#define M1064_XGENCTRL_BLACK_75IRE 0x10
-#define M1064_XGENCTRL_SYNC_ON_GREEN 0x00
-#define M1064_XGENCTRL_NO_SYNC_ON_GREEN 0x20
-#define M1064_XGENCTRL_SYNC_ON_GREEN_MASK 0x20
-#define M1064_XMISCCTRL 0x1E
-#define M1064_XMISCCTRL_DAC_DIS 0x00
-#define M1064_XMISCCTRL_DAC_EN 0x01
-#define M1064_XMISCCTRL_MFC_VGA 0x00
-#define M1064_XMISCCTRL_MFC_MAFC 0x02
-#define M1064_XMISCCTRL_MFC_DIS 0x06
-#define M1064_XMISCCTRL_DAC_6BIT 0x00
-#define M1064_XMISCCTRL_DAC_8BIT 0x08
-#define M1064_XMISCCTRL_LUT_DIS 0x00
-#define M1064_XMISCCTRL_LUT_EN 0x10
-#define M1064_XGENIOCTRL 0x2A
-#define M1064_XGENIODATA 0x2B
-#define DAC1064_XSYSPLLM 0x2C
-#define DAC1064_XSYSPLLN 0x2D
-#define DAC1064_XSYSPLLP 0x2E
-#define DAC1064_XSYSPLLSTAT 0x2F
-#define M1064_XZOOMCTRL 0x38
-#define M1064_XZOOMCTRL_1 0x00
-#define M1064_XZOOMCTRL_2 0x01
-#define M1064_XZOOMCTRL_4 0x03
-#define M1064_XSENSETEST 0x3A
-#define M1064_XSENSETEST_BCOMP 0x01
-#define M1064_XSENSETEST_GCOMP 0x02
-#define M1064_XSENSETEST_RCOMP 0x04
-#define M1064_XSENSETEST_PDOWN 0x00
-#define M1064_XSENSETEST_PUP 0x80
-#define M1064_XCRCREML 0x3C
-#define M1064_XCRCREMH 0x3D
-#define M1064_XCRCBITSEL 0x3E
-#define M1064_XCOLKEYMASKL 0x40
-#define M1064_XCOLKEYMASKH 0x41
-#define M1064_XCOLKEYL 0x42
-#define M1064_XCOLKEYH 0x43
-#define M1064_XPIXPLLAM 0x44
-#define M1064_XPIXPLLAN 0x45
-#define M1064_XPIXPLLAP 0x46
-#define M1064_XPIXPLLBM 0x48
-#define M1064_XPIXPLLBN 0x49
-#define M1064_XPIXPLLBP 0x4A
-#define M1064_XPIXPLLCM 0x4C
-#define M1064_XPIXPLLCN 0x4D
-#define M1064_XPIXPLLCP 0x4E
-#define M1064_XPIXPLLSTAT 0x4F
-
-#endif
-
-#ifdef __LITTLE_ENDIAN
-#define MX_OPTION_BSWAP 0x00000000
-
-#define M_OPMODE_4BPP (M_OPMODE_DMA_LE | M_OPMODE_DIR_LE | M_OPMODE_DMA_BLIT)
-#define M_OPMODE_8BPP (M_OPMODE_DMA_LE | M_OPMODE_DIR_LE | M_OPMODE_DMA_BLIT)
-#define M_OPMODE_16BPP (M_OPMODE_DMA_LE | M_OPMODE_DIR_LE | M_OPMODE_DMA_BLIT)
-#define M_OPMODE_24BPP (M_OPMODE_DMA_LE | M_OPMODE_DIR_LE | M_OPMODE_DMA_BLIT)
-#define M_OPMODE_32BPP (M_OPMODE_DMA_LE | M_OPMODE_DIR_LE | M_OPMODE_DMA_BLIT)
-#else
-#ifdef __BIG_ENDIAN
-#define MX_OPTION_BSWAP 0x80000000
-
-#define M_OPMODE_4BPP (M_OPMODE_DMA_LE | M_OPMODE_DIR_LE | M_OPMODE_DMA_BLIT) /* TODO */
-#define M_OPMODE_8BPP (M_OPMODE_DMA_BE_8BPP | M_OPMODE_DIR_BE_8BPP | M_OPMODE_DMA_BLIT)
-#define M_OPMODE_16BPP (M_OPMODE_DMA_BE_16BPP | M_OPMODE_DIR_BE_16BPP | M_OPMODE_DMA_BLIT)
-#define M_OPMODE_24BPP (M_OPMODE_DMA_BE_8BPP | M_OPMODE_DIR_BE_8BPP | M_OPMODE_DMA_BLIT) /* TODO, ?32 */
-#define M_OPMODE_32BPP (M_OPMODE_DMA_BE_32BPP | M_OPMODE_DIR_BE_32BPP | M_OPMODE_DMA_BLIT)
-#else
-#error "Byte ordering have to be defined. Cannot continue."
-#endif
-#endif
-
-#define mga_inb(addr) mga_readb(ACCESS_FBINFO(mmio.vbase), (addr))
-#define mga_inl(addr) mga_readl(ACCESS_FBINFO(mmio.vbase), (addr))
-#define mga_outb(addr,val) mga_writeb(ACCESS_FBINFO(mmio.vbase), (addr), (val))
-#define mga_outw(addr,val) mga_writew(ACCESS_FBINFO(mmio.vbase), (addr), (val))
-#define mga_outl(addr,val) mga_writel(ACCESS_FBINFO(mmio.vbase), (addr), (val))
-#define mga_readr(port,idx) (mga_outb((port),(idx)), mga_inb((port)+1))
-#ifdef __LITTLE_ENDIAN
-#define mga_setr(addr,port,val) mga_outw(addr, ((val)<<8) | (port))
-#else
-#define mga_setr(addr,port,val) do { mga_outb(addr, port); mga_outb((addr)+1, val); } while (0)
-#endif
-
-#ifdef __LITTLE_ENDIAN
-#define mga_fifo(n) do {} while (mga_inb(M_FIFOSTATUS) < (n))
-#else
-#define mga_fifo(n) do {} while ((mga_inl(M_FIFOSTATUS) & 0xFF) < (n))
-#endif
-
-#define WaitTillIdle() do {} while (mga_inl(M_STATUS) & 0x10000)
-
-/* code speedup */
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-#define isInterleave(x) (x->interleave)
-#define isMillenium(x) (x->millenium)
-#define isMilleniumII(x) (x->milleniumII)
-#else
-#define isInterleave(x) (0)
-#define isMillenium(x) (0)
-#define isMilleniumII(x) (0)
-#endif
-
-#define mga_ydstlen(y,l) mga_outl(M_YDSTLEN | M_EXEC, ((y) << 16) | (l))
-
-static void matrox_cfbX_init(WPMINFO struct display* p) {
- u_int32_t maccess;
- u_int32_t mpitch;
- u_int32_t mopmode;
-
- DBG("matrox_cfbX_init")
-
- mpitch = p->var.xres_virtual;
-
- if (p->type == FB_TYPE_TEXT) {
- maccess = 0x00000000;
- mpitch = (mpitch >> 4) | 0x8000; /* set something */
- mopmode = M_OPMODE_8BPP;
- } else {
- switch (p->var.bits_per_pixel) {
- case 4: maccess = 0x00000000; /* accelerate as 8bpp video */
- mpitch = (mpitch >> 1) | 0x8000; /* disable linearization */
- mopmode = M_OPMODE_4BPP;
- break;
- case 8: maccess = 0x00000000;
- mopmode = M_OPMODE_8BPP;
- break;
- case 16: if (p->var.green.length == 5)
- maccess = 0xC0000001;
- else
- maccess = 0x40000001;
- mopmode = M_OPMODE_16BPP;
- break;
- case 24: maccess = 0x00000003;
- mopmode = M_OPMODE_24BPP;
- break;
- case 32: maccess = 0x00000002;
- mopmode = M_OPMODE_32BPP;
- break;
- default: maccess = 0x00000000;
- mopmode = 0x00000000;
- break; /* turn off acceleration!!! */
- }
- }
- mga_fifo(8);
- mga_outl(M_PITCH, mpitch);
- mga_outl(M_YDSTORG, curr_ydstorg(MINFO));
- if (ACCESS_FBINFO(capable.plnwt))
- mga_outl(M_PLNWT, -1);
- mga_outl(M_OPMODE, mopmode);
- mga_outl(M_CXBNDRY, 0xFFFF0000);
- mga_outl(M_YTOP, 0);
- mga_outl(M_YBOT, 0x01FFFFFF);
- mga_outl(M_MACCESS, maccess);
- ACCESS_FBINFO(accel.m_dwg_rect) = M_DWG_TRAP | M_DWG_SOLID | M_DWG_ARZERO | M_DWG_SGNZERO | M_DWG_SHIFTZERO;
- if (isMilleniumII(MINFO)) ACCESS_FBINFO(accel.m_dwg_rect) |= M_DWG_TRANSC;
- ACCESS_FBINFO(accel.m_opmode) = mopmode;
-}
-
-static void matrox_cfbX_bmove(struct display* p, int sy, int sx, int dy, int dx, int height, int width) {
- int pixx = p->var.xres_virtual, start, end;
- MINFO_FROM_DISP(p);
-
- DBG("matrox_cfbX_bmove")
-
- sx *= fontwidth(p);
- dx *= fontwidth(p);
- width *= fontwidth(p);
- height *= fontheight(p);
- sy *= fontheight(p);
- dy *= fontheight(p);
- if ((dy < sy) || ((dy == sy) && (dx <= sx))) {
- mga_fifo(2);
- mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_SGNZERO |
- M_DWG_BFCOL | M_DWG_REPLACE);
- mga_outl(M_AR5, pixx);
- width--;
- start = sy*pixx+sx+curr_ydstorg(MINFO);
- end = start+width;
- } else {
- mga_fifo(3);
- mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_BFCOL | M_DWG_REPLACE);
- mga_outl(M_SGN, 5);
- mga_outl(M_AR5, -pixx);
- width--;
- end = (sy+height-1)*pixx+sx+curr_ydstorg(MINFO);
- start = end+width;
- dy += height-1;
- }
- mga_fifo(4);
- mga_outl(M_AR0, end);
- mga_outl(M_AR3, start);
- mga_outl(M_FXBNDRY, ((dx+width)<<16) | dx);
- mga_ydstlen(dy, height);
- WaitTillIdle();
-}
-
-#ifdef FBCON_HAS_CFB4
-static void matrox_cfb4_bmove(struct display* p, int sy, int sx, int dy, int dx, int height, int width) {
- int pixx, start, end;
- MINFO_FROM_DISP(p);
- /* both (sx or dx or width) and fontwidth() are odd, so their multiply is
- also odd, that means that we cannot use acceleration */
-
- DBG("matrox_cfb4_bmove")
-
- if ((sx | dx | width) & fontwidth(p) & 1) {
- fbcon_cfb4_bmove(p, sy, sx, dy, dx, height, width);
- return;
- }
- sx *= fontwidth(p);
- dx *= fontwidth(p);
- width *= fontwidth(p);
- height *= fontheight(p);
- sy *= fontheight(p);
- dy *= fontheight(p);
- pixx = p->var.xres_virtual >> 1;
- sx >>= 1;
- dx >>= 1;
- width >>= 1;
- if ((dy < sy) || ((dy == sy) && (dx <= sx))) {
- mga_fifo(2);
- mga_outl(M_AR5, pixx);
- mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_SGNZERO |
- M_DWG_BFCOL | M_DWG_REPLACE);
- width--;
- start = sy*pixx+sx+curr_ydstorg(MINFO);
- end = start+width;
- } else {
- mga_fifo(3);
- mga_outl(M_SGN, 5);
- mga_outl(M_AR5, -pixx);
- mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_BFCOL | M_DWG_REPLACE);
- width--;
- end = (sy+height-1)*pixx+sx+curr_ydstorg(MINFO);
- start = end+width;
- dy += height-1;
- }
- mga_fifo(5);
- mga_outl(M_AR0, end);
- mga_outl(M_AR3, start);
- mga_outl(M_FXBNDRY, ((dx+width)<<16) | dx);
- mga_outl(M_YDST, dy*pixx >> 5);
- mga_outl(M_LEN | M_EXEC, height);
- WaitTillIdle();
-}
-#endif
-
-static void matroxfb_accel_clear(CPMINFO u_int32_t color, int sy, int sx, int height,
- int width) {
-
- DBG("matroxfb_accel_clear")
-
- mga_fifo(5);
- mga_outl(M_DWGCTL, ACCESS_FBINFO(accel.m_dwg_rect) | M_DWG_REPLACE);
- mga_outl(M_FCOL, color);
- mga_outl(M_FXBNDRY, ((sx + width) << 16) | sx);
- mga_ydstlen(sy, height);
- WaitTillIdle();
-}
-
-static void matrox_cfbX_clear(u_int32_t color, struct display* p, int sy, int sx, int height, int width) {
-
- DBG("matrox_cfbX_clear")
-
- matroxfb_accel_clear(PMXINFO(p) color, sy * fontheight(p), sx * fontwidth(p),
- height * fontheight(p), width * fontwidth(p));
-}
-
-#ifdef FBCON_HAS_CFB4
-static void matrox_cfb4_clear(struct vc_data* conp, struct display* p, int sy, int sx, int height, int width) {
- u_int32_t bgx;
- int whattodo;
- MINFO_FROM_DISP(p);
-
- DBG("matrox_cfb4_clear")
-
- whattodo = 0;
- bgx = attr_bgcol_ec(p, conp);
- bgx |= bgx << 4;
- bgx |= bgx << 8;
- bgx |= bgx << 16;
- sy *= fontheight(p);
- sx *= fontwidth(p);
- height *= fontheight(p);
- width *= fontwidth(p);
- if (sx & 1) {
- sx ++;
- if (!width) return;
- width --;
- whattodo = 1;
- }
- if (width & 1) {
- whattodo |= 2;
- }
- width >>= 1;
- sx >>= 1;
- if (width) {
- mga_fifo(5);
- mga_outl(M_DWGCTL, ACCESS_FBINFO(accel.m_dwg_rect) | M_DWG_REPLACE2);
- mga_outl(M_FCOL, bgx);
- mga_outl(M_FXBNDRY, ((sx + width) << 16) | sx);
- mga_outl(M_YDST, sy * p->var.xres_virtual >> 6);
- mga_outl(M_LEN | M_EXEC, height);
- WaitTillIdle();
- }
- if (whattodo) {
- u_int32_t step = p->var.xres_virtual >> 1;
- vaddr_t vbase = ACCESS_FBINFO(video.vbase);
- if (whattodo & 1) {
- unsigned int uaddr = sy * step + sx - 1;
- u_int32_t loop;
- u_int8_t bgx2 = bgx & 0xF0;
- for (loop = height; loop > 0; loop --) {
- mga_writeb(vbase, uaddr, (mga_readb(vbase, uaddr) & 0x0F) | bgx2);
- uaddr += step;
- }
- }
- if (whattodo & 2) {
- unsigned int uaddr = sy * step + sx + width;
- u_int32_t loop;
- u_int8_t bgx2 = bgx & 0x0F;
- for (loop = height; loop > 0; loop --) {
- mga_writeb(vbase, uaddr, (mga_readb(vbase, uaddr) & 0xF0) | bgx2);
- uaddr += step;
- }
- }
- }
-}
-#endif
-
-#ifdef FBCON_HAS_CFB8
-static void matrox_cfb8_clear(struct vc_data* conp, struct display* p, int sy, int sx, int height, int width) {
- u_int32_t bgx;
-
- DBG("matrox_cfb8_clear")
-
- bgx = attr_bgcol_ec(p, conp);
- bgx |= bgx << 8;
- bgx |= bgx << 16;
- matrox_cfbX_clear(bgx, p, sy, sx, height, width);
-}
-#endif
-
-#ifdef FBCON_HAS_CFB16
-static void matrox_cfb16_clear(struct vc_data* conp, struct display* p, int sy, int sx, int height, int width) {
- u_int32_t bgx;
-
- DBG("matrox_cfb16_clear")
-
- bgx = ((u_int16_t*)p->dispsw_data)[attr_bgcol_ec(p, conp)];
- matrox_cfbX_clear((bgx << 16) | bgx, p, sy, sx, height, width);
-}
-#endif
-
-#if defined(FBCON_HAS_CFB32) || defined(FBCON_HAS_CFB24)
-static void matrox_cfb32_clear(struct vc_data* conp, struct display* p, int sy, int sx, int height, int width) {
- u_int32_t bgx;
-
- DBG("matrox_cfb32_clear")
-
- bgx = ((u_int32_t*)p->dispsw_data)[attr_bgcol_ec(p, conp)];
- matrox_cfbX_clear(bgx, p, sy, sx, height, width);
-}
-#endif
-
-static void matrox_cfbX_fastputc(u_int32_t fgx, u_int32_t bgx, struct display* p, int c, int yy, int xx) {
- unsigned int charcell;
- unsigned int ar3;
- MINFO_FROM_DISP(p);
-
- charcell = fontwidth(p) * fontheight(p);
- yy *= fontheight(p);
- xx *= fontwidth(p);
-
- mga_fifo(8);
- mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_LINEAR | M_DWG_REPLACE);
-
- mga_outl(M_FCOL, fgx);
- mga_outl(M_BCOL, bgx);
- mga_outl(M_FXBNDRY, ((xx + fontwidth(p) - 1) << 16) | xx);
- ar3 = ACCESS_FBINFO(fastfont.mgabase) + (c & p->charmask) * charcell;
- mga_outl(M_AR3, ar3);
- mga_outl(M_AR0, (ar3 + charcell - 1) & 0x0003FFFF);
- mga_ydstlen(yy, fontheight(p));
- WaitTillIdle();
-}
-
-static void matrox_cfbX_putc(u_int32_t fgx, u_int32_t bgx, struct display* p, int c, int yy, int xx) {
- u_int32_t ar0;
- u_int32_t step;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matrox_cfbX_putc");
-
- yy *= fontheight(p);
- xx *= fontwidth(p);
-
-#ifdef __BIG_ENDIAN
- WaitTillIdle();
- mga_outl(M_OPMODE, M_OPMODE_8BPP);
-#else
- mga_fifo(7);
-#endif
- ar0 = fontwidth(p) - 1;
- mga_outl(M_FXBNDRY, ((xx+ar0)<<16) | xx);
- if (fontwidth(p) <= 8)
- step = 1;
- else if (fontwidth(p) <= 16)
- step = 2;
- else
- step = 4;
- if (fontwidth(p) == step << 3) {
- size_t charcell = fontheight(p)*step;
- /* TODO: Align charcell to 4B for BE */
- mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_LINEAR | M_DWG_REPLACE);
- mga_outl(M_FCOL, fgx);
- mga_outl(M_BCOL, bgx);
- mga_outl(M_AR3, 0);
- mga_outl(M_AR0, fontheight(p)*fontwidth(p)-1);
- mga_ydstlen(yy, fontheight(p));
- mga_memcpy_toio(ACCESS_FBINFO(mmio.vbase), 0, p->fontdata+(c&p->charmask)*charcell, charcell);
- } else {
- u8* chardata = p->fontdata+(c&p->charmask)*fontheight(p)*step;
- int i;
-
- mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_REPLACE);
- mga_outl(M_FCOL, fgx);
- mga_outl(M_BCOL, bgx);
- mga_outl(M_AR5, 0);
- mga_outl(M_AR3, 0);
- mga_outl(M_AR0, ar0);
- mga_ydstlen(yy, fontheight(p));
-
- switch (step) {
- case 1:
- for (i = fontheight(p); i > 0; i--) {
-#ifdef __LITTLE_ENDIAN
- mga_outl(0, *chardata++);
-#else
- mga_outl(0, (*chardata++) << 24);
-#endif
- }
- break;
- case 2:
- for (i = fontheight(p); i > 0; i--) {
-#ifdef __LITTLE_ENDIAN
- mga_outl(0, *(u_int16_t*)chardata);
-#else
- mga_outl(0, (*(u_int16_t*)chardata) << 16);
-#endif
- chardata += 2;
- }
- break;
- case 4:
- mga_memcpy_toio(ACCESS_FBINFO(mmio.vbase), 0, chardata, fontheight(p) * 4);
- break;
- }
- }
- WaitTillIdle();
-#ifdef __BIG_ENDIAN
- mga_outl(M_OPMODE, ACCESS_FBINFO(accel.m_opmode));
-#endif
-}
-
-#ifdef FBCON_HAS_CFB8
-static void matrox_cfb8_putc(struct vc_data* conp, struct display* p, int c, int yy, int xx) {
- u_int32_t fgx, bgx;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matroxfb_cfb8_putc");
-
- fgx = attr_fgcol(p, c);
- bgx = attr_bgcol(p, c);
- fgx |= (fgx << 8);
- fgx |= (fgx << 16);
- bgx |= (bgx << 8);
- bgx |= (bgx << 16);
- ACCESS_FBINFO(curr.putc)(fgx, bgx, p, c, yy, xx);
-}
-#endif
-
-#ifdef FBCON_HAS_CFB16
-static void matrox_cfb16_putc(struct vc_data* conp, struct display* p, int c, int yy, int xx) {
- u_int32_t fgx, bgx;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matroxfb_cfb16_putc");
-
- fgx = ((u_int16_t*)p->dispsw_data)[attr_fgcol(p, c)];
- bgx = ((u_int16_t*)p->dispsw_data)[attr_bgcol(p, c)];
- fgx |= (fgx << 16);
- bgx |= (bgx << 16);
- ACCESS_FBINFO(curr.putc)(fgx, bgx, p, c, yy, xx);
-}
-#endif
-
-#if defined(FBCON_HAS_CFB32) || defined(FBCON_HAS_CFB24)
-static void matrox_cfb32_putc(struct vc_data* conp, struct display* p, int c, int yy, int xx) {
- u_int32_t fgx, bgx;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matroxfb_cfb32_putc");
-
- fgx = ((u_int32_t*)p->dispsw_data)[attr_fgcol(p, c)];
- bgx = ((u_int32_t*)p->dispsw_data)[attr_bgcol(p, c)];
- ACCESS_FBINFO(curr.putc)(fgx, bgx, p, c, yy, xx);
-}
-#endif
-
-static void matrox_cfbX_fastputcs(u_int32_t fgx, u_int32_t bgx, struct display* p, const unsigned short* s, int count, int yy, int xx) {
- unsigned int charcell;
- MINFO_FROM_DISP(p);
-
- yy *= fontheight(p);
- xx *= fontwidth(p);
- charcell = fontwidth(p) * fontheight(p);
-
- mga_fifo(3);
- mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_LINEAR | M_DWG_REPLACE);
- mga_outl(M_FCOL, fgx);
- mga_outl(M_BCOL, bgx);
- while (count--) {
- u_int32_t ar3 = ACCESS_FBINFO(fastfont.mgabase) + (scr_readw(s++) & p->charmask)*charcell;
-
- mga_fifo(4);
- mga_outl(M_FXBNDRY, ((xx + fontwidth(p) - 1) << 16) | xx);
- mga_outl(M_AR3, ar3);
- mga_outl(M_AR0, (ar3 + charcell - 1) & 0x0003FFFF);
- mga_ydstlen(yy, fontheight(p));
- xx += fontwidth(p);
- }
- WaitTillIdle();
-}
-
-static void matrox_cfbX_putcs(u_int32_t fgx, u_int32_t bgx, struct display* p, const unsigned short* s, int count, int yy, int xx) {
- u_int32_t step;
- u_int32_t ydstlen;
- u_int32_t xlen;
- u_int32_t ar0;
- u_int32_t charcell;
- u_int32_t fxbndry;
- vaddr_t mmio;
- int easy;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matroxfb_cfbX_putcs");
-
- yy *= fontheight(p);
- xx *= fontwidth(p);
- if (fontwidth(p) <= 8)
- step = 1;
- else if (fontwidth(p) <= 16)
- step = 2;
- else
- step = 4;
- charcell = fontheight(p)*step;
- xlen = (charcell + 3) & ~3;
- ydstlen = (yy << 16) | fontheight(p);
- if (fontwidth(p) == step << 3) {
- ar0 = fontheight(p)*fontwidth(p) - 1;
- easy = 1;
- } else {
- ar0 = fontwidth(p) - 1;
- easy = 0;
- }
-
-#ifdef __BIG_ENDIAN
- WaitTillIdle();
- mga_outl(M_OPMODE, M_OPMODE_8BPP);
-#else
- mga_fifo(3);
-#endif
- if (easy)
- mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_LINEAR | M_DWG_REPLACE);
- else
- mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_REPLACE);
- mga_outl(M_FCOL, fgx);
- mga_outl(M_BCOL, bgx);
- fxbndry = ((xx + fontwidth(p) - 1) << 16) | xx;
- mmio = ACCESS_FBINFO(mmio.vbase);
- while (count--) {
- u_int8_t* chardata = p->fontdata + (scr_readw(s++) & p->charmask)*charcell;
-
- mga_fifo(6);
- mga_writel(mmio, M_FXBNDRY, fxbndry);
- mga_writel(mmio, M_AR0, ar0);
- mga_writel(mmio, M_AR3, 0);
- if (easy) {
- mga_writel(mmio, M_YDSTLEN | M_EXEC, ydstlen);
- mga_memcpy_toio(mmio, 0, chardata, xlen);
- } else {
- mga_writel(mmio, M_AR5, 0);
- mga_writel(mmio, M_YDSTLEN | M_EXEC, ydstlen);
- switch (step) {
- case 1: {
- u_int8_t* charend = chardata + charcell;
- for (; chardata != charend; chardata++) {
-#ifdef __LITTLE_ENDIAN
- mga_writel(mmio, 0, *chardata);
-#else
- mga_writel(mmio, 0, (*chardata) << 24);
-#endif
- }
- }
- break;
- case 2: {
- u_int8_t* charend = chardata + charcell;
- for (; chardata != charend; chardata += 2) {
-#ifdef __LITTLE_ENDIAN
- mga_writel(mmio, 0, *(u_int16_t*)chardata);
-#else
- mga_writel(mmio, 0, (*(u_int16_t*)chardata) << 16);
-#endif
- }
- }
- break;
- default:
- mga_memcpy_toio(mmio, 0, chardata, charcell);
- break;
- }
- }
- fxbndry += fontwidth(p) + (fontwidth(p) << 16);
- }
- WaitTillIdle();
-#ifdef __BIG_ENDIAN
- mga_outl(M_OPMODE, ACCESS_FBINFO(accel.m_opmode));
-#endif
-}
-
-#ifdef FBCON_HAS_CFB8
-static void matrox_cfb8_putcs(struct vc_data* conp, struct display* p, const unsigned short* s, int count, int yy, int xx) {
- u_int32_t fgx, bgx;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matroxfb_cfb8_putcs");
-
- fgx = attr_fgcol(p, scr_readw(s));
- bgx = attr_bgcol(p, scr_readw(s));
- fgx |= (fgx << 8);
- fgx |= (fgx << 16);
- bgx |= (bgx << 8);
- bgx |= (bgx << 16);
- ACCESS_FBINFO(curr.putcs)(fgx, bgx, p, s, count, yy, xx);
-}
-#endif
-
-#ifdef FBCON_HAS_CFB16
-static void matrox_cfb16_putcs(struct vc_data* conp, struct display* p, const unsigned short* s, int count, int yy, int xx) {
- u_int32_t fgx, bgx;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matroxfb_cfb16_putcs");
-
- fgx = ((u_int16_t*)p->dispsw_data)[attr_fgcol(p, scr_readw(s))];
- bgx = ((u_int16_t*)p->dispsw_data)[attr_bgcol(p, scr_readw(s))];
- fgx |= (fgx << 16);
- bgx |= (bgx << 16);
- ACCESS_FBINFO(curr.putcs)(fgx, bgx, p, s, count, yy, xx);
-}
-#endif
-
-#if defined(FBCON_HAS_CFB32) || defined(FBCON_HAS_CFB24)
-static void matrox_cfb32_putcs(struct vc_data* conp, struct display* p, const unsigned short* s, int count, int yy, int xx) {
- u_int32_t fgx, bgx;
- MINFO_FROM_DISP(p);
-
- DBG_HEAVY("matroxfb_cfb32_putcs");
-
- fgx = ((u_int32_t*)p->dispsw_data)[attr_fgcol(p, scr_readw(s))];
- bgx = ((u_int32_t*)p->dispsw_data)[attr_bgcol(p, scr_readw(s))];
- ACCESS_FBINFO(curr.putcs)(fgx, bgx, p, s, count, yy, xx);
-}
-#endif
-
-#ifdef FBCON_HAS_CFB4
-static void matrox_cfb4_revc(struct display* p, int xx, int yy) {
- MINFO_FROM_DISP(p);
-
- DBG_LOOP("matroxfb_cfb4_revc");
-
- if (fontwidth(p) & 1) {
- fbcon_cfb4_revc(p, xx, yy);
- return;
- }
- yy *= fontheight(p);
- xx *= fontwidth(p);
- xx |= (xx + fontwidth(p)) << 16;
- xx >>= 1;
-
- mga_fifo(5);
- mga_outl(M_DWGCTL, ACCESS_FBINFO(accel.m_dwg_rect) | M_DWG_XOR);
- mga_outl(M_FCOL, 0xFFFFFFFF);
- mga_outl(M_FXBNDRY, xx);
- mga_outl(M_YDST, yy * p->var.xres_virtual >> 6);
- mga_outl(M_LEN | M_EXEC, fontheight(p));
- WaitTillIdle();
-}
-#endif
-
-#ifdef FBCON_HAS_CFB8
-static void matrox_cfb8_revc(struct display* p, int xx, int yy) {
- MINFO_FROM_DISP(p);
-
- DBG_LOOP("matrox_cfb8_revc")
-
- yy *= fontheight(p);
- xx *= fontwidth(p);
-
- mga_fifo(4);
- mga_outl(M_DWGCTL, ACCESS_FBINFO(accel.m_dwg_rect) | M_DWG_XOR);
- mga_outl(M_FCOL, 0x0F0F0F0F);
- mga_outl(M_FXBNDRY, ((xx + fontwidth(p)) << 16) | xx);
- mga_ydstlen(yy, fontheight(p));
- WaitTillIdle();
-}
-#endif
-
-static void matrox_cfbX_revc(struct display* p, int xx, int yy) {
- MINFO_FROM_DISP(p);
-
- DBG_LOOP("matrox_cfbX_revc")
-
- yy *= fontheight(p);
- xx *= fontwidth(p);
-
- mga_fifo(4);
- mga_outl(M_DWGCTL, ACCESS_FBINFO(accel.m_dwg_rect) | M_DWG_XOR);
- mga_outl(M_FCOL, 0xFFFFFFFF);
- mga_outl(M_FXBNDRY, ((xx + fontwidth(p)) << 16) | xx);
- mga_ydstlen(yy, fontheight(p));
- WaitTillIdle();
-}
-
-static void matrox_cfbX_clear_margins(struct vc_data* conp, struct display* p, int bottom_only) {
- unsigned int bottom_height, right_width;
- unsigned int bottom_start, right_start;
- unsigned int cell_h, cell_w;
-
- DBG("matrox_cfbX_clear_margins")
-
- cell_w = fontwidth(p);
- if (!cell_w) return; /* PARANOID */
- right_width = p->var.xres % cell_w;
- right_start = p->var.xres - right_width;
- if (!bottom_only && right_width) {
- /* clear whole right margin, not only visible portion */
- matroxfb_accel_clear( PMXINFO(p)
- /* color */ 0x00000000,
- /* y */ 0,
- /* x */ p->var.xoffset + right_start,
- /* height */ p->var.yres_virtual,
- /* width */ right_width);
- }
- cell_h = fontheight(p);
- if (!cell_h) return; /* PARANOID */
- bottom_height = p->var.yres % cell_h;
- if (bottom_height) {
- bottom_start = p->var.yres - bottom_height;
- matroxfb_accel_clear( PMXINFO(p)
- /* color */ 0x00000000,
- /* y */ p->var.yoffset + bottom_start,
- /* x */ p->var.xoffset,
- /* height */ bottom_height,
- /* width */ right_start);
- }
-}
-
-static void outDAC(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);
-}
-
-static int inDAC(CPMINFO int reg) {
- DBG_REG("inDAC");
- mga_outb(M_RAMDAC_BASE+M_X_INDEX, reg);
- return mga_inb(M_RAMDAC_BASE+M_X_DATAREG);
-}
-
-#define outTi3026 outDAC
-#define inTi3026 inDAC
-#define outDAC1064 outDAC
-#define inDAC1064 inDAC
-
-static 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;
-}
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-#define POS3026_XCURCTRL 20
-
-static void matroxfb_ti3026_flashcursor(unsigned long ptr) {
-#define minfo ((struct matrox_fb_info*)ptr)
- spin_lock(&ACCESS_FBINFO(lock.DAC));
- outTi3026(PMINFO TVP3026_XCURCTRL, inTi3026(PMINFO TVP3026_XCURCTRL) ^ TVP3026_XCURCTRL_DIS ^ TVP3026_XCURCTRL_XGA);
- ACCESS_FBINFO(cursor.timer.expires) = jiffies + HZ/2;
- add_timer(&ACCESS_FBINFO(cursor.timer));
- spin_unlock(&ACCESS_FBINFO(lock.DAC));
-#undef minfo
-}
-
-static void matroxfb_ti3026_createcursor(WPMINFO struct display* p) {
- unsigned long flags;
- u_int32_t xline;
- unsigned int i;
- unsigned int to;
-
- if (ACCESS_FBINFO(currcon_display) != p)
- return;
-
- DBG("matroxfb_ti3026_createcursor");
-
- matroxfb_createcursorshape(PMINFO p, p->var.vmode);
-
- xline = (~0) << (32 - ACCESS_FBINFO(cursor.w));
- spin_lock_irqsave(&ACCESS_FBINFO(lock.DAC), flags);
- mga_outb(M_RAMDAC_BASE+TVP3026_INDEX, 0);
- to = ACCESS_FBINFO(cursor.u);
- for (i = 0; i < to; i++) {
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- }
- to = ACCESS_FBINFO(cursor.d);
- for (; i < to; i++) {
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, xline >> 24);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, xline >> 16);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, xline >> 8);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, xline);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- }
- for (; i < 64; i++) {
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0);
- }
- for (i = 0; i < 512; i++)
- mga_outb(M_RAMDAC_BASE+TVP3026_CURRAMDATA, 0xFF);
- spin_unlock_irqrestore(&ACCESS_FBINFO(lock.DAC), flags);
-}
-
-static void matroxfb_ti3026_cursor(struct display* p, int mode, int x, int y) {
- unsigned long flags;
- MINFO_FROM_DISP(p);
-
- DBG("matroxfb_ti3026_cursor")
-
- if (ACCESS_FBINFO(currcon_display) != p)
- return;
-
- if (mode == CM_ERASE) {
- if (ACCESS_FBINFO(cursor.state) != CM_ERASE) {
- spin_lock_irqsave(&ACCESS_FBINFO(lock.DAC), flags);
- ACCESS_FBINFO(cursor.state) = CM_ERASE;
- del_timer(&ACCESS_FBINFO(cursor.timer));
- outTi3026(PMINFO TVP3026_XCURCTRL, ACCESS_FBINFO(currenthw->DACreg[POS3026_XCURCTRL]));
- spin_unlock_irqrestore(&ACCESS_FBINFO(lock.DAC), flags);
- }
- return;
- }
- if ((p->conp->vc_cursor_type & CUR_HWMASK) != ACCESS_FBINFO(cursor.type))
- matroxfb_ti3026_createcursor(PMINFO p);
- x *= fontwidth(p);
- y *= fontheight(p);
- y -= p->var.yoffset;
- if (p->var.vmode & FB_VMODE_DOUBLE)
- y *= 2;
- spin_lock_irqsave(&ACCESS_FBINFO(lock.DAC), flags);
- if ((x != ACCESS_FBINFO(cursor.x)) || (y != ACCESS_FBINFO(cursor.y)) || ACCESS_FBINFO(cursor.redraw)) {
- ACCESS_FBINFO(cursor.redraw) = 0;
- ACCESS_FBINFO(cursor.x) = x;
- ACCESS_FBINFO(cursor.y) = y;
- x += 64;
- y += 64;
- outTi3026(PMINFO TVP3026_XCURCTRL, ACCESS_FBINFO(currenthw->DACreg[POS3026_XCURCTRL]));
- mga_outb(M_RAMDAC_BASE+TVP3026_CURPOSXL, x);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURPOSXH, x >> 8);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURPOSYL, y);
- mga_outb(M_RAMDAC_BASE+TVP3026_CURPOSYH, y >> 8);
- }
- ACCESS_FBINFO(cursor.state) = CM_DRAW;
- if (ACCESS_FBINFO(devflags.blink))
- mod_timer(&ACCESS_FBINFO(cursor.timer), jiffies + HZ/2);
- outTi3026(PMINFO TVP3026_XCURCTRL, ACCESS_FBINFO(currenthw->DACreg[POS3026_XCURCTRL]) | TVP3026_XCURCTRL_XGA);
- spin_unlock_irqrestore(&ACCESS_FBINFO(lock.DAC), flags);
-}
-#undef POS3026_XCURCTRL
-
-static int matroxfb_ti3026_setfont(struct display* p, int width, int height) {
-
- DBG("matrox_ti3026_setfont");
-
- if (p && p->conp)
- matroxfb_ti3026_createcursor(PMXINFO(p) p);
- return 0;
-}
-#endif
-
-#ifdef NEED_DAC1064
-
-static void matroxfb_DAC1064_flashcursor(unsigned long ptr) {
-#define minfo ((struct matrox_fb_info*)ptr)
- spin_lock(&ACCESS_FBINFO(lock.DAC));
- outDAC1064(PMINFO M1064_XCURCTRL, inDAC1064(PMINFO M1064_XCURCTRL) ^ M1064_XCURCTRL_DIS ^ M1064_XCURCTRL_XGA);
- ACCESS_FBINFO(cursor.timer.expires) = jiffies + HZ/2;
- add_timer(&ACCESS_FBINFO(cursor.timer));
- spin_unlock(&ACCESS_FBINFO(lock.DAC));
-#undef minfo
-}
-
-static void matroxfb_DAC1064_createcursor(WPMINFO struct display* p) {
- vaddr_t cursorbase;
- u_int32_t xline;
- unsigned int i;
- unsigned int h, to;
-
- if (ACCESS_FBINFO(currcon_display) != p)
- return;
-
- matroxfb_createcursorshape(PMINFO p, p->var.vmode);
-
- xline = (~0) << (32 - ACCESS_FBINFO(cursor.w));
- cursorbase = ACCESS_FBINFO(video.vbase);
- h = ACCESS_FBINFO(features.DAC1064.cursorimage);
-
-#ifdef __BIG_ENDIAN
- WaitTillIdle();
- mga_outl(M_OPMODE, M_OPMODE_32BPP);
-#endif
- to = ACCESS_FBINFO(cursor.u);
- for (i = 0; i < to; i++) {
- mga_writel(cursorbase, h, 0);
- mga_writel(cursorbase, h+4, 0);
- mga_writel(cursorbase, h+8, ~0);
- mga_writel(cursorbase, h+12, ~0);
- h += 16;
- }
- to = ACCESS_FBINFO(cursor.d);
- for (; i < to; i++) {
- mga_writel(cursorbase, h, 0);
- mga_writel(cursorbase, h+4, xline);
- mga_writel(cursorbase, h+8, ~0);
- mga_writel(cursorbase, h+12, ~0);
- h += 16;
- }
- for (; i < 64; i++) {
- mga_writel(cursorbase, h, 0);
- mga_writel(cursorbase, h+4, 0);
- mga_writel(cursorbase, h+8, ~0);
- mga_writel(cursorbase, h+12, ~0);
- h += 16;
- }
-#ifdef __BIG_ENDIAN
- mga_outl(M_OPMODE, ACCESS_FBINFO(accel.m_opmode));
-#endif
-}
-
-static void matroxfb_DAC1064_cursor(struct display* p, int mode, int x, int y) {
- unsigned long flags;
- MINFO_FROM_DISP(p);
-
- if (ACCESS_FBINFO(currcon_display) != p)
- return;
-
- if (mode == CM_ERASE) {
- if (ACCESS_FBINFO(cursor.state) != CM_ERASE) {
- spin_lock_irqsave(&ACCESS_FBINFO(lock.DAC), flags);
- ACCESS_FBINFO(cursor.state) = CM_ERASE;
- del_timer(&ACCESS_FBINFO(cursor.timer));
- outDAC1064(PMINFO M1064_XCURCTRL, M1064_XCURCTRL_DIS);
- spin_unlock_irqrestore(&ACCESS_FBINFO(lock.DAC), flags);
- }
- return;
- }
- if ((p->conp->vc_cursor_type & CUR_HWMASK) != ACCESS_FBINFO(cursor.type))
- matroxfb_DAC1064_createcursor(PMINFO p);
- x *= fontwidth(p);
- y *= fontheight(p);
- y -= p->var.yoffset;
- if (p->var.vmode & FB_VMODE_DOUBLE)
- y *= 2;
- spin_lock_irqsave(&ACCESS_FBINFO(lock.DAC), flags);
- if ((x != ACCESS_FBINFO(cursor.x)) || (y != ACCESS_FBINFO(cursor.y)) || ACCESS_FBINFO(cursor.redraw)) {
- ACCESS_FBINFO(cursor.redraw) = 0;
- ACCESS_FBINFO(cursor.x) = x;
- ACCESS_FBINFO(cursor.y) = y;
- x += 64;
- y += 64;
- outDAC1064(PMINFO M1064_XCURCTRL, M1064_XCURCTRL_DIS);
- mga_outb(M_RAMDAC_BASE+M1064_CURPOSXL, x);
- mga_outb(M_RAMDAC_BASE+M1064_CURPOSXH, x >> 8);
- mga_outb(M_RAMDAC_BASE+M1064_CURPOSYL, y);
- mga_outb(M_RAMDAC_BASE+M1064_CURPOSYH, y >> 8);
- }
- ACCESS_FBINFO(cursor.state) = CM_DRAW;
- if (ACCESS_FBINFO(devflags.blink))
- mod_timer(&ACCESS_FBINFO(cursor.timer), jiffies + HZ/2);
- outDAC1064(PMINFO M1064_XCURCTRL, M1064_XCURCTRL_XGA);
- spin_unlock_irqrestore(&ACCESS_FBINFO(lock.DAC), flags);
-}
-
-static int matroxfb_DAC1064_setfont(struct display* p, int width, int height) {
- if (p && p->conp)
- matroxfb_DAC1064_createcursor(PMXINFO(p) p);
- return 0;
-}
-#endif
-
-#ifndef FNTCHARCNT
-#define FNTCHARCNT(fd) (((int *)(fd))[-3])
-#endif
-
-static int matroxfb_fastfont_tryset(WPMINFO struct display* p) {
- unsigned int fsize;
- unsigned int width;
-
- 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;
-
- 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));
-
- return 1;
-}
-
-static void matrox_text_setup(struct display* p) {
- MINFO_FROM_DISP(p);
-
- p->next_line = p->line_length ? p->line_length : ((p->var.xres_virtual / (fontwidth(p)?fontwidth(p):8)) * ACCESS_FBINFO(devflags.textstep));
- p->next_plane = 0;
-}
-
-static void matrox_text_bmove(struct display* p, int sy, int sx, int dy, int dx,
- int height, int width) {
- unsigned int srcoff;
- unsigned int dstoff;
- unsigned int step;
- MINFO_FROM_DISP(p);
-
- step = ACCESS_FBINFO(devflags.textstep);
- srcoff = (sy * p->next_line) + (sx * step);
- dstoff = (dy * p->next_line) + (dx * step);
- if (dstoff < srcoff) {
- while (height > 0) {
- int i;
- for (i = width; i > 0; dstoff += step, srcoff += step, i--)
- mga_writew(ACCESS_FBINFO(video.vbase), dstoff, mga_readw(ACCESS_FBINFO(video.vbase), srcoff));
- height--;
- dstoff += p->next_line - width * step;
- srcoff += p->next_line - width * step;
- }
- } else {
- unsigned int off;
-
- off = (height - 1) * p->next_line + (width - 1) * step;
- srcoff += off;
- dstoff += off;
- while (height > 0) {
- int i;
- for (i = width; i > 0; dstoff -= step, srcoff -= step, i--)
- mga_writew(ACCESS_FBINFO(video.vbase), dstoff, mga_readw(ACCESS_FBINFO(video.vbase), srcoff));
- dstoff -= p->next_line - width * step;
- srcoff -= p->next_line - width * step;
- height--;
- }
- }
-}
-
-static void matrox_text_clear(struct vc_data* conp, struct display* p, int sy, int sx,
- int height, int width) {
- unsigned int offs;
- unsigned int val;
- unsigned int step;
- MINFO_FROM_DISP(p);
-
- step = ACCESS_FBINFO(devflags.textstep);
- offs = sy * p->next_line + sx * step;
- val = ntohs((attr_bgcol(p, conp->vc_video_erase_char) << 4) | attr_fgcol(p, conp->vc_video_erase_char) | (' ' << 8));
-
- while (height > 0) {
- int i;
- for (i = width; i > 0; offs += step, i--)
- mga_writew(ACCESS_FBINFO(video.vbase), offs, val);
- offs += p->next_line - width * step;
- height--;
- }
-}
-
-static void matrox_text_putc(struct vc_data* conp, struct display* p, int c, int yy, int xx) {
- unsigned int offs;
- unsigned int chr;
- unsigned int step;
- MINFO_FROM_DISP(p);
-
- step = ACCESS_FBINFO(devflags.textstep);
- offs = yy * p->next_line + xx * step;
- chr = attr_fgcol(p,c) | (attr_bgcol(p,c) << 4) | ((c & p->charmask) << 8);
- if (chr & 0x10000) chr |= 0x08;
-
- mga_writew(ACCESS_FBINFO(video.vbase), offs, ntohs(chr));
-}
-
-static void matrox_text_putcs(struct vc_data* conp, struct display* p, const unsigned short* s,
- int count, int yy, int xx) {
- unsigned int offs;
- unsigned int attr;
- unsigned int step;
- MINFO_FROM_DISP(p);
-
- step = ACCESS_FBINFO(devflags.textstep);
- offs = yy * p->next_line + xx * step;
- attr = attr_fgcol(p, scr_readw(s)) | (attr_bgcol(p, scr_readw(s)) << 4);
-
- while (count-- > 0) {
- unsigned int chr = ((scr_readw(s++)) & p->charmask) << 8;
- if (chr & 0x10000) chr ^= 0x10008;
- mga_writew(ACCESS_FBINFO(video.vbase), offs, ntohs(attr|chr));
- offs += step;
- }
-}
-
-static void matrox_text_revc(struct display* p, int xx, int yy) {
- unsigned int offs;
- unsigned int step;
- MINFO_FROM_DISP(p);
-
- step = ACCESS_FBINFO(devflags.textstep);
- offs = yy * p->next_line + xx * step + 1;
-
- mga_writeb(ACCESS_FBINFO(video.vbase), offs, mga_readb(ACCESS_FBINFO(video.vbase), offs) ^ 0x77);
-}
-
-static int matrox_text_loadfont(WPMINFO struct display* p) {
- unsigned int fsize;
- unsigned int width;
- vaddr_t dst;
- unsigned int i;
- u_int8_t* font;
-
- 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;
-
- 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);
-
- return 1;
-}
-
-static void matrox_text_createcursor(WPMINFO struct display* p) {
-
- if (ACCESS_FBINFO(currcon_display) != p)
- return;
-
- matroxfb_createcursorshape(PMINFO p, 0);
-
- mga_setr(M_CRTC_INDEX, 0x0A, ACCESS_FBINFO(cursor.u));
- mga_setr(M_CRTC_INDEX, 0x0B, ACCESS_FBINFO(cursor.d) - 1);
-}
-
-static void matrox_text_cursor(struct display* p, int mode, int x, int y) {
- unsigned int pos;
- MINFO_FROM_DISP(p);
-
- if (ACCESS_FBINFO(currcon_display) != p)
- return;
-
- if (mode == CM_ERASE) {
- if (ACCESS_FBINFO(cursor.state) != CM_ERASE) {
-
- mga_setr(M_CRTC_INDEX, 0x0A, 0x20);
-
- ACCESS_FBINFO(cursor.state) = CM_ERASE;
- }
- return;
- }
- if ((p->conp->vc_cursor_type & CUR_HWMASK) != ACCESS_FBINFO(cursor.type))
- matrox_text_createcursor(PMINFO p);
-
- /* DO NOT CHECK cursor.x != x because of vgaHWinit moves cursor to 0,0 */
- ACCESS_FBINFO(cursor.x) = x;
- ACCESS_FBINFO(cursor.y) = y;
- pos = p->next_line / ACCESS_FBINFO(devflags.textstep) * y + x;
-
- mga_setr(M_CRTC_INDEX, 0x0F, pos);
- mga_setr(M_CRTC_INDEX, 0x0E, pos >> 8);
-
- mga_setr(M_CRTC_INDEX, 0x0A, ACCESS_FBINFO(cursor.u));
-
- ACCESS_FBINFO(cursor.state) = CM_DRAW;
-}
-
-static void matrox_text_round(CPMINFO struct fb_var_screeninfo* var, struct display* p) {
- unsigned hf;
- unsigned vf;
- unsigned vxres;
- unsigned ych;
-
- hf = fontwidth(p);
- if (!hf) hf = 8;
- /* do not touch xres */
- vxres = (var->xres_virtual + hf - 1) / hf;
- if (vxres >= 256)
- vxres = 255;
- if (vxres < 16)
- vxres = 16;
- vxres = (vxres + 1) & ~1; /* must be even */
- vf = fontheight(p);
- if (!vf) vf = 16;
- if (var->yres < var->yres_virtual) {
- ych = ACCESS_FBINFO(devflags.textvram) / vxres;
- var->yres_virtual = ych * vf;
- } else
- ych = var->yres_virtual / vf;
- if (vxres * ych > ACCESS_FBINFO(devflags.textvram)) {
- ych = ACCESS_FBINFO(devflags.textvram) / vxres;
- var->yres_virtual = ych * vf;
- }
- var->xres_virtual = vxres * hf;
-}
-
-static int matrox_text_setfont(struct display* p, int width, int height) {
- DBG("matrox_text_setfont");
-
- if (p) {
- MINFO_FROM_DISP(p);
-
- matrox_text_round(PMINFO &p->var, p);
- p->next_line = p->line_length = ((p->var.xres_virtual / (fontwidth(p)?fontwidth(p):8)) * ACCESS_FBINFO(devflags.textstep));
-
- if (p->conp)
- matrox_text_createcursor(PMINFO p);
- }
- return 0;
-}
-
-#define matrox_cfb16_revc matrox_cfbX_revc
-#define matrox_cfb24_revc matrox_cfbX_revc
-#define matrox_cfb32_revc matrox_cfbX_revc
-
-#define matrox_cfb24_clear matrox_cfb32_clear
-#define matrox_cfb24_putc matrox_cfb32_putc
-#define matrox_cfb24_putcs matrox_cfb32_putcs
-
-#ifdef FBCON_HAS_VGATEXT
-static struct display_switch matroxfb_text = {
- matrox_text_setup, matrox_text_bmove, matrox_text_clear,
- matrox_text_putc, matrox_text_putcs, matrox_text_revc,
- matrox_text_cursor, matrox_text_setfont, NULL,
- FONTWIDTH(8)|FONTWIDTH(9)
-};
-#endif
-
-#ifdef FBCON_HAS_CFB4
-static struct display_switch matroxfb_cfb4 = {
- fbcon_cfb4_setup, matrox_cfb4_bmove, matrox_cfb4_clear,
- fbcon_cfb4_putc, fbcon_cfb4_putcs, matrox_cfb4_revc,
- NULL, NULL, NULL,
- /* cursor... */ /* set_font... */
- FONTWIDTH(8) /* fix, fix, fix it */
-};
-#endif
-
-#ifdef FBCON_HAS_CFB8
-static struct display_switch matroxfb_cfb8 = {
- fbcon_cfb8_setup, matrox_cfbX_bmove, matrox_cfb8_clear,
- matrox_cfb8_putc, matrox_cfb8_putcs, matrox_cfb8_revc,
- NULL, NULL, matrox_cfbX_clear_margins,
- ~1 /* FONTWIDTHS */
-};
-#endif
-
-#ifdef FBCON_HAS_CFB16
-static struct display_switch matroxfb_cfb16 = {
- fbcon_cfb16_setup, matrox_cfbX_bmove, matrox_cfb16_clear,
- matrox_cfb16_putc, matrox_cfb16_putcs, matrox_cfb16_revc,
- NULL, NULL, matrox_cfbX_clear_margins,
- ~1 /* FONTWIDTHS */
-};
-#endif
-
-#ifdef FBCON_HAS_CFB24
-static struct display_switch matroxfb_cfb24 = {
- fbcon_cfb24_setup, matrox_cfbX_bmove, matrox_cfb24_clear,
- matrox_cfb24_putc, matrox_cfb24_putcs, matrox_cfb24_revc,
- NULL, NULL, matrox_cfbX_clear_margins,
- ~1 /* FONTWIDTHS */ /* TODO: and what about non-aligned access on BE? I think that there are no in my code */
-};
-#endif
-
-#ifdef FBCON_HAS_CFB32
-static struct display_switch matroxfb_cfb32 = {
- fbcon_cfb32_setup, matrox_cfbX_bmove, matrox_cfb32_clear,
- matrox_cfb32_putc, matrox_cfb32_putcs, matrox_cfb32_revc,
- NULL, NULL, matrox_cfbX_clear_margins,
- ~1 /* FONTWIDTHS */
-};
-#endif
-
-static void initMatrox(WPMINFO struct display* p) {
- struct display_switch *swtmp;
-
- DBG("initMatrox")
-
- if (ACCESS_FBINFO(currcon_display) != p)
- return;
- if (p->dispsw && p->conp)
- fb_con.con_cursor(p->conp, CM_ERASE);
- p->dispsw_data = NULL;
- if ((p->var.accel_flags & FB_ACCELF_TEXT) != FB_ACCELF_TEXT) {
- if (p->type == FB_TYPE_TEXT) {
- swtmp = &matroxfb_text;
- } else {
- switch (p->var.bits_per_pixel) {
-#ifdef FBCON_HAS_CFB4
- case 4:
- swtmp = &fbcon_cfb4;
- break;
-#endif
-#ifdef FBCON_HAS_CFB8
- case 8:
- swtmp = &fbcon_cfb8;
- break;
-#endif
-#ifdef FBCON_HAS_CFB16
- case 16:
- p->dispsw_data = &ACCESS_FBINFO(cmap.cfb16);
- swtmp = &fbcon_cfb16;
- break;
-#endif
-#ifdef FBCON_HAS_CFB24
- case 24:
- p->dispsw_data = &ACCESS_FBINFO(cmap.cfb24);
- swtmp = &fbcon_cfb24;
- break;
-#endif
-#ifdef FBCON_HAS_CFB32
- case 32:
- p->dispsw_data = &ACCESS_FBINFO(cmap.cfb32);
- swtmp = &fbcon_cfb32;
- break;
-#endif
- default:
- p->dispsw = &fbcon_dummy;
- return;
- }
- }
- dprintk(KERN_INFO "matroxfb: acceleration disabled\n");
- } else if (p->type == FB_TYPE_TEXT) {
- swtmp = &matroxfb_text;
- } else {
- switch (p->var.bits_per_pixel) {
-#ifdef FBCON_HAS_CFB4
- case 4:
- swtmp = &matroxfb_cfb4;
- break;
-#endif
-#ifdef FBCON_HAS_CFB8
- case 8:
- swtmp = &matroxfb_cfb8;
- break;
-#endif
-#ifdef FBCON_HAS_CFB16
- case 16:
- p->dispsw_data = &ACCESS_FBINFO(cmap.cfb16);
- swtmp = &matroxfb_cfb16;
- break;
-#endif
-#ifdef FBCON_HAS_CFB24
- case 24:
- p->dispsw_data = &ACCESS_FBINFO(cmap.cfb24);
- swtmp = &matroxfb_cfb24;
- break;
-#endif
-#ifdef FBCON_HAS_CFB32
- case 32:
- p->dispsw_data = &ACCESS_FBINFO(cmap.cfb32);
- swtmp = &matroxfb_cfb32;
- break;
-#endif
- default:
- p->dispsw = &fbcon_dummy;
- return;
- }
- }
- memcpy(&ACCESS_FBINFO(dispsw), swtmp, sizeof(ACCESS_FBINFO(dispsw)));
- p->dispsw = &ACCESS_FBINFO(dispsw);
- if ((p->type != FB_TYPE_TEXT) && ACCESS_FBINFO(devflags.hwcursor)) {
- if (isMillenium(MINFO)) {
-#ifdef CONFIG_FB_MATROX_MILLENIUM
- ACCESS_FBINFO(dispsw.cursor) = matroxfb_ti3026_cursor;
- ACCESS_FBINFO(dispsw.set_font) = matroxfb_ti3026_setfont;
-#endif
- } else {
-#ifdef NEED_DAC1064
- ACCESS_FBINFO(dispsw.cursor) = matroxfb_DAC1064_cursor;
- ACCESS_FBINFO(dispsw.set_font) = matroxfb_DAC1064_setfont;
-#endif
- }
- }
-}
-
-/* --------------------------------------------------------------------- */
-
-/*
- * card parameters
- */
-
-/* --------------------------------------------------------------------- */
-
-static struct fb_var_screeninfo vesafb_defined __initdata = {
- 640,480,640,480,/* W,H, W, H (virtual) load xres,xres_virtual*/
- 0,0, /* virtual -> visible no offset */
- 8, /* depth -> load bits_per_pixel */
- 0, /* greyscale ? */
- {0,0,0}, /* R */
- {0,0,0}, /* G */
- {0,0,0}, /* B */
- {0,0,0}, /* transparency */
- 0, /* standard pixel format */
- FB_ACTIVATE_NOW,
- -1,-1,
- FB_ACCELF_TEXT, /* accel flags */
- 39721L,48L,16L,33L,10L,
- 96L,2L,~0, /* No sync info */
- FB_VMODE_NONINTERLACED,
- {0,0,0,0,0,0}
-};
-
-
-
-/* --------------------------------------------------------------------- */
-
-static void matrox_pan_var(WPMINFO struct fb_var_screeninfo *var) {
- unsigned int pos;
- unsigned short p0, p1, p2;
-#ifdef CONFIG_FB_MATROX_32MB
- unsigned int p3;
-#endif
- struct display *disp;
-
- DBG("matrox_pan_var")
-
- disp = ACCESS_FBINFO(currcon_display);
- if (disp->type == FB_TYPE_TEXT) {
- pos = var->yoffset / fontheight(disp) * disp->next_line / ACCESS_FBINFO(devflags.textstep) + var->xoffset / (fontwidth(disp)?fontwidth(disp):8);
- } else {
- pos = (var->yoffset * var->xres_virtual + var->xoffset) * ACCESS_FBINFO(curr.final_bppShift) / 32;
- pos += ACCESS_FBINFO(curr.ydstorg.chunks);
- }
- p0 = ACCESS_FBINFO(currenthw)->CRTC[0x0D] = pos & 0xFF;
- p1 = ACCESS_FBINFO(currenthw)->CRTC[0x0C] = (pos & 0xFF00) >> 8;
- p2 = ACCESS_FBINFO(currenthw)->CRTCEXT[0] = (ACCESS_FBINFO(currenthw)->CRTCEXT[0] & 0xB0) | ((pos >> 16) & 0x0F) | ((pos >> 14) & 0x40);
-#ifdef CONFIG_FB_MATROX_32MB
- p3 = ACCESS_FBINFO(currenthw)->CRTCEXT[8] = pos >> 21;
-#endif
-
- mga_setr(M_CRTC_INDEX, 0x0D, p0);
- mga_setr(M_CRTC_INDEX, 0x0C, p1);
-#ifdef CONFIG_FB_MATROX_32MB
- if (ACCESS_FBINFO(devflags.support32MB))
- mga_setr(M_EXTVGA_INDEX, 0x08, p3);
-#endif
- mga_setr(M_EXTVGA_INDEX, 0x00, p2);
-}
-
- /*
- * Open/Release the frame buffer device
- */
-
-static int matroxfb_open(struct fb_info *info, int user)
-{
- DBG_LOOP("matroxfb_open")
-
- /*
- * Nothing, only a usage count for the moment
- */
- MOD_INC_USE_COUNT;
- return(0);
-}
-
-static int matroxfb_release(struct fb_info *info, int user)
-{
- DBG_LOOP("matroxfb_release")
-
- MOD_DEC_USE_COUNT;
- return(0);
-}
-
-static int matroxfb_pan_display(struct fb_var_screeninfo *var, int con,
- struct fb_info* info) {
-#define minfo ((struct matrox_fb_info*)info)
-
- DBG("matroxfb_pan_display")
-
- if (var->vmode & FB_VMODE_YWRAP) {
- if (var->yoffset < 0 || var->yoffset >= fb_display[con].var.yres_virtual || var->xoffset)
- return -EINVAL;
- } else {
- if (var->xoffset+fb_display[con].var.xres > fb_display[con].var.xres_virtual ||
- var->yoffset+fb_display[con].var.yres > fb_display[con].var.yres_virtual)
- return -EINVAL;
- }
- if (con == ACCESS_FBINFO(currcon))
- matrox_pan_var(PMINFO var);
- fb_display[con].var.xoffset = var->xoffset;
- fb_display[con].var.yoffset = var->yoffset;
- if (var->vmode & FB_VMODE_YWRAP)
- fb_display[con].var.vmode |= FB_VMODE_YWRAP;
- else
- fb_display[con].var.vmode &= ~FB_VMODE_YWRAP;
- return 0;
-#undef minfo
-}
-
-static int matroxfb_updatevar(int con, struct fb_info *info)
-{
-#define minfo ((struct matrox_fb_info*)info)
- DBG("matroxfb_updatevar");
-
- matrox_pan_var(PMINFO &fb_display[con].var);
- return 0;
-#undef minfo
-}
-
-static int matroxfb_get_final_bppShift(CPMINFO int bpp) {
- int bppshft2;
-
- DBG("matroxfb_get_final_bppShift")
-
- bppshft2 = bpp;
- if (!bppshft2) {
- return 8;
- }
- if (isInterleave(MINFO))
- bppshft2 >>= 1;
- if (ACCESS_FBINFO(devflags.video64bits))
- bppshft2 >>= 1;
- return bppshft2;
-}
-
-static int matroxfb_test_and_set_rounding(CPMINFO int xres, int bpp) {
- int over;
- int rounding;
-
- DBG("matroxfb_test_and_set_rounding")
-
- switch (bpp) {
- case 0: return xres;
- case 4: rounding = 128;
- break;
- case 8: rounding = 64; /* doc says 64; 32 is OK for G400 */
- break;
- case 16: rounding = 32;
- break;
- case 24: rounding = 64; /* doc says 64; 32 is OK for G400 */
- break;
- default: rounding = 16;
- /* on G400, 16 really does not work */
- if (ACCESS_FBINFO(devflags.accelerator) == FB_ACCEL_MATROX_MGAG400)
- rounding = 32;
- break;
- }
- if (isInterleave(MINFO)) {
- rounding *= 2;
- }
- over = xres % rounding;
- if (over)
- xres += rounding-over;
- return xres;
-}
-
-static int matroxfb_pitch_adjust(CPMINFO int xres, int bpp) {
- const int* width;
- int xres_new;
-
- DBG("matroxfb_pitch_adjust")
-
- if (!bpp) return xres;
-
- width = ACCESS_FBINFO(capable.vxres);
-
- if (ACCESS_FBINFO(devflags.precise_width)) {
- while (*width) {
- if ((*width >= xres) && (matroxfb_test_and_set_rounding(PMINFO *width, bpp) == *width)) {
- break;
- }
- width++;
- }
- xres_new = *width;
- } else {
- xres_new = matroxfb_test_and_set_rounding(PMINFO xres, bpp);
- }
- if (!xres_new) return 0;
- if (xres != xres_new) {
- printk(KERN_INFO "matroxfb: cannot set xres to %d, rounded up to %d\n", xres, xres_new);
- }
- return xres_new;
-}
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static const unsigned char DACseq[] =
-{ TVP3026_XLATCHCTRL, TVP3026_XTRUECOLORCTRL,
- TVP3026_XMUXCTRL, TVP3026_XCLKCTRL,
- TVP3026_XPALETTEPAGE,
- TVP3026_XGENCTRL,
- TVP3026_XMISCCTRL,
- TVP3026_XGENIOCTRL,
- TVP3026_XGENIODATA,
- TVP3026_XCOLKEYOVRMIN, TVP3026_XCOLKEYOVRMAX, TVP3026_XCOLKEYREDMIN, TVP3026_XCOLKEYREDMAX,
- TVP3026_XCOLKEYGREENMIN, TVP3026_XCOLKEYGREENMAX, TVP3026_XCOLKEYBLUEMIN, TVP3026_XCOLKEYBLUEMAX,
- TVP3026_XCOLKEYCTRL,
- TVP3026_XMEMPLLCTRL, TVP3026_XSENSETEST, TVP3026_XCURCTRL };
-
-#define POS3026_XLATCHCTRL 0
-#define POS3026_XTRUECOLORCTRL 1
-#define POS3026_XMUXCTRL 2
-#define POS3026_XCLKCTRL 3
-#define POS3026_XGENCTRL 5
-#define POS3026_XMISCCTRL 6
-#define POS3026_XMEMPLLCTRL 18
-#define POS3026_XCURCTRL 20
-
-static const unsigned char MGADACbpp32[] =
-{ TVP3026_XLATCHCTRL_2_1, TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_ORGB_8888,
- 0x00, TVP3026_XCLKCTRL_DIV1 | TVP3026_XCLKCTRL_SRC_PLL,
- 0x00,
- TVP3026_XGENCTRL_HSYNC_POS | TVP3026_XGENCTRL_VSYNC_POS | TVP3026_XGENCTRL_LITTLE_ENDIAN | TVP3026_XGENCTRL_BLACK_0IRE | TVP3026_XGENCTRL_NO_SYNC_ON_GREEN | TVP3026_XGENCTRL_OVERSCAN_DIS,
- TVP3026_XMISCCTRL_DAC_PUP | TVP3026_XMISCCTRL_DAC_8BIT | TVP3026_XMISCCTRL_PSEL_DIS | TVP3026_XMISCCTRL_PSEL_HIGH,
- 0x00,
- 0x1E,
- 0xFF, 0xFF, 0xFF, 0xFF,
- 0xFF, 0xFF, 0xFF, 0xFF,
- TVP3026_XCOLKEYCTRL_ZOOM1,
- 0x00, 0x00, TVP3026_XCURCTRL_DIS };
-#endif /* CONFIG_FB_MATROX_MILLENIUM */
-
-static int PLL_calcclock(CPMINFO 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 = ACCESS_FBINFO(features.pll.ref_freq);
- unsigned int fwant;
- unsigned int p;
-
- DBG("PLL_calcclock")
-
- fwant = freq;
-
-#ifdef DEBUG
- printk(KERN_ERR "post_shift_max: %d\n", ACCESS_FBINFO(features.pll.post_shift_max));
- printk(KERN_ERR "ref_freq: %d\n", ACCESS_FBINFO(features.pll.ref_freq));
- printk(KERN_ERR "freq: %d\n", freq);
- printk(KERN_ERR "vco_freq_min: %d\n", ACCESS_FBINFO(features.pll.vco_freq_min));
- printk(KERN_ERR "in_div_min: %d\n", ACCESS_FBINFO(features.pll.in_div_min));
- printk(KERN_ERR "in_div_max: %d\n", ACCESS_FBINFO(features.pll.in_div_max));
- printk(KERN_ERR "feed_div_min: %d\n", ACCESS_FBINFO(features.pll.feed_div_min));
- printk(KERN_ERR "feed_div_max: %d\n", ACCESS_FBINFO(features.pll.feed_div_max));
- printk(KERN_ERR "fmax: %d\n", fmax);
-#endif
- for (p = 1; p <= ACCESS_FBINFO(features.pll.post_shift_max); p++) {
- if (fwant * 2 > fmax)
- break;
- fwant *= 2;
- }
- if (fwant < ACCESS_FBINFO(features.pll.vco_freq_min)) fwant = ACCESS_FBINFO(features.pll.vco_freq_min);
- if (fwant > fmax) fwant = fmax;
- for (; p-- > 0; fwant >>= 1, bestdiff >>= 1) {
- unsigned int m;
-
- if (fwant < ACCESS_FBINFO(features.pll.vco_freq_min)) break;
- for (m = ACCESS_FBINFO(features.pll.in_div_min); m <= ACCESS_FBINFO(features.pll.in_div_max); m++) {
- unsigned int diff, fvco;
- unsigned int n;
-
- n = (fwant * (m + 1) + (fxtal >> 1)) / fxtal - 1;
- if (n > ACCESS_FBINFO(features.pll.feed_div_max))
- break;
- if (n < ACCESS_FBINFO(features.pll.feed_div_min))
- n = ACCESS_FBINFO(features.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;
-}
-
-#ifdef NEED_DAC1064
-static void DAC1064_calcclock(CPMINFO unsigned int freq, unsigned int fmax, unsigned int* in, unsigned int* feed, unsigned int* post) {
- unsigned int fvco;
- unsigned int p;
-
- DBG("DAC1064_calcclock")
-
- fvco = PLL_calcclock(PMINFO freq, fmax, in, feed, &p);
- p = (1 << p) - 1;
- if (fvco <= 100000)
- ;
- else if (fvco <= 140000)
- p |= 0x08;
- else if (fvco <= 180000)
- p |= 0x10;
- else
- p |= 0x18;
- *post = p;
-}
-#endif
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static int Ti3026_calcclock(CPMINFO unsigned int freq, unsigned int fmax, int* in, int* feed, int* post) {
- unsigned int fvco;
- unsigned int lin, lfeed, lpost;
-
- DBG("Ti3026_calcclock")
-
- fvco = PLL_calcclock(PMINFO freq, fmax, &lin, &lfeed, &lpost);
- fvco >>= (*post = lpost);
- *in = 64 - lin;
- *feed = 64 - lfeed;
- return fvco;
-}
-
-static int Ti3026_setpclk(CPMINFO struct matrox_hw_state* hw, int clk, struct display* p) {
- unsigned int f_pll;
- unsigned int pixfeed, pixin, pixpost;
-
- DBG("Ti3026_setpclk")
-
- f_pll = Ti3026_calcclock(PMINFO clk, ACCESS_FBINFO(max_pixel_clock), &pixin, &pixfeed, &pixpost);
-
- hw->DACclk[0] = pixin | 0xC0;
- hw->DACclk[1] = pixfeed;
- hw->DACclk[2] = pixpost | 0xB0;
-
- if (p->type == FB_TYPE_TEXT) {
- hw->DACreg[POS3026_XMEMPLLCTRL] = TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL | TVP3026_XMEMPLLCTRL_RCLK_PIXPLL;
- hw->DACclk[3] = 0xFD;
- hw->DACclk[4] = 0x3D;
- hw->DACclk[5] = 0x70;
- } else {
- unsigned int loopfeed, loopin, looppost, loopdiv, z;
- unsigned int Bpp;
-
- Bpp = ACCESS_FBINFO(curr.final_bppShift);
-
- if (p->var.bits_per_pixel == 24) {
- loopfeed = 3; /* set lm to any possible value */
- loopin = 3 * 32 / Bpp;
- } else {
- loopfeed = 4;
- loopin = 4 * 32 / Bpp;
- }
- z = (110000 * loopin) / (f_pll * loopfeed);
- loopdiv = 0; /* div 2 */
- if (z < 2)
- looppost = 0;
- else if (z < 4)
- looppost = 1;
- else if (z < 8)
- looppost = 2;
- else {
- looppost = 3;
- loopdiv = z/16;
- }
- if (p->var.bits_per_pixel == 24) {
- hw->DACclk[3] = ((65 - loopin) & 0x3F) | 0xC0;
- hw->DACclk[4] = (65 - loopfeed) | 0x80;
- if (ACCESS_FBINFO(accel.ramdac_rev) > 0x20) {
- if (isInterleave(MINFO))
- hw->DACreg[POS3026_XLATCHCTRL] = TVP3026B_XLATCHCTRL_8_3;
- else {
- hw->DACclk[4] &= ~0xC0;
- hw->DACreg[POS3026_XLATCHCTRL] = TVP3026B_XLATCHCTRL_4_3;
- }
- } else {
- if (isInterleave(MINFO))
- ; /* default... */
- else {
- hw->DACclk[4] ^= 0xC0; /* change from 0x80 to 0x40 */
- hw->DACreg[POS3026_XLATCHCTRL] = TVP3026A_XLATCHCTRL_4_3;
- }
- }
- hw->DACclk[5] = looppost | 0xF8;
- if (ACCESS_FBINFO(devflags.mga_24bpp_fix))
- hw->DACclk[5] ^= 0x40;
- } else {
- hw->DACclk[3] = ((65 - loopin) & 0x3F) | 0xC0;
- hw->DACclk[4] = 65 - loopfeed;
- hw->DACclk[5] = looppost | 0xF0;
- }
- hw->DACreg[POS3026_XMEMPLLCTRL] = loopdiv | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL | TVP3026_XMEMPLLCTRL_RCLK_LOOPPLL;
- }
- return 0;
-}
-#endif
-
-static void 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;
-}
-
-static int 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 Millenium 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 */
- 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;
-};
-
-#ifdef NEED_DAC1064
-
-static const unsigned char MGA1064_DAC_regs[] = {
- M1064_XCURADDL, M1064_XCURADDH, M1064_XCURCTRL,
- M1064_XCURCOL0RED, M1064_XCURCOL0GREEN, M1064_XCURCOL0BLUE,
- M1064_XCURCOL1RED, M1064_XCURCOL1GREEN, M1064_XCURCOL1BLUE,
- M1064_XCURCOL2RED, M1064_XCURCOL2GREEN, M1064_XCURCOL2BLUE,
- DAC1064_XVREFCTRL, M1064_XMULCTRL, M1064_XPIXCLKCTRL, M1064_XGENCTRL,
- M1064_XMISCCTRL,
- M1064_XGENIOCTRL, M1064_XGENIODATA, M1064_XZOOMCTRL, M1064_XSENSETEST,
- M1064_XCRCBITSEL,
- M1064_XCOLKEYMASKL, M1064_XCOLKEYMASKH, M1064_XCOLKEYL, M1064_XCOLKEYH };
-
-#define POS1064_XCURADDL 0
-#define POS1064_XCURADDH 1
-#define POS1064_XVREFCTRL 12
-#define POS1064_XMULCTRL 13
-#define POS1064_XGENCTRL 15
-#define POS1064_XMISCCTRL 16
-
-static const unsigned char MGA1064_DAC[] = {
- 0x00, 0x00, M1064_XCURCTRL_DIS,
- 0x00, 0x00, 0x00, /* black */
- 0xFF, 0xFF, 0xFF, /* white */
- 0xFF, 0x00, 0x00, /* red */
- 0x00, 0,
- M1064_XPIXCLKCTRL_PLL_UP | M1064_XPIXCLKCTRL_EN | M1064_XPIXCLKCTRL_SRC_PLL,
- M1064_XGENCTRL_VS_0 | M1064_XGENCTRL_ALPHA_DIS | M1064_XGENCTRL_BLACK_0IRE | M1064_XGENCTRL_NO_SYNC_ON_GREEN,
- M1064_XMISCCTRL_DAC_EN | M1064_XMISCCTRL_MFC_DIS | M1064_XMISCCTRL_DAC_8BIT | M1064_XMISCCTRL_LUT_EN,
- 0x10, 0x3F, M1064_XZOOMCTRL_1, M1064_XSENSETEST_BCOMP | M1064_XSENSETEST_GCOMP | M1064_XSENSETEST_RCOMP | M1064_XSENSETEST_PDOWN,
- 0x00,
- 0x00, 0x00, 0xFF, 0xFF};
-
-static void DAC1064_setpclk(CPMINFO struct matrox_hw_state* hw, unsigned long fout) {
- unsigned int m, n, p;
-
- DBG("DAC1064_setpclk")
-
- DAC1064_calcclock(PMINFO fout, ACCESS_FBINFO(max_pixel_clock), &m, &n, &p);
- hw->DACclk[0] = m;
- hw->DACclk[1] = n;
- hw->DACclk[2] = p;
-}
-
-static void __init DAC1064_setmclk(CPMINFO struct matrox_hw_state* hw, int oscinfo, unsigned long fmem){
- u_int32_t mx;
-
- DBG("DAC1064_setmclk")
-
- if (ACCESS_FBINFO(devflags.noinit)) {
- /* read MCLK and give up... */
- hw->DACclk[3] = inDAC1064(PMINFO DAC1064_XSYSPLLM);
- hw->DACclk[4] = inDAC1064(PMINFO DAC1064_XSYSPLLN);
- hw->DACclk[5] = inDAC1064(PMINFO DAC1064_XSYSPLLP);
- return;
- }
- mx = hw->MXoptionReg | 0x00000004;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, mx);
- mx &= ~0x000000BB;
- if (oscinfo & DAC1064_OPT_GDIV1)
- mx |= 0x00000008;
- if (oscinfo & DAC1064_OPT_MDIV1)
- mx |= 0x00000010;
- if (oscinfo & DAC1064_OPT_RESERVED)
- mx |= 0x00000080;
- if ((oscinfo & DAC1064_OPT_SCLK_MASK) == DAC1064_OPT_SCLK_PLL) {
- /* select PCI clock until we have setup oscilator... */
- int clk;
- unsigned int m, n, p;
-
- /* powerup system PLL, select PCI clock */
- mx |= 0x00000020;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, mx);
- mx &= ~0x00000004;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, mx);
-
- /* !!! you must not access device if MCLK is not running !!!
- Doing so cause immediate PCI lockup :-( Maybe they should
- generate ABORT or I/O (parity...) error and Linux should
- recover from this... (kill driver/process). But world is not
- perfect... */
- /* (bit 2 of PCI_OPTION_REG must be 0... and bits 0,1 must not
- select PLL... because of PLL can be stopped at this time) */
- DAC1064_calcclock(PMINFO fmem, ACCESS_FBINFO(max_pixel_clock), &m, &n, &p);
- outDAC1064(PMINFO DAC1064_XSYSPLLM, hw->DACclk[3] = m);
- outDAC1064(PMINFO DAC1064_XSYSPLLN, hw->DACclk[4] = n);
- outDAC1064(PMINFO DAC1064_XSYSPLLP, hw->DACclk[5] = p);
- for (clk = 65536; clk; --clk) {
- if (inDAC1064(PMINFO DAC1064_XSYSPLLSTAT) & 0x40)
- break;
- }
- if (!clk)
- printk(KERN_ERR "matroxfb: aiee, SYSPLL not locked\n");
- /* select PLL */
- mx |= 0x00000005;
- } else {
- /* select specified system clock source */
- mx |= oscinfo & DAC1064_OPT_SCLK_MASK;
- }
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, mx);
- mx &= ~0x00000004;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, mx);
- hw->MXoptionReg = mx;
-}
-
-static int DAC1064_init_1(CPMINFO struct matrox_hw_state* hw, struct my_timming* m, struct display *p) {
-
- DBG("DAC1064_init_1")
-
- memcpy(hw->DACreg, MGA1064_DAC, sizeof(MGA1064_DAC_regs));
- if (p->type == FB_TYPE_TEXT) {
- hw->DACreg[POS1064_XMISCCTRL] = M1064_XMISCCTRL_DAC_EN
- | M1064_XMISCCTRL_MFC_DIS
- | M1064_XMISCCTRL_DAC_6BIT
- | M1064_XMISCCTRL_LUT_EN;
- hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_8BPP
- | M1064_XMULCTRL_GRAPHICS_PALETIZED;
- } else {
- switch (p->var.bits_per_pixel) {
- /* case 4: not supported by MGA1064 DAC */
- case 8:
- hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_8BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED;
- break;
- case 16:
- if (p->var.green.length == 5)
- hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_15BPP_1BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED;
- else
- hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_16BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED;
- break;
- case 24:
- hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_24BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED;
- break;
- case 32:
- hw->DACreg[POS1064_XMULCTRL] = M1064_XMULCTRL_DEPTH_32BPP | M1064_XMULCTRL_GRAPHICS_PALETIZED;
- break;
- default:
- return 1; /* unsupported depth */
- }
- }
- hw->DACreg[POS1064_XVREFCTRL] = ACCESS_FBINFO(features.DAC1064.xvrefctrl);
- hw->DACreg[POS1064_XGENCTRL] &= ~M1064_XGENCTRL_SYNC_ON_GREEN_MASK;
- hw->DACreg[POS1064_XGENCTRL] |= (m->sync & FB_SYNC_ON_GREEN)?M1064_XGENCTRL_SYNC_ON_GREEN:M1064_XGENCTRL_NO_SYNC_ON_GREEN;
- hw->DACreg[POS1064_XCURADDL] = ACCESS_FBINFO(features.DAC1064.cursorimage) >> 10;
- hw->DACreg[POS1064_XCURADDH] = ACCESS_FBINFO(features.DAC1064.cursorimage) >> 18;
- return 0;
-}
-
-static int DAC1064_init_2(CPMINFO struct matrox_hw_state* hw, struct my_timming* m, struct display* p) {
-
- DBG("DAC1064_init_2")
-
- DAC1064_setpclk(PMINFO hw, m->pixclock);
- if (p->var.bits_per_pixel > 16) { /* 256 entries */
- int i;
-
- for (i = 0; i < 256; i++) {
- hw->DACpal[i * 3 + 0] = i;
- hw->DACpal[i * 3 + 1] = i;
- hw->DACpal[i * 3 + 2] = i;
- }
- } else if (p->var.bits_per_pixel > 8) {
- if (p->var.green.length == 5) { /* 0..31, 128..159 */
- int i;
-
- for (i = 0; i < 32; i++) {
- /* with p15 == 0 */
- hw->DACpal[i * 3 + 0] = i << 3;
- hw->DACpal[i * 3 + 1] = i << 3;
- hw->DACpal[i * 3 + 2] = i << 3;
- /* with p15 == 1 */
- hw->DACpal[(i + 128) * 3 + 0] = i << 3;
- hw->DACpal[(i + 128) * 3 + 1] = i << 3;
- hw->DACpal[(i + 128) * 3 + 2] = i << 3;
- }
- } else {
- int i;
-
- for (i = 0; i < 64; i++) { /* 0..63 */
- hw->DACpal[i * 3 + 0] = i << 3;
- hw->DACpal[i * 3 + 1] = i << 2;
- hw->DACpal[i * 3 + 2] = i << 3;
- }
- }
- } else {
- memset(hw->DACpal, 0, 768);
- }
- return 0;
-}
-
-static void DAC1064_restore_1(CPMINFO const struct matrox_hw_state* hw, const struct matrox_hw_state* oldhw) {
-
- DBG("DAC1064_restore_1")
-
- outDAC1064(PMINFO DAC1064_XSYSPLLM, hw->DACclk[3]);
- outDAC1064(PMINFO DAC1064_XSYSPLLN, hw->DACclk[4]);
- outDAC1064(PMINFO DAC1064_XSYSPLLP, hw->DACclk[5]);
- if (!oldhw || memcmp(hw->DACreg, oldhw->DACreg, sizeof(MGA1064_DAC_regs))) {
- unsigned int i;
-
- for (i = 0; i < sizeof(MGA1064_DAC_regs); i++)
- outDAC1064(PMINFO MGA1064_DAC_regs[i], hw->DACreg[i]);
- }
-}
-
-static void DAC1064_restore_2(WPMINFO const struct matrox_hw_state* hw, const struct matrox_hw_state* oldhw, struct display* p) {
- unsigned int i;
- unsigned int tmout;
-
- DBG("DAC1064_restore_2")
-
- for (i = 0; i < 3; i++)
- outDAC1064(PMINFO M1064_XPIXPLLCM + i, hw->DACclk[i]);
- for (tmout = 500000; tmout; tmout--) {
- if (inDAC1064(PMINFO M1064_XPIXPLLSTAT) & 0x40)
- break;
- udelay(10);
- }
-
- if (!tmout)
- printk(KERN_ERR "matroxfb: Pixel PLL not locked after 5 secs\n");
-
- if (p && p->conp) {
- if (p->type == FB_TYPE_TEXT) {
- matrox_text_createcursor(PMINFO p);
- matrox_text_loadfont(PMINFO p);
- i = 0;
- } else {
- matroxfb_DAC1064_createcursor(PMINFO p);
- i = matroxfb_fastfont_tryset(PMINFO p);
- }
- } else
- i = 0;
- if (i) {
- ACCESS_FBINFO(curr.putc) = matrox_cfbX_fastputc;
- ACCESS_FBINFO(curr.putcs) = matrox_cfbX_fastputcs;
- } else {
- ACCESS_FBINFO(curr.putc) = matrox_cfbX_putc;
- ACCESS_FBINFO(curr.putcs) = matrox_cfbX_putcs;
- }
-#ifdef DEBUG
- dprintk(KERN_DEBUG "DAC1064regs ");
- for (i = 0; i < sizeof(MGA1064_DAC_regs); i++) {
- dprintk("R%02X=%02X ", MGA1064_DAC_regs[i], hw->DACreg[i]);
- if ((i & 0x7) == 0x7) dprintk("\n" KERN_DEBUG "continuing... ");
- }
- dprintk("\n" KERN_DEBUG "DAC1064clk ");
- for (i = 0; i < 6; i++)
- dprintk("C%02X=%02X ", i, hw->DACclk[i]);
- dprintk("\n");
-#endif
-}
-#endif /* NEED_DAC1064 */
-
-#ifdef CONFIG_FB_MATROX_MYSTIQUE
-static int MGA1064_init(CPMINFO struct matrox_hw_state* hw, struct my_timming* m, struct display* p) {
-
- DBG("MGA1064_init")
-
- if (DAC1064_init_1(PMINFO hw, m, p)) return 1;
- if (vgaHWinit(PMINFO hw, m, p)) return 1;
-
- hw->MiscOutReg = 0xCB;
- if (m->sync & FB_SYNC_HOR_HIGH_ACT)
- hw->MiscOutReg &= ~0x40;
- if (m->sync & FB_SYNC_VERT_HIGH_ACT)
- hw->MiscOutReg &= ~0x80;
- if (m->sync & FB_SYNC_COMP_HIGH_ACT) /* should be only FB_SYNC_COMP */
- hw->CRTCEXT[3] |= 0x40;
-
- if (DAC1064_init_2(PMINFO hw, m, p)) return 1;
- return 0;
-}
-#endif
-
-#ifdef CONFIG_FB_MATROX_G100
-static int MGAG100_init(CPMINFO struct matrox_hw_state* hw, struct my_timming* m, struct display* p) {
-
- DBG("MGAG100_init")
-
- if (DAC1064_init_1(PMINFO hw, m, p)) return 1;
- hw->MXoptionReg &= ~0x2000;
- if (vgaHWinit(PMINFO hw, m, p)) return 1;
-
- hw->MiscOutReg = 0xEF;
- if (m->sync & FB_SYNC_HOR_HIGH_ACT)
- hw->MiscOutReg &= ~0x40;
- if (m->sync & FB_SYNC_VERT_HIGH_ACT)
- hw->MiscOutReg &= ~0x80;
- if (m->sync & FB_SYNC_COMP_HIGH_ACT) /* should be only FB_SYNC_COMP */
- hw->CRTCEXT[3] |= 0x40;
-
- if (DAC1064_init_2(PMINFO hw, m, p)) return 1;
- return 0;
-}
-#endif /* G100 */
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static int Ti3026_init(CPMINFO struct matrox_hw_state* hw, struct my_timming* m, struct display* p) {
- u_int8_t muxctrl = isInterleave(MINFO) ? TVP3026_XMUXCTRL_MEMORY_64BIT : TVP3026_XMUXCTRL_MEMORY_32BIT;
-
- DBG("Ti3026_init")
-
- memcpy(hw->DACreg, MGADACbpp32, sizeof(hw->DACreg));
- if (p->type == FB_TYPE_TEXT) {
- hw->DACreg[POS3026_XLATCHCTRL] = TVP3026_XLATCHCTRL_8_1;
- hw->DACreg[POS3026_XTRUECOLORCTRL] = TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR;
- hw->DACreg[POS3026_XMUXCTRL] = TVP3026_XMUXCTRL_VGA;
- hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL |
- TVP3026_XCLKCTRL_DIV4;
- hw->DACreg[POS3026_XMISCCTRL] = TVP3026_XMISCCTRL_DAC_PUP | TVP3026_XMISCCTRL_DAC_6BIT | TVP3026_XMISCCTRL_PSEL_DIS | TVP3026_XMISCCTRL_PSEL_LOW;
- } else {
- switch (p->var.bits_per_pixel) {
- case 4: hw->DACreg[POS3026_XLATCHCTRL] = TVP3026_XLATCHCTRL_16_1; /* or _8_1, they are same */
- hw->DACreg[POS3026_XTRUECOLORCTRL] = TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR;
- hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_4BIT;
- hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV8;
- hw->DACreg[POS3026_XMISCCTRL] = TVP3026_XMISCCTRL_DAC_PUP | TVP3026_XMISCCTRL_DAC_8BIT | TVP3026_XMISCCTRL_PSEL_DIS | TVP3026_XMISCCTRL_PSEL_LOW;
- break;
- case 8: hw->DACreg[POS3026_XLATCHCTRL] = TVP3026_XLATCHCTRL_8_1; /* or _4_1, they are same */
- hw->DACreg[POS3026_XTRUECOLORCTRL] = TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR;
- hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_8BIT;
- hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV4;
- hw->DACreg[POS3026_XMISCCTRL] = TVP3026_XMISCCTRL_DAC_PUP | TVP3026_XMISCCTRL_DAC_8BIT | TVP3026_XMISCCTRL_PSEL_DIS | TVP3026_XMISCCTRL_PSEL_LOW;
- break;
- case 16:
- /* XLATCHCTRL should be _4_1 / _2_1... Why is not? (_2_1 is used everytime) */
- hw->DACreg[POS3026_XTRUECOLORCTRL] = (p->var.green.length == 5)? (TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_ORGB_1555 ) : (TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_RGB_565);
- hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_16BIT;
- hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV2;
- break;
- case 24:
- /* XLATCHCTRL is: for (A) use _4_3 (?_8_3 is same? TBD), for (B) it is set in setpclk */
- hw->DACreg[POS3026_XTRUECOLORCTRL] = TVP3026_XTRUECOLORCTRL_DIRECTCOLOR | TVP3026_XTRUECOLORCTRL_RGB_888;
- hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_32BIT;
- hw->DACreg[POS3026_XCLKCTRL] = TVP3026_XCLKCTRL_SRC_PLL | TVP3026_XCLKCTRL_DIV4;
- break;
- case 32:
- /* XLATCHCTRL should be _2_1 / _1_1... Why is not? (_2_1 is used everytime) */
- hw->DACreg[POS3026_XMUXCTRL] = muxctrl | TVP3026_XMUXCTRL_PIXEL_32BIT;
- break;
- default:
- return 1; /* TODO: failed */
- }
- }
- if (vgaHWinit(PMINFO hw, m, p)) return 1;
-
- /* set SYNC */
- hw->MiscOutReg = 0xCB;
- if (m->sync & FB_SYNC_HOR_HIGH_ACT)
- hw->DACreg[POS3026_XGENCTRL] |= TVP3026_XGENCTRL_HSYNC_NEG;
- if (m->sync & FB_SYNC_VERT_HIGH_ACT)
- hw->DACreg[POS3026_XGENCTRL] |= TVP3026_XGENCTRL_VSYNC_NEG;
- if (m->sync & FB_SYNC_ON_GREEN)
- hw->DACreg[POS3026_XGENCTRL] |= TVP3026_XGENCTRL_SYNC_ON_GREEN;
-
- /* set DELAY */
- if (ACCESS_FBINFO(video.len) < 0x400000)
- hw->CRTCEXT[3] |= 0x08;
- else if (ACCESS_FBINFO(video.len) > 0x400000)
- hw->CRTCEXT[3] |= 0x10;
-
- /* set HWCURSOR */
- if (m->interlaced) {
- hw->DACreg[POS3026_XCURCTRL] |= TVP3026_XCURCTRL_INTERLACED;
- }
- if (m->HTotal >= 1536)
- hw->DACreg[POS3026_XCURCTRL] |= TVP3026_XCURCTRL_BLANK4096;
-
- /* set interleaving */
- hw->MXoptionReg &= ~0x00001000;
- if ((p->type != FB_TYPE_TEXT) && isInterleave(MINFO)) hw->MXoptionReg |= 0x00001000;
-
- /* set DAC */
- Ti3026_setpclk(PMINFO hw, m->pixclock, p);
- return 0;
-}
-#endif /* CONFIG_FB_MATROX_MILLENIUM */
-
-static int matroxfb_get_cmap_len(struct fb_var_screeninfo *var) {
-
- DBG("matroxfb_get_cmap_len")
-
- switch (var->bits_per_pixel) {
-#ifdef FBCON_HAS_VGATEXT
- case 0:
- return 16; /* pseudocolor... 16 entries HW palette */
-#endif
-#ifdef FBCON_HAS_CFB4
- case 4:
- return 16; /* pseudocolor... 16 entries HW palette */
-#endif
-#ifdef FBCON_HAS_CFB8
- case 8:
- return 256; /* pseudocolor... 256 entries HW palette */
-#endif
-#ifdef FBCON_HAS_CFB16
- case 16:
- return 16; /* directcolor... 16 entries SW palette */
- /* Mystique: truecolor, 16 entries SW palette, HW palette hardwired into 1:1 mapping */
-#endif
-#ifdef FBCON_HAS_CFB24
- case 24:
- return 16; /* directcolor... 16 entries SW palette */
- /* Mystique: truecolor, 16 entries SW palette, HW palette hardwired into 1:1 mapping */
-#endif
-#ifdef FBCON_HAS_CFB32
- case 32:
- return 16; /* directcolor... 16 entries SW palette */
- /* Mystique: truecolor, 16 entries SW palette, HW palette hardwired into 1:1 mapping */
-#endif
- }
- return 16; /* return something reasonable... or panic()? */
-}
-
-static int matroxfb_decode_var(CPMINFO struct display* p, struct fb_var_screeninfo *var, int *visual, int *video_cmap_len, unsigned int* ydstorg) {
- unsigned int vramlen;
- unsigned int memlen;
-
- DBG("matroxfb_decode_var")
-
- switch (var->bits_per_pixel) {
-#ifdef FBCON_HAS_VGATEXT
- case 0: if (!ACCESS_FBINFO(capable.text)) return -EINVAL;
- break;
-#endif
-#ifdef FBCON_HAS_CFB4
- case 4: if (!ACCESS_FBINFO(capable.cfb4)) return -EINVAL;
- break;
-#endif
-#ifdef FBCON_HAS_CFB8
- case 8: break;
-#endif
-#ifdef FBCON_HAS_CFB16
- case 16: break;
-#endif
-#ifdef FBCON_HAS_CFB24
- case 24: break;
-#endif
-#ifdef FBCON_HAS_CFB32
- case 32: break;
-#endif
- default: return -EINVAL;
- }
- *ydstorg = 0;
- vramlen = ACCESS_FBINFO(video.len_usable);
- if (var->bits_per_pixel) {
- var->xres_virtual = matroxfb_pitch_adjust(PMINFO var->xres_virtual, var->bits_per_pixel);
- memlen = var->xres_virtual * var->bits_per_pixel * var->yres_virtual / 8;
- if (memlen > vramlen) {
- var->yres_virtual = vramlen * 8 / (var->xres_virtual * var->bits_per_pixel);
- memlen = var->xres_virtual * var->bits_per_pixel * var->yres_virtual / 8;
- }
- /* There is hardware bug that no line can cross 4MB boundary */
- /* give up for CFB24, it is impossible to easy workaround it */
- /* for other try to do something */
- if (!ACCESS_FBINFO(capable.cross4MB) && (memlen > 0x400000)) {
- if (var->bits_per_pixel == 24) {
- /* sorry */
- } else {
- unsigned int linelen;
- unsigned int m1 = linelen = var->xres_virtual * var->bits_per_pixel / 8;
- unsigned int m2 = PAGE_SIZE; /* or 128 if you do not need PAGE ALIGNED address */
- unsigned int max_yres;
-
- while (m1) {
- int t;
-
- while (m2 >= m1) m2 -= m1;
- t = m1;
- m1 = m2;
- m2 = t;
- }
- m2 = linelen * PAGE_SIZE / m2;
- *ydstorg = m2 = 0x400000 % m2;
- max_yres = (vramlen - m2) / linelen;
- if (var->yres_virtual > max_yres)
- var->yres_virtual = max_yres;
- }
- }
- } else {
- matrox_text_round(PMINFO var, p);
-#if 0
-/* we must limit pixclock by mclk...
- Millenium I: 66 MHz = 15000
- Millenium II: 61 MHz = 16300
- Millenium G200: 83 MHz = 12000 */
- if (var->pixclock < 15000)
- var->pixclock = 15000; /* limit for "normal" gclk & mclk */
-#endif
- }
- /* YDSTLEN contains only signed 16bit value */
- if (var->yres_virtual > 32767)
- var->yres_virtual = 32767;
- if (var->yres_virtual < var->yres)
- var->yres = var->yres_virtual;
- if (var->xres_virtual < var->xres)
- var->xres = var->xres_virtual;
- if (var->xoffset + var->xres > var->xres_virtual)
- var->xoffset = var->xres_virtual - var->xres;
- if (var->yoffset + var->yres > var->yres_virtual)
- var->yoffset = var->yres_virtual - var->yres;
-
- if (var->bits_per_pixel == 0) {
- var->red.offset = 0;
- var->red.length = 6;
- var->green.offset = 0;
- var->green.length = 6;
- var->blue.offset = 0;
- var->blue.length = 6;
- var->transp.offset = 0;
- var->transp.length = 0;
- *visual = MX_VISUAL_PSEUDOCOLOR;
- } else if (var->bits_per_pixel == 4) {
- var->red.offset = 0;
- var->red.length = 8;
- var->green.offset = 0;
- var->green.length = 8;
- var->blue.offset = 0;
- var->blue.length = 8;
- var->transp.offset = 0;
- var->transp.length = 0;
- *visual = MX_VISUAL_PSEUDOCOLOR;
- } else if (var->bits_per_pixel <= 8) {
- var->red.offset = 0;
- var->red.length = 8;
- var->green.offset = 0;
- var->green.length = 8;
- var->blue.offset = 0;
- var->blue.length = 8;
- var->transp.offset = 0;
- var->transp.length = 0;
- *visual = MX_VISUAL_PSEUDOCOLOR;
- } else {
- if (var->bits_per_pixel <= 16) {
- if (var->green.length == 5) {
- var->red.offset = 10;
- var->red.length = 5;
- var->green.offset = 5;
- var->green.length = 5;
- var->blue.offset = 0;
- var->blue.length = 5;
- var->transp.offset = 15;
- var->transp.length = 1;
- } else {
- var->red.offset = 11;
- var->red.length = 5;
- var->green.offset = 5;
- var->green.length = 6;
- var->blue.offset = 0;
- var->blue.length = 5;
- var->transp.offset = 0;
- var->transp.length = 0;
- }
- } else if (var->bits_per_pixel <= 24) {
- var->red.offset = 16;
- var->red.length = 8;
- var->green.offset = 8;
- var->green.length = 8;
- var->blue.offset = 0;
- var->blue.length = 8;
- var->transp.offset = 0;
- var->transp.length = 0;
- } else {
- var->red.offset = 16;
- var->red.length = 8;
- var->green.offset = 8;
- var->green.length = 8;
- var->blue.offset = 0;
- var->blue.length = 8;
- var->transp.offset = 24;
- var->transp.length = 8;
- }
- dprintk("matroxfb: truecolor: "
- "size=%d:%d:%d:%d, shift=%d:%d:%d:%d\n",
- var->transp.length,
- var->red.length,
- var->green.length,
- var->blue.length,
- var->transp.offset,
- var->red.offset,
- var->green.offset,
- var->blue.offset);
- *visual = MX_VISUAL_DIRECTCOLOR;
- }
- *video_cmap_len = matroxfb_get_cmap_len(var);
- dprintk(KERN_INFO "requested %d*%d/%dbpp (%d*%d)\n", var->xres, var->yres, var->bits_per_pixel,
- var->xres_virtual, var->yres_virtual);
- return 0;
-}
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static void __init ti3026_setMCLK(CPMINFO struct matrox_hw_state* hw, int fout){
- unsigned int f_pll;
- unsigned int pclk_m, pclk_n, pclk_p;
- unsigned int mclk_m, mclk_n, mclk_p;
- unsigned int rfhcnt, mclk_ctl;
- int tmout;
-
- DBG("ti3026_setMCLK")
-
- f_pll = Ti3026_calcclock(PMINFO fout, ACCESS_FBINFO(max_pixel_clock), &mclk_n, &mclk_m, &mclk_p);
-
- /* save pclk */
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFC);
- pclk_n = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFD);
- pclk_m = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFE);
- pclk_p = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
-
- /* stop pclk */
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFE);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0x00);
-
- /* set pclk to new mclk */
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFC);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, mclk_n | 0xC0);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, mclk_m);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, mclk_p | 0xB0);
-
- /* wait for PLL to lock */
- for (tmout = 500000; tmout; tmout--) {
- if (inTi3026(PMINFO TVP3026_XPIXPLLDATA) & 0x40)
- break;
- udelay(10);
- };
- if (!tmout)
- printk(KERN_ERR "matroxfb: Temporary pixel PLL not locked after 5 secs\n");
-
- /* output pclk on mclk pin */
- mclk_ctl = inTi3026(PMINFO TVP3026_XMEMPLLCTRL);
- outTi3026(PMINFO TVP3026_XMEMPLLCTRL, mclk_ctl & 0xE7);
- outTi3026(PMINFO TVP3026_XMEMPLLCTRL, (mclk_ctl & 0xE7) | TVP3026_XMEMPLLCTRL_STROBEMKC4);
-
- /* stop MCLK */
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFB);
- outTi3026(PMINFO TVP3026_XMEMPLLDATA, 0x00);
-
- /* set mclk to new freq */
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xF3);
- outTi3026(PMINFO TVP3026_XMEMPLLDATA, mclk_n | 0xC0);
- outTi3026(PMINFO TVP3026_XMEMPLLDATA, mclk_m);
- outTi3026(PMINFO TVP3026_XMEMPLLDATA, mclk_p | 0xB0);
-
- /* wait for PLL to lock */
- for (tmout = 500000; tmout; tmout--) {
- if (inTi3026(PMINFO TVP3026_XMEMPLLDATA) & 0x40)
- break;
- udelay(10);
- }
- if (!tmout)
- printk(KERN_ERR "matroxfb: Memory PLL not locked after 5 secs\n");
-
- f_pll = f_pll * 333 / (10000 << mclk_p);
- if (isMilleniumII(MINFO)) {
- rfhcnt = (f_pll - 128) / 256;
- if (rfhcnt > 15)
- rfhcnt = 15;
- } else {
- rfhcnt = (f_pll - 64) / 128;
- if (rfhcnt > 15)
- rfhcnt = 0;
- }
- hw->MXoptionReg = (hw->MXoptionReg & ~0x000F0000) | (rfhcnt << 16);
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
-
- /* output MCLK to MCLK pin */
- outTi3026(PMINFO TVP3026_XMEMPLLCTRL, (mclk_ctl & 0xE7) | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL);
- outTi3026(PMINFO TVP3026_XMEMPLLCTRL, (mclk_ctl ) | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL | TVP3026_XMEMPLLCTRL_STROBEMKC4);
-
- /* stop PCLK */
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFE);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0x00);
-
- /* restore pclk */
- outTi3026(PMINFO TVP3026_XPLLADDR, 0xFC);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, pclk_n);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, pclk_m);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, pclk_p);
-
- /* wait for PLL to lock */
- for (tmout = 500000; tmout; tmout--) {
- if (inTi3026(PMINFO TVP3026_XPIXPLLDATA) & 0x40)
- break;
- udelay(10);
- }
- if (!tmout)
- printk(KERN_ERR "matroxfb: Pixel PLL not locked after 5 secs\n");
-}
-
-static void __init ti3026_ramdac_init(WPMINFO struct matrox_hw_state* hw){
-
- DBG("ti3026_ramdac_init")
-
- ACCESS_FBINFO(features.pll.vco_freq_min) = 110000;
- ACCESS_FBINFO(features.pll.ref_freq) = 114545;
- ACCESS_FBINFO(features.pll.feed_div_min) = 2;
- ACCESS_FBINFO(features.pll.feed_div_max) = 24;
- ACCESS_FBINFO(features.pll.in_div_min) = 2;
- ACCESS_FBINFO(features.pll.in_div_max) = 63;
- ACCESS_FBINFO(features.pll.post_shift_max) = 3;
- if (ACCESS_FBINFO(devflags.noinit))
- return;
- ti3026_setMCLK(PMINFO hw, 60000);
-}
-#endif
-
-static 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;
- }
- }
- }
-}
-
-#ifdef CONFIG_FB_MATROX_MYSTIQUE
-static void __init MGA1064_ramdac_init(WPMINFO struct matrox_hw_state* hw){
-
- DBG("MGA1064_ramdac_init");
-
- /* ACCESS_FBINFO(features.DAC1064.vco_freq_min) = 120000; */
- ACCESS_FBINFO(features.pll.vco_freq_min) = 62000;
- ACCESS_FBINFO(features.pll.ref_freq) = 14318;
- ACCESS_FBINFO(features.pll.feed_div_min) = 100;
- ACCESS_FBINFO(features.pll.feed_div_max) = 127;
- ACCESS_FBINFO(features.pll.in_div_min) = 1;
- ACCESS_FBINFO(features.pll.in_div_max) = 31;
- ACCESS_FBINFO(features.pll.post_shift_max) = 3;
- ACCESS_FBINFO(features.DAC1064.xvrefctrl) = DAC1064_XVREFCTRL_EXTERNAL;
- /* maybe cmdline MCLK= ?, doc says gclk=44MHz, mclk=66MHz... it was 55/83 with old values */
- DAC1064_setmclk(PMINFO hw, DAC1064_OPT_MDIV2 | DAC1064_OPT_GDIV3 | DAC1064_OPT_SCLK_PLL, 133333);
-}
-
-static int __init MGA1064_preinit(WPMINFO struct matrox_hw_state* hw){
- static const int vxres_mystique[] = { 512, 640, 768, 800, 832, 960,
- 1024, 1152, 1280, 1600, 1664, 1920,
- 2048, 0};
- DBG("MGA1064_preinit")
-
- /* ACCESS_FBINFO(capable.cfb4) = 0; ... preinitialized by 0 */
- ACCESS_FBINFO(capable.text) = 1;
- ACCESS_FBINFO(capable.vxres) = vxres_mystique;
- ACCESS_FBINFO(features.accel.has_cacheflush) = 1;
- ACCESS_FBINFO(cursor.timer.function) = matroxfb_DAC1064_flashcursor;
-
- if (ACCESS_FBINFO(devflags.noinit))
- return 0; /* do not modify settings */
- hw->MXoptionReg &= 0xC0000100;
- hw->MXoptionReg |= 0x00094E20;
- if (ACCESS_FBINFO(devflags.novga))
- hw->MXoptionReg &= ~0x00000100;
- if (ACCESS_FBINFO(devflags.nobios))
- hw->MXoptionReg &= ~0x40000000;
- if (ACCESS_FBINFO(devflags.nopciretry))
- hw->MXoptionReg |= 0x20000000;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
- mga_setr(M_SEQ_INDEX, 0x01, 0x20);
- mga_outl(M_CTLWTST, 0x00000000);
- udelay(200);
- mga_outl(M_MACCESS, 0x00008000);
- udelay(100);
- mga_outl(M_MACCESS, 0x0000C000);
- return 0;
-}
-
-static void __init MGA1064_reset(WPMINFO struct matrox_hw_state* hw){
-
- DBG("MGA1064_reset");
-
- ACCESS_FBINFO(features.DAC1064.cursorimage) = ACCESS_FBINFO(video.len_usable) - 1024;
- if (ACCESS_FBINFO(devflags.hwcursor))
- ACCESS_FBINFO(video.len_usable) -= 1024;
- matroxfb_fastfont_init(MINFO);
- MGA1064_ramdac_init(PMINFO hw);
-}
-#endif
-
-#ifdef CONFIG_FB_MATROX_G100
-/* BIOS environ */
-static int x7AF4 = 0x10; /* flags, maybe 0x10 = SDRAM, 0x00 = SGRAM??? */
- /* G100 wants 0x10, G200 SGRAM does not care... */
-#if 0
-static int def50 = 0; /* reg50, & 0x0F, & 0x3000 (only 0x0000, 0x1000, 0x2000 (0x3000 disallowed and treated as 0) */
-#endif
-
-static void __init MGAG100_progPixClock(CPMINFO int flags, int m, int n, int p){
- int reg;
- int selClk;
- int clk;
-
- DBG("MGAG100_progPixClock")
-
- outDAC1064(PMINFO M1064_XPIXCLKCTRL, inDAC1064(PMINFO M1064_XPIXCLKCTRL) | M1064_XPIXCLKCTRL_DIS |
- M1064_XPIXCLKCTRL_PLL_UP);
- switch (flags & 3) {
- case 0: reg = M1064_XPIXPLLAM; break;
- case 1: reg = M1064_XPIXPLLBM; break;
- default: reg = M1064_XPIXPLLCM; break;
- }
- outDAC1064(PMINFO reg++, m);
- outDAC1064(PMINFO reg++, n);
- outDAC1064(PMINFO reg, p);
- selClk = mga_inb(M_MISC_REG_READ) & ~0xC;
- /* there should be flags & 0x03 & case 0/1/else */
- /* and we should first select source and after that we should wait for PLL */
- /* and we are waiting for PLL with oscilator disabled... Is it right? */
- switch (flags & 0x03) {
- case 0x00: break;
- case 0x01: selClk |= 4; break;
- default: selClk |= 0x0C; break;
- }
- mga_outb(M_MISC_REG, selClk);
- for (clk = 500000; clk; clk--) {
- if (inDAC1064(PMINFO M1064_XPIXPLLSTAT) & 0x40)
- break;
- udelay(10);
- };
- if (!clk)
- printk(KERN_ERR "matroxfb: Pixel PLL%c not locked after usual time\n", (reg-M1064_XPIXPLLAM-2)/4 + 'A');
- selClk = inDAC1064(PMINFO M1064_XPIXCLKCTRL) & ~M1064_XPIXCLKCTRL_SRC_MASK;
- switch (flags & 0x0C) {
- case 0x00: selClk |= M1064_XPIXCLKCTRL_SRC_PCI; break;
- case 0x04: selClk |= M1064_XPIXCLKCTRL_SRC_PLL; break;
- default: selClk |= M1064_XPIXCLKCTRL_SRC_EXT; break;
- }
- outDAC1064(PMINFO M1064_XPIXCLKCTRL, selClk);
- outDAC1064(PMINFO M1064_XPIXCLKCTRL, inDAC1064(PMINFO M1064_XPIXCLKCTRL) & ~M1064_XPIXCLKCTRL_DIS);
-}
-
-static void __init MGAG100_setPixClock(CPMINFO int flags, int freq){
- unsigned int m, n, p;
-
- DBG("MGAG100_setPixClock")
-
- DAC1064_calcclock(PMINFO freq, ACCESS_FBINFO(max_pixel_clock), &m, &n, &p);
- MGAG100_progPixClock(PMINFO flags, m, n, p);
-}
-
-static int __init MGAG100_preinit(WPMINFO struct matrox_hw_state* hw){
- static const int vxres_g100[] = { 512, 640, 768, 800, 832, 960,
- 1024, 1152, 1280, 1600, 1664, 1920,
- 2048, 0};
- u_int32_t reg50;
-#if 0
- u_int32_t q;
-#endif
-
- DBG("MGAG100_preinit")
-
- /* there are some instabilities if in_div > 19 && vco < 61000 */
- ACCESS_FBINFO(features.pll.vco_freq_min) = 62000;
- ACCESS_FBINFO(features.pll.ref_freq) = 27000;
- ACCESS_FBINFO(features.pll.feed_div_min) = 7;
- ACCESS_FBINFO(features.pll.feed_div_max) = 127;
- ACCESS_FBINFO(features.pll.in_div_min) = 1;
- ACCESS_FBINFO(features.pll.in_div_max) = 31;
- ACCESS_FBINFO(features.pll.post_shift_max) = 3;
- ACCESS_FBINFO(features.DAC1064.xvrefctrl) = DAC1064_XVREFCTRL_G100_DEFAULT;
- /* ACCESS_FBINFO(capable.cfb4) = 0; ... preinitialized by 0 */
- ACCESS_FBINFO(capable.text) = 1;
- ACCESS_FBINFO(capable.vxres) = vxres_g100;
- ACCESS_FBINFO(features.accel.has_cacheflush) = 1;
- ACCESS_FBINFO(cursor.timer.function) = matroxfb_DAC1064_flashcursor;
- ACCESS_FBINFO(capable.plnwt) = ACCESS_FBINFO(devflags.accelerator) != FB_ACCEL_MATROX_MGAG100;
-
- if (ACCESS_FBINFO(devflags.noinit))
- return 0;
- hw->MXoptionReg &= 0xC0000100;
- hw->MXoptionReg |= 0x00078020;
- if (ACCESS_FBINFO(devflags.novga))
- hw->MXoptionReg &= ~0x00000100;
- if (ACCESS_FBINFO(devflags.nobios))
- hw->MXoptionReg &= ~0x40000000;
- if (ACCESS_FBINFO(devflags.nopciretry))
- hw->MXoptionReg |= 0x20000000;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
- pci_read_config_dword(ACCESS_FBINFO(pcidev), 0x50, ®50);
- reg50 &= ~0x3000;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), 0x50, reg50);
-
- DAC1064_setmclk(PMINFO hw, DAC1064_OPT_MDIV2 | DAC1064_OPT_GDIV3 | DAC1064_OPT_SCLK_PCI, 133333);
-
- if (ACCESS_FBINFO(devflags.accelerator) == FB_ACCEL_MATROX_MGAG100) {
- hw->MXoptionReg |= 0x1080;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
- mga_outl(M_CTLWTST, 0x00000300);
- /* mga_outl(M_CTLWTST, 0x03258A31); */
- udelay(100);
- mga_outb(0x1C05, 0x00);
- mga_outb(0x1C05, 0x80);
- udelay(100);
- mga_outb(0x1C05, 0x40);
- mga_outb(0x1C05, 0xC0);
- udelay(100);
- reg50 &= ~0xFF;
- reg50 |= 0x07;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), 0x50, reg50);
- /* it should help with G100 */
- mga_outb(M_GRAPHICS_INDEX, 6);
- mga_outb(M_GRAPHICS_DATA, (mga_inb(M_GRAPHICS_DATA) & 3) | 4);
- mga_setr(M_EXTVGA_INDEX, 0x03, 0x81);
- mga_setr(M_EXTVGA_INDEX, 0x04, 0x00);
- mga_writeb(ACCESS_FBINFO(video.vbase), 0x0000, 0xAA);
- mga_writeb(ACCESS_FBINFO(video.vbase), 0x0800, 0x55);
- mga_writeb(ACCESS_FBINFO(video.vbase), 0x4000, 0x55);
-#if 0
- if (mga_readb(ACCESS_FBINFO(video.vbase), 0x0000) != 0xAA) {
- hw->MXoptionReg &= ~0x1000;
- }
-#endif
- } else {
- hw->MXoptionReg |= 0x00000C00;
- if (ACCESS_FBINFO(devflags.sgram))
- hw->MXoptionReg |= 0x4000;
- mga_outl(M_CTLWTST, 0x042450A1);
- mga_outb(0x1E47, 0x00);
- mga_outb(0x1E46, 0x00);
- udelay(10);
- mga_outb(0x1C05, 0x00);
- mga_outb(0x1C05, 0x80);
- udelay(100);
- mga_outw(0x1E44, 0x0108);
- }
- hw->MXoptionReg = (hw->MXoptionReg & ~0x1F8000) | 0x78000;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
- return 0;
-}
-
-static void __init MGAG100_reset(WPMINFO struct matrox_hw_state* hw){
- u_int8_t b;
-
- DBG("MGAG100_reset")
-
- ACCESS_FBINFO(features.DAC1064.cursorimage) = ACCESS_FBINFO(video.len_usable) - 1024;
- if (ACCESS_FBINFO(devflags.hwcursor))
- ACCESS_FBINFO(video.len_usable) -= 1024;
- matroxfb_fastfont_init(MINFO);
-
- {
-#ifdef G100_BROKEN_IBM_82351
- u_int32_t d;
-
- find 1014/22 (IBM/82351); /* if found and bridging Matrox, do some strange stuff */
- pci_read_config_byte(ibm, PCI_SECONDARY_BUS, &b);
- if (b == ACCESS_FBINFO(pcidev)->bus->number) {
- pci_write_config_byte(ibm, PCI_COMMAND+1, 0); /* disable back-to-back & SERR */
- pci_write_config_byte(ibm, 0x41, 0xF4); /* ??? */
- pci_write_config_byte(ibm, PCI_IO_BASE, 0xF0); /* ??? */
- pci_write_config_byte(ibm, PCI_IO_LIMIT, 0x00); /* ??? */
- }
-#endif
- if (!ACCESS_FBINFO(devflags.noinit)) {
- if (x7AF4 & 8) {
- hw->MXoptionReg |= 0x40;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
- }
- mga_setr(M_EXTVGA_INDEX, 0x06, 0x50);
- }
- }
- DAC1064_setmclk(PMINFO hw, DAC1064_OPT_RESERVED | DAC1064_OPT_MDIV2 | DAC1064_OPT_GDIV1 | DAC1064_OPT_SCLK_PLL, 133333);
- if (ACCESS_FBINFO(devflags.noinit))
- return;
- MGAG100_setPixClock(PMINFO 4, 25175);
- MGAG100_setPixClock(PMINFO 5, 28322);
- if (x7AF4 & 0x10) {
- b = inDAC1064(PMINFO M1064_XGENIODATA) & ~1;
- outDAC1064(PMINFO M1064_XGENIODATA, b);
- b = inDAC1064(PMINFO M1064_XGENIOCTRL) | 1;
- outDAC1064(PMINFO M1064_XGENIOCTRL, b);
- }
-}
-#endif
-
-static void vgaHWrestore(CPMINFO struct matrox_hw_state* hw, struct matrox_hw_state* oldhw) {
- int i;
-
- 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");
-
- 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);
-}
-
-static int matrox_setcolreg(unsigned regno, unsigned red, unsigned green,
- unsigned blue, unsigned transp,
- struct fb_info *fb_info)
-{
- struct display* p;
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
- struct matrox_fb_info* minfo = (struct matrox_fb_info*)fb_info;
-#endif
-
- DBG("matrox_setcolreg")
-
- /*
- * Set a single color register. The values supplied are
- * already rounded down to the hardware's capabilities
- * (according to the entries in the `var' structure). Return
- * != 0 for invalid regno.
- */
-
- if (regno >= ACCESS_FBINFO(curr.cmap_len))
- return 1;
-
- ACCESS_FBINFO(palette[regno].red) = red;
- ACCESS_FBINFO(palette[regno].green) = green;
- ACCESS_FBINFO(palette[regno].blue) = blue;
- ACCESS_FBINFO(palette[regno].transp) = transp;
-
- p = ACCESS_FBINFO(currcon_display);
- if (p->var.grayscale) {
- /* gray = 0.30*R + 0.59*G + 0.11*B */
- red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8;
- }
-
- red = CNVT_TOHW(red, p->var.red.length);
- green = CNVT_TOHW(green, p->var.green.length);
- blue = CNVT_TOHW(blue, p->var.blue.length);
- transp = CNVT_TOHW(transp, p->var.transp.length);
-
- switch (p->var.bits_per_pixel) {
-#if defined(FBCON_HAS_CFB8) || defined(FBCON_HAS_CFB4) || defined(FBCON_HAS_VGATEXT)
-#ifdef FBCON_HAS_VGATEXT
- case 0:
-#endif
-#ifdef FBCON_HAS_CFB4
- case 4:
-#endif
-#ifdef FBCON_HAS_CFB8
- case 8:
-#endif
- mga_outb(M_DAC_REG, regno);
- mga_outb(M_DAC_VAL, red);
- mga_outb(M_DAC_VAL, green);
- mga_outb(M_DAC_VAL, blue);
- break;
-#endif
-#ifdef FBCON_HAS_CFB16
- case 16:
- ACCESS_FBINFO(cmap.cfb16[regno]) =
- (red << p->var.red.offset) |
- (green << p->var.green.offset) |
- (blue << p->var.blue.offset) |
- (transp << p->var.transp.offset); /* for 1:5:5:5 */
- break;
-#endif
-#ifdef FBCON_HAS_CFB24
- case 24:
- ACCESS_FBINFO(cmap.cfb24[regno]) =
- (red << p->var.red.offset) |
- (green << p->var.green.offset) |
- (blue << p->var.blue.offset);
- break;
-#endif
-#ifdef FBCON_HAS_CFB32
- case 32:
- ACCESS_FBINFO(cmap.cfb32[regno]) =
- (red << p->var.red.offset) |
- (green << p->var.green.offset) |
- (blue << p->var.blue.offset) |
- (transp << p->var.transp.offset); /* 8:8:8:8 */
- break;
-#endif
- }
- return 0;
-}
-
-static void do_install_cmap(WPMINFO struct display* dsp)
-{
- DBG("do_install_cmap")
-
- if (dsp->cmap.len)
- fb_set_cmap(&dsp->cmap, 1, matrox_setcolreg, &ACCESS_FBINFO(fbcon));
- else
- fb_set_cmap(fb_default_cmap(ACCESS_FBINFO(curr.cmap_len)),
- 1, matrox_setcolreg, &ACCESS_FBINFO(fbcon));
-}
-
-#ifdef CONFIG_FB_MATROX_MYSTIQUE
-static void MGA1064_restore(WPMINFO struct matrox_hw_state* hw, struct matrox_hw_state* oldhw, struct display* p) {
- int i;
-
- DBG("MGA1064_restore")
-
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
- mga_outb(M_IEN, 0x00);
- mga_outb(M_CACHEFLUSH, 0x00);
-
- DAC1064_restore_1(PMINFO hw, oldhw);
- vgaHWrestore(PMINFO hw, oldhw);
- for (i = 0; i < 6; i++)
- mga_setr(M_EXTVGA_INDEX, i, hw->CRTCEXT[i]);
- DAC1064_restore_2(PMINFO hw, oldhw, p);
-}
-#endif
-
-#ifdef CONFIG_FB_MATROX_G100
-static void MGAG100_restore(WPMINFO struct matrox_hw_state* hw, struct matrox_hw_state* oldhw, struct display* p) {
- int i;
-
- DBG("MGAG100_restore")
-
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
-
- DAC1064_restore_1(PMINFO hw, oldhw);
- vgaHWrestore(PMINFO hw, oldhw);
-#ifdef CONFIG_FB_MATROX_32MB
- if (ACCESS_FBINFO(devflags.support32MB))
- mga_setr(M_EXTVGA_INDEX, 8, hw->CRTCEXT[8]);
-#endif
- for (i = 0; i < 6; i++)
- mga_setr(M_EXTVGA_INDEX, i, hw->CRTCEXT[i]);
- DAC1064_restore_2(PMINFO hw, oldhw, p);
-}
-#endif
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static void Ti3026_restore(WPMINFO struct matrox_hw_state* hw, struct matrox_hw_state* oldhw, struct display* p) {
- int i;
-
- DBG("Ti3026_restore")
-
- dprintk(KERN_INFO "EXTVGA regs: ");
- for (i = 0; i < 6; i++)
- dprintk("%02X:", hw->CRTCEXT[i]);
- dprintk("\n");
-
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
-
- vgaHWrestore(PMINFO hw, oldhw);
-
- for (i = 0; i < 6; i++)
- mga_setr(M_EXTVGA_INDEX, i, hw->CRTCEXT[i]);
-
- for (i = 0; i < 21; i++) {
- outTi3026(PMINFO DACseq[i], hw->DACreg[i]);
- }
- if (oldhw) {
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x00);
- oldhw->DACclk[0] = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
- oldhw->DACclk[3] = inTi3026(PMINFO TVP3026_XLOOPPLLDATA);
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x15);
- oldhw->DACclk[1] = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
- oldhw->DACclk[4] = inTi3026(PMINFO TVP3026_XLOOPPLLDATA);
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x2A);
- oldhw->DACclk[2] = inTi3026(PMINFO TVP3026_XPIXPLLDATA);
- oldhw->DACclk[5] = inTi3026(PMINFO TVP3026_XLOOPPLLDATA);
- }
- if (!oldhw || memcmp(hw->DACclk, oldhw->DACclk, 6)) {
- /* agrhh... setting up PLL is very slow on Millenium... */
- /* Mystique PLL is locked in few ms, but Millenium PLL lock takes about 0.15 s... */
- /* Maybe even we should call schedule() ? */
-
- outTi3026(PMINFO TVP3026_XCLKCTRL, hw->DACreg[POS3026_XCLKCTRL]);
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x2A);
- outTi3026(PMINFO TVP3026_XLOOPPLLDATA, 0);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0);
-
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x00);
- for (i = 0; i < 3; i++)
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, hw->DACclk[i]);
- /* wait for PLL only if PLL clock requested (always for PowerMode, never for VGA) */
- if (hw->MiscOutReg & 0x08) {
- int tmout;
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x3F);
- for (tmout = 500000; tmout; --tmout) {
- if (inTi3026(PMINFO TVP3026_XPIXPLLDATA) & 0x40)
- break;
- udelay(10);
- }
-
- if (!tmout)
- printk(KERN_ERR "matroxfb: Pixel PLL not locked after 5 secs\n");
- else
- dprintk(KERN_INFO "PixelPLL: %d\n", 500000-tmout);
- }
- outTi3026(PMINFO TVP3026_XMEMPLLCTRL, hw->DACreg[POS3026_XMEMPLLCTRL]);
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x00);
- for (i = 3; i < 6; i++)
- outTi3026(PMINFO TVP3026_XLOOPPLLDATA, hw->DACclk[i]);
- if ((hw->MiscOutReg & 0x08) && ((hw->DACclk[5] & 0x80) == 0x80)) {
- int tmout;
-
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x3F);
- for (tmout = 500000; tmout; --tmout) {
- if (inTi3026(PMINFO TVP3026_XLOOPPLLDATA) & 0x40)
- break;
- udelay(10);
- }
- if (!tmout)
- printk(KERN_ERR "matroxfb: Loop PLL not locked after 5 secs\n");
- else
- dprintk(KERN_INFO "LoopPLL: %d\n", 500000-tmout);
- }
- }
- if (p && p->conp) {
- if (p->type == FB_TYPE_TEXT) {
- matrox_text_createcursor(PMINFO p);
- matrox_text_loadfont(PMINFO p);
- i = 0;
- } else {
- matroxfb_ti3026_createcursor(PMINFO p);
- i = matroxfb_fastfont_tryset(PMINFO p);
- }
- } else
- i = 0;
- if (i) {
- ACCESS_FBINFO(curr.putc) = matrox_cfbX_fastputc;
- ACCESS_FBINFO(curr.putcs) = matrox_cfbX_fastputcs;
- } else {
- ACCESS_FBINFO(curr.putc) = matrox_cfbX_putc;
- ACCESS_FBINFO(curr.putcs) = matrox_cfbX_putcs;
- }
-
- dprintk(KERN_DEBUG "3026DACregs ");
- for (i = 0; i < 21; i++) {
- dprintk("R%02X=%02X ", DACseq[i], hw->DACreg[i]);
- if ((i & 0x7) == 0x7) dprintk("\n" KERN_DEBUG "continuing... ");
- }
- dprintk("\n" KERN_DEBUG "DACclk ");
- for (i = 0; i < 6; i++)
- dprintk("C%02X=%02X ", i, hw->DACclk[i]);
- dprintk("\n");
-}
-#endif
-
-static int matroxfb_get_fix(struct fb_fix_screeninfo *fix, int con,
- struct fb_info *info)
-{
- struct display* p;
- DBG("matroxfb_get_fix")
-
-#define minfo ((struct matrox_fb_info*)info)
-
- if (con >= 0)
- p = fb_display + con;
- else
- p = ACCESS_FBINFO(fbcon.disp);
-
- memset(fix, 0, sizeof(struct fb_fix_screeninfo));
- strcpy(fix->id,"MATROX");
-
- fix->smem_start = ACCESS_FBINFO(video.base) + ACCESS_FBINFO(curr.ydstorg.bytes);
- fix->smem_len = ACCESS_FBINFO(video.len_usable) - ACCESS_FBINFO(curr.ydstorg.bytes);
- fix->type = p->type;
- fix->type_aux = p->type_aux;
- fix->visual = p->visual;
- fix->xpanstep = 8; /* 8 for 8bpp, 4 for 16bpp, 2 for 32bpp */
- fix->ypanstep = 1;
- fix->ywrapstep = 0;
- fix->line_length = p->line_length;
- fix->mmio_start = ACCESS_FBINFO(mmio.base);
- fix->mmio_len = ACCESS_FBINFO(mmio.len);
- fix->accel = ACCESS_FBINFO(devflags.accelerator);
- return 0;
-#undef minfo
-}
-
-static int matroxfb_get_var(struct fb_var_screeninfo *var, int con,
- struct fb_info *info)
-{
-#define minfo ((struct matrox_fb_info*)info)
- DBG("matroxfb_get_var")
-
- if(con < 0)
- *var=ACCESS_FBINFO(fbcon.disp)->var;
- else
- *var=fb_display[con].var;
- return 0;
-#undef minfo
-}
-
-static int matroxfb_set_var(struct fb_var_screeninfo *var, int con,
- struct fb_info *info)
-{
-#define minfo ((struct matrox_fb_info*)info)
- int err;
- int visual;
- int cmap_len;
- unsigned int ydstorg;
- struct display* display;
- int chgvar;
-
- DBG("matroxfb_set_var")
-
- if (con >= 0)
- display = fb_display + con;
- else
- display = ACCESS_FBINFO(fbcon.disp);
- if ((err = matroxfb_decode_var(PMINFO display, var, &visual, &cmap_len, &ydstorg)) != 0)
- return err;
- switch (var->activate & FB_ACTIVATE_MASK) {
- case FB_ACTIVATE_TEST: return 0;
- case FB_ACTIVATE_NXTOPEN: /* ?? */
- case FB_ACTIVATE_NOW: break; /* continue */
- default: return -EINVAL; /* unknown */
- }
- if (con >= 0) {
- chgvar = ((display->var.xres != var->xres) ||
- (display->var.yres != var->yres) ||
- (display->var.xres_virtual != var->xres_virtual) ||
- (display->var.yres_virtual != var->yres_virtual) ||
- (display->var.bits_per_pixel != var->bits_per_pixel) ||
- memcmp(&display->var.red, &var->red, sizeof(var->red)) ||
- memcmp(&display->var.green, &var->green, sizeof(var->green)) ||
- memcmp(&display->var.blue, &var->blue, sizeof(var->blue)));
- } else {
- chgvar = 0;
- }
- display->var = *var;
- /* cmap */
- display->screen_base = vaddr_va(ACCESS_FBINFO(video.vbase)) + ydstorg;
- display->visual = visual;
- display->ypanstep = 1;
- display->ywrapstep = 0;
- if (var->bits_per_pixel) {
- display->type = FB_TYPE_PACKED_PIXELS;
- display->type_aux = 0;
- display->next_line = display->line_length = (var->xres_virtual * var->bits_per_pixel) >> 3;
- } else {
- display->type = FB_TYPE_TEXT;
- display->type_aux = ACCESS_FBINFO(devflags.text_type_aux);
- display->next_line = display->line_length = (var->xres_virtual / (fontwidth(display)?fontwidth(display):8)) * ACCESS_FBINFO(devflags.textstep);
- }
- display->can_soft_blank = 1;
- display->inverse = ACCESS_FBINFO(devflags.inverse);
- /* conp, fb_info, vrows, cursor_x, cursor_y, fgcol, bgcol */
- /* next_plane, fontdata, _font*, userfont */
- initMatrox(PMINFO display); /* dispsw */
- /* dispsw, scrollmode, yscroll */
- /* fgshift, bgshift, charmask */
- if (chgvar && info && info->changevar)
- info->changevar(con);
- if (con == ACCESS_FBINFO(currcon)) {
- unsigned int pos;
-
- ACCESS_FBINFO(curr.cmap_len) = cmap_len;
- if (display->type == FB_TYPE_TEXT) {
- /* textmode must be in first megabyte, so no ydstorg allowed */
- ACCESS_FBINFO(curr.ydstorg.bytes) = 0;
- ACCESS_FBINFO(curr.ydstorg.chunks) = 0;
- ACCESS_FBINFO(curr.ydstorg.pixels) = 0;
- } else {
- ydstorg += ACCESS_FBINFO(devflags.ydstorg);
- ACCESS_FBINFO(curr.ydstorg.bytes) = ydstorg;
- ACCESS_FBINFO(curr.ydstorg.chunks) = ydstorg >> (isInterleave(MINFO)?3:2);
- if (var->bits_per_pixel == 4)
- ACCESS_FBINFO(curr.ydstorg.pixels) = ydstorg;
- else
- ACCESS_FBINFO(curr.ydstorg.pixels) = (ydstorg * 8) / var->bits_per_pixel;
- }
- ACCESS_FBINFO(curr.final_bppShift) = matroxfb_get_final_bppShift(PMINFO var->bits_per_pixel);
- if (visual == MX_VISUAL_PSEUDOCOLOR) {
- int i;
-
- for (i = 0; i < 16; i++) {
- int j;
-
- j = color_table[i];
- ACCESS_FBINFO(palette[i].red) = default_red[j];
- ACCESS_FBINFO(palette[i].green) = default_grn[j];
- ACCESS_FBINFO(palette[i].blue) = default_blu[j];
- }
- }
-
- { struct my_timming mt;
- struct matrox_hw_state* hw;
- struct matrox_hw_state* ohw;
-
- var2my(var, &mt);
- hw = ACCESS_FBINFO(newhw);
- ohw = ACCESS_FBINFO(currenthw);
-
- /* MXoptionReg is not set from scratch */
- hw->MXoptionReg = ohw->MXoptionReg;
- /* DACclk[3]..[5] are not initialized with DAC1064 */
- memcpy(hw->DACclk, ohw->DACclk, sizeof(hw->DACclk));
- /* others are initialized by init() */
-
- del_timer(&ACCESS_FBINFO(cursor.timer));
- ACCESS_FBINFO(cursor.state) = CM_ERASE;
-
- ACCESS_FBINFO(hw_switch->init(PMINFO hw, &mt, display));
- if (display->type == FB_TYPE_TEXT) {
- if (fontheight(display))
- pos = var->yoffset / fontheight(display) * display->next_line / ACCESS_FBINFO(devflags.textstep) + var->xoffset / (fontwidth(display)?fontwidth(display):8);
- else
- pos = 0;
- } else {
- pos = (var->yoffset * var->xres_virtual + var->xoffset) * ACCESS_FBINFO(curr.final_bppShift) / 32;
- pos += ACCESS_FBINFO(curr.ydstorg.chunks);
- }
-
- hw->CRTC[0x0D] = pos & 0xFF;
- hw->CRTC[0x0C] = (pos & 0xFF00) >> 8;
- hw->CRTCEXT[0] = (hw->CRTCEXT[0] & 0xF0) | ((pos >> 16) & 0x0F) | ((pos >> 14) & 0x40);
- hw->CRTCEXT[8] = pos >> 21;
- ACCESS_FBINFO(hw_switch->restore(PMINFO hw, ohw, display));
- ACCESS_FBINFO(cursor.redraw) = 1;
- ACCESS_FBINFO(currenthw) = hw;
- ACCESS_FBINFO(newhw) = ohw;
- matrox_cfbX_init(PMINFO display);
- do_install_cmap(PMINFO display);
-#if defined(CONFIG_FB_OF) && defined(CONFIG_FB_COMPAT_XPMAC)
- if (console_fb_info == &ACCESS_FBINFO(fbcon)) {
- int vmode, cmode;
-
- display_info.width = var->xres;
- display_info.height = var->yres;
- display_info.depth = var->bits_per_pixel;
- display_info.pitch = (var->xres_virtual)*(var->bits_per_pixel)/8;
- if (mac_var_to_vmode(var, &vmode, &cmode))
- display_info.mode = 0;
- else
- display_info.mode = vmode;
- strcpy(display_info.name, ACCESS_FBINFO(matrox_name));
- display_info.fb_address = ACCESS_FBINFO(video.base);
- display_info.cmap_adr_address = 0;
- display_info.cmap_data_address = 0;
- display_info.disp_reg_address = ACCESS_FBINFO(mmio.base);
- }
-#endif /* CONFIG_FB_OF && CONFIG_FB_COMPAT_XPMAC */
- }
- }
- return 0;
-#undef minfo
-}
-
-static int matrox_getcolreg(unsigned regno, unsigned *red, unsigned *green,
- unsigned *blue, unsigned *transp,
- struct fb_info *info)
-{
-
- DBG("matrox_getcolreg")
-
-#define minfo ((struct matrox_fb_info*)info)
- /*
- * Read a single color register and split it into colors/transparent.
- * Return != 0 for invalid regno.
- */
-
- if (regno >= ACCESS_FBINFO(curr.cmap_len))
- return 1;
-
- *red = ACCESS_FBINFO(palette[regno].red);
- *green = ACCESS_FBINFO(palette[regno].green);
- *blue = ACCESS_FBINFO(palette[regno].blue);
- *transp = ACCESS_FBINFO(palette[regno].transp);
- return 0;
-#undef minfo
-}
-
-static int matroxfb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
- struct fb_info *info)
-{
-#define minfo ((struct matrox_fb_info*)info)
- struct display* dsp = (con < 0) ? ACCESS_FBINFO(fbcon.disp)
- : fb_display + con;
-
- DBG("matroxfb_get_cmap")
-
- if (con == ACCESS_FBINFO(currcon)) /* current console? */
- return fb_get_cmap(cmap, kspc, matrox_getcolreg, info);
- else if (dsp->cmap.len) /* non default colormap? */
- fb_copy_cmap(&dsp->cmap, cmap, kspc ? 0 : 2);
- else
- fb_copy_cmap(fb_default_cmap(matroxfb_get_cmap_len(&dsp->var)),
- cmap, kspc ? 0 : 2);
- return 0;
-#undef minfo
-}
-
-static int matroxfb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
- struct fb_info *info)
-{
- unsigned int cmap_len;
- struct display* dsp = (con < 0) ? info->disp : (fb_display + con);
-#define minfo ((struct matrox_fb_info*)info)
-
- DBG("matroxfb_set_cmap")
-
- cmap_len = matroxfb_get_cmap_len(&dsp->var);
- if (dsp->cmap.len != cmap_len) {
- int err;
-
- err = fb_alloc_cmap(&dsp->cmap, cmap_len, 0);
- if (err)
- return err;
- }
- if (con == ACCESS_FBINFO(currcon)) { /* current console? */
- return fb_set_cmap(cmap, kspc, matrox_setcolreg, info);
- } else
- fb_copy_cmap(cmap, &dsp->cmap, kspc ? 0 : 1);
- return 0;
-#undef minfo
-}
-
-static int matroxfb_ioctl(struct inode *inode, struct file *file,
- unsigned int cmd, unsigned long arg, int con,
- struct fb_info *info)
-{
-
- DBG("matroxfb_ioctl")
-
- return -EINVAL;
-}
-
-static struct fb_ops matroxfb_ops = {
- matroxfb_open,
- matroxfb_release,
- matroxfb_get_fix,
- matroxfb_get_var,
- matroxfb_set_var,
- matroxfb_get_cmap,
- matroxfb_set_cmap,
- matroxfb_pan_display,
- matroxfb_ioctl,
- NULL /* mmap */
-};
-
-static int matroxfb_switch(int con, struct fb_info *info)
-{
-#define minfo ((struct matrox_fb_info*)info)
- struct fb_cmap* cmap;
-
- DBG("matroxfb_switch");
-
- if (ACCESS_FBINFO(currcon) >= 0) {
- /* Do we have to save the colormap? */
- cmap = &(ACCESS_FBINFO(currcon_display)->cmap);
- dprintk(KERN_DEBUG "switch1: con = %d, cmap.len = %d\n", ACCESS_FBINFO(currcon), cmap->len);
-
- if (cmap->len) {
- dprintk(KERN_DEBUG "switch1a: %p %p %p %p\n", cmap->red, cmap->green, cmap->blue, cmap->transp);
- fb_get_cmap(cmap, 1, matrox_getcolreg, info);
-#ifdef DEBUG
- if (cmap->red) {
- dprintk(KERN_DEBUG "switch1r: %X\n", cmap->red[0]);
- }
-#endif
- }
- }
- ACCESS_FBINFO(currcon) = con;
- ACCESS_FBINFO(currcon_display) = fb_display + con;
- fb_display[con].var.activate = FB_ACTIVATE_NOW;
-#ifdef DEBUG
- cmap = &fb_display[con].cmap;
- dprintk(KERN_DEBUG "switch2: con = %d, cmap.len = %d\n", con, cmap->len);
- dprintk(KERN_DEBUG "switch2a: %p %p %p %p\n", cmap->red, cmap->green, cmap->blue, cmap->transp);
- if (fb_display[con].cmap.red) {
- dprintk(KERN_DEBUG "switch2r: %X\n", cmap->red[0]);
- }
-#endif
- matroxfb_set_var(&fb_display[con].var, con, info);
-#ifdef DEBUG
- dprintk(KERN_DEBUG "switch3: con = %d, cmap.len = %d\n", con, cmap->len);
- dprintk(KERN_DEBUG "switch3a: %p %p %p %p\n", cmap->red, cmap->green, cmap->blue, cmap->transp);
- if (fb_display[con].cmap.red) {
- dprintk(KERN_DEBUG "switch3r: %X\n", cmap->red[0]);
- }
-#endif
- return 0;
-#undef minfo
-}
-
-/* 0 unblank, 1 blank, 2 no vsync, 3 no hsync, 4 off */
-
-static void matroxfb_blank(int blank, struct fb_info *info)
-{
-#define minfo ((struct matrox_fb_info*)info)
- int seq;
- int crtc;
-
- DBG("matroxfb_blank")
-
- switch (blank) {
- case 1: seq = 0x20; crtc = 0x00; break; /* works ??? */
- case 2: seq = 0x20; crtc = 0x10; break;
- case 3: seq = 0x20; crtc = 0x20; break;
- case 4: seq = 0x20; crtc = 0x30; break;
- default: seq = 0x00; crtc = 0x00; break;
- }
-
- mga_outb(M_SEQ_INDEX, 1);
- mga_outb(M_SEQ_DATA, (mga_inb(M_SEQ_DATA) & ~0x20) | seq);
- mga_outb(M_EXTVGA_INDEX, 1);
- mga_outb(M_EXTVGA_DATA, (mga_inb(M_EXTVGA_DATA) & ~0x30) | crtc);
-
-#undef minfo
-}
-
-#define RSResolution(X) ((X) & 0x0F)
-#define RS640x400 1
-#define RS640x480 2
-#define RS800x600 3
-#define RS1024x768 4
-#define RS1280x1024 5
-#define RS1600x1200 6
-#define RS768x576 7
-#define RS960x720 8
-#define RS1152x864 9
-#define RS1408x1056 10
-#define RS640x350 11
-#define RS1056x344 12 /* 132 x 43 text */
-#define RS1056x400 13 /* 132 x 50 text */
-#define RS1056x480 14 /* 132 x 60 text */
-#define RSNoxNo 15
-/* 10-FF */
-static struct { int xres, yres, left, right, upper, lower, hslen, vslen, vfreq; } timmings[] __initdata = {
- { 640, 400, 48, 16, 39, 8, 96, 2, 70 },
- { 640, 480, 48, 16, 33, 10, 96, 2, 60 },
- { 800, 600, 144, 24, 28, 8, 112, 6, 60 },
- { 1024, 768, 160, 32, 30, 4, 128, 4, 60 },
- { 1280, 1024, 224, 32, 32, 4, 136, 4, 60 },
- { 1600, 1200, 272, 48, 32, 5, 152, 5, 60 },
- { 768, 576, 144, 16, 28, 6, 112, 4, 60 },
- { 960, 720, 144, 24, 28, 8, 112, 4, 60 },
- { 1152, 864, 192, 32, 30, 4, 128, 4, 60 },
- { 1408, 1056, 256, 40, 32, 5, 144, 5, 60 },
- { 640, 350, 48, 16, 39, 8, 96, 2, 70 },
- { 1056, 344, 96, 24, 59, 44, 160, 2, 70 },
- { 1056, 400, 96, 24, 39, 8, 160, 2, 70 },
- { 1056, 480, 96, 24, 36, 12, 160, 3, 60 },
- { 0, 0, ~0, ~0, ~0, ~0, 0, 0, 0 }
-};
-
-#define RSDepth(X) (((X) >> 8) & 0x0F)
-#define RS8bpp 0x1
-#define RS15bpp 0x2
-#define RS16bpp 0x3
-#define RS32bpp 0x4
-#define RS4bpp 0x5
-#define RS24bpp 0x6
-#define RSText 0x7
-#define RSText8 0x8
-/* 9-F */
-static struct { struct fb_bitfield red, green, blue, transp; int bits_per_pixel; } colors[] __initdata = {
- { { 0, 8, 0}, { 0, 8, 0}, { 0, 8, 0}, { 0, 0, 0}, 8 },
- { { 10, 5, 0}, { 5, 5, 0}, { 0, 5, 0}, { 15, 1, 0}, 16 },
- { { 11, 5, 0}, { 6, 5, 0}, { 0, 5, 0}, { 0, 0, 0}, 16 },
- { { 16, 8, 0}, { 8, 8, 0}, { 0, 8, 0}, { 24, 8, 0}, 32 },
- { { 0, 8, 0}, { 0, 8, 0}, { 0, 8, 0}, { 0, 0, 0}, 4 },
- { { 16, 8, 0}, { 8, 8, 0}, { 0, 8, 0}, { 0, 0, 0}, 24 },
- { { 0, 6, 0}, { 0, 6, 0}, { 0, 6, 0}, { 0, 0, 0}, 0 }, /* textmode with (default) VGA8x16 */
- { { 0, 6, 0}, { 0, 6, 0}, { 0, 6, 0}, { 0, 0, 0}, 0 }, /* textmode hardwired to VGA8x8 */
-};
-
-#define RSCreate(X,Y) ((X) | ((Y) << 8))
-static struct { unsigned int vesa; unsigned int info; } *RSptr, vesamap[] __initdata = {
-/* default must be first */
-#ifdef FBCON_HAS_CFB8
- { ~0, RSCreate(RSNoxNo, RS8bpp ) },
- { 0x101, RSCreate(RS640x480, RS8bpp ) },
- { 0x100, RSCreate(RS640x400, RS8bpp ) },
- { 0x180, RSCreate(RS768x576, RS8bpp ) },
- { 0x103, RSCreate(RS800x600, RS8bpp ) },
- { 0x188, RSCreate(RS960x720, RS8bpp ) },
- { 0x105, RSCreate(RS1024x768, RS8bpp ) },
- { 0x190, RSCreate(RS1152x864, RS8bpp ) },
- { 0x107, RSCreate(RS1280x1024, RS8bpp ) },
- { 0x198, RSCreate(RS1408x1056, RS8bpp ) },
- { 0x11C, RSCreate(RS1600x1200, RS8bpp ) },
-#endif
-#ifdef FBCON_HAS_CFB16
- { ~0, RSCreate(RSNoxNo, RS15bpp) },
- { 0x110, RSCreate(RS640x480, RS15bpp) },
- { 0x181, RSCreate(RS768x576, RS15bpp) },
- { 0x113, RSCreate(RS800x600, RS15bpp) },
- { 0x189, RSCreate(RS960x720, RS15bpp) },
- { 0x116, RSCreate(RS1024x768, RS15bpp) },
- { 0x191, RSCreate(RS1152x864, RS15bpp) },
- { 0x119, RSCreate(RS1280x1024, RS15bpp) },
- { 0x199, RSCreate(RS1408x1056, RS15bpp) },
- { 0x11D, RSCreate(RS1600x1200, RS15bpp) },
- { 0x111, RSCreate(RS640x480, RS16bpp) },
- { 0x182, RSCreate(RS768x576, RS16bpp) },
- { 0x114, RSCreate(RS800x600, RS16bpp) },
- { 0x18A, RSCreate(RS960x720, RS16bpp) },
- { 0x117, RSCreate(RS1024x768, RS16bpp) },
- { 0x192, RSCreate(RS1152x864, RS16bpp) },
- { 0x11A, RSCreate(RS1280x1024, RS16bpp) },
- { 0x19A, RSCreate(RS1408x1056, RS16bpp) },
- { 0x11E, RSCreate(RS1600x1200, RS16bpp) },
-#endif
-#ifdef FBCON_HAS_CFB24
- { ~0, RSCreate(RSNoxNo, RS24bpp) },
- { 0x1B2, RSCreate(RS640x480, RS24bpp) },
- { 0x184, RSCreate(RS768x576, RS24bpp) },
- { 0x1B5, RSCreate(RS800x600, RS24bpp) },
- { 0x18C, RSCreate(RS960x720, RS24bpp) },
- { 0x1B8, RSCreate(RS1024x768, RS24bpp) },
- { 0x194, RSCreate(RS1152x864, RS24bpp) },
- { 0x1BB, RSCreate(RS1280x1024, RS24bpp) },
- { 0x19C, RSCreate(RS1408x1056, RS24bpp) },
- { 0x1BF, RSCreate(RS1600x1200, RS24bpp) },
-#endif
-#ifdef FBCON_HAS_CFB32
- { ~0, RSCreate(RSNoxNo, RS32bpp) },
- { 0x112, RSCreate(RS640x480, RS32bpp) },
- { 0x183, RSCreate(RS768x576, RS32bpp) },
- { 0x115, RSCreate(RS800x600, RS32bpp) },
- { 0x18B, RSCreate(RS960x720, RS32bpp) },
- { 0x118, RSCreate(RS1024x768, RS32bpp) },
- { 0x193, RSCreate(RS1152x864, RS32bpp) },
- { 0x11B, RSCreate(RS1280x1024, RS32bpp) },
- { 0x19B, RSCreate(RS1408x1056, RS32bpp) },
- { 0x11F, RSCreate(RS1600x1200, RS32bpp) },
-#endif
-#ifdef FBCON_HAS_VGATEXT
- { ~0, RSCreate(RSNoxNo, RSText) },
- { 0x002, RSCreate(RS640x400, RSText) }, /* 80x25 */
- { 0x003, RSCreate(RS640x400, RSText) }, /* 80x25 */
- { 0x007, RSCreate(RS640x400, RSText) }, /* 80x25 */
- { 0x1C0, RSCreate(RS640x400, RSText8) }, /* 80x50 */
- { 0x108, RSCreate(RS640x480, RSText8) }, /* 80x60 */
- { 0x109, RSCreate(RS1056x400, RSText) }, /* 132x25 */
- { 0x10A, RSCreate(RS1056x344, RSText8) }, /* 132x43 */
- { 0x10B, RSCreate(RS1056x400, RSText8) }, /* 132x50 */
- { 0x10C, RSCreate(RS1056x480, RSText8) }, /* 132x60 */
-#endif
-#ifdef FBCON_HAS_CFB4
- { ~0, RSCreate(RSNoxNo, RS4bpp ) },
- { 0x010, RSCreate(RS640x350, RS4bpp ) },
- { 0x012, RSCreate(RS640x480, RS4bpp ) },
- { 0x102, RSCreate(RS800x600, RS4bpp ) },
- { 0x104, RSCreate(RS1024x768, RS4bpp ) },
- { 0x106, RSCreate(RS1280x1024, RS4bpp ) },
-#endif
- { 0, 0 }};
-
-/* initialized by setup, see explanation at end of file (search for MODULE_PARM_DESC) */
-static unsigned int mem = 0; /* "matrox:mem:xxxxxM" */
-static int option_precise_width = 1; /* cannot be changed, option_precise_width==0 must imply noaccel */
-static int inv24 = 0; /* "matrox:inv24" */
-static int cross4MB = -1; /* "matrox:cross4MB" */
-static int disabled = 0; /* "matrox:disabled" */
-static int noaccel = 0; /* "matrox:noaccel" */
-static int nopan = 0; /* "matrox:nopan" */
-static int no_pci_retry = 0; /* "matrox:nopciretry" */
-static int novga = 0; /* "matrox:novga" */
-static int nobios = 0; /* "matrox:nobios" */
-static int noinit = 1; /* "matrox:init" */
-static int inverse = 0; /* "matrox:inverse" */
-static int hwcursor = 1; /* "matrox:nohwcursor" */
-static int blink = 1; /* "matrox:noblink" */
-static int sgram = 0; /* "matrox:sgram" */
-#ifdef CONFIG_MTRR
-static int mtrr = 1; /* "matrox:nomtrr" */
-#endif
-static int grayscale = 0; /* "matrox:grayscale" */
-static unsigned int fastfont = 0; /* "matrox:fastfont:xxxxx" */
-static int dev = -1; /* "matrox:dev:xxxxx" */
-static unsigned int vesa = ~0; /* "matrox:vesa:xxxxx" */
-static int depth = -1; /* "matrox:depth:xxxxx" */
-static unsigned int xres = 0; /* "matrox:xres:xxxxx" */
-static unsigned int yres = 0; /* "matrox:yres:xxxxx" */
-static unsigned int upper = ~0; /* "matrox:upper:xxxxx" */
-static unsigned int lower = ~0; /* "matrox:lower:xxxxx" */
-static unsigned int vslen = 0; /* "matrox:vslen:xxxxx" */
-static unsigned int left = ~0; /* "matrox:left:xxxxx" */
-static unsigned int right = ~0; /* "matrox:right:xxxxx" */
-static unsigned int hslen = 0; /* "matrox:hslen:xxxxx" */
-static unsigned int pixclock = 0; /* "matrox:pixclock:xxxxx" */
-static int sync = -1; /* "matrox:sync:xxxxx" */
-static unsigned int fv = 0; /* "matrox:fv:xxxxx" */
-static unsigned int fh = 0; /* "matrox:fh:xxxxxk" */
-static unsigned int maxclk = 0; /* "matrox:maxclk:xxxxM" */
-static char fontname[64]; /* "matrox:font:xxxxx" */
-
-#ifndef MODULE
-static char videomode[64]; /* "matrox:mode:xxxxx" or "matrox:xxxxx" */
-#endif
-
-#ifndef MODULE
-int __init matroxfb_setup(char *options) {
- char *this_opt;
-
- DBG("matroxfb_setup")
-
- fontname[0] = '\0';
-
- if (!options || !*options)
- return 0;
-
- for(this_opt=strtok(options,","); this_opt; this_opt=strtok(NULL,",")) {
- if (!*this_opt) continue;
-
- dprintk("matroxfb_setup: option %s\n", this_opt);
-
- if (!strncmp(this_opt, "dev:", 4))
- dev = simple_strtoul(this_opt+4, NULL, 0);
- else if (!strncmp(this_opt, "depth:", 6)) {
- switch (simple_strtoul(this_opt+6, NULL, 0)) {
- case 0: depth = RSText; break;
- case 4: depth = RS4bpp; break;
- case 8: depth = RS8bpp; break;
- case 15:depth = RS15bpp; break;
- case 16:depth = RS16bpp; break;
- case 24:depth = RS24bpp; break;
- case 32:depth = RS32bpp; break;
- default:
- printk(KERN_ERR "matroxfb: unsupported color depth\n");
- }
- } else if (!strncmp(this_opt, "xres:", 5))
- xres = simple_strtoul(this_opt+5, NULL, 0);
- else if (!strncmp(this_opt, "yres:", 5))
- yres = simple_strtoul(this_opt+5, NULL, 0);
- else if (!strncmp(this_opt, "vslen:", 6))
- vslen = simple_strtoul(this_opt+6, NULL, 0);
- else if (!strncmp(this_opt, "hslen:", 6))
- hslen = simple_strtoul(this_opt+6, NULL, 0);
- else if (!strncmp(this_opt, "left:", 5))
- left = simple_strtoul(this_opt+5, NULL, 0);
- else if (!strncmp(this_opt, "right:", 6))
- right = simple_strtoul(this_opt+6, NULL, 0);
- else if (!strncmp(this_opt, "upper:", 6))
- upper = simple_strtoul(this_opt+6, NULL, 0);
- else if (!strncmp(this_opt, "lower:", 6))
- lower = simple_strtoul(this_opt+6, NULL, 0);
- else if (!strncmp(this_opt, "pixclock:", 9))
- pixclock = simple_strtoul(this_opt+9, NULL, 0);
- else if (!strncmp(this_opt, "sync:", 5))
- sync = simple_strtoul(this_opt+5, NULL, 0);
- else if (!strncmp(this_opt, "vesa:", 5))
- vesa = simple_strtoul(this_opt+5, NULL, 0);
- else if (!strncmp(this_opt, "font:", 5))
- strncpy(fontname, this_opt+5, sizeof(fontname)-1);
- else if (!strncmp(this_opt, "maxclk:", 7))
- maxclk = simple_strtoul(this_opt+7, NULL, 0);
- else if (!strncmp(this_opt, "fh:", 3))
- fh = simple_strtoul(this_opt+3, NULL, 0);
- else if (!strncmp(this_opt, "fv:", 3))
- fv = simple_strtoul(this_opt+3, NULL, 0);
- else if (!strncmp(this_opt, "mem:", 4))
- mem = simple_strtoul(this_opt+4, NULL, 0);
- else if (!strncmp(this_opt, "mode:", 5))
- strncpy(videomode, this_opt+5, sizeof(videomode)-1);
-#ifdef CONFIG_FB_OF
- else if (!strncmp(this_opt, "vmode:", 6)) {
- unsigned int vmode = simple_strtoul(this_opt+6, NULL, 0);
- if (vmode > 0 && vmode <= VMODE_MAX)
- default_vmode = vmode;
- } else if (!strncmp(this_opt, "cmode:", 6)) {
- unsigned int cmode = simple_strtoul(this_opt+6, NULL, 0);
- switch (cmode) {
- case 0:
- case 8:
- default_cmode = CMODE_8;
- break;
- case 15:
- case 16:
- default_cmode = CMODE_16;
- break;
- case 24:
- case 32:
- default_cmode = CMODE_32;
- break;
- }
- }
-#endif
- else if (!strncmp(this_opt, "fastfont:", 9))
- fastfont = simple_strtoul(this_opt+9, NULL, 0);
- else if (!strcmp(this_opt, "nofastfont")) /* fastfont:N and nofastfont (nofastfont = fastfont:0) */
- fastfont = 0;
- else if (!strcmp(this_opt, "disabled")) /* nodisabled does not exist */
- disabled = 1;
- else if (!strcmp(this_opt, "enabled")) /* noenabled does not exist */
- disabled = 0;
- else if (!strcmp(this_opt, "sgram")) /* nosgram == sdram */
- sgram = 1;
- else if (!strcmp(this_opt, "sdram"))
- sgram = 0;
- else {
- int value = 1;
-
- if (!strncmp(this_opt, "no", 2)) {
- value = 0;
- this_opt += 2;
- }
- if (! strcmp(this_opt, "inverse"))
- inverse = value;
- else if (!strcmp(this_opt, "accel"))
- noaccel = !value;
- else if (!strcmp(this_opt, "pan"))
- nopan = !value;
- else if (!strcmp(this_opt, "pciretry"))
- no_pci_retry = !value;
- else if (!strcmp(this_opt, "vga"))
- novga = !value;
- else if (!strcmp(this_opt, "bios"))
- nobios = !value;
- else if (!strcmp(this_opt, "init"))
- noinit = !value;
-#ifdef CONFIG_MTRR
- else if (!strcmp(this_opt, "mtrr"))
- mtrr = value;
-#endif
- else if (!strcmp(this_opt, "inv24"))
- inv24 = value;
- else if (!strcmp(this_opt, "cross4MB"))
- cross4MB = value;
- else if (!strcmp(this_opt, "hwcursor"))
- hwcursor = value;
- else if (!strcmp(this_opt, "blink"))
- blink = value;
- else if (!strcmp(this_opt, "grayscale"))
- grayscale = value;
- else {
- strncpy(videomode, this_opt, sizeof(videomode)-1);
- }
- }
- }
- return 0;
-}
-#endif /* !MODULE */
-
-static int matroxfb_getmemory(WPMINFO unsigned int maxSize, unsigned int* realOffset, unsigned int *realSize){
- vaddr_t vm;
- unsigned int offs;
- unsigned int offs2;
- unsigned char store;
- unsigned char bytes[32];
- unsigned char* tmp;
- unsigned long cbase;
- unsigned long mbase;
- unsigned int clen;
- unsigned int mlen;
-
- DBG("matroxfb_getmemory")
-
- vm = ACCESS_FBINFO(video.vbase);
- maxSize &= ~0x1FFFFF; /* must be X*2MB (really it must be 2 or X*4MB) */
- /* at least 2MB */
- if (maxSize < 0x0200000) return 0;
- if (maxSize > 0x2000000) maxSize = 0x2000000;
-
- mga_outb(M_EXTVGA_INDEX, 0x03);
- mga_outb(M_EXTVGA_DATA, mga_inb(M_EXTVGA_DATA) | 0x80);
-
- store = mga_readb(vm, 0x1234);
- tmp = bytes;
- for (offs = 0x100000; offs < maxSize; offs += 0x200000)
- *tmp++ = mga_readb(vm, offs);
- for (offs = 0x100000; offs < maxSize; offs += 0x200000)
- mga_writeb(vm, offs, 0x02);
- if (ACCESS_FBINFO(features.accel.has_cacheflush))
- mga_outb(M_CACHEFLUSH, 0x00);
- else
- mga_writeb(vm, 0x1234, 0x99);
- cbase = mbase = 0;
- clen = mlen = 0;
- for (offs = 0x100000; offs < maxSize; offs += 0x200000) {
- if (mga_readb(vm, offs) != 0x02)
- continue;
- mga_writeb(vm, offs, mga_readb(vm, offs) - 0x02);
- if (mga_readb(vm, offs))
- continue;
- if (offs - 0x100000 == cbase + clen) {
- clen += 0x200000;
- } else {
- cbase = offs - 0x100000;
- clen = 0x200000;
- }
- if ((clen > mlen)
-#ifndef MATROX_2MB_WITH_4MB_ADDON
- && (cbase == 0)
-#endif
- ) {
- mbase = cbase;
- mlen = clen;
- }
- }
- tmp = bytes;
- for (offs2 = 0x100000; offs2 < maxSize; offs2 += 0x200000)
- mga_writeb(vm, offs2, *tmp++);
- mga_writeb(vm, 0x1234, store);
-
- mga_outb(M_EXTVGA_INDEX, 0x03);
- mga_outb(M_EXTVGA_DATA, mga_inb(M_EXTVGA_DATA) & ~0x80);
-
- *realOffset = mbase;
- *realSize = mlen;
-#ifdef CONFIG_FB_MATROX_MILLENIUM
- ACCESS_FBINFO(interleave) = !(!isMillenium(MINFO) || (mbase & 0x3FFFFF) || (mlen & 0x3FFFFF));
-#endif
- return 1;
-}
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static int __init Ti3026_preinit(WPMINFO struct matrox_hw_state* hw){
- static const int vxres_mill2[] = { 512, 640, 768, 800, 832, 960,
- 1024, 1152, 1280, 1600, 1664, 1920,
- 2048, 0};
- static const int vxres_mill1[] = { 640, 768, 800, 960,
- 1024, 1152, 1280, 1600, 1920,
- 2048, 0};
-
- DBG("Ti3026_preinit")
-
- ACCESS_FBINFO(millenium) = 1;
- ACCESS_FBINFO(milleniumII) = (ACCESS_FBINFO(pcidev)->device != PCI_DEVICE_ID_MATROX_MIL);
- ACCESS_FBINFO(capable.cfb4) = 1;
- ACCESS_FBINFO(capable.text) = 1; /* isMilleniumII(MINFO); */
- ACCESS_FBINFO(capable.vxres) = isMilleniumII(MINFO)?vxres_mill2:vxres_mill1;
- ACCESS_FBINFO(cursor.timer.function) = matroxfb_ti3026_flashcursor;
-
- if (ACCESS_FBINFO(devflags.noinit))
- return 0;
- /* preserve VGA I/O, BIOS and PPC */
- hw->MXoptionReg &= 0xC0000100;
- hw->MXoptionReg |= 0x002C0000;
- if (ACCESS_FBINFO(devflags.novga))
- hw->MXoptionReg &= ~0x00000100;
- if (ACCESS_FBINFO(devflags.nobios))
- hw->MXoptionReg &= ~0x40000000;
- if (ACCESS_FBINFO(devflags.nopciretry))
- hw->MXoptionReg |= 0x20000000;
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, hw->MXoptionReg);
-
- ACCESS_FBINFO(accel.ramdac_rev) = inTi3026(PMINFO TVP3026_XSILICONREV);
-
- outTi3026(PMINFO TVP3026_XCLKCTRL, TVP3026_XCLKCTRL_SRC_CLK0VGA | TVP3026_XCLKCTRL_CLKSTOPPED);
- outTi3026(PMINFO TVP3026_XTRUECOLORCTRL, TVP3026_XTRUECOLORCTRL_PSEUDOCOLOR);
- outTi3026(PMINFO TVP3026_XMUXCTRL, TVP3026_XMUXCTRL_VGA);
-
- outTi3026(PMINFO TVP3026_XPLLADDR, 0x2A);
- outTi3026(PMINFO TVP3026_XLOOPPLLDATA, 0x00);
- outTi3026(PMINFO TVP3026_XPIXPLLDATA, 0x00);
-
- mga_outb(M_MISC_REG, 0x67);
-
- outTi3026(PMINFO TVP3026_XMEMPLLCTRL, TVP3026_XMEMPLLCTRL_STROBEMKC4 | TVP3026_XMEMPLLCTRL_MCLK_MCLKPLL);
-
- mga_outl(M_RESET, 1);
- udelay(250);
- mga_outl(M_RESET, 0);
- udelay(250);
- mga_outl(M_MACCESS, 0x00008000);
- udelay(10);
- return 0;
-}
-
-static void __init Ti3026_reset(WPMINFO struct matrox_hw_state* hw){
-
- DBG("Ti3026_reset")
-
- matroxfb_fastfont_init(MINFO);
-
- ti3026_ramdac_init(PMINFO hw);
-}
-#endif
-
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static struct matrox_switch matrox_millenium = {
- Ti3026_preinit, Ti3026_reset, Ti3026_init, Ti3026_restore
-};
-#endif
-
-#ifdef CONFIG_FB_MATROX_MYSTIQUE
-static struct matrox_switch matrox_mystique = {
- MGA1064_preinit, MGA1064_reset, MGA1064_init, MGA1064_restore
-};
-#endif
-
-#ifdef CONFIG_FB_MATROX_G100
-static struct matrox_switch matrox_G100 = {
- MGAG100_preinit, MGAG100_reset, MGAG100_init, MGAG100_restore
-};
-#endif
-
-struct video_board {
- int maxvram;
- int maxdisplayable;
- int accelID;
- struct matrox_switch* lowlevel;
- };
-#ifdef CONFIG_FB_MATROX_MILLENIUM
-static struct video_board vbMillenium __initdata = {0x0800000, 0x0800000, FB_ACCEL_MATROX_MGA2064W, &matrox_millenium};
-static struct video_board vbMillenium2 __initdata = {0x1000000, 0x0800000, FB_ACCEL_MATROX_MGA2164W, &matrox_millenium};
-static struct video_board vbMillenium2A __initdata = {0x1000000, 0x0800000, FB_ACCEL_MATROX_MGA2164W_AGP, &matrox_millenium};
-#endif /* CONFIG_FB_MATROX_MILLENIUM */
-#ifdef CONFIG_FB_MATROX_MYSTIQUE
-static struct video_board vbMystique __initdata = {0x0800000, 0x0800000, FB_ACCEL_MATROX_MGA1064SG, &matrox_mystique};
-#endif /* CONFIG_FB_MATROX_MYSTIQUE */
-#ifdef CONFIG_FB_MATROX_G100
-static struct video_board vbG100 __initdata = {0x0800000, 0x0800000, FB_ACCEL_MATROX_MGAG100, &matrox_G100};
-static struct video_board vbG200 __initdata = {0x1000000, 0x1000000, FB_ACCEL_MATROX_MGAG200, &matrox_G100};
-#ifdef CONFIG_FB_MATROX_32MB
-/* from doc it looks like that accelerator can draw only to low 16MB :-( Direct accesses & displaying are OK for
- whole 32MB */
-static struct video_board vbG400 __initdata = {0x2000000, 0x1000000, FB_ACCEL_MATROX_MGAG400, &matrox_G100};
-#else
-static struct video_board vbG400 __initdata = {0x2000000, 0x1000000, FB_ACCEL_MATROX_MGAG400, &matrox_G100};
-#endif
-#endif
-
-#define DEVF_VIDEO64BIT 0x01
-#define DEVF_SWAPS 0x02
-#define DEVF_MILLENIUM 0x04
-#define DEVF_MILLENIUM2 0x08
-#define DEVF_CROSS4MB 0x10
-#define DEVF_TEXT4B 0x20
-#define DEVF_DDC_8_2 0x40
-#define DEVF_DMA 0x80
-#define DEVF_SUPPORT32MB 0x100
-#define DEVF_ANY_VXRES 0x200
-#define DEVF_TEXT16B 0x400
-
-#define DEVF_G100 (DEVF_VIDEO64BIT | DEVF_SWAPS | DEVF_CROSS4MB | DEVF_DDC_8_2) /* no doc, no vxres... */
-#define DEVF_G200 (DEVF_VIDEO64BIT | DEVF_SWAPS | DEVF_CROSS4MB | DEVF_DDC_8_2 | DEVF_ANY_VXRES)
-#define DEVF_G400 (DEVF_VIDEO64BIT | DEVF_SWAPS | DEVF_CROSS4MB | DEVF_DDC_8_2 | DEVF_ANY_VXRES | DEVF_SUPPORT32MB | DEVF_TEXT16B)
-
-static struct board {
- unsigned short vendor, device, rev, svid, sid;
- unsigned int flags;
- unsigned int maxclk;
- struct video_board* base;
- const char* name;
- } dev_list[] __initdata = {
-#ifdef CONFIG_FB_MATROX_MILLENIUM
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_MIL, 0xFF,
- 0, 0,
- DEVF_MILLENIUM | DEVF_TEXT4B,
- 230000,
- &vbMillenium,
- "Millennium (PCI)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_MIL_2, 0xFF,
- 0, 0,
- DEVF_MILLENIUM | DEVF_MILLENIUM2 | DEVF_SWAPS,
- 220000,
- &vbMillenium2,
- "Millennium II (PCI)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_MIL_2_AGP, 0xFF,
- 0, 0,
- DEVF_MILLENIUM | DEVF_MILLENIUM2 | DEVF_SWAPS,
- 250000,
- &vbMillenium2A,
- "Millennium II (AGP)"},
-#endif
-#ifdef CONFIG_FB_MATROX_MYSTIQUE
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_MYS, 0x02,
- 0, 0,
- DEVF_VIDEO64BIT,
- 180000,
- &vbMystique,
- "Mystique (PCI)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_MYS, 0xFF,
- 0, 0,
- DEVF_VIDEO64BIT | DEVF_SWAPS,
- 220000,
- &vbMystique,
- "Mystique 220 (PCI)"},
-#endif
-#ifdef CONFIG_FB_MATROX_G100
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G100, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_MGA_G100_PCI,
- DEVF_G100,
- 230000,
- &vbG100,
- "MGA-G100 (PCI)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G100, 0xFF,
- 0, 0,
- DEVF_G100,
- 230000,
- &vbG100,
- "unknown G100 (PCI)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G100_AGP, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_GENERIC,
- DEVF_G100,
- 230000,
- &vbG100,
- "MGA-G100 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G100_AGP, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_MGA_G100_AGP,
- DEVF_G100,
- 230000,
- &vbG100,
- "MGA-G100 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G100_AGP, 0xFF,
- PCI_SS_VENDOR_ID_SIEMENS_NIXDORF, PCI_SS_ID_SIEMENS_MGA_G100_AGP,
- DEVF_G100,
- 230000,
- &vbG100,
- "MGA-G100 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G100_AGP, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_PRODUCTIVA_G100_AGP,
- DEVF_G100,
- 230000,
- &vbG100,
- "Productiva G100 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G100_AGP, 0xFF,
- 0, 0,
- DEVF_G100,
- 230000,
- &vbG100,
- "unknown G100 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G200_PCI, 0xFF,
- 0, 0,
- DEVF_G200,
- 250000,
- &vbG200,
- "unknown G200 (PCI)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G200_AGP, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_GENERIC,
- DEVF_G200,
- 220000,
- &vbG200,
- "MGA-G200 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G200_AGP, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_MYSTIQUE_G200_AGP,
- DEVF_G200,
- 230000,
- &vbG200,
- "Mystique G200 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G200_AGP, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_MILLENIUM_G200_AGP,
- DEVF_G200,
- 250000,
- &vbG200,
- "Millennium G200 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G200_AGP, 0xFF,
- PCI_SS_VENDOR_ID_MATROX, PCI_SS_ID_MATROX_MARVEL_G200_AGP,
- DEVF_G200,
- 230000,
- &vbG200,
- "Marvel G200 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G200_AGP, 0xFF,
- PCI_SS_VENDOR_ID_SIEMENS_NIXDORF, PCI_SS_ID_SIEMENS_MGA_G200_AGP,
- DEVF_G200,
- 230000,
- &vbG200,
- "MGA-G200 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G200_AGP, 0xFF,
- 0, 0,
- DEVF_G200,
- 230000,
- &vbG200,
- "unknown G200 (AGP)"},
- {PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G400_AGP, 0xFF,
- 0, 0,
- DEVF_G400,
- 360000,
- &vbG400,
- "unknown G400 (AGP)"},
-#endif
- {0, 0, 0xFF,
- 0, 0,
- 0,
- 0,
- NULL,
- NULL}};
-
-#ifndef MODULE
- /* it cannot be static const struct due to __initdata
- marker */
- static struct fb_videomode defaultmode __initdata = {
- /* 640x480 @ 60Hz, 31.5 kHz */
- NULL, 60, 640, 480, 39721, 40, 24, 32, 11, 96, 2,
- 0, FB_VMODE_NONINTERLACED
- };
-#endif /* !MODULE */
-
-static int __init initMatrox2(WPMINFO struct display* d, struct board* b){
- unsigned long ctrlptr_phys = 0;
- unsigned long video_base_phys = 0;
- unsigned int memsize;
- struct matrox_hw_state* hw = ACCESS_FBINFO(currenthw);
-
- DBG("initMatrox2")
-
- /* set default values... */
- vesafb_defined.accel_flags = FB_ACCELF_TEXT;
-
- ACCESS_FBINFO(hw_switch) = b->base->lowlevel;
- ACCESS_FBINFO(devflags.accelerator) = b->base->accelID;
- ACCESS_FBINFO(max_pixel_clock) = b->maxclk;
-
- printk(KERN_INFO "matroxfb: Matrox %s detected\n", b->name);
- ACCESS_FBINFO(capable.plnwt) = 1;
- ACCESS_FBINFO(devflags.video64bits) = b->flags & DEVF_VIDEO64BIT;
- if (b->flags & DEVF_TEXT4B) {
- ACCESS_FBINFO(devflags.vgastep) = 4;
- ACCESS_FBINFO(devflags.textmode) = 4;
- ACCESS_FBINFO(devflags.text_type_aux) = FB_AUX_TEXT_MGA_STEP16;
- } else if (b->flags & DEVF_TEXT16B) {
- ACCESS_FBINFO(devflags.vgastep) = 16;
- ACCESS_FBINFO(devflags.textmode) = 1;
- ACCESS_FBINFO(devflags.text_type_aux) = FB_AUX_TEXT_MGA_STEP16;
- } else {
- ACCESS_FBINFO(devflags.vgastep) = 8;
- ACCESS_FBINFO(devflags.textmode) = 1;
- ACCESS_FBINFO(devflags.text_type_aux) = FB_AUX_TEXT_MGA_STEP8;
- }
-#ifdef CONFIG_FB_MATROX_32MB
- ACCESS_FBINFO(devflags.support32MB) = b->flags & DEVF_SUPPORT32MB;
-#endif
- ACCESS_FBINFO(devflags.precise_width) = !(b->flags & DEVF_ANY_VXRES);
- ACCESS_FBINFO(devflags.textstep) = ACCESS_FBINFO(devflags.vgastep) * ACCESS_FBINFO(devflags.textmode);
- ACCESS_FBINFO(devflags.textvram) = 65536 / ACCESS_FBINFO(devflags.textmode);
-
- if (ACCESS_FBINFO(capable.cross4MB) < 0)
- ACCESS_FBINFO(capable.cross4MB) = b->flags & DEVF_CROSS4MB;
- if (b->flags & DEVF_SWAPS) {
- ctrlptr_phys = ACCESS_FBINFO(pcidev)->resource[1].start;
- video_base_phys = ACCESS_FBINFO(pcidev)->resource[0].start;
- } else {
- ctrlptr_phys = ACCESS_FBINFO(pcidev)->resource[0].start;
- video_base_phys = ACCESS_FBINFO(pcidev)->resource[1].start;
- }
- if (!ctrlptr_phys) {
- printk(KERN_ERR "matroxfb: control registers are not available, matroxfb disabled\n");
- return -EINVAL;
- }
- if (!video_base_phys) {
- printk(KERN_ERR "matroxfb: video RAM is not available in PCI address space, matroxfb disabled\n");
- return -EINVAL;
- }
- if (mga_ioremap(ctrlptr_phys, 16384, MGA_IOREMAP_MMIO, &ACCESS_FBINFO(mmio.vbase))) {
- printk(KERN_ERR "matroxfb: cannot ioremap(%lX, 16384), matroxfb disabled\n", ctrlptr_phys);
- return -ENOMEM;
- }
- ACCESS_FBINFO(mmio.base) = ctrlptr_phys;
- ACCESS_FBINFO(mmio.len) = 16384;
- memsize = b->base->maxvram;
-/* convert mem (autodetect k, M) */
- if (mem < 1024) mem *= 1024;
- if (mem < 0x00100000) mem *= 1024;
-
- if (mem && (mem < memsize))
- memsize = mem;
- ACCESS_FBINFO(video.base) = video_base_phys;
- if (mga_ioremap(video_base_phys, memsize, MGA_IOREMAP_FB, &ACCESS_FBINFO(video.vbase))) {
- printk(KERN_ERR "matroxfb: cannot ioremap(%lX, %d), matroxfb disabled\n",
- video_base_phys, memsize);
- mga_iounmap(ACCESS_FBINFO(mmio.vbase));
- return -ENOMEM;
- }
- {
- u_int32_t cmd;
- u_int32_t mga_option;
-
- /* Matrox MilleniumII is deactivated on bootup, but address
- regions are assigned to board. So we have to enable it */
- pci_read_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, &mga_option);
- pci_read_config_dword(ACCESS_FBINFO(pcidev), PCI_COMMAND, &cmd);
- mga_option &= 0x7FFFFFFF; /* clear BIG_ENDIAN */
- if ((cmd & PCI_COMMAND_MEMORY) !=
- PCI_COMMAND_MEMORY) {
- /* But if we have to enable it, we have probably to
- disable VGA I/O and BIOS... Sure? */
- dprintk(KERN_WARNING "matroxfb: PCI BIOS did not enable device!\n");
- cmd = (cmd | PCI_COMMAND_MEMORY) & ~PCI_COMMAND_VGA_PALETTE;
- mga_option &= 0xBFFFFEFF;
- /* we must not enable VGA, BIOS if PCI BIOS did not enable device itself */
- ACCESS_FBINFO(devflags.novga) = 1;
- ACCESS_FBINFO(devflags.nobios) = 1;
- /* we must initialize device if PCI BIOS did not enable it.
- It probably means that it is second head ... */
- ACCESS_FBINFO(devflags.noinit) = 0;
- }
- mga_option |= MX_OPTION_BSWAP;
- if (pci_find_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82437, NULL)) {
- if (!(mga_option & 0x20000000) && !ACCESS_FBINFO(devflags.nopciretry)) {
- printk(KERN_WARNING "matroxfb: Disabling PCI retries due to i82437 present\n");
- }
- mga_option |= 0x20000000;
- ACCESS_FBINFO(devflags.nopciretry) = 1;
- }
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_COMMAND, cmd);
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_OPTION_REG, mga_option);
- hw->MXoptionReg = mga_option;
-
- /* select non-DMA memory for PCI_MGA_DATA, otherwise dump of PCI cfg space can lock PCI bus */
- /* maybe preinit() candidate, but it is same... for all devices... at this time... */
- pci_write_config_dword(ACCESS_FBINFO(pcidev), PCI_MGA_INDEX, 0x00003C00);
- }
-
- if (ACCESS_FBINFO(hw_switch)->preinit(PMINFO hw)) {
- mga_iounmap(ACCESS_FBINFO(video.vbase));
- mga_iounmap(ACCESS_FBINFO(mmio.vbase));
- return -ENXIO;
- }
-
- {
- unsigned int offs;
-
- if (!matroxfb_getmemory(PMINFO memsize, &offs, &ACCESS_FBINFO(video.len)) || !ACCESS_FBINFO(video.len)) {
- printk(KERN_ERR "matroxfb: cannot determine memory size\n");
- mga_iounmap(ACCESS_FBINFO(video.vbase));
- mga_iounmap(ACCESS_FBINFO(mmio.vbase));
- return -ENOMEM;
- }
-#ifdef MATROX_2MB_WITH_4MB_ADDON
-#ifdef FBCON_HAS_CFB24
- {
- unsigned int end = offs + ACCESS_FBINFO(video.len);
-
- if (offs)
- offs = ((offs - 1) / (4096 * 3) + 1) * 4096 * 3;
- ACCESS_FBINFO(video.len) = end - offs;
- }
-#endif
- ACCESS_FBINFO(devflags.ydstorg) = offs;
- video_base_phys += offs;
- if (offs)
- ACCESS_FBINFO(capable.text) = 0;
-#else
- ACCESS_FBINFO(devflags.ydstorg) = 0;
-#endif
- }
- ACCESS_FBINFO(currcon) = -1;
- ACCESS_FBINFO(currcon_display) = d;
- mga_iounmap(ACCESS_FBINFO(video.vbase));
- ACCESS_FBINFO(video.base) = video_base_phys;
- if (mga_ioremap(video_base_phys, ACCESS_FBINFO(video.len), MGA_IOREMAP_FB, &ACCESS_FBINFO(video.vbase))) {
- printk(KERN_ERR "matroxfb: cannot ioremap(%lX, %d), matroxfb disabled\n",
- video_base_phys, ACCESS_FBINFO(video.len));
- mga_iounmap(ACCESS_FBINFO(mmio.vbase));
- return -ENOMEM;
- }
- ACCESS_FBINFO(video.len_usable) = ACCESS_FBINFO(video.len);
- if (ACCESS_FBINFO(video.len_usable) > b->base->maxdisplayable)
- ACCESS_FBINFO(video.len_usable) = b->base->maxdisplayable;
-#ifdef CONFIG_MTRR
- if (mtrr) {
- ACCESS_FBINFO(mtrr.vram) = mtrr_add(video_base_phys, ACCESS_FBINFO(video.len), MTRR_TYPE_WRCOMB, 1);
- ACCESS_FBINFO(mtrr.vram_valid) = 1;
- printk(KERN_INFO "matroxfb: MTRR's turned on\n");
- }
-#endif /* CONFIG_MTRR */
-
- if (!ACCESS_FBINFO(devflags.novga))
- request_region(0x3C0, 32, "matrox");
- ACCESS_FBINFO(hw_switch->reset(PMINFO hw));
-
-/* validate params, autodetect k, M */
- if (fh < 1000) fh *= 1000; /* 1kHz minimum */
- if (maxclk < 1000) maxclk *= 1000; /* kHz -> Hz, MHz -> kHz */
- if (maxclk < 1000000) maxclk *= 1000; /* kHz -> Hz, 1MHz minimum */
- if (vesa != ~0)
- vesa &= 0x1DFF; /* mask out clearscreen, acceleration and so on */
-
- ACCESS_FBINFO(fbcon.monspecs.hfmin) = 0;
- ACCESS_FBINFO(fbcon.monspecs.hfmax) = fh;
- ACCESS_FBINFO(fbcon.monspecs.vfmin) = 0;
- ACCESS_FBINFO(fbcon.monspecs.vfmax) = fv;
- ACCESS_FBINFO(fbcon.monspecs.dpms) = 0; /* TBD */
-
-/* static settings */
- for (RSptr = vesamap; RSptr->vesa; RSptr++) {
- if (RSptr->vesa == vesa) break;
- }
- if (!RSptr->vesa) {
- printk(KERN_ERR "Invalid vesa mode 0x%04X\n", vesa);
- RSptr = vesamap;
- }
- {
- int res = RSResolution(RSptr->info)-1;
- if (left == ~0)
- left = timmings[res].left;
- if (!xres)
- xres = timmings[res].xres;
- if (right == ~0)
- right = timmings[res].right;
- if (!hslen)
- hslen = timmings[res].hslen;
- if (upper == ~0)
- upper = timmings[res].upper;
- if (!yres)
- yres = timmings[res].yres;
- if (lower == ~0)
- lower = timmings[res].lower;
- if (!vslen)
- vslen = timmings[res].vslen;
- if (!(fv||fh||maxclk||pixclock))
- fv = timmings[res].vfreq;
- if (depth == -1)
- depth = RSDepth(RSptr->info);
- }
- if ((depth == RSText8) && (!*ACCESS_FBINFO(fbcon.fontname))) {
- strcpy(ACCESS_FBINFO(fbcon.fontname), "VGA8x8");
- }
- vesafb_defined.red = colors[depth-1].red;
- vesafb_defined.green = colors[depth-1].green;
- vesafb_defined.blue = colors[depth-1].blue;
- vesafb_defined.bits_per_pixel = colors[depth-1].bits_per_pixel;
- vesafb_defined.grayscale = grayscale;
- vesafb_defined.vmode = 0;
- if (noaccel)
- vesafb_defined.accel_flags &= ~FB_ACCELF_TEXT;
-
- strcpy(ACCESS_FBINFO(fbcon.modename), "MATROX VGA");
- ACCESS_FBINFO(fbcon.changevar) = NULL;
- ACCESS_FBINFO(fbcon.node) = -1;
- ACCESS_FBINFO(fbcon.fbops) = &matroxfb_ops;
- ACCESS_FBINFO(fbcon.disp) = d;
- ACCESS_FBINFO(fbcon.switch_con) = &matroxfb_switch;
- ACCESS_FBINFO(fbcon.updatevar) = &matroxfb_updatevar;
- ACCESS_FBINFO(fbcon.blank) = &matroxfb_blank;
- ACCESS_FBINFO(fbcon.flags) = FBINFO_FLAG_DEFAULT;
- ACCESS_FBINFO(video.len_usable) &= PAGE_MASK;
-
-#ifndef MODULE
- /* mode database is marked __init ... */
- {
- fb_find_mode(&vesafb_defined, &ACCESS_FBINFO(fbcon), videomode[0]?videomode:NULL,
- NULL, 0, &defaultmode, vesafb_defined.bits_per_pixel);
- }
-#endif /* !MODULE */
-
- /* mode modifiers */
- if (hslen)
- vesafb_defined.hsync_len = hslen;
- if (vslen)
- vesafb_defined.vsync_len = vslen;
- if (left != ~0)
- vesafb_defined.left_margin = left;
- if (right != ~0)
- vesafb_defined.right_margin = right;
- if (upper != ~0)
- vesafb_defined.upper_margin = upper;
- if (lower != ~0)
- vesafb_defined.lower_margin = lower;
- if (xres)
- vesafb_defined.xres = xres;
- if (yres)
- vesafb_defined.yres = yres;
- if (sync != -1)
- vesafb_defined.sync = sync;
- else if (vesafb_defined.sync == ~0) {
- vesafb_defined.sync = 0;
- if (yres < 400)
- vesafb_defined.sync |= FB_SYNC_HOR_HIGH_ACT;
- else if (yres < 480)
- vesafb_defined.sync |= FB_SYNC_VERT_HIGH_ACT;
- }
-
- /* fv, fh, maxclk limits was specified */
- {
- unsigned int tmp;
-
- if (fv) {
- tmp = fv * (vesafb_defined.upper_margin + vesafb_defined.yres
- + vesafb_defined.lower_margin + vesafb_defined.vsync_len);
- if ((tmp < fh) || (fh == 0)) fh = tmp;
- }
- if (fh) {
- tmp = fh * (vesafb_defined.left_margin + vesafb_defined.xres
- + vesafb_defined.right_margin + vesafb_defined.hsync_len);
- if ((tmp < maxclk) || (maxclk == 0)) maxclk = tmp;
- }
- maxclk = (maxclk + 499) / 500;
- if (maxclk) {
- tmp = (2000000000 + maxclk) / maxclk;
- if (tmp > pixclock) pixclock = tmp;
- }
- }
- if (pixclock) {
- if (pixclock < 2000) /* > 500MHz */
- pixclock = 4000; /* 250MHz */
- if (pixclock > 1000000)
- pixclock = 1000000; /* 1MHz */
- vesafb_defined.pixclock = pixclock;
- }
-
- /* FIXME: Where to move this?! */
-#if defined(CONFIG_FB_OF)
-#if defined(CONFIG_FB_COMPAT_XPMAC)
- strcpy(ACCESS_FBINFO(matrox_name), "MTRX,"); /* OpenFirmware naming convension */
- strncat(ACCESS_FBINFO(matrox_name), b->name, 26);
- if (!console_fb_info)
- console_fb_info = &ACCESS_FBINFO(fbcon);
-#endif
- if ((xres <= 640) && (yres <= 480)) {
- struct fb_var_screeninfo var;
- if (default_vmode == VMODE_NVRAM) {
- default_vmode = nvram_read_byte(NV_VMODE);
- if (default_vmode <= 0 || default_vmode > VMODE_MAX)
- default_vmode = VMODE_CHOOSE;
- }
- if (default_vmode <= 0 || default_vmode > VMODE_MAX)
- default_vmode = VMODE_640_480_60;
- if (default_cmode == CMODE_NVRAM)
- default_cmode = nvram_read_byte(NV_CMODE);
- if (default_cmode < CMODE_8 || default_cmode > CMODE_32)
- default_cmode = CMODE_8;
- if (!mac_vmode_to_var(default_vmode, default_cmode, &var)) {
- var.accel_flags = vesafb_defined.accel_flags;
- var.xoffset = var.yoffset = 0;
- vesafb_defined = var; /* Note: mac_vmode_to_var() doesnot set all parameters */
- }
- }
-#endif
- vesafb_defined.xres_virtual = vesafb_defined.xres;
- if (nopan) {
- vesafb_defined.yres_virtual = vesafb_defined.yres;
- } else {
- vesafb_defined.yres_virtual = 65536; /* large enough to be INF, but small enough
- to yres_virtual * xres_virtual < 2^32 */
- }
- if (matroxfb_set_var(&vesafb_defined, -2, &ACCESS_FBINFO(fbcon))) {
- printk(KERN_ERR "matroxfb: cannot set required parameters\n");
- return -EINVAL;
- }
-
- printk(KERN_INFO "matroxfb: %dx%dx%dbpp (virtual: %dx%d)\n",
- vesafb_defined.xres, vesafb_defined.yres, vesafb_defined.bits_per_pixel,
- vesafb_defined.xres_virtual, vesafb_defined.yres_virtual);
- printk(KERN_INFO "matroxfb: framebuffer at 0x%lX, mapped to 0x%p, size %d\n",
- ACCESS_FBINFO(video.base), vaddr_va(ACCESS_FBINFO(video.vbase)), ACCESS_FBINFO(video.len));
-
-/* We do not have to set currcon to 0... register_framebuffer do it for us on first console
- * and we do not want currcon == 0 for subsequent framebuffers */
-
- if (register_framebuffer(&ACCESS_FBINFO(fbcon)) < 0) {
- return -EINVAL;
- }
- printk("fb%d: %s frame buffer device\n",
- GET_FB_IDX(ACCESS_FBINFO(fbcon.node)), ACCESS_FBINFO(fbcon.modename));
- if (ACCESS_FBINFO(currcon) < 0) {
- /* there is no console on this fb... but we have to initialize hardware
- * until someone tells me what is proper thing to do */
- printk(KERN_INFO "fb%d: initializing hardware\n",
- GET_FB_IDX(ACCESS_FBINFO(fbcon.node)));
- matroxfb_set_var(&vesafb_defined, -1, &ACCESS_FBINFO(fbcon));
- }
- return 0;
-}
-
-static struct matrox_fb_info* fb_list = NULL;
-
-static int __init matrox_init(void){
- struct pci_dev* pdev = NULL;
-
- DBG("matrox_init")
-
- if (disabled)
- return -ENXIO;
- while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev))) {
- struct board* b;
- u_int8_t rev;
- u_int16_t svid;
- u_int16_t sid;
-
- pci_read_config_byte(pdev, PCI_REVISION_ID, &rev);
- svid = pdev->subsystem_vendor;
- sid = pdev->subsystem_device;
- for (b = dev_list; b->vendor; b++) {
- if ((b->vendor != pdev->vendor) || (b->device != pdev->device) || (b->rev < rev)) continue;
- if (b->svid)
- if ((b->svid != svid) || (b->sid != sid)) continue;
- if (dev <= 0) {
- struct matrox_fb_info* minfo;
- struct display* d;
- int err;
-
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
- minfo = (struct matrox_fb_info*)kmalloc(sizeof(*minfo), GFP_KERNEL);
- if (minfo) {
- d = (struct display*)kmalloc(sizeof(*d), GFP_KERNEL);
- if (d) {
-#else
- minfo = &global_mxinfo;
- d = &global_disp;
-#endif
- memset(MINFO, 0, sizeof(*MINFO));
- memset(d, 0, sizeof(*d));
-
- ACCESS_FBINFO(currenthw) = &ACCESS_FBINFO(hw1);
- ACCESS_FBINFO(newhw) = &ACCESS_FBINFO(hw2);
- ACCESS_FBINFO(pcidev) = pdev;
- /* CMDLINE */
- memcpy(ACCESS_FBINFO(fbcon.fontname), fontname, sizeof(ACCESS_FBINFO(fbcon.fontname)));
- /* DEVFLAGS */
- ACCESS_FBINFO(devflags.inverse) = inverse;
- ACCESS_FBINFO(devflags.novga) = novga;
- ACCESS_FBINFO(devflags.nobios) = nobios;
- ACCESS_FBINFO(devflags.noinit) = noinit;
- ACCESS_FBINFO(devflags.nopciretry) = no_pci_retry;
- ACCESS_FBINFO(devflags.mga_24bpp_fix) = inv24;
- ACCESS_FBINFO(devflags.precise_width) = option_precise_width;
- ACCESS_FBINFO(devflags.hwcursor) = hwcursor;
- ACCESS_FBINFO(devflags.blink) = blink;
- ACCESS_FBINFO(devflags.sgram) = sgram;
- ACCESS_FBINFO(capable.cross4MB) = cross4MB;
-
- ACCESS_FBINFO(fastfont.size) = fastfont;
-
- ACCESS_FBINFO(cursor.state) = CM_ERASE;
- ACCESS_FBINFO(cursor.timer.prev) = ACCESS_FBINFO(cursor.timer.next) = NULL;
- ACCESS_FBINFO(cursor.timer.data) = (unsigned long)MINFO;
- spin_lock_init(&ACCESS_FBINFO(lock.DAC));
-
- err = initMatrox2(PMINFO d, b);
- if (!err) {
- ACCESS_FBINFO(next_fb) = fb_list;
- fb_list = MINFO;
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
- goto leave;
-#else
- return 0;
-#endif
- }
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
- kfree(d);
- }
- kfree(minfo);
- }
-#endif
- }
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
-leave:;
-#endif
- if (dev == 0) return 0;
- if (dev > 0) dev--;
- break;
- }
- }
- return 0;
-}
-
-#ifndef MODULE
-static int __init initialized = 0;
-
-int __init matroxfb_init(void)
-{
- DBG("matroxfb_init")
-
- if (!initialized) {
- initialized = 1;
- matrox_init();
- }
- if (!fb_list) return -ENXIO;
- return 0;
-}
-
-#if defined(CONFIG_FB_OF)
-int __init matrox_of_init(struct device_node *dp){
- DBG("matrox_of_init");
-
- if (!initialized) {
- initialized = 1;
- matrox_init();
- }
- if (!fb_list) return -ENXIO;
- return 0;
-}
-#endif /* CONFIG_FB_OF */
-
-#else
-
-MODULE_AUTHOR("(c) 1998,1999 Petr Vandrovec <vandrove@vc.cvut.cz>");
-MODULE_DESCRIPTION("Accelerated FBDev driver for Matrox Millennium/Mystique/G100/G200/G400");
-MODULE_PARM(mem, "i");
-MODULE_PARM_DESC(mem, "Size of available memory in MB, KB or B (2,4,8,12,16MB, default=autodetect)");
-MODULE_PARM(disabled, "i");
-MODULE_PARM_DESC(disabled, "Disabled (0 or 1=disabled), meaningless for module (default=0)");
-MODULE_PARM(noaccel, "i");
-MODULE_PARM_DESC(noaccel, "Do not use accelerating engine (0 or 1=disabled) (default=0)");
-MODULE_PARM(nopan, "i");
-MODULE_PARM_DESC(nopan, "Disable pan on startup (0 or 1=disabled) (default=0)");
-MODULE_PARM(no_pci_retry, "i");
-MODULE_PARM_DESC(no_pci_retry, "PCI retries enabled (0 or 1=disabled) (default=0)");
-MODULE_PARM(novga, "i");
-MODULE_PARM_DESC(novga, "VGA I/O (0x3C0-0x3DF) disabled (0 or 1=disabled) (default=0)");
-MODULE_PARM(nobios, "i");
-MODULE_PARM_DESC(nobios, "Disables ROM BIOS (0 or 1=disabled) (default=do not change BIOS state)");
-MODULE_PARM(noinit, "i");
-MODULE_PARM_DESC(noinit, "Disables W/SG/SD-RAM and bus interface initialization (0 or 1=do not initialize) (default=0)");
-MODULE_PARM(mtrr, "i");
-MODULE_PARM_DESC(mtrr, "This speeds up video memory accesses (0=disabled or 1) (default=1)");
-MODULE_PARM(sgram, "i");
-MODULE_PARM_DESC(sgram, "Indicates that G200/G400 has SGRAM memory (0=SDRAM, 1=SGRAM) (default=0)");
-MODULE_PARM(inv24, "i");
-MODULE_PARM_DESC(inv24, "Inverts clock polarity for 24bpp and loop frequency > 100MHz (default=do not invert polarity)");
-MODULE_PARM(inverse, "i");
-MODULE_PARM_DESC(inverse, "Inverse (0 or 1) (default=0)");
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
-MODULE_PARM(dev, "i");
-MODULE_PARM_DESC(dev, "Multihead support, attach to device ID (0..N) (default=all working)");
-#else
-MODULE_PARM(dev, "i");
-MODULE_PARM_DESC(dev, "Multihead support, attach to device ID (0..N) (default=first working)");
-#endif
-MODULE_PARM(vesa, "i");
-MODULE_PARM_DESC(vesa, "Startup videomode (0x000-0x1FF) (default=0x101)");
-MODULE_PARM(xres, "i");
-MODULE_PARM_DESC(xres, "Horizontal resolutioni (px), overrides xres from vesa (default=vesa)");
-MODULE_PARM(yres, "i");
-MODULE_PARM_DESC(yres, "Vertical resolution (scans), overrides yres from vesa (default=vesa)");
-MODULE_PARM(upper, "i");
-MODULE_PARM_DESC(upper, "Upper blank space (scans), overrides upper from vesa (default=vesa)");
-MODULE_PARM(lower, "i");
-MODULE_PARM_DESC(lower, "Lower blank space (scans), overrides lower from vesa (default=vesa)");
-MODULE_PARM(vslen, "i");
-MODULE_PARM_DESC(vslen, "Vertical sync length (scans), overrides lower from vesa (default=vesa)");
-MODULE_PARM(left, "i");
-MODULE_PARM_DESC(left, "Left blank space (px), overrides left from vesa (default=vesa)");
-MODULE_PARM(right, "i");
-MODULE_PARM_DESC(right, "Right blank space (px), overrides right from vesa (default=vesa)");
-MODULE_PARM(hslen, "i");
-MODULE_PARM_DESC(hslen, "Horizontal sync length (px), overrides hslen from vesa (default=vesa)");
-MODULE_PARM(pixclock, "i");
-MODULE_PARM_DESC(pixclock, "Pixelclock (ns), overrides pixclock from vesa (default=vesa)");
-MODULE_PARM(sync, "i");
-MODULE_PARM_DESC(sync, "Sync polarity, overrides sync from vesa (default=vesa)");
-MODULE_PARM(depth, "i");
-MODULE_PARM_DESC(depth, "Color depth (0=text,8,15,16,24,32) (default=vesa)");
-MODULE_PARM(maxclk, "i");
-MODULE_PARM_DESC(maxclk, "Startup maximal clock, 0-999MHz, 1000-999999kHz, 1000000-INF Hz");
-MODULE_PARM(fh, "i");
-MODULE_PARM_DESC(fh, "Startup horizontal frequency, 0-999kHz, 1000-INF Hz");
-MODULE_PARM(fv, "i");
-MODULE_PARM_DESC(fv, "Startup vertical frequency, 0-INF Hz\n"
-"You should specify \"fv:max_monitor_vsync,fh:max_monitor_hsync,maxclk:max_monitor_dotclock\"\n");
-MODULE_PARM(hwcursor, "i");
-MODULE_PARM_DESC(hwcursor, "Enables hardware cursor (0 or 1) (default=0)");
-MODULE_PARM(blink, "i");
-MODULE_PARM_DESC(blink, "Enables hardware cursor blinking (0 or 1) (default=1)");
-MODULE_PARM(fastfont, "i");
-MODULE_PARM_DESC(fastfont, "Specifies, how much memory should be used for font data (0, 1024-65536 are reasonable) (default=0)");
-MODULE_PARM(grayscale, "i");
-MODULE_PARM_DESC(grayscale, "Sets display into grayscale. Works perfectly with paletized videomode (4, 8bpp), some limitations apply to 16, 24 and 32bpp videomodes (default=nograyscale)");
-MODULE_PARM(cross4MB, "i");
-MODULE_PARM_DESC(cross4MB, "Specifies that 4MB boundary can be in middle of line. (default=autodetected)");
-#ifdef CONFIG_FB_OF
-MODULE_PARM(vmode, "i");
-MODULE_PARM_DESC(vmode, "Specify the vmode mode number that should be used (640x480 default)");
-MODULE_PARM(cmode, "i");
-MODULE_PARM_DESC(cmode, "Specify the video depth that should be used (8bit default)");
-#endif
-
-int __init init_module(void){
-
- DBG("init_module")
-
-#ifdef DEBUG
- if( disabled )
- return -ENXIO;
-#endif /* DEBUG */
-
- if (depth == 0)
- depth = RSText;
- else if (depth == 4)
- depth = RS4bpp;
- else if (depth == 8)
- depth = RS8bpp;
- else if (depth == 15)
- depth = RS15bpp;
- else if (depth == 16)
- depth = RS16bpp;
- else if (depth == 24)
- depth = RS24bpp;
- else if (depth == 32)
- depth = RS32bpp;
- else if (depth != -1) {
- printk(KERN_ERR "matroxfb: depth %d is not supported, using default\n", depth);
- depth = -1;
- }
- matrox_init();
- if (!fb_list) return -ENXIO;
- return 0;
-}
-
-void cleanup_module(void) {
-
- DBG("cleanup_module")
-
-#ifdef DEBUG
- if( disabled )
- return;
-#endif /* DEBUG */
-
- while (fb_list) {
- struct matrox_fb_info* minfo;
-
- minfo = fb_list;
- fb_list = fb_list->next_fb;
- unregister_framebuffer(&ACCESS_FBINFO(fbcon));
- del_timer(&ACCESS_FBINFO(cursor.timer));
-#ifdef CONFIG_MTRR
- if (ACCESS_FBINFO(mtrr.vram_valid))
- mtrr_del(ACCESS_FBINFO(mtrr.vram), ACCESS_FBINFO(video.base), ACCESS_FBINFO(video.len));
-#endif
- mga_iounmap(ACCESS_FBINFO(mmio.vbase));
- mga_iounmap(ACCESS_FBINFO(video.vbase));
-#ifdef CONFIG_FB_MATROX_MULTIHEAD
- kfree_s(ACCESS_FBINFO(fbcon.disp), sizeof(struct display));
- kfree_s(minfo, sizeof(struct matrox_fb_info));
-#endif
- }
-}
-#endif /* MODULE */
-/*
- * Overrides for Emacs so that we follow Linus's tabbing style.
- * ---------------------------------------------------------------------------
- * Local variables:
- * c-basic-offset: 8
- * End:
- */
FUNET's LINUX-ADM group, linux-adm@nic.funet.fi
TCL-scripts by Sam Shen (who was at: slshen@lbl.gov)