Home | History | Annotate | Line # | Download | only in dev
gfb.c revision 1.7.2.1
      1  1.7.2.1  jdolecek /*	$NetBSD: gfb.c,v 1.7.2.1 2017/12/03 11:36:44 jdolecek Exp $	*/
      2      1.1  macallan 
      3      1.1  macallan /*
      4      1.1  macallan  * Copyright (c) 2009 Michael Lorenz
      5      1.1  macallan  * All rights reserved.
      6      1.1  macallan  *
      7      1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8      1.1  macallan  * modification, are permitted provided that the following conditions
      9      1.1  macallan  * are met:
     10      1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11      1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12      1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13      1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14      1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15      1.1  macallan  *
     16      1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17      1.1  macallan  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18      1.1  macallan  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19      1.1  macallan  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20      1.1  macallan  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21      1.1  macallan  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22      1.1  macallan  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23      1.1  macallan  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24      1.1  macallan  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25      1.1  macallan  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26      1.1  macallan  */
     27      1.1  macallan 
     28      1.1  macallan /*
     29      1.1  macallan  * A console driver for Sun XVR-1000 graphics cards
     30      1.1  macallan  */
     31      1.1  macallan 
     32      1.1  macallan #include <sys/cdefs.h>
     33  1.7.2.1  jdolecek __KERNEL_RCSID(0, "$NetBSD: gfb.c,v 1.7.2.1 2017/12/03 11:36:44 jdolecek Exp $");
     34      1.1  macallan 
     35      1.1  macallan #include <sys/param.h>
     36      1.1  macallan #include <sys/systm.h>
     37      1.1  macallan #include <sys/kernel.h>
     38      1.1  macallan #include <sys/device.h>
     39      1.1  macallan #include <sys/malloc.h>
     40      1.1  macallan #include <sys/lwp.h>
     41      1.1  macallan #include <sys/kauth.h>
     42      1.1  macallan #include <sys/kmem.h>
     43      1.1  macallan 
     44      1.1  macallan #include <uvm/uvm_extern.h>
     45      1.1  macallan 
     46      1.1  macallan #include <dev/videomode/videomode.h>
     47      1.1  macallan 
     48      1.4    dyoung #include <sys/bus.h>
     49      1.1  macallan #include <machine/autoconf.h>
     50      1.1  macallan #include <machine/openfirm.h>
     51      1.1  macallan 
     52      1.1  macallan #include <dev/wscons/wsdisplayvar.h>
     53      1.1  macallan #include <dev/wscons/wsconsio.h>
     54      1.1  macallan #include <dev/wsfont/wsfont.h>
     55      1.1  macallan #include <dev/rasops/rasops.h>
     56      1.1  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     57      1.1  macallan 
     58      1.1  macallan 
     59      1.1  macallan struct gfb_softc {
     60      1.1  macallan 	device_t sc_dev;
     61      1.1  macallan 
     62      1.1  macallan 	bus_space_tag_t sc_memt;
     63      1.1  macallan 
     64      1.1  macallan 	bus_space_handle_t sc_fbh;
     65      1.1  macallan 	bus_addr_t sc_fb_paddr;
     66      1.1  macallan 
     67      1.1  macallan 	int sc_width, sc_height, sc_depth, sc_stride, sc_fblen;
     68      1.1  macallan 	int sc_locked;
     69      1.3  macallan 	void *sc_fbaddr;
     70      1.1  macallan 	struct vcons_screen sc_console_screen;
     71      1.1  macallan 	struct wsscreen_descr sc_defaultscreen_descr;
     72      1.1  macallan 	const struct wsscreen_descr *sc_screens[1];
     73      1.1  macallan 	struct wsscreen_list sc_screenlist;
     74      1.1  macallan 	struct vcons_data vd;
     75      1.1  macallan 	int sc_mode;
     76      1.1  macallan 	int sc_node;
     77      1.1  macallan 	u_char sc_cmap_red[256];
     78      1.1  macallan 	u_char sc_cmap_green[256];
     79      1.1  macallan 	u_char sc_cmap_blue[256];
     80      1.1  macallan };
     81      1.1  macallan 
     82      1.1  macallan static int	gfb_match(device_t, cfdata_t, void *);
     83      1.1  macallan static void	gfb_attach(device_t, device_t, void *);
     84      1.1  macallan 
     85      1.1  macallan CFATTACH_DECL_NEW(gfb, sizeof(struct gfb_softc),
     86      1.1  macallan     gfb_match, gfb_attach, NULL, NULL);
     87      1.1  macallan 
     88      1.1  macallan extern const u_char rasops_cmap[768];
     89      1.1  macallan 
     90      1.1  macallan static int	gfb_ioctl(void *, void *, u_long, void *, int,
     91      1.1  macallan 			     struct lwp *);
     92      1.1  macallan static paddr_t	gfb_mmap(void *, void *, off_t, int);
     93      1.1  macallan static void	gfb_init_screen(void *, struct vcons_screen *, int, long *);
     94      1.1  macallan 
     95      1.1  macallan static int	gfb_putcmap(struct gfb_softc *, struct wsdisplay_cmap *);
     96      1.1  macallan static int 	gfb_getcmap(struct gfb_softc *, struct wsdisplay_cmap *);
     97      1.1  macallan static void	gfb_restore_palette(struct gfb_softc *);
     98      1.1  macallan static int 	gfb_putpalreg(struct gfb_softc *, uint8_t, uint8_t,
     99      1.1  macallan 			    uint8_t, uint8_t);
    100      1.1  macallan 
    101      1.1  macallan struct wsdisplay_accessops gfb_accessops = {
    102      1.1  macallan 	gfb_ioctl,
    103      1.1  macallan 	gfb_mmap,
    104      1.1  macallan 	NULL,	/* alloc_screen */
    105      1.1  macallan 	NULL,	/* free_screen */
    106      1.1  macallan 	NULL,	/* show_screen */
    107      1.1  macallan 	NULL, 	/* load_font */
    108      1.1  macallan 	NULL,	/* pollc */
    109      1.1  macallan 	NULL	/* scroll */
    110      1.1  macallan };
    111      1.1  macallan 
    112      1.1  macallan extern int prom_stdout_node;
    113      1.1  macallan 
    114      1.1  macallan static int
    115      1.1  macallan gfb_match(device_t parent, cfdata_t match, void *aux)
    116      1.1  macallan {
    117      1.1  macallan 	struct mainbus_attach_args *ma = aux;
    118      1.1  macallan 
    119      1.1  macallan 	if (strcmp(ma->ma_name, "SUNW,gfb") == 0 )
    120      1.1  macallan 		return 100;
    121      1.1  macallan 	return 0;
    122      1.1  macallan }
    123      1.1  macallan 
    124      1.1  macallan static void
    125      1.1  macallan gfb_attach(device_t parent, device_t self, void *aux)
    126      1.1  macallan {
    127      1.1  macallan 	struct gfb_softc	*sc = device_private(self);
    128      1.1  macallan 	struct mainbus_attach_args	*ma = aux;
    129      1.1  macallan 	struct rasops_info	*ri;
    130      1.1  macallan 	struct wsemuldisplaydev_attach_args aa;
    131      1.1  macallan 	unsigned long		defattr;
    132      1.1  macallan 	bool			is_console;
    133      1.1  macallan 	int i, j;
    134      1.1  macallan 
    135      1.1  macallan 	sc->sc_memt = ma->ma_bustag;
    136      1.1  macallan 	sc->sc_dev = self;
    137      1.1  macallan 	sc->sc_node = ma->ma_node;
    138      1.1  macallan 
    139      1.1  macallan 	if (ma->ma_nreg < 7) {
    140      1.1  macallan 		aprint_error("%s: can't find the fb range\n",
    141      1.1  macallan 		    device_xname(self));
    142      1.1  macallan 		return;
    143      1.1  macallan 	}
    144      1.1  macallan 
    145      1.1  macallan 	is_console = (prom_stdout_node == ma->ma_node);
    146      1.1  macallan 
    147      1.1  macallan 	aprint_normal(": Sun XVR-1000%s\n", is_console ? " (console)" : "");
    148      1.1  macallan 
    149      1.1  macallan 	sc->sc_depth = 32;
    150      1.1  macallan 	sc->sc_stride = 0x4000;
    151      1.1  macallan 	sc->sc_height = prom_getpropint(sc->sc_node, "height", 0);
    152      1.1  macallan 	sc->sc_width = prom_getpropint(sc->sc_node, "width", 0);
    153      1.1  macallan 	sc->sc_fblen = sc->sc_stride * sc->sc_height;
    154      1.1  macallan 
    155      1.1  macallan 	if (sc->sc_fblen == 0) {
    156      1.1  macallan 		aprint_error("%s: not set up by firmware, can't continue.\n",
    157      1.1  macallan 		    device_xname(self));
    158      1.1  macallan 		return;
    159      1.1  macallan 	}
    160      1.1  macallan 
    161      1.1  macallan 	sc->sc_locked = 0;
    162      1.1  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    163      1.1  macallan 
    164      1.1  macallan 	if (bus_space_map(sc->sc_memt, ma->ma_reg[6].ur_paddr,
    165  1.7.2.1  jdolecek 	    sc->sc_fblen, BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_PREFETCHABLE,
    166  1.7.2.1  jdolecek 	    &sc->sc_fbh)) {
    167      1.1  macallan 		printf(": failed to map the framebuffer\n");
    168      1.1  macallan 		return;
    169      1.1  macallan 	}
    170      1.1  macallan 	sc->sc_fbaddr = bus_space_vaddr(sc->sc_memt, sc->sc_fbh);
    171      1.1  macallan 	sc->sc_fb_paddr = ma->ma_reg[6].ur_paddr;
    172      1.1  macallan 
    173      1.1  macallan 	sc->sc_defaultscreen_descr = (struct wsscreen_descr){
    174      1.1  macallan 		"default",
    175      1.1  macallan 		0, 0,
    176      1.1  macallan 		NULL,
    177      1.1  macallan 		8, 16,
    178      1.1  macallan 		WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
    179      1.1  macallan 		NULL
    180      1.1  macallan 	};
    181      1.1  macallan 	sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
    182      1.1  macallan 	sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
    183      1.1  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    184      1.1  macallan 	sc->sc_locked = 0;
    185      1.1  macallan 
    186      1.1  macallan 	vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
    187      1.1  macallan 	    &gfb_accessops);
    188      1.1  macallan 	sc->vd.init_screen = gfb_init_screen;
    189      1.1  macallan 
    190      1.1  macallan 	ri = &sc->sc_console_screen.scr_ri;
    191      1.1  macallan 
    192      1.1  macallan 	j = 0;
    193      1.7  macallan 	for (i = 0; i < 256; i++) {
    194      1.1  macallan 
    195      1.1  macallan 		sc->sc_cmap_red[i] = rasops_cmap[j];
    196      1.1  macallan 		sc->sc_cmap_green[i] = rasops_cmap[j + 1];
    197      1.1  macallan 		sc->sc_cmap_blue[i] = rasops_cmap[j + 2];
    198      1.1  macallan 		gfb_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1],
    199      1.1  macallan 		    rasops_cmap[j + 2]);
    200      1.1  macallan 		j += 3;
    201      1.1  macallan 	}
    202      1.1  macallan 
    203      1.1  macallan 	if (is_console) {
    204      1.1  macallan 		vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
    205      1.1  macallan 		    &defattr);
    206      1.1  macallan 		sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    207      1.1  macallan 
    208      1.1  macallan #if notyet
    209      1.1  macallan 		gfb_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height,
    210      1.1  macallan 		    ri->ri_devcmap[(defattr >> 16) & 0xff]);
    211      1.1  macallan #endif
    212      1.1  macallan 		sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
    213      1.1  macallan 		sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
    214      1.1  macallan 		sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
    215      1.1  macallan 		sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
    216      1.1  macallan 		wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
    217      1.1  macallan 		    defattr);
    218      1.1  macallan 		vcons_replay_msgbuf(&sc->sc_console_screen);
    219      1.1  macallan 	} else {
    220      1.1  macallan 		/*
    221      1.1  macallan 		 * since we're not the console we can postpone the rest
    222      1.1  macallan 		 * until someone actually allocates a screen for us
    223      1.1  macallan 		 */
    224      1.1  macallan 		(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    225      1.1  macallan 	}
    226      1.1  macallan 
    227      1.1  macallan 	aa.console = is_console;
    228      1.1  macallan 	aa.scrdata = &sc->sc_screenlist;
    229      1.1  macallan 	aa.accessops = &gfb_accessops;
    230      1.1  macallan 	aa.accesscookie = &sc->vd;
    231      1.1  macallan 
    232      1.1  macallan 	config_found(sc->sc_dev, &aa, wsemuldisplaydevprint);
    233      1.3  macallan 
    234      1.3  macallan #ifdef GFB_DEBUG
    235      1.3  macallan 	/*
    236      1.3  macallan 	 * now dump a register range
    237      1.3  macallan 	 * try 1, 2 and 4 since they're only 0x2000 each
    238      1.3  macallan 	 */
    239      1.3  macallan 	bus_space_handle_t regh;
    240      1.3  macallan 
    241      1.3  macallan 	if (bus_space_map(sc->sc_memt, ma->ma_reg[3].ur_paddr,
    242      1.3  macallan 	    0x2000, BUS_SPACE_MAP_LINEAR, &regh) == 0) {
    243      1.3  macallan 		for (i = 0; i < 0x200; i += 32) {
    244      1.3  macallan 			printf("%04x", i);
    245      1.3  macallan 			for (j = 0; j < 32; j += 4) {
    246      1.3  macallan 				printf(" %08x", bus_space_read_4(sc->sc_memt,
    247      1.3  macallan 				    regh, i + j));
    248      1.3  macallan 			}
    249  1.7.2.1  jdolecek 			printf("\n");
    250      1.3  macallan 		}
    251      1.3  macallan 		bus_space_unmap(sc->sc_memt, regh, 0x2000);
    252      1.3  macallan 	}
    253      1.3  macallan #endif
    254      1.1  macallan }
    255      1.1  macallan 
    256      1.1  macallan static int
    257      1.1  macallan gfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    258      1.1  macallan 	struct lwp *l)
    259      1.1  macallan {
    260      1.1  macallan 	struct vcons_data *vd = v;
    261      1.1  macallan 	struct gfb_softc *sc = vd->cookie;
    262      1.1  macallan 	struct wsdisplay_fbinfo *wdf;
    263      1.1  macallan 	struct vcons_screen *ms = vd->active;
    264      1.1  macallan 
    265      1.1  macallan 	switch (cmd) {
    266      1.1  macallan 
    267      1.1  macallan 		case WSDISPLAYIO_GTYPE:
    268      1.2  macallan 			*(u_int *)data = WSDISPLAY_TYPE_XVR1000;
    269      1.1  macallan 			return 0;
    270      1.1  macallan 
    271      1.1  macallan 		case WSDISPLAYIO_GINFO:
    272      1.1  macallan 			if (ms == NULL)
    273      1.1  macallan 				return ENODEV;
    274      1.1  macallan 			wdf = (void *)data;
    275      1.1  macallan 			wdf->height = ms->scr_ri.ri_height;
    276      1.1  macallan 			wdf->width = ms->scr_ri.ri_width;
    277      1.1  macallan 			wdf->depth = ms->scr_ri.ri_depth;
    278      1.1  macallan 			wdf->cmsize = 256;
    279      1.1  macallan 			return 0;
    280      1.1  macallan 
    281      1.1  macallan 		case WSDISPLAYIO_GETCMAP:
    282      1.1  macallan 			return gfb_getcmap(sc,
    283      1.1  macallan 			    (struct wsdisplay_cmap *)data);
    284      1.1  macallan 
    285      1.1  macallan 		case WSDISPLAYIO_PUTCMAP:
    286      1.1  macallan 			return gfb_putcmap(sc,
    287      1.1  macallan 			    (struct wsdisplay_cmap *)data);
    288      1.1  macallan 
    289      1.1  macallan 		case WSDISPLAYIO_LINEBYTES:
    290      1.1  macallan 			*(u_int *)data = sc->sc_stride;
    291      1.1  macallan 			return 0;
    292      1.1  macallan 
    293      1.1  macallan 		case WSDISPLAYIO_SMODE:
    294      1.1  macallan 			{
    295      1.1  macallan 				int new_mode = *(int*)data;
    296      1.1  macallan 
    297      1.1  macallan 				/* notify the bus backend */
    298      1.1  macallan 				if (new_mode != sc->sc_mode) {
    299      1.1  macallan 					sc->sc_mode = new_mode;
    300      1.1  macallan 					if(new_mode == WSDISPLAYIO_MODE_EMUL) {
    301      1.1  macallan 						gfb_restore_palette(sc);
    302      1.1  macallan 						vcons_redraw_screen(ms);
    303      1.1  macallan 					}
    304      1.1  macallan 				}
    305      1.1  macallan 			}
    306      1.1  macallan 			return 0;
    307  1.7.2.1  jdolecek 		case WSDISPLAYIO_GET_FBINFO:
    308  1.7.2.1  jdolecek 			{
    309  1.7.2.1  jdolecek 				struct wsdisplayio_fbinfo *fbi = data;
    310  1.7.2.1  jdolecek 				return wsdisplayio_get_fbinfo(&ms->scr_ri, fbi);
    311  1.7.2.1  jdolecek 			}
    312      1.1  macallan 	}
    313      1.1  macallan 	return EPASSTHROUGH;
    314      1.1  macallan }
    315      1.1  macallan 
    316      1.1  macallan static paddr_t
    317      1.1  macallan gfb_mmap(void *v, void *vs, off_t offset, int prot)
    318      1.1  macallan {
    319      1.1  macallan 	struct vcons_data *vd = v;
    320      1.1  macallan 	struct gfb_softc *sc = vd->cookie;
    321      1.1  macallan 	paddr_t pa;
    322      1.1  macallan 
    323      1.1  macallan 	/* 'regular' framebuffer mmap()ing */
    324      1.1  macallan 	if (offset < sc->sc_fblen) {
    325  1.7.2.1  jdolecek 		/*
    326  1.7.2.1  jdolecek 		 * XXX
    327  1.7.2.1  jdolecek 		 * BUS_SPACE_MAP_PREFETCHABLE produces artifacts with X, but
    328  1.7.2.1  jdolecek 		 * not with the console code, so don't set it here
    329  1.7.2.1  jdolecek 		 */
    330      1.1  macallan 		pa = bus_space_mmap(sc->sc_memt, sc->sc_fb_paddr + offset, 0,
    331      1.1  macallan 		    prot, BUS_SPACE_MAP_LINEAR);
    332      1.1  macallan 		return pa;
    333      1.1  macallan 	}
    334      1.1  macallan 
    335      1.1  macallan 	/*
    336      1.1  macallan 	 * restrict all other mappings to processes with superuser privileges
    337      1.1  macallan 	 * or the kernel itself
    338      1.1  macallan 	 */
    339      1.6      elad 	if (kauth_authorize_machdep(kauth_cred_get(), KAUTH_MACHDEP_UNMANAGEDMEM,
    340      1.6      elad 	    NULL, NULL, NULL, NULL) != 0) {
    341      1.1  macallan 		aprint_normal("%s: mmap() rejected.\n",
    342      1.1  macallan 		    device_xname(sc->sc_dev));
    343      1.1  macallan 		return -1;
    344      1.1  macallan 	}
    345      1.1  macallan 
    346      1.1  macallan 	/* let userland map other ranges */
    347      1.1  macallan 
    348      1.1  macallan 	return -1;
    349      1.1  macallan }
    350      1.1  macallan 
    351      1.1  macallan static void
    352      1.1  macallan gfb_init_screen(void *cookie, struct vcons_screen *scr,
    353      1.1  macallan     int existing, long *defattr)
    354      1.1  macallan {
    355      1.1  macallan 	struct gfb_softc *sc = cookie;
    356      1.1  macallan 	struct rasops_info *ri = &scr->scr_ri;
    357      1.1  macallan 
    358      1.1  macallan 	ri->ri_depth = sc->sc_depth;
    359      1.1  macallan 	ri->ri_width = sc->sc_width;
    360      1.1  macallan 	ri->ri_height = sc->sc_height;
    361      1.1  macallan 	ri->ri_stride = sc->sc_stride;
    362      1.7  macallan 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR | RI_ENABLE_ALPHA;
    363      1.1  macallan 
    364      1.3  macallan 	ri->ri_bits = (char *)sc->sc_fbaddr;
    365      1.3  macallan 	scr->scr_flags |= VCONS_DONT_READ;
    366      1.1  macallan 
    367      1.1  macallan 	if (existing) {
    368      1.1  macallan 		ri->ri_flg |= RI_CLEAR;
    369      1.1  macallan 	}
    370      1.1  macallan 
    371      1.7  macallan 	/* explicitly request BGR in case the default changes */
    372      1.7  macallan 	ri->ri_rnum = 8;
    373      1.7  macallan 	ri->ri_gnum = 8;
    374      1.7  macallan 	ri->ri_bnum = 8;
    375      1.7  macallan 	ri->ri_rpos = 0;
    376      1.7  macallan 	ri->ri_gpos = 8;
    377      1.7  macallan 	ri->ri_bpos = 16;
    378      1.7  macallan 
    379      1.5  macallan 	rasops_init(ri, 0, 0);
    380      1.1  macallan 	ri->ri_caps = WSSCREEN_WSCOLORS;
    381      1.1  macallan 
    382      1.1  macallan 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    383      1.1  macallan 		    sc->sc_width / ri->ri_font->fontwidth);
    384      1.1  macallan 
    385      1.1  macallan 	ri->ri_hw = scr;
    386      1.1  macallan #if 0
    387      1.1  macallan 	ri->ri_ops.copyrows = gfb_copyrows;
    388      1.1  macallan 	ri->ri_ops.copycols = gfb_copycols;
    389      1.1  macallan 	ri->ri_ops.cursor = gfb_cursor;
    390      1.1  macallan 	ri->ri_ops.eraserows = gfb_eraserows;
    391      1.1  macallan 	ri->ri_ops.erasecols = gfb_erasecols;
    392      1.1  macallan 	ri->ri_ops.putchar = gfb_putchar;
    393      1.1  macallan #endif
    394      1.1  macallan }
    395      1.1  macallan 
    396      1.1  macallan static int
    397      1.1  macallan gfb_putcmap(struct gfb_softc *sc, struct wsdisplay_cmap *cm)
    398      1.1  macallan {
    399      1.1  macallan 	u_char *r, *g, *b;
    400      1.1  macallan 	u_int index = cm->index;
    401      1.1  macallan 	u_int count = cm->count;
    402      1.1  macallan 	int i, error;
    403      1.1  macallan 	u_char rbuf[256], gbuf[256], bbuf[256];
    404      1.1  macallan 
    405      1.1  macallan #ifdef GFB_DEBUG
    406      1.1  macallan 	aprint_debug("putcmap: %d %d\n",index, count);
    407      1.1  macallan #endif
    408      1.1  macallan 	if (cm->index >= 256 || cm->count > 256 ||
    409      1.1  macallan 	    (cm->index + cm->count) > 256)
    410      1.1  macallan 		return EINVAL;
    411      1.1  macallan 	error = copyin(cm->red, &rbuf[index], count);
    412      1.1  macallan 	if (error)
    413      1.1  macallan 		return error;
    414      1.1  macallan 	error = copyin(cm->green, &gbuf[index], count);
    415      1.1  macallan 	if (error)
    416      1.1  macallan 		return error;
    417      1.1  macallan 	error = copyin(cm->blue, &bbuf[index], count);
    418      1.1  macallan 	if (error)
    419      1.1  macallan 		return error;
    420      1.1  macallan 
    421      1.1  macallan 	memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
    422      1.1  macallan 	memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
    423      1.1  macallan 	memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
    424      1.1  macallan 
    425      1.1  macallan 	r = &sc->sc_cmap_red[index];
    426      1.1  macallan 	g = &sc->sc_cmap_green[index];
    427      1.1  macallan 	b = &sc->sc_cmap_blue[index];
    428      1.1  macallan 
    429      1.1  macallan 	for (i = 0; i < count; i++) {
    430      1.1  macallan 		gfb_putpalreg(sc, index, *r, *g, *b);
    431      1.1  macallan 		index++;
    432      1.1  macallan 		r++, g++, b++;
    433      1.1  macallan 	}
    434      1.1  macallan 	return 0;
    435      1.1  macallan }
    436      1.1  macallan 
    437      1.1  macallan static int
    438      1.1  macallan gfb_getcmap(struct gfb_softc *sc, struct wsdisplay_cmap *cm)
    439      1.1  macallan {
    440      1.1  macallan 	u_int index = cm->index;
    441      1.1  macallan 	u_int count = cm->count;
    442      1.1  macallan 	int error;
    443      1.1  macallan 
    444      1.1  macallan 	if (index >= 255 || count > 256 || index + count > 256)
    445      1.1  macallan 		return EINVAL;
    446      1.1  macallan 
    447      1.1  macallan 	error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
    448      1.1  macallan 	if (error)
    449      1.1  macallan 		return error;
    450      1.1  macallan 	error = copyout(&sc->sc_cmap_green[index], cm->green, count);
    451      1.1  macallan 	if (error)
    452      1.1  macallan 		return error;
    453      1.1  macallan 	error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
    454      1.1  macallan 	if (error)
    455      1.1  macallan 		return error;
    456      1.1  macallan 
    457      1.1  macallan 	return 0;
    458      1.1  macallan }
    459      1.1  macallan 
    460      1.1  macallan static void
    461      1.1  macallan gfb_restore_palette(struct gfb_softc *sc)
    462      1.1  macallan {
    463      1.1  macallan 	int i;
    464      1.1  macallan 
    465      1.1  macallan 	for (i = 0; i < (1 << sc->sc_depth); i++) {
    466      1.1  macallan 		gfb_putpalreg(sc, i, sc->sc_cmap_red[i],
    467      1.1  macallan 		    sc->sc_cmap_green[i], sc->sc_cmap_blue[i]);
    468      1.1  macallan 	}
    469      1.1  macallan }
    470      1.1  macallan 
    471      1.1  macallan static int
    472      1.1  macallan gfb_putpalreg(struct gfb_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
    473      1.1  macallan     uint8_t b)
    474      1.1  macallan {
    475      1.1  macallan 	return 0;
    476      1.1  macallan }
    477