Home | History | Annotate | Line # | Download | only in dev
ofb.c revision 1.7
      1  1.7    tsubai /*	$NetBSD: ofb.c,v 1.7 1999/02/02 16:48:17 tsubai Exp $	*/
      2  1.1    tsubai 
      3  1.1    tsubai /*
      4  1.1    tsubai  * Copyright (c) 1995, 1996 Carnegie-Mellon University.
      5  1.1    tsubai  * All rights reserved.
      6  1.1    tsubai  *
      7  1.1    tsubai  * Author: Chris G. Demetriou
      8  1.1    tsubai  *
      9  1.1    tsubai  * Permission to use, copy, modify and distribute this software and
     10  1.1    tsubai  * its documentation is hereby granted, provided that both the copyright
     11  1.1    tsubai  * notice and this permission notice appear in all copies of the
     12  1.1    tsubai  * software, derivative works or modified versions, and any portions
     13  1.1    tsubai  * thereof, and that both notices appear in supporting documentation.
     14  1.1    tsubai  *
     15  1.1    tsubai  * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
     16  1.1    tsubai  * CONDITION.  CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND
     17  1.1    tsubai  * FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
     18  1.1    tsubai  *
     19  1.1    tsubai  * Carnegie Mellon requests users of this software to return to
     20  1.1    tsubai  *
     21  1.1    tsubai  *  Software Distribution Coordinator  or  Software.Distribution (at) CS.CMU.EDU
     22  1.1    tsubai  *  School of Computer Science
     23  1.1    tsubai  *  Carnegie Mellon University
     24  1.1    tsubai  *  Pittsburgh PA 15213-3890
     25  1.1    tsubai  *
     26  1.1    tsubai  * any improvements or extensions that they make and grant Carnegie the
     27  1.1    tsubai  * rights to redistribute these changes.
     28  1.1    tsubai  */
     29  1.1    tsubai 
     30  1.1    tsubai #include <sys/param.h>
     31  1.1    tsubai #include <sys/buf.h>
     32  1.1    tsubai #include <sys/conf.h>
     33  1.1    tsubai #include <sys/device.h>
     34  1.1    tsubai #include <sys/ioctl.h>
     35  1.1    tsubai #include <sys/kernel.h>
     36  1.1    tsubai #include <sys/malloc.h>
     37  1.1    tsubai #include <sys/systm.h>
     38  1.1    tsubai 
     39  1.3    tsubai #include <dev/pci/pcidevs.h>
     40  1.1    tsubai #include <dev/pci/pcireg.h>
     41  1.1    tsubai #include <dev/pci/pcivar.h>
     42  1.1    tsubai 
     43  1.1    tsubai #include <dev/rcons/raster.h>
     44  1.1    tsubai #include <dev/wscons/wsconsio.h>
     45  1.1    tsubai #include <dev/wscons/wscons_raster.h>
     46  1.1    tsubai #include <dev/wscons/wsdisplayvar.h>
     47  1.1    tsubai 
     48  1.1    tsubai #include <machine/bus.h>
     49  1.1    tsubai #include <machine/grfioctl.h>
     50  1.1    tsubai 
     51  1.1    tsubai #include <macppc/dev/ofbvar.h>
     52  1.1    tsubai 
     53  1.1    tsubai int	ofbmatch __P((struct device *, struct cfdata *, void *));
     54  1.1    tsubai void	ofbattach __P((struct device *, struct device *, void *));
     55  1.1    tsubai int	ofbprint __P((void *, const char *));
     56  1.1    tsubai 
     57  1.1    tsubai struct cfattach ofb_ca = {
     58  1.1    tsubai 	sizeof(struct ofb_softc), ofbmatch, ofbattach,
     59  1.1    tsubai };
     60  1.1    tsubai 
     61  1.1    tsubai struct ofb_devconfig ofb_console_dc;
     62  1.1    tsubai 
     63  1.1    tsubai struct wsdisplay_emulops ofb_emulops = {
     64  1.1    tsubai 	rcons_cursor,			/* could use hardware cursor; punt */
     65  1.1    tsubai 	rcons_mapchar,
     66  1.1    tsubai 	rcons_putchar,
     67  1.1    tsubai 	rcons_copycols,
     68  1.1    tsubai 	rcons_erasecols,
     69  1.1    tsubai 	rcons_copyrows,
     70  1.1    tsubai 	rcons_eraserows,
     71  1.1    tsubai 	rcons_alloc_attr
     72  1.1    tsubai };
     73  1.1    tsubai 
     74  1.1    tsubai struct wsscreen_descr ofb_stdscreen = {
     75  1.1    tsubai 	"std",
     76  1.1    tsubai 	0, 0,	/* will be filled in -- XXX shouldn't, it's global */
     77  1.1    tsubai 	&ofb_emulops,
     78  1.1    tsubai 	0, 0,
     79  1.1    tsubai 	WSSCREEN_REVERSE
     80  1.1    tsubai };
     81  1.1    tsubai 
     82  1.1    tsubai const struct wsscreen_descr *_ofb_scrlist[] = {
     83  1.1    tsubai 	&ofb_stdscreen,
     84  1.1    tsubai 	/* XXX other formats, graphics screen? */
     85  1.1    tsubai };
     86  1.1    tsubai 
     87  1.1    tsubai struct wsscreen_list ofb_screenlist = {
     88  1.1    tsubai 	sizeof(_ofb_scrlist) / sizeof(struct wsscreen_descr *), _ofb_scrlist
     89  1.1    tsubai };
     90  1.1    tsubai 
     91  1.1    tsubai static int ofb_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
     92  1.1    tsubai static int ofb_mmap __P((void *, off_t, int));
     93  1.1    tsubai static int ofb_alloc_screen __P((void *, const struct wsscreen_descr *,
     94  1.1    tsubai 				void **, int *, int *, long *));
     95  1.1    tsubai static void ofb_free_screen __P((void *, void *));
     96  1.1    tsubai static void ofb_show_screen __P((void *, void *));
     97  1.1    tsubai 
     98  1.1    tsubai struct wsdisplay_accessops ofb_accessops = {
     99  1.1    tsubai 	ofb_ioctl,
    100  1.1    tsubai 	ofb_mmap,
    101  1.1    tsubai 	ofb_alloc_screen,
    102  1.1    tsubai 	ofb_free_screen,
    103  1.1    tsubai 	ofb_show_screen,
    104  1.6  drochner 	0 /* load_font */
    105  1.1    tsubai };
    106  1.1    tsubai 
    107  1.1    tsubai static void ofb_common_init __P((int, struct ofb_devconfig *));
    108  1.1    tsubai 
    109  1.1    tsubai int
    110  1.1    tsubai ofbmatch(parent, match, aux)
    111  1.1    tsubai 	struct device *parent;
    112  1.1    tsubai 	struct cfdata *match;
    113  1.1    tsubai 	void *aux;
    114  1.1    tsubai {
    115  1.1    tsubai 	struct pci_attach_args *pa = aux;
    116  1.1    tsubai 
    117  1.3    tsubai 	/* /chaos/control */
    118  1.3    tsubai 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_APPLE &&
    119  1.3    tsubai 	    PCI_PRODUCT(pa->pa_id) == 3)
    120  1.3    tsubai 		return 1;
    121  1.1    tsubai 
    122  1.3    tsubai 	if (PCI_CLASS(pa->pa_class) == PCI_CLASS_DISPLAY)
    123  1.3    tsubai 		return 1;
    124  1.3    tsubai 
    125  1.3    tsubai 	return 0;
    126  1.1    tsubai }
    127  1.1    tsubai 
    128  1.1    tsubai void
    129  1.1    tsubai ofbattach(parent, self, aux)
    130  1.1    tsubai 	struct device *parent, *self;
    131  1.1    tsubai 	void *aux;
    132  1.1    tsubai {
    133  1.1    tsubai 	struct ofb_softc *sc = (struct ofb_softc *)self;
    134  1.1    tsubai 	struct pci_attach_args *pa = aux;
    135  1.1    tsubai 	struct wsemuldisplaydev_attach_args a;
    136  1.1    tsubai 	int console;
    137  1.1    tsubai 	struct ofb_devconfig *dc;
    138  1.5    tsubai 	char devinfo[256];
    139  1.1    tsubai 
    140  1.1    tsubai 	console = ofb_is_console();
    141  1.1    tsubai 
    142  1.1    tsubai 	if (console) {
    143  1.1    tsubai 		dc = &ofb_console_dc;
    144  1.1    tsubai 		sc->nscreens = 1;
    145  1.1    tsubai 	} else {
    146  1.1    tsubai 		int node;
    147  1.1    tsubai 
    148  1.1    tsubai 		dc = malloc(sizeof(struct ofb_devconfig), M_DEVBUF, M_WAITOK);
    149  1.1    tsubai 		bzero(dc, sizeof(struct ofb_devconfig));
    150  1.5    tsubai 		node = pcidev_to_ofdev(pa->pa_pc, pa->pa_tag);
    151  1.3    tsubai 		if (node == 0) {
    152  1.3    tsubai 			printf(": ofdev not found\n");
    153  1.3    tsubai 			return;
    154  1.3    tsubai 		}
    155  1.1    tsubai 		ofb_common_init(node, dc);
    156  1.1    tsubai 	}
    157  1.1    tsubai 	sc->sc_dc = dc;
    158  1.1    tsubai 
    159  1.1    tsubai 	if (dc->dc_paddr == 0) {
    160  1.1    tsubai 		printf(": cannot map framebuffer\n");
    161  1.1    tsubai 		return;
    162  1.1    tsubai 	}
    163  1.1    tsubai 	dc->dc_raster.pixels = mapiodev(dc->dc_paddr,
    164  1.1    tsubai 				dc->dc_linebytes * dc->dc_height);
    165  1.1    tsubai 
    166  1.5    tsubai 	pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo);
    167  1.5    tsubai 	printf(": %s\n", devinfo);
    168  1.5    tsubai 	printf("%s: %d x %d, %dbpp\n", self->dv_xname,
    169  1.1    tsubai 	    dc->dc_raster.width, dc->dc_raster.height, dc->dc_raster.depth);
    170  1.1    tsubai 
    171  1.1    tsubai 	a.console = console;
    172  1.1    tsubai 	a.scrdata = &ofb_screenlist;
    173  1.1    tsubai 	a.accessops = &ofb_accessops;
    174  1.1    tsubai 	a.accesscookie = sc;
    175  1.1    tsubai 
    176  1.1    tsubai 	config_found(self, &a, wsemuldisplaydevprint);
    177  1.1    tsubai }
    178  1.1    tsubai 
    179  1.1    tsubai void
    180  1.1    tsubai ofb_common_init(node, dc)
    181  1.1    tsubai 	int node;
    182  1.1    tsubai 	struct ofb_devconfig *dc;
    183  1.1    tsubai {
    184  1.1    tsubai 	struct raster *rap;
    185  1.1    tsubai 	struct rcons *rcp;
    186  1.1    tsubai 	int i;
    187  1.1    tsubai 	int addr, width, height, linebytes, depth;
    188  1.1    tsubai 	u_int regs[5];
    189  1.1    tsubai 
    190  1.1    tsubai 	OF_getprop(node, "assigned-addresses", regs, sizeof(regs));
    191  1.1    tsubai 	addr = regs[2] & 0xf0000000;
    192  1.1    tsubai 
    193  1.1    tsubai 	if (dc->dc_ih == 0) {
    194  1.1    tsubai 		char name[64];
    195  1.1    tsubai 
    196  1.1    tsubai 		bzero(name, 64);
    197  1.1    tsubai 		OF_package_to_path(node, name, sizeof(name));
    198  1.1    tsubai 		dc->dc_ih = OF_open(name);
    199  1.1    tsubai 	}
    200  1.3    tsubai 
    201  1.3    tsubai 	/*
    202  1.3    tsubai 	 * /chaos/control don't have "width", "height", ...
    203  1.3    tsubai 	 */
    204  1.3    tsubai 	width = height = -1;
    205  1.3    tsubai 	if (OF_getprop(node, "width", &width, sizeof(width)) != 4)
    206  1.3    tsubai 		OF_interpret("screen-width", 1, &width);
    207  1.3    tsubai 	if (OF_getprop(node, "height", &height, sizeof(height)) != 4)
    208  1.3    tsubai 		OF_interpret("screen-height", 1, &height);
    209  1.3    tsubai 	if (OF_getprop(node, "linebytes", &linebytes, sizeof(linebytes)) != 4)
    210  1.3    tsubai 		linebytes = width;			/* XXX */
    211  1.3    tsubai 	if (OF_getprop(node, "depth", &depth, sizeof(depth)) != 4)
    212  1.3    tsubai 		depth = 8;				/* XXX */
    213  1.3    tsubai 	if (width == -1 || height == -1)
    214  1.3    tsubai 		return;
    215  1.1    tsubai 
    216  1.1    tsubai 	OF_interpret("frame-buffer-adr", 1, &addr);
    217  1.1    tsubai 	if (addr == 0)
    218  1.1    tsubai 		return;
    219  1.1    tsubai 	dc->dc_paddr = addr;	/* PA of the frame buffer */
    220  1.1    tsubai 
    221  1.1    tsubai 	/* Set colormap to black on white. */
    222  1.1    tsubai 	OF_call_method_1("color!", dc->dc_ih, 4, 0, 0, 0, 0xff);
    223  1.1    tsubai 	OF_call_method_1("color!", dc->dc_ih, 4, 255, 255, 255, 0);
    224  1.1    tsubai 	for (i = 0; i < height * linebytes; i += sizeof(u_int32_t))
    225  1.1    tsubai 		*(u_int32_t *)(addr + i) = 0;
    226  1.1    tsubai 
    227  1.1    tsubai 	/* initialize the raster */
    228  1.1    tsubai 	rap = &dc->dc_raster;
    229  1.1    tsubai 	rap->width = width;
    230  1.1    tsubai 	rap->height = height;
    231  1.1    tsubai 	rap->depth = depth;
    232  1.1    tsubai 	rap->linelongs = linebytes / sizeof(u_int32_t);
    233  1.1    tsubai 	rap->pixels = (u_int32_t *)addr;
    234  1.1    tsubai 
    235  1.1    tsubai 	/* initialize the raster console blitter */
    236  1.1    tsubai 	rcp = &dc->dc_rcons;
    237  1.1    tsubai 	rcp->rc_sp = rap;
    238  1.1    tsubai 	rcp->rc_crow = rcp->rc_ccol = -1;
    239  1.1    tsubai 	rcp->rc_crowp = &rcp->rc_crow;
    240  1.1    tsubai 	rcp->rc_ccolp = &rcp->rc_ccol;
    241  1.1    tsubai 	rcons_init(rcp, 128, 128);
    242  1.1    tsubai 
    243  1.1    tsubai 	ofb_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
    244  1.1    tsubai 	ofb_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
    245  1.1    tsubai }
    246  1.1    tsubai 
    247  1.1    tsubai int
    248  1.1    tsubai ofb_is_console()
    249  1.1    tsubai {
    250  1.1    tsubai 	int chosen, stdout, node;
    251  1.1    tsubai 	char type[16];
    252  1.1    tsubai 
    253  1.1    tsubai 	chosen = OF_finddevice("/chosen");
    254  1.1    tsubai 	OF_getprop(chosen, "stdout", &stdout, 4);
    255  1.1    tsubai 	node = OF_instance_to_package(stdout);
    256  1.1    tsubai 	OF_getprop(node, "device_type", type, sizeof(type));
    257  1.1    tsubai 	if (strcmp(type, "display") == 0)
    258  1.1    tsubai 		return 1;
    259  1.1    tsubai 	else
    260  1.1    tsubai 		return 0;
    261  1.1    tsubai }
    262  1.1    tsubai 
    263  1.1    tsubai int
    264  1.1    tsubai ofb_ioctl(v, cmd, data, flag, p)
    265  1.1    tsubai 	void *v;
    266  1.1    tsubai 	u_long cmd;
    267  1.1    tsubai 	caddr_t data;
    268  1.1    tsubai 	int flag;
    269  1.1    tsubai 	struct proc *p;
    270  1.1    tsubai {
    271  1.1    tsubai 	struct ofb_softc *sc = v;
    272  1.1    tsubai 	struct ofb_devconfig *dc = sc->sc_dc;
    273  1.1    tsubai 	struct wsdisplay_fbinfo *wdf;
    274  1.1    tsubai 	struct grfinfo *gm;
    275  1.1    tsubai 
    276  1.1    tsubai 	switch (cmd) {
    277  1.1    tsubai 	case WSDISPLAYIO_GTYPE:
    278  1.1    tsubai 		*(u_int *)data = WSDISPLAY_TYPE_PCIMISC;	/* XXX ? */
    279  1.1    tsubai 		return 0;
    280  1.1    tsubai 
    281  1.1    tsubai 	case WSDISPLAYIO_GINFO:
    282  1.1    tsubai 		wdf = (void *)data;
    283  1.1    tsubai 		wdf->height = sc->sc_dc->dc_raster.height;
    284  1.1    tsubai 		wdf->width = sc->sc_dc->dc_raster.width;
    285  1.1    tsubai 		wdf->depth = sc->sc_dc->dc_raster.depth;
    286  1.1    tsubai 		wdf->cmsize = 256;
    287  1.1    tsubai 		return 0;
    288  1.1    tsubai 
    289  1.1    tsubai 	case WSDISPLAYIO_PUTCMAP:
    290  1.1    tsubai 		return putcmap(sc, data);
    291  1.1    tsubai 
    292  1.1    tsubai 	/* XXX There are no way to know framebuffer pa from a user program. */
    293  1.1    tsubai 	case GRFIOCGINFO:
    294  1.1    tsubai 		gm = (void *)data;
    295  1.1    tsubai 		bzero(gm, sizeof(struct grfinfo));
    296  1.1    tsubai 		gm->gd_fbaddr = (caddr_t)sc->sc_dc->dc_paddr;
    297  1.1    tsubai 		gm->gd_fbrowbytes = sc->sc_dc->dc_linebytes;
    298  1.1    tsubai 		return 0;
    299  1.1    tsubai 	}
    300  1.1    tsubai 	return -1;
    301  1.1    tsubai }
    302  1.1    tsubai 
    303  1.1    tsubai int
    304  1.1    tsubai ofb_mmap(v, offset, prot)
    305  1.1    tsubai 	void *v;
    306  1.1    tsubai 	off_t offset;
    307  1.1    tsubai 	int prot;
    308  1.1    tsubai {
    309  1.1    tsubai 	struct ofb_softc *sc = v;
    310  1.1    tsubai 	struct ofb_devconfig *dc = sc->sc_dc;
    311  1.1    tsubai 
    312  1.4       mrg 	if (offset >= (dc->dc_linebytes * dc->dc_height) || offset < 0)
    313  1.1    tsubai 		return -1;
    314  1.1    tsubai 
    315  1.1    tsubai 	return dc->dc_paddr + offset;
    316  1.1    tsubai }
    317  1.1    tsubai 
    318  1.1    tsubai int
    319  1.1    tsubai ofb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
    320  1.1    tsubai 	void *v;
    321  1.1    tsubai 	const struct wsscreen_descr *type;
    322  1.1    tsubai 	void **cookiep;
    323  1.1    tsubai 	int *curxp, *curyp;
    324  1.1    tsubai 	long *attrp;
    325  1.1    tsubai {
    326  1.1    tsubai 	struct ofb_softc *sc = v;
    327  1.1    tsubai 	long defattr;
    328  1.1    tsubai 
    329  1.1    tsubai 	if (sc->nscreens > 0)
    330  1.1    tsubai 		return (ENOMEM);
    331  1.1    tsubai 
    332  1.1    tsubai 	*cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
    333  1.1    tsubai 	*curxp = 0;
    334  1.1    tsubai 	*curyp = 0;
    335  1.1    tsubai 	rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
    336  1.1    tsubai 	*attrp = defattr;
    337  1.1    tsubai 	sc->nscreens++;
    338  1.1    tsubai 	return 0;
    339  1.1    tsubai }
    340  1.1    tsubai 
    341  1.1    tsubai void
    342  1.1    tsubai ofb_free_screen(v, cookie)
    343  1.1    tsubai 	void *v;
    344  1.1    tsubai 	void *cookie;
    345  1.1    tsubai {
    346  1.1    tsubai 	struct ofb_softc *sc = v;
    347  1.1    tsubai 
    348  1.1    tsubai 	if (sc->sc_dc == &ofb_console_dc)
    349  1.1    tsubai 		panic("ofb_free_screen: console");
    350  1.1    tsubai 
    351  1.1    tsubai 	sc->nscreens--;
    352  1.1    tsubai }
    353  1.1    tsubai 
    354  1.1    tsubai void
    355  1.1    tsubai ofb_show_screen(v, cookie)
    356  1.1    tsubai 	void *v;
    357  1.1    tsubai 	void *cookie;
    358  1.1    tsubai {
    359  1.1    tsubai }
    360  1.1    tsubai 
    361  1.1    tsubai int
    362  1.1    tsubai ofb_cnattach()
    363  1.1    tsubai {
    364  1.1    tsubai 	struct ofb_devconfig *dc = &ofb_console_dc;
    365  1.1    tsubai 	long defattr;
    366  1.1    tsubai 	int crow;
    367  1.1    tsubai 	int chosen, stdout, node;
    368  1.1    tsubai 	char cmd[32];
    369  1.1    tsubai 
    370  1.1    tsubai 	chosen = OF_finddevice("/chosen");
    371  1.1    tsubai 	OF_getprop(chosen, "stdout", &stdout, sizeof(stdout));
    372  1.1    tsubai 	node = OF_instance_to_package(stdout);
    373  1.1    tsubai 	dc->dc_ih = stdout;
    374  1.1    tsubai 
    375  1.1    tsubai 	ofb_common_init(node, dc);
    376  1.1    tsubai #if 0
    377  1.1    tsubai 	/* get current cursor position */
    378  1.1    tsubai 	OF_interpret("line#", 1, &crow);
    379  1.1    tsubai 
    380  1.1    tsubai 	/* move (rom monitor) cursor to the lowest line */
    381  1.1    tsubai 	sprintf(cmd, "%x to line#", ofb_stdscreen.nrows - 1);
    382  1.1    tsubai 	OF_interpret(cmd, 0);
    383  1.1    tsubai #endif
    384  1.1    tsubai 	rcons_alloc_attr(&dc->dc_rcons, 0, 0, 0, &defattr);
    385  1.1    tsubai 	wsdisplay_cnattach(&ofb_stdscreen, &dc->dc_rcons, 0, 0, defattr);
    386  1.1    tsubai 
    387  1.1    tsubai 	return 0;
    388  1.1    tsubai }
    389  1.1    tsubai 
    390  1.1    tsubai int
    391  1.1    tsubai putcmap(sc, cm)
    392  1.1    tsubai 	struct ofb_softc *sc;
    393  1.1    tsubai 	struct wsdisplay_cmap *cm;
    394  1.1    tsubai {
    395  1.1    tsubai 	struct ofb_devconfig *dc = sc->sc_dc;
    396  1.1    tsubai 	int index = cm->index;
    397  1.1    tsubai 	int count = cm->count;
    398  1.7    tsubai 	int i;
    399  1.1    tsubai 	u_char *r, *g, *b;
    400  1.1    tsubai 
    401  1.1    tsubai 	if (cm->index >= 256 || cm->count > 256 ||
    402  1.1    tsubai 	    (cm->index + cm->count) > 256)
    403  1.1    tsubai 		return EINVAL;
    404  1.1    tsubai #if defined(UVM)
    405  1.1    tsubai 	if (!uvm_useracc(cm->red, cm->count, B_READ) ||
    406  1.1    tsubai 	    !uvm_useracc(cm->green, cm->count, B_READ) ||
    407  1.1    tsubai 	    !uvm_useracc(cm->blue, cm->count, B_READ))
    408  1.1    tsubai 		return EFAULT;
    409  1.1    tsubai #else
    410  1.1    tsubai 	if (!useracc(cm->red, cm->count, B_READ) ||
    411  1.1    tsubai 	    !useracc(cm->green, cm->count, B_READ) ||
    412  1.1    tsubai 	    !useracc(cm->blue, cm->count, B_READ))
    413  1.1    tsubai 		return EFAULT;
    414  1.1    tsubai #endif
    415  1.1    tsubai 	copyin(cm->red,   &sc->sc_cmap_red[index],   count);
    416  1.1    tsubai 	copyin(cm->green, &sc->sc_cmap_green[index], count);
    417  1.1    tsubai 	copyin(cm->blue,  &sc->sc_cmap_blue[index],  count);
    418  1.1    tsubai 
    419  1.1    tsubai 	r = &sc->sc_cmap_red[index];
    420  1.1    tsubai 	g = &sc->sc_cmap_green[index];
    421  1.1    tsubai 	b = &sc->sc_cmap_blue[index];
    422  1.1    tsubai 
    423  1.1    tsubai 	for (i = 0; i < count; i++) {
    424  1.1    tsubai 		OF_call_method_1("color!", dc->dc_ih, 4, *r, *g, *b, index);
    425  1.1    tsubai 		r++, g++, b++, index++;
    426  1.1    tsubai 	}
    427  1.1    tsubai 
    428  1.1    tsubai 	return 0;
    429  1.1    tsubai }
    430