Bug #6328: Add support for Matrox G200SE chips. (Matrox)

1 files changed, 221 insertions, 0 deletions

diff --git a/src/mga_vga.c b/src/mga_vga.c
new file mode 100644
index 0000000..26fcefc
--- /dev/null
+++ b/src/mga_vga.c
@@ -0,0 +1,221 @@
+#include "misc.h"
+#include "xf86.h"
+#include "xf86_OSproc.h"
+#include "xf86_ansic.h"
+#include "vgaHW.h"
+#include "compiler.h"
+#include "xf86cmap.h"
+
+#define TEXT_AMOUNT 16384
+#define FONT_AMOUNT (8*8192)
+
+void
+MGAG200SERestoreFonts(ScrnInfoPtr scrninfp, vgaRegPtr restore)
+{
+    vgaHWPtr hwp = VGAHWPTR(scrninfp);
+    int savedIOBase;
+    unsigned char miscOut, attr10, gr1, gr3, gr4, gr5, gr6, gr8, seq2, seq4;
+    Bool doMap = FALSE;
+
+    /* If nothing to do, return now */
+    if (!hwp->FontInfo1 && !hwp->FontInfo2 && !hwp->TextInfo)
+	return;
+
+    if (hwp->Base == NULL) {
+	doMap = TRUE;
+	if (!vgaHWMapMem(scrninfp)) {
+	    xf86DrvMsg(scrninfp->scrnIndex, X_ERROR,
+		    "vgaHWRestoreFonts: vgaHWMapMem() failed\n");
+	    return;
+	}
+    }
+
+    /* save the registers that are needed here */
+    miscOut = hwp->readMiscOut(hwp);
+    attr10 = hwp->readAttr(hwp, 0x10);
+    gr1 = hwp->readGr(hwp, 0x01);
+    gr3 = hwp->readGr(hwp, 0x03);
+    gr4 = hwp->readGr(hwp, 0x04);
+    gr5 = hwp->readGr(hwp, 0x05);
+    gr6 = hwp->readGr(hwp, 0x06);
+    gr8 = hwp->readGr(hwp, 0x08);
+    seq2 = hwp->readSeq(hwp, 0x02);
+    seq4 = hwp->readSeq(hwp, 0x04);
+
+    /* save hwp->IOBase and temporarily set it for colour mode */
+    savedIOBase = hwp->IOBase;
+    hwp->IOBase = VGA_IOBASE_COLOR;
+
+    /* Force into colour mode */
+    hwp->writeMiscOut(hwp, miscOut | 0x01);
+
+    vgaHWBlankScreen(scrninfp, FALSE);
+
+    /*
+     * here we temporarily switch to 16 colour planar mode, to simply
+     * copy the font-info and saved text.
+     *
+     * BUG ALERT: The (S)VGA's segment-select register MUST be set correctly!
+     */
+#if 0
+    hwp->writeAttr(hwp, 0x10, 0x01);   /* graphics mode */
+#endif
+    if (scrninfp->depth == 4) {
+	/* GJA */
+	hwp->writeGr(hwp, 0x03, 0x00);  /* don't rotate, write unmodified */
+	hwp->writeGr(hwp, 0x08, 0xFF);  /* write all bits in a byte */
+	hwp->writeGr(hwp, 0x01, 0x00);  /* all planes come from CPU */
+    }
+
+    if (hwp->FontInfo1) {
+	hwp->writeSeq(hwp, 0x02, 0x04); /* write to plane 2 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x02);  /* read plane 2 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_tobus(hwp->FontInfo1, hwp->Base, FONT_AMOUNT);
+    }
+
+    if (hwp->FontInfo2) {
+	hwp->writeSeq(hwp, 0x02, 0x08); /* write to plane 3 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x03);  /* read plane 3 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_tobus(hwp->FontInfo2, hwp->Base, FONT_AMOUNT);
+    }
+
+    if (hwp->TextInfo) {
+	hwp->writeSeq(hwp, 0x02, 0x01); /* write to plane 0 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x00);  /* read plane 0 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_tobus(hwp->TextInfo, hwp->Base, TEXT_AMOUNT);
+	hwp->writeSeq(hwp, 0x02, 0x02); /* write to plane 1 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x01);  /* read plane 1 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_tobus((unsigned char *)hwp->TextInfo + TEXT_AMOUNT,
+		hwp->Base, TEXT_AMOUNT);
+    }
+
+    /* restore the registers that were changed */
+    hwp->writeMiscOut(hwp, miscOut);
+    hwp->writeAttr(hwp, 0x10, attr10);
+    hwp->writeGr(hwp, 0x01, gr1);
+    hwp->writeGr(hwp, 0x03, gr3);
+    hwp->writeGr(hwp, 0x04, gr4);
+    hwp->writeGr(hwp, 0x05, gr5);
+    hwp->writeGr(hwp, 0x06, gr6);
+    hwp->writeGr(hwp, 0x08, gr8);
+    hwp->writeSeq(hwp, 0x02, seq2);
+    hwp->writeSeq(hwp, 0x04, seq4);
+    hwp->IOBase = savedIOBase;
+
+    vgaHWBlankScreen(scrninfp, TRUE);
+
+    if (doMap)
+	vgaHWUnmapMem(scrninfp);
+}
+
+
+void
+MGAG200SESaveFonts(ScrnInfoPtr scrninfp, vgaRegPtr save)
+{
+    vgaHWPtr hwp = VGAHWPTR(scrninfp);
+    int savedIOBase;
+    unsigned char miscOut, attr10, gr4, gr5, gr6, seq2, seq4;
+    Bool doMap = FALSE;
+
+    if (hwp->Base == NULL) {
+	doMap = TRUE;
+	if (!vgaHWMapMem(scrninfp)) {
+	    xf86DrvMsg(scrninfp->scrnIndex, X_ERROR,
+		    "vgaHWSaveFonts: vgaHWMapMem() failed\n");
+	    return;
+	}
+    }
+
+    /* If in graphics mode, don't save anything */
+    attr10 = hwp->readAttr(hwp, 0x10);
+    if (attr10 & 0x01)
+	return;
+
+    /* save the registers that are needed here */
+    miscOut = hwp->readMiscOut(hwp);
+    gr4 = hwp->readGr(hwp, 0x04);
+    gr5 = hwp->readGr(hwp, 0x05);
+    gr6 = hwp->readGr(hwp, 0x06);
+    seq2 = hwp->readSeq(hwp, 0x02);
+    seq4 = hwp->readSeq(hwp, 0x04);
+
+    /* save hwp->IOBase and temporarily set it for colour mode */
+    savedIOBase = hwp->IOBase;
+    hwp->IOBase = VGA_IOBASE_COLOR;
+
+    /* Force into colour mode */
+    hwp->writeMiscOut(hwp, miscOut | 0x01);
+
+    vgaHWBlankScreen(scrninfp, FALSE);
+
+    /*
+     * get the character sets, and text screen if required
+     */
+    /*
+     * Here we temporarily switch to 16 colour planar mode, to simply
+     * copy the font-info
+     *
+     * BUG ALERT: The (S)VGA's segment-select register MUST be set correctly!
+     */
+#if 0
+    hwp->writeAttr(hwp, 0x10, 0x01);   /* graphics mode */
+#endif
+    if (hwp->FontInfo1 || (hwp->FontInfo1 = xalloc(FONT_AMOUNT))) {
+	hwp->writeSeq(hwp, 0x02, 0x04); /* write to plane 2 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x02);  /* read plane 2 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_frombus(hwp->Base, hwp->FontInfo1, FONT_AMOUNT);
+    }
+    if (hwp->FontInfo2 || (hwp->FontInfo2 = xalloc(FONT_AMOUNT))) {
+	hwp->writeSeq(hwp, 0x02, 0x08); /* write to plane 3 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x03);  /* read plane 3 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_frombus(hwp->Base, hwp->FontInfo2, FONT_AMOUNT);
+    }
+    if (hwp->TextInfo || (hwp->TextInfo = xalloc(2 * TEXT_AMOUNT))) {
+	hwp->writeSeq(hwp, 0x02, 0x01); /* write to plane 0 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x00);  /* read plane 0 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_frombus(hwp->Base, hwp->TextInfo, TEXT_AMOUNT);
+	hwp->writeSeq(hwp, 0x02, 0x02); /* write to plane 1 */
+	hwp->writeSeq(hwp, 0x04, 0x06); /* enable plane graphics */
+	hwp->writeGr(hwp, 0x04, 0x01);  /* read plane 1 */
+	hwp->writeGr(hwp, 0x05, 0x00);  /* write mode 0, read mode 0 */
+	hwp->writeGr(hwp, 0x06, 0x05);  /* set graphics */
+	slowbcopy_frombus(hwp->Base,
+		(unsigned char *)hwp->TextInfo + TEXT_AMOUNT, TEXT_AMOUNT);
+    }
+
+    /* Restore clobbered registers */
+    hwp->writeAttr(hwp, 0x10, attr10);
+    hwp->writeGr(hwp, 0x04, gr4);
+    hwp->writeGr(hwp, 0x05, gr5);
+    hwp->writeGr(hwp, 0x06, gr6);
+    hwp->writeSeq(hwp, 0x02, seq2);
+    hwp->writeSeq(hwp, 0x04, seq4);
+    hwp->writeMiscOut(hwp, miscOut);
+    hwp->IOBase = savedIOBase;
+
+    vgaHWBlankScreen(scrninfp, TRUE);
+
+    if (doMap)
+	vgaHWUnmapMem(scrninfp);
+}