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