Home | History | Annotate | Line # | Download | only in apbus
xafb.c revision 1.15
      1  1.15   tsutsui /*	$NetBSD: xafb.c,v 1.15 2008/04/09 15:40:30 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.15   tsutsui __KERNEL_RCSID(0, "$NetBSD: xafb.c,v 1.15 2008/04/09 15:40:30 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.15   tsutsui 	volatile uint32_t r0;
     54  1.15   tsutsui 	volatile uint32_t index;
     55  1.15   tsutsui 	volatile uint32_t r2;
     56  1.15   tsutsui 	volatile uint32_t zero;
     57  1.15   tsutsui 	volatile uint32_t r4;
     58  1.15   tsutsui 	volatile uint32_t r5;
     59  1.15   tsutsui 	volatile uint32_t r6;
     60  1.15   tsutsui 	volatile uint32_t rgb;
     61   1.1    tsubai };
     62   1.1    tsubai 
     63   1.1    tsubai struct xafb_devconfig {
     64  1.15   tsutsui 	uint8_t *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.15   tsutsui 	device_t sc_dev;
     72   1.1    tsubai 	struct xafb_devconfig *sc_dc;
     73   1.1    tsubai 	int sc_nscreens;
     74  1.15   tsutsui 	uint8_t sc_cmap_red[256];
     75  1.15   tsutsui 	uint8_t sc_cmap_green[256];
     76  1.15   tsutsui 	uint8_t sc_cmap_blue[256];
     77   1.1    tsubai };
     78   1.1    tsubai 
     79  1.15   tsutsui int xafb_match(device_t, cfdata_t, void *);
     80  1.15   tsutsui void xafb_attach(device_t, device_t, 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.14  christos int xafb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     86  1.13      jmmv 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.15   tsutsui CFATTACH_DECL_NEW(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.15   tsutsui 	__arraycount(xafb_scrlist), xafb_scrlist
    126   1.1    tsubai };
    127   1.1    tsubai 
    128   1.1    tsubai int
    129  1.15   tsutsui xafb_match(device_t parent, cfdata_t cf, 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.15   tsutsui xafb_attach(device_t parent, device_t self, void *aux)
    141   1.1    tsubai {
    142  1.15   tsutsui 	struct xafb_softc *sc = device_private(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.15   tsutsui 	sc->sc_dev = self;
    150   1.1    tsubai 	console = xafb_is_console();
    151   1.1    tsubai 
    152   1.1    tsubai 	if (console) {
    153   1.1    tsubai 		dc = &xafb_console_dc;
    154   1.1    tsubai 		ri = &dc->dc_ri;
    155   1.1    tsubai 		sc->sc_nscreens = 1;
    156   1.1    tsubai 	} else {
    157   1.9   tsutsui 		dc = malloc(sizeof(struct xafb_devconfig), M_DEVBUF,
    158   1.9   tsutsui 		    M_WAITOK|M_ZERO);
    159   1.8       uch 		dc->dc_fbpaddr = (paddr_t)0x10000000;
    160   1.8       uch 		dc->dc_fbbase = (void *)MIPS_PHYS_TO_KSEG1(dc->dc_fbpaddr);
    161   1.1    tsubai 		dc->dc_reg = (void *)(apa->apa_hwbase + 0x3000);
    162   1.1    tsubai 		if (xafb_common_init(dc) != 0) {
    163  1.15   tsutsui 			aprint_error(": couldn't initialize device\n");
    164   1.1    tsubai 			return;
    165   1.1    tsubai 		}
    166   1.1    tsubai 
    167   1.1    tsubai 		ri = &dc->dc_ri;
    168   1.1    tsubai 
    169   1.1    tsubai 		/* clear screen */
    170   1.1    tsubai 		(*ri->ri_ops.eraserows)(ri, 0, ri->ri_rows, 0);
    171   1.1    tsubai 	}
    172   1.1    tsubai 	sc->sc_dc = dc;
    173   1.1    tsubai 
    174   1.1    tsubai 	for (i = 0; i < 256; i++) {
    175   1.1    tsubai 		sc->sc_cmap_red[i] = i;
    176   1.1    tsubai 		sc->sc_cmap_green[i] = i;
    177   1.1    tsubai 		sc->sc_cmap_blue[i] = i;
    178   1.1    tsubai 	}
    179   1.1    tsubai 
    180  1.15   tsutsui 	aprint_normal(": %d x %d, %dbpp\n",
    181  1.15   tsutsui 	    ri->ri_width, ri->ri_height, ri->ri_depth);
    182   1.1    tsubai 
    183   1.1    tsubai 	wsa.console = console;
    184   1.1    tsubai 	wsa.scrdata = &xafb_screenlist;
    185   1.1    tsubai 	wsa.accessops = &xafb_accessops;
    186   1.1    tsubai 	wsa.accesscookie = sc;
    187   1.1    tsubai 
    188   1.1    tsubai 	config_found(self, &wsa, wsemuldisplaydevprint);
    189   1.1    tsubai }
    190   1.1    tsubai 
    191   1.1    tsubai void
    192   1.9   tsutsui xafb_setcolor(struct xafb_devconfig *dc, int index, int r, int g, int b)
    193   1.1    tsubai {
    194   1.1    tsubai 	volatile struct xafb_reg *reg = dc->dc_reg;
    195   1.1    tsubai 
    196   1.1    tsubai 	reg->index = index;
    197   1.1    tsubai 	reg->zero = 0;
    198   1.1    tsubai 	reg->rgb = r;
    199   1.1    tsubai 	reg->rgb = g;
    200   1.1    tsubai 	reg->rgb = b;
    201   1.1    tsubai }
    202   1.1    tsubai 
    203   1.1    tsubai int
    204   1.9   tsutsui xafb_common_init(struct xafb_devconfig *dc)
    205   1.1    tsubai {
    206   1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    207   1.1    tsubai 	int i;
    208   1.1    tsubai 
    209   1.1    tsubai 	for (i = 0; i < 256; i++)
    210   1.1    tsubai 		xafb_setcolor(dc, i, i, i, i);
    211   1.1    tsubai 
    212   1.1    tsubai 	/* initialize rasops */
    213   1.1    tsubai 	ri->ri_width = 1280;
    214   1.1    tsubai 	ri->ri_height = 1024;
    215   1.1    tsubai 	ri->ri_depth = 8;
    216   1.1    tsubai 	ri->ri_stride = 2048;
    217   1.1    tsubai 	ri->ri_bits = (void *)dc->dc_fbbase;
    218   1.1    tsubai 	ri->ri_flg = RI_FORCEMONO | RI_FULLCLEAR;
    219   1.1    tsubai 
    220   1.1    tsubai 	rasops_init(ri, 44, 100);
    221   1.1    tsubai 
    222   1.1    tsubai 	/* mono */
    223   1.1    tsubai 	ri->ri_devcmap[0] = 0;				/* bg */
    224   1.1    tsubai 	ri->ri_devcmap[1] = 0xffffffff;			/* fg */
    225   1.1    tsubai 
    226   1.1    tsubai 	xafb_stdscreen.nrows = ri->ri_rows;
    227   1.1    tsubai 	xafb_stdscreen.ncols = ri->ri_cols;
    228   1.1    tsubai 	xafb_stdscreen.textops = &ri->ri_ops;
    229   1.1    tsubai 	xafb_stdscreen.capabilities = ri->ri_caps;
    230   1.1    tsubai 
    231   1.1    tsubai 	return 0;
    232   1.1    tsubai }
    233   1.1    tsubai 
    234   1.1    tsubai int
    235   1.9   tsutsui xafb_is_console(void)
    236   1.1    tsubai {
    237  1.15   tsutsui 	volatile uint32_t *dipsw = (void *)NEWS5000_DIP_SWITCH;
    238   1.1    tsubai 
    239   1.1    tsubai 	if (*dipsw & 1)					/* XXX right? */
    240   1.1    tsubai 		return 1;
    241   1.1    tsubai 
    242   1.1    tsubai 	return 0;
    243   1.1    tsubai }
    244   1.1    tsubai 
    245   1.1    tsubai int
    246  1.14  christos xafb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
    247   1.1    tsubai {
    248   1.1    tsubai 	struct xafb_softc *sc = v;
    249   1.1    tsubai 	struct xafb_devconfig *dc = sc->sc_dc;
    250   1.8       uch 	struct newsmips_wsdisplay_fbinfo *nwdf = (void *)data;
    251   1.8       uch 	struct wsdisplay_fbinfo *wdf = (void *)data;
    252   1.1    tsubai 
    253   1.1    tsubai 	switch (cmd) {
    254   1.1    tsubai 	case WSDISPLAYIO_GTYPE:
    255   1.1    tsubai 		*(int *)data = WSDISPLAY_TYPE_UNKNOWN;	/* XXX */
    256   1.1    tsubai 		return 0;
    257   1.1    tsubai 
    258   1.8       uch 	case NEWSMIPS_WSDISPLAYIO_GINFO:
    259   1.8       uch 		nwdf->stride = dc->dc_ri.ri_stride;
    260   1.8       uch 		/* FALLTHROUGH */
    261   1.1    tsubai 	case WSDISPLAYIO_GINFO:
    262   1.1    tsubai 		wdf->height = dc->dc_ri.ri_height;
    263   1.1    tsubai 		wdf->width = dc->dc_ri.ri_width;
    264   1.1    tsubai 		wdf->depth = dc->dc_ri.ri_depth;
    265   1.1    tsubai 		wdf->cmsize = 256;
    266   1.1    tsubai 		return 0;
    267   1.1    tsubai 
    268   1.1    tsubai 	case WSDISPLAYIO_GETCMAP:
    269   1.1    tsubai 		return xafb_getcmap(sc, (struct wsdisplay_cmap *)data);
    270   1.1    tsubai 
    271   1.1    tsubai 	case WSDISPLAYIO_PUTCMAP:
    272   1.1    tsubai 		return xafb_putcmap(sc, (struct wsdisplay_cmap *)data);
    273   1.1    tsubai 
    274   1.1    tsubai 	/* case WSDISPLAYIO_SVIDEO: */
    275   1.1    tsubai 	}
    276   1.2    atatat 	return EPASSTHROUGH;
    277   1.1    tsubai }
    278   1.1    tsubai 
    279   1.1    tsubai paddr_t
    280  1.13      jmmv xafb_mmap(void *v, void *vs, off_t offset, int prot)
    281   1.1    tsubai {
    282   1.1    tsubai 	struct xafb_softc *sc = v;
    283   1.1    tsubai 	struct xafb_devconfig *dc = sc->sc_dc;
    284   1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    285   1.1    tsubai 
    286   1.1    tsubai 	if (offset >= (ri->ri_stride * ri->ri_height) || offset < 0)
    287   1.1    tsubai 		return -1;
    288   1.1    tsubai 
    289   1.8       uch 	return mips_btop(dc->dc_fbpaddr + offset);
    290   1.1    tsubai }
    291   1.1    tsubai 
    292   1.1    tsubai int
    293   1.9   tsutsui xafb_alloc_screen(void *v, const struct wsscreen_descr *scrdesc,
    294   1.9   tsutsui     void **cookiep, int *ccolp, int *crowp, long *attrp)
    295   1.1    tsubai {
    296   1.1    tsubai 	struct xafb_softc *sc = v;
    297   1.1    tsubai 	struct rasops_info *ri = &sc->sc_dc->dc_ri;
    298   1.1    tsubai 	long defattr;
    299   1.1    tsubai 
    300   1.1    tsubai 	if (sc->sc_nscreens > 0)
    301   1.1    tsubai 		return ENOMEM;
    302   1.1    tsubai 
    303   1.1    tsubai 	*cookiep = ri;
    304   1.1    tsubai 	*ccolp = *crowp = 0;
    305   1.3  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    306   1.1    tsubai 	*attrp = defattr;
    307   1.1    tsubai 	sc->sc_nscreens++;
    308   1.1    tsubai 
    309   1.1    tsubai 	return 0;
    310   1.1    tsubai }
    311   1.1    tsubai 
    312   1.1    tsubai void
    313   1.9   tsutsui xafb_free_screen(void *v, void *cookie)
    314   1.1    tsubai {
    315   1.1    tsubai 	struct xafb_softc *sc = v;
    316   1.1    tsubai 
    317   1.1    tsubai 	if (sc->sc_dc == &xafb_console_dc)
    318   1.1    tsubai 		panic("xafb_free_screen: console");
    319   1.1    tsubai 
    320   1.1    tsubai 	sc->sc_nscreens--;
    321   1.1    tsubai }
    322   1.1    tsubai 
    323   1.1    tsubai int
    324   1.9   tsutsui xafb_show_screen(void *v, void *cookie, int waitok,
    325   1.9   tsutsui     void (*cb)(void *, int, int), void *cbarg)
    326   1.1    tsubai {
    327   1.9   tsutsui 
    328   1.1    tsubai 	return 0;
    329   1.1    tsubai }
    330   1.1    tsubai 
    331   1.1    tsubai int
    332   1.9   tsutsui xafb_cnattach(void)
    333   1.1    tsubai {
    334   1.1    tsubai 	struct xafb_devconfig *dc = &xafb_console_dc;
    335   1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    336   1.1    tsubai 	long defattr;
    337   1.1    tsubai 	int crow = 0;
    338   1.1    tsubai 
    339   1.1    tsubai 	if (!xafb_is_console())
    340   1.1    tsubai 		return -1;
    341   1.1    tsubai 
    342   1.8       uch 	dc->dc_fbpaddr = (paddr_t)0x10000000;
    343   1.8       uch 	dc->dc_fbbase = (void *)MIPS_PHYS_TO_KSEG1(dc->dc_fbpaddr);
    344   1.1    tsubai 	dc->dc_reg = (void *)0xb4903000;			/* XXX */
    345   1.1    tsubai 	xafb_common_init(dc);
    346   1.1    tsubai 
    347   1.1    tsubai 	crow = 0;			/* XXX current cursor pos */
    348   1.1    tsubai 
    349   1.3  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    350   1.1    tsubai 	wsdisplay_cnattach(&xafb_stdscreen, &dc->dc_ri, 0, crow, defattr);
    351   1.1    tsubai 
    352   1.1    tsubai 	return 0;
    353   1.1    tsubai }
    354   1.1    tsubai 
    355   1.1    tsubai int
    356   1.9   tsutsui xafb_getcmap(struct xafb_softc *sc, struct wsdisplay_cmap *cm)
    357   1.1    tsubai {
    358   1.1    tsubai 	u_int index = cm->index;
    359   1.1    tsubai 	u_int count = cm->count;
    360   1.1    tsubai 	int error;
    361   1.1    tsubai 
    362   1.1    tsubai 	if (index >= 256 || count > 256 || index + count > 256)
    363   1.1    tsubai 		return EINVAL;
    364   1.1    tsubai 
    365   1.1    tsubai 	error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
    366   1.1    tsubai 	if (error)
    367   1.1    tsubai 		return error;
    368   1.1    tsubai 	error = copyout(&sc->sc_cmap_green[index], cm->green, count);
    369   1.1    tsubai 	if (error)
    370   1.1    tsubai 		return error;
    371   1.1    tsubai 	error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
    372   1.1    tsubai 	if (error)
    373   1.1    tsubai 		return error;
    374   1.1    tsubai 
    375   1.1    tsubai 	return 0;
    376   1.1    tsubai }
    377   1.1    tsubai 
    378   1.1    tsubai int
    379   1.9   tsutsui xafb_putcmap(struct xafb_softc *sc, struct wsdisplay_cmap *cm)
    380   1.1    tsubai {
    381   1.1    tsubai 	u_int index = cm->index;
    382   1.1    tsubai 	u_int count = cm->count;
    383   1.7       chs 	int i, error;
    384   1.7       chs 	u_char rbuf[256], gbuf[256], bbuf[256];
    385   1.1    tsubai 	u_char *r, *g, *b;
    386   1.1    tsubai 
    387   1.7       chs 	if (cm->index >= 256 || cm->count > 256 ||
    388   1.7       chs 	    (cm->index + cm->count) > 256)
    389   1.1    tsubai 		return EINVAL;
    390   1.7       chs 	error = copyin(cm->red, &rbuf[index], count);
    391   1.7       chs 	if (error)
    392   1.7       chs 		return error;
    393   1.7       chs 	error = copyin(cm->green, &gbuf[index], count);
    394   1.7       chs 	if (error)
    395   1.7       chs 		return error;
    396   1.7       chs 	error = copyin(cm->blue, &bbuf[index], count);
    397   1.7       chs 	if (error)
    398   1.7       chs 		return error;
    399   1.7       chs 
    400   1.7       chs 	memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
    401   1.7       chs 	memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
    402   1.7       chs 	memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
    403   1.1    tsubai 
    404   1.1    tsubai 	r = &sc->sc_cmap_red[index];
    405   1.1    tsubai 	g = &sc->sc_cmap_green[index];
    406   1.1    tsubai 	b = &sc->sc_cmap_blue[index];
    407   1.1    tsubai 	for (i = 0; i < count; i++)
    408   1.1    tsubai 		xafb_setcolor(sc->sc_dc, index++, *r++, *g++, *b++);
    409   1.1    tsubai 	return 0;
    410   1.1    tsubai }
    411