Home | History | Annotate | Line # | Download | only in dev
cgfourteen.c revision 1.20.4.6
      1  1.20.4.6  jdolecek /*	$NetBSD: cgfourteen.c,v 1.20.4.6 2002/09/06 08:40:49 jdolecek Exp $ */
      2       1.1    abrown 
      3       1.1    abrown /*
      4      1.12        pk  * Copyright (c) 1996
      5       1.1    abrown  *	The President and Fellows of Harvard College. All rights reserved.
      6       1.1    abrown  * Copyright (c) 1992, 1993
      7       1.1    abrown  *	The Regents of the University of California.  All rights reserved.
      8       1.1    abrown  *
      9       1.1    abrown  * This software was developed by the Computer Systems Engineering group
     10       1.1    abrown  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
     11       1.1    abrown  * contributed to Berkeley.
     12       1.1    abrown  *
     13       1.1    abrown  * All advertising materials mentioning features or use of this software
     14       1.1    abrown  * must display the following acknowledgement:
     15       1.1    abrown  *	This product includes software developed by Harvard University.
     16       1.1    abrown  *	This product includes software developed by the University of
     17       1.1    abrown  *	California, Lawrence Berkeley Laboratory.
     18       1.1    abrown  *
     19       1.1    abrown  * Redistribution and use in source and binary forms, with or without
     20       1.1    abrown  * modification, are permitted provided that the following conditions
     21       1.1    abrown  * are met:
     22       1.1    abrown  * 1. Redistributions of source code must retain the above copyright
     23       1.1    abrown  *    notice, this list of conditions and the following disclaimer.
     24       1.1    abrown  * 2. Redistributions in binary form must reproduce the above copyright
     25       1.1    abrown  *    notice, this list of conditions and the following disclaimer in the
     26       1.1    abrown  *    documentation and/or other materials provided with the distribution.
     27       1.1    abrown  * 3. All advertising materials mentioning features or use of this software
     28       1.1    abrown  *    must display the following acknowledgement:
     29       1.1    abrown  *	This product includes software developed by the University of
     30       1.1    abrown  *	California, Berkeley and its contributors.
     31       1.1    abrown  *	This product includes software developed by Harvard University and
     32       1.1    abrown  *	its contributors.
     33       1.1    abrown  * 4. Neither the name of the University nor the names of its contributors
     34       1.1    abrown  *    may be used to endorse or promote products derived from this software
     35       1.1    abrown  *    without specific prior written permission.
     36       1.1    abrown  *
     37       1.1    abrown  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     38       1.1    abrown  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     39       1.1    abrown  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     40       1.1    abrown  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     41       1.1    abrown  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     42       1.1    abrown  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     43       1.1    abrown  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     44       1.1    abrown  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     45       1.1    abrown  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     46       1.1    abrown  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     47       1.1    abrown  * SUCH DAMAGE.
     48       1.1    abrown  *
     49       1.1    abrown  *   Based on:
     50       1.1    abrown  *	NetBSD: cgthree.c,v 1.28 1996/05/31 09:59:22 pk Exp
     51       1.1    abrown  *	NetBSD: cgsix.c,v 1.25 1996/04/01 17:30:00 christos Exp
     52       1.1    abrown  */
     53       1.1    abrown 
     54       1.1    abrown /*
     55       1.1    abrown  * Driver for Campus-II on-board mbus-based video (cgfourteen).
     56       1.1    abrown  * Provides minimum emulation of a Sun cgthree 8-bit framebuffer to
     57       1.1    abrown  * allow X to run.
     58       1.1    abrown  *
     59       1.1    abrown  * Does not handle interrupts, even though they can occur.
     60       1.1    abrown  *
     61       1.1    abrown  * XXX should defer colormap updates to vertical retrace interrupts
     62       1.1    abrown  */
     63      1.10       mrg 
     64      1.12        pk /*
     65       1.1    abrown  * The following is for debugging only; it opens up a security hole
     66      1.12        pk  * enabled by allowing any user to map the control registers for the
     67       1.1    abrown  * cg14 into their space.
     68       1.1    abrown  */
     69       1.1    abrown #undef CG14_MAP_REGS
     70       1.1    abrown 
     71       1.1    abrown /*
     72       1.1    abrown  * The following enables 24-bit operation: when opened, the framebuffer
     73      1.12        pk  * will switch to 24-bit mode (actually 32-bit mode), and provide a
     74       1.1    abrown  * simple cg8 emulation.
     75       1.1    abrown  *
     76       1.1    abrown  * XXX Note that the code enabled by this define is currently untested/broken.
     77       1.1    abrown  */
     78       1.1    abrown #undef CG14_CG8
     79       1.1    abrown 
     80       1.1    abrown #include <sys/param.h>
     81       1.1    abrown #include <sys/systm.h>
     82       1.1    abrown #include <sys/buf.h>
     83       1.1    abrown #include <sys/device.h>
     84       1.1    abrown #include <sys/ioctl.h>
     85       1.1    abrown #include <sys/malloc.h>
     86       1.1    abrown #include <sys/mman.h>
     87       1.1    abrown #include <sys/tty.h>
     88       1.1    abrown #include <sys/conf.h>
     89       1.1    abrown 
     90      1.18       mrg #include <uvm/uvm_extern.h>
     91       1.1    abrown 
     92      1.19        pk #include <machine/bus.h>
     93      1.19        pk #include <machine/autoconf.h>
     94      1.19        pk #include <machine/conf.h>
     95      1.19        pk 
     96      1.19        pk #include <dev/sbus/sbusvar.h>
     97      1.19        pk 
     98      1.20        pk #include <dev/sun/fbio.h>
     99      1.20        pk #include <dev/sun/fbvar.h>
    100       1.1    abrown 
    101       1.1    abrown #include <sparc/dev/cgfourteenreg.h>
    102       1.1    abrown #include <sparc/dev/cgfourteenvar.h>
    103       1.1    abrown 
    104       1.1    abrown /* autoconfiguration driver */
    105       1.1    abrown static void	cgfourteenattach(struct device *, struct device *, void *);
    106       1.6        pk static int	cgfourteenmatch(struct device *, struct cfdata *, void *);
    107       1.1    abrown static void	cgfourteenunblank(struct device *);
    108       1.1    abrown 
    109       1.3   thorpej /* cdevsw prototypes */
    110       1.3   thorpej cdev_decl(cgfourteen);
    111       1.3   thorpej 
    112       1.1    abrown struct cfattach cgfourteen_ca = {
    113       1.1    abrown 	sizeof(struct cgfourteen_softc), cgfourteenmatch, cgfourteenattach
    114       1.1    abrown };
    115       1.1    abrown 
    116       1.8   thorpej extern struct cfdriver cgfourteen_cd;
    117       1.1    abrown 
    118       1.1    abrown /* frame buffer generic driver */
    119       1.1    abrown static struct fbdriver cgfourteenfbdriver = {
    120      1.12        pk 	cgfourteenunblank, cgfourteenopen, cgfourteenclose, cgfourteenioctl,
    121  1.20.4.5  jdolecek 	cgfourteenpoll, cgfourteenmmap, cgfourteenkqfilter
    122       1.1    abrown };
    123       1.1    abrown 
    124       1.1    abrown static void cg14_set_video __P((struct cgfourteen_softc *, int));
    125       1.1    abrown static int  cg14_get_video __P((struct cgfourteen_softc *));
    126       1.1    abrown static int  cg14_get_cmap __P((struct fbcmap *, union cg14cmap *, int));
    127       1.1    abrown static int  cg14_put_cmap __P((struct fbcmap *, union cg14cmap *, int));
    128       1.1    abrown static void cg14_load_hwcmap __P((struct cgfourteen_softc *, int, int));
    129       1.1    abrown static void cg14_init __P((struct cgfourteen_softc *));
    130       1.1    abrown static void cg14_reset __P((struct cgfourteen_softc *));
    131       1.1    abrown static void cg14_loadomap __P((struct cgfourteen_softc *));/* cursor overlay */
    132       1.1    abrown static void cg14_setcursor __P((struct cgfourteen_softc *));/* set position */
    133       1.1    abrown static void cg14_loadcursor __P((struct cgfourteen_softc *));/* set shape */
    134       1.1    abrown 
    135       1.1    abrown /*
    136  1.20.4.3  jdolecek  * We map the display memory with an offset of 256K when emulating the cg3 or
    137  1.20.4.3  jdolecek  * cg8; the cg3 uses this offset for compatibility with the cg4, and both the
    138  1.20.4.3  jdolecek  * cg4 and cg8 have a mono overlay plane and an overlay enable plane in the
    139  1.20.4.3  jdolecek  * first 256K.  Mapping at an offset of 0x04000000 causes only the color
    140  1.20.4.3  jdolecek  * frame buffer to be mapped, without the overlay planes.
    141  1.20.4.3  jdolecek  */
    142  1.20.4.3  jdolecek #define START		(128*1024 + 128*1024)
    143  1.20.4.3  jdolecek #define NOOVERLAY	(0x04000000)
    144  1.20.4.3  jdolecek 
    145  1.20.4.3  jdolecek /*
    146       1.1    abrown  * Match a cgfourteen.
    147       1.1    abrown  */
    148       1.1    abrown int
    149       1.6        pk cgfourteenmatch(parent, cf, aux)
    150       1.1    abrown 	struct device *parent;
    151       1.6        pk 	struct cfdata *cf;
    152       1.6        pk 	void *aux;
    153       1.1    abrown {
    154      1.11        pk 	union obio_attach_args *uoba = aux;
    155      1.11        pk 	struct sbus_attach_args *sa = &uoba->uoba_sbus;
    156       1.1    abrown 
    157       1.1    abrown 	/*
    158       1.1    abrown 	 * The cgfourteen is a local-bus video adaptor, accessed directly
    159       1.1    abrown 	 * via the processor, and not through device space or an external
    160       1.1    abrown 	 * bus. Thus we look _only_ at the obio bus.
    161       1.1    abrown 	 * Additionally, these things exist only on the Sun4m.
    162       1.1    abrown 	 */
    163      1.11        pk 
    164      1.11        pk 	if (uoba->uoba_isobio4 != 0 || !CPU_ISSUN4M)
    165      1.11        pk 		return (0);
    166      1.11        pk 
    167      1.11        pk 	/* Check driver name */
    168      1.11        pk 	return (strcmp(cf->cf_driver->cd_name, sa->sa_name) == 0);
    169       1.1    abrown }
    170       1.1    abrown 
    171       1.1    abrown /*
    172       1.1    abrown  * Attach a display.  We need to notice if it is the console, too.
    173       1.1    abrown  */
    174       1.1    abrown void
    175      1.11        pk cgfourteenattach(parent, self, aux)
    176       1.1    abrown 	struct device *parent, *self;
    177      1.11        pk 	void *aux;
    178       1.1    abrown {
    179      1.11        pk 	union obio_attach_args *uoba = aux;
    180      1.11        pk 	struct sbus_attach_args *sa = &uoba->uoba_sbus;
    181      1.11        pk 	struct cgfourteen_softc *sc = (struct cgfourteen_softc *)self;
    182      1.11        pk 	struct fbdevice *fb = &sc->sc_fb;
    183      1.11        pk 	bus_space_handle_t bh;
    184      1.11        pk 	int node, ramsize;
    185      1.11        pk 	u_int32_t *lut;
    186       1.1    abrown 	int i, isconsole;
    187      1.11        pk 
    188      1.11        pk 	node = sa->sa_node;
    189      1.11        pk 
    190      1.11        pk 	/* Remember cookies for cgfourteenmmap() */
    191      1.11        pk 	sc->sc_bustag = sa->sa_bustag;
    192       1.1    abrown 
    193      1.11        pk 	fb->fb_driver = &cgfourteenfbdriver;
    194      1.11        pk 	fb->fb_device = &sc->sc_dev;
    195      1.11        pk 	/* Mask out invalid flags from the user. */
    196      1.11        pk 	fb->fb_flags = sc->sc_dev.dv_cfdata->cf_flags & FB_USERMASK;
    197       1.1    abrown 
    198       1.1    abrown 	/*
    199       1.1    abrown 	 * We're emulating a cg3/8, so represent ourselves as one
    200       1.1    abrown 	 */
    201       1.1    abrown #ifdef CG14_CG8
    202      1.11        pk 	fb->fb_type.fb_type = FBTYPE_MEMCOLOR;
    203      1.11        pk 	fb->fb_type.fb_depth = 32;
    204       1.1    abrown #else
    205      1.11        pk 	fb->fb_type.fb_type = FBTYPE_SUN3COLOR;
    206      1.11        pk 	fb->fb_type.fb_depth = 8;
    207       1.1    abrown #endif
    208      1.11        pk 	fb_setsize_obp(fb, sc->sc_fb.fb_type.fb_depth, 1152, 900, node);
    209  1.20.4.3  jdolecek #ifdef CG14_CG8
    210  1.20.4.3  jdolecek 	/*
    211  1.20.4.3  jdolecek 	 * fb_setsize_obp set fb->fb_linebytes based on the current
    212  1.20.4.3  jdolecek 	 * depth reported by obp, but that defaults to 8 bits (as
    213  1.20.4.3  jdolecek 	 * reported by getpropint().  Update the value to reflect
    214  1.20.4.3  jdolecek 	 * the depth that will be used after open.
    215  1.20.4.3  jdolecek 	 * The display memory size returned by the cg8 driver includes
    216  1.20.4.3  jdolecek 	 * the space used by the overlay planes, but the size returned
    217  1.20.4.3  jdolecek 	 * by the cg3 driver does not; emulate the other drivers.
    218  1.20.4.3  jdolecek 	 */
    219  1.20.4.3  jdolecek 	fb->fb_linebytes = (fb->fb_type.fb_width * fb->fb_type.fb_depth) / 8;
    220  1.20.4.3  jdolecek 	ramsize = roundup(START + (fb->fb_type.fb_height * fb->fb_linebytes),
    221  1.20.4.3  jdolecek 			NBPG);
    222  1.20.4.3  jdolecek #else
    223      1.11        pk 	ramsize = roundup(fb->fb_type.fb_height * fb->fb_linebytes, NBPG);
    224  1.20.4.3  jdolecek #endif
    225      1.11        pk 	fb->fb_type.fb_cmsize = CG14_CLUT_SIZE;
    226      1.11        pk 	fb->fb_type.fb_size = ramsize;
    227      1.11        pk 
    228      1.13        pk 	if (sa->sa_nreg < 2) {
    229      1.13        pk 		printf("%s: only %d register sets\n",
    230      1.13        pk 			self->dv_xname, sa->sa_nreg);
    231      1.11        pk 		return;
    232      1.11        pk 	}
    233      1.13        pk 	bcopy(sa->sa_reg, sc->sc_physadr,
    234  1.20.4.6  jdolecek 	      sa->sa_nreg * sizeof(struct openprom_addr));
    235       1.1    abrown 
    236       1.1    abrown 	/*
    237       1.1    abrown 	 * Now map in the 8 useful pages of registers
    238       1.1    abrown 	 */
    239      1.11        pk 	if (sa->sa_size < 0x10000) {
    240       1.1    abrown #ifdef DIAGNOSTIC
    241       1.5  christos 		printf("warning: can't find all cgfourteen registers...\n");
    242       1.1    abrown #endif
    243      1.11        pk 		sa->sa_size = 0x10000;
    244       1.1    abrown 	}
    245  1.20.4.2  jdolecek 	if (sbus_bus_map(sa->sa_bustag,
    246  1.20.4.2  jdolecek 			 sa->sa_slot, sa->sa_offset, sa->sa_size,
    247  1.20.4.2  jdolecek 			 BUS_SPACE_MAP_LINEAR, &bh) != 0) {
    248      1.11        pk 		printf("%s: cannot map control registers\n", self->dv_xname);
    249      1.11        pk 		return;
    250      1.11        pk 	}
    251      1.11        pk 
    252      1.11        pk 	sc->sc_ctl   = (struct cg14ctl  *) (bh);
    253      1.11        pk 	sc->sc_hwc   = (struct cg14curs *) (bh + CG14_OFFSET_CURS);
    254      1.11        pk 	sc->sc_dac   = (struct cg14dac  *) (bh + CG14_OFFSET_DAC);
    255      1.11        pk 	sc->sc_xlut  = (struct cg14xlut *) (bh + CG14_OFFSET_XLUT);
    256      1.11        pk 	sc->sc_clut1 = (struct cg14clut *) (bh + CG14_OFFSET_CLUT1);
    257      1.11        pk 	sc->sc_clut2 = (struct cg14clut *) (bh + CG14_OFFSET_CLUT2);
    258      1.11        pk 	sc->sc_clut3 = (struct cg14clut *) (bh + CG14_OFFSET_CLUT3);
    259      1.11        pk 	sc->sc_clutincr =        (u_int *) (bh + CG14_OFFSET_CLUTINCR);
    260       1.1    abrown 
    261       1.1    abrown 	/*
    262       1.1    abrown 	 * Let the user know that we're here
    263       1.1    abrown 	 */
    264       1.1    abrown #ifdef CG14_CG8
    265       1.5  christos 	printf(": cgeight emulated at %dx%dx24bpp",
    266      1.11        pk 		fb->fb_type.fb_width, fb->fb_type.fb_height);
    267       1.1    abrown #else
    268       1.5  christos 	printf(": cgthree emulated at %dx%dx8bpp",
    269      1.11        pk 		fb->fb_type.fb_width, fb->fb_type.fb_height);
    270       1.1    abrown #endif
    271       1.1    abrown 	/*
    272       1.1    abrown 	 * Enable the video, but don't change the pixel depth.
    273       1.1    abrown 	 */
    274       1.1    abrown 	cg14_set_video(sc, 1);
    275       1.1    abrown 
    276       1.1    abrown 	/*
    277       1.1    abrown 	 * Grab the initial colormap
    278       1.1    abrown 	 */
    279       1.1    abrown 	lut = (u_int32_t *) sc->sc_clut1->clut_lut;
    280       1.1    abrown 	for (i = 0; i < CG14_CLUT_SIZE; i++)
    281       1.1    abrown 		sc->sc_cmap.cm_chip[i] = lut[i];
    282       1.1    abrown 
    283       1.1    abrown 	/* See if we're the console */
    284      1.16        pk 	isconsole = fb_is_console(node);
    285       1.1    abrown 
    286       1.1    abrown 	if (isconsole) {
    287       1.5  christos 		printf(" (console)\n");
    288       1.1    abrown #ifdef notdef
    289      1.11        pk 		/*
    290      1.11        pk 		 * We don't use the raster console since the cg14 is
    291      1.11        pk 		 * fast enough already.
    292      1.11        pk 		 */
    293       1.1    abrown #ifdef RASTERCONSOLE
    294      1.11        pk 		fbrcons_init(fb);
    295       1.1    abrown #endif
    296       1.1    abrown #endif /* notdef */
    297       1.1    abrown 	} else
    298       1.5  christos 		printf("\n");
    299       1.1    abrown 
    300       1.1    abrown 	/* Attach to /dev/fb */
    301      1.16        pk 	fb_attach(&sc->sc_fb, isconsole);
    302       1.1    abrown }
    303       1.1    abrown 
    304       1.1    abrown /*
    305      1.12        pk  * Keep track of the number of opens made. In the 24-bit driver, we need to
    306       1.1    abrown  * switch to 24-bit mode on the first open, and switch back to 8-bit on
    307       1.1    abrown  * the last close. This kind of nonsense is needed to give screenblank
    308       1.1    abrown  * a fighting chance of working.
    309       1.1    abrown  */
    310       1.1    abrown static int cg14_opens = 0;
    311       1.1    abrown 
    312       1.1    abrown int
    313       1.1    abrown cgfourteenopen(dev, flags, mode, p)
    314       1.1    abrown 	dev_t dev;
    315       1.1    abrown 	int flags, mode;
    316       1.1    abrown 	struct proc *p;
    317       1.1    abrown {
    318      1.11        pk 	struct cgfourteen_softc *sc = cgfourteen_cd.cd_devs[minor(dev)];
    319       1.1    abrown 	int unit = minor(dev);
    320       1.1    abrown 	int s, oldopens;
    321       1.1    abrown 
    322      1.12        pk 	if (unit >= cgfourteen_cd.cd_ndevs ||
    323       1.1    abrown 	    cgfourteen_cd.cd_devs[unit] == NULL)
    324       1.1    abrown 		return (ENXIO);
    325       1.1    abrown 
    326       1.1    abrown 	s = splhigh();
    327       1.1    abrown 	oldopens = cg14_opens++;
    328       1.1    abrown 	splx(s);
    329       1.1    abrown 
    330       1.1    abrown 	/* Setup the cg14 as we want it, and save the original PROM state */
    331       1.1    abrown 	if (oldopens == 0)	/* first open only, to make screenblank work */
    332       1.1    abrown 		cg14_init(sc);
    333       1.1    abrown 
    334       1.1    abrown 	return (0);
    335       1.1    abrown }
    336       1.1    abrown 
    337       1.1    abrown int
    338       1.1    abrown cgfourteenclose(dev, flags, mode, p)
    339       1.1    abrown 	dev_t dev;
    340       1.1    abrown 	int flags, mode;
    341       1.1    abrown 	struct proc *p;
    342       1.1    abrown {
    343      1.11        pk 	struct cgfourteen_softc *sc = cgfourteen_cd.cd_devs[minor(dev)];
    344       1.1    abrown 	int s, opens;
    345       1.1    abrown 
    346       1.1    abrown 	s = splhigh();
    347       1.1    abrown 	opens = --cg14_opens;
    348       1.1    abrown 	if (cg14_opens < 0)
    349       1.1    abrown 		opens = cg14_opens = 0;
    350       1.1    abrown 	splx(s);
    351       1.1    abrown 
    352       1.1    abrown 	/*
    353       1.1    abrown 	 * Restore video state to make the PROM happy, on last close.
    354       1.1    abrown 	 */
    355       1.1    abrown 	if (opens == 0)
    356       1.1    abrown 		cg14_reset(sc);
    357       1.1    abrown 
    358       1.1    abrown 	return (0);
    359       1.1    abrown }
    360       1.1    abrown 
    361       1.1    abrown int
    362       1.1    abrown cgfourteenioctl(dev, cmd, data, flags, p)
    363       1.1    abrown 	dev_t dev;
    364       1.1    abrown 	u_long cmd;
    365      1.11        pk 	caddr_t data;
    366       1.1    abrown 	int flags;
    367       1.1    abrown 	struct proc *p;
    368       1.1    abrown {
    369      1.11        pk 	struct cgfourteen_softc *sc = cgfourteen_cd.cd_devs[minor(dev)];
    370      1.11        pk 	struct fbgattr *fba;
    371       1.1    abrown 	union cg14cursor_cmap tcm;
    372       1.1    abrown 	int v, error;
    373       1.1    abrown 	u_int count;
    374       1.1    abrown 
    375       1.1    abrown 	switch (cmd) {
    376       1.1    abrown 
    377       1.1    abrown 	case FBIOGTYPE:
    378       1.1    abrown 		*(struct fbtype *)data = sc->sc_fb.fb_type;
    379       1.1    abrown 		break;
    380       1.1    abrown 
    381       1.1    abrown 	case FBIOGATTR:
    382       1.1    abrown 		fba = (struct fbgattr *)data;
    383       1.1    abrown 		fba->real_type = FBTYPE_MDICOLOR;
    384       1.1    abrown 		fba->owner = 0;		/* XXX ??? */
    385       1.1    abrown 		fba->fbtype = sc->sc_fb.fb_type;
    386       1.1    abrown 		fba->sattr.flags = 0;
    387       1.1    abrown 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
    388       1.1    abrown 		fba->sattr.dev_specific[0] = -1;
    389       1.1    abrown 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
    390       1.1    abrown 		fba->emu_types[1] = -1;
    391       1.1    abrown 		break;
    392       1.1    abrown 
    393       1.1    abrown 	case FBIOGETCMAP:
    394      1.12        pk 		return (cg14_get_cmap((struct fbcmap *)data, &sc->sc_cmap,
    395       1.1    abrown 				     CG14_CLUT_SIZE));
    396       1.1    abrown 
    397       1.1    abrown 	case FBIOPUTCMAP:
    398       1.1    abrown 		/* copy to software map */
    399       1.1    abrown #define p ((struct fbcmap *)data)
    400       1.1    abrown #ifdef CG14_CG8
    401       1.1    abrown 		p->index &= 0xffffff;
    402       1.1    abrown #endif
    403       1.1    abrown 		error = cg14_put_cmap(p, &sc->sc_cmap, CG14_CLUT_SIZE);
    404       1.1    abrown 		if (error)
    405       1.1    abrown 			return (error);
    406       1.1    abrown 		/* now blast them into the chip */
    407       1.1    abrown 		/* XXX should use retrace interrupt */
    408       1.1    abrown 		cg14_load_hwcmap(sc, p->index, p->count);
    409       1.1    abrown #undef p
    410       1.1    abrown 		break;
    411       1.1    abrown 
    412       1.1    abrown 	case FBIOGVIDEO:
    413       1.1    abrown 		*(int *)data = cg14_get_video(sc);
    414       1.1    abrown 		break;
    415       1.1    abrown 
    416       1.1    abrown 	case FBIOSVIDEO:
    417       1.1    abrown 		cg14_set_video(sc, *(int *)data);
    418       1.1    abrown 		break;
    419       1.1    abrown 
    420       1.1    abrown /* these are for both FBIOSCURSOR and FBIOGCURSOR */
    421       1.1    abrown #define p ((struct fbcursor *)data)
    422       1.1    abrown #define cc (&sc->sc_cursor)
    423       1.1    abrown 	case FBIOGCURSOR:
    424       1.1    abrown 		/* do not quite want everything here... */
    425       1.1    abrown 		p->set = FB_CUR_SETALL;	/* close enough, anyway */
    426       1.1    abrown 		p->enable = cc->cc_enable;
    427       1.1    abrown 		p->pos = cc->cc_pos;
    428       1.1    abrown 		p->hot = cc->cc_hot;
    429       1.1    abrown 		p->size = cc->cc_size;
    430       1.1    abrown 
    431       1.1    abrown 		/* begin ugh ... can we lose some of this crap?? */
    432       1.1    abrown 		if (p->image != NULL) {
    433       1.1    abrown 			count = cc->cc_size.y * 32 / NBBY;
    434       1.1    abrown 			error = copyout((caddr_t)cc->cc_cplane,
    435       1.1    abrown 			    (caddr_t)p->image, count);
    436       1.1    abrown 			if (error)
    437       1.1    abrown 				return (error);
    438       1.1    abrown 			error = copyout((caddr_t)cc->cc_eplane,
    439       1.1    abrown 			    (caddr_t)p->mask, count);
    440       1.1    abrown 			if (error)
    441       1.1    abrown 				return (error);
    442       1.1    abrown 		}
    443       1.1    abrown 		if (p->cmap.red != NULL) {
    444       1.1    abrown 			error = cg14_get_cmap(&p->cmap,
    445       1.1    abrown 			    (union cg14cmap *)&cc->cc_color, 2);
    446       1.1    abrown 			if (error)
    447       1.1    abrown 				return (error);
    448       1.1    abrown 		} else {
    449       1.1    abrown 			p->cmap.index = 0;
    450       1.1    abrown 			p->cmap.count = 2;
    451       1.1    abrown 		}
    452       1.1    abrown 		/* end ugh */
    453       1.1    abrown 		break;
    454       1.1    abrown 
    455       1.1    abrown 	case FBIOSCURSOR:
    456       1.1    abrown 		/*
    457       1.1    abrown 		 * For setcmap and setshape, verify parameters, so that
    458       1.1    abrown 		 * we do not get halfway through an update and then crap
    459       1.1    abrown 		 * out with the software state screwed up.
    460       1.1    abrown 		 */
    461       1.1    abrown 		v = p->set;
    462       1.1    abrown 		if (v & FB_CUR_SETCMAP) {
    463       1.1    abrown 			/*
    464       1.1    abrown 			 * This use of a temporary copy of the cursor
    465       1.1    abrown 			 * colormap is not terribly efficient, but these
    466       1.1    abrown 			 * copies are small (8 bytes)...
    467       1.1    abrown 			 */
    468       1.1    abrown 			tcm = cc->cc_color;
    469       1.1    abrown 			error = cg14_put_cmap(&p->cmap, (union cg14cmap *)&tcm,
    470       1.1    abrown 					      2);
    471       1.1    abrown 			if (error)
    472       1.1    abrown 				return (error);
    473       1.1    abrown 		}
    474       1.1    abrown 		if (v & FB_CUR_SETSHAPE) {
    475       1.1    abrown 			if ((u_int)p->size.x > 32 || (u_int)p->size.y > 32)
    476       1.1    abrown 				return (EINVAL);
    477       1.1    abrown 			count = p->size.y * 32 / NBBY;
    478       1.9       mrg 			if (!uvm_useracc(p->image, count, B_READ) ||
    479       1.9       mrg 			    !uvm_useracc(p->mask, count, B_READ))
    480       1.9       mrg 				return (EFAULT);
    481       1.1    abrown 		}
    482       1.1    abrown 
    483       1.1    abrown 		/* parameters are OK; do it */
    484       1.1    abrown 		if (v & (FB_CUR_SETCUR | FB_CUR_SETPOS | FB_CUR_SETHOT)) {
    485       1.1    abrown 			if (v & FB_CUR_SETCUR)
    486       1.1    abrown 				cc->cc_enable = p->enable;
    487       1.1    abrown 			if (v & FB_CUR_SETPOS)
    488       1.1    abrown 				cc->cc_pos = p->pos;
    489       1.1    abrown 			if (v & FB_CUR_SETHOT)
    490       1.1    abrown 				cc->cc_hot = p->hot;
    491       1.1    abrown 			cg14_setcursor(sc);
    492       1.1    abrown 		}
    493       1.1    abrown 		if (v & FB_CUR_SETCMAP) {
    494       1.1    abrown 			cc->cc_color = tcm;
    495       1.1    abrown 			cg14_loadomap(sc); /* XXX defer to vertical retrace */
    496       1.1    abrown 		}
    497       1.1    abrown 		if (v & FB_CUR_SETSHAPE) {
    498       1.1    abrown 			cc->cc_size = p->size;
    499       1.1    abrown 			count = p->size.y * 32 / NBBY;
    500       1.1    abrown 			bzero((caddr_t)cc->cc_eplane, sizeof cc->cc_eplane);
    501       1.1    abrown 			bzero((caddr_t)cc->cc_cplane, sizeof cc->cc_cplane);
    502       1.1    abrown 			bcopy(p->mask, (caddr_t)cc->cc_eplane, count);
    503       1.1    abrown 			bcopy(p->image, (caddr_t)cc->cc_cplane, count);
    504       1.1    abrown 			cg14_loadcursor(sc);
    505       1.1    abrown 		}
    506       1.1    abrown 		break;
    507       1.1    abrown 
    508       1.1    abrown #undef cc
    509       1.1    abrown #undef p
    510       1.1    abrown 	case FBIOGCURPOS:
    511       1.1    abrown 		*(struct fbcurpos *)data = sc->sc_cursor.cc_pos;
    512       1.1    abrown 		break;
    513       1.1    abrown 
    514       1.1    abrown 	case FBIOSCURPOS:
    515       1.1    abrown 		sc->sc_cursor.cc_pos = *(struct fbcurpos *)data;
    516       1.1    abrown 		cg14_setcursor(sc);
    517       1.1    abrown 		break;
    518       1.1    abrown 
    519       1.1    abrown 	case FBIOGCURMAX:
    520       1.1    abrown 		/* max cursor size is 32x32 */
    521       1.1    abrown 		((struct fbcurpos *)data)->x = 32;
    522       1.1    abrown 		((struct fbcurpos *)data)->y = 32;
    523       1.1    abrown 		break;
    524       1.1    abrown 
    525       1.1    abrown 	default:
    526       1.1    abrown 		return (ENOTTY);
    527       1.1    abrown 	}
    528       1.1    abrown 	return (0);
    529       1.1    abrown }
    530       1.1    abrown 
    531       1.1    abrown /*
    532       1.1    abrown  * Undo the effect of an FBIOSVIDEO that turns the video off.
    533       1.1    abrown  */
    534       1.1    abrown static void
    535       1.1    abrown cgfourteenunblank(dev)
    536       1.1    abrown 	struct device *dev;
    537       1.1    abrown {
    538       1.1    abrown 
    539       1.1    abrown 	cg14_set_video((struct cgfourteen_softc *)dev, 1);
    540       1.1    abrown }
    541       1.1    abrown 
    542       1.1    abrown /*
    543       1.1    abrown  * Return the address that would map the given device at the given
    544       1.1    abrown  * offset, allowing for the given protection, or return -1 for error.
    545       1.1    abrown  *
    546       1.1    abrown  * The cg14 frame buffer can be mapped in either 8-bit or 32-bit mode
    547       1.1    abrown  * starting at the address stored in the PROM. In 8-bit mode, the X
    548       1.1    abrown  * channel is not present, and can be ignored. In 32-bit mode, mapping
    549       1.1    abrown  * at 0K delivers a 32-bpp buffer where the upper 8 bits select the X
    550       1.1    abrown  * channel information. We hardwire the Xlut to all zeroes to insure
    551       1.1    abrown  * that, regardless of this value, direct 24-bit color access will be
    552       1.1    abrown  * used.
    553      1.12        pk  *
    554      1.12        pk  * Alternatively, mapping the frame buffer at an offset of 16M seems to
    555       1.1    abrown  * tell the chip to ignore the X channel. XXX where does it get the X value
    556       1.1    abrown  * to use?
    557       1.1    abrown  */
    558      1.17    simonb paddr_t
    559       1.1    abrown cgfourteenmmap(dev, off, prot)
    560       1.1    abrown 	dev_t dev;
    561      1.17    simonb 	off_t off;
    562      1.17    simonb 	int prot;
    563       1.1    abrown {
    564      1.11        pk 	struct cgfourteen_softc *sc = cgfourteen_cd.cd_devs[minor(dev)];
    565      1.12        pk 
    566       1.1    abrown 	if (off & PGOFSET)
    567       1.1    abrown 		panic("cgfourteenmmap");
    568      1.14       mrg 
    569      1.14       mrg 	if (off < 0)
    570      1.14       mrg 		return (-1);
    571       1.1    abrown 
    572       1.1    abrown #if defined(DEBUG) && defined(CG14_MAP_REGS) /* XXX: security hole */
    573       1.1    abrown 	/*
    574      1.12        pk 	 * Map the control registers into user space. Should only be
    575       1.1    abrown 	 * used for debugging!
    576       1.1    abrown 	 */
    577       1.1    abrown 	if ((u_int)off >= 0x10000000 && (u_int)off < 0x10000000 + 16*4096) {
    578       1.1    abrown 		off -= 0x10000000;
    579      1.12        pk 		if (bus_space_mmap(sc->sc_bustag,
    580  1.20.4.1   thorpej 			BUS_ADDR(sc->sc_physadr[CG14_CTL_IDX].sbr_slot,
    581  1.20.4.1   thorpej 				sc->sc_physadr[CG14_CTL_IDX].sbr_offset),
    582  1.20.4.1   thorpej 			off, prot, BUS_SPACE_MAP_LINEAR));
    583       1.1    abrown 	}
    584       1.1    abrown #endif
    585       1.1    abrown 
    586       1.1    abrown 	if ((u_int)off >= NOOVERLAY)
    587       1.1    abrown 		off -= NOOVERLAY;
    588  1.20.4.3  jdolecek 	else if ((u_int)off >= START)
    589  1.20.4.3  jdolecek 		off -= START;
    590       1.1    abrown 	else
    591       1.1    abrown 		off = 0;
    592       1.1    abrown 
    593  1.20.4.3  jdolecek 	/*
    594  1.20.4.3  jdolecek 	 * fb_size includes the overlay space only for the CG8.
    595  1.20.4.3  jdolecek 	 */
    596  1.20.4.3  jdolecek #ifdef CG14_CG8
    597  1.20.4.3  jdolecek 	if (off >= sc->sc_fb.fb_type.fb_size - START)
    598  1.20.4.3  jdolecek #else
    599  1.20.4.3  jdolecek 	if (off >= sc->sc_fb.fb_type.fb_size)
    600  1.20.4.3  jdolecek #endif
    601  1.20.4.3  jdolecek 	{
    602       1.1    abrown #ifdef DEBUG
    603       1.5  christos 		printf("\nmmap request out of bounds: request 0x%x, "
    604      1.12        pk 		    "bound 0x%x\n", (unsigned) off,
    605       1.4  christos 		    (unsigned)sc->sc_fb.fb_type.fb_size);
    606       1.1    abrown #endif
    607       1.1    abrown 		return (-1);
    608       1.1    abrown 	}
    609       1.1    abrown 
    610  1.20.4.1   thorpej 	return (bus_space_mmap(sc->sc_bustag,
    611  1.20.4.6  jdolecek 		BUS_ADDR(sc->sc_physadr[CG14_PXL_IDX].oa_space,
    612  1.20.4.6  jdolecek 			sc->sc_physadr[CG14_PXL_IDX].oa_base),
    613  1.20.4.1   thorpej 		off, prot, BUS_SPACE_MAP_LINEAR));
    614       1.1    abrown }
    615       1.2    abrown 
    616       1.2    abrown int
    617       1.2    abrown cgfourteenpoll(dev, events, p)
    618       1.2    abrown 	dev_t dev;
    619       1.2    abrown 	int events;
    620       1.2    abrown 	struct proc *p;
    621       1.2    abrown {
    622       1.3   thorpej 
    623       1.3   thorpej 	return (seltrue(dev, events, p));
    624  1.20.4.4  jdolecek }
    625  1.20.4.4  jdolecek 
    626  1.20.4.4  jdolecek static void
    627  1.20.4.4  jdolecek filt_cgfourteendetach(struct knote *kn)
    628  1.20.4.4  jdolecek {
    629  1.20.4.4  jdolecek 	/* Nothing to do */
    630  1.20.4.4  jdolecek }
    631  1.20.4.4  jdolecek 
    632  1.20.4.4  jdolecek static const struct filterops cgfourteen_filtops =
    633  1.20.4.4  jdolecek 	{ 1, NULL, filt_cgfourteendetach, filt_seltrue };
    634  1.20.4.4  jdolecek 
    635  1.20.4.4  jdolecek int
    636  1.20.4.4  jdolecek cgfourteenkqfilter(dev_t dev, struct knote *kn)
    637  1.20.4.4  jdolecek {
    638  1.20.4.4  jdolecek 	switch (kn->kn_filter) {
    639  1.20.4.4  jdolecek 	case EVFILT_READ:
    640  1.20.4.4  jdolecek 	case EVFILT_WRITE:
    641  1.20.4.4  jdolecek 		kn->kn_fop = &cgfourteen_filtops;
    642  1.20.4.4  jdolecek 		break;
    643  1.20.4.4  jdolecek 	default:
    644  1.20.4.4  jdolecek 		return (1);
    645  1.20.4.4  jdolecek 	}
    646  1.20.4.4  jdolecek 
    647  1.20.4.4  jdolecek 	/* Nothing more to do */
    648  1.20.4.4  jdolecek 	return (0);
    649      1.12        pk }
    650       1.1    abrown 
    651       1.1    abrown /*
    652      1.12        pk  * Miscellaneous helper functions
    653       1.1    abrown  */
    654       1.1    abrown 
    655       1.1    abrown /* Initialize the framebuffer, storing away useful state for later reset */
    656      1.12        pk static void
    657       1.1    abrown cg14_init(sc)
    658       1.1    abrown 	struct cgfourteen_softc *sc;
    659       1.1    abrown {
    660      1.11        pk 	u_int32_t *clut;
    661      1.11        pk 	u_int8_t  *xlut;
    662      1.11        pk 	int i;
    663       1.1    abrown 
    664       1.1    abrown 	/*
    665       1.1    abrown 	 * We stash away the following to restore on close:
    666       1.1    abrown 	 *
    667       1.1    abrown 	 * 	color look-up table 1 	(sc->sc_saveclut)
    668       1.1    abrown 	 *	x look-up table		(sc->sc_savexlut)
    669       1.1    abrown 	 *	control register	(sc->sc_savectl)
    670       1.1    abrown 	 *	cursor control register (sc->sc_savehwc)
    671       1.1    abrown 	 */
    672       1.1    abrown 	sc->sc_savectl = sc->sc_ctl->ctl_mctl;
    673       1.1    abrown 	sc->sc_savehwc = sc->sc_hwc->curs_ctl;
    674       1.1    abrown 
    675       1.1    abrown 	clut = (u_int32_t *) sc->sc_clut1->clut_lut;
    676       1.1    abrown 	xlut = (u_int8_t *) sc->sc_xlut->xlut_lut;
    677       1.1    abrown 	for (i = 0; i < CG14_CLUT_SIZE; i++) {
    678       1.1    abrown 		sc->sc_saveclut.cm_chip[i] = clut[i];
    679       1.1    abrown 		sc->sc_savexlut[i] = xlut[i];
    680       1.1    abrown 	}
    681       1.1    abrown 
    682       1.1    abrown #ifdef CG14_CG8
    683       1.1    abrown 	/*
    684       1.1    abrown 	 * Enable the video, and put in 24 bit mode.
    685       1.1    abrown 	 */
    686       1.1    abrown 	sc->sc_ctl->ctl_mctl = CG14_MCTL_ENABLEVID | CG14_MCTL_PIXMODE_32 |
    687       1.1    abrown 		CG14_MCTL_POWERCTL;
    688       1.1    abrown 
    689      1.12        pk 	/*
    690       1.1    abrown 	 * Zero the xlut to enable direct-color mode
    691       1.1    abrown 	 */
    692       1.1    abrown 	bzero(sc->sc_xlut, CG14_CLUT_SIZE);
    693       1.1    abrown #else
    694       1.1    abrown 	/*
    695       1.1    abrown 	 * Enable the video and put it in 8 bit mode
    696       1.1    abrown 	 */
    697       1.1    abrown 	sc->sc_ctl->ctl_mctl = CG14_MCTL_ENABLEVID | CG14_MCTL_PIXMODE_8 |
    698       1.1    abrown 		CG14_MCTL_POWERCTL;
    699       1.1    abrown #endif
    700       1.1    abrown }
    701       1.1    abrown 
    702       1.1    abrown static void
    703       1.1    abrown cg14_reset(sc)	/* Restore the state saved on cg14_init */
    704       1.1    abrown 	struct cgfourteen_softc *sc;
    705       1.1    abrown {
    706      1.11        pk 	u_int32_t *clut;
    707      1.11        pk 	u_int8_t  *xlut;
    708      1.11        pk 	int i;
    709       1.1    abrown 
    710       1.1    abrown 	/*
    711       1.1    abrown 	 * We restore the following, saved in cg14_init:
    712       1.1    abrown 	 *
    713       1.1    abrown 	 * 	color look-up table 1 	(sc->sc_saveclut)
    714       1.1    abrown 	 *	x look-up table		(sc->sc_savexlut)
    715       1.1    abrown 	 *	control register	(sc->sc_savectl)
    716       1.1    abrown 	 *	cursor control register (sc->sc_savehwc)
    717       1.1    abrown 	 *
    718       1.1    abrown 	 * Note that we don't touch the video enable bits in the
    719       1.1    abrown 	 * control register; otherwise, screenblank wouldn't work.
    720       1.1    abrown 	 */
    721       1.1    abrown 	sc->sc_ctl->ctl_mctl = (sc->sc_ctl->ctl_mctl & (CG14_MCTL_ENABLEVID |
    722       1.1    abrown 							CG14_MCTL_POWERCTL)) |
    723       1.1    abrown 				(sc->sc_savectl & ~(CG14_MCTL_ENABLEVID |
    724       1.1    abrown 						    CG14_MCTL_POWERCTL));
    725       1.1    abrown 	sc->sc_hwc->curs_ctl = sc->sc_savehwc;
    726       1.1    abrown 
    727       1.1    abrown 	clut = (u_int32_t *) sc->sc_clut1->clut_lut;
    728       1.1    abrown 	xlut = (u_int8_t *) sc->sc_xlut->xlut_lut;
    729       1.1    abrown 	for (i = 0; i < CG14_CLUT_SIZE; i++) {
    730       1.1    abrown 		clut[i] = sc->sc_saveclut.cm_chip[i];
    731       1.1    abrown 		xlut[i] = sc->sc_savexlut[i];
    732       1.1    abrown 	}
    733       1.1    abrown }
    734       1.1    abrown 
    735       1.1    abrown /* Enable/disable video display; power down monitor if DPMS-capable */
    736       1.1    abrown static void
    737       1.1    abrown cg14_set_video(sc, enable)
    738       1.1    abrown 	struct cgfourteen_softc *sc;
    739       1.1    abrown 	int enable;
    740       1.1    abrown {
    741      1.12        pk 	/*
    742       1.1    abrown 	 * We can only use DPMS to power down the display if the chip revision
    743       1.1    abrown 	 * is greater than 0.
    744       1.1    abrown 	 */
    745       1.1    abrown 	if (enable) {
    746       1.1    abrown 		if ((sc->sc_ctl->ctl_rsr & CG14_RSR_REVMASK) > 0)
    747       1.1    abrown 			sc->sc_ctl->ctl_mctl |= (CG14_MCTL_ENABLEVID |
    748       1.1    abrown 						 CG14_MCTL_POWERCTL);
    749       1.1    abrown 		else
    750       1.1    abrown 			sc->sc_ctl->ctl_mctl |= CG14_MCTL_ENABLEVID;
    751       1.1    abrown 	} else {
    752       1.1    abrown 		if ((sc->sc_ctl->ctl_rsr & CG14_RSR_REVMASK) > 0)
    753       1.1    abrown 			sc->sc_ctl->ctl_mctl &= ~(CG14_MCTL_ENABLEVID |
    754       1.1    abrown 						  CG14_MCTL_POWERCTL);
    755       1.1    abrown 		else
    756       1.1    abrown 			sc->sc_ctl->ctl_mctl &= ~CG14_MCTL_ENABLEVID;
    757       1.1    abrown 	}
    758       1.1    abrown }
    759       1.1    abrown 
    760       1.1    abrown /* Get status of video display */
    761       1.1    abrown static int
    762       1.1    abrown cg14_get_video(sc)
    763       1.1    abrown 	struct cgfourteen_softc *sc;
    764       1.1    abrown {
    765       1.1    abrown 	return ((sc->sc_ctl->ctl_mctl & CG14_MCTL_ENABLEVID) != 0);
    766       1.1    abrown }
    767       1.1    abrown 
    768       1.1    abrown /* Read the software shadow colormap */
    769      1.12        pk static int
    770       1.1    abrown cg14_get_cmap(p, cm, cmsize)
    771      1.11        pk 	struct fbcmap *p;
    772       1.1    abrown 	union cg14cmap *cm;
    773       1.1    abrown 	int cmsize;
    774       1.1    abrown {
    775  1.20.4.6  jdolecek 	u_int i, start, count;
    776  1.20.4.6  jdolecek 	u_char *cp;
    777      1.12        pk 
    778  1.20.4.6  jdolecek 	start = p->index;
    779  1.20.4.6  jdolecek 	count = p->count;
    780  1.20.4.6  jdolecek 	if (start >= cmsize || count > cmsize - start)
    781       1.1    abrown #ifdef DEBUG
    782       1.1    abrown 	{
    783       1.5  christos 		printf("putcmaperror: start %d cmsize %d count %d\n",
    784       1.4  christos 		    start,cmsize,count);
    785       1.1    abrown #endif
    786  1.20.4.6  jdolecek 		return (EINVAL);
    787       1.1    abrown #ifdef DEBUG
    788       1.1    abrown 	}
    789       1.1    abrown #endif
    790       1.1    abrown 
    791  1.20.4.6  jdolecek 	if (!uvm_useracc(p->red, count, B_WRITE) ||
    792  1.20.4.6  jdolecek 	    !uvm_useracc(p->green, count, B_WRITE) ||
    793  1.20.4.6  jdolecek 	    !uvm_useracc(p->blue, count, B_WRITE))
    794  1.20.4.6  jdolecek 		return (EFAULT);
    795  1.20.4.6  jdolecek 	for (cp = &cm->cm_map[start][0], i = 0; i < count; cp += 4, i++) {
    796  1.20.4.6  jdolecek 		p->red[i] = cp[3];
    797  1.20.4.6  jdolecek 		p->green[i] = cp[2];
    798  1.20.4.6  jdolecek 		p->blue[i] = cp[1];
    799  1.20.4.6  jdolecek 	}
    800  1.20.4.6  jdolecek 	return (0);
    801       1.1    abrown }
    802       1.1    abrown 
    803       1.1    abrown /* Write the software shadow colormap */
    804       1.1    abrown static int
    805       1.1    abrown cg14_put_cmap(p, cm, cmsize)
    806  1.20.4.6  jdolecek 	struct fbcmap *p;
    807  1.20.4.6  jdolecek 	union cg14cmap *cm;
    808  1.20.4.6  jdolecek 	int cmsize;
    809  1.20.4.6  jdolecek {
    810  1.20.4.6  jdolecek 	u_int i, start, count;
    811  1.20.4.6  jdolecek 	u_char *cp;
    812  1.20.4.6  jdolecek 
    813  1.20.4.6  jdolecek 	start = p->index;
    814  1.20.4.6  jdolecek 	count = p->count;
    815  1.20.4.6  jdolecek 	if (start >= cmsize || count > cmsize - start)
    816       1.1    abrown #ifdef DEBUG
    817       1.1    abrown 	{
    818       1.5  christos 		printf("putcmaperror: start %d cmsize %d count %d\n",
    819       1.4  christos 		    start,cmsize,count);
    820       1.1    abrown #endif
    821  1.20.4.6  jdolecek 		return (EINVAL);
    822       1.1    abrown #ifdef DEBUG
    823       1.1    abrown 	}
    824       1.1    abrown #endif
    825       1.1    abrown 
    826  1.20.4.6  jdolecek 	if (!uvm_useracc(p->red, count, B_READ) ||
    827  1.20.4.6  jdolecek 	    !uvm_useracc(p->green, count, B_READ) ||
    828  1.20.4.6  jdolecek 	    !uvm_useracc(p->blue, count, B_READ))
    829  1.20.4.6  jdolecek 		return (EFAULT);
    830  1.20.4.6  jdolecek 	for (cp = &cm->cm_map[start][0], i = 0; i < count; cp += 4, i++) {
    831  1.20.4.6  jdolecek 		cp[3] = p->red[i];
    832  1.20.4.6  jdolecek 		cp[2] = p->green[i];
    833  1.20.4.6  jdolecek 		cp[1] = p->blue[i];
    834       1.1    abrown 		cp[0] = 0;	/* no alpha channel */
    835  1.20.4.6  jdolecek 	}
    836  1.20.4.6  jdolecek 	return (0);
    837       1.1    abrown }
    838       1.1    abrown 
    839       1.1    abrown static void
    840       1.1    abrown cg14_load_hwcmap(sc, start, ncolors)
    841      1.11        pk 	struct cgfourteen_softc *sc;
    842      1.11        pk 	int start, ncolors;
    843       1.1    abrown {
    844       1.1    abrown 	/* XXX switch to auto-increment, and on retrace intr */
    845       1.1    abrown 
    846       1.1    abrown 	/* Setup pointers to source and dest */
    847      1.11        pk 	u_int32_t *colp = &sc->sc_cmap.cm_chip[start];
    848      1.11        pk 	volatile u_int32_t *lutp = &sc->sc_clut1->clut_lut[start];
    849       1.1    abrown 
    850       1.1    abrown 	/* Copy by words */
    851       1.1    abrown 	while (--ncolors >= 0)
    852       1.1    abrown 		*lutp++ = *colp++;
    853       1.1    abrown }
    854       1.1    abrown 
    855       1.1    abrown /*
    856       1.1    abrown  * Load the cursor (overlay `foreground' and `background') colors.
    857       1.1    abrown  */
    858       1.1    abrown static void
    859       1.1    abrown cg14_setcursor(sc)
    860      1.11        pk 	struct cgfourteen_softc *sc;
    861       1.1    abrown {
    862       1.1    abrown 	/* we need to subtract the hot-spot value here */
    863       1.1    abrown #define COORD(f) (sc->sc_cursor.cc_pos.f - sc->sc_cursor.cc_hot.f)
    864       1.1    abrown 
    865       1.1    abrown 	sc->sc_hwc->curs_ctl = (sc->sc_cursor.cc_enable ? CG14_CURS_ENABLE : 0);
    866       1.1    abrown 	sc->sc_hwc->curs_x = COORD(x);
    867       1.1    abrown 	sc->sc_hwc->curs_y = COORD(y);
    868       1.1    abrown 
    869       1.1    abrown #undef COORD
    870       1.1    abrown }
    871       1.1    abrown 
    872       1.1    abrown static void
    873       1.1    abrown cg14_loadcursor(sc)
    874      1.11        pk 	struct cgfourteen_softc *sc;
    875       1.1    abrown {
    876      1.11        pk 	volatile struct cg14curs *hwc;
    877      1.11        pk 	u_int edgemask, m;
    878      1.11        pk 	int i;
    879       1.1    abrown 
    880       1.1    abrown 	/*
    881       1.1    abrown 	 * Keep the top size.x bits.  Here we *throw out* the top
    882       1.1    abrown 	 * size.x bits from an all-one-bits word, introducing zeros in
    883       1.1    abrown 	 * the top size.x bits, then invert all the bits to get what
    884       1.1    abrown 	 * we really wanted as our mask.  But this fails if size.x is
    885       1.1    abrown 	 * 32---a sparc uses only the low 5 bits of the shift count---
    886       1.1    abrown 	 * so we have to special case that.
    887       1.1    abrown 	 */
    888       1.1    abrown 	edgemask = ~0;
    889       1.1    abrown 	if (sc->sc_cursor.cc_size.x < 32)
    890       1.1    abrown 		edgemask = ~(edgemask >> sc->sc_cursor.cc_size.x);
    891       1.1    abrown 	hwc = sc->sc_hwc;
    892       1.1    abrown 	for (i = 0; i < 32; i++) {
    893       1.1    abrown 		m = sc->sc_cursor.cc_eplane[i] & edgemask;
    894       1.1    abrown 		hwc->curs_plane0[i] = m;
    895       1.1    abrown 		hwc->curs_plane1[i] = m & sc->sc_cursor.cc_cplane[i];
    896       1.1    abrown 	}
    897       1.1    abrown }
    898       1.1    abrown 
    899       1.1    abrown static void
    900       1.1    abrown cg14_loadomap(sc)
    901      1.11        pk 	struct cgfourteen_softc *sc;
    902       1.1    abrown {
    903       1.1    abrown 	/* set background color */
    904       1.1    abrown 	sc->sc_hwc->curs_color1 = sc->sc_cursor.cc_color.cm_chip[0];
    905       1.1    abrown 	/* set foreground color */
    906       1.1    abrown 	sc->sc_hwc->curs_color2 = sc->sc_cursor.cc_color.cm_chip[1];
    907       1.1    abrown }
    908