Home | History | Annotate | Line # | Download | only in apbus
xafb.c revision 1.9
      1  1.9   tsutsui /*	$NetBSD: xafb.c,v 1.9 2005/02/06 02:18:02 tsutsui Exp $	*/
      2  1.1    tsubai 
      3  1.1    tsubai /*-
      4  1.1    tsubai  * Copyright (c) 2000 Tsubai Masanari.  All rights reserved.
      5  1.1    tsubai  *
      6  1.1    tsubai  * Redistribution and use in source and binary forms, with or without
      7  1.1    tsubai  * modification, are permitted provided that the following conditions
      8  1.1    tsubai  * are met:
      9  1.1    tsubai  * 1. Redistributions of source code must retain the above copyright
     10  1.1    tsubai  *    notice, this list of conditions and the following disclaimer.
     11  1.1    tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1    tsubai  *    notice, this list of conditions and the following disclaimer in the
     13  1.1    tsubai  *    documentation and/or other materials provided with the distribution.
     14  1.1    tsubai  * 3. The name of the author may not be used to endorse or promote products
     15  1.1    tsubai  *    derived from this software without specific prior written permission.
     16  1.1    tsubai  *
     17  1.1    tsubai  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     18  1.1    tsubai  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     19  1.1    tsubai  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     20  1.1    tsubai  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     21  1.1    tsubai  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     22  1.1    tsubai  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     23  1.1    tsubai  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     24  1.1    tsubai  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     25  1.1    tsubai  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     26  1.1    tsubai  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27  1.1    tsubai  */
     28  1.1    tsubai 
     29  1.1    tsubai /* "xa" frame buffer driver.  Currently supports 1280x1024x8 only. */
     30  1.6     lukem 
     31  1.6     lukem #include <sys/cdefs.h>
     32  1.9   tsutsui __KERNEL_RCSID(0, "$NetBSD: xafb.c,v 1.9 2005/02/06 02:18:02 tsutsui Exp $");
     33  1.1    tsubai 
     34  1.1    tsubai #include <sys/param.h>
     35  1.1    tsubai #include <sys/buf.h>
     36  1.1    tsubai #include <sys/device.h>
     37  1.1    tsubai #include <sys/ioctl.h>
     38  1.1    tsubai #include <sys/malloc.h>
     39  1.1    tsubai #include <sys/systm.h>
     40  1.1    tsubai 
     41  1.1    tsubai #include <uvm/uvm_extern.h>
     42  1.1    tsubai 
     43  1.1    tsubai #include <machine/adrsmap.h>
     44  1.1    tsubai #include <machine/apcall.h>
     45  1.1    tsubai 
     46  1.8       uch #include <machine/wsconsio.h>
     47  1.1    tsubai #include <dev/wscons/wsdisplayvar.h>
     48  1.1    tsubai #include <dev/rasops/rasops.h>
     49  1.1    tsubai 
     50  1.1    tsubai #include <newsmips/apbus/apbusvar.h>
     51  1.1    tsubai 
     52  1.1    tsubai struct xafb_reg {
     53  1.1    tsubai 	volatile u_int r0;
     54  1.1    tsubai 	volatile u_int index;
     55  1.1    tsubai 	volatile u_int r2;
     56  1.1    tsubai 	volatile u_int zero;
     57  1.1    tsubai 	volatile u_int r4;
     58  1.1    tsubai 	volatile u_int r5;
     59  1.1    tsubai 	volatile u_int r6;
     60  1.1    tsubai 	volatile u_int rgb;
     61  1.1    tsubai };
     62  1.1    tsubai 
     63  1.1    tsubai struct xafb_devconfig {
     64  1.1    tsubai 	volatile u_char *dc_fbbase;	/* VRAM base address */
     65  1.8       uch 	paddr_t dc_fbpaddr;		/* VRAM physical address */
     66  1.1    tsubai 	struct xafb_reg *dc_reg;	/* register address */
     67  1.1    tsubai 	struct rasops_info dc_ri;
     68  1.1    tsubai };
     69  1.1    tsubai 
     70  1.1    tsubai struct xafb_softc {
     71  1.1    tsubai 	struct device sc_dev;
     72  1.1    tsubai 	struct xafb_devconfig *sc_dc;
     73  1.1    tsubai 	int sc_nscreens;
     74  1.1    tsubai 	u_char sc_cmap_red[256];
     75  1.1    tsubai 	u_char sc_cmap_green[256];
     76  1.1    tsubai 	u_char sc_cmap_blue[256];
     77  1.1    tsubai };
     78  1.1    tsubai 
     79  1.9   tsutsui int xafb_match(struct device *, struct cfdata *, void *);
     80  1.9   tsutsui void xafb_attach(struct device *, struct device *, void *);
     81  1.1    tsubai 
     82  1.9   tsutsui int xafb_common_init(struct xafb_devconfig *);
     83  1.9   tsutsui int xafb_is_console(void);
     84  1.1    tsubai 
     85  1.9   tsutsui int xafb_ioctl(void *, u_long, caddr_t, int, struct proc *);
     86  1.9   tsutsui paddr_t xafb_mmap(void *, off_t, int);
     87  1.9   tsutsui int xafb_alloc_screen(void *, const struct wsscreen_descr *, void **, int *,
     88  1.9   tsutsui     int *, long *);
     89  1.9   tsutsui void xafb_free_screen(void *, void *);
     90  1.9   tsutsui int xafb_show_screen(void *, void *, int, void (*) (void *, int, int), void *);
     91  1.9   tsutsui 
     92  1.9   tsutsui int xafb_cnattach(void);
     93  1.9   tsutsui int xafb_getcmap(struct xafb_softc *, struct wsdisplay_cmap *);
     94  1.9   tsutsui int xafb_putcmap(struct xafb_softc *, struct wsdisplay_cmap *);
     95  1.1    tsubai 
     96  1.1    tsubai static __inline void xafb_setcolor(struct xafb_devconfig *, int, int, int, int);
     97  1.1    tsubai 
     98  1.5   thorpej CFATTACH_DECL(xafb, sizeof(struct xafb_softc),
     99  1.5   thorpej     xafb_match, xafb_attach, NULL, NULL);
    100  1.1    tsubai 
    101  1.1    tsubai struct xafb_devconfig xafb_console_dc;
    102  1.1    tsubai 
    103  1.1    tsubai struct wsdisplay_accessops xafb_accessops = {
    104  1.1    tsubai 	xafb_ioctl,
    105  1.1    tsubai 	xafb_mmap,
    106  1.1    tsubai 	xafb_alloc_screen,
    107  1.1    tsubai 	xafb_free_screen,
    108  1.1    tsubai 	xafb_show_screen,
    109  1.1    tsubai 	NULL	/* load_font */
    110  1.1    tsubai };
    111  1.1    tsubai 
    112  1.1    tsubai struct wsscreen_descr xafb_stdscreen = {
    113  1.1    tsubai 	"std",
    114  1.1    tsubai 	0, 0,
    115  1.1    tsubai 	0,
    116  1.1    tsubai 	0, 0,
    117  1.1    tsubai 	WSSCREEN_REVERSE
    118  1.1    tsubai };
    119  1.1    tsubai 
    120  1.1    tsubai const struct wsscreen_descr *xafb_scrlist[] = {
    121  1.1    tsubai 	&xafb_stdscreen
    122  1.1    tsubai };
    123  1.1    tsubai 
    124  1.1    tsubai struct wsscreen_list xafb_screenlist = {
    125  1.1    tsubai 	sizeof(xafb_scrlist) / sizeof(xafb_scrlist[0]), xafb_scrlist
    126  1.1    tsubai };
    127  1.1    tsubai 
    128  1.1    tsubai int
    129  1.9   tsutsui xafb_match(struct device *parent, struct cfdata *match, void *aux)
    130  1.1    tsubai {
    131  1.1    tsubai 	struct apbus_attach_args *apa = aux;
    132  1.1    tsubai 
    133  1.1    tsubai 	if (strcmp(apa->apa_name, "xa") != 0)
    134  1.1    tsubai 		return 0;
    135  1.1    tsubai 
    136  1.1    tsubai 	return 1;
    137  1.1    tsubai }
    138  1.1    tsubai 
    139  1.1    tsubai void
    140  1.9   tsutsui xafb_attach(struct device *parent, struct device *self, void *aux)
    141  1.1    tsubai {
    142  1.1    tsubai 	struct xafb_softc *sc = (void *)self;
    143  1.1    tsubai 	struct apbus_attach_args *apa = aux;
    144  1.1    tsubai 	struct wsemuldisplaydev_attach_args wsa;
    145  1.1    tsubai 	struct xafb_devconfig *dc;
    146  1.1    tsubai 	struct rasops_info *ri;
    147  1.1    tsubai 	int console, i;
    148  1.1    tsubai 
    149  1.1    tsubai 	console = xafb_is_console();
    150  1.1    tsubai 
    151  1.1    tsubai 	if (console) {
    152  1.1    tsubai 		dc = &xafb_console_dc;
    153  1.1    tsubai 		ri = &dc->dc_ri;
    154  1.1    tsubai 		sc->sc_nscreens = 1;
    155  1.1    tsubai 	} else {
    156  1.9   tsutsui 		dc = malloc(sizeof(struct xafb_devconfig), M_DEVBUF,
    157  1.9   tsutsui 		    M_WAITOK|M_ZERO);
    158  1.8       uch 		dc->dc_fbpaddr = (paddr_t)0x10000000;
    159  1.8       uch 		dc->dc_fbbase = (void *)MIPS_PHYS_TO_KSEG1(dc->dc_fbpaddr);
    160  1.1    tsubai 		dc->dc_reg = (void *)(apa->apa_hwbase + 0x3000);
    161  1.1    tsubai 		if (xafb_common_init(dc) != 0) {
    162  1.1    tsubai 			printf(": couldn't initialize device\n");
    163  1.1    tsubai 			return;
    164  1.1    tsubai 		}
    165  1.1    tsubai 
    166  1.1    tsubai 		ri = &dc->dc_ri;
    167  1.1    tsubai 
    168  1.1    tsubai 		/* clear screen */
    169  1.1    tsubai 		(*ri->ri_ops.eraserows)(ri, 0, ri->ri_rows, 0);
    170  1.1    tsubai 	}
    171  1.1    tsubai 	sc->sc_dc = dc;
    172  1.1    tsubai 
    173  1.1    tsubai 	for (i = 0; i < 256; i++) {
    174  1.1    tsubai 		sc->sc_cmap_red[i] = i;
    175  1.1    tsubai 		sc->sc_cmap_green[i] = i;
    176  1.1    tsubai 		sc->sc_cmap_blue[i] = i;
    177  1.1    tsubai 	}
    178  1.1    tsubai 
    179  1.1    tsubai 	printf(": %d x %d, %dbpp\n", ri->ri_width, ri->ri_height, ri->ri_depth);
    180  1.1    tsubai 
    181  1.1    tsubai 	wsa.console = console;
    182  1.1    tsubai 	wsa.scrdata = &xafb_screenlist;
    183  1.1    tsubai 	wsa.accessops = &xafb_accessops;
    184  1.1    tsubai 	wsa.accesscookie = sc;
    185  1.1    tsubai 
    186  1.1    tsubai 	config_found(self, &wsa, wsemuldisplaydevprint);
    187  1.1    tsubai }
    188  1.1    tsubai 
    189  1.1    tsubai void
    190  1.9   tsutsui xafb_setcolor(struct xafb_devconfig *dc, int index, int r, int g, int b)
    191  1.1    tsubai {
    192  1.1    tsubai 	volatile struct xafb_reg *reg = dc->dc_reg;
    193  1.1    tsubai 
    194  1.1    tsubai 	reg->index = index;
    195  1.1    tsubai 	reg->zero = 0;
    196  1.1    tsubai 	reg->rgb = r;
    197  1.1    tsubai 	reg->rgb = g;
    198  1.1    tsubai 	reg->rgb = b;
    199  1.1    tsubai }
    200  1.1    tsubai 
    201  1.1    tsubai int
    202  1.9   tsutsui xafb_common_init(struct xafb_devconfig *dc)
    203  1.1    tsubai {
    204  1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    205  1.1    tsubai 	int i;
    206  1.1    tsubai 
    207  1.1    tsubai 	for (i = 0; i < 256; i++)
    208  1.1    tsubai 		xafb_setcolor(dc, i, i, i, i);
    209  1.1    tsubai 
    210  1.1    tsubai 	/* initialize rasops */
    211  1.1    tsubai 	ri->ri_width = 1280;
    212  1.1    tsubai 	ri->ri_height = 1024;
    213  1.1    tsubai 	ri->ri_depth = 8;
    214  1.1    tsubai 	ri->ri_stride = 2048;
    215  1.1    tsubai 	ri->ri_bits = (void *)dc->dc_fbbase;
    216  1.1    tsubai 	ri->ri_flg = RI_FORCEMONO | RI_FULLCLEAR;
    217  1.1    tsubai 
    218  1.1    tsubai 	rasops_init(ri, 44, 100);
    219  1.1    tsubai 
    220  1.1    tsubai 	/* mono */
    221  1.1    tsubai 	ri->ri_devcmap[0] = 0;				/* bg */
    222  1.1    tsubai 	ri->ri_devcmap[1] = 0xffffffff;			/* fg */
    223  1.1    tsubai 
    224  1.1    tsubai 	xafb_stdscreen.nrows = ri->ri_rows;
    225  1.1    tsubai 	xafb_stdscreen.ncols = ri->ri_cols;
    226  1.1    tsubai 	xafb_stdscreen.textops = &ri->ri_ops;
    227  1.1    tsubai 	xafb_stdscreen.capabilities = ri->ri_caps;
    228  1.1    tsubai 
    229  1.1    tsubai 	return 0;
    230  1.1    tsubai }
    231  1.1    tsubai 
    232  1.1    tsubai int
    233  1.9   tsutsui xafb_is_console(void)
    234  1.1    tsubai {
    235  1.1    tsubai 	volatile u_int *dipsw = (void *)NEWS5000_DIP_SWITCH;
    236  1.1    tsubai 
    237  1.1    tsubai 	if (*dipsw & 1)					/* XXX right? */
    238  1.1    tsubai 		return 1;
    239  1.1    tsubai 
    240  1.1    tsubai 	return 0;
    241  1.1    tsubai }
    242  1.1    tsubai 
    243  1.1    tsubai int
    244  1.9   tsutsui xafb_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
    245  1.1    tsubai {
    246  1.1    tsubai 	struct xafb_softc *sc = v;
    247  1.1    tsubai 	struct xafb_devconfig *dc = sc->sc_dc;
    248  1.8       uch 	struct newsmips_wsdisplay_fbinfo *nwdf = (void *)data;
    249  1.8       uch 	struct wsdisplay_fbinfo *wdf = (void *)data;
    250  1.1    tsubai 
    251  1.1    tsubai 	switch (cmd) {
    252  1.1    tsubai 	case WSDISPLAYIO_GTYPE:
    253  1.1    tsubai 		*(int *)data = WSDISPLAY_TYPE_UNKNOWN;	/* XXX */
    254  1.1    tsubai 		return 0;
    255  1.1    tsubai 
    256  1.8       uch 	case NEWSMIPS_WSDISPLAYIO_GINFO:
    257  1.8       uch 		nwdf->stride = dc->dc_ri.ri_stride;
    258  1.8       uch 		/* FALLTHROUGH */
    259  1.1    tsubai 	case WSDISPLAYIO_GINFO:
    260  1.1    tsubai 		wdf->height = dc->dc_ri.ri_height;
    261  1.1    tsubai 		wdf->width = dc->dc_ri.ri_width;
    262  1.1    tsubai 		wdf->depth = dc->dc_ri.ri_depth;
    263  1.1    tsubai 		wdf->cmsize = 256;
    264  1.1    tsubai 		return 0;
    265  1.1    tsubai 
    266  1.1    tsubai 	case WSDISPLAYIO_GETCMAP:
    267  1.1    tsubai 		return xafb_getcmap(sc, (struct wsdisplay_cmap *)data);
    268  1.1    tsubai 
    269  1.1    tsubai 	case WSDISPLAYIO_PUTCMAP:
    270  1.1    tsubai 		return xafb_putcmap(sc, (struct wsdisplay_cmap *)data);
    271  1.1    tsubai 
    272  1.1    tsubai 	/* case WSDISPLAYIO_SVIDEO: */
    273  1.1    tsubai 	}
    274  1.2    atatat 	return EPASSTHROUGH;
    275  1.1    tsubai }
    276  1.1    tsubai 
    277  1.1    tsubai paddr_t
    278  1.9   tsutsui xafb_mmap(void *v, off_t offset, int prot)
    279  1.1    tsubai {
    280  1.1    tsubai 	struct xafb_softc *sc = v;
    281  1.1    tsubai 	struct xafb_devconfig *dc = sc->sc_dc;
    282  1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    283  1.1    tsubai 
    284  1.1    tsubai 	if (offset >= (ri->ri_stride * ri->ri_height) || offset < 0)
    285  1.1    tsubai 		return -1;
    286  1.1    tsubai 
    287  1.8       uch 	return mips_btop(dc->dc_fbpaddr + offset);
    288  1.1    tsubai }
    289  1.1    tsubai 
    290  1.1    tsubai int
    291  1.9   tsutsui xafb_alloc_screen(void *v, const struct wsscreen_descr *scrdesc,
    292  1.9   tsutsui     void **cookiep, int *ccolp, int *crowp, long *attrp)
    293  1.1    tsubai {
    294  1.1    tsubai 	struct xafb_softc *sc = v;
    295  1.1    tsubai 	struct rasops_info *ri = &sc->sc_dc->dc_ri;
    296  1.1    tsubai 	long defattr;
    297  1.1    tsubai 
    298  1.1    tsubai 	if (sc->sc_nscreens > 0)
    299  1.1    tsubai 		return ENOMEM;
    300  1.1    tsubai 
    301  1.1    tsubai 	*cookiep = ri;
    302  1.1    tsubai 	*ccolp = *crowp = 0;
    303  1.3  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    304  1.1    tsubai 	*attrp = defattr;
    305  1.1    tsubai 	sc->sc_nscreens++;
    306  1.1    tsubai 
    307  1.1    tsubai 	return 0;
    308  1.1    tsubai }
    309  1.1    tsubai 
    310  1.1    tsubai void
    311  1.9   tsutsui xafb_free_screen(void *v, void *cookie)
    312  1.1    tsubai {
    313  1.1    tsubai 	struct xafb_softc *sc = v;
    314  1.1    tsubai 
    315  1.1    tsubai 	if (sc->sc_dc == &xafb_console_dc)
    316  1.1    tsubai 		panic("xafb_free_screen: console");
    317  1.1    tsubai 
    318  1.1    tsubai 	sc->sc_nscreens--;
    319  1.1    tsubai }
    320  1.1    tsubai 
    321  1.1    tsubai int
    322  1.9   tsutsui xafb_show_screen(void *v, void *cookie, int waitok,
    323  1.9   tsutsui     void (*cb)(void *, int, int), void *cbarg)
    324  1.1    tsubai {
    325  1.9   tsutsui 
    326  1.1    tsubai 	return 0;
    327  1.1    tsubai }
    328  1.1    tsubai 
    329  1.1    tsubai int
    330  1.9   tsutsui xafb_cnattach(void)
    331  1.1    tsubai {
    332  1.1    tsubai 	struct xafb_devconfig *dc = &xafb_console_dc;
    333  1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    334  1.1    tsubai 	long defattr;
    335  1.1    tsubai 	int crow = 0;
    336  1.1    tsubai 
    337  1.1    tsubai 	if (!xafb_is_console())
    338  1.1    tsubai 		return -1;
    339  1.1    tsubai 
    340  1.8       uch 	dc->dc_fbpaddr = (paddr_t)0x10000000;
    341  1.8       uch 	dc->dc_fbbase = (void *)MIPS_PHYS_TO_KSEG1(dc->dc_fbpaddr);
    342  1.1    tsubai 	dc->dc_reg = (void *)0xb4903000;			/* XXX */
    343  1.1    tsubai 	xafb_common_init(dc);
    344  1.1    tsubai 
    345  1.1    tsubai 	crow = 0;			/* XXX current cursor pos */
    346  1.1    tsubai 
    347  1.3  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    348  1.1    tsubai 	wsdisplay_cnattach(&xafb_stdscreen, &dc->dc_ri, 0, crow, defattr);
    349  1.1    tsubai 
    350  1.1    tsubai 	return 0;
    351  1.1    tsubai }
    352  1.1    tsubai 
    353  1.1    tsubai int
    354  1.9   tsutsui xafb_getcmap(struct xafb_softc *sc, struct wsdisplay_cmap *cm)
    355  1.1    tsubai {
    356  1.1    tsubai 	u_int index = cm->index;
    357  1.1    tsubai 	u_int count = cm->count;
    358  1.1    tsubai 	int error;
    359  1.1    tsubai 
    360  1.1    tsubai 	if (index >= 256 || count > 256 || index + count > 256)
    361  1.1    tsubai 		return EINVAL;
    362  1.1    tsubai 
    363  1.1    tsubai 	error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
    364  1.1    tsubai 	if (error)
    365  1.1    tsubai 		return error;
    366  1.1    tsubai 	error = copyout(&sc->sc_cmap_green[index], cm->green, count);
    367  1.1    tsubai 	if (error)
    368  1.1    tsubai 		return error;
    369  1.1    tsubai 	error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
    370  1.1    tsubai 	if (error)
    371  1.1    tsubai 		return error;
    372  1.1    tsubai 
    373  1.1    tsubai 	return 0;
    374  1.1    tsubai }
    375  1.1    tsubai 
    376  1.1    tsubai int
    377  1.9   tsutsui xafb_putcmap(struct xafb_softc *sc, struct wsdisplay_cmap *cm)
    378  1.1    tsubai {
    379  1.1    tsubai 	u_int index = cm->index;
    380  1.1    tsubai 	u_int count = cm->count;
    381  1.7       chs 	int i, error;
    382  1.7       chs 	u_char rbuf[256], gbuf[256], bbuf[256];
    383  1.1    tsubai 	u_char *r, *g, *b;
    384  1.1    tsubai 
    385  1.7       chs 	if (cm->index >= 256 || cm->count > 256 ||
    386  1.7       chs 	    (cm->index + cm->count) > 256)
    387  1.1    tsubai 		return EINVAL;
    388  1.7       chs 	error = copyin(cm->red, &rbuf[index], count);
    389  1.7       chs 	if (error)
    390  1.7       chs 		return error;
    391  1.7       chs 	error = copyin(cm->green, &gbuf[index], count);
    392  1.7       chs 	if (error)
    393  1.7       chs 		return error;
    394  1.7       chs 	error = copyin(cm->blue, &bbuf[index], count);
    395  1.7       chs 	if (error)
    396  1.7       chs 		return error;
    397  1.7       chs 
    398  1.7       chs 	memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
    399  1.7       chs 	memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
    400  1.7       chs 	memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
    401  1.1    tsubai 
    402  1.1    tsubai 	r = &sc->sc_cmap_red[index];
    403  1.1    tsubai 	g = &sc->sc_cmap_green[index];
    404  1.1    tsubai 	b = &sc->sc_cmap_blue[index];
    405  1.1    tsubai 	for (i = 0; i < count; i++)
    406  1.1    tsubai 		xafb_setcolor(sc->sc_dc, index++, *r++, *g++, *b++);
    407  1.1    tsubai 	return 0;
    408  1.1    tsubai }
    409