Home | History | Annotate | Line # | Download | only in sun
      1  1.36   thorpej /*	$NetBSD: cgthree.c,v 1.36 2022/09/25 21:30:29 thorpej Exp $ */
      2   1.1        pk 
      3   1.1        pk /*-
      4   1.1        pk  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5   1.1        pk  * All rights reserved.
      6   1.1        pk  *
      7   1.1        pk  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1        pk  * by Paul Kranenburg.
      9   1.1        pk  *
     10   1.1        pk  * Redistribution and use in source and binary forms, with or without
     11   1.1        pk  * modification, are permitted provided that the following conditions
     12   1.1        pk  * are met:
     13   1.1        pk  * 1. Redistributions of source code must retain the above copyright
     14   1.1        pk  *    notice, this list of conditions and the following disclaimer.
     15   1.1        pk  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1        pk  *    notice, this list of conditions and the following disclaimer in the
     17   1.1        pk  *    documentation and/or other materials provided with the distribution.
     18   1.1        pk  *
     19   1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1        pk  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1        pk  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1        pk  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1        pk  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1        pk  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1        pk  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1        pk  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1        pk  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1        pk  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1        pk  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1        pk  */
     31   1.1        pk 
     32   1.1        pk /*
     33   1.1        pk  * color display (cgthree) driver.
     34   1.1        pk  *
     35   1.1        pk  * Does not handle interrupts, even though they can occur.
     36   1.1        pk  *
     37   1.1        pk  * XXX should defer colormap updates to vertical retrace interrupts
     38   1.1        pk  */
     39   1.4     lukem 
     40   1.4     lukem #include <sys/cdefs.h>
     41  1.36   thorpej __KERNEL_RCSID(0, "$NetBSD: cgthree.c,v 1.36 2022/09/25 21:30:29 thorpej Exp $");
     42   1.1        pk 
     43   1.1        pk #include <sys/param.h>
     44   1.1        pk #include <sys/systm.h>
     45   1.1        pk #include <sys/buf.h>
     46   1.1        pk #include <sys/device.h>
     47   1.1        pk #include <sys/ioctl.h>
     48   1.1        pk #include <sys/mman.h>
     49   1.1        pk #include <sys/tty.h>
     50   1.1        pk #include <sys/conf.h>
     51   1.1        pk 
     52  1.14        ad #include <sys/bus.h>
     53   1.1        pk #include <machine/autoconf.h>
     54   1.1        pk 
     55   1.1        pk #include <dev/sun/fbio.h>
     56   1.1        pk #include <dev/sun/fbvar.h>
     57   1.1        pk 
     58  1.20       jdc #include <dev/sun/btreg.h>
     59  1.20       jdc #include <dev/sun/btvar.h>
     60  1.20       jdc #include <dev/sun/cgthreereg.h>
     61  1.20       jdc #include <dev/sun/cgthreevar.h>
     62  1.20       jdc 
     63  1.17       jdc #if NWSDISPLAY > 0
     64  1.17       jdc #include <dev/wscons/wsconsio.h>
     65  1.17       jdc #include <dev/wsfont/wsfont.h>
     66  1.17       jdc #include <dev/rasops/rasops.h>
     67  1.17       jdc 
     68  1.17       jdc #include "opt_wsemul.h"
     69  1.17       jdc #endif
     70  1.17       jdc 
     71  1.25   tsutsui #include "ioconf.h"
     72  1.25   tsutsui 
     73  1.23    cegger static void	cgthreeunblank(device_t);
     74   1.2        pk static void	cgthreeloadcmap(struct cgthree_softc *, int, int);
     75   1.2        pk static void	cgthree_set_video(struct cgthree_softc *, int);
     76   1.2        pk static int	cgthree_get_video(struct cgthree_softc *);
     77   1.2        pk 
     78   1.5   gehenna dev_type_open(cgthreeopen);
     79   1.5   gehenna dev_type_ioctl(cgthreeioctl);
     80   1.5   gehenna dev_type_mmap(cgthreemmap);
     81   1.5   gehenna 
     82   1.5   gehenna const struct cdevsw cgthree_cdevsw = {
     83  1.30  dholland 	.d_open = cgthreeopen,
     84  1.30  dholland 	.d_close = nullclose,
     85  1.30  dholland 	.d_read = noread,
     86  1.30  dholland 	.d_write = nowrite,
     87  1.30  dholland 	.d_ioctl = cgthreeioctl,
     88  1.30  dholland 	.d_stop = nostop,
     89  1.30  dholland 	.d_tty = notty,
     90  1.30  dholland 	.d_poll = nopoll,
     91  1.30  dholland 	.d_mmap = cgthreemmap,
     92  1.30  dholland 	.d_kqfilter = nokqfilter,
     93  1.31  dholland 	.d_discard = nodiscard,
     94  1.30  dholland 	.d_flag = D_OTHER
     95   1.5   gehenna };
     96   1.1        pk 
     97   1.1        pk /* frame buffer generic driver */
     98   1.1        pk static struct fbdriver cgthreefbdriver = {
     99   1.5   gehenna 	cgthreeunblank, cgthreeopen, nullclose, cgthreeioctl, nopoll,
    100   1.6  jdolecek 	cgthreemmap, nokqfilter
    101   1.1        pk };
    102   1.1        pk 
    103   1.1        pk /* Video control parameters */
    104   1.1        pk struct cg3_videoctrl {
    105   1.1        pk 	unsigned char	sense;		/* Monitor sense value */
    106   1.1        pk 	unsigned char	vctrl[12];
    107   1.1        pk } cg3_videoctrl[] = {
    108   1.1        pk /* Missing entries: sense 0x10, 0x30, 0x50 */
    109   1.1        pk 	{ 0x40, /* this happens to be my 19'' 1152x900 gray-scale monitor */
    110   1.1        pk 	   {0xbb, 0x2b, 0x3, 0xb, 0xb3, 0x3, 0xaf, 0x2b, 0x2, 0xa, 0xff, 0x1}
    111   1.1        pk 	},
    112   1.1        pk 	{ 0x00, /* default? must be last */
    113   1.1        pk 	   {0xbb, 0x2b, 0x3, 0xb, 0xb3, 0x3, 0xaf, 0x2b, 0x2, 0xa, 0xff, 0x1}
    114   1.1        pk 	}
    115   1.1        pk };
    116   1.1        pk 
    117  1.17       jdc static void cg3_setup_palette(struct cgthree_softc *);
    118  1.17       jdc 
    119  1.17       jdc struct wsscreen_descr cgthree_defaultscreen = {
    120  1.17       jdc 	"std",
    121  1.17       jdc 	0, 0,	/* will be filled in -- XXX shouldn't, it's global */
    122  1.17       jdc 	NULL,		/* textops */
    123  1.17       jdc 	8, 16,	/* font width/height */
    124  1.17       jdc 	WSSCREEN_WSCOLORS,	/* capabilities */
    125  1.17       jdc 	NULL	/* modecookie */
    126  1.17       jdc };
    127  1.17       jdc 
    128  1.17       jdc static int 	cgthree_ioctl(void *, void *, u_long, void *, int, struct lwp *);
    129  1.17       jdc static paddr_t	cgthree_mmap(void *, void *, off_t, int);
    130  1.17       jdc static void	cgthree_init_screen(void *, struct vcons_screen *, int, long *);
    131  1.17       jdc 
    132  1.17       jdc int	cgthree_putcmap(struct cgthree_softc *, struct wsdisplay_cmap *);
    133  1.17       jdc int	cgthree_getcmap(struct cgthree_softc *, struct wsdisplay_cmap *);
    134  1.17       jdc 
    135  1.17       jdc struct wsdisplay_accessops cgthree_accessops = {
    136  1.17       jdc 	cgthree_ioctl,
    137  1.17       jdc 	cgthree_mmap,
    138  1.17       jdc 	NULL,	/* alloc_screen */
    139  1.17       jdc 	NULL,	/* free_screen */
    140  1.17       jdc 	NULL,	/* show_screen */
    141  1.17       jdc 	NULL, 	/* load_font */
    142  1.17       jdc 	NULL,	/* pollc */
    143  1.17       jdc 	NULL	/* scroll */
    144  1.17       jdc };
    145  1.17       jdc 
    146  1.17       jdc const struct wsscreen_descr *_cgthree_scrlist[] = {
    147  1.17       jdc 	&cgthree_defaultscreen
    148  1.17       jdc };
    149  1.17       jdc 
    150  1.17       jdc struct wsscreen_list cgthree_screenlist = {
    151  1.17       jdc 	sizeof(_cgthree_scrlist) / sizeof(struct wsscreen_descr *),
    152  1.17       jdc 	_cgthree_scrlist
    153  1.17       jdc };
    154  1.17       jdc 
    155  1.17       jdc 
    156  1.17       jdc extern const u_char rasops_cmap[768];
    157  1.17       jdc 
    158  1.17       jdc static struct vcons_screen cg3_console_screen;
    159   1.1        pk 
    160   1.1        pk void
    161  1.21       dsl cgthreeattach(struct cgthree_softc *sc, const char *name, int isconsole)
    162   1.1        pk {
    163   1.1        pk 	int i;
    164   1.1        pk 	struct fbdevice *fb = &sc->sc_fb;
    165  1.17       jdc 	struct wsemuldisplaydev_attach_args aa;
    166  1.17       jdc 	struct rasops_info *ri = &cg3_console_screen.scr_ri;
    167  1.17       jdc 	unsigned long defattr;
    168   1.1        pk 	volatile struct fbcontrol *fbc = sc->sc_fbc;
    169   1.1        pk 	volatile struct bt_regs *bt = &fbc->fbc_dac;
    170   1.1        pk 
    171   1.1        pk 	fb->fb_driver = &cgthreefbdriver;
    172   1.1        pk 	fb->fb_type.fb_cmsize = 256;
    173   1.1        pk 	fb->fb_type.fb_size = fb->fb_type.fb_height * fb->fb_linebytes;
    174   1.1        pk 	printf(": %s, %d x %d", name,
    175   1.1        pk 		fb->fb_type.fb_width, fb->fb_type.fb_height);
    176   1.1        pk 
    177   1.1        pk 	/* Transfer video magic to board, if it's not running */
    178   1.1        pk 	if ((fbc->fbc_ctrl & FBC_TIMING) == 0) {
    179   1.1        pk 		int sense = (fbc->fbc_status & FBS_MSENSE);
    180   1.1        pk 		/* Search table for video timings fitting this monitor */
    181   1.1        pk 		for (i = 0; i < sizeof(cg3_videoctrl)/sizeof(cg3_videoctrl[0]);
    182   1.1        pk 		     i++) {
    183   1.1        pk 			int j;
    184   1.1        pk 			if (sense != cg3_videoctrl[i].sense)
    185   1.1        pk 				continue;
    186   1.1        pk 
    187   1.1        pk 			printf(" setting video ctrl");
    188   1.1        pk 			for (j = 0; j < 12; j++)
    189   1.1        pk 				fbc->fbc_vcontrol[j] =
    190   1.1        pk 					cg3_videoctrl[i].vctrl[j];
    191   1.1        pk 			fbc->fbc_ctrl |= FBC_TIMING;
    192   1.1        pk 			break;
    193   1.1        pk 		}
    194   1.1        pk 	}
    195   1.1        pk 
    196   1.1        pk 	/* make sure we are not blanked */
    197   1.1        pk 	cgthree_set_video(sc, 1);
    198   1.1        pk 	BT_INIT(bt, 0);
    199   1.1        pk 
    200   1.1        pk 	if (isconsole) {
    201   1.1        pk 		printf(" (console)\n");
    202   1.1        pk 	} else
    203   1.1        pk 		printf("\n");
    204   1.1        pk 
    205   1.1        pk 	fb_attach(fb, isconsole);
    206  1.17       jdc 
    207  1.17       jdc 	sc->sc_width = fb->fb_type.fb_width;
    208  1.17       jdc 	sc->sc_stride = fb->fb_type.fb_width;
    209  1.17       jdc 	sc->sc_height = fb->fb_type.fb_height;
    210  1.17       jdc 
    211  1.17       jdc 	/* setup rasops and so on for wsdisplay */
    212  1.17       jdc 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    213  1.17       jdc 
    214  1.17       jdc 	vcons_init(&sc->vd, sc, &cgthree_defaultscreen, &cgthree_accessops);
    215  1.17       jdc 	sc->vd.init_screen = cgthree_init_screen;
    216  1.17       jdc 
    217  1.17       jdc 	if(isconsole) {
    218  1.17       jdc 		/* we mess with cg3_console_screen only once */
    219  1.17       jdc 		vcons_init_screen(&sc->vd, &cg3_console_screen, 1,
    220  1.17       jdc 		    &defattr);
    221  1.28  macallan 		memset(sc->sc_fb.fb_pixels, (defattr >> 16) & 0xff,
    222  1.28  macallan 		    sc->sc_stride * sc->sc_height);
    223  1.17       jdc 		cg3_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    224  1.19       jdc 
    225  1.17       jdc 		cgthree_defaultscreen.textops = &ri->ri_ops;
    226  1.17       jdc 		cgthree_defaultscreen.capabilities = ri->ri_caps;
    227  1.17       jdc 		cgthree_defaultscreen.nrows = ri->ri_rows;
    228  1.17       jdc 		cgthree_defaultscreen.ncols = ri->ri_cols;
    229  1.17       jdc 		sc->vd.active = &cg3_console_screen;
    230  1.19       jdc 		wsdisplay_cnattach(&cgthree_defaultscreen, ri, 0, 0, defattr);
    231  1.28  macallan 		vcons_replay_msgbuf(&cg3_console_screen);
    232  1.17       jdc 	} else {
    233  1.17       jdc 		/*
    234  1.17       jdc 		 * we're not the console so we just clear the screen and don't
    235  1.17       jdc 		 * set up any sort of text display
    236  1.17       jdc 		 */
    237  1.17       jdc 	}
    238  1.17       jdc 
    239  1.17       jdc 	/* Initialize the default color map. */
    240  1.17       jdc 	cg3_setup_palette(sc);
    241  1.19       jdc 
    242  1.17       jdc 	aa.scrdata = &cgthree_screenlist;
    243  1.17       jdc 	aa.console = isconsole;
    244  1.17       jdc 	aa.accessops = &cgthree_accessops;
    245  1.17       jdc 	aa.accesscookie = &sc->vd;
    246  1.35   thorpej 	config_found(sc->sc_dev, &aa, wsemuldisplaydevprint, CFARGS_NONE);
    247   1.1        pk }
    248   1.1        pk 
    249   1.1        pk 
    250   1.1        pk int
    251  1.22       dsl cgthreeopen(dev_t dev, int flags, int mode, struct lwp *l)
    252   1.1        pk {
    253   1.1        pk 	int unit = minor(dev);
    254   1.1        pk 
    255  1.16  drochner 	if (device_lookup(&cgthree_cd, unit) == NULL)
    256   1.1        pk 		return (ENXIO);
    257   1.1        pk 	return (0);
    258   1.1        pk }
    259   1.1        pk 
    260   1.1        pk int
    261  1.21       dsl cgthreeioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
    262   1.1        pk {
    263  1.16  drochner 	struct cgthree_softc *sc = device_lookup_private(&cgthree_cd,
    264  1.16  drochner 							 minor(dev));
    265   1.1        pk 	struct fbgattr *fba;
    266   1.1        pk 	int error;
    267   1.1        pk 
    268   1.1        pk 	switch (cmd) {
    269   1.1        pk 
    270   1.1        pk 	case FBIOGTYPE:
    271   1.1        pk 		*(struct fbtype *)data = sc->sc_fb.fb_type;
    272   1.1        pk 		break;
    273   1.1        pk 
    274   1.1        pk 	case FBIOGATTR:
    275   1.1        pk 		fba = (struct fbgattr *)data;
    276   1.1        pk 		fba->real_type = sc->sc_fb.fb_type.fb_type;
    277   1.1        pk 		fba->owner = 0;		/* XXX ??? */
    278   1.1        pk 		fba->fbtype = sc->sc_fb.fb_type;
    279   1.1        pk 		fba->sattr.flags = 0;
    280   1.1        pk 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
    281   1.1        pk 		fba->sattr.dev_specific[0] = -1;
    282   1.1        pk 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
    283   1.1        pk 		fba->emu_types[1] = -1;
    284   1.1        pk 		break;
    285   1.1        pk 
    286   1.1        pk 	case FBIOGETCMAP:
    287   1.1        pk #define p ((struct fbcmap *)data)
    288   1.1        pk 		return (bt_getcmap(p, &sc->sc_cmap, 256, 1));
    289   1.1        pk 
    290   1.1        pk 	case FBIOPUTCMAP:
    291   1.1        pk 		/* copy to software map */
    292   1.1        pk 		error = bt_putcmap(p, &sc->sc_cmap, 256, 1);
    293   1.1        pk 		if (error)
    294   1.1        pk 			return (error);
    295   1.1        pk 		/* now blast them into the chip */
    296   1.1        pk 		/* XXX should use retrace interrupt */
    297   1.1        pk 		cgthreeloadcmap(sc, p->index, p->count);
    298   1.1        pk #undef p
    299   1.1        pk 		break;
    300   1.1        pk 
    301   1.1        pk 	case FBIOGVIDEO:
    302   1.1        pk 		*(int *)data = cgthree_get_video(sc);
    303   1.1        pk 		break;
    304   1.1        pk 
    305   1.1        pk 	case FBIOSVIDEO:
    306   1.1        pk 		cgthree_set_video(sc, *(int *)data);
    307   1.1        pk 		break;
    308   1.1        pk 
    309   1.1        pk 	default:
    310   1.1        pk 		return (ENOTTY);
    311   1.1        pk 	}
    312   1.1        pk 	return (0);
    313   1.1        pk }
    314   1.1        pk 
    315   1.1        pk /*
    316   1.1        pk  * Undo the effect of an FBIOSVIDEO that turns the video off.
    317   1.1        pk  */
    318   1.1        pk static void
    319  1.24   tsutsui cgthreeunblank(device_t self)
    320   1.1        pk {
    321  1.24   tsutsui 	struct cgthree_softc *sc = device_private(self);
    322   1.1        pk 
    323  1.24   tsutsui 	cgthree_set_video(sc, 1);
    324   1.1        pk }
    325   1.1        pk 
    326   1.1        pk static void
    327  1.21       dsl cgthree_set_video(struct cgthree_softc *sc, int enable)
    328   1.1        pk {
    329   1.1        pk 
    330   1.1        pk 	if (enable)
    331   1.1        pk 		sc->sc_fbc->fbc_ctrl |= FBC_VENAB;
    332   1.1        pk 	else
    333   1.1        pk 		sc->sc_fbc->fbc_ctrl &= ~FBC_VENAB;
    334   1.1        pk }
    335   1.1        pk 
    336   1.1        pk static int
    337  1.21       dsl cgthree_get_video(struct cgthree_softc *sc)
    338   1.1        pk {
    339   1.1        pk 
    340   1.1        pk 	return ((sc->sc_fbc->fbc_ctrl & FBC_VENAB) != 0);
    341   1.1        pk }
    342   1.1        pk 
    343   1.1        pk /*
    344   1.1        pk  * Load a subset of the current (new) colormap into the Brooktree DAC.
    345   1.1        pk  */
    346   1.1        pk static void
    347  1.22       dsl cgthreeloadcmap(struct cgthree_softc *sc, int start, int ncolors)
    348   1.1        pk {
    349   1.1        pk 	volatile struct bt_regs *bt;
    350   1.1        pk 	u_int *ip;
    351   1.1        pk 	int count;
    352   1.1        pk 
    353   1.1        pk 	ip = &sc->sc_cmap.cm_chip[BT_D4M3(start)];	/* start/4 * 3 */
    354   1.1        pk 	count = BT_D4M3(start + ncolors - 1) - BT_D4M3(start) + 3;
    355   1.1        pk 	bt = &sc->sc_fbc->fbc_dac;
    356   1.1        pk 	bt->bt_addr = BT_D4M4(start);
    357   1.1        pk 	while (--count >= 0)
    358   1.1        pk 		bt->bt_cmap = *ip++;
    359   1.1        pk }
    360   1.1        pk 
    361   1.1        pk /*
    362   1.1        pk  * Return the address that would map the given device at the given
    363   1.1        pk  * offset, allowing for the given protection, or return -1 for error.
    364   1.1        pk  *
    365   1.1        pk  * The cg3 is mapped starting at 256KB, for pseudo-compatibility with
    366   1.1        pk  * the cg4 (which had an overlay plane in the first 128K and an enable
    367   1.1        pk  * plane in the next 128K).  X11 uses only 256k+ region but tries to
    368   1.1        pk  * map the whole thing, so we repeatedly map the first 256K to the
    369   1.1        pk  * first page of the color screen.  If someone tries to use the overlay
    370   1.1        pk  * and enable regions, they will get a surprise....
    371   1.1        pk  *
    372   1.1        pk  * As well, mapping at an offset of 0x04000000 causes the cg3 to be
    373   1.1        pk  * mapped in flat mode without the cg4 emulation.
    374   1.1        pk  */
    375   1.1        pk paddr_t
    376  1.21       dsl cgthreemmap(dev_t dev, off_t off, int prot)
    377   1.1        pk {
    378  1.16  drochner 	struct cgthree_softc *sc = device_lookup_private(&cgthree_cd,
    379  1.16  drochner 							 minor(dev));
    380   1.1        pk 
    381   1.1        pk #define START		(128*1024 + 128*1024)
    382   1.1        pk #define NOOVERLAY	(0x04000000)
    383   1.1        pk 
    384   1.1        pk 	if (off & PGOFSET)
    385   1.1        pk 		panic("cgthreemmap");
    386   1.1        pk 	if (off < 0)
    387   1.1        pk 		return (-1);
    388   1.1        pk 	if ((u_int)off >= NOOVERLAY)
    389   1.1        pk 		off -= NOOVERLAY;
    390   1.1        pk 	else if ((u_int)off >= START)
    391   1.1        pk 		off -= START;
    392   1.1        pk 	else
    393   1.1        pk 		off = 0;
    394   1.1        pk 
    395   1.1        pk 	if (off >= sc->sc_fb.fb_type.fb_size)
    396   1.1        pk 		return (-1);
    397   1.1        pk 
    398   1.3       eeh 	return (bus_space_mmap(sc->sc_bustag,
    399   1.3       eeh 		sc->sc_paddr, CG3REG_MEM + off,
    400   1.3       eeh 		prot, BUS_SPACE_MAP_LINEAR));
    401   1.1        pk }
    402  1.17       jdc 
    403  1.17       jdc static void
    404  1.17       jdc cg3_setup_palette(struct cgthree_softc *sc)
    405  1.17       jdc {
    406  1.17       jdc 	int i, j;
    407  1.19       jdc 
    408  1.17       jdc 	j = 0;
    409  1.17       jdc 	for (i = 0; i < 256; i++) {
    410  1.17       jdc 		sc->sc_cmap.cm_map[i][0] = rasops_cmap[j];
    411  1.17       jdc 		j++;
    412  1.17       jdc 		sc->sc_cmap.cm_map[i][1] = rasops_cmap[j];
    413  1.17       jdc 		j++;
    414  1.17       jdc 		sc->sc_cmap.cm_map[i][2] = rasops_cmap[j];
    415  1.17       jdc 		j++;
    416  1.17       jdc 	}
    417  1.17       jdc 	cgthreeloadcmap(sc, 0, 256);
    418  1.17       jdc }
    419  1.17       jdc 
    420  1.17       jdc int
    421  1.17       jdc cgthree_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    422  1.17       jdc 	struct lwp *l)
    423  1.17       jdc {
    424  1.17       jdc 	/* we'll probably need to add more stuff here */
    425  1.17       jdc 	struct vcons_data *vd = v;
    426  1.17       jdc 	struct cgthree_softc *sc = vd->cookie;
    427  1.17       jdc 	struct wsdisplay_fbinfo *wdf;
    428  1.17       jdc 	struct vcons_screen *ms = sc->vd.active;
    429  1.32  macallan 	struct rasops_info *ri = &ms->scr_ri;
    430  1.17       jdc 	switch (cmd) {
    431  1.17       jdc 		case WSDISPLAYIO_GTYPE:
    432  1.17       jdc 			*(u_int *)data = WSDISPLAY_TYPE_SUNTCX;
    433  1.17       jdc 			return 0;
    434  1.17       jdc 		case WSDISPLAYIO_GINFO:
    435  1.17       jdc 			wdf = (void *)data;
    436  1.17       jdc 			wdf->height = ri->ri_height;
    437  1.17       jdc 			wdf->width = ri->ri_width;
    438  1.33  macallan 			wdf->depth = 8;
    439  1.17       jdc 			wdf->cmsize = 256;
    440  1.17       jdc 			return 0;
    441  1.17       jdc 
    442  1.17       jdc 		case WSDISPLAYIO_GETCMAP:
    443  1.17       jdc 			return cgthree_getcmap(sc,
    444  1.17       jdc 			    (struct wsdisplay_cmap *)data);
    445  1.17       jdc 		case WSDISPLAYIO_PUTCMAP:
    446  1.17       jdc 			return cgthree_putcmap(sc,
    447  1.17       jdc 			    (struct wsdisplay_cmap *)data);
    448  1.17       jdc 
    449  1.17       jdc 		case WSDISPLAYIO_SMODE:
    450  1.17       jdc 			{
    451  1.17       jdc 				int new_mode = *(int*)data;
    452  1.17       jdc 				if (new_mode != sc->sc_mode)
    453  1.17       jdc 				{
    454  1.17       jdc 					sc->sc_mode = new_mode;
    455  1.17       jdc 					if(new_mode == WSDISPLAYIO_MODE_EMUL)
    456  1.17       jdc 					{
    457  1.17       jdc 						cg3_setup_palette(sc);
    458  1.17       jdc 						vcons_redraw_screen(ms);
    459  1.17       jdc 					}
    460  1.17       jdc 				}
    461  1.17       jdc 			}
    462  1.32  macallan 			return 0;
    463  1.32  macallan 		case WSDISPLAYIO_GET_FBINFO:
    464  1.32  macallan 			{
    465  1.32  macallan 				struct wsdisplayio_fbinfo *fbi = data;
    466  1.32  macallan 
    467  1.32  macallan 				return wsdisplayio_get_fbinfo(&ms->scr_ri, fbi);
    468  1.32  macallan 			}
    469  1.17       jdc 	}
    470  1.17       jdc 	return EPASSTHROUGH;
    471  1.17       jdc }
    472  1.17       jdc 
    473  1.17       jdc paddr_t
    474  1.17       jdc cgthree_mmap(void *v, void *vs, off_t offset, int prot)
    475  1.17       jdc {
    476  1.33  macallan 	struct vcons_data *vd = v;
    477  1.33  macallan 	struct cgthree_softc *sc = vd->cookie;
    478  1.33  macallan 
    479  1.33  macallan 	if (offset < 0) return -1;
    480  1.33  macallan 	if (offset >= sc->sc_fb.fb_type.fb_size)
    481  1.33  macallan 		return -1;
    482  1.33  macallan 
    483  1.33  macallan 	return bus_space_mmap(sc->sc_bustag,
    484  1.33  macallan 		sc->sc_paddr, CG3REG_MEM + offset,
    485  1.33  macallan 		prot, BUS_SPACE_MAP_LINEAR);
    486  1.17       jdc }
    487  1.17       jdc 
    488  1.17       jdc int
    489  1.17       jdc cgthree_putcmap(struct cgthree_softc *sc, struct wsdisplay_cmap *cm)
    490  1.17       jdc {
    491  1.17       jdc 	u_int index = cm->index;
    492  1.17       jdc 	u_int count = cm->count;
    493  1.17       jdc 	int error,i;
    494  1.17       jdc 	if (index >= 256 || count > 256 || index + count > 256)
    495  1.17       jdc 		return EINVAL;
    496  1.17       jdc 
    497  1.17       jdc 	for (i = 0; i < count; i++)
    498  1.17       jdc 	{
    499  1.17       jdc 		error = copyin(&cm->red[i],
    500  1.17       jdc 		    &sc->sc_cmap.cm_map[index + i][0], 1);
    501  1.17       jdc 		if (error)
    502  1.17       jdc 			return error;
    503  1.17       jdc 		error = copyin(&cm->green[i],
    504  1.17       jdc 		    &sc->sc_cmap.cm_map[index + i][1],
    505  1.17       jdc 		    1);
    506  1.17       jdc 		if (error)
    507  1.17       jdc 			return error;
    508  1.17       jdc 		error = copyin(&cm->blue[i],
    509  1.17       jdc 		    &sc->sc_cmap.cm_map[index + i][2], 1);
    510  1.17       jdc 		if (error)
    511  1.17       jdc 			return error;
    512  1.17       jdc 	}
    513  1.17       jdc 	cgthreeloadcmap(sc, index, count);
    514  1.17       jdc 
    515  1.17       jdc 	return 0;
    516  1.17       jdc }
    517  1.17       jdc 
    518  1.17       jdc int
    519  1.17       jdc cgthree_getcmap(struct cgthree_softc *sc, struct wsdisplay_cmap *cm)
    520  1.17       jdc {
    521  1.17       jdc 	u_int index = cm->index;
    522  1.17       jdc 	u_int count = cm->count;
    523  1.17       jdc 	int error,i;
    524  1.17       jdc 
    525  1.17       jdc 	if (index >= 256 || count > 256 || index + count > 256)
    526  1.17       jdc 		return EINVAL;
    527  1.17       jdc 
    528  1.17       jdc 	for (i = 0; i < count; i++)
    529  1.17       jdc 	{
    530  1.17       jdc 		error = copyout(&sc->sc_cmap.cm_map[index + i][0],
    531  1.17       jdc 		    &cm->red[i], 1);
    532  1.17       jdc 		if (error)
    533  1.17       jdc 			return error;
    534  1.17       jdc 		error = copyout(&sc->sc_cmap.cm_map[index + i][1],
    535  1.17       jdc 		    &cm->green[i], 1);
    536  1.17       jdc 		if (error)
    537  1.17       jdc 			return error;
    538  1.17       jdc 		error = copyout(&sc->sc_cmap.cm_map[index + i][2],
    539  1.17       jdc 		    &cm->blue[i], 1);
    540  1.17       jdc 		if (error)
    541  1.17       jdc 			return error;
    542  1.17       jdc 	}
    543  1.17       jdc 
    544  1.17       jdc 	return 0;
    545  1.17       jdc }
    546  1.17       jdc 
    547  1.17       jdc void
    548  1.17       jdc cgthree_init_screen(void *cookie, struct vcons_screen *scr,
    549  1.17       jdc     int existing, long *defattr)
    550  1.17       jdc {
    551  1.17       jdc 	struct cgthree_softc *sc = cookie;
    552  1.17       jdc 	struct rasops_info *ri = &scr->scr_ri;
    553  1.17       jdc 
    554  1.27  macallan 	scr->scr_flags |= VCONS_DONT_READ;
    555  1.27  macallan 
    556  1.17       jdc 	ri->ri_depth = 8;
    557  1.17       jdc 	ri->ri_width = sc->sc_width;
    558  1.17       jdc 	ri->ri_height = sc->sc_height;
    559  1.17       jdc 	ri->ri_stride = sc->sc_stride;
    560  1.19       jdc 	ri->ri_flg = RI_CENTER;
    561  1.17       jdc 
    562  1.17       jdc 	ri->ri_bits = sc->sc_fb.fb_pixels;
    563  1.19       jdc 
    564  1.29  macallan 	rasops_init(ri, 0, 0);
    565  1.17       jdc 	ri->ri_caps = WSSCREEN_WSCOLORS | WSSCREEN_REVERSE;
    566  1.17       jdc 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    567  1.17       jdc 		    sc->sc_width / ri->ri_font->fontwidth);
    568  1.17       jdc 
    569  1.17       jdc 	ri->ri_hw = scr;
    570  1.17       jdc }
    571