Home | History | Annotate | Line # | Download | only in apbus
xafb.c revision 1.12.10.1
      1  1.12.10.1      elad /*	$NetBSD: xafb.c,v 1.12.10.1 2006/04/19 02:33:25 elad 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.12.10.1      elad __KERNEL_RCSID(0, "$NetBSD: xafb.c,v 1.12.10.1 2006/04/19 02:33:25 elad 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.10   tsutsui 	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.12.10.1      elad int xafb_ioctl(void *, void *, u_long, caddr_t, int, struct lwp *);
     86  1.12.10.1      elad paddr_t xafb_mmap(void *, 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.12     perry 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.12.10.1      elad xafb_ioctl(void *v, void *vs, u_long cmd, caddr_t data, int flag, struct lwp *l)
    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.12.10.1      elad xafb_mmap(void *v, void *vs, 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