Home | History | Annotate | Line # | Download | only in tc
cfb.c revision 1.44
      1  1.44  nisimura /* $NetBSD: cfb.c,v 1.44 2003/12/20 07:10:00 nisimura Exp $ */
      2   1.2  nisimura 
      3   1.2  nisimura /*
      4  1.12  nisimura  * Copyright (c) 1998, 1999 Tohru Nishimura.  All rights reserved.
      5   1.2  nisimura  *
      6   1.2  nisimura  * Redistribution and use in source and binary forms, with or without
      7   1.2  nisimura  * modification, are permitted provided that the following conditions
      8   1.2  nisimura  * are met:
      9   1.2  nisimura  * 1. Redistributions of source code must retain the above copyright
     10   1.2  nisimura  *    notice, this list of conditions and the following disclaimer.
     11   1.2  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.2  nisimura  *    notice, this list of conditions and the following disclaimer in the
     13   1.2  nisimura  *    documentation and/or other materials provided with the distribution.
     14   1.2  nisimura  * 3. All advertising materials mentioning features or use of this software
     15   1.2  nisimura  *    must display the following acknowledgement:
     16   1.2  nisimura  *      This product includes software developed by Tohru Nishimura
     17   1.2  nisimura  *	for the NetBSD Project.
     18   1.2  nisimura  * 4. The name of the author may not be used to endorse or promote products
     19   1.2  nisimura  *    derived from this software without specific prior written permission
     20   1.2  nisimura  *
     21   1.2  nisimura  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22   1.2  nisimura  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23   1.2  nisimura  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24   1.2  nisimura  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25   1.2  nisimura  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26   1.2  nisimura  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27   1.2  nisimura  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28   1.2  nisimura  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29   1.2  nisimura  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30   1.2  nisimura  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31   1.2  nisimura  */
     32   1.1  nisimura 
     33  1.30     lukem #include <sys/cdefs.h>
     34  1.44  nisimura __KERNEL_RCSID(0, "$NetBSD: cfb.c,v 1.44 2003/12/20 07:10:00 nisimura Exp $");
     35   1.1  nisimura 
     36   1.1  nisimura #include <sys/param.h>
     37   1.1  nisimura #include <sys/systm.h>
     38   1.1  nisimura #include <sys/kernel.h>
     39   1.1  nisimura #include <sys/device.h>
     40   1.1  nisimura #include <sys/malloc.h>
     41   1.1  nisimura #include <sys/buf.h>
     42   1.1  nisimura #include <sys/ioctl.h>
     43   1.1  nisimura 
     44   1.1  nisimura #include <machine/bus.h>
     45   1.1  nisimura #include <machine/intr.h>
     46   1.1  nisimura 
     47   1.1  nisimura #include <dev/wscons/wsconsio.h>
     48   1.1  nisimura #include <dev/wscons/wsdisplayvar.h>
     49   1.1  nisimura 
     50  1.18  nisimura #include <dev/rasops/rasops.h>
     51  1.18  nisimura #include <dev/wsfont/wsfont.h>
     52  1.18  nisimura 
     53   1.1  nisimura #include <dev/tc/tcvar.h>
     54   1.1  nisimura #include <dev/ic/bt459reg.h>
     55   1.1  nisimura 
     56   1.1  nisimura #include <uvm/uvm_extern.h>
     57   1.1  nisimura 
     58   1.7   thorpej #if defined(pmax)
     59  1.29  nisimura #define	machine_btop(x) mips_btop(MIPS_KSEG1_TO_PHYS(x))
     60   1.1  nisimura #endif
     61   1.1  nisimura 
     62  1.26  nisimura #if defined(alpha)
     63  1.29  nisimura #define	machine_btop(x) alpha_btop(ALPHA_K0SEG_TO_PHYS(x))
     64   1.1  nisimura #endif
     65   1.1  nisimura 
     66   1.1  nisimura /*
     67   1.1  nisimura  * N.B., Bt459 registers are 8bit width.  Some of TC framebuffers have
     68   1.3  nisimura  * obscure register layout such as 2nd and 3rd Bt459 registers are
     69   1.3  nisimura  * adjacent each other in a word, i.e.,
     70   1.1  nisimura  *	struct bt459triplet {
     71   1.1  nisimura  * 		struct {
     72   1.1  nisimura  *			u_int8_t u0;
     73   1.1  nisimura  *			u_int8_t u1;
     74   1.1  nisimura  *			u_int8_t u2;
     75  1.29  nisimura  *			unsigned :8;
     76   1.1  nisimura  *		} bt_lo;
     77   1.1  nisimura  *		...
     78   1.1  nisimura  * Although CX has single Bt459, 32bit R/W can be done w/o any trouble.
     79  1.26  nisimura  *	struct bt459reg {
     80  1.26  nisimura  *		   u_int32_t	   bt_lo;
     81  1.26  nisimura  *		   u_int32_t	   bt_hi;
     82  1.26  nisimura  *		   u_int32_t	   bt_reg;
     83  1.26  nisimura  *		   u_int32_t	   bt_cmap;
     84  1.26  nisimura  *	};
     85   1.1  nisimura  */
     86   1.2  nisimura 
     87  1.44  nisimura /* Bt459 hardware registers, memory-mapped in 32bit stride */
     88  1.44  nisimura #define	bt_lo	0x0
     89  1.44  nisimura #define	bt_hi	0x4
     90  1.44  nisimura #define	bt_reg	0x8
     91  1.44  nisimura #define	bt_cmap 0xc
     92  1.44  nisimura 
     93  1.44  nisimura #define	REGWRITE32(p,i,v) do {					\
     94  1.44  nisimura 	*(volatile u_int32_t *)((p) + (i)) = (v); tc_wmb();	\
     95  1.44  nisimura     } while (0)
     96  1.44  nisimura #define	VDACSELECT(p,r) do {					\
     97  1.44  nisimura 	REGWRITE32(p, bt_lo, 0xff & (r));			\
     98  1.44  nisimura 	REGWRITE32(p, bt_hi, 0x0f & ((r)>>8));			\
     99  1.12  nisimura    } while (0)
    100   1.1  nisimura 
    101  1.11  nisimura struct hwcmap256 {
    102   1.1  nisimura #define	CMAP_SIZE	256	/* 256 R/G/B entries */
    103   1.1  nisimura 	u_int8_t r[CMAP_SIZE];
    104   1.1  nisimura 	u_int8_t g[CMAP_SIZE];
    105   1.1  nisimura 	u_int8_t b[CMAP_SIZE];
    106   1.1  nisimura };
    107   1.1  nisimura 
    108  1.11  nisimura struct hwcursor64 {
    109   1.1  nisimura 	struct wsdisplay_curpos cc_pos;
    110   1.1  nisimura 	struct wsdisplay_curpos cc_hot;
    111   1.1  nisimura 	struct wsdisplay_curpos cc_size;
    112  1.11  nisimura 	struct wsdisplay_curpos cc_magic;
    113   1.1  nisimura #define	CURSOR_MAX_SIZE	64
    114   1.1  nisimura 	u_int8_t cc_color[6];
    115  1.42       chs 	u_int64_t cc_image[CURSOR_MAX_SIZE];
    116  1.42       chs 	u_int64_t cc_mask[CURSOR_MAX_SIZE];
    117   1.1  nisimura };
    118   1.1  nisimura 
    119   1.1  nisimura struct cfb_softc {
    120   1.1  nisimura 	struct device sc_dev;
    121  1.29  nisimura 	vaddr_t sc_vaddr;
    122  1.29  nisimura 	size_t sc_size;
    123  1.29  nisimura 	struct rasops_info *sc_ri;
    124  1.11  nisimura 	struct hwcmap256 sc_cmap;	/* software copy of colormap */
    125  1.11  nisimura 	struct hwcursor64 sc_cursor;	/* software copy of cursor */
    126  1.29  nisimura 	int sc_blanked;
    127   1.1  nisimura 	int sc_curenb;			/* cursor sprite enabled */
    128  1.26  nisimura 	int sc_changed;			/* need update of hardware */
    129  1.26  nisimura #define	WSDISPLAY_CMAP_DOLUT	0x20
    130   1.1  nisimura 	int nscreens;
    131  1.11  nisimura };
    132  1.11  nisimura 
    133  1.12  nisimura #define	CX_MAGIC_X	220
    134  1.12  nisimura #define	CX_MAGIC_Y 	35
    135   1.1  nisimura 
    136   1.3  nisimura #define	CX_FB_OFFSET	0x000000
    137   1.3  nisimura #define	CX_FB_SIZE	0x100000
    138   1.3  nisimura #define	CX_BT459_OFFSET	0x200000
    139   1.3  nisimura #define	CX_OFFSET_IREQ	0x300000	/* Interrupt req. control */
    140   1.3  nisimura 
    141  1.44  nisimura static int  cfbmatch(struct device *, struct cfdata *, void *);
    142  1.44  nisimura static void cfbattach(struct device *, struct device *, void *);
    143   1.1  nisimura 
    144  1.37   thorpej CFATTACH_DECL(cfb, sizeof(struct cfb_softc),
    145  1.38   thorpej     cfbmatch, cfbattach, NULL, NULL);
    146   1.1  nisimura 
    147  1.44  nisimura static void cfb_common_init(struct rasops_info *);
    148  1.29  nisimura static struct rasops_info cfb_console_ri;
    149  1.14  nisimura static tc_addr_t cfb_consaddr;
    150   1.1  nisimura 
    151  1.14  nisimura static struct wsscreen_descr cfb_stdscreen = {
    152   1.1  nisimura 	"std", 0, 0,
    153  1.18  nisimura 	0, /* textops */
    154   1.1  nisimura 	0, 0,
    155  1.13  nisimura 	WSSCREEN_REVERSE
    156   1.1  nisimura };
    157   1.1  nisimura 
    158  1.14  nisimura static const struct wsscreen_descr *_cfb_scrlist[] = {
    159   1.1  nisimura 	&cfb_stdscreen,
    160   1.1  nisimura };
    161   1.1  nisimura 
    162  1.14  nisimura static const struct wsscreen_list cfb_screenlist = {
    163   1.1  nisimura 	sizeof(_cfb_scrlist) / sizeof(struct wsscreen_descr *), _cfb_scrlist
    164   1.1  nisimura };
    165   1.1  nisimura 
    166  1.44  nisimura static int	cfbioctl(void *, u_long, caddr_t, int, struct proc *);
    167  1.44  nisimura static paddr_t	cfbmmap(void *, off_t, int);
    168   1.1  nisimura 
    169  1.44  nisimura static int	cfb_alloc_screen(void *, const struct wsscreen_descr *,
    170  1.44  nisimura 				      void **, int *, int *, long *);
    171  1.44  nisimura static void	cfb_free_screen(void *, void *);
    172  1.44  nisimura static int	cfb_show_screen(void *, void *, int,
    173  1.44  nisimura 				     void (*) (void *, int, int), void *);
    174   1.1  nisimura 
    175  1.14  nisimura static const struct wsdisplay_accessops cfb_accessops = {
    176   1.1  nisimura 	cfbioctl,
    177   1.1  nisimura 	cfbmmap,
    178   1.1  nisimura 	cfb_alloc_screen,
    179   1.1  nisimura 	cfb_free_screen,
    180   1.1  nisimura 	cfb_show_screen,
    181   1.6  drochner 	0 /* load_font */
    182   1.1  nisimura };
    183   1.1  nisimura 
    184  1.44  nisimura int  cfb_cnattach(tc_addr_t);
    185  1.44  nisimura static int  cfbintr(void *);
    186  1.44  nisimura static void cfbhwinit(caddr_t);
    187  1.44  nisimura static void cfb_cmap_init(struct cfb_softc *);
    188  1.44  nisimura 
    189  1.44  nisimura static int  get_cmap(struct cfb_softc *, struct wsdisplay_cmap *);
    190  1.44  nisimura static int  set_cmap(struct cfb_softc *, struct wsdisplay_cmap *);
    191  1.44  nisimura static int  set_cursor(struct cfb_softc *, struct wsdisplay_cursor *);
    192  1.44  nisimura static int  get_cursor(struct cfb_softc *, struct wsdisplay_cursor *);
    193  1.44  nisimura static void set_curpos(struct cfb_softc *, struct wsdisplay_curpos *);
    194   1.1  nisimura 
    195   1.3  nisimura /*
    196   1.3  nisimura  * Compose 2 bit/pixel cursor image.  Bit order will be reversed.
    197   1.3  nisimura  *   M M M M I I I I		M I M I M I M I
    198   1.3  nisimura  *	[ before ]		   [ after ]
    199   1.3  nisimura  *   3 2 1 0 3 2 1 0		0 0 1 1 2 2 3 3
    200   1.3  nisimura  *   7 6 5 4 7 6 5 4		4 4 5 5 6 6 7 7
    201   1.3  nisimura  */
    202  1.14  nisimura static const u_int8_t shuffle[256] = {
    203   1.3  nisimura 	0x00, 0x40, 0x10, 0x50, 0x04, 0x44, 0x14, 0x54,
    204   1.3  nisimura 	0x01, 0x41, 0x11, 0x51, 0x05, 0x45, 0x15, 0x55,
    205   1.3  nisimura 	0x80, 0xc0, 0x90, 0xd0, 0x84, 0xc4, 0x94, 0xd4,
    206   1.3  nisimura 	0x81, 0xc1, 0x91, 0xd1, 0x85, 0xc5, 0x95, 0xd5,
    207   1.3  nisimura 	0x20, 0x60, 0x30, 0x70, 0x24, 0x64, 0x34, 0x74,
    208   1.3  nisimura 	0x21, 0x61, 0x31, 0x71, 0x25, 0x65, 0x35, 0x75,
    209   1.3  nisimura 	0xa0, 0xe0, 0xb0, 0xf0, 0xa4, 0xe4, 0xb4, 0xf4,
    210   1.3  nisimura 	0xa1, 0xe1, 0xb1, 0xf1, 0xa5, 0xe5, 0xb5, 0xf5,
    211   1.3  nisimura 	0x08, 0x48, 0x18, 0x58, 0x0c, 0x4c, 0x1c, 0x5c,
    212   1.3  nisimura 	0x09, 0x49, 0x19, 0x59, 0x0d, 0x4d, 0x1d, 0x5d,
    213   1.3  nisimura 	0x88, 0xc8, 0x98, 0xd8, 0x8c, 0xcc, 0x9c, 0xdc,
    214   1.3  nisimura 	0x89, 0xc9, 0x99, 0xd9, 0x8d, 0xcd, 0x9d, 0xdd,
    215   1.3  nisimura 	0x28, 0x68, 0x38, 0x78, 0x2c, 0x6c, 0x3c, 0x7c,
    216   1.3  nisimura 	0x29, 0x69, 0x39, 0x79, 0x2d, 0x6d, 0x3d, 0x7d,
    217   1.3  nisimura 	0xa8, 0xe8, 0xb8, 0xf8, 0xac, 0xec, 0xbc, 0xfc,
    218   1.3  nisimura 	0xa9, 0xe9, 0xb9, 0xf9, 0xad, 0xed, 0xbd, 0xfd,
    219   1.3  nisimura 	0x02, 0x42, 0x12, 0x52, 0x06, 0x46, 0x16, 0x56,
    220   1.3  nisimura 	0x03, 0x43, 0x13, 0x53, 0x07, 0x47, 0x17, 0x57,
    221   1.3  nisimura 	0x82, 0xc2, 0x92, 0xd2, 0x86, 0xc6, 0x96, 0xd6,
    222   1.3  nisimura 	0x83, 0xc3, 0x93, 0xd3, 0x87, 0xc7, 0x97, 0xd7,
    223   1.3  nisimura 	0x22, 0x62, 0x32, 0x72, 0x26, 0x66, 0x36, 0x76,
    224   1.3  nisimura 	0x23, 0x63, 0x33, 0x73, 0x27, 0x67, 0x37, 0x77,
    225   1.3  nisimura 	0xa2, 0xe2, 0xb2, 0xf2, 0xa6, 0xe6, 0xb6, 0xf6,
    226   1.3  nisimura 	0xa3, 0xe3, 0xb3, 0xf3, 0xa7, 0xe7, 0xb7, 0xf7,
    227   1.3  nisimura 	0x0a, 0x4a, 0x1a, 0x5a, 0x0e, 0x4e, 0x1e, 0x5e,
    228   1.3  nisimura 	0x0b, 0x4b, 0x1b, 0x5b, 0x0f, 0x4f, 0x1f, 0x5f,
    229   1.3  nisimura 	0x8a, 0xca, 0x9a, 0xda, 0x8e, 0xce, 0x9e, 0xde,
    230   1.3  nisimura 	0x8b, 0xcb, 0x9b, 0xdb, 0x8f, 0xcf, 0x9f, 0xdf,
    231   1.3  nisimura 	0x2a, 0x6a, 0x3a, 0x7a, 0x2e, 0x6e, 0x3e, 0x7e,
    232   1.3  nisimura 	0x2b, 0x6b, 0x3b, 0x7b, 0x2f, 0x6f, 0x3f, 0x7f,
    233   1.3  nisimura 	0xaa, 0xea, 0xba, 0xfa, 0xae, 0xee, 0xbe, 0xfe,
    234   1.3  nisimura 	0xab, 0xeb, 0xbb, 0xfb, 0xaf, 0xef, 0xbf, 0xff,
    235   1.3  nisimura };
    236   1.1  nisimura 
    237  1.14  nisimura static int
    238   1.1  nisimura cfbmatch(parent, match, aux)
    239   1.1  nisimura 	struct device *parent;
    240   1.1  nisimura 	struct cfdata *match;
    241   1.1  nisimura 	void *aux;
    242   1.1  nisimura {
    243   1.1  nisimura 	struct tc_attach_args *ta = aux;
    244   1.1  nisimura 
    245   1.1  nisimura 	if (strncmp("PMAG-BA ", ta->ta_modname, TC_ROM_LLEN) != 0)
    246   1.1  nisimura 		return (0);
    247   1.1  nisimura 
    248   1.1  nisimura 	return (1);
    249   1.1  nisimura }
    250   1.1  nisimura 
    251  1.14  nisimura static void
    252   1.1  nisimura cfbattach(parent, self, aux)
    253   1.1  nisimura 	struct device *parent, *self;
    254   1.1  nisimura 	void *aux;
    255   1.1  nisimura {
    256   1.1  nisimura 	struct cfb_softc *sc = (struct cfb_softc *)self;
    257   1.1  nisimura 	struct tc_attach_args *ta = aux;
    258  1.29  nisimura 	struct rasops_info *ri;
    259   1.1  nisimura 	struct wsemuldisplaydev_attach_args waa;
    260  1.43        ad 	int console;
    261   1.1  nisimura 
    262   1.1  nisimura 	console = (ta->ta_addr == cfb_consaddr);
    263   1.1  nisimura 	if (console) {
    264  1.29  nisimura 		sc->sc_ri = ri = &cfb_console_ri;
    265   1.1  nisimura 		sc->nscreens = 1;
    266   1.1  nisimura 	}
    267   1.1  nisimura 	else {
    268  1.29  nisimura 		MALLOC(ri, struct rasops_info *, sizeof(struct rasops_info),
    269  1.29  nisimura 			M_DEVBUF, M_NOWAIT);
    270  1.29  nisimura 		if (ri == NULL) {
    271  1.29  nisimura 			printf(": can't alloc memory\n");
    272  1.29  nisimura 			return;
    273  1.29  nisimura 		}
    274  1.29  nisimura 		memset(ri, 0, sizeof(struct rasops_info));
    275  1.29  nisimura 
    276  1.29  nisimura 		ri->ri_hw = (void *)ta->ta_addr;
    277  1.29  nisimura 		cfb_common_init(ri);
    278  1.29  nisimura 		sc->sc_ri = ri;
    279   1.1  nisimura 	}
    280  1.29  nisimura 	printf(": %dx%d, %dbpp\n", ri->ri_width, ri->ri_height, ri->ri_depth);
    281   1.1  nisimura 
    282  1.43        ad 	cfb_cmap_init(sc);
    283  1.11  nisimura 
    284  1.29  nisimura 	sc->sc_vaddr = ta->ta_addr;
    285  1.11  nisimura 	sc->sc_cursor.cc_magic.x = CX_MAGIC_X;
    286  1.11  nisimura 	sc->sc_cursor.cc_magic.y = CX_MAGIC_Y;
    287  1.29  nisimura 	sc->sc_blanked = sc->sc_curenb = 0;
    288   1.1  nisimura 
    289  1.14  nisimura 	tc_intr_establish(parent, ta->ta_cookie, IPL_TTY, cfbintr, sc);
    290  1.29  nisimura 
    291  1.29  nisimura 	/* clear any pending interrupts */
    292  1.44  nisimura 	*(volatile u_int8_t *)((caddr_t)ri->ri_hw + CX_OFFSET_IREQ) = 0;
    293   1.1  nisimura 
    294   1.1  nisimura 	waa.console = console;
    295   1.1  nisimura 	waa.scrdata = &cfb_screenlist;
    296   1.1  nisimura 	waa.accessops = &cfb_accessops;
    297   1.1  nisimura 	waa.accesscookie = sc;
    298   1.1  nisimura 
    299   1.1  nisimura 	config_found(self, &waa, wsemuldisplaydevprint);
    300   1.1  nisimura }
    301   1.1  nisimura 
    302  1.29  nisimura static void
    303  1.43        ad cfb_cmap_init(sc)
    304  1.43        ad 	struct cfb_softc *sc;
    305  1.43        ad {
    306  1.43        ad 	struct hwcmap256 *cm;
    307  1.43        ad 	const u_int8_t *p;
    308  1.43        ad 	int index;
    309  1.43        ad 
    310  1.43        ad 	cm = &sc->sc_cmap;
    311  1.43        ad 	p = rasops_cmap;
    312  1.43        ad 	for (index = 0; index < CMAP_SIZE; index++, p += 3) {
    313  1.43        ad 		cm->r[index] = p[0];
    314  1.43        ad 		cm->g[index] = p[1];
    315  1.43        ad 		cm->b[index] = p[2];
    316  1.43        ad 	}
    317  1.43        ad }
    318  1.43        ad 
    319  1.43        ad static void
    320  1.29  nisimura cfb_common_init(ri)
    321  1.29  nisimura 	struct rasops_info *ri;
    322  1.29  nisimura {
    323  1.29  nisimura 	caddr_t base;
    324  1.29  nisimura 	int cookie;
    325  1.29  nisimura 
    326  1.29  nisimura 	base = (caddr_t)ri->ri_hw;
    327  1.29  nisimura 
    328  1.29  nisimura 	/* initialize colormap and cursor hardware */
    329  1.29  nisimura 	cfbhwinit(base);
    330  1.29  nisimura 
    331  1.29  nisimura 	ri->ri_flg = RI_CENTER;
    332  1.29  nisimura 	ri->ri_depth = 8;
    333  1.29  nisimura 	ri->ri_width = 1024;
    334  1.29  nisimura 	ri->ri_height = 864;
    335  1.29  nisimura 	ri->ri_stride = 1024;
    336  1.29  nisimura 	ri->ri_bits = base + CX_FB_OFFSET;
    337  1.29  nisimura 
    338  1.29  nisimura 	/* clear the screen */
    339  1.29  nisimura 	memset(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
    340  1.29  nisimura 
    341  1.29  nisimura 	wsfont_init();
    342  1.29  nisimura 	/* prefer 12 pixel wide font */
    343  1.31        ad 	cookie = wsfont_find(NULL, 12, 0, 0, WSDISPLAY_FONTORDER_L2R,
    344  1.31        ad 	    WSDISPLAY_FONTORDER_L2R);
    345  1.31        ad 	if (cookie <= 0)
    346  1.31        ad 		cookie = wsfont_find(NULL, 0, 0, 0, WSDISPLAY_FONTORDER_L2R,
    347  1.31        ad 		    WSDISPLAY_FONTORDER_L2R);
    348  1.29  nisimura 	if (cookie <= 0) {
    349  1.29  nisimura 		printf("cfb: font table is empty\n");
    350  1.29  nisimura 		return;
    351  1.29  nisimura 	}
    352  1.29  nisimura 
    353  1.31        ad 	if (wsfont_lock(cookie, &ri->ri_font)) {
    354  1.29  nisimura 		printf("cfb: couldn't lock font\n");
    355  1.29  nisimura 		return;
    356  1.29  nisimura 	}
    357  1.29  nisimura 	ri->ri_wsfcookie = cookie;
    358  1.29  nisimura 
    359  1.29  nisimura 	rasops_init(ri, 34, 80);
    360  1.29  nisimura 
    361  1.29  nisimura 	/* XXX shouldn't be global */
    362  1.29  nisimura 	cfb_stdscreen.nrows = ri->ri_rows;
    363  1.29  nisimura 	cfb_stdscreen.ncols = ri->ri_cols;
    364  1.29  nisimura 	cfb_stdscreen.textops = &ri->ri_ops;
    365  1.29  nisimura 	cfb_stdscreen.capabilities = ri->ri_caps;
    366  1.29  nisimura }
    367  1.29  nisimura 
    368  1.14  nisimura static int
    369  1.40      fvdl cfbioctl(v, cmd, data, flag, p)
    370   1.1  nisimura 	void *v;
    371   1.1  nisimura 	u_long cmd;
    372   1.1  nisimura 	caddr_t data;
    373   1.1  nisimura 	int flag;
    374  1.40      fvdl 	struct proc *p;
    375   1.1  nisimura {
    376   1.1  nisimura 	struct cfb_softc *sc = v;
    377  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    378  1.43        ad 	int turnoff, s;
    379   1.1  nisimura 
    380   1.1  nisimura 	switch (cmd) {
    381   1.1  nisimura 	case WSDISPLAYIO_GTYPE:
    382   1.1  nisimura 		*(u_int *)data = WSDISPLAY_TYPE_CFB;
    383   1.1  nisimura 		return (0);
    384   1.1  nisimura 
    385   1.1  nisimura 	case WSDISPLAYIO_GINFO:
    386   1.1  nisimura #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    387  1.29  nisimura 		wsd_fbip->height = ri->ri_height;
    388  1.29  nisimura 		wsd_fbip->width = ri->ri_width;
    389  1.29  nisimura 		wsd_fbip->depth = ri->ri_depth;
    390   1.1  nisimura 		wsd_fbip->cmsize = CMAP_SIZE;
    391   1.1  nisimura #undef fbt
    392   1.1  nisimura 		return (0);
    393   1.1  nisimura 
    394   1.1  nisimura 	case WSDISPLAYIO_GETCMAP:
    395   1.1  nisimura 		return get_cmap(sc, (struct wsdisplay_cmap *)data);
    396   1.1  nisimura 
    397   1.1  nisimura 	case WSDISPLAYIO_PUTCMAP:
    398   1.1  nisimura 		return set_cmap(sc, (struct wsdisplay_cmap *)data);
    399   1.1  nisimura 
    400   1.1  nisimura 	case WSDISPLAYIO_SVIDEO:
    401   1.1  nisimura 		turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
    402  1.29  nisimura 		if ((sc->sc_blanked == 0) ^ turnoff) {
    403  1.29  nisimura 			sc->sc_blanked = turnoff;
    404   1.3  nisimura 			/* XXX later XXX */
    405   1.1  nisimura 		}
    406   1.1  nisimura 		return (0);
    407   1.1  nisimura 
    408   1.1  nisimura 	case WSDISPLAYIO_GVIDEO:
    409  1.29  nisimura 		*(u_int *)data = sc->sc_blanked ?
    410   1.1  nisimura 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
    411   1.1  nisimura 		return (0);
    412   1.1  nisimura 
    413   1.1  nisimura 	case WSDISPLAYIO_GCURPOS:
    414   1.1  nisimura 		*(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
    415   1.1  nisimura 		return (0);
    416   1.1  nisimura 
    417   1.1  nisimura 	case WSDISPLAYIO_SCURPOS:
    418  1.43        ad 		s = spltty();
    419   1.1  nisimura 		set_curpos(sc, (struct wsdisplay_curpos *)data);
    420  1.27   reinoud 		sc->sc_changed |= WSDISPLAY_CURSOR_DOPOS;
    421  1.43        ad 		splx(s);
    422   1.1  nisimura 		return (0);
    423   1.1  nisimura 
    424   1.1  nisimura 	case WSDISPLAYIO_GCURMAX:
    425   1.1  nisimura 		((struct wsdisplay_curpos *)data)->x =
    426   1.1  nisimura 		((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
    427   1.1  nisimura 		return (0);
    428   1.1  nisimura 
    429   1.1  nisimura 	case WSDISPLAYIO_GCURSOR:
    430   1.1  nisimura 		return get_cursor(sc, (struct wsdisplay_cursor *)data);
    431   1.1  nisimura 
    432   1.1  nisimura 	case WSDISPLAYIO_SCURSOR:
    433   1.1  nisimura 		return set_cursor(sc, (struct wsdisplay_cursor *)data);
    434  1.43        ad 
    435  1.43        ad 	case WSDISPLAYIO_SMODE:
    436  1.43        ad 		if (*(int *)data == WSDISPLAYIO_MODE_EMUL) {
    437  1.43        ad 			s = spltty();
    438  1.43        ad 			cfb_cmap_init(sc);
    439  1.43        ad 			sc->sc_curenb = 0;
    440  1.43        ad 			sc->sc_blanked = 0;
    441  1.43        ad 			sc->sc_changed |= (WSDISPLAY_CURSOR_DOCUR |
    442  1.43        ad 			    WSDISPLAY_CMAP_DOLUT);
    443  1.43        ad 			splx(s);
    444  1.43        ad 		}
    445  1.43        ad 		return (0);
    446   1.1  nisimura 	}
    447  1.32    atatat 	return EPASSTHROUGH;
    448   1.1  nisimura }
    449   1.1  nisimura 
    450  1.21    simonb paddr_t
    451   1.1  nisimura cfbmmap(v, offset, prot)
    452   1.1  nisimura 	void *v;
    453   1.1  nisimura 	off_t offset;
    454   1.1  nisimura 	int prot;
    455   1.1  nisimura {
    456   1.1  nisimura 	struct cfb_softc *sc = v;
    457   1.1  nisimura 
    458   1.5       mrg 	if (offset >= CX_FB_SIZE || offset < 0)
    459   1.1  nisimura 		return (-1);
    460  1.29  nisimura 	return machine_btop(sc->sc_vaddr + CX_FB_OFFSET + offset);
    461   1.1  nisimura }
    462   1.1  nisimura 
    463  1.14  nisimura static int
    464   1.1  nisimura cfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
    465   1.1  nisimura 	void *v;
    466   1.1  nisimura 	const struct wsscreen_descr *type;
    467   1.1  nisimura 	void **cookiep;
    468   1.1  nisimura 	int *curxp, *curyp;
    469   1.1  nisimura 	long *attrp;
    470   1.1  nisimura {
    471   1.1  nisimura 	struct cfb_softc *sc = v;
    472  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    473   1.1  nisimura 	long defattr;
    474   1.1  nisimura 
    475   1.1  nisimura 	if (sc->nscreens > 0)
    476   1.1  nisimura 		return (ENOMEM);
    477   1.1  nisimura 
    478  1.29  nisimura 	*cookiep = ri;	 /* one and only for now */
    479   1.1  nisimura 	*curxp = 0;
    480   1.1  nisimura 	*curyp = 0;
    481  1.33  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    482   1.1  nisimura 	*attrp = defattr;
    483   1.1  nisimura 	sc->nscreens++;
    484   1.1  nisimura 	return (0);
    485   1.1  nisimura }
    486   1.1  nisimura 
    487  1.14  nisimura static void
    488   1.1  nisimura cfb_free_screen(v, cookie)
    489   1.1  nisimura 	void *v;
    490   1.1  nisimura 	void *cookie;
    491   1.1  nisimura {
    492   1.1  nisimura 	struct cfb_softc *sc = v;
    493   1.1  nisimura 
    494  1.29  nisimura 	if (sc->sc_ri == &cfb_console_ri)
    495   1.1  nisimura 		panic("cfb_free_screen: console");
    496   1.1  nisimura 
    497   1.1  nisimura 	sc->nscreens--;
    498   1.1  nisimura }
    499   1.1  nisimura 
    500  1.15  drochner static int
    501  1.16  nisimura cfb_show_screen(v, cookie, waitok, cb, cbarg)
    502   1.1  nisimura 	void *v;
    503   1.1  nisimura 	void *cookie;
    504  1.15  drochner 	int waitok;
    505  1.44  nisimura 	void (*cb)(void *, int, int);
    506  1.15  drochner 	void *cbarg;
    507   1.1  nisimura {
    508  1.15  drochner 
    509  1.15  drochner 	return (0);
    510   1.1  nisimura }
    511   1.1  nisimura 
    512  1.14  nisimura /* EXPORT */ int
    513   1.1  nisimura cfb_cnattach(addr)
    514  1.18  nisimura 	tc_addr_t addr;
    515   1.1  nisimura {
    516  1.29  nisimura 	struct rasops_info *ri;
    517  1.18  nisimura 	long defattr;
    518   1.1  nisimura 
    519  1.29  nisimura 	ri = &cfb_console_ri;
    520  1.29  nisimura 	ri->ri_hw = (void *)addr;
    521  1.29  nisimura 	cfb_common_init(ri);
    522  1.33  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    523  1.29  nisimura 	wsdisplay_cnattach(&cfb_stdscreen, ri, 0, 0, defattr);
    524  1.18  nisimura 	cfb_consaddr = addr;
    525  1.18  nisimura 	return(0);
    526   1.1  nisimura }
    527   1.1  nisimura 
    528  1.14  nisimura static int
    529   1.1  nisimura cfbintr(arg)
    530   1.1  nisimura 	void *arg;
    531   1.1  nisimura {
    532   1.1  nisimura 	struct cfb_softc *sc = arg;
    533  1.29  nisimura 	caddr_t base, vdac;
    534   1.1  nisimura 	int v;
    535   1.1  nisimura 
    536  1.29  nisimura 	base = (caddr_t)sc->sc_ri->ri_hw;
    537  1.29  nisimura 	*(u_int8_t *)(base + CX_OFFSET_IREQ) = 0;
    538   1.1  nisimura 	if (sc->sc_changed == 0)
    539   1.1  nisimura 		return (1);
    540   1.1  nisimura 
    541  1.29  nisimura 	vdac = base + CX_BT459_OFFSET;
    542   1.1  nisimura 	v = sc->sc_changed;
    543  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR) {
    544  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CCR);
    545  1.44  nisimura 		REGWRITE32(vdac, bt_reg, (sc->sc_curenb) ? 0xc0 : 0x00);
    546   1.1  nisimura 	}
    547  1.26  nisimura 	if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOHOT)) {
    548  1.26  nisimura 		int x, y;
    549  1.26  nisimura 
    550  1.26  nisimura 		x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
    551  1.26  nisimura 		y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
    552  1.26  nisimura 
    553  1.26  nisimura 		x += sc->sc_cursor.cc_magic.x;
    554  1.26  nisimura 		y += sc->sc_cursor.cc_magic.y;
    555  1.26  nisimura 
    556  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CURSOR_X_LOW);
    557  1.44  nisimura 		REGWRITE32(vdac, bt_reg, x);
    558  1.44  nisimura 		REGWRITE32(vdac, bt_reg, x >> 8);
    559  1.44  nisimura 		REGWRITE32(vdac, bt_reg, y);
    560  1.44  nisimura 		REGWRITE32(vdac, bt_reg, y >> 8);
    561  1.26  nisimura 	}
    562  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    563   1.1  nisimura 		u_int8_t *cp = sc->sc_cursor.cc_color;
    564   1.1  nisimura 
    565  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CCOLOR_2);
    566  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[1]);
    567  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[3]);
    568  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[5]);
    569  1.44  nisimura 
    570  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[0]);
    571  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[2]);
    572  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[4]);
    573   1.1  nisimura 	}
    574  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    575   1.3  nisimura 		u_int8_t *ip, *mp, img, msk;
    576   1.3  nisimura 		u_int8_t u;
    577   1.3  nisimura 		int bcnt;
    578   1.3  nisimura 
    579   1.3  nisimura 		ip = (u_int8_t *)sc->sc_cursor.cc_image;
    580  1.42       chs 		mp = (u_int8_t *)sc->sc_cursor.cc_mask;
    581   1.3  nisimura 
    582   1.3  nisimura 		bcnt = 0;
    583  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CRAM_BASE+0);
    584   1.3  nisimura 		/* 64 pixel scan line is consisted with 16 byte cursor ram */
    585   1.3  nisimura 		while (bcnt < sc->sc_cursor.cc_size.y * 16) {
    586   1.3  nisimura 			/* pad right half 32 pixel when smaller than 33 */
    587   1.3  nisimura 			if ((bcnt & 0x8) && sc->sc_cursor.cc_size.x < 33) {
    588  1.44  nisimura 				REGWRITE32(vdac, bt_reg, 0);
    589  1.44  nisimura 				REGWRITE32(vdac, bt_reg, 0);
    590   1.3  nisimura 			}
    591   1.3  nisimura 			else {
    592   1.3  nisimura 				img = *ip++;
    593   1.3  nisimura 				msk = *mp++;
    594   1.3  nisimura 				img &= msk;	/* cookie off image */
    595   1.3  nisimura 				u = (msk & 0x0f) << 4 | (img & 0x0f);
    596  1.44  nisimura 				REGWRITE32(vdac, bt_reg, shuffle[u]);
    597   1.3  nisimura 				u = (msk & 0xf0) | (img & 0xf0) >> 4;
    598  1.44  nisimura 				REGWRITE32(vdac, bt_reg, shuffle[u]);
    599   1.3  nisimura 			}
    600   1.3  nisimura 			bcnt += 2;
    601   1.3  nisimura 		}
    602   1.3  nisimura 		/* pad unoccupied scan lines */
    603   1.3  nisimura 		while (bcnt < CURSOR_MAX_SIZE * 16) {
    604  1.44  nisimura 			REGWRITE32(vdac, bt_reg, 0);
    605  1.44  nisimura 			REGWRITE32(vdac, bt_reg, 0);
    606   1.3  nisimura 			bcnt += 2;
    607   1.1  nisimura 		}
    608   1.1  nisimura 	}
    609  1.26  nisimura 	if (v & WSDISPLAY_CMAP_DOLUT) {
    610  1.11  nisimura 		struct hwcmap256 *cm = &sc->sc_cmap;
    611   1.1  nisimura 		int index;
    612   1.1  nisimura 
    613  1.44  nisimura 		VDACSELECT(vdac, 0);
    614   1.1  nisimura 		for (index = 0; index < CMAP_SIZE; index++) {
    615  1.44  nisimura 			REGWRITE32(vdac, bt_cmap, cm->r[index]);
    616  1.44  nisimura 			REGWRITE32(vdac, bt_cmap, cm->g[index]);
    617  1.44  nisimura 			REGWRITE32(vdac, bt_cmap, cm->b[index]);
    618   1.1  nisimura 		}
    619   1.1  nisimura 	}
    620  1.26  nisimura 	sc->sc_changed = 0;
    621   1.1  nisimura 	return (1);
    622   1.1  nisimura }
    623   1.1  nisimura 
    624  1.14  nisimura static void
    625  1.29  nisimura cfbhwinit(cfbbase)
    626  1.29  nisimura 	caddr_t cfbbase;
    627   1.1  nisimura {
    628  1.29  nisimura 	caddr_t vdac = cfbbase + CX_BT459_OFFSET;
    629  1.24  nisimura 	const u_int8_t *p;
    630   1.1  nisimura 	int i;
    631   1.1  nisimura 
    632  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_COMMAND_0);
    633  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x40); /* CMD0 */
    634  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* CMD1 */
    635  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xc0); /* CMD2 */
    636  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff); /* PRM */
    637  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);    /* 205 */
    638  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* PBM */
    639  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);    /* 207 */
    640  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* ORM */
    641  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* OBM */
    642  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* ILV */
    643  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* TEST */
    644  1.44  nisimura 
    645  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_CCR);
    646  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    647  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    648  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    649  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    650  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    651  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    652  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    653  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    654  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    655  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    656  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    657  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    658  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    659   1.3  nisimura 
    660   1.3  nisimura 	/* build sane colormap */
    661  1.44  nisimura 	VDACSELECT(vdac, 0);
    662  1.24  nisimura 	p = rasops_cmap;
    663  1.25  nisimura 	for (i = 0; i < CMAP_SIZE; i++, p += 3) {
    664  1.44  nisimura 		REGWRITE32(vdac, bt_cmap, p[0]);
    665  1.44  nisimura 		REGWRITE32(vdac, bt_cmap, p[1]);
    666  1.44  nisimura 		REGWRITE32(vdac, bt_cmap, p[2]);
    667   1.3  nisimura 	}
    668   1.3  nisimura 
    669   1.3  nisimura 	/* clear out cursor image */
    670  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_CRAM_BASE);
    671   1.3  nisimura 	for (i = 0; i < 1024; i++)
    672  1.44  nisimura 		REGWRITE32(vdac, bt_reg, 0xff);
    673   1.3  nisimura 
    674   1.3  nisimura 	/*
    675   1.3  nisimura 	 * 2 bit/pixel cursor.  Assign MSB for cursor mask and LSB for
    676   1.3  nisimura 	 * cursor image.  CCOLOR_2 for mask color, while CCOLOR_3 for
    677   1.3  nisimura 	 * image color.  CCOLOR_1 will be never used.
    678   1.3  nisimura 	 */
    679  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_CCOLOR_1);
    680  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    681  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    682  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    683  1.44  nisimura 
    684  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);
    685  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);
    686  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);
    687  1.44  nisimura 
    688  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    689  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    690  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    691   1.1  nisimura }
    692   1.1  nisimura 
    693   1.1  nisimura static int
    694   1.1  nisimura get_cmap(sc, p)
    695   1.1  nisimura 	struct cfb_softc *sc;
    696   1.1  nisimura 	struct wsdisplay_cmap *p;
    697   1.1  nisimura {
    698   1.1  nisimura 	u_int index = p->index, count = p->count;
    699  1.42       chs 	int error;
    700   1.1  nisimura 
    701  1.35     itohy 	if (index >= CMAP_SIZE || count > CMAP_SIZE - index)
    702   1.1  nisimura 		return (EINVAL);
    703   1.1  nisimura 
    704  1.42       chs 	error = copyout(&sc->sc_cmap.r[index], p->red, count);
    705  1.42       chs 	if (error)
    706  1.42       chs 		return error;
    707  1.42       chs 	error = copyout(&sc->sc_cmap.g[index], p->green, count);
    708  1.42       chs 	if (error)
    709  1.42       chs 		return error;
    710  1.42       chs 	error = copyout(&sc->sc_cmap.b[index], p->blue, count);
    711  1.42       chs 	return error;
    712   1.1  nisimura }
    713   1.1  nisimura 
    714   1.1  nisimura static int
    715   1.1  nisimura set_cmap(sc, p)
    716   1.1  nisimura 	struct cfb_softc *sc;
    717   1.1  nisimura 	struct wsdisplay_cmap *p;
    718   1.1  nisimura {
    719  1.42       chs 	struct hwcmap256 cmap;
    720   1.1  nisimura 	u_int index = p->index, count = p->count;
    721  1.43        ad 	int error, s;
    722   1.1  nisimura 
    723  1.36     itohy 	if (index >= CMAP_SIZE || count > CMAP_SIZE - index)
    724   1.1  nisimura 		return (EINVAL);
    725   1.1  nisimura 
    726  1.42       chs 	error = copyin(p->red, &cmap.r[index], count);
    727  1.42       chs 	if (error)
    728  1.42       chs 		return error;
    729  1.42       chs 	error = copyin(p->green, &cmap.g[index], count);
    730  1.42       chs 	if (error)
    731  1.42       chs 		return error;
    732  1.42       chs 	error = copyin(p->blue, &cmap.b[index], count);
    733  1.42       chs 	if (error)
    734  1.42       chs 		return error;
    735  1.43        ad 	s = spltty();
    736  1.42       chs 	memcpy(&sc->sc_cmap.r[index], &cmap.r[index], count);
    737  1.42       chs 	memcpy(&sc->sc_cmap.g[index], &cmap.g[index], count);
    738  1.42       chs 	memcpy(&sc->sc_cmap.b[index], &cmap.b[index], count);
    739  1.26  nisimura 	sc->sc_changed |= WSDISPLAY_CMAP_DOLUT;
    740  1.43        ad 	splx(s);
    741   1.1  nisimura 	return (0);
    742   1.1  nisimura }
    743   1.1  nisimura 
    744   1.1  nisimura static int
    745   1.1  nisimura set_cursor(sc, p)
    746   1.1  nisimura 	struct cfb_softc *sc;
    747   1.1  nisimura 	struct wsdisplay_cursor *p;
    748   1.1  nisimura {
    749   1.1  nisimura #define	cc (&sc->sc_cursor)
    750  1.41       chs 	u_int v, index = 0, count = 0, icount = 0;
    751  1.42       chs 	uint8_t r[2], g[2], b[2], image[512], mask[512];
    752  1.43        ad 	int error, s;
    753   1.1  nisimura 
    754   1.1  nisimura 	v = p->which;
    755   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    756   1.1  nisimura 		index = p->cmap.index;
    757   1.1  nisimura 		count = p->cmap.count;
    758   1.1  nisimura 		if (index >= 2 || (index + count) > 2)
    759   1.1  nisimura 			return (EINVAL);
    760  1.42       chs 		error = copyin(p->cmap.red, &r[index], count);
    761  1.42       chs 		if (error)
    762  1.42       chs 			return error;
    763  1.42       chs 		error = copyin(p->cmap.green, &g[index], count);
    764  1.42       chs 		if (error)
    765  1.42       chs 			return error;
    766  1.42       chs 		error = copyin(p->cmap.blue, &b[index], count);
    767  1.42       chs 		if (error)
    768  1.42       chs 			return error;
    769   1.1  nisimura 	}
    770   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    771   1.1  nisimura 		if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
    772   1.1  nisimura 			return (EINVAL);
    773   1.4  nisimura 		icount = ((p->size.x < 33) ? 4 : 8) * p->size.y;
    774  1.42       chs 		error = copyin(p->image, image, icount);
    775  1.42       chs 		if (error)
    776  1.42       chs 			return error;
    777  1.42       chs 		error = copyin(p->mask, mask, icount);
    778  1.42       chs 		if (error)
    779  1.42       chs 			return error;
    780   1.1  nisimura 	}
    781   1.1  nisimura 
    782  1.43        ad 	s = spltty();
    783  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR)
    784   1.1  nisimura 		sc->sc_curenb = p->enable;
    785  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOPOS)
    786  1.26  nisimura 		set_curpos(sc, &p->pos);
    787  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOHOT)
    788  1.26  nisimura 		cc->cc_hot = p->hot;
    789   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    790  1.42       chs 		memcpy(&cc->cc_color[index], &r[index], count);
    791  1.42       chs 		memcpy(&cc->cc_color[index + 2], &g[index], count);
    792  1.42       chs 		memcpy(&cc->cc_color[index + 4], &b[index], count);
    793   1.1  nisimura 	}
    794   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    795   1.1  nisimura 		cc->cc_size = p->size;
    796   1.1  nisimura 		memset(cc->cc_image, 0, sizeof cc->cc_image);
    797  1.42       chs 		memcpy(cc->cc_image, image, icount);
    798  1.42       chs 		memset(cc->cc_mask, 0, sizeof cc->cc_mask);
    799  1.42       chs 		memcpy(cc->cc_mask, mask, icount);
    800   1.1  nisimura 	}
    801  1.27   reinoud 	sc->sc_changed |= v;
    802  1.43        ad 	splx(s);
    803   1.1  nisimura 
    804   1.1  nisimura 	return (0);
    805   1.1  nisimura #undef cc
    806   1.1  nisimura }
    807   1.1  nisimura 
    808   1.1  nisimura static int
    809   1.1  nisimura get_cursor(sc, p)
    810   1.1  nisimura 	struct cfb_softc *sc;
    811   1.1  nisimura 	struct wsdisplay_cursor *p;
    812   1.1  nisimura {
    813  1.32    atatat 	return (EPASSTHROUGH); /* XXX */
    814   1.1  nisimura }
    815   1.1  nisimura 
    816   1.1  nisimura static void
    817   1.1  nisimura set_curpos(sc, curpos)
    818   1.1  nisimura 	struct cfb_softc *sc;
    819   1.1  nisimura 	struct wsdisplay_curpos *curpos;
    820   1.1  nisimura {
    821  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    822   1.1  nisimura 	int x = curpos->x, y = curpos->y;
    823   1.1  nisimura 
    824   1.1  nisimura 	if (y < 0)
    825   1.1  nisimura 		y = 0;
    826  1.29  nisimura 	else if (y > ri->ri_height)
    827  1.29  nisimura 		y = ri->ri_height;
    828   1.1  nisimura 	if (x < 0)
    829   1.1  nisimura 		x = 0;
    830  1.29  nisimura 	else if (x > ri->ri_width)
    831  1.29  nisimura 		x = ri->ri_width;
    832   1.1  nisimura 	sc->sc_cursor.cc_pos.x = x;
    833   1.1  nisimura 	sc->sc_cursor.cc_pos.y = y;
    834   1.1  nisimura }
    835