Home | History | Annotate | Line # | Download | only in dev
grf.c revision 1.62
      1 /*	$NetBSD: grf.c,v 1.62 2014/07/25 08:10:31 dholland Exp $ */
      2 
      3 /*
      4  * Copyright (c) 1988 University of Utah.
      5  * Copyright (c) 1990 The Regents of the University of California.
      6  * All rights reserved.
      7  *
      8  * This code is derived from software contributed to Berkeley by
      9  * the Systems Programming Group of the University of Utah Computer
     10  * Science Department.
     11  *
     12  * Redistribution and use in source and binary forms, with or without
     13  * modification, are permitted provided that the following conditions
     14  * are met:
     15  * 1. Redistributions of source code must retain the above copyright
     16  *    notice, this list of conditions and the following disclaimer.
     17  * 2. Redistributions in binary form must reproduce the above copyright
     18  *    notice, this list of conditions and the following disclaimer in the
     19  *    documentation and/or other materials provided with the distribution.
     20  * 3. Neither the name of the University nor the names of its contributors
     21  *    may be used to endorse or promote products derived from this software
     22  *    without specific prior written permission.
     23  *
     24  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     25  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     26  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     27  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     28  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     29  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     30  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     31  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     32  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     33  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     34  * SUCH DAMAGE.
     35  *
     36  * from: Utah $Hdr: grf.c 1.31 91/01/21$
     37  *
     38  *	@(#)grf.c	7.8 (Berkeley) 5/7/91
     39  */
     40 
     41 #include <sys/cdefs.h>
     42 __KERNEL_RCSID(0, "$NetBSD: grf.c,v 1.62 2014/07/25 08:10:31 dholland Exp $");
     43 
     44 /*
     45  * Graphics display driver for the Amiga
     46  * This is the hardware-independent portion of the driver.
     47  * Hardware access is through the grf_softc->g_mode routine.
     48  */
     49 
     50 #include "view.h"
     51 #include "grf.h"
     52 #include "kbd.h"
     53 #include "wsdisplay.h"
     54 
     55 #include <sys/param.h>
     56 #include <sys/proc.h>
     57 #include <sys/ioctl.h>
     58 #include <sys/device.h>
     59 #include <sys/file.h>
     60 #include <sys/malloc.h>
     61 #include <sys/systm.h>
     62 #include <sys/vnode.h>
     63 #include <sys/mman.h>
     64 #include <sys/bus.h>
     65 #include <sys/kauth.h>
     66 
     67 #include <machine/cpu.h>
     68 
     69 #include <dev/cons.h>
     70 #include <dev/sun/fbio.h>
     71 #include <dev/wscons/wsconsio.h>
     72 #include <dev/wscons/wsdisplayvar.h>
     73 #include <dev/rasops/rasops.h>
     74 #include <dev/wscons/wsdisplay_vconsvar.h>
     75 
     76 #include <amiga/amiga/color.h>	/* DEBUG */
     77 #include <amiga/amiga/device.h>
     78 #include <amiga/dev/grfioctl.h>
     79 #include <amiga/dev/grfws.h>
     80 #include <amiga/dev/grfvar.h>
     81 #include <amiga/dev/itevar.h>
     82 #include <amiga/dev/kbdvar.h>
     83 #include <amiga/dev/viewioctl.h>
     84 
     85 #include <sys/conf.h>
     86 
     87 #if NGRF > 0
     88 #include "ite.h"
     89 #if NITE == 0
     90 #define	ite_on(u,f)
     91 #define	ite_off(u,f)
     92 #define ite_reinit(d)
     93 #endif
     94 
     95 int grfon(dev_t);
     96 int grfoff(dev_t);
     97 int grfsinfo(dev_t, struct grfdyninfo *);
     98 
     99 void grfattach(device_t, device_t, void *);
    100 int grfmatch(device_t, cfdata_t, void *);
    101 int grfprint(void *, const char *);
    102 #ifdef DEBUG
    103 void grfdebug(struct grf_softc *, const char *, ...);
    104 #endif
    105 /*
    106  * pointers to grf drivers device structs
    107  */
    108 struct grf_softc *grfsp[NGRF];
    109 
    110 CFATTACH_DECL_NEW(grf, 0,
    111     grfmatch, grfattach, NULL, NULL);
    112 
    113 dev_type_open(grfopen);
    114 dev_type_close(grfclose);
    115 dev_type_ioctl(grfioctl);
    116 dev_type_mmap(grfmmap);
    117 
    118 const struct cdevsw grf_cdevsw = {
    119 	.d_open = grfopen,
    120 	.d_close = grfclose,
    121 	.d_read = nullread,
    122 	.d_write = nullwrite,
    123 	.d_ioctl = grfioctl,
    124 	.d_stop = nostop,
    125 	.d_tty = notty,
    126 	.d_poll = nopoll,
    127 	.d_mmap = grfmmap,
    128 	.d_kqfilter = nokqfilter,
    129 	.d_discard = nodiscard,
    130 	.d_flag = 0
    131 };
    132 
    133 /*
    134  * only used in console init.
    135  */
    136 static cfdata_t cfdata;
    137 
    138 #if NWSDISPLAY > 0
    139 static struct vcons_screen console_vcons;
    140 
    141 static void grf_init_screen(void *, struct vcons_screen *, int, long *);
    142 static struct rasops_info *grf_setup_rasops(struct grf_softc *,
    143     struct vcons_screen *);
    144 static paddr_t grf_wsmmap_md(off_t off);
    145 
    146 cons_decl(grf);
    147 #endif
    148 
    149 /*
    150  * match if the unit of grf matches its perspective
    151  * low level board driver.
    152  */
    153 int
    154 grfmatch(device_t parent, cfdata_t cf, void *aux)
    155 {
    156 	struct grf_softc *psc;
    157 
    158 	psc = device_private(parent);
    159 	if (cf->cf_unit != psc->g_unit)
    160 		return(0);
    161 	cfdata = cf;
    162 	return(1);
    163 }
    164 
    165 /*
    166  * Attach.. plug pointer in and print some info.
    167  * Then try and attach a wsdisplay or ite to us.
    168  * Note: self is NULL durring console init.
    169  */
    170 void
    171 grfattach(device_t parent, device_t self, void *aux)
    172 {
    173 #if NWSDISPLAY > 0
    174 	struct wsemuldisplaydev_attach_args wa;
    175 	long defattr;
    176 #endif
    177 	struct grf_softc *gp;
    178 	int maj;
    179 
    180 	gp = device_private(parent);
    181 	gp->g_device = self;
    182 	grfsp[gp->g_unit] = gp;
    183 
    184 	/*
    185 	 * find our major device number
    186 	 */
    187 	maj = cdevsw_lookup_major(&grf_cdevsw);
    188 
    189 	gp->g_grfdev = makedev(maj, gp->g_unit);
    190 	if (self != NULL) {
    191 		printf(": width %d height %d", gp->g_display.gd_dwidth,
    192 		    gp->g_display.gd_dheight);
    193 		if (gp->g_display.gd_colors == 2)
    194 			printf(" monochrome\n");
    195 		else
    196 			printf(" colors %d\n", gp->g_display.gd_colors);
    197 #if NWSDISPLAY > 0
    198 		vcons_init(&gp->g_vd, gp, gp->g_screens[0], gp->g_accessops);
    199 		gp->g_vd.init_screen = grf_init_screen;
    200 		if (gp->g_flags & GF_CONSOLE) {
    201 			console_vcons.scr_flags |= VCONS_SCREEN_IS_STATIC;
    202 			vcons_init_screen(&gp->g_vd,
    203 			    &console_vcons, 1, &defattr);
    204 			gp->g_screens[0]->textops =
    205 			    &console_vcons.scr_ri.ri_ops;
    206 			wsdisplay_cnattach(gp->g_screens[0],
    207 			    &console_vcons.scr_ri, 0, 0, defattr);
    208 			vcons_replay_msgbuf(&console_vcons);
    209 		}
    210 
    211 		/* attach wsdisplay */
    212 		wa.console = (gp->g_flags & GF_CONSOLE) != 0;
    213 		wa.scrdata = &gp->g_screenlist;
    214 		wa.accessops = gp->g_accessops;
    215 		wa.accesscookie = &gp->g_vd;
    216 		config_found(self, &wa, wsemuldisplaydevprint);
    217 #endif  /* NWSDISPLAY > 0 */
    218 	}
    219 
    220 #if NWSDISPLAY == 0
    221 	/*
    222 	 * try and attach an ite
    223 	 */
    224 	amiga_config_found(cfdata, self, gp, grfprint);
    225 #endif
    226 }
    227 
    228 int
    229 grfprint(void *aux, const char *pnp)
    230 {
    231 	if (pnp)
    232 		aprint_normal("ite at %s", pnp);
    233 	return(UNCONF);
    234 }
    235 
    236 /*ARGSUSED*/
    237 int
    238 grfopen(dev_t dev, int flags, int devtype, struct lwp *l)
    239 {
    240 	struct grf_softc *gp;
    241 
    242 	if (GRFUNIT(dev) >= NGRF || (gp = grfsp[GRFUNIT(dev)]) == NULL)
    243 		return(ENXIO);
    244 
    245 	if ((gp->g_flags & GF_ALIVE) == 0)
    246 		return(ENXIO);
    247 
    248 	if ((gp->g_flags & (GF_OPEN|GF_EXCLUDE)) == (GF_OPEN|GF_EXCLUDE))
    249 		return(EBUSY);
    250 
    251 	return(0);
    252 }
    253 
    254 /*ARGSUSED*/
    255 int
    256 grfclose(dev_t dev, int flags, int mode, struct lwp *l)
    257 {
    258 	struct grf_softc *gp;
    259 
    260 	gp = grfsp[GRFUNIT(dev)];
    261 	(void)grfoff(dev);
    262 	gp->g_flags &= GF_ALIVE;
    263 	return(0);
    264 }
    265 
    266 /*ARGSUSED*/
    267 int
    268 grfioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
    269 {
    270 	struct grf_softc *gp;
    271 	int error;
    272 
    273 	gp = grfsp[GRFUNIT(dev)];
    274 	error = 0;
    275 
    276 	switch (cmd) {
    277 	case OGRFIOCGINFO:
    278 	        /* argl.. no bank-member.. */
    279 	  	memcpy(data, (void *)&gp->g_display, sizeof(struct grfinfo)-4);
    280 		break;
    281 	case GRFIOCGINFO:
    282 		memcpy(data, (void *)&gp->g_display, sizeof(struct grfinfo));
    283 		break;
    284 	case GRFIOCON:
    285 		error = grfon(dev);
    286 		break;
    287 	case GRFIOCOFF:
    288 		error = grfoff(dev);
    289 		break;
    290 	case GRFIOCSINFO:
    291 		error = grfsinfo(dev, (struct grfdyninfo *) data);
    292 		break;
    293 	case GRFGETVMODE:
    294 		return(gp->g_mode(gp, GM_GRFGETVMODE, data, 0, 0));
    295 	case GRFSETVMODE:
    296 		error = gp->g_mode(gp, GM_GRFSETVMODE, data, 0, 0);
    297 		if (error == 0 && gp->g_itedev && !(gp->g_flags & GF_GRFON))
    298 			ite_reinit(gp->g_itedev);
    299 		break;
    300 	case GRFGETNUMVM:
    301 		return(gp->g_mode(gp, GM_GRFGETNUMVM, data, 0, 0));
    302 	/*
    303 	 * these are all hardware dependent, and have to be resolved
    304 	 * in the respective driver.
    305 	 */
    306 	case GRFIOCPUTCMAP:
    307 	case GRFIOCGETCMAP:
    308 	case GRFIOCSSPRITEPOS:
    309 	case GRFIOCGSPRITEPOS:
    310 	case GRFIOCSSPRITEINF:
    311 	case GRFIOCGSPRITEINF:
    312 	case GRFIOCGSPRITEMAX:
    313 	case GRFIOCBITBLT:
    314     	case GRFIOCSETMON:
    315 	case GRFTOGGLE: /* Toggles between Cirrus boards and native ECS on
    316                      Amiga. 15/11/94 ill */
    317 		/*
    318 		 * We need the minor dev number to get the overlay/image
    319 		 * information for grf_ul.
    320 		 */
    321 		return(gp->g_mode(gp, GM_GRFIOCTL, data, cmd, dev));
    322 
    323 	case GRFIOCBLANK:	/* blank ioctl, IOCON/OFF will turn ite on */
    324 	case FBIOSVIDEO:
    325 		error = gp->g_mode(gp, GM_GRFIOCTL, data, GRFIOCBLANK, dev);
    326 		if (!error)
    327 			gp->g_blank = *(int *)data;
    328 		return (error);
    329 
    330 	case FBIOGVIDEO:
    331 		*(int *)data = gp->g_blank;
    332 		return (0);
    333 
    334 	default:
    335 #if NVIEW > 0
    336 		/*
    337 		 * check to see whether it's a command recognized by the
    338 		 * view code if the unit is 0
    339 		 * XXX
    340 		 */
    341 		if (GRFUNIT(dev) == 0) {
    342 			extern const struct cdevsw view_cdevsw;
    343 
    344 			return((*view_cdevsw.d_ioctl)(dev, cmd, data, flag, l));
    345 		}
    346 #endif
    347 		error = EPASSTHROUGH;
    348 		break;
    349 
    350 	}
    351 	return(error);
    352 }
    353 
    354 /*
    355  * map the contents of a graphics display card into process'
    356  * memory space.
    357  */
    358 paddr_t
    359 grfmmap(dev_t dev, off_t off, int prot)
    360 {
    361 	struct grf_softc *gp;
    362 	struct grfinfo *gi;
    363 
    364 	gp = grfsp[GRFUNIT(dev)];
    365 	gi = &gp->g_display;
    366 
    367 	/*
    368 	 * control registers
    369 	 */
    370 	if (off >= 0 && off < gi->gd_regsize)
    371 		return(((paddr_t)gi->gd_regaddr + off) >> PGSHIFT);
    372 
    373 	/*
    374 	 * frame buffer
    375 	 */
    376 	if (off >= gi->gd_regsize && off < gi->gd_regsize+gi->gd_fbsize) {
    377 		off -= gi->gd_regsize;
    378 		return(((paddr_t)gi->gd_fbaddr + off) >> PGSHIFT);
    379 	}
    380 	/* bogus */
    381 	return(-1);
    382 }
    383 
    384 int
    385 grfon(dev_t dev)
    386 {
    387 	struct grf_softc *gp;
    388 
    389 	gp = grfsp[GRFUNIT(dev)];
    390 
    391 	if (gp->g_flags & GF_GRFON)
    392 		return(0);
    393 
    394 	gp->g_flags |= GF_GRFON;
    395 	if (gp->g_itedev != NODEV)
    396 		ite_off(gp->g_itedev, 3);
    397 
    398 	return(gp->g_mode(gp, (dev & GRFOVDEV) ? GM_GRFOVON : GM_GRFON,
    399 							NULL, 0, 0));
    400 }
    401 
    402 int
    403 grfoff(dev_t dev)
    404 {
    405 	struct grf_softc *gp;
    406 	int error;
    407 
    408 	gp = grfsp[GRFUNIT(dev)];
    409 
    410 	if ((gp->g_flags & GF_GRFON) == 0)
    411 		return(0);
    412 
    413 	gp->g_flags &= ~GF_GRFON;
    414 	error = gp->g_mode(gp, (dev & GRFOVDEV) ? GM_GRFOVOFF : GM_GRFOFF,
    415 							NULL, 0, 0);
    416 
    417 	/*
    418 	 * Closely tied together no X's
    419 	 */
    420 	if (gp->g_itedev != NODEV)
    421 		ite_on(gp->g_itedev, 2);
    422 
    423 	return(error);
    424 }
    425 
    426 int
    427 grfsinfo(dev_t dev, struct grfdyninfo *dyninfo)
    428 {
    429 	struct grf_softc *gp;
    430 	int error;
    431 
    432 	gp = grfsp[GRFUNIT(dev)];
    433 	error = gp->g_mode(gp, GM_GRFCONFIG, dyninfo, 0, 0);
    434 
    435 	/*
    436 	 * Closely tied together no X's
    437 	 */
    438 	if (gp->g_itedev != NODEV)
    439 		ite_reinit(gp->g_itedev);
    440 	return(error);
    441 }
    442 
    443 #if NWSDISPLAY > 0
    444 void
    445 grfcnprobe(struct consdev *cd)
    446 {
    447 	struct grf_softc *gp;
    448 	int unit;
    449 
    450 	/*
    451 	 * Find the first working grf device for being console.
    452 	 * Ignore unit 0 (grfcc), which should use amidisplaycc instead.
    453 	 */
    454 	for (unit = 1; unit < NGRF; unit++) {
    455 		gp = grfsp[unit];
    456 		if (gp != NULL && (gp->g_flags & GF_ALIVE)) {
    457 			cd->cn_pri = CN_INTERNAL;
    458 			cd->cn_dev = NODEV;  /* initialized later by wscons */
    459 			return;
    460 		}
    461 	}
    462 
    463 	/* no grf console alive */
    464 	cd->cn_pri = CN_DEAD;
    465 }
    466 
    467 void
    468 grfcninit(struct consdev *cd)
    469 {
    470 	struct grf_softc *gp;
    471 	struct rasops_info *ri;
    472 	long defattr;
    473 	int unit;
    474 
    475 	/* find console grf and set up wsdisplay for it */
    476 	for (unit = 1; unit < NGRF; unit++) {
    477 		gp = grfsp[unit];
    478 		if (gp != NULL && (gp->g_flags & GF_ALIVE)) {
    479 			gp->g_flags |= GF_CONSOLE;  /* we are console! */
    480 			gp->g_screens[0]->ncols = gp->g_display.gd_fbwidth /
    481 			    gp->g_screens[0]->fontwidth;
    482 			gp->g_screens[0]->nrows = gp->g_display.gd_fbheight /
    483 			    gp->g_screens[0]->fontheight;
    484 
    485 			ri = grf_setup_rasops(gp, &console_vcons);
    486 			console_vcons.scr_cookie = gp;
    487 			defattr = 0;  /* XXX */
    488 
    489 			wsdisplay_preattach(gp->g_screens[0], ri, 0, 0,
    490 			    defattr);
    491 #if NKBD > 0
    492 			/* tell kbd device it is used as console keyboard */
    493 			kbd_cnattach();
    494 #endif
    495 			return;
    496 		}
    497 	}
    498 	panic("grfcninit: lost console");
    499 }
    500 
    501 static void
    502 grf_init_screen(void *cookie, struct vcons_screen *scr, int existing,
    503     long *defattr)
    504 {
    505 	struct grf_softc *gp;
    506 	struct rasops_info *ri __unused;
    507 
    508 	gp = cookie;
    509 	ri = grf_setup_rasops(gp, scr);
    510 }
    511 
    512 static struct rasops_info *
    513 grf_setup_rasops(struct grf_softc *gp, struct vcons_screen *scr)
    514 {
    515 	struct rasops_info *ri;
    516 	int i;
    517 
    518 	ri = &scr->scr_ri;
    519 	scr->scr_flags |= VCONS_DONT_READ;
    520 	memset(ri, 0, sizeof(struct rasops_info));
    521 
    522 	ri->ri_rows = gp->g_screens[0]->nrows;
    523 	ri->ri_cols = gp->g_screens[0]->ncols;
    524 	ri->ri_hw = scr;
    525 	ri->ri_ops.cursor    = gp->g_emulops->cursor;
    526 	ri->ri_ops.mapchar   = gp->g_emulops->mapchar;
    527 	ri->ri_ops.copyrows  = gp->g_emulops->copyrows;
    528 	ri->ri_ops.eraserows = gp->g_emulops->eraserows;
    529 	ri->ri_ops.copycols  = gp->g_emulops->copycols;
    530 	ri->ri_ops.erasecols = gp->g_emulops->erasecols;
    531 	ri->ri_ops.putchar   = gp->g_emulops->putchar;
    532 	ri->ri_ops.allocattr = gp->g_emulops->allocattr;
    533 
    534 	/* multiplication table for row-offsets */
    535 	for (i = 0; i < ri->ri_rows; i++)
    536 		gp->g_rowoffset[i] = i * ri->ri_cols;
    537 
    538 	return ri;
    539 }
    540 
    541 paddr_t
    542 grf_wsmmap(void *v, void *vs, off_t off, int prot)
    543 {
    544 	struct vcons_data *vd;
    545 	struct grf_softc *gp;
    546 	struct grfinfo *gi;
    547 
    548 	vd = v;
    549 	gp = vd->cookie;
    550 	gi = &gp->g_display;
    551 
    552 	/* Normal fb mapping */
    553 	if (off < gi->gd_fbsize)
    554 		return grf_wsmmap_md(((bus_addr_t)gp->g_fbkva) + off);
    555 
    556 	if (kauth_authorize_machdep(kauth_cred_get(), KAUTH_MACHDEP_UNMANAGEDMEM,
    557 	    NULL, NULL, NULL, NULL) != 0) {
    558 		aprint_normal("%s: permission to mmap denied.\n",
    559 		    device_xname(gp->g_device));
    560 		return -1;
    561 	}
    562 
    563 	if ((off >= (bus_addr_t)gp->g_fbkva ) &&
    564 	    (off < ( (bus_addr_t)gp->g_fbkva + (size_t)gi->gd_fbsize)))
    565 		return grf_wsmmap_md(off);
    566 
    567 	/* Handle register mapping */
    568 	if ((off >= (bus_addr_t)gi->gd_regaddr) &&
    569 	    (off < ((bus_addr_t)gi->gd_regaddr + (size_t)gi->gd_regsize)))
    570 		return grf_wsmmap_md(off);
    571 
    572 	return -1;
    573 }
    574 
    575 static paddr_t
    576 grf_wsmmap_md(off_t off)
    577 {
    578 #if defined(__m68k__)
    579 	return (paddr_t) m68k_btop(off);
    580 #else
    581 	return -1; /* FIXME */
    582 #endif
    583 }
    584 
    585 int
    586 grf_wsioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
    587 {
    588 	struct vcons_data *vd;
    589 	struct grf_softc *gp;
    590 
    591 	vd = v;
    592 	gp = vd->cookie;
    593 
    594 	switch (cmd) {
    595 	/* XXX: check if ptr to implementation is not null */
    596 	case WSDISPLAYIO_GINFO:
    597 		return gp->g_wsioctl->ginfo(gp, data);
    598 	case WSDISPLAYIO_SMODE:
    599 		return gp->g_wsioctl->smode(gp, data);
    600 	case WSDISPLAYIO_GMODE:
    601 		return gp->g_wsioctl->gmode(gp, data);
    602 	case WSDISPLAYIO_GTYPE:
    603 		return gp->g_wsioctl->gtype(gp, data);
    604 	case WSDISPLAYIO_SVIDEO:
    605 		return gp->g_wsioctl->svideo(gp, data);
    606 	case WSDISPLAYIO_GVIDEO:
    607 		return gp->g_wsioctl->gvideo(gp, data);
    608 	case WSDISPLAYIO_GETCMAP:
    609 		return gp->g_wsioctl->getcmap(gp, data);
    610 	case WSDISPLAYIO_PUTCMAP:
    611 		return gp->g_wsioctl->putcmap(gp, data);
    612 	}
    613 
    614 	return EPASSTHROUGH;
    615 }
    616 
    617 /* wsdisplay_accessops ioctls */
    618 
    619 int
    620 grf_wsaogetcmap(void *c, void *data)
    621 {
    622 	u_int index, count;
    623 	struct grf_softc *gp;
    624 	struct wsdisplay_cmap *cm __unused;
    625 
    626 	cm = (struct wsdisplay_cmap*) data;
    627 	gp = c;
    628 	index = 0;
    629 	count = 0;
    630 
    631 	if (gp->g_wsmode == WSDISPLAYIO_MODE_EMUL)
    632 		return EINVAL;
    633 
    634 	if (index >= 255 || count > 256 || index + count > 256)
    635 		return EINVAL;
    636 
    637 	/*
    638 	 * TODO: copyout values for r, g, b. This function should be
    639 	 * driver-specific...
    640 	 */
    641 
    642 	return 0;
    643 }
    644 
    645 int
    646 grf_wsaoputcmap(void *c, void *data)
    647 {
    648 	/*
    649 	 * We probably couldn't care less about color map in MODE_EMUL,
    650 	 * I don't know about X11 yet. Also, these ioctls could be used by
    651 	 * fullscreen console programs (think wsdisplay picture viewer, or
    652 	 * the wsimgshow tool written by Yasushi Oshima).
    653 	 */
    654 	struct grf_softc *gp;
    655 
    656 	gp = c;
    657 
    658 	if (gp->g_wsmode == WSDISPLAYIO_MODE_EMUL)
    659 		return EINVAL;
    660 	/* ... */
    661 
    662 	return 0;
    663 }
    664 
    665 int
    666 grf_wsaosvideo(void *c, void *data)
    667 {
    668 #if 0
    669 	struct grf_softc *gp;
    670 	dev_t dev;
    671 	int rv;
    672 
    673 	gp = c;
    674 	dev = (dev_t) &gp->g_grfdev;
    675 
    676 	if (*(u_int *)data == WSDISPLAYIO_VIDEO_OFF) {
    677 		if ((gp->g_flags & GF_GRFON) == 0)
    678 			rv = 0;
    679 		else {
    680 			gp->g_flags &= ~GF_GRFON;
    681 			rv = gp->g_mode(gp, (dev & GRFOVDEV) ?
    682 			    GM_GRFOVOFF : GM_GRFOFF, NULL, 0, 0);
    683 		}
    684 
    685 	} else {
    686 		if ((gp->g_flags & GF_GRFON))
    687         		rv = 0;
    688 		else
    689 			gp->g_flags |= GF_GRFON;
    690 			rv = gp->g_mode(gp, (dev & GRFOVDEV) ?
    691 			    GM_GRFOVON : GM_GRFON, NULL, 0, 0);
    692 	}
    693 
    694 	return rv;
    695 #endif
    696 	return 0;
    697 }
    698 
    699 int
    700 grf_wsaogvideo(void *c, void *data)
    701 {
    702 	struct grf_softc *gp;
    703 
    704 	gp = c;
    705 
    706 	if(gp->g_flags & GF_GRFON)
    707 		*(u_int *)data = WSDISPLAYIO_VIDEO_ON;
    708 	else
    709 		*(u_int *)data = WSDISPLAYIO_VIDEO_OFF;
    710 
    711 	return 0;
    712 }
    713 
    714 int
    715 grf_wsaogtype(void *c, void *data)
    716 {
    717 	struct grf_softc *gp __unused;
    718 
    719 	gp = c;
    720 
    721 	*(u_int *)data = WSDISPLAY_TYPE_GRF;
    722 	return 0;
    723 }
    724 
    725 int
    726 grf_wsaogmode(void *c, void *data)
    727 {
    728 	struct grf_softc *gp;
    729 
    730 	gp = c;
    731 
    732 	*(u_int *)data = gp->g_wsmode;
    733 	return 0;
    734 }
    735 
    736 int
    737 grf_wsaosmode(void *c, void *data)
    738 {
    739 	/* XXX: should provide hw-dependent impl of this in grf_xxx driver? */
    740 	struct grf_softc *gp;
    741 
    742 	gp = c;
    743 
    744 	if ((*(int*) data) != gp->g_wsmode) {
    745 		gp->g_wsmode = (*(int*) data);
    746 		if ((*(int*) data) == WSDISPLAYIO_MODE_EMUL) {
    747 			//vcons_redraw_screen( active vcons screen );
    748 		}
    749 	}
    750 	return 0;
    751 }
    752 
    753 int
    754 grf_wsaoginfo(void *c, void *data)
    755 {
    756 	struct wsdisplay_fbinfo *fbinfo;
    757 	struct grf_softc *gp;
    758 	struct grfinfo *gi;
    759 
    760 	gp = c;
    761 
    762 	fbinfo = (struct wsdisplay_fbinfo *)data;
    763 	gi = &gp->g_display;
    764 
    765 	/*
    766 	 * TODO: better sanity checking, it is possible that
    767 	 * wsdisplay is initialized, but no screen is opened
    768 	 * (for example, device is not used).
    769 	 */
    770 
    771 	/*
    772 	 * We shold return truth about current mode here because
    773 	 * X11 wsfb driver denepds on this!
    774 	 */
    775 	fbinfo->height = gi->gd_fbheight;
    776 	fbinfo->width = gi->gd_fbwidth;
    777 	fbinfo->depth = gi->gd_planes;
    778 	fbinfo->cmsize = gi->gd_colors;
    779 
    780 	return 0;
    781 }
    782 
    783 #endif  /* NWSDISPLAY > 0 */
    784 
    785 #ifdef DEBUG
    786 void
    787 grfdebug(struct grf_softc *gp, const char *fmt, ...)
    788 {
    789 	static int ccol = 0, crow = 1;
    790 	volatile char *cp;
    791 	char buf[256];
    792 	va_list ap;
    793 	int ncols;
    794 	char *bp;
    795 
    796 	va_start(ap, fmt);
    797 	vsnprintf(buf, 256, fmt, ap);
    798 	va_end(ap);
    799 
    800 	cp = gp->g_fbkva;
    801 	ncols = gp->g_display.gd_fbwidth / 8;
    802 	cp += (crow * ncols + ccol) << 2;
    803 	for (bp = buf; *bp != '\0'; bp++) {
    804 		if (*bp == '\n') {
    805 			ccol = 0;
    806 			crow++;
    807 			continue;
    808 		}
    809 		*cp++ = *bp;
    810 		*cp = 0x0a;
    811 		cp += 3;
    812 		ccol++;
    813 	}
    814 }
    815 #endif  /* DEBUG */
    816 
    817 #endif	/* NGRF > 0 */
    818