Home | History | Annotate | Line # | Download | only in dev
grf_cl.c revision 1.7
      1  1.7  thorpej /*      $NetBSD: grf_cl.c,v 1.7 1996/03/17 01:17:11 thorpej Exp $        */
      2  1.1   chopps 
      3  1.1   chopps /*
      4  1.1   chopps  * Copyright (c) 1995 Ezra Story
      5  1.1   chopps  * Copyright (c) 1995 Kari Mettinen
      6  1.1   chopps  * Copyright (c) 1994 Markus Wild
      7  1.1   chopps  * Copyright (c) 1994 Lutz Vieweg
      8  1.1   chopps  * All rights reserved.
      9  1.1   chopps  *
     10  1.1   chopps  * Redistribution and use in source and binary forms, with or without
     11  1.1   chopps  * modification, are permitted provided that the following conditions
     12  1.1   chopps  * are met:
     13  1.1   chopps  * 1. Redistributions of source code must retain the above copyright
     14  1.1   chopps  *    notice, this list of conditions and the following disclaimer.
     15  1.1   chopps  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1   chopps  *    notice, this list of conditions and the following disclaimer in the
     17  1.1   chopps  *    documentation and/or other materials provided with the distribution.
     18  1.1   chopps  * 3. All advertising materials mentioning features or use of this software
     19  1.1   chopps  *    must display the following acknowledgement:
     20  1.1   chopps  *      This product includes software developed by Lutz Vieweg.
     21  1.1   chopps  * 4. The name of the author may not be used to endorse or promote products
     22  1.1   chopps  *    derived from this software without specific prior written permission
     23  1.1   chopps  *
     24  1.1   chopps  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     25  1.1   chopps  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     26  1.1   chopps  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     27  1.1   chopps  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     28  1.1   chopps  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     29  1.1   chopps  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     30  1.1   chopps  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     31  1.1   chopps  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     32  1.1   chopps  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     33  1.5   chopps  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     34  1.1   chopps  */
     35  1.5   chopps #include "grfcl.h"
     36  1.5   chopps #if NGRFCL > 0
     37  1.1   chopps 
     38  1.1   chopps /*
     39  1.1   chopps  * Graphics routines for Cirrus CL GD 5426 boards,
     40  1.1   chopps  *
     41  1.1   chopps  * This code offers low-level routines to access Cirrus Cl GD 5426
     42  1.1   chopps  * graphics-boards from within NetBSD for the Amiga.
     43  1.1   chopps  * No warranties for any kind of function at all - this
     44  1.1   chopps  * code may crash your hardware and scratch your harddisk.  Use at your
     45  1.1   chopps  * own risk.  Freely distributable.
     46  1.1   chopps  *
     47  1.1   chopps  * Modified for Cirrus CL GD 5426 from
     48  1.1   chopps  * Lutz Vieweg's retina driver by Kari Mettinen 08/94
     49  1.1   chopps  * Contributions by Ill, ScottE, MiL
     50  1.1   chopps  * Extensively hacked and rewritten by Ezra Story (Ezy) 01/95
     51  1.6       is  * Picasso/040 patches (wee!) by crest 01/96
     52  1.1   chopps  *
     53  1.1   chopps  * Thanks to Village Tronic Marketing Gmbh for providing me with
     54  1.1   chopps  * a Picasso-II board.
     55  1.1   chopps  * Thanks for Integrated Electronics Oy Ab for providing me with
     56  1.1   chopps  * Cirrus CL GD 542x family documentation.
     57  1.1   chopps  *
     58  1.1   chopps  * TODO:
     59  1.5   chopps  *    Mouse support (almost there! :-))
     60  1.1   chopps  *    Blitter support
     61  1.1   chopps  *
     62  1.1   chopps  */
     63  1.1   chopps 
     64  1.1   chopps #include <sys/param.h>
     65  1.4   chopps #include <sys/systm.h>
     66  1.1   chopps #include <sys/errno.h>
     67  1.1   chopps #include <sys/ioctl.h>
     68  1.1   chopps #include <sys/device.h>
     69  1.1   chopps #include <sys/malloc.h>
     70  1.5   chopps 
     71  1.1   chopps #include <machine/cpu.h>
     72  1.1   chopps #include <dev/cons.h>
     73  1.1   chopps #include <amiga/amiga/device.h>
     74  1.1   chopps #include <amiga/dev/grfioctl.h>
     75  1.1   chopps #include <amiga/dev/grfvar.h>
     76  1.1   chopps #include <amiga/dev/grf_clreg.h>
     77  1.1   chopps #include <amiga/dev/zbusvar.h>
     78  1.1   chopps 
     79  1.5   chopps static int cl_mondefok __P((struct grfvideo_mode * gv));
     80  1.1   chopps static void cl_boardinit();
     81  1.5   chopps static void CompFQ __P((u_int fq, u_char * num, u_char * denom));
     82  1.5   chopps static int cl_getvmode __P((struct grf_softc * gp, struct grfvideo_mode * vm));
     83  1.5   chopps static int cl_setvmode __P((struct grf_softc * gp, unsigned int mode));
     84  1.5   chopps static int cl_toggle __P((struct grf_softc * gp, unsigned short));
     85  1.5   chopps static int cl_getcmap __P((struct grf_softc * gfp, struct grf_colormap * cmap));
     86  1.5   chopps static int cl_putcmap __P((struct grf_softc * gfp, struct grf_colormap * cmap));
     87  1.5   chopps static void cl_off __P((struct grf_softc * gp));
     88  1.5   chopps static void cl_inittextmode __P((struct grf_softc * gp));
     89  1.5   chopps static int cl_ioctl __P((register struct grf_softc * gp, int cmd, void *data));
     90  1.5   chopps static int cl_getmousepos __P((struct grf_softc * gp, struct grf_position * data));
     91  1.5   chopps static int cl_setmousepos __P((struct grf_softc * gp, struct grf_position * data));
     92  1.5   chopps static int cl_setspriteinfo __P((struct grf_softc * gp, struct grf_spriteinfo * data));
     93  1.5   chopps static int cl_getspriteinfo __P((struct grf_softc * gp, struct grf_spriteinfo * data));
     94  1.5   chopps static int cl_getspritemax __P((struct grf_softc * gp, struct grf_position * data));
     95  1.5   chopps static int cl_blank __P((struct grf_softc * gp, int * on));
     96  1.5   chopps 
     97  1.1   chopps 
     98  1.1   chopps void grfclattach __P((struct device *, struct device *, void *));
     99  1.5   chopps int grfclprint __P((void *, char *));
    100  1.7  thorpej int grfclmatch __P((struct device *, void *, void *));
    101  1.5   chopps void cl_memset __P((unsigned char *d, unsigned char c, int l));
    102  1.1   chopps 
    103  1.5   chopps /* Graphics display definitions.
    104  1.1   chopps  * These are filled by 'grfconfig' using GRFIOCSETMON.
    105  1.1   chopps  */
    106  1.1   chopps #define monitor_def_max 8
    107  1.1   chopps static struct grfvideo_mode monitor_def[8] = {
    108  1.1   chopps 	{0}, {0}, {0}, {0}, {0}, {0}, {0}, {0}
    109  1.1   chopps };
    110  1.1   chopps static struct grfvideo_mode *monitor_current = &monitor_def[0];
    111  1.1   chopps 
    112  1.1   chopps /* Patchable maximum pixel clock */
    113  1.5   chopps unsigned long cl_maxpixelclock = 86000000;
    114  1.1   chopps 
    115  1.1   chopps /* Console display definition.
    116  1.1   chopps  *   Default hardcoded text mode.  This grf_cl is set up to
    117  1.1   chopps  *   use one text mode only, and this is it.  You may use
    118  1.1   chopps  *   grfconfig to change the mode after boot.
    119  1.5   chopps  */
    120  1.1   chopps /* Console font */
    121  1.2   chopps #ifdef KFONT_8X11
    122  1.2   chopps #define CIRRUSFONT kernel_font_8x11
    123  1.2   chopps #define CIRRUSFONTY 11
    124  1.2   chopps #else
    125  1.1   chopps #define CIRRUSFONT kernel_font_8x8
    126  1.1   chopps #define CIRRUSFONTY 8
    127  1.2   chopps #endif
    128  1.1   chopps extern unsigned char CIRRUSFONT[];
    129  1.1   chopps 
    130  1.1   chopps struct grfcltext_mode clconsole_mode = {
    131  1.5   chopps 	{255, "", 25200000, 640, 480, 4, 80, 100, 94, 99, 100, 481, 522, 490,
    132  1.5   chopps 	498, 522},
    133  1.5   chopps 	8, CIRRUSFONTY, 80, 480 / CIRRUSFONTY, CIRRUSFONT, 32, 255
    134  1.1   chopps };
    135  1.1   chopps /* Console colors */
    136  1.5   chopps unsigned char clconscolors[3][3] = {	/* background, foreground, hilite */
    137  1.5   chopps 	{0, 0x40, 0x50}, {152, 152, 152}, {255, 255, 255}
    138  1.1   chopps };
    139  1.1   chopps 
    140  1.5   chopps int     cltype = 0;		/* Picasso, Spectrum or Piccolo */
    141  1.5   chopps unsigned char pass_toggle;	/* passthru status tracker */
    142  1.1   chopps 
    143  1.5   chopps /* because all 5426-boards have 2 configdev entries, one for
    144  1.1   chopps  * framebuffer mem and the other for regs, we have to hold onto
    145  1.1   chopps  * the pointers globally until we match on both.  This and 'cltype'
    146  1.1   chopps  * are the primary obsticles to multiple board support, but if you
    147  1.1   chopps  * have multiple boards you have bigger problems than grf_cl.
    148  1.1   chopps  */
    149  1.5   chopps static void *cl_fbaddr = 0;	/* framebuffer */
    150  1.5   chopps static void *cl_regaddr = 0;	/* registers */
    151  1.5   chopps static int cl_fbsize;		/* framebuffer size */
    152  1.5   chopps 
    153  1.5   chopps /* current sprite info, if you add summport for multiple boards
    154  1.5   chopps  * make this an array or something
    155  1.5   chopps  */
    156  1.5   chopps struct grf_spriteinfo cl_cursprite;
    157  1.5   chopps 
    158  1.5   chopps /* sprite bitmaps in kernel stack, you'll need to arrayize these too if
    159  1.5   chopps  * you add multiple board support
    160  1.5   chopps  */
    161  1.5   chopps static unsigned char cl_imageptr[8 * 64], cl_maskptr[8 * 64];
    162  1.5   chopps static unsigned char cl_sprred[2], cl_sprgreen[2], cl_sprblue[2];
    163  1.1   chopps 
    164  1.1   chopps /* standard driver stuff */
    165  1.7  thorpej struct cfattac grfcl_ca = {
    166  1.7  thorpej 	sizeof(struct grf_softc), grfclmatch, grfclattach
    167  1.7  thorpej };
    168  1.7  thorpej 
    169  1.7  thorpej struct cfdriver grfcl_cd = {
    170  1.7  thorpej 	NULL, "grfcl", DV_DULL, NULL, 0
    171  1.1   chopps };
    172  1.1   chopps static struct cfdata *cfdata;
    173  1.1   chopps 
    174  1.1   chopps int
    175  1.7  thorpej grfclmatch(pdp, match, auxp)
    176  1.1   chopps 	struct device *pdp;
    177  1.7  thorpej 	void   *match, *auxp;
    178  1.1   chopps {
    179  1.7  thorpej 	struct cfdata *cfp = match;
    180  1.1   chopps 	struct zbus_args *zap;
    181  1.1   chopps 	static int regprod, fbprod;
    182  1.1   chopps 
    183  1.1   chopps 	zap = auxp;
    184  1.1   chopps 
    185  1.1   chopps #ifndef CL5426CONSOLE
    186  1.1   chopps 	if (amiga_realconfig == 0)
    187  1.5   chopps 		return (0);
    188  1.1   chopps #endif
    189  1.1   chopps 
    190  1.5   chopps 	/* Grab the first board we encounter as the preferred one.  This will
    191  1.5   chopps 	 * allow one board to work in a multiple 5426 board system, but not
    192  1.5   chopps 	 * multiple boards at the same time.  */
    193  1.1   chopps 	if (cltype == 0) {
    194  1.1   chopps 		switch (zap->manid) {
    195  1.1   chopps 		case PICASSO:
    196  1.3   chopps 			if (zap->prodid != 12 && zap->prodid != 11)
    197  1.3   chopps 				return (0);
    198  1.1   chopps 			regprod = 12;
    199  1.1   chopps 			fbprod = 11;
    200  1.1   chopps 			break;
    201  1.1   chopps 		case SPECTRUM:
    202  1.3   chopps 			if (zap->prodid != 2 && zap->prodid != 1)
    203  1.3   chopps 				return (0);
    204  1.1   chopps 			regprod = 2;
    205  1.1   chopps 			fbprod = 1;
    206  1.1   chopps 			break;
    207  1.1   chopps 		case PICCOLO:
    208  1.3   chopps 			if (zap->prodid != 6 && zap->prodid != 5)
    209  1.3   chopps 				return (0);
    210  1.1   chopps 			regprod = 6;
    211  1.1   chopps 			fbprod = 5;
    212  1.1   chopps 			break;
    213  1.1   chopps 		default:
    214  1.5   chopps 			return (0);
    215  1.1   chopps 		}
    216  1.1   chopps 		cltype = zap->manid;
    217  1.1   chopps 	} else {
    218  1.1   chopps 		if (cltype != zap->manid) {
    219  1.5   chopps 			return (0);
    220  1.1   chopps 		}
    221  1.1   chopps 	}
    222  1.1   chopps 
    223  1.5   chopps 	/* Configure either registers or framebuffer in any order */
    224  1.1   chopps 	if (zap->prodid == regprod)
    225  1.1   chopps 		cl_regaddr = zap->va;
    226  1.5   chopps 	else
    227  1.5   chopps 		if (zap->prodid == fbprod) {
    228  1.5   chopps 			cl_fbaddr = zap->va;
    229  1.5   chopps 			cl_fbsize = zap->size;
    230  1.5   chopps 		} else
    231  1.5   chopps 			return (0);
    232  1.1   chopps 
    233  1.1   chopps #ifdef CL5426CONSOLE
    234  1.1   chopps 	if (amiga_realconfig == 0) {
    235  1.1   chopps 		cfdata = cfp;
    236  1.1   chopps 	}
    237  1.5   chopps #endif
    238  1.1   chopps 
    239  1.5   chopps 	return (1);
    240  1.1   chopps }
    241  1.1   chopps 
    242  1.1   chopps void
    243  1.1   chopps grfclattach(pdp, dp, auxp)
    244  1.1   chopps 	struct device *pdp, *dp;
    245  1.5   chopps 	void   *auxp;
    246  1.1   chopps {
    247  1.1   chopps 	static struct grf_softc congrf;
    248  1.1   chopps 	struct zbus_args *zap;
    249  1.1   chopps 	struct grf_softc *gp;
    250  1.5   chopps 	int     x;
    251  1.1   chopps 	static char attachflag = 0;
    252  1.1   chopps 
    253  1.1   chopps 	zap = auxp;
    254  1.1   chopps 
    255  1.1   chopps 	printf("\n");
    256  1.1   chopps 
    257  1.1   chopps 	/* make sure both halves have matched */
    258  1.1   chopps 	if (!cl_regaddr || !cl_fbaddr)
    259  1.1   chopps 		return;
    260  1.1   chopps 
    261  1.1   chopps 	/* do all that messy console/grf stuff */
    262  1.1   chopps 	if (dp == NULL)
    263  1.1   chopps 		gp = &congrf;
    264  1.1   chopps 	else
    265  1.5   chopps 		gp = (struct grf_softc *) dp;
    266  1.1   chopps 
    267  1.1   chopps 	if (dp != NULL && congrf.g_regkva != 0) {
    268  1.1   chopps 		/*
    269  1.1   chopps 		 * inited earlier, just copy (not device struct)
    270  1.1   chopps 		 */
    271  1.1   chopps 		bcopy(&congrf.g_display, &gp->g_display,
    272  1.5   chopps 		    (char *) &gp[1] - (char *) &gp->g_display);
    273  1.1   chopps 	} else {
    274  1.5   chopps 		gp->g_regkva = (volatile caddr_t) cl_regaddr;
    275  1.5   chopps 		gp->g_fbkva = (volatile caddr_t) cl_fbaddr;
    276  1.1   chopps 
    277  1.1   chopps 		gp->g_unit = GRF_CL5426_UNIT;
    278  1.1   chopps 		gp->g_mode = cl_mode;
    279  1.1   chopps 		gp->g_conpri = grfcl_cnprobe();
    280  1.1   chopps 		gp->g_flags = GF_ALIVE;
    281  1.1   chopps 
    282  1.1   chopps 		/* wakeup the board */
    283  1.1   chopps 		cl_boardinit(gp);
    284  1.1   chopps 
    285  1.1   chopps #ifdef CL5426CONSOLE
    286  1.1   chopps 		grfcl_iteinit(gp);
    287  1.5   chopps 		(void) cl_load_mon(gp, &clconsole_mode);
    288  1.1   chopps #endif
    289  1.1   chopps 
    290  1.1   chopps 	}
    291  1.1   chopps 
    292  1.1   chopps 	/*
    293  1.1   chopps 	 * attach grf (once)
    294  1.1   chopps 	 */
    295  1.1   chopps 	if (amiga_config_found(cfdata, &gp->g_device, gp, grfclprint)) {
    296  1.1   chopps 		attachflag = 1;
    297  1.5   chopps 		printf("grfcl: %dMB ", cl_fbsize / 0x100000);
    298  1.1   chopps 		switch (cltype) {
    299  1.1   chopps 		case PICASSO:
    300  1.1   chopps 			printf("Picasso II");
    301  1.5   chopps                         cl_maxpixelclock = 86000000;
    302  1.1   chopps 			break;
    303  1.1   chopps 		case SPECTRUM:
    304  1.1   chopps 			printf("Spectrum");
    305  1.5   chopps                         cl_maxpixelclock = 90000000;
    306  1.1   chopps 			break;
    307  1.1   chopps 		case PICCOLO:
    308  1.1   chopps 			printf("Piccolo");
    309  1.5   chopps                         cl_maxpixelclock = 90000000;
    310  1.1   chopps 			break;
    311  1.1   chopps 		}
    312  1.1   chopps 		printf(" being used\n");
    313  1.5   chopps #ifdef CL_OVERCLOCK
    314  1.5   chopps                 cl_maxpixelclock = 115000000;
    315  1.5   chopps #endif
    316  1.1   chopps 	} else {
    317  1.1   chopps 		if (!attachflag)
    318  1.1   chopps 			printf("grfcl unattached!!\n");
    319  1.1   chopps 	}
    320  1.1   chopps }
    321  1.1   chopps 
    322  1.1   chopps int
    323  1.1   chopps grfclprint(auxp, pnp)
    324  1.5   chopps 	void   *auxp;
    325  1.5   chopps 	char   *pnp;
    326  1.1   chopps {
    327  1.1   chopps 	if (pnp)
    328  1.1   chopps 		printf("ite at %s: ", pnp);
    329  1.5   chopps 	return (UNCONF);
    330  1.1   chopps }
    331  1.1   chopps 
    332  1.1   chopps void
    333  1.1   chopps cl_boardinit(gp)
    334  1.5   chopps 	struct grf_softc *gp;
    335  1.1   chopps {
    336  1.1   chopps 	unsigned char *ba = gp->g_regkva;
    337  1.5   chopps 	int     x;
    338  1.5   chopps 	void   *bah;
    339  1.1   chopps 
    340  1.1   chopps 	/* wakeup board and flip passthru OFF */
    341  1.1   chopps 
    342  1.1   chopps 	RegWakeup(ba);
    343  1.1   chopps 	RegOnpass(ba);
    344  1.1   chopps 
    345  1.1   chopps 	vgaw(ba, 0x46e8, 0x16);
    346  1.1   chopps 	vgaw(ba, 0x102, 1);
    347  1.1   chopps 	vgaw(ba, 0x46e8, 0x0e);
    348  1.1   chopps 	vgaw(ba, 0x3c3, 1);
    349  1.1   chopps 
    350  1.1   chopps 	/* setup initial unchanging parameters */
    351  1.1   chopps 
    352  1.5   chopps 	WSeq(ba, SEQ_ID_CLOCKING_MODE, 0x21);	/* 8 dot - display off */
    353  1.5   chopps 	vgaw(ba, GREG_MISC_OUTPUT_W, 0xe1);	/* mem disable */
    354  1.1   chopps 
    355  1.5   chopps 	WGfx(ba, GCT_ID_OFFSET_1, 0xec);	/* magic cookie */
    356  1.5   chopps 	WSeq(ba, SEQ_ID_UNLOCK_EXT, 0x12);	/* yum! cookies! */
    357  1.1   chopps 
    358  1.5   chopps 	WSeq(ba, SEQ_ID_DRAM_CNTL, 0xb0);
    359  1.5   chopps 	WSeq(ba, SEQ_ID_RESET, 0x03);
    360  1.1   chopps 	WSeq(ba, SEQ_ID_MAP_MASK, 0xff);
    361  1.5   chopps 	WSeq(ba, SEQ_ID_CHAR_MAP_SELECT, 0x00);
    362  1.5   chopps 	WSeq(ba, SEQ_ID_MEMORY_MODE, 0x0e);	/* a or 6? */
    363  1.1   chopps 	WSeq(ba, SEQ_ID_EXT_SEQ_MODE, (cltype == PICASSO) ? 0x20 : 0x80);
    364  1.1   chopps 	WSeq(ba, SEQ_ID_EEPROM_CNTL, 0x00);
    365  1.5   chopps 	WSeq(ba, SEQ_ID_PERF_TUNE, 0x0a);	/* mouse 0a fa */
    366  1.1   chopps 	WSeq(ba, SEQ_ID_SIG_CNTL, 0x02);
    367  1.5   chopps 	WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x04);
    368  1.1   chopps 
    369  1.1   chopps 	WSeq(ba, SEQ_ID_MCLK_SELECT, 0x22);
    370  1.1   chopps 
    371  1.1   chopps 	WCrt(ba, CRT_ID_PRESET_ROW_SCAN, 0x00);
    372  1.1   chopps 	WCrt(ba, CRT_ID_CURSOR_START, 0x00);
    373  1.1   chopps 	WCrt(ba, CRT_ID_CURSOR_END, 0x08);
    374  1.1   chopps 	WCrt(ba, CRT_ID_START_ADDR_HIGH, 0x00);
    375  1.1   chopps 	WCrt(ba, CRT_ID_START_ADDR_LOW, 0x00);
    376  1.1   chopps 	WCrt(ba, CRT_ID_CURSOR_LOC_HIGH, 0x00);
    377  1.1   chopps 	WCrt(ba, CRT_ID_CURSOR_LOC_LOW, 0x00);
    378  1.1   chopps 
    379  1.1   chopps 	WCrt(ba, CRT_ID_UNDERLINE_LOC, 0x07);
    380  1.5   chopps 	WCrt(ba, CRT_ID_MODE_CONTROL, 0xa3);	/* c3 */
    381  1.5   chopps 	WCrt(ba, CRT_ID_LINE_COMPARE, 0xff);	/* ff */
    382  1.1   chopps 	WCrt(ba, CRT_ID_EXT_DISP_CNTL, 0x22);
    383  1.5   chopps 	WSeq(ba, SEQ_ID_CURSOR_STORE, 0x3c);	/* mouse 0x00 */
    384  1.1   chopps 
    385  1.1   chopps 	WGfx(ba, GCT_ID_SET_RESET, 0x00);
    386  1.1   chopps 	WGfx(ba, GCT_ID_ENABLE_SET_RESET, 0x00);
    387  1.1   chopps 	WGfx(ba, GCT_ID_DATA_ROTATE, 0x00);
    388  1.1   chopps 	WGfx(ba, GCT_ID_READ_MAP_SELECT, 0x00);
    389  1.1   chopps 	WGfx(ba, GCT_ID_GRAPHICS_MODE, 0x00);
    390  1.1   chopps 	WGfx(ba, GCT_ID_MISC, 0x01);
    391  1.1   chopps 	WGfx(ba, GCT_ID_COLOR_XCARE, 0x0f);
    392  1.1   chopps 	WGfx(ba, GCT_ID_BITMASK, 0xff);
    393  1.1   chopps 	WGfx(ba, GCT_ID_MODE_EXT, 0x28);
    394  1.1   chopps 
    395  1.5   chopps 	for (x = 0; x < 0x10; x++)
    396  1.5   chopps 		WAttr(ba, x, x);
    397  1.1   chopps 	WAttr(ba, ACT_ID_ATTR_MODE_CNTL, 0x01);
    398  1.1   chopps 	WAttr(ba, ACT_ID_OVERSCAN_COLOR, 0x00);
    399  1.1   chopps 	WAttr(ba, ACT_ID_COLOR_PLANE_ENA, 0x0f);
    400  1.1   chopps 	WAttr(ba, ACT_ID_HOR_PEL_PANNING, 0x00);
    401  1.1   chopps 	WAttr(ba, ACT_ID_COLOR_SELECT, 0x00);
    402  1.1   chopps 
    403  1.1   chopps 	delay(200000);
    404  1.5   chopps 	WAttr(ba, 0x34, 0x00);
    405  1.1   chopps 	delay(200000);
    406  1.1   chopps 
    407  1.1   chopps 	vgaw(ba, VDAC_MASK, 0xff);
    408  1.1   chopps 	delay(200000);
    409  1.5   chopps 	vgaw(ba, GREG_MISC_OUTPUT_W, 0xe3);	/* c3 */
    410  1.1   chopps 
    411  1.1   chopps 	WGfx(ba, GCT_ID_BLT_STAT_START, 0x40);
    412  1.1   chopps 	WGfx(ba, GCT_ID_BLT_STAT_START, 0x00);
    413  1.1   chopps 
    414  1.1   chopps 	/* colors initially set to greyscale */
    415  1.1   chopps 
    416  1.1   chopps 	vgaw(ba, VDAC_ADDRESS_W, 0);
    417  1.5   chopps 	for (x = 255; x >= 0; x--) {
    418  1.1   chopps 		vgaw(ba, VDAC_DATA, x);
    419  1.1   chopps 		vgaw(ba, VDAC_DATA, x);
    420  1.1   chopps 		vgaw(ba, VDAC_DATA, x);
    421  1.1   chopps 	}
    422  1.5   chopps 	/* set sprite bitmap pointers */
    423  1.5   chopps 	cl_cursprite.image = cl_imageptr;
    424  1.5   chopps 	cl_cursprite.mask = cl_maskptr;
    425  1.5   chopps 	cl_cursprite.cmap.red = cl_sprred;
    426  1.5   chopps 	cl_cursprite.cmap.green = cl_sprgreen;
    427  1.5   chopps 	cl_cursprite.cmap.blue = cl_sprblue;
    428  1.1   chopps }
    429  1.1   chopps 
    430  1.1   chopps 
    431  1.1   chopps int
    432  1.1   chopps cl_getvmode(gp, vm)
    433  1.1   chopps 	struct grf_softc *gp;
    434  1.1   chopps 	struct grfvideo_mode *vm;
    435  1.1   chopps {
    436  1.1   chopps 	struct grfvideo_mode *gv;
    437  1.1   chopps 
    438  1.1   chopps #ifdef CL5426CONSOLE
    439  1.1   chopps 	/* Handle grabbing console mode */
    440  1.1   chopps 	if (vm->mode_num == 255) {
    441  1.1   chopps 		bcopy(&clconsole_mode, vm, sizeof(struct grfvideo_mode));
    442  1.5   chopps 		/* XXX so grfconfig can tell us the correct text dimensions. */
    443  1.1   chopps 		vm->depth = clconsole_mode.fy;
    444  1.5   chopps 	} else
    445  1.1   chopps #endif
    446  1.5   chopps         {
    447  1.5   chopps                 if (vm->mode_num == 0)
    448  1.5   chopps                         vm->mode_num = (monitor_current - monitor_def) + 1;
    449  1.5   chopps                 if (vm->mode_num < 1 || vm->mode_num > monitor_def_max)
    450  1.5   chopps                         return (EINVAL);
    451  1.5   chopps                 gv = monitor_def + (vm->mode_num - 1);
    452  1.5   chopps                 if (gv->mode_num == 0)
    453  1.5   chopps                         return (EINVAL);
    454  1.5   chopps 
    455  1.5   chopps                 bcopy(gv, vm, sizeof(struct grfvideo_mode));
    456  1.5   chopps         }
    457  1.5   chopps 
    458  1.5   chopps         /* adjust internal values to pixel values */
    459  1.5   chopps 
    460  1.5   chopps         vm->hblank_start *= 8;
    461  1.5   chopps         vm->hblank_stop *= 8;
    462  1.5   chopps         vm->hsync_start *= 8;
    463  1.5   chopps         vm->hsync_stop *= 8;
    464  1.5   chopps         vm->htotal *= 8;
    465  1.5   chopps 
    466  1.5   chopps 	return (0);
    467  1.1   chopps }
    468  1.1   chopps 
    469  1.1   chopps 
    470  1.1   chopps int
    471  1.1   chopps cl_setvmode(gp, mode)
    472  1.1   chopps 	struct grf_softc *gp;
    473  1.1   chopps 	unsigned mode;
    474  1.1   chopps {
    475  1.5   chopps 	if (!mode || (mode > monitor_def_max) ||
    476  1.5   chopps 	    monitor_def[mode - 1].mode_num == 0)
    477  1.5   chopps 		return (EINVAL);
    478  1.1   chopps 
    479  1.1   chopps 	monitor_current = monitor_def + (mode - 1);
    480  1.1   chopps 
    481  1.5   chopps 	return (0);
    482  1.1   chopps }
    483  1.1   chopps 
    484  1.1   chopps void
    485  1.1   chopps cl_off(gp)
    486  1.5   chopps 	struct grf_softc *gp;
    487  1.1   chopps {
    488  1.5   chopps 	char   *ba = gp->g_regkva;
    489  1.1   chopps 
    490  1.5   chopps 	/* we'll put the pass-through on for cc ite and set Full Bandwidth bit
    491  1.5   chopps 	 * on just in case it didn't work...but then it doesn't matter does
    492  1.5   chopps 	 * it? =) */
    493  1.1   chopps 	RegOnpass(ba);
    494  1.1   chopps 	WSeq(ba, SEQ_ID_CLOCKING_MODE, 0x21);
    495  1.1   chopps }
    496  1.1   chopps 
    497  1.5   chopps int
    498  1.5   chopps cl_blank(gp, on)
    499  1.5   chopps         struct grf_softc *gp;
    500  1.5   chopps         int *on;
    501  1.5   chopps {
    502  1.5   chopps         WSeq(gp->g_regkva, SEQ_ID_CLOCKING_MODE, *on ? 0x21 : 0x01);
    503  1.5   chopps         return(0);
    504  1.5   chopps }
    505  1.5   chopps 
    506  1.1   chopps /*
    507  1.1   chopps  * Change the mode of the display.
    508  1.1   chopps  * Return a UNIX error number or 0 for success.
    509  1.1   chopps  */
    510  1.1   chopps cl_mode(gp, cmd, arg, a2, a3)
    511  1.1   chopps 	register struct grf_softc *gp;
    512  1.5   chopps 	int     cmd;
    513  1.5   chopps 	void   *arg;
    514  1.5   chopps 	int     a2, a3;
    515  1.1   chopps {
    516  1.5   chopps 	int     error;
    517  1.1   chopps 
    518  1.1   chopps 	switch (cmd) {
    519  1.1   chopps 	case GM_GRFON:
    520  1.5   chopps 		error = cl_load_mon(gp,
    521  1.1   chopps 		    (struct grfcltext_mode *) monitor_current) ? 0 : EINVAL;
    522  1.5   chopps 		return (error);
    523  1.1   chopps 
    524  1.1   chopps 	case GM_GRFOFF:
    525  1.1   chopps #ifndef CL5426CONSOLE
    526  1.1   chopps 		cl_off(gp);
    527  1.1   chopps #else
    528  1.1   chopps 		cl_load_mon(gp, &clconsole_mode);
    529  1.1   chopps #endif
    530  1.5   chopps 		return (0);
    531  1.1   chopps 
    532  1.1   chopps 	case GM_GRFCONFIG:
    533  1.5   chopps 		return (0);
    534  1.1   chopps 
    535  1.1   chopps 	case GM_GRFGETVMODE:
    536  1.5   chopps 		return (cl_getvmode(gp, (struct grfvideo_mode *) arg));
    537  1.1   chopps 
    538  1.1   chopps 	case GM_GRFSETVMODE:
    539  1.5   chopps 		error = cl_setvmode(gp, *(unsigned *) arg);
    540  1.5   chopps 		if (!error && (gp->g_flags & GF_GRFON))
    541  1.5   chopps 			cl_load_mon(gp,
    542  1.1   chopps 			    (struct grfcltext_mode *) monitor_current);
    543  1.5   chopps 		return (error);
    544  1.1   chopps 
    545  1.1   chopps 	case GM_GRFGETNUMVM:
    546  1.5   chopps 		*(int *) arg = monitor_def_max;
    547  1.5   chopps 		return (0);
    548  1.1   chopps 
    549  1.1   chopps 	case GM_GRFIOCTL:
    550  1.5   chopps 		return (cl_ioctl(gp, (int) arg, (caddr_t) a2));
    551  1.1   chopps 
    552  1.1   chopps 	default:
    553  1.1   chopps 		break;
    554  1.1   chopps 	}
    555  1.1   chopps 
    556  1.5   chopps 	return (EINVAL);
    557  1.1   chopps }
    558  1.1   chopps 
    559  1.1   chopps int
    560  1.5   chopps cl_ioctl(gp, cmd, data)
    561  1.1   chopps 	register struct grf_softc *gp;
    562  1.5   chopps 	int     cmd;
    563  1.5   chopps 	void   *data;
    564  1.1   chopps {
    565  1.1   chopps 	switch (cmd) {
    566  1.1   chopps 	case GRFIOCGSPRITEPOS:
    567  1.5   chopps 		return (cl_getmousepos(gp, (struct grf_position *) data));
    568  1.5   chopps 
    569  1.1   chopps 	case GRFIOCSSPRITEPOS:
    570  1.5   chopps 		return (cl_setmousepos(gp, (struct grf_position *) data));
    571  1.5   chopps 
    572  1.1   chopps 	case GRFIOCSSPRITEINF:
    573  1.5   chopps 		return (cl_setspriteinfo(gp, (struct grf_spriteinfo *) data));
    574  1.5   chopps 
    575  1.1   chopps 	case GRFIOCGSPRITEINF:
    576  1.5   chopps 		return (cl_getspriteinfo(gp, (struct grf_spriteinfo *) data));
    577  1.5   chopps 
    578  1.1   chopps 	case GRFIOCGSPRITEMAX:
    579  1.5   chopps 		return (cl_getspritemax(gp, (struct grf_position *) data));
    580  1.1   chopps 
    581  1.1   chopps 	case GRFIOCGETCMAP:
    582  1.5   chopps 		return (cl_getcmap(gp, (struct grf_colormap *) data));
    583  1.1   chopps 
    584  1.1   chopps 	case GRFIOCPUTCMAP:
    585  1.5   chopps 		return (cl_putcmap(gp, (struct grf_colormap *) data));
    586  1.1   chopps 
    587  1.1   chopps 	case GRFIOCBITBLT:
    588  1.1   chopps 		break;
    589  1.1   chopps 
    590  1.1   chopps 	case GRFTOGGLE:
    591  1.5   chopps 		return (cl_toggle(gp, 0));
    592  1.1   chopps 
    593  1.1   chopps 	case GRFIOCSETMON:
    594  1.5   chopps 		return (cl_setmonitor(gp, (struct grfvideo_mode *) data));
    595  1.5   chopps 
    596  1.5   chopps         case GRFIOCBLANK:
    597  1.5   chopps                 return (cl_blank(gp, (int *)data));
    598  1.5   chopps 
    599  1.5   chopps 	}
    600  1.5   chopps 	return (EINVAL);
    601  1.5   chopps }
    602  1.5   chopps 
    603  1.5   chopps int
    604  1.5   chopps cl_getmousepos(gp, data)
    605  1.5   chopps 	struct grf_softc *gp;
    606  1.5   chopps 	struct grf_position *data;
    607  1.5   chopps {
    608  1.5   chopps 	data->x = cl_cursprite.pos.x;
    609  1.5   chopps 	data->y = cl_cursprite.pos.y;
    610  1.5   chopps 	return (0);
    611  1.5   chopps }
    612  1.5   chopps 
    613  1.5   chopps void
    614  1.5   chopps cl_writesprpos(ba, x, y)
    615  1.5   chopps 	volatile char *ba;
    616  1.5   chopps 	short   x;
    617  1.5   chopps 	short   y;
    618  1.5   chopps {
    619  1.5   chopps 	/* we want to use a 16-bit write to 3c4 so no macros used */
    620  1.5   chopps 	volatile unsigned char *cwp;
    621  1.5   chopps         volatile unsigned short *wp;
    622  1.5   chopps 
    623  1.5   chopps 	cwp = ba + 0x3c4;
    624  1.5   chopps         wp = (unsigned short *)cwp;
    625  1.5   chopps 
    626  1.5   chopps 	/* don't ask me why, but apparently you can't do a 16-bit write with
    627  1.5   chopps 	 * x-position like with y-position below (dagge) */
    628  1.5   chopps         cwp[0] = 0x10 | ((x << 5) & 0xff);
    629  1.5   chopps         cwp[1] = (x >> 3) & 0xff;
    630  1.5   chopps 
    631  1.5   chopps         *wp = 0x1100 | ((y & 7) << 13) | ((y >> 3) & 0xff);
    632  1.5   chopps 
    633  1.5   chopps }
    634  1.5   chopps 
    635  1.5   chopps void
    636  1.5   chopps writeshifted(to, shiftx, shifty)
    637  1.5   chopps 	unsigned char *to;
    638  1.5   chopps 	char    shiftx;
    639  1.5   chopps 	char    shifty;
    640  1.5   chopps {
    641  1.5   chopps 	register char y;
    642  1.5   chopps 	unsigned long long *tptr, *iptr, *mptr, line;
    643  1.5   chopps 
    644  1.5   chopps 	tptr = (unsigned long long *) to;
    645  1.5   chopps         iptr = (unsigned long long *) cl_cursprite.image;
    646  1.5   chopps         mptr = (unsigned long long *) cl_cursprite.mask;
    647  1.5   chopps 
    648  1.5   chopps         shiftx = shiftx < 0 ? 0 : shiftx;
    649  1.5   chopps         shifty = shifty < 0 ? 0 : shifty;
    650  1.5   chopps 
    651  1.5   chopps         /* start reading shifty lines down, and
    652  1.5   chopps          * shift each line in by shiftx
    653  1.5   chopps          */
    654  1.5   chopps         for (y = shifty; y < 64; y++) {
    655  1.5   chopps 
    656  1.5   chopps                 /* image */
    657  1.5   chopps                 line = iptr[y];
    658  1.5   chopps 		*tptr++ = line << shiftx;
    659  1.5   chopps 
    660  1.5   chopps                 /* mask */
    661  1.5   chopps                 line = mptr[y];
    662  1.5   chopps 		*tptr++ = line << shiftx;
    663  1.5   chopps 	}
    664  1.5   chopps 
    665  1.5   chopps         /* clear the remainder */
    666  1.5   chopps         for (y = shifty; y > 0; y--) {
    667  1.5   chopps                 *tptr++ = 0;
    668  1.5   chopps                 *tptr++ = 0;
    669  1.5   chopps         }
    670  1.5   chopps }
    671  1.5   chopps 
    672  1.5   chopps int
    673  1.5   chopps cl_setmousepos(gp, data)
    674  1.5   chopps 	struct grf_softc *gp;
    675  1.5   chopps 	struct grf_position *data;
    676  1.5   chopps {
    677  1.5   chopps 	volatile char *ba = gp->g_regkva;
    678  1.5   chopps 	volatile char *fb = gp->g_fbkva;
    679  1.5   chopps         volatile char *sprite = fb + (cl_fbsize - 1024);
    680  1.5   chopps         short rx, ry, prx, pry;
    681  1.5   chopps 
    682  1.5   chopps         /* no movement */
    683  1.5   chopps 	if (cl_cursprite.pos.x == data->x && cl_cursprite.pos.y == data->y)
    684  1.5   chopps 		return (0);
    685  1.5   chopps 
    686  1.5   chopps         /* current and previous real coordinates */
    687  1.5   chopps 	rx = data->x - cl_cursprite.hot.x;
    688  1.5   chopps 	ry = data->y - cl_cursprite.hot.y;
    689  1.5   chopps 	prx = cl_cursprite.pos.x - cl_cursprite.hot.x;
    690  1.5   chopps 	pry = cl_cursprite.pos.y - cl_cursprite.hot.y;
    691  1.5   chopps 
    692  1.5   chopps         /* if we are/were on an edge, create (un)shifted bitmap --
    693  1.5   chopps          * ripped out optimization (not extremely worthwhile,
    694  1.5   chopps          * and kind of buggy anyhow).
    695  1.5   chopps          */
    696  1.5   chopps #ifdef CL_SHIFTSPRITE
    697  1.5   chopps         if (rx < 0 || ry < 0 || prx < 0 || pry < 0) {
    698  1.5   chopps                 writeshifted(sprite, rx < 0 ? -rx : 0, ry < 0 ? -ry : 0);
    699  1.5   chopps         }
    700  1.5   chopps #endif
    701  1.5   chopps 
    702  1.5   chopps         /* do movement, save position */
    703  1.5   chopps         cl_writesprpos(ba, rx < 0 ? 0 : rx, ry < 0 ? 0 : ry);
    704  1.5   chopps 	cl_cursprite.pos.x = data->x;
    705  1.5   chopps 	cl_cursprite.pos.y = data->y;
    706  1.5   chopps 
    707  1.5   chopps 	return (0);
    708  1.5   chopps }
    709  1.5   chopps 
    710  1.5   chopps int
    711  1.5   chopps cl_getspriteinfo(gp, data)
    712  1.5   chopps 	struct grf_softc *gp;
    713  1.5   chopps 	struct grf_spriteinfo *data;
    714  1.5   chopps {
    715  1.5   chopps 	copyout(&cl_cursprite, data, sizeof(struct grf_spriteinfo));
    716  1.5   chopps 	copyout(cl_cursprite.image, data->image, 64 * 8);
    717  1.5   chopps 	copyout(cl_cursprite.mask, data->mask, 64 * 8);
    718  1.5   chopps 	return (0);
    719  1.5   chopps }
    720  1.5   chopps 
    721  1.5   chopps static
    722  1.5   chopps int
    723  1.5   chopps cl_setspriteinfo(gp, data)
    724  1.5   chopps 	struct grf_softc *gp;
    725  1.5   chopps 	struct grf_spriteinfo *data;
    726  1.5   chopps {
    727  1.5   chopps 	volatile unsigned char *ba = gp->g_regkva, *fb = gp->g_fbkva;
    728  1.5   chopps         volatile char *sprite = fb + (cl_fbsize - 1024);
    729  1.5   chopps 
    730  1.5   chopps 	if (data->set & GRFSPRSET_SHAPE) {
    731  1.5   chopps 
    732  1.5   chopps                 short dsx, dsy, i;
    733  1.5   chopps                 unsigned long *di, *dm, *si, *sm;
    734  1.5   chopps                 unsigned long ssi[128], ssm[128];
    735  1.5   chopps                 struct grf_position gpos;
    736  1.5   chopps 
    737  1.5   chopps 
    738  1.5   chopps                 /* check for a too large sprite (no clipping!) */
    739  1.5   chopps                 dsy = data->size.y;
    740  1.5   chopps                 dsx = data->size.x;
    741  1.5   chopps                 if (dsy > 64 || dsx > 64)
    742  1.5   chopps                         return(EINVAL);
    743  1.5   chopps 
    744  1.5   chopps                 /* prepare destination */
    745  1.5   chopps                 di = (unsigned long *)cl_cursprite.image;
    746  1.5   chopps                 dm = (unsigned long *)cl_cursprite.mask;
    747  1.5   chopps                 cl_memset((unsigned char *)di, 0, 8*64);
    748  1.5   chopps                 cl_memset((unsigned char *)dm, 0, 8*64);
    749  1.5   chopps 
    750  1.5   chopps                 /* two alternatives:  64 across, then it's
    751  1.5   chopps                  * the same format we use, just copy.  Otherwise,
    752  1.5   chopps                  * copy into tmp buf and recopy skipping the
    753  1.5   chopps                  * unused 32 bits.
    754  1.5   chopps                  */
    755  1.5   chopps                 if ((dsx - 1) / 32) {
    756  1.5   chopps                         copyin(data->image, di, 8 * dsy);
    757  1.5   chopps                         copyin(data->mask, dm, 8 * dsy);
    758  1.5   chopps                 } else {
    759  1.5   chopps                         si = ssi; sm = ssm;
    760  1.5   chopps                         copyin(data->image, si, 4 * dsy);
    761  1.5   chopps                         copyin(data->mask, sm, 4 * dsy);
    762  1.5   chopps                         for (i = 0; i < dsy; i++) {
    763  1.5   chopps                                 *di = *si++;
    764  1.5   chopps                                 *dm = *sm++;
    765  1.5   chopps                                 di += 2;
    766  1.5   chopps                                 dm += 2;
    767  1.5   chopps                         }
    768  1.5   chopps                 }
    769  1.5   chopps 
    770  1.5   chopps                 /* set size */
    771  1.5   chopps 		cl_cursprite.size.x = data->size.x;
    772  1.5   chopps 		cl_cursprite.size.y = data->size.y;
    773  1.5   chopps 
    774  1.5   chopps                 /* forcably load into board */
    775  1.5   chopps                 gpos.x = cl_cursprite.pos.x;
    776  1.5   chopps                 gpos.y = cl_cursprite.pos.y;
    777  1.5   chopps                 cl_cursprite.pos.x = -1;
    778  1.5   chopps                 cl_cursprite.pos.y = -1;
    779  1.5   chopps                 writeshifted(sprite, 0, 0);
    780  1.5   chopps                 cl_setmousepos(gp, &gpos);
    781  1.5   chopps 
    782  1.5   chopps 	}
    783  1.5   chopps 	if (data->set & GRFSPRSET_HOT) {
    784  1.5   chopps 
    785  1.5   chopps 		cl_cursprite.hot = data->hot;
    786  1.5   chopps 
    787  1.5   chopps 	}
    788  1.5   chopps 	if (data->set & GRFSPRSET_CMAP) {
    789  1.5   chopps 
    790  1.5   chopps 		u_char  red[2], green[2], blue[2];
    791  1.5   chopps 
    792  1.5   chopps 		copyin(data->cmap.red, red, 2);
    793  1.5   chopps 		copyin(data->cmap.green, green, 2);
    794  1.5   chopps 		copyin(data->cmap.blue, blue, 2);
    795  1.5   chopps 		bcopy(red, cl_cursprite.cmap.red, 2);
    796  1.5   chopps 		bcopy(green, cl_cursprite.cmap.green, 2);
    797  1.5   chopps 		bcopy(blue, cl_cursprite.cmap.blue, 2);
    798  1.5   chopps 
    799  1.5   chopps                 /* enable and load colors 256 & 257 */
    800  1.5   chopps 		WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x06);
    801  1.5   chopps 
    802  1.5   chopps                 /* 256 */
    803  1.5   chopps 		vgaw(ba, VDAC_ADDRESS_W, 0x00);
    804  1.5   chopps 		if (cltype == PICASSO) {
    805  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (red[0] >> 2));
    806  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (green[0] >> 2));
    807  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (blue[0] >> 2));
    808  1.5   chopps 		} else {
    809  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (blue[0] >> 2));
    810  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (green[0] >> 2));
    811  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (red[0] >> 2));
    812  1.5   chopps 		}
    813  1.5   chopps 
    814  1.5   chopps                 /* 257 */
    815  1.5   chopps 		vgaw(ba, VDAC_ADDRESS_W, 0x0f);
    816  1.5   chopps 		if (cltype == PICASSO) {
    817  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (red[1] >> 2));
    818  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (green[1] >> 2));
    819  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (blue[1] >> 2));
    820  1.5   chopps 		} else {
    821  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (blue[1] >> 2));
    822  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (green[1] >> 2));
    823  1.5   chopps 			vgaw(ba, VDAC_DATA, (u_char) (red[1] >> 2));
    824  1.5   chopps 		}
    825  1.5   chopps 
    826  1.5   chopps                 /* turn on/off sprite */
    827  1.5   chopps 		if (cl_cursprite.enable) {
    828  1.5   chopps 			WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x05);
    829  1.5   chopps 		} else {
    830  1.5   chopps 			WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x04);
    831  1.5   chopps 		}
    832  1.5   chopps 
    833  1.5   chopps 	}
    834  1.5   chopps 	if (data->set & GRFSPRSET_ENABLE) {
    835  1.5   chopps 
    836  1.5   chopps 		if (data->enable == 1) {
    837  1.5   chopps 			WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x05);
    838  1.5   chopps 			cl_cursprite.enable = 1;
    839  1.5   chopps 		} else {
    840  1.5   chopps 			WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x04);
    841  1.5   chopps 			cl_cursprite.enable = 0;
    842  1.5   chopps 		}
    843  1.5   chopps 
    844  1.5   chopps 	}
    845  1.5   chopps 	if (data->set & GRFSPRSET_POS) {
    846  1.5   chopps 
    847  1.5   chopps                 /* force placement */
    848  1.5   chopps                 cl_cursprite.pos.x = -1;
    849  1.5   chopps                 cl_cursprite.pos.y = -1;
    850  1.1   chopps 
    851  1.5   chopps                 /* do it */
    852  1.5   chopps                 cl_setmousepos(gp, &data->pos);
    853  1.5   chopps 
    854  1.1   chopps 	}
    855  1.5   chopps 	return (0);
    856  1.5   chopps }
    857  1.5   chopps 
    858  1.5   chopps static
    859  1.5   chopps int
    860  1.5   chopps cl_getspritemax(gp, data)
    861  1.5   chopps 	struct grf_softc *gp;
    862  1.5   chopps 	struct grf_position *data;
    863  1.5   chopps {
    864  1.5   chopps 	if (gp->g_display.gd_planes == 24)
    865  1.5   chopps 		return (EINVAL);
    866  1.5   chopps 	data->x = 64;
    867  1.5   chopps 	data->y = 64;
    868  1.5   chopps 	return (0);
    869  1.1   chopps }
    870  1.1   chopps 
    871  1.1   chopps int
    872  1.1   chopps cl_setmonitor(gp, gv)
    873  1.1   chopps 	struct grf_softc *gp;
    874  1.1   chopps 	struct grfvideo_mode *gv;
    875  1.1   chopps {
    876  1.5   chopps 	struct grfvideo_mode *md;
    877  1.5   chopps 
    878  1.5   chopps         if (!cl_mondefok(gv))
    879  1.5   chopps                 return(EINVAL);
    880  1.1   chopps 
    881  1.1   chopps #ifdef CL5426CONSOLE
    882  1.1   chopps 	/* handle interactive setting of console mode */
    883  1.5   chopps 	if (gv->mode_num == 255) {
    884  1.1   chopps 		bcopy(gv, &clconsole_mode.gv, sizeof(struct grfvideo_mode));
    885  1.5   chopps                 clconsole_mode.gv.hblank_start /= 8;
    886  1.5   chopps                 clconsole_mode.gv.hblank_stop /= 8;
    887  1.5   chopps                 clconsole_mode.gv.hsync_start /= 8;
    888  1.5   chopps                 clconsole_mode.gv.hsync_stop /= 8;
    889  1.5   chopps                 clconsole_mode.gv.htotal /= 8;
    890  1.1   chopps 		clconsole_mode.rows = gv->disp_height / clconsole_mode.fy;
    891  1.1   chopps 		clconsole_mode.cols = gv->disp_width / clconsole_mode.fx;
    892  1.1   chopps 		if (!(gp->g_flags & GF_GRFON))
    893  1.5   chopps 			cl_load_mon(gp, &clconsole_mode);
    894  1.1   chopps 		ite_reinit(gp->g_itedev);
    895  1.5   chopps 		return (0);
    896  1.1   chopps 	}
    897  1.1   chopps #endif
    898  1.1   chopps 
    899  1.5   chopps 	md = monitor_def + (gv->mode_num - 1);
    900  1.5   chopps 	bcopy(gv, md, sizeof(struct grfvideo_mode));
    901  1.5   chopps 
    902  1.5   chopps         /* adjust pixel oriented values to internal rep. */
    903  1.1   chopps 
    904  1.5   chopps         md->hblank_start /= 8;
    905  1.5   chopps         md->hblank_stop /= 8;
    906  1.5   chopps         md->hsync_start /= 8;
    907  1.5   chopps         md->hsync_stop /= 8;
    908  1.5   chopps         md->htotal /= 8;
    909  1.1   chopps 
    910  1.5   chopps 	return (0);
    911  1.1   chopps }
    912  1.1   chopps 
    913  1.1   chopps int
    914  1.5   chopps cl_getcmap(gfp, cmap)
    915  1.1   chopps 	struct grf_softc *gfp;
    916  1.1   chopps 	struct grf_colormap *cmap;
    917  1.1   chopps {
    918  1.1   chopps 	volatile unsigned char *ba;
    919  1.5   chopps 	u_char  red[256], green[256], blue[256], *rp, *gp, *bp;
    920  1.5   chopps 	short   x;
    921  1.5   chopps 	int     error;
    922  1.1   chopps 
    923  1.1   chopps 	if (cmap->count == 0 || cmap->index >= 256)
    924  1.1   chopps 		return 0;
    925  1.1   chopps 
    926  1.1   chopps 	if (cmap->index + cmap->count > 256)
    927  1.1   chopps 		cmap->count = 256 - cmap->index;
    928  1.1   chopps 
    929  1.1   chopps 	ba = gfp->g_regkva;
    930  1.1   chopps 	/* first read colors out of the chip, then copyout to userspace */
    931  1.6       is 	vgaw(ba, VDAC_ADDRESS_R, cmap->index);
    932  1.1   chopps 	x = cmap->count - 1;
    933  1.1   chopps 
    934  1.1   chopps /* Some sort 'o Magic. Spectrum has some changes on the board to speed
    935  1.1   chopps  * up 15 and 16Bit modes. They can access these modes with easy-to-programm
    936  1.1   chopps  * rgbrgbrgb instead of rrrgggbbb. Side effect: when in 8Bit mode, rgb
    937  1.1   chopps  * is swapped to bgr. I wonder if we need to check for 8Bit though, ill
    938  1.1   chopps  */
    939  1.1   chopps 
    940  1.5   chopps 	switch (cltype) {
    941  1.5   chopps 	case SPECTRUM:
    942  1.1   chopps 	case PICCOLO:
    943  1.5   chopps 		rp = blue + cmap->index;
    944  1.1   chopps 		gp = green + cmap->index;
    945  1.1   chopps 		bp = red + cmap->index;
    946  1.1   chopps 		break;
    947  1.1   chopps 	case PICASSO:
    948  1.5   chopps 		rp = red + cmap->index;
    949  1.1   chopps 		gp = green + cmap->index;
    950  1.1   chopps 		bp = blue + cmap->index;
    951  1.1   chopps 		break;
    952  1.1   chopps 	}
    953  1.1   chopps 
    954  1.1   chopps 	do {
    955  1.5   chopps 		*rp++ = vgar(ba, VDAC_DATA) << 2;
    956  1.5   chopps 		*gp++ = vgar(ba, VDAC_DATA) << 2;
    957  1.5   chopps 		*bp++ = vgar(ba, VDAC_DATA) << 2;
    958  1.1   chopps 	} while (x-- > 0);
    959  1.1   chopps 
    960  1.5   chopps 	if (!(error = copyout(red + cmap->index, cmap->red, cmap->count))
    961  1.5   chopps 	    && !(error = copyout(green + cmap->index, cmap->green, cmap->count))
    962  1.5   chopps 	    && !(error = copyout(blue + cmap->index, cmap->blue, cmap->count)))
    963  1.5   chopps 		return (0);
    964  1.1   chopps 
    965  1.5   chopps 	return (error);
    966  1.1   chopps }
    967  1.1   chopps 
    968  1.1   chopps int
    969  1.5   chopps cl_putcmap(gfp, cmap)
    970  1.1   chopps 	struct grf_softc *gfp;
    971  1.1   chopps 	struct grf_colormap *cmap;
    972  1.1   chopps {
    973  1.1   chopps 	volatile unsigned char *ba;
    974  1.5   chopps 	u_char  red[256], green[256], blue[256], *rp, *gp, *bp;
    975  1.5   chopps 	short   x;
    976  1.5   chopps 	int     error;
    977  1.1   chopps 
    978  1.1   chopps 	if (cmap->count == 0 || cmap->index >= 256)
    979  1.5   chopps 		return (0);
    980  1.1   chopps 
    981  1.1   chopps 	if (cmap->index + cmap->count > 256)
    982  1.1   chopps 		cmap->count = 256 - cmap->index;
    983  1.1   chopps 
    984  1.1   chopps 	/* first copy the colors into kernelspace */
    985  1.5   chopps 	if (!(error = copyin(cmap->red, red + cmap->index, cmap->count))
    986  1.5   chopps 	    && !(error = copyin(cmap->green, green + cmap->index, cmap->count))
    987  1.5   chopps 	    && !(error = copyin(cmap->blue, blue + cmap->index, cmap->count))) {
    988  1.1   chopps 		ba = gfp->g_regkva;
    989  1.5   chopps 		vgaw(ba, VDAC_ADDRESS_W, cmap->index);
    990  1.1   chopps 		x = cmap->count - 1;
    991  1.1   chopps 
    992  1.5   chopps 		switch (cltype) {
    993  1.5   chopps 		case SPECTRUM:
    994  1.1   chopps 		case PICCOLO:
    995  1.1   chopps 			rp = blue + cmap->index;
    996  1.1   chopps 			gp = green + cmap->index;
    997  1.1   chopps 			bp = red + cmap->index;
    998  1.1   chopps 			break;
    999  1.1   chopps 		case PICASSO:
   1000  1.1   chopps 			rp = red + cmap->index;
   1001  1.1   chopps 			gp = green + cmap->index;
   1002  1.1   chopps 			bp = blue + cmap->index;
   1003  1.1   chopps 			break;
   1004  1.5   chopps 		}
   1005  1.1   chopps 
   1006  1.1   chopps 		do {
   1007  1.5   chopps 			vgaw(ba, VDAC_DATA, *rp++ >> 2);
   1008  1.5   chopps 			vgaw(ba, VDAC_DATA, *gp++ >> 2);
   1009  1.5   chopps 			vgaw(ba, VDAC_DATA, *bp++ >> 2);
   1010  1.1   chopps 		} while (x-- > 0);
   1011  1.5   chopps 		return (0);
   1012  1.5   chopps 	} else
   1013  1.5   chopps 		return (error);
   1014  1.1   chopps }
   1015  1.1   chopps 
   1016  1.1   chopps 
   1017  1.1   chopps int
   1018  1.5   chopps cl_toggle(gp, wopp)
   1019  1.1   chopps 	struct grf_softc *gp;
   1020  1.5   chopps 	unsigned short wopp;	/* don't need that one yet, ill */
   1021  1.1   chopps {
   1022  1.1   chopps 	volatile unsigned char *ba;
   1023  1.1   chopps 
   1024  1.1   chopps 	ba = gp->g_regkva;
   1025  1.1   chopps 
   1026  1.1   chopps 	if (pass_toggle) {
   1027  1.1   chopps 		RegOffpass(ba);
   1028  1.1   chopps 	} else {
   1029  1.1   chopps 		/* This was in the original.. is it needed? */
   1030  1.1   chopps 		if (cltype == PICASSO || cltype == PICCOLO)
   1031  1.1   chopps 			RegWakeup(ba);
   1032  1.1   chopps 		RegOnpass(ba);
   1033  1.1   chopps 	}
   1034  1.5   chopps 	return (0);
   1035  1.1   chopps }
   1036  1.1   chopps 
   1037  1.1   chopps static void
   1038  1.5   chopps CompFQ(fq, num, denom)
   1039  1.5   chopps 	u_int   fq;
   1040  1.5   chopps 	u_char *num;
   1041  1.5   chopps 	u_char *denom;
   1042  1.1   chopps {
   1043  1.1   chopps #define OSC     14318180
   1044  1.1   chopps /* OK, here's what we're doing here:
   1045  1.5   chopps  *
   1046  1.1   chopps  *             OSC * NUMERATOR
   1047  1.1   chopps  *      VCLK = -------------------  Hz
   1048  1.1   chopps  *             DENOMINATOR * (1+P)
   1049  1.1   chopps  *
   1050  1.1   chopps  * so we're given VCLK and we should give out some useful
   1051  1.1   chopps  * values....
   1052  1.1   chopps  *
   1053  1.5   chopps  * NUMERATOR is 7 bits wide
   1054  1.1   chopps  * DENOMINATOR is 5 bits wide with bit P in the same char as bit 0.
   1055  1.1   chopps  *
   1056  1.1   chopps  * We run through all the possible combinations and
   1057  1.1   chopps  * return the values which deviate the least from the chosen frequency.
   1058  1.5   chopps  *
   1059  1.1   chopps  */
   1060  1.1   chopps #define OSC     14318180
   1061  1.1   chopps #define count(n,d,p)    ((OSC * n)/(d * (1+p)))
   1062  1.1   chopps 
   1063  1.1   chopps 	unsigned char n, d, p, minn, mind, minp;
   1064  1.1   chopps 	unsigned long err, minerr;
   1065  1.1   chopps 
   1066  1.1   chopps /*
   1067  1.5   chopps numer = 0x00 - 0x7f
   1068  1.1   chopps denom = 0x00 - 0x1f (1) 0x20 - 0x3e (even)
   1069  1.1   chopps */
   1070  1.1   chopps 
   1071  1.5   chopps 	/* find lowest error in 6144 iterations. */
   1072  1.1   chopps 	minerr = fq;
   1073  1.1   chopps 	minn = 0;
   1074  1.1   chopps 	mind = 0;
   1075  1.1   chopps 	p = 0;
   1076  1.1   chopps 
   1077  1.5   chopps 	for (d = 1; d < 0x20; d++) {
   1078  1.5   chopps 		for (n = 1; n < 0x80; n++) {
   1079  1.1   chopps 			err = abs(count(n, d, p) - fq);
   1080  1.1   chopps 			if (err < minerr) {
   1081  1.1   chopps 				minerr = err;
   1082  1.1   chopps 				minn = n;
   1083  1.1   chopps 				mind = d;
   1084  1.1   chopps 				minp = p;
   1085  1.1   chopps 			}
   1086  1.1   chopps 		}
   1087  1.1   chopps 		if (d == 0x1f && p == 0) {
   1088  1.1   chopps 			p = 1;
   1089  1.1   chopps 			d = 0x0f;
   1090  1.1   chopps 		}
   1091  1.1   chopps 	}
   1092  1.1   chopps 
   1093  1.1   chopps 	*num = minn;
   1094  1.1   chopps 	*denom = (mind << 1) | minp;
   1095  1.1   chopps 	if (minerr > 500000)
   1096  1.5   chopps 		printf("Warning: CompFQ minimum error = %d\n", minerr);
   1097  1.1   chopps 	return;
   1098  1.1   chopps }
   1099  1.1   chopps 
   1100  1.1   chopps int
   1101  1.5   chopps cl_mondefok(gv)
   1102  1.5   chopps 	struct grfvideo_mode *gv;
   1103  1.1   chopps {
   1104  1.5   chopps         unsigned long maxpix;
   1105  1.5   chopps 
   1106  1.5   chopps 	if (gv->mode_num < 1 || gv->mode_num > monitor_def_max)
   1107  1.5   chopps                 if (gv->mode_num != 255 || gv->depth != 4)
   1108  1.5   chopps                         return(0);
   1109  1.1   chopps 
   1110  1.5   chopps 	switch (gv->depth) {
   1111  1.5   chopps 	case 4:
   1112  1.5   chopps                 if (gv->mode_num != 255)
   1113  1.5   chopps                         return(0);
   1114  1.1   chopps 	case 1:
   1115  1.1   chopps 	case 8:
   1116  1.5   chopps                 maxpix = cl_maxpixelclock;
   1117  1.5   chopps                 break;
   1118  1.1   chopps 	case 15:
   1119  1.1   chopps 	case 16:
   1120  1.5   chopps                 maxpix = cl_maxpixelclock - (cl_maxpixelclock / 3);
   1121  1.5   chopps                 break;
   1122  1.1   chopps 	case 24:
   1123  1.5   chopps                 maxpix = cl_maxpixelclock / 3;
   1124  1.5   chopps                 break;
   1125  1.1   chopps 	default:
   1126  1.5   chopps 		return (0);
   1127  1.1   chopps 	}
   1128  1.5   chopps         if (gv->pixel_clock > maxpix)
   1129  1.5   chopps                 return (0);
   1130  1.5   chopps         return (1);
   1131  1.1   chopps }
   1132  1.1   chopps 
   1133  1.1   chopps int
   1134  1.1   chopps cl_load_mon(gp, md)
   1135  1.1   chopps 	struct grf_softc *gp;
   1136  1.1   chopps 	struct grfcltext_mode *md;
   1137  1.1   chopps {
   1138  1.1   chopps 	struct grfvideo_mode *gv;
   1139  1.1   chopps 	struct grfinfo *gi;
   1140  1.1   chopps 	volatile unsigned char *ba;
   1141  1.1   chopps 	volatile unsigned char *fb;
   1142  1.5   chopps 	unsigned char num0, denom0;
   1143  1.5   chopps 	unsigned short HT, HDE, HBS, HBE, HSS, HSE, VDE, VBS, VBE, VSS,
   1144  1.5   chopps 	        VSE, VT;
   1145  1.5   chopps 	char    LACE, DBLSCAN, TEXT;
   1146  1.1   chopps 	unsigned short clkdiv, clksel;
   1147  1.5   chopps 	int     uplim, lowlim;
   1148  1.1   chopps 
   1149  1.1   chopps 	/* identity */
   1150  1.1   chopps 	gv = &md->gv;
   1151  1.1   chopps 	TEXT = (gv->depth == 4);
   1152  1.1   chopps 
   1153  1.1   chopps 	if (!cl_mondefok(gv)) {
   1154  1.1   chopps 		printf("mondef not ok\n");
   1155  1.5   chopps 		return (0);
   1156  1.1   chopps 	}
   1157  1.1   chopps 	ba = gp->g_regkva;
   1158  1.1   chopps 	fb = gp->g_fbkva;
   1159  1.1   chopps 
   1160  1.5   chopps 	/* provide all needed information in grf device-independant locations */
   1161  1.5   chopps 	gp->g_data = (caddr_t) gv;
   1162  1.1   chopps 	gi = &gp->g_display;
   1163  1.5   chopps 	gi->gd_regaddr = (caddr_t) ztwopa(ba);
   1164  1.5   chopps 	gi->gd_regsize = 64 * 1024;
   1165  1.5   chopps 	gi->gd_fbaddr = (caddr_t) kvtop(fb);
   1166  1.5   chopps 	gi->gd_fbsize = cl_fbsize;
   1167  1.5   chopps 	gi->gd_colors = 1 << gv->depth;
   1168  1.5   chopps 	gi->gd_planes = gv->depth;
   1169  1.5   chopps 	gi->gd_fbwidth = gv->disp_width;
   1170  1.5   chopps 	gi->gd_fbheight = gv->disp_height;
   1171  1.5   chopps 	gi->gd_fbx = 0;
   1172  1.5   chopps 	gi->gd_fby = 0;
   1173  1.1   chopps 	if (TEXT) {
   1174  1.5   chopps 		gi->gd_dwidth = md->fx * md->cols;
   1175  1.5   chopps 		gi->gd_dheight = md->fy * md->rows;
   1176  1.1   chopps 	} else {
   1177  1.5   chopps 		gi->gd_dwidth = gv->disp_width;
   1178  1.5   chopps 		gi->gd_dheight = gv->disp_height;
   1179  1.1   chopps 	}
   1180  1.5   chopps 	gi->gd_dx = 0;
   1181  1.5   chopps 	gi->gd_dy = 0;
   1182  1.1   chopps 
   1183  1.1   chopps 	/* get display mode parameters */
   1184  1.1   chopps 
   1185  1.1   chopps 	HBS = gv->hblank_start;
   1186  1.1   chopps 	HBE = gv->hblank_stop;
   1187  1.1   chopps 	HSS = gv->hsync_start;
   1188  1.1   chopps 	HSE = gv->hsync_stop;
   1189  1.5   chopps 	HT = gv->htotal;
   1190  1.1   chopps 	VBS = gv->vblank_start;
   1191  1.1   chopps 	VSS = gv->vsync_start;
   1192  1.1   chopps 	VSE = gv->vsync_stop;
   1193  1.1   chopps 	VBE = gv->vblank_stop;
   1194  1.5   chopps 	VT = gv->vtotal;
   1195  1.1   chopps 
   1196  1.5   chopps 	if (TEXT)
   1197  1.5   chopps 		HDE = ((gv->disp_width + md->fx - 1) / md->fx) - 1;
   1198  1.1   chopps 	else
   1199  1.5   chopps 		HDE = (gv->disp_width + 3) / 8 - 1;	/* HBS; */
   1200  1.5   chopps 	VDE = gv->disp_height - 1;
   1201  1.1   chopps 
   1202  1.1   chopps 	/* figure out whether lace or dblscan is needed */
   1203  1.1   chopps 
   1204  1.1   chopps 	uplim = gv->disp_height + (gv->disp_height / 4);
   1205  1.5   chopps 	lowlim = gv->disp_height - (gv->disp_height / 4);
   1206  1.5   chopps 	LACE = (((VT * 2) > lowlim) && ((VT * 2) < uplim)) ? 1 : 0;
   1207  1.5   chopps 	DBLSCAN = (((VT / 2) > lowlim) && ((VT / 2) < uplim)) ? 1 : 0;
   1208  1.1   chopps 
   1209  1.1   chopps 	/* adjustments */
   1210  1.1   chopps 
   1211  1.1   chopps 	if (LACE)
   1212  1.1   chopps 		VDE /= 2;
   1213  1.1   chopps 
   1214  1.1   chopps 	WSeq(ba, SEQ_ID_MEMORY_MODE, (TEXT || (gv->depth == 1)) ? 0x06 : 0x0e);
   1215  1.5   chopps 	WSeq(ba, SEQ_ID_DRAM_CNTL, (TEXT || (gv->depth == 1)) ? 0x90 : 0xb0);
   1216  1.5   chopps 	WGfx(ba, GCT_ID_READ_MAP_SELECT, 0x00);
   1217  1.1   chopps 	WSeq(ba, SEQ_ID_MAP_MASK, (gv->depth == 1) ? 0x01 : 0xff);
   1218  1.5   chopps 	WSeq(ba, SEQ_ID_CHAR_MAP_SELECT, 0x00);
   1219  1.1   chopps 
   1220  1.1   chopps 	/* Set clock */
   1221  1.1   chopps 
   1222  1.5   chopps 	CompFQ((gv->depth == 24) ? gv->pixel_clock * 3 : gv->pixel_clock,
   1223  1.1   chopps 	    &num0, &denom0);
   1224  1.1   chopps 	WSeq(ba, SEQ_ID_VCLK_0_NUM, num0);
   1225  1.1   chopps 	WSeq(ba, SEQ_ID_VCLK_0_DENOM, denom0);
   1226  1.1   chopps 
   1227  1.1   chopps 	/* load display parameters into board */
   1228  1.1   chopps 
   1229  1.1   chopps 	WCrt(ba, CRT_ID_HOR_TOTAL, HT);
   1230  1.5   chopps 	WCrt(ba, CRT_ID_HOR_DISP_ENA_END, ((HDE >= HBS) ? HBS - 1 : HDE));
   1231  1.1   chopps 	WCrt(ba, CRT_ID_START_HOR_BLANK, HBS);
   1232  1.5   chopps 	WCrt(ba, CRT_ID_END_HOR_BLANK, (HBE & 0x1f) | 0x80);	/* | 0x80? */
   1233  1.1   chopps 	WCrt(ba, CRT_ID_START_HOR_RETR, HSS);
   1234  1.1   chopps 	WCrt(ba, CRT_ID_END_HOR_RETR,
   1235  1.5   chopps 	    (HSE & 0x1f) |
   1236  1.5   chopps 	    ((HBE & 0x20) ? 0x80 : 0x00));
   1237  1.1   chopps 	WCrt(ba, CRT_ID_VER_TOTAL, VT);
   1238  1.1   chopps 	WCrt(ba, CRT_ID_OVERFLOW,
   1239  1.1   chopps 	    0x10 |
   1240  1.5   chopps 	    ((VT & 0x100) ? 0x01 : 0x00) |
   1241  1.1   chopps 	    ((VDE & 0x100) ? 0x02 : 0x00) |
   1242  1.1   chopps 	    ((VSS & 0x100) ? 0x04 : 0x00) |
   1243  1.1   chopps 	    ((VBS & 0x100) ? 0x08 : 0x00) |
   1244  1.5   chopps 	    ((VT & 0x200) ? 0x20 : 0x00) |
   1245  1.1   chopps 	    ((VDE & 0x200) ? 0x40 : 0x00) |
   1246  1.5   chopps 	    ((VSS & 0x200) ? 0x80 : 0x00));
   1247  1.1   chopps 
   1248  1.1   chopps 
   1249  1.1   chopps 	WCrt(ba, CRT_ID_CHAR_HEIGHT,
   1250  1.5   chopps 	    0x40 |		/* TEXT ? 0x00 ??? */
   1251  1.1   chopps 	    (DBLSCAN ? 0x80 : 0x00) |
   1252  1.1   chopps 	    ((VBS & 0x200) ? 0x20 : 0x00) |
   1253  1.5   chopps 	    (TEXT ? ((md->fy - 1) & 0x1f) : 0x00));
   1254  1.5   chopps 	WCrt(ba, CRT_ID_MODE_CONTROL,
   1255  1.1   chopps 	    ((TEXT || (gv->depth == 1)) ? 0xc3 : 0xa3));
   1256  1.1   chopps 
   1257  1.1   chopps 	/* text cursor */
   1258  1.1   chopps 
   1259  1.1   chopps 	if (TEXT) {
   1260  1.5   chopps #if CL_ULCURSOR
   1261  1.1   chopps 		WCrt(ba, CRT_ID_CURSOR_START, (md->fy & 0x1f) - 2);
   1262  1.1   chopps 		WCrt(ba, CRT_ID_CURSOR_END, (md->fy & 0x1f) - 1);
   1263  1.1   chopps #else
   1264  1.1   chopps 		WCrt(ba, CRT_ID_CURSOR_START, 0x00);
   1265  1.1   chopps 		WCrt(ba, CRT_ID_CURSOR_END, md->fy & 0x1f);
   1266  1.1   chopps #endif
   1267  1.5   chopps 		WCrt(ba, CRT_ID_UNDERLINE_LOC, md->fy - 1 & 0x1f);
   1268  1.1   chopps 
   1269  1.1   chopps 		WCrt(ba, CRT_ID_CURSOR_LOC_HIGH, 0x00);
   1270  1.5   chopps 		WCrt(ba, CRT_ID_CURSOR_LOC_LOW, 0x00);
   1271  1.1   chopps 	}
   1272  1.1   chopps 	WCrt(ba, CRT_ID_START_ADDR_HIGH, 0x00);
   1273  1.1   chopps 	WCrt(ba, CRT_ID_START_ADDR_LOW, 0x00);
   1274  1.1   chopps 
   1275  1.1   chopps 	WCrt(ba, CRT_ID_START_VER_RETR, VSS);
   1276  1.1   chopps 	WCrt(ba, CRT_ID_END_VER_RETR, (VSE & 0x0f) | 0x30);
   1277  1.1   chopps 	WCrt(ba, CRT_ID_VER_DISP_ENA_END, VDE);
   1278  1.1   chopps 	WCrt(ba, CRT_ID_START_VER_BLANK, VBS);
   1279  1.1   chopps 	WCrt(ba, CRT_ID_END_VER_BLANK, VBE);
   1280  1.1   chopps 
   1281  1.1   chopps 	WCrt(ba, CRT_ID_LINE_COMPARE, 0xff);
   1282  1.5   chopps 	WCrt(ba, CRT_ID_LACE_END, HT / 2);	/* MW/16 */
   1283  1.1   chopps 	WCrt(ba, CRT_ID_LACE_CNTL,
   1284  1.1   chopps 	    (LACE ? 0x01 : 0x00) |
   1285  1.1   chopps 	    ((HBE & 0x40) ? 0x10 : 0x00) |
   1286  1.1   chopps 	    ((HBE & 0x80) ? 0x20 : 0x00) |
   1287  1.1   chopps 	    ((VBE & 0x100) ? 0x40 : 0x00) |
   1288  1.5   chopps 	    ((VBE & 0x200) ? 0x80 : 0x00));
   1289  1.1   chopps 
   1290  1.1   chopps 	/* depth dependent stuff */
   1291  1.1   chopps 
   1292  1.1   chopps 	switch (gv->depth) {
   1293  1.1   chopps 	case 1:
   1294  1.1   chopps 	case 4:
   1295  1.1   chopps 	case 8:
   1296  1.5   chopps 		clkdiv = 0;
   1297  1.5   chopps 		break;
   1298  1.1   chopps 	case 15:
   1299  1.1   chopps 	case 16:
   1300  1.5   chopps 		clkdiv = 3;
   1301  1.5   chopps 		break;
   1302  1.1   chopps 	case 24:
   1303  1.5   chopps 		clkdiv = 2;
   1304  1.5   chopps 		break;
   1305  1.1   chopps 	}
   1306  1.5   chopps 
   1307  1.5   chopps 	WGfx(ba, GCT_ID_GRAPHICS_MODE,
   1308  1.1   chopps 	    ((TEXT || (gv->depth == 1)) ? 0x00 : 0x40));
   1309  1.1   chopps 	WGfx(ba, GCT_ID_MISC, (TEXT ? 0x04 : 0x01));
   1310  1.1   chopps 
   1311  1.5   chopps 	WSeq(ba, SEQ_ID_EXT_SEQ_MODE,
   1312  1.5   chopps 	    ((TEXT || (gv->depth == 1)) ? 0x00 : 0x01) |
   1313  1.5   chopps 	    ((cltype == PICASSO) ? 0x20 : 0x80) |
   1314  1.5   chopps 	    (clkdiv << 1));
   1315  1.1   chopps 
   1316  1.5   chopps 	delay(200000);
   1317  1.6       is 
   1318  1.6       is 	/* write 0x00 to VDAC_MASK before accessing HDR this helps
   1319  1.6       is 	   sometimes, out of "secret" application note (crest) */
   1320  1.6       is 	vgaw(ba, VDAC_MASK, 0);
   1321  1.6       is 	delay(200000);
   1322  1.6       is 	/* reset HDR "magic" access counter (crest) */
   1323  1.6       is 	vgar(ba, VDAC_ADDRESS);
   1324  1.6       is 
   1325  1.1   chopps 	delay(200000);
   1326  1.1   chopps 	vgar(ba, VDAC_MASK);
   1327  1.1   chopps 	delay(200000);
   1328  1.1   chopps 	vgar(ba, VDAC_MASK);
   1329  1.1   chopps 	delay(200000);
   1330  1.1   chopps 	vgar(ba, VDAC_MASK);
   1331  1.1   chopps 	delay(200000);
   1332  1.1   chopps 	vgar(ba, VDAC_MASK);
   1333  1.1   chopps 	delay(200000);
   1334  1.1   chopps 	switch (gv->depth) {
   1335  1.1   chopps 	case 1:
   1336  1.5   chopps 	case 4:		/* text */
   1337  1.1   chopps 		vgaw(ba, VDAC_MASK, 0);
   1338  1.1   chopps 		HDE = gv->disp_width / 16;
   1339  1.1   chopps 		break;
   1340  1.1   chopps 	case 8:
   1341  1.1   chopps 		vgaw(ba, VDAC_MASK, 0);
   1342  1.1   chopps 		HDE = gv->disp_width / 8;
   1343  1.1   chopps 		break;
   1344  1.1   chopps 	case 15:
   1345  1.1   chopps 		vgaw(ba, VDAC_MASK, 0xd0);
   1346  1.1   chopps 		HDE = gv->disp_width / 4;
   1347  1.1   chopps 		break;
   1348  1.1   chopps 	case 16:
   1349  1.5   chopps 		vgaw(ba, VDAC_MASK, 0xc1);
   1350  1.1   chopps 		HDE = gv->disp_width / 4;
   1351  1.1   chopps 		break;
   1352  1.1   chopps 	case 24:
   1353  1.5   chopps 		vgaw(ba, VDAC_MASK, 0xc5);
   1354  1.1   chopps 		HDE = (gv->disp_width / 8) * 3;
   1355  1.1   chopps 		break;
   1356  1.1   chopps 	}
   1357  1.6       is 	delay(20000);
   1358  1.6       is 
   1359  1.6       is 	/* reset HDR "magic" access counter (crest) */
   1360  1.6       is 	vgar(ba, VDAC_ADDRESS);
   1361  1.1   chopps 	delay(200000);
   1362  1.6       is 	/* then enable all bit in VDAC_MASK afterwards (crest) */
   1363  1.6       is 	vgaw(ba, VDAC_MASK, 0xff);
   1364  1.6       is 	delay(20000);
   1365  1.1   chopps 
   1366  1.5   chopps 	WCrt(ba, CRT_ID_OFFSET, HDE);
   1367  1.5   chopps 	WCrt(ba, CRT_ID_EXT_DISP_CNTL,
   1368  1.1   chopps 	    ((TEXT && gv->pixel_clock > 29000000) ? 0x40 : 0x00) |
   1369  1.5   chopps 	    0x22 |
   1370  1.5   chopps 	    ((HDE > 0xff) ? 0x10 : 0x00));	/* text? */
   1371  1.1   chopps 
   1372  1.1   chopps 	delay(200000);
   1373  1.1   chopps 	WAttr(ba, ACT_ID_ATTR_MODE_CNTL, (TEXT ? 0x0a : 0x01));
   1374  1.1   chopps 	delay(200000);
   1375  1.5   chopps 	WAttr(ba, 0x20 | ACT_ID_COLOR_PLANE_ENA,
   1376  1.1   chopps 	    (gv->depth == 1) ? 0x01 : 0x0f);
   1377  1.1   chopps 	delay(200000);
   1378  1.1   chopps 
   1379  1.1   chopps 	/* text initialization */
   1380  1.1   chopps 
   1381  1.1   chopps 	if (TEXT) {
   1382  1.1   chopps 		cl_inittextmode(gp);
   1383  1.1   chopps 	}
   1384  1.1   chopps 	WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x14);
   1385  1.1   chopps 	WSeq(ba, SEQ_ID_CLOCKING_MODE, 0x01);
   1386  1.1   chopps 
   1387  1.1   chopps 	/* Pass-through */
   1388  1.1   chopps 
   1389  1.1   chopps 	RegOffpass(ba);
   1390  1.1   chopps 
   1391  1.5   chopps 	return (1);
   1392  1.1   chopps }
   1393  1.1   chopps 
   1394  1.1   chopps void
   1395  1.1   chopps cl_inittextmode(gp)
   1396  1.1   chopps 	struct grf_softc *gp;
   1397  1.1   chopps {
   1398  1.5   chopps 	struct grfcltext_mode *tm = (struct grfcltext_mode *) gp->g_data;
   1399  1.1   chopps 	volatile unsigned char *ba = gp->g_regkva;
   1400  1.1   chopps 	unsigned char *fb = gp->g_fbkva;
   1401  1.1   chopps 	unsigned char *c, *f, y;
   1402  1.1   chopps 	unsigned short z;
   1403  1.1   chopps 
   1404  1.1   chopps 
   1405  1.5   chopps 	/* load text font into beginning of display memory. Each character
   1406  1.5   chopps 	 * cell is 32 bytes long (enough for 4 planes) */
   1407  1.1   chopps 
   1408  1.1   chopps 	SetTextPlane(ba, 0x02);
   1409  1.5   chopps         cl_memset(fb, 0, 256 * 32);
   1410  1.5   chopps 	c = (unsigned char *) (fb) + (32 * tm->fdstart);
   1411  1.1   chopps 	f = tm->fdata;
   1412  1.5   chopps 	for (z = tm->fdstart; z <= tm->fdend; z++, c += (32 - tm->fy))
   1413  1.5   chopps 		for (y = 0; y < tm->fy; y++)
   1414  1.1   chopps 			*c++ = *f++;
   1415  1.1   chopps 
   1416  1.1   chopps 	/* clear out text/attr planes (three screens worth) */
   1417  1.1   chopps 
   1418  1.1   chopps 	SetTextPlane(ba, 0x01);
   1419  1.5   chopps 	cl_memset(fb, 0x07, tm->cols * tm->rows * 3);
   1420  1.1   chopps 	SetTextPlane(ba, 0x00);
   1421  1.5   chopps 	cl_memset(fb, 0x20, tm->cols * tm->rows * 3);
   1422  1.1   chopps 
   1423  1.1   chopps 	/* print out a little init msg */
   1424  1.1   chopps 
   1425  1.5   chopps 	c = (unsigned char *) (fb) + (tm->cols - 16);
   1426  1.1   chopps 	strcpy(c, "CIRRUS");
   1427  1.1   chopps 	c[6] = 0x20;
   1428  1.1   chopps 
   1429  1.1   chopps 	/* set colors (B&W) */
   1430  1.1   chopps 
   1431  1.1   chopps 
   1432  1.1   chopps 	vgaw(ba, VDAC_ADDRESS_W, 0);
   1433  1.5   chopps 	for (z = 0; z < 256; z++) {
   1434  1.1   chopps 		unsigned char r, g, b;
   1435  1.1   chopps 
   1436  1.1   chopps 		y = (z & 1) ? ((z > 7) ? 2 : 1) : 0;
   1437  1.1   chopps 
   1438  1.1   chopps 		if (cltype == PICASSO) {
   1439  1.1   chopps 			r = clconscolors[y][0];
   1440  1.1   chopps 			g = clconscolors[y][1];
   1441  1.1   chopps 			b = clconscolors[y][2];
   1442  1.1   chopps 		} else {
   1443  1.1   chopps 			b = clconscolors[y][0];
   1444  1.1   chopps 			g = clconscolors[y][1];
   1445  1.1   chopps 			r = clconscolors[y][2];
   1446  1.1   chopps 		}
   1447  1.1   chopps 		vgaw(ba, VDAC_DATA, r >> 2);
   1448  1.1   chopps 		vgaw(ba, VDAC_DATA, g >> 2);
   1449  1.1   chopps 		vgaw(ba, VDAC_DATA, b >> 2);
   1450  1.1   chopps 	}
   1451  1.1   chopps }
   1452  1.1   chopps 
   1453  1.1   chopps void
   1454  1.5   chopps cl_memset(d, c, l)
   1455  1.1   chopps 	unsigned char *d;
   1456  1.1   chopps 	unsigned char c;
   1457  1.5   chopps 	int     l;
   1458  1.1   chopps {
   1459  1.5   chopps 	for (; l > 0; l--)
   1460  1.1   chopps 		*d++ = c;
   1461  1.1   chopps }
   1462  1.5   chopps #endif /* NGRFCL */
   1463