Home | History | Annotate | Line # | Download | only in apbus
xafb.c revision 1.5.6.1
      1  1.5.6.1     skrll /*	$NetBSD: xafb.c,v 1.5.6.1 2004/08/03 10:38:28 skrll 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.1    tsubai 
     31  1.5.6.1     skrll #include <sys/cdefs.h>
     32  1.5.6.1     skrll __KERNEL_RCSID(0, "$NetBSD: xafb.c,v 1.5.6.1 2004/08/03 10:38:28 skrll Exp $");
     33  1.5.6.1     skrll 
     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.1    tsubai #include <dev/wscons/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.1    tsubai 	struct xafb_reg *dc_reg;	/* register address */
     66      1.1    tsubai 	struct rasops_info dc_ri;
     67      1.1    tsubai };
     68      1.1    tsubai 
     69      1.1    tsubai struct xafb_softc {
     70      1.1    tsubai 	struct device sc_dev;
     71      1.1    tsubai 	struct xafb_devconfig *sc_dc;
     72      1.1    tsubai 	int sc_nscreens;
     73      1.1    tsubai 	u_char sc_cmap_red[256];
     74      1.1    tsubai 	u_char sc_cmap_green[256];
     75      1.1    tsubai 	u_char sc_cmap_blue[256];
     76      1.1    tsubai };
     77      1.1    tsubai 
     78      1.1    tsubai int xafb_match __P((struct device *, struct cfdata *, void *));
     79      1.1    tsubai void xafb_attach __P((struct device *, struct device *, void *));
     80      1.1    tsubai 
     81      1.1    tsubai int xafb_common_init __P((struct xafb_devconfig *));
     82      1.1    tsubai int xafb_is_console __P((void));
     83      1.1    tsubai 
     84      1.1    tsubai int xafb_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
     85      1.1    tsubai paddr_t xafb_mmap __P((void *, off_t, int));
     86      1.1    tsubai int xafb_alloc_screen __P((void *, const struct wsscreen_descr *,
     87      1.1    tsubai 			   void **, int *, int *, long *));
     88      1.1    tsubai void xafb_free_screen __P((void *, void *));
     89      1.1    tsubai int xafb_show_screen __P((void *, void *, int,
     90      1.1    tsubai 			  void (*) (void *, int, int), void *));
     91      1.1    tsubai 
     92      1.1    tsubai int xafb_cnattach __P((void));
     93      1.1    tsubai int xafb_getcmap __P((struct xafb_softc *, struct wsdisplay_cmap *));
     94      1.1    tsubai int xafb_putcmap __P((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.1    tsubai xafb_match(parent, match, aux)
    130      1.1    tsubai 	struct device *parent;
    131      1.1    tsubai 	struct cfdata *match;
    132      1.1    tsubai 	void *aux;
    133      1.1    tsubai {
    134      1.1    tsubai 	struct apbus_attach_args *apa = aux;
    135      1.1    tsubai 
    136      1.1    tsubai 	if (strcmp(apa->apa_name, "xa") != 0)
    137      1.1    tsubai 		return 0;
    138      1.1    tsubai 
    139      1.1    tsubai 	return 1;
    140      1.1    tsubai }
    141      1.1    tsubai 
    142      1.1    tsubai void
    143      1.1    tsubai xafb_attach(parent, self, aux)
    144      1.1    tsubai 	struct device *parent, *self;
    145      1.1    tsubai 	void *aux;
    146      1.1    tsubai {
    147      1.1    tsubai 	struct xafb_softc *sc = (void *)self;
    148      1.1    tsubai 	struct apbus_attach_args *apa = aux;
    149      1.1    tsubai 	struct wsemuldisplaydev_attach_args wsa;
    150      1.1    tsubai 	struct xafb_devconfig *dc;
    151      1.1    tsubai 	struct rasops_info *ri;
    152      1.1    tsubai 	int console, i;
    153      1.1    tsubai 
    154      1.1    tsubai 	console = xafb_is_console();
    155      1.1    tsubai 
    156      1.1    tsubai 	if (console) {
    157      1.1    tsubai 		dc = &xafb_console_dc;
    158      1.1    tsubai 		ri = &dc->dc_ri;
    159      1.1    tsubai 		sc->sc_nscreens = 1;
    160      1.1    tsubai 	} else {
    161      1.1    tsubai 		dc = malloc(sizeof(struct xafb_devconfig), M_DEVBUF, M_WAITOK);
    162      1.1    tsubai 		bzero(dc, sizeof(struct xafb_devconfig));
    163      1.1    tsubai 
    164      1.1    tsubai 		dc->dc_fbbase = (void *)0xb0000000;		/* XXX */
    165      1.1    tsubai 		dc->dc_reg = (void *)(apa->apa_hwbase + 0x3000);
    166      1.1    tsubai 		if (xafb_common_init(dc) != 0) {
    167      1.1    tsubai 			printf(": couldn't initialize device\n");
    168      1.1    tsubai 			return;
    169      1.1    tsubai 		}
    170      1.1    tsubai 
    171      1.1    tsubai 		ri = &dc->dc_ri;
    172      1.1    tsubai 
    173      1.1    tsubai 		/* clear screen */
    174      1.1    tsubai 		(*ri->ri_ops.eraserows)(ri, 0, ri->ri_rows, 0);
    175      1.1    tsubai 	}
    176      1.1    tsubai 	sc->sc_dc = dc;
    177      1.1    tsubai 
    178      1.1    tsubai 	for (i = 0; i < 256; i++) {
    179      1.1    tsubai 		sc->sc_cmap_red[i] = i;
    180      1.1    tsubai 		sc->sc_cmap_green[i] = i;
    181      1.1    tsubai 		sc->sc_cmap_blue[i] = i;
    182      1.1    tsubai 	}
    183      1.1    tsubai 
    184      1.1    tsubai 	printf(": %d x %d, %dbpp\n", ri->ri_width, ri->ri_height, ri->ri_depth);
    185      1.1    tsubai 
    186      1.1    tsubai 	wsa.console = console;
    187      1.1    tsubai 	wsa.scrdata = &xafb_screenlist;
    188      1.1    tsubai 	wsa.accessops = &xafb_accessops;
    189      1.1    tsubai 	wsa.accesscookie = sc;
    190      1.1    tsubai 
    191      1.1    tsubai 	config_found(self, &wsa, wsemuldisplaydevprint);
    192      1.1    tsubai }
    193      1.1    tsubai 
    194      1.1    tsubai void
    195      1.1    tsubai xafb_setcolor(dc, index, r, g, b)
    196      1.1    tsubai 	struct xafb_devconfig *dc;
    197      1.1    tsubai 	int index, r, g, b;
    198      1.1    tsubai {
    199      1.1    tsubai 	volatile struct xafb_reg *reg = dc->dc_reg;
    200      1.1    tsubai 
    201      1.1    tsubai 	reg->index = index;
    202      1.1    tsubai 	reg->zero = 0;
    203      1.1    tsubai 	reg->rgb = r;
    204      1.1    tsubai 	reg->rgb = g;
    205      1.1    tsubai 	reg->rgb = b;
    206      1.1    tsubai }
    207      1.1    tsubai 
    208      1.1    tsubai int
    209      1.1    tsubai xafb_common_init(dc)
    210      1.1    tsubai 	struct xafb_devconfig *dc;
    211      1.1    tsubai {
    212      1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    213      1.1    tsubai 	int i;
    214      1.1    tsubai 
    215      1.1    tsubai 	for (i = 0; i < 256; i++)
    216      1.1    tsubai 		xafb_setcolor(dc, i, i, i, i);
    217      1.1    tsubai 
    218      1.1    tsubai 	/* initialize rasops */
    219      1.1    tsubai 	ri->ri_width = 1280;
    220      1.1    tsubai 	ri->ri_height = 1024;
    221      1.1    tsubai 	ri->ri_depth = 8;
    222      1.1    tsubai 	ri->ri_stride = 2048;
    223      1.1    tsubai 	ri->ri_bits = (void *)dc->dc_fbbase;
    224      1.1    tsubai 	ri->ri_flg = RI_FORCEMONO | RI_FULLCLEAR;
    225      1.1    tsubai 
    226      1.1    tsubai 	rasops_init(ri, 44, 100);
    227      1.1    tsubai 
    228      1.1    tsubai 	/* mono */
    229      1.1    tsubai 	ri->ri_devcmap[0] = 0;				/* bg */
    230      1.1    tsubai 	ri->ri_devcmap[1] = 0xffffffff;			/* fg */
    231      1.1    tsubai 
    232      1.1    tsubai 	xafb_stdscreen.nrows = ri->ri_rows;
    233      1.1    tsubai 	xafb_stdscreen.ncols = ri->ri_cols;
    234      1.1    tsubai 	xafb_stdscreen.textops = &ri->ri_ops;
    235      1.1    tsubai 	xafb_stdscreen.capabilities = ri->ri_caps;
    236      1.1    tsubai 
    237      1.1    tsubai 	return 0;
    238      1.1    tsubai }
    239      1.1    tsubai 
    240      1.1    tsubai int
    241      1.1    tsubai xafb_is_console()
    242      1.1    tsubai {
    243      1.1    tsubai 	volatile u_int *dipsw = (void *)NEWS5000_DIP_SWITCH;
    244      1.1    tsubai 
    245      1.1    tsubai 	if (*dipsw & 1)					/* XXX right? */
    246      1.1    tsubai 		return 1;
    247      1.1    tsubai 
    248      1.1    tsubai 	return 0;
    249      1.1    tsubai }
    250      1.1    tsubai 
    251      1.1    tsubai int
    252      1.1    tsubai xafb_ioctl(v, cmd, data, flag, p)
    253      1.1    tsubai 	void *v;
    254      1.1    tsubai 	u_long cmd;
    255      1.1    tsubai 	caddr_t data;
    256      1.1    tsubai 	int flag;
    257      1.1    tsubai 	struct proc *p;
    258      1.1    tsubai {
    259      1.1    tsubai 	struct xafb_softc *sc = v;
    260      1.1    tsubai 	struct xafb_devconfig *dc = sc->sc_dc;
    261      1.1    tsubai 	struct wsdisplay_fbinfo *wdf;
    262      1.1    tsubai 
    263      1.1    tsubai 	switch (cmd) {
    264      1.1    tsubai 	case WSDISPLAYIO_GTYPE:
    265      1.1    tsubai 		*(int *)data = WSDISPLAY_TYPE_UNKNOWN;	/* XXX */
    266      1.1    tsubai 		return 0;
    267      1.1    tsubai 
    268      1.1    tsubai 	case WSDISPLAYIO_GINFO:
    269      1.1    tsubai 		wdf = (void *)data;
    270      1.1    tsubai 		wdf->height = dc->dc_ri.ri_height;
    271      1.1    tsubai 		wdf->width = dc->dc_ri.ri_width;
    272      1.1    tsubai 		wdf->depth = dc->dc_ri.ri_depth;
    273      1.1    tsubai 		wdf->cmsize = 256;
    274      1.1    tsubai 		return 0;
    275      1.1    tsubai 
    276      1.1    tsubai 	case WSDISPLAYIO_GETCMAP:
    277      1.1    tsubai 		return xafb_getcmap(sc, (struct wsdisplay_cmap *)data);
    278      1.1    tsubai 
    279      1.1    tsubai 	case WSDISPLAYIO_PUTCMAP:
    280      1.1    tsubai 		return xafb_putcmap(sc, (struct wsdisplay_cmap *)data);
    281      1.1    tsubai 
    282      1.1    tsubai 	/* case WSDISPLAYIO_SVIDEO: */
    283      1.1    tsubai 	}
    284      1.2    atatat 	return EPASSTHROUGH;
    285      1.1    tsubai }
    286      1.1    tsubai 
    287      1.1    tsubai paddr_t
    288      1.1    tsubai xafb_mmap(v, offset, prot)
    289      1.1    tsubai 	void *v;
    290      1.1    tsubai 	off_t offset;
    291      1.1    tsubai 	int prot;
    292      1.1    tsubai {
    293      1.1    tsubai 	struct xafb_softc *sc = v;
    294      1.1    tsubai 	struct xafb_devconfig *dc = sc->sc_dc;
    295      1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    296      1.1    tsubai 
    297      1.1    tsubai 	if (offset >= (ri->ri_stride * ri->ri_height) || offset < 0)
    298      1.1    tsubai 		return -1;
    299      1.1    tsubai 
    300      1.1    tsubai 	return mips_btop((int)dc->dc_fbbase + offset);
    301      1.1    tsubai }
    302      1.1    tsubai 
    303      1.1    tsubai int
    304      1.1    tsubai xafb_alloc_screen(v, scrdesc, cookiep, ccolp, crowp, attrp)
    305      1.1    tsubai 	void *v;
    306      1.1    tsubai 	const struct wsscreen_descr *scrdesc;
    307      1.1    tsubai 	void **cookiep;
    308      1.1    tsubai 	int *ccolp, *crowp;
    309      1.1    tsubai 	long *attrp;
    310      1.1    tsubai {
    311      1.1    tsubai 	struct xafb_softc *sc = v;
    312      1.1    tsubai 	struct rasops_info *ri = &sc->sc_dc->dc_ri;
    313      1.1    tsubai 	long defattr;
    314      1.1    tsubai 
    315      1.1    tsubai 	if (sc->sc_nscreens > 0)
    316      1.1    tsubai 		return ENOMEM;
    317      1.1    tsubai 
    318      1.1    tsubai 	*cookiep = ri;
    319      1.1    tsubai 	*ccolp = *crowp = 0;
    320      1.3  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    321      1.1    tsubai 	*attrp = defattr;
    322      1.1    tsubai 	sc->sc_nscreens++;
    323      1.1    tsubai 
    324      1.1    tsubai 	return 0;
    325      1.1    tsubai }
    326      1.1    tsubai 
    327      1.1    tsubai void
    328      1.1    tsubai xafb_free_screen(v, cookie)
    329      1.1    tsubai 	void *v;
    330      1.1    tsubai 	void *cookie;
    331      1.1    tsubai {
    332      1.1    tsubai 	struct xafb_softc *sc = v;
    333      1.1    tsubai 
    334      1.1    tsubai 	if (sc->sc_dc == &xafb_console_dc)
    335      1.1    tsubai 		panic("xafb_free_screen: console");
    336      1.1    tsubai 
    337      1.1    tsubai 	sc->sc_nscreens--;
    338      1.1    tsubai }
    339      1.1    tsubai 
    340      1.1    tsubai int
    341      1.1    tsubai xafb_show_screen(v, cookie, waitok, cb, cbarg)
    342      1.1    tsubai 	void *v;
    343      1.1    tsubai 	void *cookie;
    344      1.1    tsubai 	int waitok;
    345      1.1    tsubai 	void (*cb) __P((void *, int, int));
    346      1.1    tsubai 	void *cbarg;
    347      1.1    tsubai {
    348      1.1    tsubai 	return 0;
    349      1.1    tsubai }
    350      1.1    tsubai 
    351      1.1    tsubai int
    352      1.1    tsubai xafb_cnattach()
    353      1.1    tsubai {
    354      1.1    tsubai 	struct xafb_devconfig *dc = &xafb_console_dc;
    355      1.1    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    356      1.1    tsubai 	long defattr;
    357      1.1    tsubai 	int crow = 0;
    358      1.1    tsubai 
    359      1.1    tsubai 	if (!xafb_is_console())
    360      1.1    tsubai 		return -1;
    361      1.1    tsubai 
    362      1.1    tsubai 	dc->dc_fbbase = (void *)0xb0000000;			/* XXX */
    363      1.1    tsubai 	dc->dc_reg = (void *)0xb4903000;			/* XXX */
    364      1.1    tsubai 	xafb_common_init(dc);
    365      1.1    tsubai 
    366      1.1    tsubai 	crow = 0;			/* XXX current cursor pos */
    367      1.1    tsubai 
    368      1.3  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    369      1.1    tsubai 	wsdisplay_cnattach(&xafb_stdscreen, &dc->dc_ri, 0, crow, defattr);
    370      1.1    tsubai 
    371      1.1    tsubai 	return 0;
    372      1.1    tsubai }
    373      1.1    tsubai 
    374      1.1    tsubai int
    375      1.1    tsubai xafb_getcmap(sc, cm)
    376      1.1    tsubai 	struct xafb_softc *sc;
    377      1.1    tsubai 	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.1    tsubai 	int error;
    382      1.1    tsubai 
    383      1.1    tsubai 	if (index >= 256 || count > 256 || index + count > 256)
    384      1.1    tsubai 		return EINVAL;
    385      1.1    tsubai 
    386      1.1    tsubai 	error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
    387      1.1    tsubai 	if (error)
    388      1.1    tsubai 		return error;
    389      1.1    tsubai 	error = copyout(&sc->sc_cmap_green[index], cm->green, count);
    390      1.1    tsubai 	if (error)
    391      1.1    tsubai 		return error;
    392      1.1    tsubai 	error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
    393      1.1    tsubai 	if (error)
    394      1.1    tsubai 		return error;
    395      1.1    tsubai 
    396      1.1    tsubai 	return 0;
    397      1.1    tsubai }
    398      1.1    tsubai 
    399      1.1    tsubai int
    400      1.1    tsubai xafb_putcmap(sc, cm)
    401      1.1    tsubai 	struct xafb_softc *sc;
    402      1.1    tsubai 	struct wsdisplay_cmap *cm;
    403      1.1    tsubai {
    404      1.1    tsubai 	u_int index = cm->index;
    405      1.1    tsubai 	u_int count = cm->count;
    406  1.5.6.1     skrll 	int i, error;
    407  1.5.6.1     skrll 	u_char rbuf[256], gbuf[256], bbuf[256];
    408      1.1    tsubai 	u_char *r, *g, *b;
    409      1.1    tsubai 
    410  1.5.6.1     skrll 	if (cm->index >= 256 || cm->count > 256 ||
    411  1.5.6.1     skrll 	    (cm->index + cm->count) > 256)
    412      1.1    tsubai 		return EINVAL;
    413  1.5.6.1     skrll 	error = copyin(cm->red, &rbuf[index], count);
    414  1.5.6.1     skrll 	if (error)
    415  1.5.6.1     skrll 		return error;
    416  1.5.6.1     skrll 	error = copyin(cm->green, &gbuf[index], count);
    417  1.5.6.1     skrll 	if (error)
    418  1.5.6.1     skrll 		return error;
    419  1.5.6.1     skrll 	error = copyin(cm->blue, &bbuf[index], count);
    420  1.5.6.1     skrll 	if (error)
    421  1.5.6.1     skrll 		return error;
    422  1.5.6.1     skrll 
    423  1.5.6.1     skrll 	memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
    424  1.5.6.1     skrll 	memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
    425  1.5.6.1     skrll 	memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
    426      1.1    tsubai 
    427      1.1    tsubai 	r = &sc->sc_cmap_red[index];
    428      1.1    tsubai 	g = &sc->sc_cmap_green[index];
    429      1.1    tsubai 	b = &sc->sc_cmap_blue[index];
    430      1.1    tsubai 	for (i = 0; i < count; i++)
    431      1.1    tsubai 		xafb_setcolor(sc->sc_dc, index++, *r++, *g++, *b++);
    432      1.1    tsubai 	return 0;
    433      1.1    tsubai }
    434