Home | History | Annotate | Line # | Download | only in dev
cgtwo.c revision 1.4
      1  1.4  pk /*	$NetBSD: cgtwo.c,v 1.4 1995/10/04 23:35:16 pk Exp $ */
      2  1.1  pk 
      3  1.1  pk /*
      4  1.1  pk  * Copyright (c) 1992, 1993
      5  1.1  pk  *	The Regents of the University of California.  All rights reserved.
      6  1.1  pk  *
      7  1.1  pk  * This software was developed by the Computer Systems Engineering group
      8  1.1  pk  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
      9  1.1  pk  * contributed to Berkeley.
     10  1.1  pk  *
     11  1.1  pk  * All advertising materials mentioning features or use of this software
     12  1.1  pk  * must display the following acknowledgement:
     13  1.1  pk  *	This product includes software developed by the University of
     14  1.1  pk  *	California, Lawrence Berkeley Laboratory.
     15  1.1  pk  *
     16  1.1  pk  * Redistribution and use in source and binary forms, with or without
     17  1.1  pk  * modification, are permitted provided that the following conditions
     18  1.1  pk  * are met:
     19  1.1  pk  * 1. Redistributions of source code must retain the above copyright
     20  1.1  pk  *    notice, this list of conditions and the following disclaimer.
     21  1.1  pk  * 2. Redistributions in binary form must reproduce the above copyright
     22  1.1  pk  *    notice, this list of conditions and the following disclaimer in the
     23  1.1  pk  *    documentation and/or other materials provided with the distribution.
     24  1.1  pk  * 3. All advertising materials mentioning features or use of this software
     25  1.1  pk  *    must display the following acknowledgement:
     26  1.1  pk  *	This product includes software developed by the University of
     27  1.1  pk  *	California, Berkeley and its contributors.
     28  1.1  pk  * 4. Neither the name of the University nor the names of its contributors
     29  1.1  pk  *    may be used to endorse or promote products derived from this software
     30  1.1  pk  *    without specific prior written permission.
     31  1.1  pk  *
     32  1.1  pk  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     33  1.1  pk  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     34  1.1  pk  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     35  1.1  pk  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     36  1.1  pk  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     37  1.1  pk  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     38  1.1  pk  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     39  1.1  pk  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     40  1.1  pk  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     41  1.1  pk  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     42  1.1  pk  * SUCH DAMAGE.
     43  1.1  pk  *
     44  1.1  pk  *	from: @(#)cgthree.c	8.2 (Berkeley) 10/30/93
     45  1.1  pk  */
     46  1.1  pk 
     47  1.1  pk /*
     48  1.1  pk  * color display (cgtwo) driver.
     49  1.1  pk  *
     50  1.1  pk  * Does not handle interrupts, even though they can occur.
     51  1.1  pk  *
     52  1.1  pk  * XXX should defer colormap updates to vertical retrace interrupts
     53  1.1  pk  */
     54  1.1  pk 
     55  1.1  pk #include <sys/param.h>
     56  1.1  pk #include <sys/buf.h>
     57  1.1  pk #include <sys/device.h>
     58  1.1  pk #include <sys/ioctl.h>
     59  1.1  pk #include <sys/malloc.h>
     60  1.1  pk #include <sys/mman.h>
     61  1.1  pk #include <sys/tty.h>
     62  1.1  pk 
     63  1.1  pk #include <vm/vm.h>
     64  1.1  pk 
     65  1.1  pk #include <machine/fbio.h>
     66  1.1  pk #include <machine/autoconf.h>
     67  1.1  pk #include <machine/pmap.h>
     68  1.1  pk #include <machine/fbvar.h>
     69  1.2  pk #if defined(SUN4)
     70  1.2  pk #include <machine/eeprom.h>
     71  1.2  pk #endif
     72  1.1  pk 
     73  1.3  pk #include <machine/cgtworeg.h>
     74  1.1  pk #include <sparc/dev/sbusvar.h>
     75  1.1  pk 
     76  1.1  pk /* per-display variables */
     77  1.1  pk struct cgtwo_softc {
     78  1.1  pk 	struct	device sc_dev;		/* base device */
     79  1.1  pk 	struct	sbusdev sc_sd;		/* sbus device */
     80  1.1  pk 	struct	fbdevice sc_fb;		/* frame buffer device */
     81  1.1  pk 	caddr_t	sc_phys;		/* display RAM (phys addr) */
     82  1.3  pk 	volatile struct cg2statusreg *sc_reg;	/* CG2 control registers */
     83  1.3  pk 	volatile u_short *sc_cmap;
     84  1.3  pk #define sc_redmap(sc)	((sc)->sc_cmap)
     85  1.3  pk #define sc_greenmap(sc)	((sc)->sc_cmap + CG2_CMSIZE)
     86  1.3  pk #define sc_bluemap(sc)	((sc)->sc_cmap + 2 * CG2_CMSIZE)
     87  1.1  pk };
     88  1.1  pk 
     89  1.1  pk /* autoconfiguration driver */
     90  1.1  pk static void	cgtwoattach(struct device *, struct device *, void *);
     91  1.1  pk static int	cgtwomatch(struct device *, void *, void *);
     92  1.1  pk int		cgtwoopen __P((dev_t, int, int, struct proc *));
     93  1.1  pk int		cgtwoclose __P((dev_t, int, int, struct proc *));
     94  1.1  pk int		cgtwoioctl __P((dev_t, u_long, caddr_t, int, struct proc *));
     95  1.1  pk int		cgtwommap __P((dev_t, int, int));
     96  1.1  pk static void	cgtwounblank(struct device *);
     97  1.1  pk 
     98  1.1  pk struct cfdriver cgtwocd = {
     99  1.1  pk 	NULL, "cgtwo", cgtwomatch, cgtwoattach,
    100  1.1  pk 	DV_DULL, sizeof(struct cgtwo_softc)
    101  1.1  pk };
    102  1.1  pk 
    103  1.1  pk /* frame buffer generic driver */
    104  1.1  pk static struct fbdriver cgtwofbdriver = {
    105  1.1  pk 	cgtwounblank, cgtwoopen, cgtwoclose, cgtwoioctl, cgtwommap
    106  1.1  pk };
    107  1.1  pk 
    108  1.1  pk extern int fbnode;
    109  1.1  pk extern struct tty *fbconstty;
    110  1.1  pk extern int nullop();
    111  1.1  pk static int cgtwo_cnputc();
    112  1.1  pk 
    113  1.1  pk static void cgtwoloadcmap __P((struct cgtwo_softc *, int, int));
    114  1.1  pk 
    115  1.1  pk /*
    116  1.1  pk  * Match a cgtwo.
    117  1.1  pk  */
    118  1.1  pk int
    119  1.1  pk cgtwomatch(parent, vcf, aux)
    120  1.1  pk 	struct device *parent;
    121  1.1  pk 	void *vcf, *aux;
    122  1.1  pk {
    123  1.1  pk 	struct cfdata *cf = vcf;
    124  1.1  pk 	struct confargs *ca = aux;
    125  1.1  pk 	struct romaux *ra = &ca->ca_ra;
    126  1.2  pk 	int probe;
    127  1.2  pk 	caddr_t tmp;
    128  1.2  pk 
    129  1.2  pk 	if (ca->ca_bustype != BUS_VME16)
    130  1.2  pk 		return (0);
    131  1.1  pk 
    132  1.1  pk 	if (strcmp(cf->cf_driver->cd_name, ra->ra_name))
    133  1.1  pk 		return (0);
    134  1.2  pk 
    135  1.2  pk #if defined(SUN4)
    136  1.2  pk 	if (cputyp != CPU_SUN4 || cf->cf_unit != 0)
    137  1.2  pk 		return (0);
    138  1.2  pk 
    139  1.2  pk 	/* XXX - Must do our own mapping at CG2_CTLREG_OFF */
    140  1.2  pk 	bus_untmp();
    141  1.2  pk 	tmp = (caddr_t)bus_tmp(ra->ra_paddr + CG2_CTLREG_OFF, ca->ca_bustype);
    142  1.2  pk 	if (probeget(tmp, 2) != -1)
    143  1.2  pk 		return 1;
    144  1.2  pk #endif
    145  1.2  pk 	return 0;
    146  1.1  pk }
    147  1.1  pk 
    148  1.1  pk /*
    149  1.1  pk  * Attach a display.  We need to notice if it is the console, too.
    150  1.1  pk  */
    151  1.1  pk void
    152  1.1  pk cgtwoattach(parent, self, args)
    153  1.1  pk 	struct device *parent, *self;
    154  1.1  pk 	void *args;
    155  1.1  pk {
    156  1.1  pk 	register struct cgtwo_softc *sc = (struct cgtwo_softc *)self;
    157  1.1  pk 	register struct confargs *ca = args;
    158  1.2  pk 	register int node, i;
    159  1.1  pk 	register struct cgtwo_all *p;
    160  1.1  pk 	int isconsole;
    161  1.1  pk 	int sbus = 1;
    162  1.1  pk 	char *nam;
    163  1.1  pk 
    164  1.1  pk 	sc->sc_fb.fb_driver = &cgtwofbdriver;
    165  1.1  pk 	sc->sc_fb.fb_device = &sc->sc_dev;
    166  1.1  pk 	/*
    167  1.1  pk 	 * The defaults below match my screen, but are not guaranteed
    168  1.1  pk 	 * to be correct as defaults go...
    169  1.1  pk 	 */
    170  1.1  pk 	sc->sc_fb.fb_type.fb_type = FBTYPE_SUN2COLOR;
    171  1.1  pk 	switch (ca->ca_bustype) {
    172  1.1  pk 	case BUS_OBIO:
    173  1.1  pk 	case BUS_VME32:
    174  1.1  pk 	case BUS_VME16:
    175  1.1  pk 		sbus = node = 0;
    176  1.1  pk 		sc->sc_fb.fb_type.fb_width = 1152;
    177  1.1  pk 		sc->sc_fb.fb_type.fb_height = 900;
    178  1.1  pk 		sc->sc_fb.fb_linebytes = 1152;
    179  1.1  pk 		nam = "cgtwo";
    180  1.2  pk 
    181  1.2  pk #if defined(SUN4)
    182  1.2  pk 		if (cputyp==CPU_SUN4) {
    183  1.2  pk 			struct eeprom *eep = (struct eeprom *)eeprom_va;
    184  1.2  pk 			if (eep != NULL) {
    185  1.2  pk 				switch (eep->eeScreenSize) {
    186  1.2  pk 				case EE_SCR_1152X900:
    187  1.2  pk 					/* Handled above. */
    188  1.2  pk 					break;
    189  1.2  pk 
    190  1.2  pk 				case EE_SCR_1024X1024:
    191  1.2  pk 					sc->sc_fb.fb_type.fb_width = 1024;
    192  1.2  pk 					sc->sc_fb.fb_type.fb_height = 1024;
    193  1.2  pk 					sc->sc_fb.fb_linebytes = 128;
    194  1.2  pk 					break;
    195  1.2  pk 
    196  1.2  pk 				case EE_SCR_1600X1280:
    197  1.2  pk 					sc->sc_fb.fb_type.fb_width = 1600;
    198  1.2  pk 					sc->sc_fb.fb_type.fb_height = 1280;
    199  1.2  pk 					sc->sc_fb.fb_linebytes = 200;
    200  1.2  pk 					break;
    201  1.2  pk 
    202  1.2  pk 				case EE_SCR_1440X1440:
    203  1.2  pk 					sc->sc_fb.fb_type.fb_width = 1440;
    204  1.2  pk 					sc->sc_fb.fb_type.fb_height = 1440;
    205  1.2  pk 					sc->sc_fb.fb_linebytes = 180;
    206  1.2  pk 					break;
    207  1.2  pk 
    208  1.2  pk 				default:
    209  1.2  pk 					/*
    210  1.2  pk 					 * XXX: Do nothing, I guess.
    211  1.2  pk 					 * Should we print a warning about
    212  1.2  pk 					 * an unknown value? --thorpej
    213  1.2  pk 					 */
    214  1.2  pk 					break;
    215  1.2  pk 				}
    216  1.2  pk 			}
    217  1.2  pk 		}
    218  1.2  pk #endif
    219  1.1  pk 		break;
    220  1.2  pk #if 0
    221  1.1  pk 	case BUS_SBUS:
    222  1.1  pk 		node = ca->ca_ra.ra_node;
    223  1.1  pk 		sc->sc_fb.fb_type.fb_width = getpropint(node, "width", 1152);
    224  1.1  pk 		sc->sc_fb.fb_type.fb_height = getpropint(node, "height", 900);
    225  1.1  pk 		sc->sc_fb.fb_linebytes = getpropint(node, "linebytes", 1152);
    226  1.1  pk 		nam = getpropstring(node, "model");
    227  1.1  pk 		break;
    228  1.2  pk #endif
    229  1.1  pk 	}
    230  1.1  pk 
    231  1.1  pk 	sc->sc_fb.fb_type.fb_depth = 8;
    232  1.1  pk 	sc->sc_fb.fb_type.fb_cmsize = 256;
    233  1.2  pk 	sc->sc_fb.fb_type.fb_size = roundup(CG2_MAPPED_SIZE, NBPG);
    234  1.1  pk 	printf(": %s, %d x %d", nam,
    235  1.1  pk 	    sc->sc_fb.fb_type.fb_width, sc->sc_fb.fb_type.fb_height);
    236  1.1  pk 
    237  1.1  pk 	/*
    238  1.1  pk 	 * When the ROM has mapped in a cgtwo display, the address
    239  1.1  pk 	 * maps only the video RAM, so in any case we have to map the
    240  1.1  pk 	 * registers ourselves.  We only need the video RAM if we are
    241  1.1  pk 	 * going to print characters via rconsole.
    242  1.1  pk 	 */
    243  1.2  pk #if defined(SUN4)
    244  1.2  pk 	if (cputyp == CPU_SUN4) {
    245  1.2  pk 		struct eeprom *eep = (struct eeprom *)eeprom_va;
    246  1.2  pk 		/*
    247  1.2  pk 		 * Assume this is the console if there's no eeprom info
    248  1.2  pk 		 * to be found.
    249  1.2  pk 		 */
    250  1.2  pk 		if (eep == NULL || eep->eeConsole == EE_CONS_COLOR)
    251  1.2  pk 			isconsole = (fbconstty != NULL);
    252  1.2  pk 		else
    253  1.2  pk 			isconsole = 0;
    254  1.2  pk 	}
    255  1.2  pk #endif
    256  1.2  pk #if defined(SUN4C) || defined(SUN4M)
    257  1.2  pk 	if (cputyp == CPU_SUN4C || cputyp == CPU_SUN4M)
    258  1.2  pk 		isconsole = node == fbnode && fbconstty != NULL;
    259  1.2  pk #endif
    260  1.1  pk 	sc->sc_phys = (caddr_t)ca->ca_ra.ra_paddr;
    261  1.1  pk 	if ((sc->sc_fb.fb_pixels = ca->ca_ra.ra_vaddr) == NULL && isconsole) {
    262  1.1  pk 		/* this probably cannot happen, but what the heck */
    263  1.2  pk 		sc->sc_fb.fb_pixels = mapiodev(sc->sc_phys + CG2_PIXMAP_OFF,
    264  1.2  pk 					       CG2_PIXMAP_SIZE,
    265  1.1  pk 					       ca->ca_bustype);
    266  1.1  pk 	}
    267  1.3  pk #ifndef offsetof
    268  1.3  pk #define	offsetof(type, member)  ((size_t)(&((type *)0)->member))
    269  1.3  pk #endif
    270  1.3  pk 
    271  1.3  pk 	sc->sc_reg = (volatile struct cg2statusreg *)
    272  1.3  pk 	    mapiodev((caddr_t)sc->sc_phys +
    273  1.3  pk 		     CG2_ROPMEM_OFF + offsetof(struct cg2fb, status.reg),
    274  1.4  pk 		     sizeof(struct cg2statusreg), ca->ca_bustype);
    275  1.3  pk 
    276  1.3  pk 	sc->sc_cmap = (volatile u_short *)
    277  1.3  pk 	    mapiodev((caddr_t)sc->sc_phys +
    278  1.3  pk 		     CG2_ROPMEM_OFF + offsetof(struct cg2fb, redmap[0]),
    279  1.3  pk 		     3 * CG2_CMSIZE, ca->ca_bustype);
    280  1.1  pk 
    281  1.1  pk 	if (isconsole) {
    282  1.1  pk 		printf(" (console)\n");
    283  1.4  pk #ifdef RASTERCONSOLE
    284  1.1  pk 		fbrcons_init(&sc->sc_fb);
    285  1.1  pk #endif
    286  1.1  pk 	} else
    287  1.1  pk 		printf("\n");
    288  1.1  pk 	if (sbus)
    289  1.1  pk 		sbus_establish(&sc->sc_sd, &sc->sc_dev);
    290  1.1  pk 	if (node == fbnode)
    291  1.1  pk 		fb_attach(&sc->sc_fb);
    292  1.1  pk }
    293  1.1  pk 
    294  1.1  pk int
    295  1.1  pk cgtwoopen(dev, flags, mode, p)
    296  1.1  pk 	dev_t dev;
    297  1.1  pk 	int flags, mode;
    298  1.1  pk 	struct proc *p;
    299  1.1  pk {
    300  1.1  pk 	int unit = minor(dev);
    301  1.1  pk 
    302  1.1  pk 	if (unit >= cgtwocd.cd_ndevs || cgtwocd.cd_devs[unit] == NULL)
    303  1.1  pk 		return (ENXIO);
    304  1.1  pk 	return (0);
    305  1.1  pk }
    306  1.1  pk 
    307  1.1  pk int
    308  1.1  pk cgtwoclose(dev, flags, mode, p)
    309  1.1  pk 	dev_t dev;
    310  1.1  pk 	int flags, mode;
    311  1.1  pk 	struct proc *p;
    312  1.1  pk {
    313  1.1  pk 
    314  1.1  pk 	return (0);
    315  1.1  pk }
    316  1.1  pk 
    317  1.1  pk int
    318  1.1  pk cgtwoioctl(dev, cmd, data, flags, p)
    319  1.1  pk 	dev_t dev;
    320  1.1  pk 	u_long cmd;
    321  1.1  pk 	register caddr_t data;
    322  1.1  pk 	int flags;
    323  1.1  pk 	struct proc *p;
    324  1.1  pk {
    325  1.1  pk 	register struct cgtwo_softc *sc = cgtwocd.cd_devs[minor(dev)];
    326  1.1  pk 	register struct fbgattr *fba;
    327  1.1  pk 	int error;
    328  1.1  pk 
    329  1.1  pk 	switch (cmd) {
    330  1.1  pk 
    331  1.1  pk 	case FBIOGTYPE:
    332  1.1  pk 		*(struct fbtype *)data = sc->sc_fb.fb_type;
    333  1.1  pk 		break;
    334  1.1  pk 
    335  1.1  pk 	case FBIOGATTR:
    336  1.1  pk 		fba = (struct fbgattr *)data;
    337  1.1  pk 		fba->real_type = sc->sc_fb.fb_type.fb_type;
    338  1.1  pk 		fba->owner = 0;		/* XXX ??? */
    339  1.1  pk 		fba->fbtype = sc->sc_fb.fb_type;
    340  1.1  pk 		fba->sattr.flags = 0;
    341  1.1  pk 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
    342  1.1  pk 		fba->sattr.dev_specific[0] = -1;
    343  1.1  pk 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
    344  1.1  pk 		fba->emu_types[1] = -1;
    345  1.1  pk 		break;
    346  1.1  pk 
    347  1.1  pk 	case FBIOGETCMAP:
    348  1.1  pk 		return cgtwogetcmap(sc, data);
    349  1.1  pk 
    350  1.1  pk 	case FBIOPUTCMAP:
    351  1.1  pk 		return cgtwoputcmap(sc, data);
    352  1.1  pk 
    353  1.1  pk 	case FBIOGVIDEO:
    354  1.3  pk 		*(int *)data = sc->sc_reg->video_enab;
    355  1.1  pk 		break;
    356  1.1  pk 
    357  1.1  pk 	case FBIOSVIDEO:
    358  1.3  pk 		sc->sc_reg->video_enab = (*(int*)data) & 1;
    359  1.1  pk 		break;
    360  1.1  pk 
    361  1.1  pk 	default:
    362  1.1  pk 		return (ENOTTY);
    363  1.1  pk 	}
    364  1.1  pk 	return (0);
    365  1.1  pk }
    366  1.1  pk 
    367  1.1  pk /*
    368  1.1  pk  * Undo the effect of an FBIOSVIDEO that turns the video off.
    369  1.1  pk  */
    370  1.1  pk static void
    371  1.1  pk cgtwounblank(dev)
    372  1.1  pk 	struct device *dev;
    373  1.1  pk {
    374  1.1  pk 	struct cgtwo_softc *sc = (struct cgtwo_softc *)dev;
    375  1.3  pk 	sc->sc_reg->video_enab = 1;
    376  1.1  pk }
    377  1.1  pk 
    378  1.1  pk /*
    379  1.1  pk  */
    380  1.1  pk int
    381  1.1  pk cgtwogetcmap(sc, cmap)
    382  1.1  pk 	register struct cgtwo_softc *sc;
    383  1.1  pk 	register struct fbcmap *cmap;
    384  1.1  pk {
    385  1.1  pk 	u_char red[CG2_CMSIZE], green[CG2_CMSIZE], blue[CG2_CMSIZE];
    386  1.1  pk 	int error, start, count, ecount;
    387  1.1  pk 	register u_int i;
    388  1.3  pk 	register volatile u_short *p;
    389  1.1  pk 
    390  1.1  pk 	start = cmap->index;
    391  1.1  pk 	count = cmap->count;
    392  1.1  pk 	ecount = start + count;
    393  1.1  pk 	if (start >= CG2_CMSIZE || ecount > CG2_CMSIZE)
    394  1.1  pk 		return (EINVAL);
    395  1.1  pk 
    396  1.1  pk 	/* XXX - Wait for retrace? */
    397  1.1  pk 
    398  1.1  pk 	/* Copy hardware to local arrays. */
    399  1.3  pk 	p = &sc_redmap(sc)[start];
    400  1.1  pk 	for (i = start; i < ecount; i++)
    401  1.1  pk 		red[i] = *p++;
    402  1.3  pk 	p = &sc_greenmap(sc)[start];
    403  1.1  pk 	for (i = start; i < ecount; i++)
    404  1.1  pk 		green[i] = *p++;
    405  1.3  pk 	p = &sc_bluemap(sc)[start];
    406  1.1  pk 	for (i = start; i < ecount; i++)
    407  1.1  pk 		blue[i] = *p++;
    408  1.1  pk 
    409  1.1  pk 	/* Copy local arrays to user space. */
    410  1.1  pk 	if ((error = copyout(red + start, cmap->red, count)) != 0)
    411  1.1  pk 		return (error);
    412  1.1  pk 	if ((error = copyout(green + start, cmap->green, count)) != 0)
    413  1.1  pk 		return (error);
    414  1.1  pk 	if ((error = copyout(blue + start, cmap->blue, count)) != 0)
    415  1.1  pk 		return (error);
    416  1.1  pk 
    417  1.1  pk 	return (0);
    418  1.1  pk }
    419  1.1  pk 
    420  1.1  pk /*
    421  1.1  pk  */
    422  1.1  pk int
    423  1.1  pk cgtwoputcmap(sc, cmap)
    424  1.1  pk 	register struct cgtwo_softc *sc;
    425  1.1  pk 	register struct fbcmap *cmap;
    426  1.1  pk {
    427  1.1  pk 	u_char red[CG2_CMSIZE], green[CG2_CMSIZE], blue[CG2_CMSIZE];
    428  1.1  pk 	int error, start, count, ecount;
    429  1.1  pk 	register u_int i;
    430  1.3  pk 	register volatile u_short *p;
    431  1.1  pk 
    432  1.1  pk 	start = cmap->index;
    433  1.1  pk 	count = cmap->count;
    434  1.1  pk 	ecount = start + count;
    435  1.1  pk 	if (start >= CG2_CMSIZE || ecount > CG2_CMSIZE)
    436  1.1  pk 		return (EINVAL);
    437  1.1  pk 
    438  1.1  pk 	/* Copy from user space to local arrays. */
    439  1.1  pk 	if ((error = copyin(cmap->red, red + start, count)) != 0)
    440  1.1  pk 		return (error);
    441  1.1  pk 	if ((error = copyin(cmap->green, green + start, count)) != 0)
    442  1.1  pk 		return (error);
    443  1.1  pk 	if ((error = copyin(cmap->blue, blue + start, count)) != 0)
    444  1.1  pk 		return (error);
    445  1.1  pk 
    446  1.1  pk 	/* XXX - Wait for retrace? */
    447  1.1  pk 
    448  1.1  pk 	/* Copy from local arrays to hardware. */
    449  1.3  pk 	p = &sc_redmap(sc)[start];
    450  1.1  pk 	for (i = start; i < ecount; i++)
    451  1.1  pk 		*p++ = red[i];
    452  1.3  pk 	p = &sc_greenmap(sc)[start];
    453  1.1  pk 	for (i = start; i < ecount; i++)
    454  1.1  pk 		*p++ = green[i];
    455  1.3  pk 	p = &sc_bluemap(sc)[start];
    456  1.1  pk 	for (i = start; i < ecount; i++)
    457  1.1  pk 		*p++ = blue[i];
    458  1.1  pk 
    459  1.1  pk 	return (0);
    460  1.1  pk }
    461  1.1  pk 
    462  1.1  pk /*
    463  1.1  pk  * Return the address that would map the given device at the given
    464  1.1  pk  * offset, allowing for the given protection, or return -1 for error.
    465  1.1  pk  */
    466  1.1  pk int
    467  1.1  pk cgtwommap(dev, off, prot)
    468  1.1  pk 	dev_t dev;
    469  1.1  pk 	int off, prot;
    470  1.1  pk {
    471  1.1  pk 	register struct cgtwo_softc *sc = cgtwocd.cd_devs[minor(dev)];
    472  1.1  pk 
    473  1.1  pk 	if (off & PGOFSET)
    474  1.1  pk 		panic("cgtwommap");
    475  1.1  pk 
    476  1.1  pk 	if ((unsigned)off >= sc->sc_fb.fb_type.fb_size)
    477  1.1  pk 		return (-1);
    478  1.1  pk 
    479  1.2  pk 	return ((int)sc->sc_phys + off + PMAP_VME16 + PMAP_NC);
    480  1.1  pk }
    481