Home | History | Annotate | Line # | Download | only in tc
cfb.c revision 1.49
      1  1.49   thorpej /* $NetBSD: cfb.c,v 1.49 2006/03/31 17:39:33 thorpej 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.49   thorpej __KERNEL_RCSID(0, "$NetBSD: cfb.c,v 1.49 2006/03/31 17:39:33 thorpej 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.46     perry #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.47  christos static int	cfbioctl(void *, u_long, caddr_t, int, struct lwp *);
    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.49   thorpej cfbmatch(struct device *parent, struct cfdata *match, void *aux)
    239   1.1  nisimura {
    240   1.1  nisimura 	struct tc_attach_args *ta = aux;
    241   1.1  nisimura 
    242   1.1  nisimura 	if (strncmp("PMAG-BA ", ta->ta_modname, TC_ROM_LLEN) != 0)
    243   1.1  nisimura 		return (0);
    244   1.1  nisimura 
    245   1.1  nisimura 	return (1);
    246   1.1  nisimura }
    247   1.1  nisimura 
    248  1.14  nisimura static void
    249  1.49   thorpej cfbattach(struct device *parent, struct device *self, void *aux)
    250   1.1  nisimura {
    251  1.48   thorpej 	struct cfb_softc *sc = device_private(self);
    252   1.1  nisimura 	struct tc_attach_args *ta = aux;
    253  1.29  nisimura 	struct rasops_info *ri;
    254   1.1  nisimura 	struct wsemuldisplaydev_attach_args waa;
    255  1.43        ad 	int console;
    256   1.1  nisimura 
    257   1.1  nisimura 	console = (ta->ta_addr == cfb_consaddr);
    258   1.1  nisimura 	if (console) {
    259  1.29  nisimura 		sc->sc_ri = ri = &cfb_console_ri;
    260   1.1  nisimura 		sc->nscreens = 1;
    261   1.1  nisimura 	}
    262   1.1  nisimura 	else {
    263  1.29  nisimura 		MALLOC(ri, struct rasops_info *, sizeof(struct rasops_info),
    264  1.29  nisimura 			M_DEVBUF, M_NOWAIT);
    265  1.29  nisimura 		if (ri == NULL) {
    266  1.29  nisimura 			printf(": can't alloc memory\n");
    267  1.29  nisimura 			return;
    268  1.29  nisimura 		}
    269  1.29  nisimura 		memset(ri, 0, sizeof(struct rasops_info));
    270  1.29  nisimura 
    271  1.29  nisimura 		ri->ri_hw = (void *)ta->ta_addr;
    272  1.29  nisimura 		cfb_common_init(ri);
    273  1.29  nisimura 		sc->sc_ri = ri;
    274   1.1  nisimura 	}
    275  1.29  nisimura 	printf(": %dx%d, %dbpp\n", ri->ri_width, ri->ri_height, ri->ri_depth);
    276   1.1  nisimura 
    277  1.43        ad 	cfb_cmap_init(sc);
    278  1.11  nisimura 
    279  1.29  nisimura 	sc->sc_vaddr = ta->ta_addr;
    280  1.11  nisimura 	sc->sc_cursor.cc_magic.x = CX_MAGIC_X;
    281  1.11  nisimura 	sc->sc_cursor.cc_magic.y = CX_MAGIC_Y;
    282  1.29  nisimura 	sc->sc_blanked = sc->sc_curenb = 0;
    283   1.1  nisimura 
    284  1.14  nisimura 	tc_intr_establish(parent, ta->ta_cookie, IPL_TTY, cfbintr, sc);
    285  1.29  nisimura 
    286  1.29  nisimura 	/* clear any pending interrupts */
    287  1.44  nisimura 	*(volatile u_int8_t *)((caddr_t)ri->ri_hw + CX_OFFSET_IREQ) = 0;
    288   1.1  nisimura 
    289   1.1  nisimura 	waa.console = console;
    290   1.1  nisimura 	waa.scrdata = &cfb_screenlist;
    291   1.1  nisimura 	waa.accessops = &cfb_accessops;
    292   1.1  nisimura 	waa.accesscookie = sc;
    293   1.1  nisimura 
    294   1.1  nisimura 	config_found(self, &waa, wsemuldisplaydevprint);
    295   1.1  nisimura }
    296   1.1  nisimura 
    297  1.29  nisimura static void
    298  1.49   thorpej cfb_cmap_init(struct cfb_softc *sc)
    299  1.43        ad {
    300  1.43        ad 	struct hwcmap256 *cm;
    301  1.43        ad 	const u_int8_t *p;
    302  1.43        ad 	int index;
    303  1.43        ad 
    304  1.43        ad 	cm = &sc->sc_cmap;
    305  1.43        ad 	p = rasops_cmap;
    306  1.43        ad 	for (index = 0; index < CMAP_SIZE; index++, p += 3) {
    307  1.43        ad 		cm->r[index] = p[0];
    308  1.43        ad 		cm->g[index] = p[1];
    309  1.43        ad 		cm->b[index] = p[2];
    310  1.43        ad 	}
    311  1.43        ad }
    312  1.43        ad 
    313  1.43        ad static void
    314  1.49   thorpej cfb_common_init(struct rasops_info *ri)
    315  1.29  nisimura {
    316  1.29  nisimura 	caddr_t base;
    317  1.29  nisimura 	int cookie;
    318  1.29  nisimura 
    319  1.29  nisimura 	base = (caddr_t)ri->ri_hw;
    320  1.29  nisimura 
    321  1.29  nisimura 	/* initialize colormap and cursor hardware */
    322  1.29  nisimura 	cfbhwinit(base);
    323  1.29  nisimura 
    324  1.29  nisimura 	ri->ri_flg = RI_CENTER;
    325  1.29  nisimura 	ri->ri_depth = 8;
    326  1.29  nisimura 	ri->ri_width = 1024;
    327  1.29  nisimura 	ri->ri_height = 864;
    328  1.29  nisimura 	ri->ri_stride = 1024;
    329  1.29  nisimura 	ri->ri_bits = base + CX_FB_OFFSET;
    330  1.29  nisimura 
    331  1.29  nisimura 	/* clear the screen */
    332  1.29  nisimura 	memset(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
    333  1.29  nisimura 
    334  1.29  nisimura 	wsfont_init();
    335  1.29  nisimura 	/* prefer 12 pixel wide font */
    336  1.31        ad 	cookie = wsfont_find(NULL, 12, 0, 0, WSDISPLAY_FONTORDER_L2R,
    337  1.31        ad 	    WSDISPLAY_FONTORDER_L2R);
    338  1.31        ad 	if (cookie <= 0)
    339  1.31        ad 		cookie = wsfont_find(NULL, 0, 0, 0, WSDISPLAY_FONTORDER_L2R,
    340  1.31        ad 		    WSDISPLAY_FONTORDER_L2R);
    341  1.29  nisimura 	if (cookie <= 0) {
    342  1.29  nisimura 		printf("cfb: font table is empty\n");
    343  1.29  nisimura 		return;
    344  1.29  nisimura 	}
    345  1.29  nisimura 
    346  1.31        ad 	if (wsfont_lock(cookie, &ri->ri_font)) {
    347  1.29  nisimura 		printf("cfb: couldn't lock font\n");
    348  1.29  nisimura 		return;
    349  1.29  nisimura 	}
    350  1.29  nisimura 	ri->ri_wsfcookie = cookie;
    351  1.29  nisimura 
    352  1.29  nisimura 	rasops_init(ri, 34, 80);
    353  1.29  nisimura 
    354  1.29  nisimura 	/* XXX shouldn't be global */
    355  1.29  nisimura 	cfb_stdscreen.nrows = ri->ri_rows;
    356  1.29  nisimura 	cfb_stdscreen.ncols = ri->ri_cols;
    357  1.29  nisimura 	cfb_stdscreen.textops = &ri->ri_ops;
    358  1.29  nisimura 	cfb_stdscreen.capabilities = ri->ri_caps;
    359  1.29  nisimura }
    360  1.29  nisimura 
    361  1.14  nisimura static int
    362  1.49   thorpej cfbioctl(void *v, u_long cmd, caddr_t data, int flag, struct lwp *l)
    363   1.1  nisimura {
    364   1.1  nisimura 	struct cfb_softc *sc = v;
    365  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    366  1.43        ad 	int turnoff, s;
    367   1.1  nisimura 
    368   1.1  nisimura 	switch (cmd) {
    369   1.1  nisimura 	case WSDISPLAYIO_GTYPE:
    370   1.1  nisimura 		*(u_int *)data = WSDISPLAY_TYPE_CFB;
    371   1.1  nisimura 		return (0);
    372   1.1  nisimura 
    373   1.1  nisimura 	case WSDISPLAYIO_GINFO:
    374   1.1  nisimura #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    375  1.29  nisimura 		wsd_fbip->height = ri->ri_height;
    376  1.29  nisimura 		wsd_fbip->width = ri->ri_width;
    377  1.29  nisimura 		wsd_fbip->depth = ri->ri_depth;
    378   1.1  nisimura 		wsd_fbip->cmsize = CMAP_SIZE;
    379   1.1  nisimura #undef fbt
    380   1.1  nisimura 		return (0);
    381   1.1  nisimura 
    382   1.1  nisimura 	case WSDISPLAYIO_GETCMAP:
    383   1.1  nisimura 		return get_cmap(sc, (struct wsdisplay_cmap *)data);
    384   1.1  nisimura 
    385   1.1  nisimura 	case WSDISPLAYIO_PUTCMAP:
    386   1.1  nisimura 		return set_cmap(sc, (struct wsdisplay_cmap *)data);
    387   1.1  nisimura 
    388   1.1  nisimura 	case WSDISPLAYIO_SVIDEO:
    389   1.1  nisimura 		turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
    390  1.45    mhitch 		if (sc->sc_blanked != turnoff) {
    391  1.29  nisimura 			sc->sc_blanked = turnoff;
    392   1.3  nisimura 			/* XXX later XXX */
    393   1.1  nisimura 		}
    394   1.1  nisimura 		return (0);
    395   1.1  nisimura 
    396   1.1  nisimura 	case WSDISPLAYIO_GVIDEO:
    397  1.29  nisimura 		*(u_int *)data = sc->sc_blanked ?
    398   1.1  nisimura 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
    399   1.1  nisimura 		return (0);
    400   1.1  nisimura 
    401   1.1  nisimura 	case WSDISPLAYIO_GCURPOS:
    402   1.1  nisimura 		*(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
    403   1.1  nisimura 		return (0);
    404   1.1  nisimura 
    405   1.1  nisimura 	case WSDISPLAYIO_SCURPOS:
    406  1.43        ad 		s = spltty();
    407   1.1  nisimura 		set_curpos(sc, (struct wsdisplay_curpos *)data);
    408  1.27   reinoud 		sc->sc_changed |= WSDISPLAY_CURSOR_DOPOS;
    409  1.43        ad 		splx(s);
    410   1.1  nisimura 		return (0);
    411   1.1  nisimura 
    412   1.1  nisimura 	case WSDISPLAYIO_GCURMAX:
    413   1.1  nisimura 		((struct wsdisplay_curpos *)data)->x =
    414   1.1  nisimura 		((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
    415   1.1  nisimura 		return (0);
    416   1.1  nisimura 
    417   1.1  nisimura 	case WSDISPLAYIO_GCURSOR:
    418   1.1  nisimura 		return get_cursor(sc, (struct wsdisplay_cursor *)data);
    419   1.1  nisimura 
    420   1.1  nisimura 	case WSDISPLAYIO_SCURSOR:
    421   1.1  nisimura 		return set_cursor(sc, (struct wsdisplay_cursor *)data);
    422  1.43        ad 
    423  1.43        ad 	case WSDISPLAYIO_SMODE:
    424  1.43        ad 		if (*(int *)data == WSDISPLAYIO_MODE_EMUL) {
    425  1.43        ad 			s = spltty();
    426  1.43        ad 			cfb_cmap_init(sc);
    427  1.43        ad 			sc->sc_curenb = 0;
    428  1.43        ad 			sc->sc_blanked = 0;
    429  1.43        ad 			sc->sc_changed |= (WSDISPLAY_CURSOR_DOCUR |
    430  1.43        ad 			    WSDISPLAY_CMAP_DOLUT);
    431  1.43        ad 			splx(s);
    432  1.43        ad 		}
    433  1.43        ad 		return (0);
    434   1.1  nisimura 	}
    435  1.32    atatat 	return EPASSTHROUGH;
    436   1.1  nisimura }
    437   1.1  nisimura 
    438  1.21    simonb paddr_t
    439  1.49   thorpej cfbmmap(void *v, off_t offset, int prot)
    440   1.1  nisimura {
    441   1.1  nisimura 	struct cfb_softc *sc = v;
    442   1.1  nisimura 
    443   1.5       mrg 	if (offset >= CX_FB_SIZE || offset < 0)
    444   1.1  nisimura 		return (-1);
    445  1.29  nisimura 	return machine_btop(sc->sc_vaddr + CX_FB_OFFSET + offset);
    446   1.1  nisimura }
    447   1.1  nisimura 
    448  1.14  nisimura static int
    449  1.49   thorpej cfb_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
    450  1.49   thorpej     int *curxp, int *curyp, long *attrp)
    451   1.1  nisimura {
    452   1.1  nisimura 	struct cfb_softc *sc = v;
    453  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    454   1.1  nisimura 	long defattr;
    455   1.1  nisimura 
    456   1.1  nisimura 	if (sc->nscreens > 0)
    457   1.1  nisimura 		return (ENOMEM);
    458   1.1  nisimura 
    459  1.29  nisimura 	*cookiep = ri;	 /* one and only for now */
    460   1.1  nisimura 	*curxp = 0;
    461   1.1  nisimura 	*curyp = 0;
    462  1.33  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    463   1.1  nisimura 	*attrp = defattr;
    464   1.1  nisimura 	sc->nscreens++;
    465   1.1  nisimura 	return (0);
    466   1.1  nisimura }
    467   1.1  nisimura 
    468  1.14  nisimura static void
    469  1.49   thorpej cfb_free_screen(void *v, void *cookie)
    470   1.1  nisimura {
    471   1.1  nisimura 	struct cfb_softc *sc = v;
    472   1.1  nisimura 
    473  1.29  nisimura 	if (sc->sc_ri == &cfb_console_ri)
    474   1.1  nisimura 		panic("cfb_free_screen: console");
    475   1.1  nisimura 
    476   1.1  nisimura 	sc->nscreens--;
    477   1.1  nisimura }
    478   1.1  nisimura 
    479  1.15  drochner static int
    480  1.49   thorpej cfb_show_screen(void *v, void *cookie, int waitok,
    481  1.49   thorpej     void (*cb)(void *, int, int), void *cbarg)
    482   1.1  nisimura {
    483  1.15  drochner 
    484  1.15  drochner 	return (0);
    485   1.1  nisimura }
    486   1.1  nisimura 
    487  1.14  nisimura /* EXPORT */ int
    488  1.49   thorpej cfb_cnattach(tc_addr_t addr)
    489   1.1  nisimura {
    490  1.29  nisimura 	struct rasops_info *ri;
    491  1.18  nisimura 	long defattr;
    492   1.1  nisimura 
    493  1.29  nisimura 	ri = &cfb_console_ri;
    494  1.29  nisimura 	ri->ri_hw = (void *)addr;
    495  1.29  nisimura 	cfb_common_init(ri);
    496  1.33  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    497  1.29  nisimura 	wsdisplay_cnattach(&cfb_stdscreen, ri, 0, 0, defattr);
    498  1.18  nisimura 	cfb_consaddr = addr;
    499  1.18  nisimura 	return(0);
    500   1.1  nisimura }
    501   1.1  nisimura 
    502  1.14  nisimura static int
    503  1.49   thorpej cfbintr(void *arg)
    504   1.1  nisimura {
    505   1.1  nisimura 	struct cfb_softc *sc = arg;
    506  1.29  nisimura 	caddr_t base, vdac;
    507   1.1  nisimura 	int v;
    508  1.46     perry 
    509  1.29  nisimura 	base = (caddr_t)sc->sc_ri->ri_hw;
    510  1.29  nisimura 	*(u_int8_t *)(base + CX_OFFSET_IREQ) = 0;
    511   1.1  nisimura 	if (sc->sc_changed == 0)
    512   1.1  nisimura 		return (1);
    513   1.1  nisimura 
    514  1.29  nisimura 	vdac = base + CX_BT459_OFFSET;
    515   1.1  nisimura 	v = sc->sc_changed;
    516  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR) {
    517  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CCR);
    518  1.44  nisimura 		REGWRITE32(vdac, bt_reg, (sc->sc_curenb) ? 0xc0 : 0x00);
    519   1.1  nisimura 	}
    520  1.26  nisimura 	if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOHOT)) {
    521  1.26  nisimura 		int x, y;
    522  1.26  nisimura 
    523  1.26  nisimura 		x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
    524  1.26  nisimura 		y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
    525  1.26  nisimura 
    526  1.26  nisimura 		x += sc->sc_cursor.cc_magic.x;
    527  1.26  nisimura 		y += sc->sc_cursor.cc_magic.y;
    528  1.26  nisimura 
    529  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CURSOR_X_LOW);
    530  1.46     perry 		REGWRITE32(vdac, bt_reg, x);
    531  1.44  nisimura 		REGWRITE32(vdac, bt_reg, x >> 8);
    532  1.44  nisimura 		REGWRITE32(vdac, bt_reg, y);
    533  1.44  nisimura 		REGWRITE32(vdac, bt_reg, y >> 8);
    534  1.26  nisimura 	}
    535  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    536   1.1  nisimura 		u_int8_t *cp = sc->sc_cursor.cc_color;
    537   1.1  nisimura 
    538  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CCOLOR_2);
    539  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[1]);
    540  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[3]);
    541  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[5]);
    542  1.44  nisimura 
    543  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[0]);
    544  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[2]);
    545  1.44  nisimura 		REGWRITE32(vdac, bt_reg, cp[4]);
    546   1.1  nisimura 	}
    547  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    548   1.3  nisimura 		u_int8_t *ip, *mp, img, msk;
    549   1.3  nisimura 		u_int8_t u;
    550   1.3  nisimura 		int bcnt;
    551   1.3  nisimura 
    552   1.3  nisimura 		ip = (u_int8_t *)sc->sc_cursor.cc_image;
    553  1.42       chs 		mp = (u_int8_t *)sc->sc_cursor.cc_mask;
    554   1.3  nisimura 
    555   1.3  nisimura 		bcnt = 0;
    556  1.44  nisimura 		VDACSELECT(vdac, BT459_IREG_CRAM_BASE+0);
    557   1.3  nisimura 		/* 64 pixel scan line is consisted with 16 byte cursor ram */
    558   1.3  nisimura 		while (bcnt < sc->sc_cursor.cc_size.y * 16) {
    559   1.3  nisimura 			/* pad right half 32 pixel when smaller than 33 */
    560   1.3  nisimura 			if ((bcnt & 0x8) && sc->sc_cursor.cc_size.x < 33) {
    561  1.44  nisimura 				REGWRITE32(vdac, bt_reg, 0);
    562  1.44  nisimura 				REGWRITE32(vdac, bt_reg, 0);
    563   1.3  nisimura 			}
    564   1.3  nisimura 			else {
    565   1.3  nisimura 				img = *ip++;
    566   1.3  nisimura 				msk = *mp++;
    567   1.3  nisimura 				img &= msk;	/* cookie off image */
    568   1.3  nisimura 				u = (msk & 0x0f) << 4 | (img & 0x0f);
    569  1.44  nisimura 				REGWRITE32(vdac, bt_reg, shuffle[u]);
    570   1.3  nisimura 				u = (msk & 0xf0) | (img & 0xf0) >> 4;
    571  1.44  nisimura 				REGWRITE32(vdac, bt_reg, shuffle[u]);
    572   1.3  nisimura 			}
    573   1.3  nisimura 			bcnt += 2;
    574   1.3  nisimura 		}
    575   1.3  nisimura 		/* pad unoccupied scan lines */
    576   1.3  nisimura 		while (bcnt < CURSOR_MAX_SIZE * 16) {
    577  1.44  nisimura 			REGWRITE32(vdac, bt_reg, 0);
    578  1.44  nisimura 			REGWRITE32(vdac, bt_reg, 0);
    579   1.3  nisimura 			bcnt += 2;
    580   1.1  nisimura 		}
    581   1.1  nisimura 	}
    582  1.26  nisimura 	if (v & WSDISPLAY_CMAP_DOLUT) {
    583  1.11  nisimura 		struct hwcmap256 *cm = &sc->sc_cmap;
    584   1.1  nisimura 		int index;
    585   1.1  nisimura 
    586  1.44  nisimura 		VDACSELECT(vdac, 0);
    587   1.1  nisimura 		for (index = 0; index < CMAP_SIZE; index++) {
    588  1.44  nisimura 			REGWRITE32(vdac, bt_cmap, cm->r[index]);
    589  1.44  nisimura 			REGWRITE32(vdac, bt_cmap, cm->g[index]);
    590  1.44  nisimura 			REGWRITE32(vdac, bt_cmap, cm->b[index]);
    591   1.1  nisimura 		}
    592   1.1  nisimura 	}
    593  1.26  nisimura 	sc->sc_changed = 0;
    594   1.1  nisimura 	return (1);
    595   1.1  nisimura }
    596   1.1  nisimura 
    597  1.14  nisimura static void
    598  1.49   thorpej cfbhwinit(caddr_t cfbbase)
    599   1.1  nisimura {
    600  1.29  nisimura 	caddr_t vdac = cfbbase + CX_BT459_OFFSET;
    601  1.24  nisimura 	const u_int8_t *p;
    602   1.1  nisimura 	int i;
    603   1.1  nisimura 
    604  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_COMMAND_0);
    605  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x40); /* CMD0 */
    606  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* CMD1 */
    607  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xc0); /* CMD2 */
    608  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff); /* PRM */
    609  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);    /* 205 */
    610  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* PBM */
    611  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);    /* 207 */
    612  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* ORM */
    613  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* OBM */
    614  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* ILV */
    615  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);  /* TEST */
    616  1.44  nisimura 
    617  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_CCR);
    618  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    619  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    620  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    621  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    622  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    623  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    624  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    625  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    626  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    627  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    628  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    629  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    630  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0x0);
    631   1.3  nisimura 
    632   1.3  nisimura 	/* build sane colormap */
    633  1.44  nisimura 	VDACSELECT(vdac, 0);
    634  1.24  nisimura 	p = rasops_cmap;
    635  1.25  nisimura 	for (i = 0; i < CMAP_SIZE; i++, p += 3) {
    636  1.44  nisimura 		REGWRITE32(vdac, bt_cmap, p[0]);
    637  1.44  nisimura 		REGWRITE32(vdac, bt_cmap, p[1]);
    638  1.44  nisimura 		REGWRITE32(vdac, bt_cmap, p[2]);
    639   1.3  nisimura 	}
    640   1.3  nisimura 
    641   1.3  nisimura 	/* clear out cursor image */
    642  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_CRAM_BASE);
    643   1.3  nisimura 	for (i = 0; i < 1024; i++)
    644  1.44  nisimura 		REGWRITE32(vdac, bt_reg, 0xff);
    645   1.3  nisimura 
    646   1.3  nisimura 	/*
    647   1.3  nisimura 	 * 2 bit/pixel cursor.  Assign MSB for cursor mask and LSB for
    648   1.3  nisimura 	 * cursor image.  CCOLOR_2 for mask color, while CCOLOR_3 for
    649   1.3  nisimura 	 * image color.  CCOLOR_1 will be never used.
    650   1.3  nisimura 	 */
    651  1.44  nisimura 	VDACSELECT(vdac, BT459_IREG_CCOLOR_1);
    652  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    653  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    654  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    655  1.44  nisimura 
    656  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);
    657  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);
    658  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0);
    659  1.44  nisimura 
    660  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    661  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    662  1.44  nisimura 	REGWRITE32(vdac, bt_reg, 0xff);
    663   1.1  nisimura }
    664   1.1  nisimura 
    665   1.1  nisimura static int
    666  1.49   thorpej get_cmap(struct cfb_softc *sc, struct wsdisplay_cmap *p)
    667   1.1  nisimura {
    668   1.1  nisimura 	u_int index = p->index, count = p->count;
    669  1.42       chs 	int error;
    670   1.1  nisimura 
    671  1.35     itohy 	if (index >= CMAP_SIZE || count > CMAP_SIZE - index)
    672   1.1  nisimura 		return (EINVAL);
    673   1.1  nisimura 
    674  1.42       chs 	error = copyout(&sc->sc_cmap.r[index], p->red, count);
    675  1.42       chs 	if (error)
    676  1.42       chs 		return error;
    677  1.42       chs 	error = copyout(&sc->sc_cmap.g[index], p->green, count);
    678  1.42       chs 	if (error)
    679  1.42       chs 		return error;
    680  1.42       chs 	error = copyout(&sc->sc_cmap.b[index], p->blue, count);
    681  1.42       chs 	return error;
    682   1.1  nisimura }
    683   1.1  nisimura 
    684   1.1  nisimura static int
    685  1.49   thorpej set_cmap(struct cfb_softc *sc, struct wsdisplay_cmap *p)
    686   1.1  nisimura {
    687  1.42       chs 	struct hwcmap256 cmap;
    688   1.1  nisimura 	u_int index = p->index, count = p->count;
    689  1.43        ad 	int error, s;
    690   1.1  nisimura 
    691  1.36     itohy 	if (index >= CMAP_SIZE || count > CMAP_SIZE - index)
    692   1.1  nisimura 		return (EINVAL);
    693   1.1  nisimura 
    694  1.42       chs 	error = copyin(p->red, &cmap.r[index], count);
    695  1.42       chs 	if (error)
    696  1.42       chs 		return error;
    697  1.42       chs 	error = copyin(p->green, &cmap.g[index], count);
    698  1.42       chs 	if (error)
    699  1.42       chs 		return error;
    700  1.42       chs 	error = copyin(p->blue, &cmap.b[index], count);
    701  1.42       chs 	if (error)
    702  1.42       chs 		return error;
    703  1.43        ad 	s = spltty();
    704  1.42       chs 	memcpy(&sc->sc_cmap.r[index], &cmap.r[index], count);
    705  1.42       chs 	memcpy(&sc->sc_cmap.g[index], &cmap.g[index], count);
    706  1.42       chs 	memcpy(&sc->sc_cmap.b[index], &cmap.b[index], count);
    707  1.26  nisimura 	sc->sc_changed |= WSDISPLAY_CMAP_DOLUT;
    708  1.43        ad 	splx(s);
    709   1.1  nisimura 	return (0);
    710   1.1  nisimura }
    711   1.1  nisimura 
    712   1.1  nisimura static int
    713  1.49   thorpej set_cursor(struct cfb_softc *sc, struct wsdisplay_cursor *p)
    714   1.1  nisimura {
    715   1.1  nisimura #define	cc (&sc->sc_cursor)
    716  1.41       chs 	u_int v, index = 0, count = 0, icount = 0;
    717  1.42       chs 	uint8_t r[2], g[2], b[2], image[512], mask[512];
    718  1.43        ad 	int error, s;
    719   1.1  nisimura 
    720   1.1  nisimura 	v = p->which;
    721   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    722   1.1  nisimura 		index = p->cmap.index;
    723   1.1  nisimura 		count = p->cmap.count;
    724   1.1  nisimura 		if (index >= 2 || (index + count) > 2)
    725   1.1  nisimura 			return (EINVAL);
    726  1.42       chs 		error = copyin(p->cmap.red, &r[index], count);
    727  1.42       chs 		if (error)
    728  1.42       chs 			return error;
    729  1.42       chs 		error = copyin(p->cmap.green, &g[index], count);
    730  1.42       chs 		if (error)
    731  1.42       chs 			return error;
    732  1.42       chs 		error = copyin(p->cmap.blue, &b[index], count);
    733  1.42       chs 		if (error)
    734  1.42       chs 			return error;
    735   1.1  nisimura 	}
    736   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    737   1.1  nisimura 		if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
    738   1.1  nisimura 			return (EINVAL);
    739   1.4  nisimura 		icount = ((p->size.x < 33) ? 4 : 8) * p->size.y;
    740  1.42       chs 		error = copyin(p->image, image, icount);
    741  1.42       chs 		if (error)
    742  1.42       chs 			return error;
    743  1.42       chs 		error = copyin(p->mask, mask, icount);
    744  1.42       chs 		if (error)
    745  1.42       chs 			return error;
    746   1.1  nisimura 	}
    747   1.1  nisimura 
    748  1.43        ad 	s = spltty();
    749  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR)
    750   1.1  nisimura 		sc->sc_curenb = p->enable;
    751  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOPOS)
    752  1.26  nisimura 		set_curpos(sc, &p->pos);
    753  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOHOT)
    754  1.26  nisimura 		cc->cc_hot = p->hot;
    755   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    756  1.42       chs 		memcpy(&cc->cc_color[index], &r[index], count);
    757  1.42       chs 		memcpy(&cc->cc_color[index + 2], &g[index], count);
    758  1.42       chs 		memcpy(&cc->cc_color[index + 4], &b[index], count);
    759   1.1  nisimura 	}
    760   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    761   1.1  nisimura 		cc->cc_size = p->size;
    762   1.1  nisimura 		memset(cc->cc_image, 0, sizeof cc->cc_image);
    763  1.42       chs 		memcpy(cc->cc_image, image, icount);
    764  1.42       chs 		memset(cc->cc_mask, 0, sizeof cc->cc_mask);
    765  1.42       chs 		memcpy(cc->cc_mask, mask, icount);
    766   1.1  nisimura 	}
    767  1.27   reinoud 	sc->sc_changed |= v;
    768  1.43        ad 	splx(s);
    769   1.1  nisimura 
    770   1.1  nisimura 	return (0);
    771   1.1  nisimura #undef cc
    772   1.1  nisimura }
    773   1.1  nisimura 
    774   1.1  nisimura static int
    775  1.49   thorpej get_cursor(struct cfb_softc *sc, struct wsdisplay_cursor *p)
    776   1.1  nisimura {
    777  1.32    atatat 	return (EPASSTHROUGH); /* XXX */
    778   1.1  nisimura }
    779   1.1  nisimura 
    780   1.1  nisimura static void
    781  1.49   thorpej set_curpos(struct cfb_softc *sc, struct wsdisplay_curpos *curpos)
    782   1.1  nisimura {
    783  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    784   1.1  nisimura 	int x = curpos->x, y = curpos->y;
    785   1.1  nisimura 
    786   1.1  nisimura 	if (y < 0)
    787   1.1  nisimura 		y = 0;
    788  1.29  nisimura 	else if (y > ri->ri_height)
    789  1.29  nisimura 		y = ri->ri_height;
    790   1.1  nisimura 	if (x < 0)
    791   1.1  nisimura 		x = 0;
    792  1.29  nisimura 	else if (x > ri->ri_width)
    793  1.29  nisimura 		x = ri->ri_width;
    794   1.1  nisimura 	sc->sc_cursor.cc_pos.x = x;
    795   1.1  nisimura 	sc->sc_cursor.cc_pos.y = y;
    796   1.1  nisimura }
    797