Home | History | Annotate | Line # | Download | only in apbus
xafb.c revision 1.16.8.1
      1  1.16.8.1      yamt /*	$NetBSD: xafb.c,v 1.16.8.1 2014/05/22 11:40:00 yamt 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.16.8.1      yamt __KERNEL_RCSID(0, "$NetBSD: xafb.c,v 1.16.8.1 2014/05/22 11:40:00 yamt 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.16.8.1      yamt 	case WSDISPLAYIO_LINEBYTES:
    272  1.16.8.1      yamt 		*(u_int *)data = dc->dc_ri.ri_stride;
    273  1.16.8.1      yamt 		return 0;
    274  1.16.8.1      yamt 
    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