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