Home | History | Annotate | Line # | Download | only in sun
cgsix.c revision 1.18
      1  1.18    martin /*	$NetBSD: cgsix.c,v 1.18 2005/02/25 16:03:09 martin Exp $ */
      2   1.1        pk 
      3   1.1        pk /*-
      4   1.1        pk  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5   1.1        pk  * All rights reserved.
      6   1.1        pk  *
      7   1.1        pk  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1        pk  * by Paul Kranenburg.
      9   1.1        pk  *
     10   1.1        pk  * Redistribution and use in source and binary forms, with or without
     11   1.1        pk  * modification, are permitted provided that the following conditions
     12   1.1        pk  * are met:
     13   1.1        pk  * 1. Redistributions of source code must retain the above copyright
     14   1.1        pk  *    notice, this list of conditions and the following disclaimer.
     15   1.1        pk  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1        pk  *    notice, this list of conditions and the following disclaimer in the
     17   1.1        pk  *    documentation and/or other materials provided with the distribution.
     18   1.1        pk  * 3. All advertising materials mentioning features or use of this software
     19   1.1        pk  *    must display the following acknowledgement:
     20   1.1        pk  *        This product includes software developed by the NetBSD
     21   1.1        pk  *        Foundation, Inc. and its contributors.
     22   1.1        pk  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.1        pk  *    contributors may be used to endorse or promote products derived
     24   1.1        pk  *    from this software without specific prior written permission.
     25   1.1        pk  *
     26   1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.1        pk  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.1        pk  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.1        pk  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.1        pk  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.1        pk  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.1        pk  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.1        pk  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.1        pk  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.1        pk  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.1        pk  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1        pk  */
     38   1.1        pk 
     39   1.1        pk /*
     40   1.1        pk  * Copyright (c) 1993
     41   1.1        pk  *	The Regents of the University of California.  All rights reserved.
     42   1.1        pk  *
     43   1.1        pk  * This software was developed by the Computer Systems Engineering group
     44   1.1        pk  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
     45   1.1        pk  * contributed to Berkeley.
     46   1.1        pk  *
     47   1.1        pk  * All advertising materials mentioning features or use of this software
     48   1.1        pk  * must display the following acknowledgement:
     49   1.1        pk  *	This product includes software developed by the University of
     50   1.1        pk  *	California, Lawrence Berkeley Laboratory.
     51   1.1        pk  *
     52   1.1        pk  * Redistribution and use in source and binary forms, with or without
     53   1.1        pk  * modification, are permitted provided that the following conditions
     54   1.1        pk  * are met:
     55   1.1        pk  * 1. Redistributions of source code must retain the above copyright
     56   1.1        pk  *    notice, this list of conditions and the following disclaimer.
     57   1.1        pk  * 2. Redistributions in binary form must reproduce the above copyright
     58   1.1        pk  *    notice, this list of conditions and the following disclaimer in the
     59   1.1        pk  *    documentation and/or other materials provided with the distribution.
     60  1.13       agc  * 3. Neither the name of the University nor the names of its contributors
     61   1.1        pk  *    may be used to endorse or promote products derived from this software
     62   1.1        pk  *    without specific prior written permission.
     63   1.1        pk  *
     64   1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     65   1.1        pk  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     66   1.1        pk  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     67   1.1        pk  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     68   1.1        pk  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     69   1.1        pk  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     70   1.1        pk  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     71   1.1        pk  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     72   1.1        pk  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     73   1.1        pk  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     74   1.1        pk  * SUCH DAMAGE.
     75   1.1        pk  *
     76   1.1        pk  *	@(#)cgsix.c	8.4 (Berkeley) 1/21/94
     77   1.1        pk  */
     78   1.1        pk 
     79   1.1        pk /*
     80   1.1        pk  * color display (cgsix) driver.
     81   1.1        pk  *
     82   1.1        pk  * Does not handle interrupts, even though they can occur.
     83   1.1        pk  *
     84   1.1        pk  * XXX should defer colormap updates to vertical retrace interrupts
     85   1.1        pk  */
     86   1.7     lukem 
     87   1.7     lukem #include <sys/cdefs.h>
     88  1.18    martin __KERNEL_RCSID(0, "$NetBSD: cgsix.c,v 1.18 2005/02/25 16:03:09 martin Exp $");
     89   1.1        pk 
     90   1.1        pk #include <sys/param.h>
     91   1.1        pk #include <sys/systm.h>
     92   1.1        pk #include <sys/buf.h>
     93   1.1        pk #include <sys/device.h>
     94   1.1        pk #include <sys/ioctl.h>
     95   1.1        pk #include <sys/malloc.h>
     96   1.1        pk #include <sys/mman.h>
     97   1.1        pk #include <sys/tty.h>
     98   1.1        pk #include <sys/conf.h>
     99   1.1        pk 
    100   1.1        pk #ifdef DEBUG
    101   1.1        pk #include <sys/proc.h>
    102   1.1        pk #include <sys/syslog.h>
    103   1.1        pk #endif
    104   1.1        pk 
    105   1.1        pk #include <uvm/uvm_extern.h>
    106   1.1        pk 
    107   1.1        pk #include <machine/bus.h>
    108   1.1        pk 
    109   1.1        pk #include <dev/sun/fbio.h>
    110   1.1        pk #include <dev/sun/fbvar.h>
    111   1.1        pk 
    112   1.1        pk #include <dev/sun/btreg.h>
    113   1.1        pk #include <dev/sun/btvar.h>
    114   1.1        pk #include <dev/sun/cgsixreg.h>
    115   1.1        pk #include <dev/sun/cgsixvar.h>
    116   1.1        pk #include <dev/sun/pfourreg.h>
    117   1.1        pk 
    118  1.18    martin #include <dev/wscons/wsconsio.h>
    119  1.18    martin #include <dev/wsfont/wsfont.h>
    120   1.1        pk #include <dev/rasops/rasops.h>
    121  1.18    martin 
    122  1.18    martin #include "opt_wsemul.h"
    123   1.1        pk 
    124   1.1        pk static void	cg6_unblank(struct device *);
    125   1.1        pk 
    126   1.8   gehenna extern struct cfdriver cgsix_cd;
    127   1.1        pk 
    128   1.8   gehenna dev_type_open(cgsixopen);
    129   1.8   gehenna dev_type_close(cgsixclose);
    130   1.8   gehenna dev_type_ioctl(cgsixioctl);
    131   1.8   gehenna dev_type_mmap(cgsixmmap);
    132   1.8   gehenna 
    133   1.8   gehenna const struct cdevsw cgsix_cdevsw = {
    134   1.8   gehenna 	cgsixopen, cgsixclose, noread, nowrite, cgsixioctl,
    135   1.9  jdolecek 	nostop, notty, nopoll, cgsixmmap, nokqfilter,
    136   1.8   gehenna };
    137   1.1        pk 
    138   1.1        pk /* frame buffer generic driver */
    139   1.1        pk static struct fbdriver cg6_fbdriver = {
    140   1.9  jdolecek 	cg6_unblank, cgsixopen, cgsixclose, cgsixioctl, nopoll, cgsixmmap,
    141   1.9  jdolecek 	nokqfilter
    142   1.1        pk };
    143   1.1        pk 
    144   1.1        pk static void cg6_reset (struct cgsix_softc *);
    145   1.1        pk static void cg6_loadcmap (struct cgsix_softc *, int, int);
    146   1.1        pk static void cg6_loadomap (struct cgsix_softc *);
    147   1.1        pk static void cg6_setcursor (struct cgsix_softc *);/* set position */
    148   1.1        pk static void cg6_loadcursor (struct cgsix_softc *);/* set shape */
    149   1.1        pk 
    150  1.18    martin struct wsscreen_descr cgsix_defaultscreen = {
    151  1.18    martin 	"std",
    152  1.18    martin 	0, 0,	/* will be filled in -- XXX shouldn't, it's global */
    153  1.18    martin 	0,		/* textops */
    154  1.18    martin 	0, 0,	/* font width/height */
    155  1.18    martin 	WSSCREEN_REVERSE	/* capabilities */
    156  1.18    martin };
    157  1.18    martin 
    158  1.18    martin static int cgsix_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
    159  1.18    martin static paddr_t cgsix_mmap __P((void *, off_t, int));
    160  1.18    martin static int cgsix_alloc_screen __P((void *, const struct wsscreen_descr *,
    161  1.18    martin 				void **, int *, int *, long *));
    162  1.18    martin static void cgsix_free_screen __P((void *, void *));
    163  1.18    martin static int cgsix_show_screen __P((void *, void *, int,
    164  1.18    martin 				void (*) (void *, int, int), void *));
    165  1.18    martin int cgsix_putcmap(struct cgsix_softc *, struct wsdisplay_cmap *);
    166  1.18    martin int cgsix_getcmap(struct cgsix_softc *, struct wsdisplay_cmap *);
    167  1.18    martin 
    168  1.18    martin struct wsdisplay_accessops cgsix_accessops = {
    169  1.18    martin 	cgsix_ioctl,
    170  1.18    martin 	cgsix_mmap,
    171  1.18    martin 	cgsix_alloc_screen,
    172  1.18    martin 	cgsix_free_screen,
    173  1.18    martin 	cgsix_show_screen,
    174  1.18    martin 	NULL, 	/* load_font */
    175  1.18    martin 	NULL,	/* pollc */
    176  1.18    martin 	NULL,	/* getwschar */
    177  1.18    martin 	NULL,	/* putwschar */
    178  1.18    martin 	NULL	/* scroll */
    179  1.18    martin };
    180  1.18    martin 
    181  1.18    martin const struct wsscreen_descr *_cgsix_scrlist[] = {
    182  1.18    martin 	&cgsix_defaultscreen
    183  1.18    martin };
    184  1.18    martin 
    185  1.18    martin struct wsscreen_list cgsix_screenlist = {
    186  1.18    martin 	sizeof(_cgsix_scrlist) / sizeof(struct wsscreen_descr *),
    187  1.18    martin 	_cgsix_scrlist
    188  1.18    martin };
    189  1.18    martin 
    190   1.1        pk #ifdef RASTERCONSOLE
    191   1.1        pk int cgsix_use_rasterconsole = 1;
    192  1.18    martin #endif
    193   1.1        pk 
    194   1.1        pk /*
    195   1.1        pk  * cg6 accelerated console routines.
    196   1.1        pk  *
    197   1.1        pk  * Note that buried in this code in several places is the assumption
    198   1.1        pk  * that pixels are exactly one byte wide.  Since this is cg6-specific
    199   1.1        pk  * code, this seems safe.  This assumption resides in things like the
    200   1.1        pk  * use of ri_emuwidth without messing around with ri_pelbytes, or the
    201   1.1        pk  * assumption that ri_font->fontwidth is the right thing to multiply
    202   1.1        pk  * character-cell counts by to get byte counts.
    203   1.1        pk  */
    204   1.1        pk 
    205   1.1        pk /*
    206   1.1        pk  * Magic values for blitter
    207   1.1        pk  */
    208   1.1        pk 
    209   1.5   tsutsui /* Values for the mode register */
    210   1.5   tsutsui #define CG6_MODE	(						\
    211   1.5   tsutsui 	  0x00200000 /* GX_BLIT_SRC */					\
    212   1.5   tsutsui 	| 0x00020000 /* GX_MODE_COLOR8 */				\
    213   1.5   tsutsui 	| 0x00008000 /* GX_DRAW_RENDER */				\
    214   1.5   tsutsui 	| 0x00002000 /* GX_BWRITE0_ENABLE */				\
    215   1.5   tsutsui 	| 0x00001000 /* GX_BWRITE1_DISABLE */				\
    216   1.5   tsutsui 	| 0x00000200 /* GX_BREAD_0 */					\
    217   1.5   tsutsui 	| 0x00000080 /* GX_BDISP_0 */					\
    218   1.5   tsutsui )
    219   1.5   tsutsui #define CG6_MODE_MASK	(						\
    220   1.5   tsutsui 	  0x00300000 /* GX_BLIT_ALL */					\
    221   1.5   tsutsui 	| 0x00060000 /* GX_MODE_ALL */					\
    222   1.5   tsutsui 	| 0x00018000 /* GX_DRAW_ALL */					\
    223   1.5   tsutsui 	| 0x00006000 /* GX_BWRITE0_ALL */				\
    224   1.5   tsutsui 	| 0x00001800 /* GX_BWRITE1_ALL */				\
    225   1.5   tsutsui 	| 0x00000600 /* GX_BREAD_ALL */					\
    226   1.5   tsutsui 	| 0x00000180 /* GX_BDISP_ALL */					\
    227   1.5   tsutsui )
    228   1.5   tsutsui 
    229   1.1        pk /* Value for the alu register for screen-to-screen copies */
    230   1.1        pk #define CG6_ALU_COPY	(						\
    231   1.1        pk 	  0x80000000 /* GX_PLANE_ONES (ignore planemask register) */	\
    232   1.1        pk 	| 0x20000000 /* GX_PIXEL_ONES (ignore pixelmask register) */	\
    233   1.1        pk 	| 0x00800000 /* GX_ATTR_SUPP (function unknown) */		\
    234   1.1        pk 	| 0x00000000 /* GX_RAST_BOOL (function unknown) */		\
    235   1.1        pk 	| 0x00000000 /* GX_PLOT_PLOT (function unknown) */		\
    236   1.1        pk 	| 0x08000000 /* GX_PATTERN_ONES (ignore pattern) */		\
    237   1.1        pk 	| 0x01000000 /* GX_POLYG_OVERLAP (unsure - handle overlap?) */	\
    238   1.1        pk 	| 0x0000cccc /* ALU = src */					\
    239   1.1        pk )
    240   1.1        pk 
    241   1.1        pk /* Value for the alu register for region fills */
    242   1.1        pk #define CG6_ALU_FILL	(						\
    243   1.1        pk 	  0x80000000 /* GX_PLANE_ONES (ignore planemask register) */	\
    244   1.1        pk 	| 0x20000000 /* GX_PIXEL_ONES (ignore pixelmask register) */	\
    245   1.1        pk 	| 0x00800000 /* GX_ATTR_SUPP (function unknown) */		\
    246   1.1        pk 	| 0x00000000 /* GX_RAST_BOOL (function unknown) */		\
    247   1.1        pk 	| 0x00000000 /* GX_PLOT_PLOT (function unknown) */		\
    248   1.1        pk 	| 0x08000000 /* GX_PATTERN_ONES (ignore pattern) */		\
    249   1.1        pk 	| 0x01000000 /* GX_POLYG_OVERLAP (unsure - handle overlap?) */	\
    250   1.1        pk 	| 0x0000ff00 /* ALU = fg color */				\
    251   1.1        pk )
    252   1.1        pk 
    253   1.1        pk /* Value for the alu register for toggling an area */
    254   1.1        pk #define CG6_ALU_FLIP	(						\
    255   1.1        pk 	  0x80000000 /* GX_PLANE_ONES (ignore planemask register) */	\
    256   1.1        pk 	| 0x20000000 /* GX_PIXEL_ONES (ignore pixelmask register) */	\
    257   1.1        pk 	| 0x00800000 /* GX_ATTR_SUPP (function unknown) */		\
    258   1.1        pk 	| 0x00000000 /* GX_RAST_BOOL (function unknown) */		\
    259   1.1        pk 	| 0x00000000 /* GX_PLOT_PLOT (function unknown) */		\
    260   1.1        pk 	| 0x08000000 /* GX_PATTERN_ONES (ignore pattern) */		\
    261   1.1        pk 	| 0x01000000 /* GX_POLYG_OVERLAP (unsure - handle overlap?) */	\
    262   1.1        pk 	| 0x00005555 /* ALU = ~dst */					\
    263   1.1        pk )
    264   1.1        pk 
    265   1.1        pk /*
    266   1.1        pk  * Wait for a blit to finish.
    267   1.1        pk  * 0x8000000 bit: function unknown; 0x20000000 bit: GX_BLT_INPROGRESS
    268   1.1        pk  */
    269   1.1        pk #define CG6_BLIT_WAIT(fbc) do {						\
    270   1.1        pk 	while (((fbc)->fbc_blit & 0xa0000000) == 0xa0000000)		\
    271   1.1        pk 		/*EMPTY*/;						\
    272   1.1        pk } while (0)
    273   1.1        pk 
    274   1.1        pk /*
    275   1.1        pk  * Wait for a drawing operation to finish, or at least get queued.
    276   1.1        pk  * 0x8000000 bit: function unknown; 0x20000000 bit: GX_FULL
    277   1.1        pk  */
    278   1.1        pk #define CG6_DRAW_WAIT(fbc) do {						\
    279   1.1        pk        	while (((fbc)->fbc_draw & 0xa0000000) == 0xa0000000)		\
    280   1.1        pk 		/*EMPTY*/;						\
    281   1.1        pk } while (0)
    282   1.1        pk 
    283   1.1        pk /*
    284   1.1        pk  * Wait for the whole engine to go idle.  This may not matter in our case;
    285   1.1        pk  * I'm not sure whether blits are actually queued or not.  It more likely
    286   1.1        pk  * is intended for lines and such that do get queued.
    287   1.1        pk  * 0x10000000 bit: GX_INPROGRESS
    288   1.1        pk  */
    289   1.1        pk #define CG6_DRAIN(fbc) do {						\
    290   1.1        pk 	while ((fbc)->fbc_s & 0x10000000)				\
    291   1.1        pk 		/*EMPTY*/;						\
    292   1.1        pk } while (0)
    293   1.1        pk 
    294   1.5   tsutsui static void cg6_ras_init(struct cgsix_softc *);
    295   1.5   tsutsui static void cg6_ras_copyrows(void *, int, int, int);
    296   1.5   tsutsui static void cg6_ras_copycols(void *, int, int, int, int);
    297   1.5   tsutsui static void cg6_ras_erasecols(void *, int, int, int, long int);
    298   1.5   tsutsui static void cg6_ras_eraserows(void *, int, int, long int);
    299   1.5   tsutsui static void cg6_ras_do_cursor(struct rasops_info *);
    300   1.5   tsutsui 
    301   1.5   tsutsui static void
    302   1.5   tsutsui cg6_ras_init(struct cgsix_softc *sc)
    303   1.5   tsutsui {
    304   1.5   tsutsui 	volatile struct cg6_fbc *fbc = sc->sc_fbc;
    305   1.5   tsutsui 
    306   1.5   tsutsui 	CG6_DRAIN(fbc);
    307   1.5   tsutsui 	fbc->fbc_mode &= ~CG6_MODE_MASK;
    308   1.5   tsutsui 	fbc->fbc_mode |= CG6_MODE;
    309   1.5   tsutsui }
    310   1.5   tsutsui 
    311   1.1        pk static void
    312   1.1        pk cg6_ras_copyrows(void *cookie, int src, int dst, int n)
    313   1.1        pk {
    314   1.1        pk 	struct rasops_info *ri;
    315   1.1        pk 	volatile struct cg6_fbc *fbc;
    316   1.1        pk 
    317   1.1        pk 	ri = cookie;
    318   1.1        pk 	if (dst == src)
    319   1.1        pk 		return;
    320   1.1        pk 	if (src < 0) {
    321   1.1        pk 		n += src;
    322   1.1        pk 		src = 0;
    323   1.1        pk 	}
    324   1.1        pk 	if (src+n > ri->ri_rows)
    325   1.1        pk 		n = ri->ri_rows - src;
    326   1.1        pk 	if (dst < 0) {
    327   1.1        pk 		n += dst;
    328   1.1        pk 		dst = 0;
    329   1.1        pk 	}
    330   1.1        pk 	if (dst+n > ri->ri_rows)
    331   1.1        pk 		n = ri->ri_rows - dst;
    332   1.1        pk 	if (n <= 0)
    333   1.1        pk 		return;
    334   1.1        pk 	n *= ri->ri_font->fontheight;
    335   1.1        pk 	src *= ri->ri_font->fontheight;
    336   1.1        pk 	dst *= ri->ri_font->fontheight;
    337   1.1        pk 	fbc = ((struct cgsix_softc *)ri->ri_hw)->sc_fbc;
    338   1.1        pk 	fbc->fbc_clip = 0;
    339   1.1        pk 	fbc->fbc_s = 0;
    340   1.1        pk 	fbc->fbc_offx = 0;
    341   1.1        pk 	fbc->fbc_offy = 0;
    342   1.1        pk 	fbc->fbc_clipminx = 0;
    343   1.1        pk 	fbc->fbc_clipminy = 0;
    344   1.1        pk 	fbc->fbc_clipmaxx = ri->ri_width - 1;
    345   1.1        pk 	fbc->fbc_clipmaxy = ri->ri_height - 1;
    346   1.1        pk 	fbc->fbc_alu = CG6_ALU_COPY;
    347   1.1        pk 	fbc->fbc_x0 = ri->ri_xorigin;
    348   1.1        pk 	fbc->fbc_y0 = ri->ri_yorigin + src;
    349   1.1        pk 	fbc->fbc_x1 = ri->ri_xorigin + ri->ri_emuwidth - 1;
    350   1.1        pk 	fbc->fbc_y1 = ri->ri_yorigin + src + n - 1;
    351   1.1        pk 	fbc->fbc_x2 = ri->ri_xorigin;
    352   1.1        pk 	fbc->fbc_y2 = ri->ri_yorigin + dst;
    353   1.1        pk 	fbc->fbc_x3 = ri->ri_xorigin + ri->ri_emuwidth - 1;
    354   1.1        pk 	fbc->fbc_y3 = ri->ri_yorigin + dst + n - 1;
    355   1.1        pk 	CG6_BLIT_WAIT(fbc);
    356   1.1        pk 	CG6_DRAIN(fbc);
    357   1.1        pk }
    358   1.1        pk 
    359   1.1        pk static void
    360   1.1        pk cg6_ras_copycols(void *cookie, int row, int src, int dst, int n)
    361   1.1        pk {
    362   1.1        pk 	struct rasops_info *ri;
    363   1.1        pk 	volatile struct cg6_fbc *fbc;
    364   1.1        pk 
    365   1.1        pk 	ri = cookie;
    366   1.1        pk 	if (dst == src)
    367   1.1        pk 		return;
    368   1.1        pk 	if ((row < 0) || (row >= ri->ri_rows))
    369   1.1        pk 		return;
    370   1.1        pk 	if (src < 0) {
    371   1.1        pk 		n += src;
    372   1.1        pk 		src = 0;
    373   1.1        pk 	}
    374   1.1        pk 	if (src+n > ri->ri_cols)
    375   1.1        pk 		n = ri->ri_cols - src;
    376   1.1        pk 	if (dst < 0) {
    377   1.1        pk 		n += dst;
    378   1.1        pk 		dst = 0;
    379   1.1        pk 	}
    380   1.1        pk 	if (dst+n > ri->ri_cols)
    381   1.1        pk 		n = ri->ri_cols - dst;
    382   1.1        pk 	if (n <= 0)
    383   1.1        pk 		return;
    384   1.1        pk 	n *= ri->ri_font->fontwidth;
    385   1.1        pk 	src *= ri->ri_font->fontwidth;
    386   1.1        pk 	dst *= ri->ri_font->fontwidth;
    387   1.1        pk 	row *= ri->ri_font->fontheight;
    388   1.1        pk 	fbc = ((struct cgsix_softc *)ri->ri_hw)->sc_fbc;
    389   1.1        pk 	fbc->fbc_clip = 0;
    390   1.1        pk 	fbc->fbc_s = 0;
    391   1.1        pk 	fbc->fbc_offx = 0;
    392   1.1        pk 	fbc->fbc_offy = 0;
    393   1.1        pk 	fbc->fbc_clipminx = 0;
    394   1.1        pk 	fbc->fbc_clipminy = 0;
    395   1.1        pk 	fbc->fbc_clipmaxx = ri->ri_width - 1;
    396   1.1        pk 	fbc->fbc_clipmaxy = ri->ri_height - 1;
    397   1.1        pk 	fbc->fbc_alu = CG6_ALU_COPY;
    398   1.1        pk 	fbc->fbc_x0 = ri->ri_xorigin + src;
    399   1.1        pk 	fbc->fbc_y0 = ri->ri_yorigin + row;
    400   1.1        pk 	fbc->fbc_x1 = ri->ri_xorigin + src + n - 1;
    401   1.1        pk 	fbc->fbc_y1 = ri->ri_yorigin + row + ri->ri_font->fontheight - 1;
    402   1.1        pk 	fbc->fbc_x2 = ri->ri_xorigin + dst;
    403   1.1        pk 	fbc->fbc_y2 = ri->ri_yorigin + row;
    404   1.1        pk 	fbc->fbc_x3 = ri->ri_xorigin + dst + n - 1;
    405   1.1        pk 	fbc->fbc_y3 = ri->ri_yorigin + row + ri->ri_font->fontheight - 1;
    406   1.1        pk 	CG6_BLIT_WAIT(fbc);
    407   1.1        pk 	CG6_DRAIN(fbc);
    408   1.1        pk }
    409   1.1        pk 
    410   1.1        pk static void
    411   1.1        pk cg6_ras_erasecols(void *cookie, int row, int col, int n, long int attr)
    412   1.1        pk {
    413   1.1        pk 	struct rasops_info *ri;
    414   1.1        pk 	volatile struct cg6_fbc *fbc;
    415   1.1        pk 
    416   1.1        pk 	ri = cookie;
    417   1.1        pk 	if ((row < 0) || (row >= ri->ri_rows))
    418   1.1        pk 		return;
    419   1.1        pk 	if (col < 0) {
    420   1.1        pk 		n += col;
    421   1.1        pk 		col = 0;
    422   1.1        pk 	}
    423   1.1        pk 	if (col+n > ri->ri_cols)
    424   1.1        pk 		n = ri->ri_cols - col;
    425   1.1        pk 	if (n <= 0)
    426   1.1        pk 		return;
    427   1.1        pk 	n *= ri->ri_font->fontwidth;
    428   1.1        pk 	col *= ri->ri_font->fontwidth;
    429   1.1        pk 	row *= ri->ri_font->fontheight;
    430   1.1        pk 	fbc = ((struct cgsix_softc *)ri->ri_hw)->sc_fbc;
    431   1.1        pk 	fbc->fbc_clip = 0;
    432   1.1        pk 	fbc->fbc_s = 0;
    433   1.1        pk 	fbc->fbc_offx = 0;
    434   1.1        pk 	fbc->fbc_offy = 0;
    435   1.1        pk 	fbc->fbc_clipminx = 0;
    436   1.1        pk 	fbc->fbc_clipminy = 0;
    437   1.1        pk 	fbc->fbc_clipmaxx = ri->ri_width - 1;
    438   1.1        pk 	fbc->fbc_clipmaxy = ri->ri_height - 1;
    439   1.1        pk 	fbc->fbc_alu = CG6_ALU_FILL;
    440   1.1        pk 	fbc->fbc_fg = ri->ri_devcmap[(attr >> 16) & 0xf];
    441   1.1        pk 	fbc->fbc_arecty = ri->ri_yorigin + row;
    442   1.1        pk 	fbc->fbc_arectx = ri->ri_xorigin + col;
    443   1.1        pk 	fbc->fbc_arecty = ri->ri_yorigin + row + ri->ri_font->fontheight - 1;
    444   1.1        pk 	fbc->fbc_arectx = ri->ri_xorigin + col + n - 1;
    445   1.1        pk 	CG6_DRAW_WAIT(fbc);
    446   1.1        pk 	CG6_DRAIN(fbc);
    447   1.1        pk }
    448   1.1        pk 
    449   1.1        pk static void
    450   1.1        pk cg6_ras_eraserows(void *cookie, int row, int n, long int attr)
    451   1.1        pk {
    452   1.1        pk 	struct rasops_info *ri;
    453   1.1        pk 	volatile struct cg6_fbc *fbc;
    454   1.1        pk 
    455   1.1        pk 	ri = cookie;
    456   1.1        pk 	if (row < 0) {
    457   1.1        pk 		n += row;
    458   1.1        pk 		row = 0;
    459   1.1        pk 	}
    460   1.1        pk 	if (row+n > ri->ri_rows)
    461   1.1        pk 		n = ri->ri_rows - row;
    462   1.1        pk 	if (n <= 0)
    463   1.1        pk 		return;
    464   1.1        pk 	fbc = ((struct cgsix_softc *)ri->ri_hw)->sc_fbc;
    465   1.1        pk 	fbc->fbc_clip = 0;
    466   1.1        pk 	fbc->fbc_s = 0;
    467   1.1        pk 	fbc->fbc_offx = 0;
    468   1.1        pk 	fbc->fbc_offy = 0;
    469   1.1        pk 	fbc->fbc_clipminx = 0;
    470   1.1        pk 	fbc->fbc_clipminy = 0;
    471   1.1        pk 	fbc->fbc_clipmaxx = ri->ri_width - 1;
    472   1.1        pk 	fbc->fbc_clipmaxy = ri->ri_height - 1;
    473   1.1        pk 	fbc->fbc_alu = CG6_ALU_FILL;
    474   1.1        pk 	fbc->fbc_fg = ri->ri_devcmap[(attr >> 16) & 0xf];
    475   1.1        pk 	if ((n == ri->ri_rows) && (ri->ri_flg & RI_FULLCLEAR)) {
    476   1.1        pk 		fbc->fbc_arecty = 0;
    477   1.1        pk 		fbc->fbc_arectx = 0;
    478   1.1        pk 		fbc->fbc_arecty = ri->ri_height - 1;
    479   1.1        pk 		fbc->fbc_arectx = ri->ri_width - 1;
    480   1.1        pk 	} else {
    481   1.1        pk 		row *= ri->ri_font->fontheight;
    482   1.1        pk 		fbc->fbc_arecty = ri->ri_yorigin + row;
    483   1.1        pk 		fbc->fbc_arectx = ri->ri_xorigin;
    484   1.1        pk 		fbc->fbc_arecty = ri->ri_yorigin + row + (n * ri->ri_font->fontheight) - 1;
    485   1.1        pk 		fbc->fbc_arectx = ri->ri_xorigin + ri->ri_emuwidth - 1;
    486   1.1        pk 	}
    487   1.1        pk 	CG6_DRAW_WAIT(fbc);
    488   1.1        pk 	CG6_DRAIN(fbc);
    489   1.1        pk }
    490   1.1        pk 
    491   1.1        pk /*
    492   1.1        pk  * Really want something more like fg^bg here, but that would be more
    493   1.1        pk  * or less impossible to migrate to colors.  So we hope there's
    494   1.1        pk  * something not too inappropriate in the colormap...besides, it's what
    495   1.1        pk  * the non-accelerated code did. :-)
    496   1.1        pk  */
    497   1.1        pk static void
    498   1.1        pk cg6_ras_do_cursor(struct rasops_info *ri)
    499   1.1        pk {
    500   1.1        pk 	volatile struct cg6_fbc *fbc;
    501   1.1        pk 	int row;
    502   1.1        pk 	int col;
    503   1.1        pk 
    504   1.1        pk 	row = ri->ri_crow * ri->ri_font->fontheight;
    505   1.1        pk 	col = ri->ri_ccol * ri->ri_font->fontwidth;
    506   1.1        pk 	fbc = ((struct cgsix_softc *)ri->ri_hw)->sc_fbc;
    507   1.1        pk 	fbc->fbc_clip = 0;
    508   1.1        pk 	fbc->fbc_s = 0;
    509   1.1        pk 	fbc->fbc_offx = 0;
    510   1.1        pk 	fbc->fbc_offy = 0;
    511   1.1        pk 	fbc->fbc_clipminx = 0;
    512   1.1        pk 	fbc->fbc_clipminy = 0;
    513   1.1        pk 	fbc->fbc_clipmaxx = ri->ri_width - 1;
    514   1.1        pk 	fbc->fbc_clipmaxy = ri->ri_height - 1;
    515   1.1        pk 	fbc->fbc_alu = CG6_ALU_FLIP;
    516   1.1        pk 	fbc->fbc_arecty = ri->ri_yorigin + row;
    517   1.1        pk 	fbc->fbc_arectx = ri->ri_xorigin + col;
    518   1.1        pk 	fbc->fbc_arecty = ri->ri_yorigin + row + ri->ri_font->fontheight - 1;
    519   1.1        pk 	fbc->fbc_arectx = ri->ri_xorigin + col + ri->ri_font->fontwidth - 1;
    520   1.1        pk 	CG6_DRAW_WAIT(fbc);
    521   1.1        pk 	CG6_DRAIN(fbc);
    522   1.1        pk }
    523   1.1        pk 
    524   1.1        pk void
    525   1.1        pk cg6attach(sc, name, isconsole)
    526   1.1        pk 	struct cgsix_softc *sc;
    527   1.1        pk 	char *name;
    528   1.1        pk 	int isconsole;
    529   1.1        pk {
    530   1.1        pk 	struct fbdevice *fb = &sc->sc_fb;
    531  1.18    martin 	struct wsemuldisplaydev_attach_args aa;
    532  1.18    martin 	struct rasops_info *ri = &fb->fb_rinfo;
    533  1.18    martin 	unsigned long defattr;
    534   1.1        pk 
    535   1.1        pk 	fb->fb_driver = &cg6_fbdriver;
    536   1.1        pk 
    537   1.1        pk 	/* Don't have to map the pfour register on the cgsix. */
    538   1.1        pk 	fb->fb_pfour = NULL;
    539   1.1        pk 
    540   1.1        pk 	fb->fb_type.fb_cmsize = 256;
    541   1.1        pk 	fb->fb_type.fb_size = fb->fb_type.fb_height * fb->fb_linebytes;
    542   1.1        pk 	printf(": %s, %d x %d", name,
    543   1.1        pk 	       fb->fb_type.fb_width, fb->fb_type.fb_height);
    544  1.18    martin 	if(sc->sc_fhc) {
    545   1.1        pk 	sc->sc_fhcrev = (*sc->sc_fhc >> FHC_REV_SHIFT) &
    546   1.1        pk 			(FHC_REV_MASK >> FHC_REV_SHIFT);
    547  1.18    martin 	} else
    548  1.18    martin 		sc->sc_fhcrev=-1;
    549   1.1        pk 	printf(", rev %d", sc->sc_fhcrev);
    550   1.1        pk 
    551   1.1        pk 	/* reset cursor & frame buffer controls */
    552   1.1        pk 	cg6_reset(sc);
    553   1.1        pk 
    554   1.1        pk 	/* enable video */
    555   1.1        pk 	sc->sc_thc->thc_misc |= THC_MISC_VIDEN;
    556   1.1        pk 
    557   1.1        pk 	if (isconsole) {
    558   1.1        pk 		printf(" (console)");
    559  1.18    martin 
    560  1.18    martin /* this is the old console attachment stuff - we shouldn't need it anymore */
    561   1.1        pk #ifdef RASTERCONSOLE
    562   1.1        pk 		if (cgsix_use_rasterconsole) {
    563   1.1        pk 			fbrcons_init(&sc->sc_fb);
    564   1.1        pk 			sc->sc_fb.fb_rinfo.ri_hw = sc;
    565   1.1        pk 			sc->sc_fb.fb_rinfo.ri_ops.copyrows = cg6_ras_copyrows;
    566   1.1        pk 			sc->sc_fb.fb_rinfo.ri_ops.copycols = cg6_ras_copycols;
    567   1.1        pk 			sc->sc_fb.fb_rinfo.ri_ops.erasecols = cg6_ras_erasecols;
    568   1.1        pk 			sc->sc_fb.fb_rinfo.ri_ops.eraserows = cg6_ras_eraserows;
    569   1.1        pk 			sc->sc_fb.fb_rinfo.ri_do_cursor = cg6_ras_do_cursor;
    570   1.5   tsutsui 			cg6_ras_init(sc);
    571   1.1        pk 		}
    572   1.1        pk #endif
    573   1.1        pk 	}
    574   1.1        pk 
    575  1.18    martin 	fb_attach(&sc->sc_fb, isconsole);
    576  1.18    martin 
    577  1.18    martin /* setup rasops and so on for wsdisplay */
    578  1.18    martin 	wsfont_init();
    579  1.18    martin 	/* fill in rasops_info */
    580  1.18    martin 	ri->ri_hw=sc;
    581  1.18    martin 	ri->ri_width = fb->fb_type.fb_width;
    582  1.18    martin 	ri->ri_height = fb->fb_type.fb_height;
    583  1.18    martin 	ri->ri_depth = 8;
    584  1.18    martin 	ri->ri_stride = fb->fb_linebytes;
    585  1.18    martin 	ri->ri_bits = fb->fb_pixels;
    586  1.18    martin 	ri->ri_flg = RI_FORCEMONO | RI_CENTER | RI_CLEAR;
    587  1.18    martin 	rasops_init(ri, fb->fb_type.fb_height/16, fb->fb_type.fb_width/8);
    588  1.18    martin 	ri->ri_ops.copyrows = cg6_ras_copyrows;
    589  1.18    martin 	ri->ri_ops.copycols = cg6_ras_copycols;
    590  1.18    martin 	ri->ri_ops.erasecols = cg6_ras_erasecols;
    591  1.18    martin 	ri->ri_ops.eraserows = cg6_ras_eraserows;
    592  1.18    martin 	ri->ri_do_cursor = cg6_ras_do_cursor;
    593  1.18    martin 	cg6_ras_init(sc);
    594  1.18    martin 	cgsix_defaultscreen.nrows = ri->ri_rows;
    595  1.18    martin 	cgsix_defaultscreen.ncols = ri->ri_cols;
    596  1.18    martin 	cgsix_defaultscreen.textops = &ri->ri_ops;
    597  1.18    martin 	cgsix_defaultscreen.capabilities = ri->ri_caps;
    598  1.18    martin 	if(isconsole) {
    599  1.18    martin 		(*ri->ri_ops.allocattr)(ri, 0,0,0, &defattr);
    600  1.18    martin 		wsdisplay_cnattach(&cgsix_defaultscreen, ri, 0, 0, defattr);
    601  1.18    martin 	}
    602  1.18    martin 
    603  1.18    martin /* set up a colour map matching the terminal emulation in use */
    604  1.18    martin #ifdef WSEMUL_SUN
    605  1.18    martin 	sc->sc_cmap.cm_map[0][0]=255;
    606  1.18    martin 	sc->sc_cmap.cm_map[0][1]=255;
    607  1.18    martin 	sc->sc_cmap.cm_map[0][2]=255;
    608  1.18    martin 	sc->sc_cmap.cm_map[254][0]=255;
    609  1.18    martin 	sc->sc_cmap.cm_map[254][1]=255;
    610  1.18    martin 	sc->sc_cmap.cm_map[254][2]=255;
    611  1.18    martin 	sc->sc_cmap.cm_map[1][0]=0;
    612  1.18    martin 	sc->sc_cmap.cm_map[1][1]=0;
    613  1.18    martin 	sc->sc_cmap.cm_map[1][2]=0;
    614  1.18    martin 	sc->sc_cmap.cm_map[255][0]=0;
    615  1.18    martin 	sc->sc_cmap.cm_map[255][1]=0;
    616  1.18    martin 	sc->sc_cmap.cm_map[255][2]=0;
    617  1.18    martin 	cg6_loadcmap(sc,0,256);
    618  1.18    martin #elif defined(WSEMUL_VT100)
    619  1.18    martin 	/* here we should steal the VT100 colour map from rasops */
    620  1.18    martin #endif
    621  1.18    martin 
    622  1.18    martin 	aa.console = isconsole;
    623  1.18    martin 	aa.scrdata = &cgsix_screenlist;
    624  1.18    martin 	aa.accessops = &cgsix_accessops;
    625  1.18    martin 	aa.accesscookie = sc;
    626   1.1        pk 	printf("\n");
    627  1.18    martin 
    628  1.18    martin 	config_found(&sc->sc_dev, &aa, wsemuldisplaydevprint);
    629  1.18    martin 
    630   1.1        pk }
    631   1.1        pk 
    632   1.1        pk 
    633   1.1        pk int
    634  1.12      fvdl cgsixopen(dev, flags, mode, p)
    635   1.1        pk 	dev_t dev;
    636   1.1        pk 	int flags, mode;
    637  1.12      fvdl 	struct proc *p;
    638   1.1        pk {
    639   1.1        pk 	int unit = minor(dev);
    640   1.1        pk 
    641   1.1        pk 	if (unit >= cgsix_cd.cd_ndevs || cgsix_cd.cd_devs[unit] == NULL)
    642   1.1        pk 		return (ENXIO);
    643   1.1        pk 	return (0);
    644   1.1        pk }
    645   1.1        pk 
    646   1.1        pk int
    647  1.12      fvdl cgsixclose(dev, flags, mode, p)
    648   1.1        pk 	dev_t dev;
    649   1.1        pk 	int flags, mode;
    650  1.12      fvdl 	struct proc *p;
    651   1.1        pk {
    652   1.1        pk 	struct cgsix_softc *sc = cgsix_cd.cd_devs[minor(dev)];
    653   1.1        pk 
    654   1.1        pk 	cg6_reset(sc);
    655   1.1        pk 
    656   1.1        pk 	/* (re-)initialize the default color map */
    657   1.1        pk 	bt_initcmap(&sc->sc_cmap, 256);
    658   1.1        pk 	cg6_loadcmap(sc, 0, 256);
    659   1.1        pk 
    660   1.1        pk 	return (0);
    661   1.1        pk }
    662   1.1        pk 
    663   1.1        pk int
    664  1.12      fvdl cgsixioctl(dev, cmd, data, flags, p)
    665   1.1        pk 	dev_t dev;
    666   1.1        pk 	u_long cmd;
    667   1.1        pk 	caddr_t data;
    668   1.1        pk 	int flags;
    669  1.12      fvdl 	struct proc *p;
    670   1.1        pk {
    671   1.1        pk 	struct cgsix_softc *sc = cgsix_cd.cd_devs[minor(dev)];
    672  1.16       chs 	union cursor_cmap tcm;
    673  1.16       chs 	uint32_t image[32], mask[32];
    674   1.1        pk 	u_int count;
    675   1.1        pk 	int v, error;
    676   1.1        pk 
    677  1.18    martin #ifdef CGSIX_DEBUG
    678  1.18    martin 	printf("cgsixioctl(%ld)\n",cmd);
    679  1.18    martin #endif
    680  1.18    martin 
    681   1.1        pk 	switch (cmd) {
    682   1.1        pk 
    683   1.1        pk 	case FBIOGTYPE:
    684   1.1        pk 		*(struct fbtype *)data = sc->sc_fb.fb_type;
    685   1.1        pk 		break;
    686   1.1        pk 
    687   1.1        pk 	case FBIOGATTR:
    688   1.1        pk #define fba ((struct fbgattr *)data)
    689   1.1        pk 		fba->real_type = sc->sc_fb.fb_type.fb_type;
    690   1.1        pk 		fba->owner = 0;		/* XXX ??? */
    691   1.1        pk 		fba->fbtype = sc->sc_fb.fb_type;
    692   1.1        pk 		fba->sattr.flags = 0;
    693   1.1        pk 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
    694   1.1        pk 		fba->sattr.dev_specific[0] = -1;
    695   1.1        pk 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
    696   1.1        pk 		fba->emu_types[1] = -1;
    697   1.1        pk #undef fba
    698   1.1        pk 		break;
    699   1.1        pk 
    700   1.1        pk 	case FBIOGETCMAP:
    701   1.1        pk #define	p ((struct fbcmap *)data)
    702   1.1        pk 		return (bt_getcmap(p, &sc->sc_cmap, 256, 1));
    703   1.1        pk 
    704   1.1        pk 	case FBIOPUTCMAP:
    705   1.1        pk 		/* copy to software map */
    706   1.1        pk 		error = bt_putcmap(p, &sc->sc_cmap, 256, 1);
    707   1.1        pk 		if (error)
    708   1.1        pk 			return (error);
    709   1.1        pk 		/* now blast them into the chip */
    710   1.1        pk 		/* XXX should use retrace interrupt */
    711   1.1        pk 		cg6_loadcmap(sc, p->index, p->count);
    712   1.1        pk #undef p
    713   1.1        pk 		break;
    714   1.1        pk 
    715   1.1        pk 	case FBIOGVIDEO:
    716   1.1        pk 		*(int *)data = sc->sc_blanked;
    717   1.1        pk 		break;
    718   1.1        pk 
    719   1.1        pk 	case FBIOSVIDEO:
    720   1.1        pk 		if (*(int *)data)
    721   1.1        pk 			cg6_unblank(&sc->sc_dev);
    722   1.1        pk 		else if (!sc->sc_blanked) {
    723   1.1        pk 			sc->sc_blanked = 1;
    724   1.1        pk 			sc->sc_thc->thc_misc &= ~THC_MISC_VIDEN;
    725   1.1        pk 		}
    726   1.1        pk 		break;
    727   1.1        pk 
    728   1.1        pk /* these are for both FBIOSCURSOR and FBIOGCURSOR */
    729   1.1        pk #define p ((struct fbcursor *)data)
    730   1.1        pk #define cc (&sc->sc_cursor)
    731   1.1        pk 
    732   1.1        pk 	case FBIOGCURSOR:
    733   1.1        pk 		/* do not quite want everything here... */
    734   1.1        pk 		p->set = FB_CUR_SETALL;	/* close enough, anyway */
    735   1.1        pk 		p->enable = cc->cc_enable;
    736   1.1        pk 		p->pos = cc->cc_pos;
    737   1.1        pk 		p->hot = cc->cc_hot;
    738   1.1        pk 		p->size = cc->cc_size;
    739   1.1        pk 
    740   1.1        pk 		/* begin ugh ... can we lose some of this crap?? */
    741   1.1        pk 		if (p->image != NULL) {
    742   1.1        pk 			count = cc->cc_size.y * 32 / NBBY;
    743  1.16       chs 			error = copyout(cc->cc_bits[1], p->image, count);
    744   1.1        pk 			if (error)
    745   1.1        pk 				return (error);
    746  1.16       chs 			error = copyout(cc->cc_bits[0], p->mask, count);
    747   1.1        pk 			if (error)
    748   1.1        pk 				return (error);
    749   1.1        pk 		}
    750   1.1        pk 		if (p->cmap.red != NULL) {
    751   1.1        pk 			error = bt_getcmap(&p->cmap,
    752   1.1        pk 			    (union bt_cmap *)&cc->cc_color, 2, 1);
    753   1.1        pk 			if (error)
    754   1.1        pk 				return (error);
    755   1.1        pk 		} else {
    756   1.1        pk 			p->cmap.index = 0;
    757   1.1        pk 			p->cmap.count = 2;
    758   1.1        pk 		}
    759   1.1        pk 		/* end ugh */
    760   1.1        pk 		break;
    761   1.1        pk 
    762   1.1        pk 	case FBIOSCURSOR:
    763   1.1        pk 		/*
    764   1.1        pk 		 * For setcmap and setshape, verify parameters, so that
    765   1.1        pk 		 * we do not get halfway through an update and then crap
    766   1.1        pk 		 * out with the software state screwed up.
    767   1.1        pk 		 */
    768   1.1        pk 		v = p->set;
    769   1.1        pk 		if (v & FB_CUR_SETCMAP) {
    770   1.1        pk 			/*
    771   1.1        pk 			 * This use of a temporary copy of the cursor
    772   1.1        pk 			 * colormap is not terribly efficient, but these
    773   1.1        pk 			 * copies are small (8 bytes)...
    774   1.1        pk 			 */
    775   1.1        pk 			tcm = cc->cc_color;
    776   1.1        pk 			error = bt_putcmap(&p->cmap, (union bt_cmap *)&tcm, 2, 1);
    777   1.1        pk 			if (error)
    778   1.1        pk 				return (error);
    779   1.1        pk 		}
    780   1.1        pk 		if (v & FB_CUR_SETSHAPE) {
    781   1.1        pk 			if ((u_int)p->size.x > 32 || (u_int)p->size.y > 32)
    782   1.1        pk 				return (EINVAL);
    783   1.1        pk 			count = p->size.y * 32 / NBBY;
    784  1.16       chs 			error = copyin(p->image, image, count);
    785  1.16       chs 			if (error)
    786  1.16       chs 				return error;
    787  1.16       chs 			error = copyin(p->mask, mask, count);
    788  1.16       chs 			if (error)
    789  1.16       chs 				return error;
    790   1.1        pk 		}
    791   1.1        pk 
    792   1.1        pk 		/* parameters are OK; do it */
    793   1.1        pk 		if (v & (FB_CUR_SETCUR | FB_CUR_SETPOS | FB_CUR_SETHOT)) {
    794   1.1        pk 			if (v & FB_CUR_SETCUR)
    795   1.1        pk 				cc->cc_enable = p->enable;
    796   1.1        pk 			if (v & FB_CUR_SETPOS)
    797   1.1        pk 				cc->cc_pos = p->pos;
    798   1.1        pk 			if (v & FB_CUR_SETHOT)
    799   1.1        pk 				cc->cc_hot = p->hot;
    800   1.1        pk 			cg6_setcursor(sc);
    801   1.1        pk 		}
    802   1.1        pk 		if (v & FB_CUR_SETCMAP) {
    803   1.1        pk 			cc->cc_color = tcm;
    804   1.1        pk 			cg6_loadomap(sc); /* XXX defer to vertical retrace */
    805   1.1        pk 		}
    806   1.1        pk 		if (v & FB_CUR_SETSHAPE) {
    807   1.1        pk 			cc->cc_size = p->size;
    808   1.1        pk 			count = p->size.y * 32 / NBBY;
    809  1.16       chs 			memset(cc->cc_bits, 0, sizeof cc->cc_bits);
    810  1.16       chs 			memcpy(cc->cc_bits[1], image, count);
    811  1.16       chs 			memcpy(cc->cc_bits[0], mask, count);
    812   1.1        pk 			cg6_loadcursor(sc);
    813   1.1        pk 		}
    814   1.1        pk 		break;
    815   1.1        pk 
    816   1.1        pk #undef p
    817   1.1        pk #undef cc
    818   1.1        pk 
    819   1.1        pk 	case FBIOGCURPOS:
    820   1.1        pk 		*(struct fbcurpos *)data = sc->sc_cursor.cc_pos;
    821   1.1        pk 		break;
    822   1.1        pk 
    823   1.1        pk 	case FBIOSCURPOS:
    824   1.1        pk 		sc->sc_cursor.cc_pos = *(struct fbcurpos *)data;
    825   1.1        pk 		cg6_setcursor(sc);
    826   1.1        pk 		break;
    827   1.1        pk 
    828   1.1        pk 	case FBIOGCURMAX:
    829   1.1        pk 		/* max cursor size is 32x32 */
    830   1.1        pk 		((struct fbcurpos *)data)->x = 32;
    831   1.1        pk 		((struct fbcurpos *)data)->y = 32;
    832   1.1        pk 		break;
    833   1.1        pk 
    834   1.1        pk 	default:
    835   1.1        pk #ifdef DEBUG
    836   1.1        pk 		log(LOG_NOTICE, "cgsixioctl(0x%lx) (%s[%d])\n", cmd,
    837   1.1        pk 		    p->p_comm, p->p_pid);
    838   1.1        pk #endif
    839   1.1        pk 		return (ENOTTY);
    840   1.1        pk 	}
    841   1.1        pk 	return (0);
    842   1.1        pk }
    843   1.1        pk 
    844   1.1        pk /*
    845   1.1        pk  * Clean up hardware state (e.g., after bootup or after X crashes).
    846   1.1        pk  */
    847   1.1        pk static void
    848   1.1        pk cg6_reset(sc)
    849   1.1        pk 	struct cgsix_softc *sc;
    850   1.1        pk {
    851   1.1        pk 	volatile struct cg6_tec_xxx *tec;
    852   1.1        pk 	int fhc;
    853   1.1        pk 	volatile struct bt_regs *bt;
    854   1.1        pk 
    855   1.1        pk 	/* hide the cursor, just in case */
    856   1.1        pk 	sc->sc_thc->thc_cursxy = (THC_CURSOFF << 16) | THC_CURSOFF;
    857   1.1        pk 
    858   1.1        pk 	/* turn off frobs in transform engine (makes X11 work) */
    859   1.1        pk 	tec = sc->sc_tec;
    860   1.1        pk 	tec->tec_mv = 0;
    861   1.1        pk 	tec->tec_clip = 0;
    862   1.1        pk 	tec->tec_vdc = 0;
    863   1.1        pk 
    864   1.1        pk 	/* take care of hardware bugs in old revisions */
    865   1.1        pk 	if (sc->sc_fhcrev < 5) {
    866   1.1        pk 		/*
    867  1.17       wiz 		 * Keep current resolution; set CPU to 68020, set test
    868   1.1        pk 		 * window (size 1Kx1K), and for rev 1, disable dest cache.
    869   1.1        pk 		 */
    870   1.1        pk 		fhc = (*sc->sc_fhc & FHC_RES_MASK) | FHC_CPU_68020 |
    871   1.1        pk 		    FHC_TEST |
    872   1.1        pk 		    (11 << FHC_TESTX_SHIFT) | (11 << FHC_TESTY_SHIFT);
    873   1.1        pk 		if (sc->sc_fhcrev < 2)
    874   1.1        pk 			fhc |= FHC_DST_DISABLE;
    875   1.1        pk 		*sc->sc_fhc = fhc;
    876   1.1        pk 	}
    877   1.1        pk 
    878   1.1        pk 	/* Enable cursor in Brooktree DAC. */
    879   1.1        pk 	bt = sc->sc_bt;
    880   1.1        pk 	bt->bt_addr = 0x06 << 24;
    881   1.1        pk 	bt->bt_ctrl |= 0x03 << 24;
    882   1.1        pk }
    883   1.1        pk 
    884   1.1        pk static void
    885   1.1        pk cg6_setcursor(sc)
    886   1.1        pk 	struct cgsix_softc *sc;
    887   1.1        pk {
    888   1.1        pk 
    889   1.1        pk 	/* we need to subtract the hot-spot value here */
    890   1.1        pk #define COORD(f) (sc->sc_cursor.cc_pos.f - sc->sc_cursor.cc_hot.f)
    891   1.1        pk 	sc->sc_thc->thc_cursxy = sc->sc_cursor.cc_enable ?
    892   1.1        pk 	    ((COORD(x) << 16) | (COORD(y) & 0xffff)) :
    893   1.1        pk 	    (THC_CURSOFF << 16) | THC_CURSOFF;
    894   1.1        pk #undef COORD
    895   1.1        pk }
    896   1.1        pk 
    897   1.1        pk static void
    898   1.1        pk cg6_loadcursor(sc)
    899   1.1        pk 	struct cgsix_softc *sc;
    900   1.1        pk {
    901   1.1        pk 	volatile struct cg6_thc *thc;
    902   1.1        pk 	u_int edgemask, m;
    903   1.1        pk 	int i;
    904   1.1        pk 
    905   1.1        pk 	/*
    906   1.1        pk 	 * Keep the top size.x bits.  Here we *throw out* the top
    907   1.1        pk 	 * size.x bits from an all-one-bits word, introducing zeros in
    908   1.1        pk 	 * the top size.x bits, then invert all the bits to get what
    909   1.1        pk 	 * we really wanted as our mask.  But this fails if size.x is
    910   1.1        pk 	 * 32---a sparc uses only the low 5 bits of the shift count---
    911   1.1        pk 	 * so we have to special case that.
    912   1.1        pk 	 */
    913   1.1        pk 	edgemask = ~0;
    914   1.1        pk 	if (sc->sc_cursor.cc_size.x < 32)
    915   1.1        pk 		edgemask = ~(edgemask >> sc->sc_cursor.cc_size.x);
    916   1.1        pk 	thc = sc->sc_thc;
    917   1.1        pk 	for (i = 0; i < 32; i++) {
    918   1.1        pk 		m = sc->sc_cursor.cc_bits[0][i] & edgemask;
    919   1.1        pk 		thc->thc_cursmask[i] = m;
    920   1.1        pk 		thc->thc_cursbits[i] = m & sc->sc_cursor.cc_bits[1][i];
    921   1.1        pk 	}
    922   1.1        pk }
    923   1.1        pk 
    924   1.1        pk /*
    925   1.1        pk  * Load a subset of the current (new) colormap into the color DAC.
    926   1.1        pk  */
    927   1.1        pk static void
    928   1.1        pk cg6_loadcmap(sc, start, ncolors)
    929   1.1        pk 	struct cgsix_softc *sc;
    930   1.1        pk 	int start, ncolors;
    931   1.1        pk {
    932   1.1        pk 	volatile struct bt_regs *bt;
    933   1.1        pk 	u_int *ip, i;
    934   1.1        pk 	int count;
    935   1.1        pk 
    936   1.1        pk 	ip = &sc->sc_cmap.cm_chip[BT_D4M3(start)];	/* start/4 * 3 */
    937   1.1        pk 	count = BT_D4M3(start + ncolors - 1) - BT_D4M3(start) + 3;
    938   1.1        pk 	bt = sc->sc_bt;
    939   1.1        pk 	bt->bt_addr = BT_D4M4(start) << 24;
    940   1.1        pk 	while (--count >= 0) {
    941   1.1        pk 		i = *ip++;
    942   1.1        pk 		/* hardware that makes one want to pound boards with hammers */
    943   1.1        pk 		bt->bt_cmap = i;
    944   1.1        pk 		bt->bt_cmap = i << 8;
    945   1.1        pk 		bt->bt_cmap = i << 16;
    946   1.1        pk 		bt->bt_cmap = i << 24;
    947   1.1        pk 	}
    948   1.1        pk }
    949   1.1        pk 
    950   1.1        pk /*
    951   1.1        pk  * Load the cursor (overlay `foreground' and `background') colors.
    952   1.1        pk  */
    953   1.1        pk static void
    954   1.1        pk cg6_loadomap(sc)
    955   1.1        pk 	struct cgsix_softc *sc;
    956   1.1        pk {
    957   1.1        pk 	volatile struct bt_regs *bt;
    958   1.1        pk 	u_int i;
    959   1.1        pk 
    960   1.1        pk 	bt = sc->sc_bt;
    961   1.1        pk 	bt->bt_addr = 0x01 << 24;	/* set background color */
    962   1.1        pk 	i = sc->sc_cursor.cc_color.cm_chip[0];
    963   1.1        pk 	bt->bt_omap = i;		/* R */
    964   1.1        pk 	bt->bt_omap = i << 8;		/* G */
    965   1.1        pk 	bt->bt_omap = i << 16;		/* B */
    966   1.1        pk 
    967   1.1        pk 	bt->bt_addr = 0x03 << 24;	/* set foreground color */
    968   1.1        pk 	bt->bt_omap = i << 24;		/* R */
    969   1.1        pk 	i = sc->sc_cursor.cc_color.cm_chip[1];
    970   1.1        pk 	bt->bt_omap = i;		/* G */
    971   1.1        pk 	bt->bt_omap = i << 8;		/* B */
    972   1.1        pk }
    973   1.1        pk 
    974   1.1        pk static void
    975   1.1        pk cg6_unblank(dev)
    976   1.1        pk 	struct device *dev;
    977   1.1        pk {
    978   1.1        pk 	struct cgsix_softc *sc = (struct cgsix_softc *)dev;
    979   1.1        pk 
    980   1.1        pk 	if (sc->sc_blanked) {
    981   1.1        pk 		sc->sc_blanked = 0;
    982   1.1        pk 		sc->sc_thc->thc_misc |= THC_MISC_VIDEN;
    983   1.1        pk 	}
    984   1.1        pk }
    985   1.1        pk 
    986   1.1        pk /* XXX the following should be moved to a "user interface" header */
    987   1.1        pk /*
    988   1.1        pk  * Base addresses at which users can mmap() the various pieces of a cg6.
    989   1.1        pk  * Note that although the Brooktree color registers do not occupy 8K,
    990   1.1        pk  * the X server dies if we do not allow it to map 8K there (it just maps
    991   1.1        pk  * from 0x70000000 forwards, as a contiguous chunk).
    992   1.1        pk  */
    993   1.1        pk #define	CG6_USER_FBC	0x70000000
    994   1.1        pk #define	CG6_USER_TEC	0x70001000
    995   1.1        pk #define	CG6_USER_BTREGS	0x70002000
    996   1.1        pk #define	CG6_USER_FHC	0x70004000
    997   1.1        pk #define	CG6_USER_THC	0x70005000
    998   1.1        pk #define	CG6_USER_ROM	0x70006000
    999   1.1        pk #define	CG6_USER_RAM	0x70016000
   1000   1.1        pk #define	CG6_USER_DHC	0x80000000
   1001   1.1        pk 
   1002   1.1        pk struct mmo {
   1003   1.2       eeh 	u_long	mo_uaddr;	/* user (virtual) address */
   1004   1.2       eeh 	u_long	mo_size;	/* size, or 0 for video ram size */
   1005   1.2       eeh 	u_long	mo_physoff;	/* offset from sc_physadr */
   1006   1.1        pk };
   1007   1.1        pk 
   1008   1.1        pk /*
   1009   1.1        pk  * Return the address that would map the given device at the given
   1010   1.1        pk  * offset, allowing for the given protection, or return -1 for error.
   1011   1.1        pk  *
   1012   1.1        pk  * XXX	needs testing against `demanding' applications (e.g., aviator)
   1013   1.1        pk  */
   1014   1.1        pk paddr_t
   1015   1.1        pk cgsixmmap(dev, off, prot)
   1016   1.1        pk 	dev_t dev;
   1017   1.1        pk 	off_t off;
   1018   1.1        pk 	int prot;
   1019   1.1        pk {
   1020   1.1        pk 	struct cgsix_softc *sc = cgsix_cd.cd_devs[minor(dev)];
   1021   1.1        pk 	struct mmo *mo;
   1022   1.1        pk 	u_int u, sz;
   1023   1.1        pk 	static struct mmo mmo[] = {
   1024   1.1        pk 		{ CG6_USER_RAM, 0, CGSIX_RAM_OFFSET },
   1025   1.1        pk 
   1026   1.1        pk 		/* do not actually know how big most of these are! */
   1027   1.1        pk 		{ CG6_USER_FBC, 1, CGSIX_FBC_OFFSET },
   1028   1.1        pk 		{ CG6_USER_TEC, 1, CGSIX_TEC_OFFSET },
   1029   1.1        pk 		{ CG6_USER_BTREGS, 8192 /* XXX */, CGSIX_BT_OFFSET },
   1030   1.1        pk 		{ CG6_USER_FHC, 1, CGSIX_FHC_OFFSET },
   1031   1.1        pk 		{ CG6_USER_THC, sizeof(struct cg6_thc), CGSIX_THC_OFFSET },
   1032   1.1        pk 		{ CG6_USER_ROM, 65536, CGSIX_ROM_OFFSET },
   1033   1.1        pk 		{ CG6_USER_DHC, 1, CGSIX_DHC_OFFSET },
   1034   1.1        pk 	};
   1035   1.1        pk #define NMMO (sizeof mmo / sizeof *mmo)
   1036   1.1        pk 
   1037   1.1        pk 	if (off & PGOFSET)
   1038   1.1        pk 		panic("cgsixmmap");
   1039   1.1        pk 
   1040   1.1        pk 	/*
   1041   1.1        pk 	 * Entries with size 0 map video RAM (i.e., the size in fb data).
   1042   1.1        pk 	 *
   1043   1.1        pk 	 * Since we work in pages, the fact that the map offset table's
   1044   1.1        pk 	 * sizes are sometimes bizarre (e.g., 1) is effectively ignored:
   1045   1.1        pk 	 * one byte is as good as one page.
   1046   1.1        pk 	 */
   1047   1.1        pk 	for (mo = mmo; mo < &mmo[NMMO]; mo++) {
   1048   1.2       eeh 		if ((u_long)off < mo->mo_uaddr)
   1049   1.1        pk 			continue;
   1050   1.1        pk 		u = off - mo->mo_uaddr;
   1051   1.1        pk 		sz = mo->mo_size ? mo->mo_size : sc->sc_fb.fb_type.fb_size;
   1052   1.1        pk 		if (u < sz) {
   1053   1.6       eeh 			return (bus_space_mmap(sc->sc_bustag,
   1054   1.6       eeh 				sc->sc_paddr, u+mo->mo_physoff,
   1055   1.6       eeh 				prot, BUS_SPACE_MAP_LINEAR));
   1056   1.1        pk 		}
   1057   1.1        pk 	}
   1058   1.1        pk 
   1059   1.1        pk #ifdef DEBUG
   1060   1.1        pk 	{
   1061  1.10   thorpej 	  struct proc *p = curlwp->l_proc;	/* XXX */
   1062   1.4       chs 	  log(LOG_NOTICE, "cgsixmmap(0x%llx) (%s[%d])\n",
   1063   1.4       chs 		(long long)off, p->p_comm, p->p_pid);
   1064   1.1        pk 	}
   1065   1.1        pk #endif
   1066   1.1        pk 	return (-1);	/* not a user-map offset */
   1067   1.1        pk }
   1068  1.18    martin 
   1069  1.18    martin /* dummies for multiple screen handling */
   1070  1.18    martin int
   1071  1.18    martin cgsix_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
   1072  1.18    martin 	void *v;
   1073  1.18    martin 	const struct wsscreen_descr *type;
   1074  1.18    martin 	void **cookiep;
   1075  1.18    martin 	int *curxp, *curyp;
   1076  1.18    martin 	long *attrp;
   1077  1.18    martin {
   1078  1.18    martin 	/*struct cg6_softc *sc = v;
   1079  1.18    martin 	struct rasops_info *ri = &sc->sc_dc->dc_ri;
   1080  1.18    martin 	long defattr;*/
   1081  1.18    martin 
   1082  1.18    martin 	return (ENOMEM);
   1083  1.18    martin }
   1084  1.18    martin 
   1085  1.18    martin void
   1086  1.18    martin cgsix_free_screen(v, cookie)
   1087  1.18    martin 	void *v;
   1088  1.18    martin 	void *cookie;
   1089  1.18    martin {
   1090  1.18    martin 	/*struct cg6_softc *sc = v;*/
   1091  1.18    martin }
   1092  1.18    martin 
   1093  1.18    martin int
   1094  1.18    martin cgsix_show_screen(v, cookie, waitok, cb, cbarg)
   1095  1.18    martin 	void *v;
   1096  1.18    martin 	void *cookie;
   1097  1.18    martin 	int waitok;
   1098  1.18    martin 	void (*cb) __P((void *, int, int));
   1099  1.18    martin 	void *cbarg;
   1100  1.18    martin {
   1101  1.18    martin 
   1102  1.18    martin 	return (0);
   1103  1.18    martin }
   1104  1.18    martin 
   1105  1.18    martin int
   1106  1.18    martin cgsix_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
   1107  1.18    martin {
   1108  1.18    martin 	/* we'll probably need to add more stuff here */
   1109  1.18    martin 	struct cgsix_softc *sc = v;
   1110  1.18    martin 	struct wsdisplay_fbinfo *wdf;
   1111  1.18    martin 	struct rasops_info *ri = &sc->sc_fb.fb_rinfo;
   1112  1.18    martin #ifdef CGSIX_DEBUG
   1113  1.18    martin 	printf("cgsix_ioctl(%ld)\n",cmd);
   1114  1.18    martin #endif
   1115  1.18    martin 	switch (cmd) {
   1116  1.18    martin 		case WSDISPLAYIO_GTYPE:
   1117  1.18    martin 			*(u_int *)data = WSDISPLAY_TYPE_SUNTCX;
   1118  1.18    martin 			return 0;
   1119  1.18    martin 		case WSDISPLAYIO_GINFO:
   1120  1.18    martin 			wdf = (void *)data;
   1121  1.18    martin 			wdf->height = ri->ri_height;
   1122  1.18    martin 			wdf->width = ri->ri_width;
   1123  1.18    martin 			wdf->depth = ri->ri_depth;
   1124  1.18    martin 			wdf->cmsize = 256;
   1125  1.18    martin 			return 0;
   1126  1.18    martin 
   1127  1.18    martin 		case WSDISPLAYIO_GETCMAP:
   1128  1.18    martin 			return cgsix_getcmap(sc, (struct wsdisplay_cmap *)data);
   1129  1.18    martin 		case WSDISPLAYIO_PUTCMAP:
   1130  1.18    martin 			return cgsix_putcmap(sc, (struct wsdisplay_cmap *)data);
   1131  1.18    martin 
   1132  1.18    martin #ifdef notyet
   1133  1.18    martin 		case WSDISPLAYIO_SMODE:
   1134  1.18    martin 			{
   1135  1.18    martin 				int new_mode=*(int*)data;
   1136  1.18    martin 				if(new_mode!=sc->sc_mode)
   1137  1.18    martin 				{
   1138  1.18    martin 					sc->sc_mode=new_mode;
   1139  1.18    martin 					if(new_mode==WSDISPLAYIO_MODE_EMUL)
   1140  1.18    martin 					{
   1141  1.18    martin 						/* we'll probably want to reset the console into a known state here
   1142  1.18    martin 						   just in case the Xserver crashed or didn't properly clean up after
   1143  1.18    martin 						   itself for whetever reason */
   1144  1.18    martin 					}
   1145  1.18    martin 				}
   1146  1.18    martin 			}
   1147  1.18    martin #endif
   1148  1.18    martin 	}
   1149  1.18    martin 	return EPASSTHROUGH;
   1150  1.18    martin }
   1151  1.18    martin 
   1152  1.18    martin paddr_t
   1153  1.18    martin cgsix_mmap(void *v, off_t offset, int prot)
   1154  1.18    martin {
   1155  1.18    martin 	struct cgsix_softc *sc = v;
   1156  1.18    martin 	/* how do I get the real RAM size? */
   1157  1.18    martin 	int ramsize=sc->sc_fb.fb_type.fb_height * sc->sc_fb.fb_linebytes;
   1158  1.18    martin 	if(offset<ramsize) {
   1159  1.18    martin 		return bus_space_mmap(sc->sc_bustag,sc->sc_paddr,CGSIX_RAM_OFFSET+offset,prot,BUS_SPACE_MAP_LINEAR);
   1160  1.18    martin 	}
   1161  1.18    martin 	/* I'm not at all sure this is the right thing to do */
   1162  1.18    martin 	return cgsixmmap(0,offset,prot); /* assume we're minor dev 0 for now */
   1163  1.18    martin }
   1164  1.18    martin 
   1165  1.18    martin int
   1166  1.18    martin cgsix_putcmap(struct cgsix_softc *sc, struct wsdisplay_cmap *cm)
   1167  1.18    martin {
   1168  1.18    martin 	u_int index = cm->index;
   1169  1.18    martin 	u_int count = cm->count;
   1170  1.18    martin 	int error,i;
   1171  1.18    martin 
   1172  1.18    martin 	if (index >= 256 || count > 256 || index + count > 256)
   1173  1.18    martin 		return EINVAL;
   1174  1.18    martin 
   1175  1.18    martin 	for(i=0;i<count;i++)
   1176  1.18    martin 	{
   1177  1.18    martin 		error = copyin(&cm->red[i], &sc->sc_cmap.cm_map[index+i][0], 1);
   1178  1.18    martin 		if (error)
   1179  1.18    martin 			return error;
   1180  1.18    martin 		error = copyin(&cm->green[i], &sc->sc_cmap.cm_map[index+i][1], 1);
   1181  1.18    martin 		if (error)
   1182  1.18    martin 			return error;
   1183  1.18    martin 		error = copyin(&cm->blue[i], &sc->sc_cmap.cm_map[index+i][2], 1);
   1184  1.18    martin 		if (error)
   1185  1.18    martin 			return error;
   1186  1.18    martin 	}
   1187  1.18    martin 	cg6_loadcmap(sc,index,count);
   1188  1.18    martin 
   1189  1.18    martin 	return 0;
   1190  1.18    martin }
   1191  1.18    martin 
   1192  1.18    martin int cgsix_getcmap(struct cgsix_softc *sc, struct wsdisplay_cmap *cm)
   1193  1.18    martin {
   1194  1.18    martin 	u_int index = cm->index;
   1195  1.18    martin 	u_int count = cm->count;
   1196  1.18    martin 	int error,i;
   1197  1.18    martin 
   1198  1.18    martin 	if (index >= 256 || count > 256 || index + count > 256)
   1199  1.18    martin 		return EINVAL;
   1200  1.18    martin 
   1201  1.18    martin 	for(i=0;i<count;i++)
   1202  1.18    martin 	{
   1203  1.18    martin 		error = copyout(&sc->sc_cmap.cm_map[index+i][0],   &cm->red[i],1);
   1204  1.18    martin 		if (error)
   1205  1.18    martin 			return error;
   1206  1.18    martin 		error = copyout(&sc->sc_cmap.cm_map[index+i][1],   &cm->green[i],1);
   1207  1.18    martin 		if (error)
   1208  1.18    martin 			return error;
   1209  1.18    martin 		error = copyout(&sc->sc_cmap.cm_map[index+i][2],   &cm->blue[i],1);
   1210  1.18    martin 		if (error)
   1211  1.18    martin 			return error;
   1212  1.18    martin 	}
   1213  1.18    martin 
   1214  1.18    martin 	return 0;
   1215  1.18    martin }
   1216