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